Function SampleMeasurementsDown

src/Resampling.cpp:27–63

namespace libRSF
{
  std::vector<Data> SampleMeasurementsDown(const std::vector<Data> &Input, const double SampleTime)
  {
    std::vector<Data> Output;

    if(Input.empty())
    {
      PRINT_ERROR("There is no Measurement!");
      return Output;
    }

    double Time = Input.front().getTimestamp();
    double TimeNext = Time + SampleTime;
    double TimeMax = Input.back().getTimestamp();

    std::vector<Data> AveragingWindow;
    for(const Data &Sensor : Input)
    {
      /** group measurements in periods of sample time length*/
      AveragingWindow.push_back(Sensor);

      /** average when period is over*/
      if(Sensor.getTimestamp() >= TimeNext || Sensor.getTimestamp() == TimeMax)
      {
        /** average measurements */
        Output.push_back(AverageMeasurement(AveragingWindow));

        /** set timestamp to last used measurements */
        Output.back().setTimestamp(AveragingWindow.back().getTimestamp());

        /** set end of new window and clear old one */
        AveragingWindow.clear();
        TimeNext += SampleTime;
      }
    }

    return Output;
  }

  Data AverageMeasurement(const std::vector<Data> &Input)
  {