set BODY_TO_IMU_x with unit="deg" instead of RadOfDeg macro

This commit is contained in:
Felix Ruess
2011-12-01 16:28:16 +01:00
parent 16524fffda
commit fdf63bcd42
37 changed files with 124 additions and 124 deletions
+3 -3
View File
@@ -61,9 +61,9 @@
<define name="MAG_Y_SENS" value="4.884119848" integer="16"/> <define name="MAG_Y_SENS" value="4.884119848" integer="16"/>
<define name="MAG_Z_SENS" value="2.59926404993" 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_PHI" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 135.)"/> <define name="BODY_TO_IMU_PSI" value="135." unit="deg"/>
</section> </section>
+4 -4
View File
@@ -130,10 +130,10 @@
<define name="MAG_Y_SENS" value="5.43740121157" integer="16"/> <define name="MAG_Y_SENS" value="5.43740121157" integer="16"/>
<define name="MAG_Z_SENS" value="2.60492836649" 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_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<!--define name="BODY_TO_IMU_PSI" value="RadOfDeg(45.)"/--> <!--define name="BODY_TO_IMU_PSI" value="45." unit="deg"/-->
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -94,9 +94,9 @@
<define name="MAG_Y_SENS" value="21.79885" integer="16"/> <define name="MAG_Y_SENS" value="21.79885" integer="16"/>
<define name="MAG_Z_SENS" value="14.675745" 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_PHI" value="1.3" unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(-2.6)"/> <define name="BODY_TO_IMU_THETA" value="-2.6" unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -67,9 +67,9 @@
<define name="MAG_Y_SENS" value="21.79885" integer="16"/> <define name="MAG_Y_SENS" value="21.79885" integer="16"/>
<define name="MAG_Z_SENS" value="14.675745" 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_PHI" value="1.3" unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(-2.6)"/> <define name="BODY_TO_IMU_THETA" value="-2.6" unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
@@ -87,9 +87,9 @@
<define name="MAG_Y_SENS" value="-21.79885" integer="16"/> <define name="MAG_Y_SENS" value="-21.79885" integer="16"/>
<define name="MAG_Z_SENS" value="-14.675745" 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_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -117,9 +117,9 @@
<define name="MAG_Y_SENS" value="-21.79885" integer="16"/> <define name="MAG_Y_SENS" value="-21.79885" integer="16"/>
<define name="MAG_Z_SENS" value="-14.675745" 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_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
+6 -6
View File
@@ -99,9 +99,9 @@
<define name="MAG_Y_SENS" value="4.8961742578" integer="16"/> <define name="MAG_Y_SENS" value="4.8961742578" integer="16"/>
<define name="MAG_Z_SENS" value="5.31527656902" 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_PHI" value="0." unit="deg"/> <!-- -10 -->
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <!-- -10 --> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/> <!-- -10 -->
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
@@ -133,9 +133,9 @@
<define name="MAG_Y_SENS" value="4.49687342915" integer="16"/> <define name="MAG_Y_SENS" value="4.49687342915" integer="16"/>
<define name="MAG_Z_SENS" value="4.93138019221" 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_PHI" value="-10." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(-10.)"/> <define name="BODY_TO_IMU_THETA" value="-10." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -88,9 +88,9 @@
<define name="MAG_Y_SENS" value="6.95371185551" integer="16"/> <define name="MAG_Y_SENS" value="6.95371185551" integer="16"/>
<define name="MAG_Z_SENS" value="3.12322557454" 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_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-135.)"/> <define name="BODY_TO_IMU_PSI" value="-135." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -81,9 +81,9 @@
<define name="MAG_Y_CHAN" value="0"/> <define name="MAG_Y_CHAN" value="0"/>
<define name="MAG_Z_CHAN" value="2"/> <define name="MAG_Z_CHAN" value="2"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 4.5)"/> <define name="BODY_TO_IMU_PHI" value="4.5" unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 6.8)"/> <define name="BODY_TO_IMU_THETA" value="6.8" unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( -45.)"/> <define name="BODY_TO_IMU_PSI" value="-45." unit="deg"/>
<define name="GYRO_P_CHAN" value="0"/> <define name="GYRO_P_CHAN" value="0"/>
<define name="GYRO_Q_CHAN" value="4"/> <define name="GYRO_Q_CHAN" value="4"/>
+3 -3
View File
@@ -67,9 +67,9 @@
<define name="MAG_Z_SENS" value="-3.11986612709" integer="16"/> <define name="MAG_Z_SENS" value="-3.11986612709" integer="16"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/> <define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
<!-- 3 --> <!-- 3 -->
<define name="GYRO_P_CHAN" value="0"/> <define name="GYRO_P_CHAN" value="0"/>
+6 -6
View File
@@ -73,13 +73,13 @@
<define name="MAG_X_SENS" value=" 3.4936416" integer="16"/> <define name="MAG_X_SENS" value=" 3.4936416" integer="16"/>
<define name="MAG_Y_SENS" value=" 3.607713" 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_PHI" value="4." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(3.)"/> <define name="BODY_TO_IMU_THETA" value="3." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
<!-- <!--
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
--> -->
</section> </section>
+3 -3
View File
@@ -76,9 +76,9 @@
<!-- <define name="MAG_X_SENS" value="-3.4936416" integer="16"/> --> <!-- <define name="MAG_X_SENS" value="-3.4936416" integer="16"/> -->
<!-- <define name="MAG_Y_SENS" value=" 3.607713" 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_PHI" value="4." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(3.)"/> <define name="BODY_TO_IMU_THETA" value="3." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -61,9 +61,9 @@
<define name="MAG_Y_SENS" value="4.884119848" integer="16"/> <define name="MAG_Y_SENS" value="4.884119848" integer="16"/>
<define name="MAG_Z_SENS" value="2.59926404993" 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_PHI" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 135.)"/> <define name="BODY_TO_IMU_PSI" value="135." unit="deg"/>
</section> </section>
+9 -9
View File
@@ -74,9 +74,9 @@
<define name="MAG_Z_SENS" value="-3.11986612709" integer="16"/> <define name="MAG_Z_SENS" value="-3.11986612709" integer="16"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/> <define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
<define name="GYRO_P_CHAN" value="0"/> <define name="GYRO_P_CHAN" value="0"/>
<define name="GYRO_Q_CHAN" value="4"/> <define name="GYRO_Q_CHAN" value="4"/>
@@ -118,9 +118,9 @@
<define name="MAG_Y_NEUTRAL" value=" 49"/> <define name="MAG_Y_NEUTRAL" value=" 49"/>
<define name="MAG_Z_NEUTRAL" value="-66"/> <define name="MAG_Z_NEUTRAL" value="-66"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/> <define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
</section> </section>
--> -->
@@ -167,9 +167,9 @@
<define name="MAG_Z_SENS" value="-3.11986612709" integer="16"/> <define name="MAG_Z_SENS" value="-3.11986612709" integer="16"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/> <define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
<define name="GYRO_P_CHAN" value="0"/> <define name="GYRO_P_CHAN" value="0"/>
<define name="GYRO_Q_CHAN" value="4"/> <define name="GYRO_Q_CHAN" value="4"/>
+3 -3
View File
@@ -63,9 +63,9 @@
<define name="MAG_Y_NEUTRAL" value=" 49"/> <define name="MAG_Y_NEUTRAL" value=" 49"/>
<define name="MAG_Z_NEUTRAL" value="-66"/> <define name="MAG_Z_NEUTRAL" value="-66"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 90.)"/> <define name="BODY_TO_IMU_PSI" value="90." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -132,9 +132,9 @@ second attempt
<define name="MAG_45_HACK" value="1"/> <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_PHI" value="2.9 " unit="deg"/> <!-- previously 1.5-->
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( -3.7 )"/> <!-- previously -1.5--> <define name="BODY_TO_IMU_THETA" value="-3.7 " unit="deg"/> <!-- previously -1.5-->
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -61,9 +61,9 @@
<define name="MAG_Y_SENS" value="4.13471628028" integer="16"/> <define name="MAG_Y_SENS" value="4.13471628028" integer="16"/>
<define name="MAG_Z_SENS" value="2.07762920804" 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_PHI" value="0.53 " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( -1.24 )"/> <define name="BODY_TO_IMU_THETA" value="-1.24 " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0)"/> <define name="BODY_TO_IMU_PSI" value="0" unit="deg"/>
</section> </section>
+3 -3
View File
@@ -62,9 +62,9 @@
<define name="MAG_Z_SENS" value=" 2.98000294999" integer="16"/> <define name="MAG_Z_SENS" value=" 2.98000294999" integer="16"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-90.)"/> <define name="BODY_TO_IMU_PSI" value="-90." unit="deg"/>
</section> </section>
@@ -62,9 +62,9 @@
<define name="MAG_Z_SENS" value=" 2.98000294999" integer="16"/> <define name="MAG_Z_SENS" value=" 2.98000294999" integer="16"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-90.)"/> <define name="BODY_TO_IMU_PSI" value="-90." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -131,9 +131,9 @@ second attempt
<define name="MAG_45_HACK" value="1"/> <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_PHI" value="2.9 " unit="deg"/> <!-- previously 1.5-->
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( -3.7 )"/> <!-- previously -1.5--> <define name="BODY_TO_IMU_THETA" value="-3.7 " unit="deg"/> <!-- previously -1.5-->
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -58,9 +58,9 @@
<define name="MAG_Y_NEUTRAL" value=" 49"/> <define name="MAG_Y_NEUTRAL" value=" 49"/>
<define name="MAG_Z_NEUTRAL" value="-66"/> <define name="MAG_Z_NEUTRAL" value="-66"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/> <define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -103,9 +103,9 @@
<define name="MAG_Y_NEUTRAL" value="1944"/> <define name="MAG_Y_NEUTRAL" value="1944"/>
<define name="MAG_Z_NEUTRAL" value="2099"/> <define name="MAG_Z_NEUTRAL" value="2099"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)" /> <define name="BODY_TO_IMU_PHI" value="0." unit="deg" />
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)" /> <define name="BODY_TO_IMU_THETA" value="0." unit="deg" />
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)" /> <define name="BODY_TO_IMU_PSI" value="0." unit="deg" />
</section> </section>
<section name="AHRS" prefix="AHRS_"> <section name="AHRS" prefix="AHRS_">
+3 -3
View File
@@ -47,9 +47,9 @@
<define name="MAG_Y_NEUTRAL" value="5"/> <define name="MAG_Y_NEUTRAL" value="5"/>
<define name="MAG_Z_NEUTRAL" value="192"/> <define name="MAG_Z_NEUTRAL" value="192"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -51,9 +51,9 @@
<section name="IMU" prefix="IMU_"> <section name="IMU" prefix="IMU_">
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 180. )"/> <define name="BODY_TO_IMU_PHI" value="180. " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -68,9 +68,9 @@
<define name="MAG_XZ_SENS" value="0.0" integer="16"/> <define name="MAG_XZ_SENS" value="0.0" integer="16"/>
<define name="MAG_YZ_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_PHI" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45. )"/> <define name="BODY_TO_IMU_PSI" value="45. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -68,9 +68,9 @@
<define name="MAG_XZ_SENS" value="0.0" integer="16"/> <define name="MAG_XZ_SENS" value="0.0" integer="16"/>
<define name="MAG_YZ_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_PHI" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45. )"/> <define name="BODY_TO_IMU_PSI" value="45. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -82,9 +82,9 @@
<define name="MAG_XZ_SENS" value="0.0" integer="16"/> <define name="MAG_XZ_SENS" value="0.0" integer="16"/>
<define name="MAG_YZ_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_PHI" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45. )"/> <define name="BODY_TO_IMU_PSI" value="45. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -56,9 +56,9 @@
<section name="IMU" prefix="IMU_"> <section name="IMU" prefix="IMU_">
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_PHI" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 225. )"/> <define name="BODY_TO_IMU_PSI" value="225. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -59,9 +59,9 @@
<section name="IMU" prefix="IMU_"> <section name="IMU" prefix="IMU_">
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 180. )"/> <define name="BODY_TO_IMU_PHI" value="180. " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 90. )"/> <define name="BODY_TO_IMU_THETA" value="90. " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -69,9 +69,9 @@
<define name="MAG_Y_NEUTRAL" value="512"/> <define name="MAG_Y_NEUTRAL" value="512"/>
<define name="MAG_Z_NEUTRAL" value="512"/> <define name="MAG_Z_NEUTRAL" value="512"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)" /> <define name="BODY_TO_IMU_PHI" value="0." unit="deg" />
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)" /> <define name="BODY_TO_IMU_THETA" value="0." unit="deg" />
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(0.)" /> <define name="BODY_TO_IMU_PSI" value="0." unit="deg" />
</section> </section>
<section name="AUTO1" prefix="AUTO1_"> <section name="AUTO1" prefix="AUTO1_">
+3 -3
View File
@@ -68,9 +68,9 @@
<define name="MAG_Y_SENS" value="4.86013203775" integer="16"/> <define name="MAG_Y_SENS" value="4.86013203775" integer="16"/>
<define name="MAG_Z_SENS" value="2.5947951512" 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_PHI" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_THETA" value="0. " unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 45.)"/> <define name="BODY_TO_IMU_PSI" value="45." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -62,9 +62,9 @@
<define name="MAG_Z_SENS" value="-2.98000294999" integer="16"/> <define name="MAG_Z_SENS" value="-2.98000294999" integer="16"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-90.)"/> <define name="BODY_TO_IMU_PSI" value="-90." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -61,9 +61,9 @@
<define name="MAG_Y_NEUTRAL" value="20"/> <define name="MAG_Y_NEUTRAL" value="20"/>
<define name="MAG_Z_NEUTRAL" value="-30"/> <define name="MAG_Z_NEUTRAL" value="-30"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-90.)"/> <define name="BODY_TO_IMU_PSI" value="-90." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -65,9 +65,9 @@
<define name="MAG_Y_SENS" value="-4.2959321" integer="16"/> <define name="MAG_Y_SENS" value="-4.2959321" integer="16"/>
<define name="MAG_Z_SENS" value="-4.0988408" 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_PHI" value="1.5" unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg(-1.5)"/> <define name="BODY_TO_IMU_THETA" value="-1.5" unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0. )"/> <define name="BODY_TO_IMU_PSI" value="0. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -52,9 +52,9 @@
<define name="MAG_Y_SENS" value="20." integer="16"/> <define name="MAG_Y_SENS" value="20." integer="16"/>
<define name="MAG_Z_SENS" value="15." 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_PHI" value="14.5" unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( -8.5)"/> <define name="BODY_TO_IMU_THETA" value="-8.5" unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-45. )"/> <define name="BODY_TO_IMU_PSI" value="-45. " unit="deg"/>
</section> </section>
+3 -3
View File
@@ -54,9 +54,9 @@
<define name="MAG_X_SENS" value="-3.03386034" integer="16"/> <define name="MAG_X_SENS" value="-3.03386034" integer="16"/>
<define name="MAG_Y_SENS" value=" 4.99085017" 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_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section> </section>
+3 -3
View File
@@ -75,9 +75,9 @@
<define name="MAG_Y_NEUTRAL" value="24"/> <define name="MAG_Y_NEUTRAL" value="24"/>
<define name="MAG_Z_NEUTRAL" value="28"/> <define name="MAG_Z_NEUTRAL" value="28"/>
<define name="BODY_TO_IMU_PHI" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="RadOfDeg( 0.)"/> <define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="RadOfDeg(-45.)"/> <define name="BODY_TO_IMU_PSI" value="-45." unit="deg"/>
</section> </section>