lin-estimator.hh

Go to the documentation of this file.

/*
   Oscar Efrain RAMOS PONCE, LAAS-CNRS
   Date: 28/10/2014
   Object to estimate a polynomial of first order that fits some data.
*/
 
#ifndef _LIN_ESTIMATOR_HH_
#define _LIN_ESTIMATOR_HH_
 
#include <sot/torque_control/utils/poly-estimator.hh>
 
class LinEstimator : public PolyEstimator {
 public:
  LinEstimator(const unsigned int& N, const unsigned int& dim,
               const double& dt = 0.0);
 
  virtual void estimate(std::vector<double>& estimee,
                        const std::vector<double>& el);
 
  virtual void estimateRecursive(std::vector<double>& estimee,
                                 const std::vector<double>& el,
                                 const double& time);
 
  void getEstimateDerivative(std::vector<double>& estimeeDerivative,
                             const unsigned int order);
 
 private:
  virtual void fit();
  virtual double getEsteeme();
 
  int dim_;  // size of the data
 
  // Sums for the recursive computation
  double sum_ti_;
  double sum_ti2_;
  std::vector<double> sum_xi_;
  std::vector<double> sum_tixi_;
 
  // coefficients of the polynomial c2*x^2 + c1*x + c0
  std::vector<double> c0_;
  std::vector<double> c1_;
 
  // Rows of the pseudo-inverse (when assuming constant sample time)
  double* pinv0_;
  double* pinv1_;
  // Half of the maximum time (according to the size of the window and dt)
  double tmed_;
};
 
#endif