22 #include "1080to360.h"
24 #include <core/exception.h>
25 #include <utils/math/angle.h>
26 #include <utils/time/time.h>
44 unsigned int in_data_size,
45 std::vector<LaserDataFilter::Buffer *> &in)
59 const unsigned int vecsize = std::min(
in.size(),
out.size());
60 for (
unsigned int a = 0; a < vecsize; ++a) {
61 out[a]->frame =
in[a]->frame;
62 out[a]->timestamp->set_time(
in[a]->timestamp);
63 float *inbuf =
in[a]->values;
64 float *outbuf =
out[a]->values;
67 for (
unsigned int i = 0; i < 360; ++i) {
68 outbuf[i] = (inbuf[i * 3] + inbuf[i * 2 + 1] + inbuf[i * 2 + 2]) / 2.0;
71 for (
unsigned int i = 0; i < 360; ++i) {
72 outbuf[i] = inbuf[i * 3 + 1];