Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
stabilization_indi_simple.h
Go to the documentation of this file.
1/*
2 * Copyright (C) Ewoud Smeur <ewoud_smeur@msn.com>
3 * MAVLab Delft University of Technology
4 *
5 * This control algorithm is Incremental Nonlinear Dynamic Inversion (INDI)
6 *
7 * This is a simplified implementation of the (soon to be) publication in the
8 * journal of Control Guidance and Dynamics: Adaptive Incremental Nonlinear
9 * Dynamic Inversion for Attitude Control of Micro Aerial Vehicles
10 *
11 * This file is part of paparazzi.
12 *
13 * paparazzi is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License as published by
15 * the Free Software Foundation; either version 2, or (at your option)
16 * any later version.
17 *
18 * paparazzi is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License
24 * along with paparazzi; see the file COPYING. If not, write to
25 * the Free Software Foundation, 59 Temple Place - Suite 330,
26 * Boston, MA 02111-1307, USA.
27 */
28
33
34#ifndef STABILIZATION_INDI_SIMPLE_H
35#define STABILIZATION_INDI_SIMPLE_H
36
41
42struct Indi_gains {
43 struct FloatRates att;
44 struct FloatRates rate;
45};
46
50 float rate_d[3];
51 float rate_dd[3];
52 float u_d[3];
53 float u_dd[3];
54 struct FloatRates g1;
55 float g2;
56 float mu;
57};
58
80
81
82extern struct IndiVariables indi;
83extern void stabilization_indi_init(void);
84extern void stabilization_indi_enter(void);
85extern void stabilization_indi_rate_run(bool in_flight, struct StabilizationSetpoint *rate_sp, struct ThrustSetpoint *thrust, int32_t *cmd);
86extern void stabilization_indi_attitude_run(bool in_flight, struct StabilizationSetpoint *att_sp, struct ThrustSetpoint *thrust, int32_t *cmd);
87extern void stabilization_indi_simple_reset_r_filter_cutoff(float new_cutoff);
88
89#endif /* STABILIZATION_INDI_SIMPLE_H */
90
angular rates
Simple first order low pass filter with bilinear transform.
struct SecondOrderLowPass Butterworth2LowPass
Second order Butterworth low pass filter.
General attitude stabilization interface for rotorcrafts.
General stabilization interface for rotorcrafts.
Rotorcraft attitude reference generation.
struct IndiVariables indi
float max_rate
Maximum rate in rate control in rad/s.
struct Indi_gains gains
void stabilization_indi_enter(void)
Function that resets important values upon engaging INDI.
Butterworth2LowPass rate[3]
void stabilization_indi_rate_run(bool in_flight, struct StabilizationSetpoint *rate_sp, struct ThrustSetpoint *thrust, int32_t *cmd)
Does the INDI calculations.
struct FloatRates act_dyn
struct IndiEstimation est
Estimation parameters for adaptive INDI.
Butterworth2LowPass u[3]
void stabilization_indi_simple_reset_r_filter_cutoff(float new_cutoff)
Butterworth2LowPass u[3]
struct FloatRates u_act_dyn
struct FloatRates u_in
struct FloatRates rate
struct FloatRates angular_accel_ref
struct FloatRates att
void stabilization_indi_init(void)
Function that initializes important values upon engaging INDI.
void stabilization_indi_attitude_run(bool in_flight, struct StabilizationSetpoint *att_sp, struct ThrustSetpoint *thrust, int32_t *cmd)
runs stabilization indi
bool adaptive
Enable adataptive estimation.
float attitude_max_yaw_rate
Maximum yaw rate in atttiude control in rad/s.
Butterworth2LowPass rate[3]
Stabilization setpoint.
Thrust setpoint // TODO to a setpoint header Structure to store the desired thrust vector with differ...
int int32_t
Typedef defining 32 bit int type.