mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-06 07:53:43 +08:00
set BODY_TO_IMU_x with unit="deg" instead of RadOfDeg macro
This commit is contained in:
@@ -61,9 +61,9 @@
|
||||
<define name="MAG_Y_SENS" value="4.884119848" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="2.59926404993" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 135.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="135." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -130,10 +130,10 @@
|
||||
<define name="MAG_Y_SENS" value="5.43740121157" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="2.60492836649" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<!--define name="BODY_TO_IMU_PSI" value="RadOfDeg(45.)"/-->
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<!--define name="BODY_TO_IMU_PSI" value="45." unit="deg"/-->
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -94,9 +94,9 @@
|
||||
<define name="MAG_Y_SENS" value="21.79885" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="14.675745" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(1.3)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(-2.6)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="1.3" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="-2.6" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -67,9 +67,9 @@
|
||||
<define name="MAG_Y_SENS" value="21.79885" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="14.675745" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(1.3)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(-2.6)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="1.3" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="-2.6" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -87,9 +87,9 @@
|
||||
<define name="MAG_Y_SENS" value="-21.79885" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="-14.675745" integer="16"/-->
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -117,9 +117,9 @@
|
||||
<define name="MAG_Y_SENS" value="-21.79885" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="-14.675745" integer="16"/-->
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -99,9 +99,9 @@
|
||||
<define name="MAG_Y_SENS" value="4.8961742578" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="5.31527656902" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/> <!-- -10 -->
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <!-- -10 -->
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/> <!-- -10 -->
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/> <!-- -10 -->
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
@@ -133,9 +133,9 @@
|
||||
<define name="MAG_Y_SENS" value="4.49687342915" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="4.93138019221" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(-10.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(-10.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="-10." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="-10." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -88,9 +88,9 @@
|
||||
<define name="MAG_Y_SENS" value="6.95371185551" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="3.12322557454" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-135.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="-135." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -81,9 +81,9 @@
|
||||
<define name="MAG_Y_CHAN" value="0"/>
|
||||
<define name="MAG_Z_CHAN" value="2"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 4.5)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 6.8)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( -45.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="4.5" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="6.8" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="-45." unit="deg"/>
|
||||
|
||||
<define name="GYRO_P_CHAN" value="0"/>
|
||||
<define name="GYRO_Q_CHAN" value="4"/>
|
||||
|
||||
@@ -67,9 +67,9 @@
|
||||
<define name="MAG_Z_SENS" value="-3.11986612709" integer="16"/>
|
||||
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
|
||||
|
||||
<!-- 3 -->
|
||||
<define name="GYRO_P_CHAN" value="0"/>
|
||||
|
||||
@@ -73,13 +73,13 @@
|
||||
<define name="MAG_X_SENS" value=" 3.4936416" integer="16"/>
|
||||
<define name="MAG_Y_SENS" value=" 3.607713" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(4.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(3.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="4." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="3." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
<!--
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
-->
|
||||
|
||||
</section>
|
||||
|
||||
@@ -76,9 +76,9 @@
|
||||
<!-- <define name="MAG_X_SENS" value="-3.4936416" integer="16"/> -->
|
||||
<!-- <define name="MAG_Y_SENS" value=" 3.607713" integer="16"/> -->
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(4.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(3.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="4." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="3." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -61,9 +61,9 @@
|
||||
<define name="MAG_Y_SENS" value="4.884119848" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="2.59926404993" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 135.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="135." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -74,9 +74,9 @@
|
||||
<define name="MAG_Z_SENS" value="-3.11986612709" integer="16"/>
|
||||
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
|
||||
|
||||
<define name="GYRO_P_CHAN" value="0"/>
|
||||
<define name="GYRO_Q_CHAN" value="4"/>
|
||||
@@ -118,9 +118,9 @@
|
||||
<define name="MAG_Y_NEUTRAL" value=" 49"/>
|
||||
<define name="MAG_Z_NEUTRAL" value="-66"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
|
||||
|
||||
</section>
|
||||
-->
|
||||
@@ -167,9 +167,9 @@
|
||||
<define name="MAG_Z_SENS" value="-3.11986612709" integer="16"/>
|
||||
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
|
||||
|
||||
<define name="GYRO_P_CHAN" value="0"/>
|
||||
<define name="GYRO_Q_CHAN" value="4"/>
|
||||
|
||||
@@ -63,9 +63,9 @@
|
||||
<define name="MAG_Y_NEUTRAL" value=" 49"/>
|
||||
<define name="MAG_Z_NEUTRAL" value="-66"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 90.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="90." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -132,9 +132,9 @@ second attempt
|
||||
|
||||
<define name="MAG_45_HACK" value="1"/>
|
||||
-->
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 2.9 )"/> <!-- previously 1.5-->
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( -3.7 )"/> <!-- previously -1.5-->
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="2.9 " unit="deg"/> <!-- previously 1.5-->
|
||||
<define name="BODY_TO_IMU_THETA" value="-3.7 " unit="deg"/> <!-- previously -1.5-->
|
||||
<define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -61,9 +61,9 @@
|
||||
<define name="MAG_Y_SENS" value="4.13471628028" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="2.07762920804" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.53 )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( -1.24 )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0.53 " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="-1.24 " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0" unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -62,9 +62,9 @@
|
||||
<define name="MAG_Z_SENS" value=" 2.98000294999" integer="16"/>
|
||||
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-90.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="-90." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -62,9 +62,9 @@
|
||||
<define name="MAG_Z_SENS" value=" 2.98000294999" integer="16"/>
|
||||
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-90.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="-90." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -131,9 +131,9 @@ second attempt
|
||||
|
||||
<define name="MAG_45_HACK" value="1"/>
|
||||
-->
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 2.9 )"/> <!-- previously 1.5-->
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( -3.7 )"/> <!-- previously -1.5-->
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="2.9 " unit="deg"/> <!-- previously 1.5-->
|
||||
<define name="BODY_TO_IMU_THETA" value="-3.7 " unit="deg"/> <!-- previously -1.5-->
|
||||
<define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -58,9 +58,9 @@
|
||||
<define name="MAG_Y_NEUTRAL" value=" 49"/>
|
||||
<define name="MAG_Z_NEUTRAL" value="-66"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -103,9 +103,9 @@
|
||||
<define name="MAG_Y_NEUTRAL" value="1944"/>
|
||||
<define name="MAG_Z_NEUTRAL" value="2099"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)" />
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)" />
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)" />
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg" />
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg" />
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg" />
|
||||
</section>
|
||||
|
||||
<section name="AHRS" prefix="AHRS_">
|
||||
|
||||
@@ -47,9 +47,9 @@
|
||||
<define name="MAG_Y_NEUTRAL" value="5"/>
|
||||
<define name="MAG_Z_NEUTRAL" value="192"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -51,9 +51,9 @@
|
||||
|
||||
<section name="IMU" prefix="IMU_">
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 180. )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="180. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -68,9 +68,9 @@
|
||||
<define name="MAG_XZ_SENS" value="0.0" integer="16"/>
|
||||
<define name="MAG_YZ_SENS" value="0.0" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="45. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -68,9 +68,9 @@
|
||||
<define name="MAG_XZ_SENS" value="0.0" integer="16"/>
|
||||
<define name="MAG_YZ_SENS" value="0.0" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="45. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -82,9 +82,9 @@
|
||||
<define name="MAG_XZ_SENS" value="0.0" integer="16"/>
|
||||
<define name="MAG_YZ_SENS" value="0.0" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="45. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -56,9 +56,9 @@
|
||||
|
||||
<section name="IMU" prefix="IMU_">
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 225. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="225. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -59,9 +59,9 @@
|
||||
|
||||
<section name="IMU" prefix="IMU_">
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 180. )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 90. )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="180. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="90. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -69,9 +69,9 @@
|
||||
<define name="MAG_Y_NEUTRAL" value="512"/>
|
||||
<define name="MAG_Z_NEUTRAL" value="512"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)" />
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)" />
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)" />
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg" />
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg" />
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg" />
|
||||
</section>
|
||||
|
||||
<section name="AUTO1" prefix="AUTO1_">
|
||||
|
||||
@@ -68,9 +68,9 @@
|
||||
<define name="MAG_Y_SENS" value="4.86013203775" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="2.5947951512" integer="16"/>
|
||||
-->
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -62,9 +62,9 @@
|
||||
<define name="MAG_Z_SENS" value="-2.98000294999" integer="16"/>
|
||||
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-90.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="-90." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -61,9 +61,9 @@
|
||||
<define name="MAG_Y_NEUTRAL" value="20"/>
|
||||
<define name="MAG_Z_NEUTRAL" value="-30"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-90.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="-90." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -65,9 +65,9 @@
|
||||
<define name="MAG_Y_SENS" value="-4.2959321" integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="-4.0988408" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 1.5)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(-1.5)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="1.5" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="-1.5" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -52,9 +52,9 @@
|
||||
<define name="MAG_Y_SENS" value="20." integer="16"/>
|
||||
<define name="MAG_Z_SENS" value="15." integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 14.5)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( -8.5)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-45. )"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="14.5" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="-8.5" unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="-45. " unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -54,9 +54,9 @@
|
||||
<define name="MAG_X_SENS" value="-3.03386034" integer="16"/>
|
||||
<define name="MAG_Y_SENS" value=" 4.99085017" integer="16"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
@@ -75,9 +75,9 @@
|
||||
<define name="MAG_Y_NEUTRAL" value="24"/>
|
||||
<define name="MAG_Z_NEUTRAL" value="28"/>
|
||||
|
||||
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-45.)"/>
|
||||
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
|
||||
<define name="BODY_TO_IMU_PSI" value="-45." unit="deg"/>
|
||||
|
||||
</section>
|
||||
|
||||
|
||||
Reference in New Issue
Block a user