wind_estimator.h

Go to the documentation of this file.

/*
 * Copyright (C) 2016 Johan Maurin, Gautier Hattenberger
 *
 * This file is part of paparazzi.
 *
 * paparazzi is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * paparazzi is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with paparazzi; see the file COPYING.  If not, see
 * <http://www.gnu.org/licenses/>.
 */

#ifndef WIND_ESTIMATOR_H
#define WIND_ESTIMATOR_H

#include "std.h"
#include "math/pprz_algebra_float.h"

struct WindEstimator {
  struct FloatVect3 airspeed;   
  struct FloatVect3 wind;       
  bool data_available;          
  bool reset;                   

  // filter parameters
  float r_gs;       
  float r_va;       
  float r_aoa;      
  float r_ssa;      
  float q_va;       
  float q_wind;     
  float q_va_scale; 
};

extern struct WindEstimator wind_estimator;

extern void wind_estimator_init(void);
extern void wind_estimator_periodic(void);
extern void wind_estimator_event(void);

// paramenters settings handler
extern void wind_estimator_Set_R_GS(float _v);
extern void wind_estimator_Set_R_VA(float _v);
extern void wind_estimator_Set_R_AOA(float _v);
extern void wind_estimator_Set_R_SSA(float _v);
extern void wind_estimator_Set_Q_VA(float _v);
extern void wind_estimator_Set_Q_WIND(float _v);
extern void wind_estimator_Set_Q_VA_SCALE(float _v);

#endif