airplanecost.h

Go to the documentation of this file.

#ifndef GCOP_AIRPLANECOST_H
#define GCOP_AIRPLANECOST_H

#include "lqcost.h"
#include <limits>
#include "normal.h"

namespace gcop {
  
  using namespace std;
  using namespace Eigen;
  
  typedef Matrix<double, 5, 1> Vector5d;
  typedef Matrix<double, 5, 5> Matrix5d;
  typedef Matrix<double, 5, 2> Matrix52d;
  typedef pair<Matrix3d, Vector2d> M3V2d;
  

  class AirplaneCost : public LqCost<M3V2d, 5, 2> {
  public:      
    
    AirplaneCost(Airdouble tf, const M3V2d &xf, int N);
    
    double L(double t, const M3V2d &x, const Vector2d &u, double h,
             Vector5d *Lx = 0, Matrix5d *Lxx = 0,
             Vector2d *Lu = 0, Matrix2d *Luu = 0,
             Matrix52d *Lxu = 0);
    
    void SetObstacle(double s, double n);
    
    double n;
    //    Normal gd;  ///< Gaussian distribution    
    vector<Normal> gds;
    
  };
}

#endif