mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-02 05:17:03 +08:00
[fixedwing] removed ALT_KALMAN, not needed with ins_alt_float anymore
like before: * the kalman filter is still disabled by default (unless a baro is used) * to enable define ALT_KALMAN_ENABLED
This commit is contained in:
@@ -144,7 +144,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|
||||||
@@ -157,7 +156,6 @@
|
|||||||
<!-- Sensors -->
|
<!-- Sensors -->
|
||||||
<subsystem name="gps" type="ublox_utm"/>
|
<subsystem name="gps" type="ublox_utm"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
@@ -163,14 +163,12 @@
|
|||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="WIND_INFO_RET"/>
|
<define name="WIND_INFO_RET"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<!-- <define name="NB_CHANNELS" value="5" /> -->
|
<!-- <define name="NB_CHANNELS" value="5" /> -->
|
||||||
</target>
|
</target>
|
||||||
<target name="sim" board="pc"/>
|
<target name="sim" board="pc"/>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
<subsystem name="gps" type="ublox" />
|
<subsystem name="gps" type="ublox" />
|
||||||
|
|
||||||
<!-- Communication -->
|
<!-- Communication -->
|
||||||
<subsystem name="telemetry" type="xbee_api">
|
<subsystem name="telemetry" type="xbee_api">
|
||||||
<configure name="MODEM_BAUD" value="B9600"/>
|
<configure name="MODEM_BAUD" value="B9600"/>
|
||||||
|
|||||||
@@ -214,7 +214,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
|
|
||||||
<!-- Sensors -->
|
<!-- Sensors -->
|
||||||
<!--
|
<!--
|
||||||
@@ -227,6 +226,7 @@
|
|||||||
<configure name="USE_MAGNETOMETER" value="0"/>
|
<configure name="USE_MAGNETOMETER" value="0"/>
|
||||||
</subsystem>
|
</subsystem>
|
||||||
|
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|
||||||
|
|||||||
@@ -178,7 +178,6 @@
|
|||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="WIND_INFO_RET"/>
|
<define name="WIND_INFO_RET"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
</target>
|
</target>
|
||||||
<target name="sim" board="pc"/>
|
<target name="sim" board="pc"/>
|
||||||
|
|
||||||
|
|||||||
@@ -238,7 +238,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
|
|
||||||
<!-- Sensors -->
|
<!-- Sensors -->
|
||||||
<!--
|
<!--
|
||||||
@@ -252,7 +251,7 @@
|
|||||||
<!-- <configure name="USE_MAGNETOMETER" /> -->
|
<!-- <configure name="USE_MAGNETOMETER" /> -->
|
||||||
</subsystem>
|
</subsystem>
|
||||||
|
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|
||||||
<!-- Communication -->
|
<!-- Communication -->
|
||||||
|
|||||||
@@ -14,7 +14,6 @@
|
|||||||
|
|
||||||
<firmware name="fixedwing">
|
<firmware name="fixedwing">
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<!--define name="PITCH_TRIM"/-->
|
<!--define name="PITCH_TRIM"/-->
|
||||||
|
|
||||||
@@ -37,6 +36,7 @@
|
|||||||
<subsystem name="ahrs" type="float_dcm">
|
<subsystem name="ahrs" type="float_dcm">
|
||||||
<define name="USE_HIGH_ACCEL_FLAG"/>
|
<define name="USE_HIGH_ACCEL_FLAG"/>
|
||||||
</subsystem>
|
</subsystem>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
<subsystem name="control" type="adaptive"/>
|
<subsystem name="control" type="adaptive"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
<!-- Sensors -->
|
<!-- Sensors -->
|
||||||
|
|||||||
@@ -18,7 +18,6 @@
|
|||||||
<define name="USE_I2C0"/>
|
<define name="USE_I2C0"/>
|
||||||
<define name="USE_I2C1"/>
|
<define name="USE_I2C1"/>
|
||||||
<!--define name="AGR_CLIMB"/-->
|
<!--define name="AGR_CLIMB"/-->
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="USE_AIRSPEED"/>
|
<define name="USE_AIRSPEED"/>
|
||||||
<!--define name="LOITER_TRIM"/-->
|
<!--define name="LOITER_TRIM"/-->
|
||||||
<!--define name="PITCH_TRIM"/-->
|
<!--define name="PITCH_TRIM"/-->
|
||||||
@@ -38,6 +37,7 @@
|
|||||||
<subsystem name="ahrs" type="float_dcm">
|
<subsystem name="ahrs" type="float_dcm">
|
||||||
<define name="USE_HIGH_ACCEL_FLAG"/>
|
<define name="USE_HIGH_ACCEL_FLAG"/>
|
||||||
</subsystem>
|
</subsystem>
|
||||||
|
<subsystem name="ins" typee="alt_float"/>
|
||||||
<subsystem name="control" type="new"/>
|
<subsystem name="control" type="new"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
<!-- Sensors -->
|
<!-- Sensors -->
|
||||||
|
|||||||
@@ -6,12 +6,10 @@
|
|||||||
<target name="sim" board="pc">
|
<target name="sim" board="pc">
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
</target>
|
</target>
|
||||||
<target name="ap" board="tiny_0.99">
|
<target name="ap" board="tiny_0.99">
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
</target>
|
</target>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
@@ -26,7 +24,7 @@
|
|||||||
<subsystem name="ahrs" type="infrared"/>
|
<subsystem name="ahrs" type="infrared"/>
|
||||||
<subsystem name="gps" type="ublox_utm"/>
|
<subsystem name="gps" type="ublox_utm"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<firmware name="setup">
|
<firmware name="setup">
|
||||||
|
|||||||
@@ -6,12 +6,10 @@
|
|||||||
<target name="sim" board="pc">
|
<target name="sim" board="pc">
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
</target>
|
</target>
|
||||||
<target name="ap" board="tiny_1.1">
|
<target name="ap" board="tiny_1.1">
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
</target>
|
</target>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
@@ -26,7 +24,7 @@
|
|||||||
<subsystem name="ahrs" type="infrared"/>
|
<subsystem name="ahrs" type="infrared"/>
|
||||||
<subsystem name="gps" type="ublox_utm"/>
|
<subsystem name="gps" type="ublox_utm"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<firmware name="setup">
|
<firmware name="setup">
|
||||||
|
|||||||
@@ -6,12 +6,10 @@
|
|||||||
<target name="sim" board="pc">
|
<target name="sim" board="pc">
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
</target>
|
</target>
|
||||||
<target name="ap" board="tiny_1.1">
|
<target name="ap" board="tiny_1.1">
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
</target>
|
</target>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
@@ -26,7 +24,7 @@
|
|||||||
<subsystem name="ahrs" type="infrared"/>
|
<subsystem name="ahrs" type="infrared"/>
|
||||||
<subsystem name="gps" type="ublox_utm"/>
|
<subsystem name="gps" type="ublox_utm"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<firmware name="setup">
|
<firmware name="setup">
|
||||||
|
|||||||
@@ -230,7 +230,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
|
|
||||||
<!-- Sensors -->
|
<!-- Sensors -->
|
||||||
<!--
|
<!--
|
||||||
@@ -243,7 +242,7 @@
|
|||||||
<subsystem name="ahrs" type="float_dcm">
|
<subsystem name="ahrs" type="float_dcm">
|
||||||
<!-- <configure name="USE_MAGNETOMETER" /> -->
|
<!-- <configure name="USE_MAGNETOMETER" /> -->
|
||||||
</subsystem>
|
</subsystem>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|
||||||
|
|||||||
@@ -25,6 +25,7 @@
|
|||||||
</subsystem>
|
</subsystem>
|
||||||
<subsystem name="ahrs" type="float_dcm"/>
|
<subsystem name="ahrs" type="float_dcm"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<servos>
|
<servos>
|
||||||
|
|||||||
@@ -24,6 +24,7 @@
|
|||||||
<configure name="GPS_BAUD" value="B57600"/>
|
<configure name="GPS_BAUD" value="B57600"/>
|
||||||
</subsystem>
|
</subsystem>
|
||||||
<subsystem name="ahrs" type="float_dcm"/>
|
<subsystem name="ahrs" type="float_dcm"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
|
|||||||
@@ -21,7 +21,6 @@
|
|||||||
|
|
||||||
<target name="sim" board="pc"/>
|
<target name="sim" board="pc"/>
|
||||||
|
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="USE_MAGNETOMETER" value="FALSE"/>
|
<define name="USE_MAGNETOMETER" value="FALSE"/>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
@@ -31,6 +30,7 @@
|
|||||||
<subsystem name="ahrs" type="float_dcm"/>
|
<subsystem name="ahrs" type="float_dcm"/>
|
||||||
<subsystem name="gps" type="ublox"/>
|
<subsystem name="gps" type="ublox"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<!-- commands section -->
|
<!-- commands section -->
|
||||||
|
|||||||
@@ -160,7 +160,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|
||||||
@@ -175,6 +174,7 @@
|
|||||||
<subsystem name="ahrs" type="infrared"/>
|
<subsystem name="ahrs" type="infrared"/>
|
||||||
<subsystem name="gps" type="ublox_utm"/>
|
<subsystem name="gps" type="ublox_utm"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<firmware name="setup">
|
<firmware name="setup">
|
||||||
|
|||||||
@@ -10,15 +10,10 @@
|
|||||||
<airframe name="EasyStar TWOGv1">
|
<airframe name="EasyStar TWOGv1">
|
||||||
|
|
||||||
<firmware name="fixedwing">
|
<firmware name="fixedwing">
|
||||||
<target name="ap" board="twog_1.0">
|
<target name="ap" board="twog_1.0"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<target name="sim" board="pc"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
</target>
|
|
||||||
|
|
||||||
<target name="sim" board="pc">
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="LOITER_TRIM"/>
|
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
</target>
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
<subsystem name="telemetry" type="transparent"/>
|
<subsystem name="telemetry" type="transparent"/>
|
||||||
@@ -26,6 +21,7 @@
|
|||||||
<subsystem name="ahrs" type="infrared"/>
|
<subsystem name="ahrs" type="infrared"/>
|
||||||
<subsystem name="gps" type="ublox"/>
|
<subsystem name="gps" type="ublox"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<firmware name="setup">
|
<firmware name="setup">
|
||||||
|
|||||||
@@ -16,7 +16,6 @@
|
|||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="USE_I2C0"/>
|
<define name="USE_I2C0"/>
|
||||||
<define name="USE_AIRSPEED"/>
|
<define name="USE_AIRSPEED"/>
|
||||||
<define name="USE_BARO_ETS"/>
|
<define name="USE_BARO_ETS"/>
|
||||||
|
|||||||
@@ -16,7 +16,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
<subsystem name="joystick"/>
|
<subsystem name="joystick"/>
|
||||||
@@ -111,7 +110,6 @@
|
|||||||
<define name="CARROT" value="5." unit="s"/>
|
<define name="CARROT" value="5." unit="s"/>
|
||||||
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
||||||
|
|||||||
@@ -16,7 +16,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
<subsystem name="joystick"/>
|
<subsystem name="joystick"/>
|
||||||
@@ -120,7 +119,6 @@
|
|||||||
<define name="CARROT" value="5." unit="s"/>
|
<define name="CARROT" value="5." unit="s"/>
|
||||||
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
||||||
|
|||||||
@@ -170,7 +170,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|
||||||
@@ -187,7 +186,7 @@
|
|||||||
<subsystem name="ahrs" type="infrared"/>
|
<subsystem name="ahrs" type="infrared"/>
|
||||||
<subsystem name="gps" type="ublox_utm"/>
|
<subsystem name="gps" type="ublox_utm"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<modules>
|
<modules>
|
||||||
|
|||||||
@@ -14,7 +14,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|
||||||
@@ -30,6 +29,7 @@
|
|||||||
<subsystem name="gps" type="ublox"/>
|
<subsystem name="gps" type="ublox"/>
|
||||||
<subsystem name="control"/>
|
<subsystem name="control"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<modules>
|
<modules>
|
||||||
@@ -197,7 +197,6 @@
|
|||||||
<define name="NOMINAL_AIRSPEED" value="13." unit="m/s"/>
|
<define name="NOMINAL_AIRSPEED" value="13." unit="m/s"/>
|
||||||
<define name="CARROT" value="5." unit="s"/>
|
<define name="CARROT" value="5." unit="s"/>
|
||||||
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
||||||
<define name="ALT_KALMAN_ENABLED" value="TRUE"/>
|
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="80."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="80."/>
|
||||||
</section>
|
</section>
|
||||||
|
|
||||||
|
|||||||
@@ -14,7 +14,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="STRONG_WIND"/>
|
<define name="STRONG_WIND"/>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|||||||
@@ -14,7 +14,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|
||||||
@@ -29,6 +28,7 @@
|
|||||||
|
|
||||||
<subsystem name="control"/>
|
<subsystem name="control"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<modules>
|
<modules>
|
||||||
|
|||||||
@@ -15,7 +15,6 @@
|
|||||||
<target name="sim" board="pc"/>
|
<target name="sim" board="pc"/>
|
||||||
|
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|||||||
@@ -16,7 +16,6 @@
|
|||||||
<target name="sim" board="pc"/>
|
<target name="sim" board="pc"/>
|
||||||
|
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
@@ -127,7 +126,6 @@
|
|||||||
<define name="CARROT" value="5." unit="s"/>
|
<define name="CARROT" value="5." unit="s"/>
|
||||||
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
||||||
|
|||||||
@@ -210,6 +210,7 @@
|
|||||||
<subsystem name="ahrs" type="float_dcm"/>
|
<subsystem name="ahrs" type="float_dcm"/>
|
||||||
<subsystem name="gps" type="ublox"/>
|
<subsystem name="gps" type="ublox"/>
|
||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
</airframe>
|
</airframe>
|
||||||
|
|||||||
@@ -11,7 +11,6 @@
|
|||||||
<define name="USE_I2C0"/>
|
<define name="USE_I2C0"/>
|
||||||
<define name="USE_I2C1"/>
|
<define name="USE_I2C1"/>
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
|
|
||||||
<target name="sim" board="pc"/>
|
<target name="sim" board="pc"/>
|
||||||
<target name="ap" board="umarim_lite_2.0"/>
|
<target name="ap" board="umarim_lite_2.0"/>
|
||||||
@@ -28,6 +27,7 @@
|
|||||||
<subsystem name="navigation"/>
|
<subsystem name="navigation"/>
|
||||||
<!-- Sensors -->
|
<!-- Sensors -->
|
||||||
<subsystem name="gps" type="ublox"/>
|
<subsystem name="gps" type="ublox"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
@@ -27,7 +27,6 @@
|
|||||||
<define name="USE_GYRO_PITCH_RATE"/>
|
<define name="USE_GYRO_PITCH_RATE"/>
|
||||||
|
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
|
|
||||||
<!-- Communication -->
|
<!-- Communication -->
|
||||||
<subsystem name="telemetry" type="transparent"/>
|
<subsystem name="telemetry" type="transparent"/>
|
||||||
@@ -42,6 +41,7 @@
|
|||||||
<configure name="USE_MAGNETOMETER" value="0"/>
|
<configure name="USE_MAGNETOMETER" value="0"/>
|
||||||
<define name="AHRS_USE_GPS_HEADING" value="1"/>
|
<define name="AHRS_USE_GPS_HEADING" value="1"/>
|
||||||
</subsystem>
|
</subsystem>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
|
|
||||||
<!-- Sensors -->
|
<!-- Sensors -->
|
||||||
<subsystem name="imu" type="b2_v1.0">
|
<subsystem name="imu" type="b2_v1.0">
|
||||||
|
|||||||
@@ -194,7 +194,6 @@
|
|||||||
|
|
||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="LOITER_TRIM" />
|
<define name="LOITER_TRIM" />
|
||||||
<define name="ALT_KALMAN" />
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|
||||||
|
|||||||
@@ -17,7 +17,6 @@
|
|||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
<!--<define name="TELEMETRY_MODE_FBW" value="1"/>-->
|
<!--<define name="TELEMETRY_MODE_FBW" value="1"/>-->
|
||||||
@@ -26,6 +25,7 @@
|
|||||||
<subsystem name="ahrs" type="infrared"/>
|
<subsystem name="ahrs" type="infrared"/>
|
||||||
<subsystem name="gps" type="ublox"/>
|
<subsystem name="gps" type="ublox"/>
|
||||||
<subsystem name="navigation" type="extra"/>
|
<subsystem name="navigation" type="extra"/>
|
||||||
|
<subsystem name="ins" type="alt_float"/>
|
||||||
</firmware>
|
</firmware>
|
||||||
|
|
||||||
<firmware name="setup">
|
<firmware name="setup">
|
||||||
|
|||||||
@@ -14,7 +14,6 @@
|
|||||||
<target name="ap" board="tiny_2.1">
|
<target name="ap" board="tiny_2.1">
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="WIND_INFO_RET"/>
|
<define name="WIND_INFO_RET"/>
|
||||||
</target>
|
</target>
|
||||||
@@ -137,7 +136,6 @@
|
|||||||
<define name="CARROT" value="5." unit="s"/>
|
<define name="CARROT" value="5." unit="s"/>
|
||||||
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
||||||
|
|||||||
@@ -13,7 +13,6 @@
|
|||||||
<target name="ap" board="tiny_2.11">
|
<target name="ap" board="tiny_2.11">
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="WIND_INFO_RET"/>
|
<define name="WIND_INFO_RET"/>
|
||||||
</target>
|
</target>
|
||||||
@@ -21,7 +20,6 @@
|
|||||||
<target name="sim" board="pc">
|
<target name="sim" board="pc">
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="WIND_INFO_RET"/>
|
<define name="WIND_INFO_RET"/>
|
||||||
</target>
|
</target>
|
||||||
@@ -132,7 +130,6 @@
|
|||||||
<define name="CARROT" value="5." unit="s"/>
|
<define name="CARROT" value="5." unit="s"/>
|
||||||
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
||||||
|
|||||||
@@ -91,7 +91,6 @@
|
|||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<define name="XBEE_INIT" value="\"ATPL2\rATRN1\rATTT80\r\""/>
|
<define name="XBEE_INIT" value="\"ATPL2\rATRN1\rATTT80\r\""/>
|
||||||
<!-- <define name="NO_XBEE_API_INIT" value="TRUE"/> -->
|
<!-- <define name="NO_XBEE_API_INIT" value="TRUE"/> -->
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="150."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="150."/>
|
||||||
|
|||||||
@@ -12,7 +12,6 @@
|
|||||||
<target name="sim" board="pc">
|
<target name="sim" board="pc">
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="WIND_INFO_RET"/>
|
<define name="WIND_INFO_RET"/>
|
||||||
</target>
|
</target>
|
||||||
@@ -20,7 +19,6 @@
|
|||||||
<target name="ap" board="tiny_2.11">
|
<target name="ap" board="tiny_2.11">
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="WIND_INFO_RET"/>
|
<define name="WIND_INFO_RET"/>
|
||||||
<define name="USE_I2C0"/>
|
<define name="USE_I2C0"/>
|
||||||
@@ -124,7 +122,6 @@
|
|||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<!-- <define name="XBEE_INIT" value="\"ATPL2\rATRN1\rATTT80\r\""/> -->
|
<!-- <define name="XBEE_INIT" value="\"ATPL2\rATRN1\rATTT80\r\""/> -->
|
||||||
<!-- <define name="NO_XBEE_API_INIT" value="TRUE"/> -->
|
<!-- <define name="NO_XBEE_API_INIT" value="TRUE"/> -->
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
||||||
|
|||||||
@@ -89,7 +89,6 @@
|
|||||||
<define name="CARROT" value="5." unit="s"/>
|
<define name="CARROT" value="5." unit="s"/>
|
||||||
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
||||||
@@ -167,7 +166,6 @@
|
|||||||
<target name="sim" board="pc"/>
|
<target name="sim" board="pc"/>
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="WIND_INFO_RET"/>
|
<define name="WIND_INFO_RET"/>
|
||||||
<define name="USE_I2C0"/>
|
<define name="USE_I2C0"/>
|
||||||
|
|||||||
@@ -14,7 +14,6 @@
|
|||||||
<target name="ap" board="tiny_2.1">
|
<target name="ap" board="tiny_2.1">
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="WIND_INFO"/>
|
<define name="WIND_INFO"/>
|
||||||
<define name="WIND_INFO_RET"/>
|
<define name="WIND_INFO_RET"/>
|
||||||
</target>
|
</target>
|
||||||
@@ -121,7 +120,6 @@
|
|||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<!-- <define name="XBEE_INIT" value="\"ATPL2\rATRN1\rATTT80\r\""/> -->
|
<!-- <define name="XBEE_INIT" value="\"ATPL2\rATRN1\rATTT80\r\""/> -->
|
||||||
<!-- <define name="NO_XBEE_API_INIT" value="TRUE"/> -->
|
<!-- <define name="NO_XBEE_API_INIT" value="TRUE"/> -->
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
||||||
|
|||||||
@@ -18,7 +18,6 @@
|
|||||||
<target name="sim" board="pc"/>
|
<target name="sim" board="pc"/>
|
||||||
|
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
<define name="AGR_CLIMB"/>
|
<define name="AGR_CLIMB"/>
|
||||||
|
|
||||||
<subsystem name="radio_control" type="ppm"/>
|
<subsystem name="radio_control" type="ppm"/>
|
||||||
|
|||||||
@@ -109,7 +109,6 @@
|
|||||||
<define name="CARROT" value="5." unit="s"/>
|
<define name="CARROT" value="5." unit="s"/>
|
||||||
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
<define name="KILL_MODE_DISTANCE" value="(1.5*MAX_DIST_FROM_HOME)"/>
|
||||||
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
<define name="CONTROL_FREQUENCY" value="60" unit="Hz"/>
|
||||||
<define name="ALT_KALMAN_ENABLED" value="FALSE"/>
|
|
||||||
|
|
||||||
<define name="TRIGGER_DELAY" value="1."/>
|
<define name="TRIGGER_DELAY" value="1."/>
|
||||||
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
<define name="DEFAULT_CIRCLE_RADIUS" value="120."/>
|
||||||
|
|||||||
@@ -7,7 +7,6 @@
|
|||||||
<define name="AGR_CLIMB" />
|
<define name="AGR_CLIMB" />
|
||||||
<define name="TRAFFIC_INFO"/>
|
<define name="TRAFFIC_INFO"/>
|
||||||
<define name="LOITER_TRIM"/>
|
<define name="LOITER_TRIM"/>
|
||||||
<define name="ALT_KALMAN"/>
|
|
||||||
</target>
|
</target>
|
||||||
|
|
||||||
<target name="sim" description="The simulator">
|
<target name="sim" description="The simulator">
|
||||||
|
|||||||
@@ -6,7 +6,7 @@
|
|||||||
<dl_settings>
|
<dl_settings>
|
||||||
|
|
||||||
<dl_settings NAME="alt_baro">
|
<dl_settings NAME="alt_baro">
|
||||||
<dl_setting MAX="1" MIN="0" STEP="1" VAR="alt_kalman_enabled" shortname="alt_kalman" module="subsystems/ins/ins_float"/>
|
<dl_setting MAX="1" MIN="0" STEP="1" VAR="alt_kalman_enabled" shortname="alt_kalman" module="subsystems/ins/ins_alt_float"/>
|
||||||
</dl_settings>
|
</dl_settings>
|
||||||
|
|
||||||
</dl_settings>
|
</dl_settings>
|
||||||
|
|||||||
@@ -374,9 +374,6 @@ void handle_ins_msg(void) {
|
|||||||
#endif /* USE_IMU */
|
#endif /* USE_IMU */
|
||||||
|
|
||||||
#if USE_GPS_XSENS
|
#if USE_GPS_XSENS
|
||||||
#ifndef ALT_KALMAN
|
|
||||||
#warning NO_VZ
|
|
||||||
#endif
|
|
||||||
|
|
||||||
// Horizontal speed
|
// Horizontal speed
|
||||||
float fspeed = sqrt(ins_vx*ins_vx + ins_vy*ins_vy);
|
float fspeed = sqrt(ins_vx*ins_vx + ins_vy*ins_vy);
|
||||||
|
|||||||
@@ -142,8 +142,6 @@ void pbn_read_event( void ) {
|
|||||||
#if USE_AIRSPEED
|
#if USE_AIRSPEED
|
||||||
stateSetAirspeed_f(&pbn_airspeed);
|
stateSetAirspeed_f(&pbn_airspeed);
|
||||||
#endif
|
#endif
|
||||||
//alt_kalman(pbn_altitude);
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -58,9 +58,7 @@ void ins_init() {
|
|||||||
|
|
||||||
stateSetPositionUtm_f(&utm0);
|
stateSetPositionUtm_f(&utm0);
|
||||||
|
|
||||||
#ifdef ALT_KALMAN
|
|
||||||
alt_kalman_init();
|
alt_kalman_init();
|
||||||
#endif
|
|
||||||
|
|
||||||
#if USE_BAROMETER
|
#if USE_BAROMETER
|
||||||
ins_qfe = 0;;
|
ins_qfe = 0;;
|
||||||
@@ -137,8 +135,6 @@ void ins_update_sonar() {
|
|||||||
|
|
||||||
bool_t alt_kalman_enabled;
|
bool_t alt_kalman_enabled;
|
||||||
|
|
||||||
#ifdef ALT_KALMAN
|
|
||||||
|
|
||||||
#ifndef ALT_KALMAN_ENABLED
|
#ifndef ALT_KALMAN_ENABLED
|
||||||
#define ALT_KALMAN_ENABLED FALSE
|
#define ALT_KALMAN_ENABLED FALSE
|
||||||
#endif
|
#endif
|
||||||
@@ -232,5 +228,3 @@ void alt_kalman(float z_meas) {
|
|||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif // ALT_KALMAN
|
|
||||||
|
|
||||||
|
|||||||
@@ -56,13 +56,9 @@ extern float estimator_z; ///< altitude above MSL in meters
|
|||||||
extern float estimator_z_dot;
|
extern float estimator_z_dot;
|
||||||
|
|
||||||
extern bool_t alt_kalman_enabled;
|
extern bool_t alt_kalman_enabled;
|
||||||
#ifdef ALT_KALMAN
|
|
||||||
extern void alt_kalman_reset( void );
|
extern void alt_kalman_reset( void );
|
||||||
extern void alt_kalman_init( void );
|
extern void alt_kalman_init( void );
|
||||||
extern void alt_kalman( float );
|
extern void alt_kalman( float );
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifdef ALT_KALMAN
|
|
||||||
|
|
||||||
#if USE_BAROMETER
|
#if USE_BAROMETER
|
||||||
/* Kalman filter cannot be disabled in this mode (no z_dot) */
|
/* Kalman filter cannot be disabled in this mode (no z_dot) */
|
||||||
@@ -77,8 +73,4 @@ extern void alt_kalman( float );
|
|||||||
}
|
}
|
||||||
#endif /* ! USE_BAROMETER */
|
#endif /* ! USE_BAROMETER */
|
||||||
|
|
||||||
#else /* ALT_KALMAN */
|
|
||||||
#define EstimatorSetAlt(z) { estimator_z = z; }
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#endif /* INS_FLOAT_H */
|
#endif /* INS_FLOAT_H */
|
||||||
|
|||||||
Reference in New Issue
Block a user