23 #include "circle_sector.h" 25 #include <core/exception.h> 26 #include <utils/math/angle.h> 27 #include <utils/time/time.h> 51 unsigned int in_data_size,
52 std::vector<LaserDataFilter::Buffer *> &in)
62 const unsigned int vecsize = std::min(
in.size(),
out.size());
64 for (
unsigned int a = 0; a < vecsize; ++a) {
66 out[a]->frame =
in[a]->frame;
67 out[a]->timestamp->set_time(
in[a]->timestamp);
69 float *inbuf =
in[a]->values;
70 float *outbuf =
out[a]->values;
73 for (
unsigned int i = from_; i < arrsize; ++i) {
76 for (
unsigned int i = 0; i <= std::min(to_, arrsize - 1); ++i) {
80 for (
unsigned int i = from_; i <= std::min(to_, arrsize - 1); ++i) {
LaserCircleSectorDataFilter(const std::string &filter_name, unsigned int from, unsigned int to, unsigned int data_size, std::vector< LaserDataFilter::Buffer * > &in)
Constructor.
std::vector< Buffer * > out
Vector of output arrays.
Fawkes library namespace.
void filter()
Filter the incoming data.
void reset_outbuf(Buffer *b)
Resets all readings in outbuf to NaN.
unsigned int out_data_size
Number of entries in output arrays.
std::vector< Buffer * > in
Vector of input arrays.
unsigned int in_data_size
Number of entries in input arrays.