mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-05 23:49:00 +08:00
rename BOOZ2_MODE_* to MODE_* and BOOZ2_AP_MODE_* to AP_MODE_*
This commit is contained in:
@@ -170,9 +170,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
<section name="FMS">
|
||||
|
||||
@@ -191,9 +191,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
<section name="FMS">
|
||||
|
||||
@@ -198,9 +198,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
<section name="FMS">
|
||||
|
||||
@@ -185,9 +185,9 @@
|
||||
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/><!--Attitude Stabilized Roll,Pitch,Yaw | Direct Throttle control-->
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/><!--Attitude Stabilized Roll,Pitch,Yaw | Throttle commanded climb rate control-->
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/><!--Attitude Stabilized Roll,Pitch,Yaw | Altitude hold(100% throttle required) control-->
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/><!--Attitude Stabilized Roll,Pitch,Yaw | Direct Throttle control-->
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/><!--Attitude Stabilized Roll,Pitch,Yaw | Throttle commanded climb rate control-->
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_Z_HOLD"/><!--Attitude Stabilized Roll,Pitch,Yaw | Altitude hold(100% throttle required) control-->
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -203,9 +203,9 @@
|
||||
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/><!--Attitude Stabilized Roll,Pitch,Yaw | Direct Throttle control-->
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/><!--Attitude Stabilized Roll,Pitch,Yaw | Throttle commanded climb rate control-->
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/><!--Attitude Stabilized Roll,Pitch,Yaw | Altitude hold(100% throttle required) control-->
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/><!--Attitude Stabilized Roll,Pitch,Yaw | Direct Throttle control-->
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/><!--Attitude Stabilized Roll,Pitch,Yaw | Throttle commanded climb rate control-->
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_Z_HOLD"/><!--Attitude Stabilized Roll,Pitch,Yaw | Altitude hold(100% throttle required) control-->
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -175,9 +175,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
<section name="FMS">
|
||||
|
||||
@@ -179,9 +179,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
<section name="FMS">
|
||||
|
||||
@@ -168,9 +168,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -153,9 +153,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -131,9 +131,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -175,9 +175,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
<makefile>
|
||||
|
||||
@@ -70,9 +70,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
</section>
|
||||
|
||||
<section name="BAT">
|
||||
|
||||
@@ -69,9 +69,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
<section name="BAT">
|
||||
|
||||
@@ -248,9 +248,9 @@ second attempt
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_HOVER_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
<section name="FMS">
|
||||
|
||||
@@ -57,9 +57,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_HOVER_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
<section name="BAT">
|
||||
|
||||
@@ -211,9 +211,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -211,9 +211,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -250,9 +250,9 @@ second attempt
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_HOVER_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
<section name="FMS">
|
||||
|
||||
@@ -65,9 +65,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
</section>
|
||||
|
||||
<section name="BAT">
|
||||
|
||||
@@ -168,9 +168,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -211,9 +211,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_RATE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_RATE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -211,9 +211,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -211,9 +211,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_RATE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_RATE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -207,10 +207,10 @@
|
||||
<define name="SENSORS_PARAMS" value=""nps_sensors_params_booz2_a1.h"" />
|
||||
</section>
|
||||
|
||||
<section name="BOOZ2_MODE" prefix="BOOZ2_MODE_">
|
||||
<define name="MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT" />
|
||||
<define name="AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD" />
|
||||
<define name="AUTO2" value="BOOZ2_AP_MODE_HOVER_Z_HOLD" />
|
||||
<section name="MODE" prefix="MODE_">
|
||||
<define name="MANUAL" value="AP_MODE_ATTITUDE_DIRECT" />
|
||||
<define name="AUTO1" value="AP_MODE_ATTITUDE_Z_HOLD" />
|
||||
<define name="AUTO2" value="AP_MODE_HOVER_Z_HOLD" />
|
||||
</section>
|
||||
|
||||
|
||||
|
||||
@@ -186,9 +186,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_HOVER_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
<section name="INS" prefix="BOOZ_INS_">
|
||||
|
||||
@@ -164,9 +164,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_NAV"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_Z_HOLD"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
|
||||
</section>
|
||||
|
||||
<section name="FMS">
|
||||
|
||||
@@ -173,9 +173,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_RC_CLIMB"/>
|
||||
</section>
|
||||
|
||||
<section name="FMS">
|
||||
|
||||
@@ -65,9 +65,9 @@
|
||||
</section>
|
||||
|
||||
<section name="AUTOPILOT">
|
||||
<define name="BOOZ2_MODE_MANUAL" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO1" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="BOOZ2_MODE_AUTO2" value="BOOZ2_AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
<define name="MODE_AUTO2" value="AP_MODE_ATTITUDE_DIRECT"/>
|
||||
</section>
|
||||
|
||||
<section name="BAT">
|
||||
|
||||
@@ -82,8 +82,8 @@ bool_t nav_detect_ground(void);
|
||||
|
||||
void nav_home(void);
|
||||
|
||||
#define NavKillThrottle() ({ if (autopilot_mode == BOOZ2_AP_MODE_NAV) { kill_throttle = 1; autopilot_motors_on = 0; } FALSE; })
|
||||
#define NavResurrect() ({ if (autopilot_mode == BOOZ2_AP_MODE_NAV) { kill_throttle = 0; autopilot_motors_on = 1; } FALSE; })
|
||||
#define NavKillThrottle() ({ if (autopilot_mode == AP_MODE_NAV) { kill_throttle = 1; autopilot_motors_on = 0; } FALSE; })
|
||||
#define NavResurrect() ({ if (autopilot_mode == AP_MODE_NAV) { kill_throttle = 0; autopilot_motors_on = 1; } FALSE; })
|
||||
|
||||
#define InitStage() nav_init_stage();
|
||||
|
||||
|
||||
@@ -64,12 +64,12 @@ uint8_t props_throttle_pass;
|
||||
|
||||
|
||||
void csc_ap_init(void) {
|
||||
booz2_autopilot_mode = BOOZ2_AP_MODE_FAILSAFE;
|
||||
booz2_autopilot_mode = AP_MODE_FAILSAFE;
|
||||
booz2_autopilot_motors_on = FALSE;
|
||||
booz2_autopilot_in_flight = FALSE;
|
||||
booz2_autopilot_motors_on_counter = 0;
|
||||
booz2_autopilot_in_flight_counter = 0;
|
||||
booz2_autopilot_mode_auto2 = BOOZ2_MODE_AUTO2;
|
||||
booz2_autopilot_mode_auto2 = MODE_AUTO2;
|
||||
|
||||
props_throttle_pass = 0;
|
||||
for(uint8_t i = 0; i < PROPS_NB; i++){
|
||||
|
||||
@@ -53,13 +53,13 @@ uint16_t autopilot_flight_time;
|
||||
#define AUTOPILOT_YAW_TRESHOLD (MAX_PPRZ * 19 / 20)
|
||||
|
||||
void autopilot_init(void) {
|
||||
autopilot_mode = BOOZ2_AP_MODE_KILL;
|
||||
autopilot_mode = AP_MODE_KILL;
|
||||
autopilot_motors_on = FALSE;
|
||||
autopilot_in_flight = FALSE;
|
||||
kill_throttle = ! autopilot_motors_on;
|
||||
autopilot_motors_on_counter = 0;
|
||||
autopilot_in_flight_counter = 0;
|
||||
autopilot_mode_auto2 = BOOZ2_MODE_AUTO2;
|
||||
autopilot_mode_auto2 = MODE_AUTO2;
|
||||
autopilot_detect_ground = FALSE;
|
||||
autopilot_detect_ground_once = FALSE;
|
||||
autopilot_flight_time = 0;
|
||||
@@ -73,16 +73,16 @@ void autopilot_periodic(void) {
|
||||
|
||||
RunOnceEvery(BOOZ2_NAV_PRESCALER, nav_periodic_task());
|
||||
#ifdef FAILSAFE_GROUND_DETECT
|
||||
if (autopilot_mode == BOOZ2_AP_MODE_FAILSAFE && autopilot_detect_ground) {
|
||||
autopilot_set_mode(BOOZ2_AP_MODE_KILL);
|
||||
if (autopilot_mode == AP_MODE_FAILSAFE && autopilot_detect_ground) {
|
||||
autopilot_set_mode(AP_MODE_KILL);
|
||||
autopilot_detect_ground = FALSE;
|
||||
}
|
||||
#endif
|
||||
if ( !autopilot_motors_on ||
|
||||
#ifndef FAILSAFE_GROUND_DETECT
|
||||
autopilot_mode == BOOZ2_AP_MODE_FAILSAFE ||
|
||||
autopilot_mode == AP_MODE_FAILSAFE ||
|
||||
#endif
|
||||
autopilot_mode == BOOZ2_AP_MODE_KILL ) {
|
||||
autopilot_mode == AP_MODE_KILL ) {
|
||||
SetCommands(booz2_commands_failsafe,
|
||||
autopilot_in_flight, autopilot_motors_on);
|
||||
}
|
||||
@@ -101,32 +101,32 @@ void autopilot_set_mode(uint8_t new_autopilot_mode) {
|
||||
if (new_autopilot_mode != autopilot_mode) {
|
||||
/* horizontal mode */
|
||||
switch (new_autopilot_mode) {
|
||||
case BOOZ2_AP_MODE_FAILSAFE:
|
||||
case AP_MODE_FAILSAFE:
|
||||
#ifndef BOOZ_KILL_AS_FAILSAFE
|
||||
booz_stab_att_sp_euler.phi = 0;
|
||||
booz_stab_att_sp_euler.theta = 0;
|
||||
booz2_guidance_h_mode_changed(BOOZ2_GUIDANCE_H_MODE_ATTITUDE);
|
||||
break;
|
||||
#endif
|
||||
case BOOZ2_AP_MODE_KILL:
|
||||
case AP_MODE_KILL:
|
||||
autopilot_motors_on = FALSE;
|
||||
booz2_guidance_h_mode_changed(BOOZ2_GUIDANCE_H_MODE_KILL);
|
||||
break;
|
||||
case BOOZ2_AP_MODE_RATE_DIRECT:
|
||||
case BOOZ2_AP_MODE_RATE_Z_HOLD:
|
||||
case AP_MODE_RATE_DIRECT:
|
||||
case AP_MODE_RATE_Z_HOLD:
|
||||
booz2_guidance_h_mode_changed(BOOZ2_GUIDANCE_H_MODE_RATE);
|
||||
break;
|
||||
case BOOZ2_AP_MODE_ATTITUDE_DIRECT:
|
||||
case BOOZ2_AP_MODE_ATTITUDE_CLIMB:
|
||||
case BOOZ2_AP_MODE_ATTITUDE_Z_HOLD:
|
||||
case AP_MODE_ATTITUDE_DIRECT:
|
||||
case AP_MODE_ATTITUDE_CLIMB:
|
||||
case AP_MODE_ATTITUDE_Z_HOLD:
|
||||
booz2_guidance_h_mode_changed(BOOZ2_GUIDANCE_H_MODE_ATTITUDE);
|
||||
break;
|
||||
case BOOZ2_AP_MODE_HOVER_DIRECT:
|
||||
case BOOZ2_AP_MODE_HOVER_CLIMB:
|
||||
case BOOZ2_AP_MODE_HOVER_Z_HOLD:
|
||||
case AP_MODE_HOVER_DIRECT:
|
||||
case AP_MODE_HOVER_CLIMB:
|
||||
case AP_MODE_HOVER_Z_HOLD:
|
||||
booz2_guidance_h_mode_changed(BOOZ2_GUIDANCE_H_MODE_HOVER);
|
||||
break;
|
||||
case BOOZ2_AP_MODE_NAV:
|
||||
case AP_MODE_NAV:
|
||||
booz2_guidance_h_mode_changed(BOOZ2_GUIDANCE_H_MODE_NAV);
|
||||
break;
|
||||
default:
|
||||
@@ -134,34 +134,34 @@ void autopilot_set_mode(uint8_t new_autopilot_mode) {
|
||||
}
|
||||
/* vertical mode */
|
||||
switch (new_autopilot_mode) {
|
||||
case BOOZ2_AP_MODE_FAILSAFE:
|
||||
case AP_MODE_FAILSAFE:
|
||||
#ifndef BOOZ_KILL_AS_FAILSAFE
|
||||
booz2_guidance_v_zd_sp = SPEED_BFP_OF_REAL(0.5);
|
||||
booz2_guidance_v_mode_changed(BOOZ2_GUIDANCE_V_MODE_CLIMB);
|
||||
break;
|
||||
#endif
|
||||
case BOOZ2_AP_MODE_KILL:
|
||||
case AP_MODE_KILL:
|
||||
booz2_guidance_v_mode_changed(BOOZ2_GUIDANCE_V_MODE_KILL);
|
||||
break;
|
||||
case BOOZ2_AP_MODE_RATE_DIRECT:
|
||||
case BOOZ2_AP_MODE_ATTITUDE_DIRECT:
|
||||
case BOOZ2_AP_MODE_HOVER_DIRECT:
|
||||
case AP_MODE_RATE_DIRECT:
|
||||
case AP_MODE_ATTITUDE_DIRECT:
|
||||
case AP_MODE_HOVER_DIRECT:
|
||||
booz2_guidance_v_mode_changed(BOOZ2_GUIDANCE_V_MODE_RC_DIRECT);
|
||||
break;
|
||||
case BOOZ2_AP_MODE_RATE_RC_CLIMB:
|
||||
case BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB:
|
||||
case AP_MODE_RATE_RC_CLIMB:
|
||||
case AP_MODE_ATTITUDE_RC_CLIMB:
|
||||
booz2_guidance_v_mode_changed(BOOZ2_GUIDANCE_V_MODE_RC_CLIMB);
|
||||
break;
|
||||
case BOOZ2_AP_MODE_ATTITUDE_CLIMB:
|
||||
case BOOZ2_AP_MODE_HOVER_CLIMB:
|
||||
case AP_MODE_ATTITUDE_CLIMB:
|
||||
case AP_MODE_HOVER_CLIMB:
|
||||
booz2_guidance_v_mode_changed(BOOZ2_GUIDANCE_V_MODE_CLIMB);
|
||||
break;
|
||||
case BOOZ2_AP_MODE_RATE_Z_HOLD:
|
||||
case BOOZ2_AP_MODE_ATTITUDE_Z_HOLD:
|
||||
case BOOZ2_AP_MODE_HOVER_Z_HOLD:
|
||||
case AP_MODE_RATE_Z_HOLD:
|
||||
case AP_MODE_ATTITUDE_Z_HOLD:
|
||||
case AP_MODE_HOVER_Z_HOLD:
|
||||
booz2_guidance_v_mode_changed(BOOZ2_GUIDANCE_V_MODE_HOVER);
|
||||
break;
|
||||
case BOOZ2_AP_MODE_NAV:
|
||||
case AP_MODE_NAV:
|
||||
booz2_guidance_v_mode_changed(BOOZ2_GUIDANCE_V_MODE_NAV);
|
||||
break;
|
||||
default:
|
||||
@@ -244,14 +244,14 @@ void autopilot_on_rc_frame(void) {
|
||||
|
||||
#ifdef RADIO_CONTROL_KILL_SWITCH
|
||||
if (radio_control.values[RADIO_CONTROL_KILL_SWITCH] < 0)
|
||||
autopilot_set_mode(BOOZ2_AP_MODE_KILL);
|
||||
autopilot_set_mode(AP_MODE_KILL);
|
||||
#endif
|
||||
|
||||
autopilot_check_motors_on();
|
||||
autopilot_check_in_flight();
|
||||
kill_throttle = !autopilot_motors_on;
|
||||
|
||||
if (autopilot_mode > BOOZ2_AP_MODE_FAILSAFE) {
|
||||
if (autopilot_mode > AP_MODE_FAILSAFE) {
|
||||
booz2_guidance_v_read_rc();
|
||||
booz2_guidance_h_read_rc(autopilot_in_flight);
|
||||
}
|
||||
|
||||
@@ -32,19 +32,19 @@
|
||||
#include "airframe.h"
|
||||
#include "booz2_ins.h"
|
||||
|
||||
#define BOOZ2_AP_MODE_FAILSAFE 0
|
||||
#define BOOZ2_AP_MODE_KILL 1
|
||||
#define BOOZ2_AP_MODE_RATE_DIRECT 2
|
||||
#define BOOZ2_AP_MODE_ATTITUDE_DIRECT 3
|
||||
#define BOOZ2_AP_MODE_RATE_RC_CLIMB 4
|
||||
#define BOOZ2_AP_MODE_ATTITUDE_RC_CLIMB 5
|
||||
#define BOOZ2_AP_MODE_ATTITUDE_CLIMB 6
|
||||
#define BOOZ2_AP_MODE_RATE_Z_HOLD 7
|
||||
#define BOOZ2_AP_MODE_ATTITUDE_Z_HOLD 8
|
||||
#define BOOZ2_AP_MODE_HOVER_DIRECT 9
|
||||
#define BOOZ2_AP_MODE_HOVER_CLIMB 10
|
||||
#define BOOZ2_AP_MODE_HOVER_Z_HOLD 11
|
||||
#define BOOZ2_AP_MODE_NAV 12
|
||||
#define AP_MODE_FAILSAFE 0
|
||||
#define AP_MODE_KILL 1
|
||||
#define AP_MODE_RATE_DIRECT 2
|
||||
#define AP_MODE_ATTITUDE_DIRECT 3
|
||||
#define AP_MODE_RATE_RC_CLIMB 4
|
||||
#define AP_MODE_ATTITUDE_RC_CLIMB 5
|
||||
#define AP_MODE_ATTITUDE_CLIMB 6
|
||||
#define AP_MODE_RATE_Z_HOLD 7
|
||||
#define AP_MODE_ATTITUDE_Z_HOLD 8
|
||||
#define AP_MODE_HOVER_DIRECT 9
|
||||
#define AP_MODE_HOVER_CLIMB 10
|
||||
#define AP_MODE_HOVER_Z_HOLD 11
|
||||
#define AP_MODE_NAV 12
|
||||
|
||||
|
||||
extern uint8_t autopilot_mode;
|
||||
@@ -66,14 +66,14 @@ extern bool_t autopilot_detect_ground_once;
|
||||
|
||||
extern uint16_t autopilot_flight_time;
|
||||
|
||||
#ifndef BOOZ2_MODE_MANUAL
|
||||
#define BOOZ2_MODE_MANUAL BOOZ2_AP_MODE_RATE_DIRECT
|
||||
#ifndef MODE_MANUAL
|
||||
#define MODE_MANUAL AP_MODE_RATE_DIRECT
|
||||
#endif
|
||||
#ifndef BOOZ2_MODE_AUTO1
|
||||
#define BOOZ2_MODE_AUTO1 BOOZ2_AP_MODE_ATTITUDE_DIRECT
|
||||
#ifndef MODE_AUTO1
|
||||
#define MODE_AUTO1 AP_MODE_ATTITUDE_DIRECT
|
||||
#endif
|
||||
#ifndef BOOZ2_MODE_AUTO2
|
||||
#define BOOZ2_MODE_AUTO2 BOOZ2_AP_MODE_ATTITUDE_Z_HOLD
|
||||
#ifndef MODE_AUTO2
|
||||
#define MODE_AUTO2 AP_MODE_ATTITUDE_Z_HOLD
|
||||
#endif
|
||||
|
||||
|
||||
@@ -84,9 +84,9 @@ extern uint16_t autopilot_flight_time;
|
||||
if (_rc > TRESHOLD_2_PPRZ) \
|
||||
_booz_mode = autopilot_mode_auto2; \
|
||||
else if (_rc > TRESHOLD_1_PPRZ) \
|
||||
_booz_mode = BOOZ2_MODE_AUTO1; \
|
||||
_booz_mode = MODE_AUTO1; \
|
||||
else \
|
||||
_booz_mode = BOOZ2_MODE_MANUAL; \
|
||||
_booz_mode = MODE_MANUAL; \
|
||||
}
|
||||
|
||||
#define autopilot_KillThrottle(_v) { \
|
||||
@@ -104,8 +104,8 @@ extern uint16_t autopilot_flight_time;
|
||||
#ifndef TRESHOLD_GROUND_DETECT
|
||||
#define TRESHOLD_GROUND_DETECT ACCEL_BFP_OF_REAL(15.)
|
||||
#endif
|
||||
static inline void BoozDetectGroundEvent(void) {
|
||||
if (autopilot_mode == BOOZ2_AP_MODE_FAILSAFE || autopilot_detect_ground_once) {
|
||||
static inline void DetectGroundEvent(void) {
|
||||
if (autopilot_mode == AP_MODE_FAILSAFE || autopilot_detect_ground_once) {
|
||||
if (booz_ins_ltp_accel.z < -TRESHOLD_GROUND_DETECT ||
|
||||
booz_ins_ltp_accel.z > TRESHOLD_GROUND_DETECT) {
|
||||
autopilot_detect_ground = TRUE;
|
||||
|
||||
@@ -148,9 +148,9 @@ STATIC_INLINE void booz2_main_periodic( void ) {
|
||||
{ \
|
||||
radio_control_periodic(); \
|
||||
if (radio_control.status != RADIO_CONTROL_OK && \
|
||||
autopilot_mode != BOOZ2_AP_MODE_KILL && \
|
||||
autopilot_mode != BOOZ2_AP_MODE_NAV) \
|
||||
autopilot_set_mode(BOOZ2_AP_MODE_FAILSAFE); \
|
||||
autopilot_mode != AP_MODE_KILL && \
|
||||
autopilot_mode != AP_MODE_NAV) \
|
||||
autopilot_set_mode(AP_MODE_FAILSAFE); \
|
||||
}, \
|
||||
{ \
|
||||
booz_fms_periodic(); \
|
||||
@@ -174,8 +174,8 @@ STATIC_INLINE void booz2_main_periodic( void ) {
|
||||
|
||||
#ifdef USE_GPS
|
||||
if (radio_control.status != RADIO_CONTROL_OK && \
|
||||
autopilot_mode == BOOZ2_AP_MODE_NAV && GpsIsLost()) \
|
||||
autopilot_set_mode(BOOZ2_AP_MODE_FAILSAFE); \
|
||||
autopilot_mode == AP_MODE_NAV && GpsIsLost()) \
|
||||
autopilot_set_mode(AP_MODE_FAILSAFE); \
|
||||
booz_gps_periodic();
|
||||
#endif
|
||||
|
||||
@@ -208,7 +208,7 @@ STATIC_INLINE void booz2_main_event( void ) {
|
||||
#endif
|
||||
|
||||
#ifdef FAILSAFE_GROUND_DETECT
|
||||
BoozDetectGroundEvent();
|
||||
DetectGroundEvent();
|
||||
#endif
|
||||
|
||||
modules_event_task();
|
||||
|
||||
Reference in New Issue
Block a user