mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-05 06:54:49 +08:00
[rotorcraft] stabilization attitude ref include cleanup
This commit is contained in:
@@ -31,13 +31,6 @@
|
|||||||
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_common_float.h"
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_common_float.h"
|
||||||
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_quat_float.h"
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_quat_float.h"
|
||||||
|
|
||||||
#ifndef STABILIZATION_ATTITUDE_GAIN_NB
|
|
||||||
#define STABILIZATION_ATTITUDE_GAIN_NB 1
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifndef STABILIZATION_ATTITUDE_GAIN_IDX_DEFAULT
|
|
||||||
#define STABILIZATION_ATTITUDE_GAIN_IDX_DEFAULT 0
|
|
||||||
#endif
|
|
||||||
|
|
||||||
extern struct FloatAttitudeGains stabilization_gains[];
|
extern struct FloatAttitudeGains stabilization_gains[];
|
||||||
|
|
||||||
|
|||||||
+2
-1
@@ -1,4 +1,5 @@
|
|||||||
#include "firmwares/rotorcraft/stabilization/stabilization_attitude.h"
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_euler_float.h"
|
||||||
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_saturate.h"
|
||||||
#include "generated/airframe.h"
|
#include "generated/airframe.h"
|
||||||
|
|
||||||
struct FloatEulers stab_att_sp_euler;
|
struct FloatEulers stab_att_sp_euler;
|
||||||
|
|||||||
-3
@@ -22,10 +22,7 @@
|
|||||||
#ifndef STABILIZATION_ATTITUDE_FLOAT_REF_EULER_FLOAT_H
|
#ifndef STABILIZATION_ATTITUDE_FLOAT_REF_EULER_FLOAT_H
|
||||||
#define STABILIZATION_ATTITUDE_FLOAT_REF_EULER_FLOAT_H
|
#define STABILIZATION_ATTITUDE_FLOAT_REF_EULER_FLOAT_H
|
||||||
|
|
||||||
#include "math/pprz_algebra_float.h"
|
|
||||||
|
|
||||||
#include "stabilization_attitude_ref_float.h"
|
#include "stabilization_attitude_ref_float.h"
|
||||||
#include "stabilization_attitude_ref.h"
|
|
||||||
|
|
||||||
void stabilization_attitude_ref_enter(void);
|
void stabilization_attitude_ref_enter(void);
|
||||||
|
|
||||||
|
|||||||
+2
-1
@@ -24,7 +24,8 @@
|
|||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include "firmwares/rotorcraft/stabilization/stabilization_attitude.h"
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_euler_int.h"
|
||||||
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_saturate.h"
|
||||||
#include "generated/airframe.h"
|
#include "generated/airframe.h"
|
||||||
|
|
||||||
struct Int32Eulers stab_att_sp_euler;
|
struct Int32Eulers stab_att_sp_euler;
|
||||||
|
|||||||
@@ -28,7 +28,5 @@
|
|||||||
#define STABILIZATION_ATTITUDE_REF_EULER_INT_H
|
#define STABILIZATION_ATTITUDE_REF_EULER_INT_H
|
||||||
|
|
||||||
#include "stabilization_attitude_ref_int.h"
|
#include "stabilization_attitude_ref_int.h"
|
||||||
#include "stabilization_attitude_ref.h"
|
|
||||||
|
|
||||||
|
|
||||||
#endif /* STABILIZATION_ATTITUDE_REF_EULER_INT_H */
|
#endif /* STABILIZATION_ATTITUDE_REF_EULER_INT_H */
|
||||||
|
|||||||
@@ -27,9 +27,7 @@
|
|||||||
#ifndef STABILIZATION_ATTITUDE_REF_FLOAT_H
|
#ifndef STABILIZATION_ATTITUDE_REF_FLOAT_H
|
||||||
#define STABILIZATION_ATTITUDE_REF_FLOAT_H
|
#define STABILIZATION_ATTITUDE_REF_FLOAT_H
|
||||||
|
|
||||||
#include "generated/airframe.h"
|
#include "math/pprz_algebra_float.h"
|
||||||
|
|
||||||
#include "state.h"
|
|
||||||
|
|
||||||
extern struct FloatEulers stab_att_sp_euler;
|
extern struct FloatEulers stab_att_sp_euler;
|
||||||
extern struct FloatQuat stab_att_sp_quat;
|
extern struct FloatQuat stab_att_sp_quat;
|
||||||
|
|||||||
@@ -29,8 +29,6 @@
|
|||||||
|
|
||||||
#include "math/pprz_algebra_int.h"
|
#include "math/pprz_algebra_int.h"
|
||||||
|
|
||||||
#include "state.h"
|
|
||||||
|
|
||||||
extern struct Int32Eulers stab_att_ref_euler; ///< with #REF_ANGLE_FRAC
|
extern struct Int32Eulers stab_att_ref_euler; ///< with #REF_ANGLE_FRAC
|
||||||
extern struct Int32Quat stab_att_ref_quat; ///< with #INT32_QUAT_FRAC
|
extern struct Int32Quat stab_att_ref_quat; ///< with #INT32_QUAT_FRAC
|
||||||
extern struct Int32Rates stab_att_ref_rate; ///< with #REF_RATE_FRAC
|
extern struct Int32Rates stab_att_ref_rate; ///< with #REF_RATE_FRAC
|
||||||
|
|||||||
+2
-3
@@ -28,10 +28,9 @@
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
#include "generated/airframe.h"
|
#include "generated/airframe.h"
|
||||||
#include "firmwares/rotorcraft/stabilization.h"
|
|
||||||
#include "state.h"
|
|
||||||
|
|
||||||
#include "stabilization_attitude_ref_float.h"
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_quat_float.h"
|
||||||
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_saturate.h"
|
||||||
|
|
||||||
#define REF_ACCEL_MAX_P STABILIZATION_ATTITUDE_REF_MAX_PDOT
|
#define REF_ACCEL_MAX_P STABILIZATION_ATTITUDE_REF_MAX_PDOT
|
||||||
#define REF_ACCEL_MAX_Q STABILIZATION_ATTITUDE_REF_MAX_QDOT
|
#define REF_ACCEL_MAX_Q STABILIZATION_ATTITUDE_REF_MAX_QDOT
|
||||||
|
|||||||
+7
-6
@@ -30,14 +30,15 @@
|
|||||||
#ifndef STABILIZATION_ATTITUDE_FLOAT_REF_QUAT_FLOAT_H
|
#ifndef STABILIZATION_ATTITUDE_FLOAT_REF_QUAT_FLOAT_H
|
||||||
#define STABILIZATION_ATTITUDE_FLOAT_REF_QUAT_FLOAT_H
|
#define STABILIZATION_ATTITUDE_FLOAT_REF_QUAT_FLOAT_H
|
||||||
|
|
||||||
#include "subsystems/radio_control.h"
|
|
||||||
#include "math/pprz_algebra_float.h"
|
|
||||||
|
|
||||||
#include "stabilization_attitude_ref_float.h"
|
#include "stabilization_attitude_ref_float.h"
|
||||||
#include "stabilization_attitude_ref.h"
|
|
||||||
|
|
||||||
#define DEADBAND_EXCEEDED(VARIABLE, VALUE) ((VARIABLE > VALUE) || (VARIABLE < -VALUE))
|
#ifndef STABILIZATION_ATTITUDE_GAIN_NB
|
||||||
#define APPLY_DEADBAND(VARIABLE, VALUE) (DEADBAND_EXCEEDED(VARIABLE, VALUE) ? VARIABLE : 0.0)
|
#define STABILIZATION_ATTITUDE_GAIN_NB 1
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef STABILIZATION_ATTITUDE_GAIN_IDX_DEFAULT
|
||||||
|
#define STABILIZATION_ATTITUDE_GAIN_IDX_DEFAULT 0
|
||||||
|
#endif
|
||||||
|
|
||||||
void stabilization_attitude_ref_enter(void);
|
void stabilization_attitude_ref_enter(void);
|
||||||
void stabilization_attitude_ref_schedule(uint8_t idx);
|
void stabilization_attitude_ref_schedule(uint8_t idx);
|
||||||
|
|||||||
+2
-3
@@ -28,9 +28,8 @@
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
#include "generated/airframe.h"
|
#include "generated/airframe.h"
|
||||||
#include "firmwares/rotorcraft/stabilization.h"
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_quat_int.h"
|
||||||
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_ref_saturate.h"
|
||||||
#include "stabilization_attitude_ref_int.h"
|
|
||||||
|
|
||||||
#define REF_ACCEL_MAX_P BFP_OF_REAL(STABILIZATION_ATTITUDE_REF_MAX_PDOT, REF_ACCEL_FRAC)
|
#define REF_ACCEL_MAX_P BFP_OF_REAL(STABILIZATION_ATTITUDE_REF_MAX_PDOT, REF_ACCEL_FRAC)
|
||||||
#define REF_ACCEL_MAX_Q BFP_OF_REAL(STABILIZATION_ATTITUDE_REF_MAX_QDOT, REF_ACCEL_FRAC)
|
#define REF_ACCEL_MAX_Q BFP_OF_REAL(STABILIZATION_ATTITUDE_REF_MAX_QDOT, REF_ACCEL_FRAC)
|
||||||
|
|||||||
@@ -31,7 +31,6 @@
|
|||||||
#define STABILIZATION_ATTITUDE_INT_REF_QUAT_INT_H
|
#define STABILIZATION_ATTITUDE_INT_REF_QUAT_INT_H
|
||||||
|
|
||||||
#include "stabilization_attitude_ref_int.h"
|
#include "stabilization_attitude_ref_int.h"
|
||||||
#include "stabilization_attitude_ref.h"
|
|
||||||
|
|
||||||
void stabilization_attitude_ref_enter(void);
|
void stabilization_attitude_ref_enter(void);
|
||||||
|
|
||||||
|
|||||||
+5
-5
@@ -19,12 +19,12 @@
|
|||||||
* Boston, MA 02111-1307, USA.
|
* Boston, MA 02111-1307, USA.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/** @file firmwares/rotorcraft/stabilization/stabilization_attitude_ref.h
|
/** @file firmwares/rotorcraft/stabilization/stabilization_attitude_ref_saturate.h
|
||||||
* Common rotorcraft attitude reference generation include.
|
* Common rotorcraft attitude reference saturation include.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef STABILIZATION_ATTITUDE_REF_H
|
#ifndef STABILIZATION_ATTITUDE_REF_SATURATE_H
|
||||||
#define STABILIZATION_ATTITUDE_REF_H
|
#define STABILIZATION_ATTITUDE_REF_SATURATE_H
|
||||||
|
|
||||||
#define SATURATE_SPEED_TRIM_ACCEL() { \
|
#define SATURATE_SPEED_TRIM_ACCEL() { \
|
||||||
if (stab_att_ref_rate.p >= REF_RATE_MAX_P) { \
|
if (stab_att_ref_rate.p >= REF_RATE_MAX_P) { \
|
||||||
@@ -60,4 +60,4 @@
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
#endif /* STABILIZATION_ATTITUDE_REF_H */
|
#endif /* STABILIZATION_ATTITUDE_REF_SATURATE_H */
|
||||||
Reference in New Issue
Block a user