changed IMU_MAG_OFFSET to radians

This commit is contained in:
Felix Ruess
2011-11-29 00:23:56 +01:00
parent 87905f83d7
commit 4be15501fa
6 changed files with 6 additions and 6 deletions
+1 -1
View File
@@ -261,7 +261,7 @@
<define name="FACE_REINJ_1" value="1024"/>
<define name="DEFAULT_CIRCLE_RADIUS" value="10."/>
<define name="BoozDropPwm(_v)" value="BoozSetPwm0Value(_v)"/>
<define name="IMU_MAG_OFFSET" value="-9."/>
<define name="IMU_MAG_OFFSET" value="RadOfDeg(-9.)"/>
</section>
<section name="GCS">
+1 -1
View File
@@ -230,7 +230,7 @@
<define name="BOOZ_ANALOG_BARO_THRESHOLD" value="800"/>
<define name="FACE_REINJ_1" value="1024"/>
<define name="DEFAULT_CIRCLE_RADIUS" value="10."/>
<!--define name="IMU_MAG_OFFSET" value="-5.8"/-->
<!--define name="IMU_MAG_OFFSET" value="RadOfDeg(-5.8)"/-->
</section>
<section name="GCS">
+1 -1
View File
@@ -272,7 +272,7 @@
<define name="FACE_REINJ_1" value="1024"/>
<define name="DEFAULT_CIRCLE_RADIUS" value="10."/>
<define name="BoozDropPwm(_v)" value="BoozSetPwm1Value(_v)"/>
<define name="IMU_MAG_OFFSET" value="-9."/>
<define name="IMU_MAG_OFFSET" value="RadOfDeg(-9.)"/>
</section>
<section name="GCS">
@@ -34,7 +34,7 @@ void vi_impl_set_enabled(bool_t enabled __attribute__ ((unused))) {
#define ViMaxHSpeed ((int16_t)SPEED_BFP_OF_REAL(VI_MAX_H_SPEED))
#define ViMaxVSpeed ((int16_t)SPEED_BFP_OF_REAL(VI_MAX_V_SPEED))
#define ViMaxHeadingRate ((int16_t)RATE_BFP_OF_REAL(RadOfDeg(VI_MAX_HEADING_RATE)))
#define ViMaxHeadingRate ((int16_t)RATE_BFP_OF_REAL(VI_MAX_HEADING_RATE))
struct Int16Vect3 wp_speed_max = { ViMaxHSpeed, ViMaxHSpeed, ViMaxVSpeed };
@@ -37,7 +37,7 @@
#endif
#ifndef VI_MAX_HEADING_RATE
#define VI_MAX_HEADING_RATE 60.
#define VI_MAX_HEADING_RATE RadOfDeg(60.)
#endif
extern void vi_update_wp(uint8_t wp_id);
@@ -261,7 +261,7 @@ __attribute__ ((always_inline)) static inline void get_psi_measurement_from_mag(
// sphi_ctheta * imu.mag.y +
// cphi_ctheta * imu.mag.z;
float m_psi = -atan2(me, mn);
*psi_meas = ((m_psi - RadOfDeg(ahrs_mag_offset))*(float)(1<<(INT32_ANGLE_FRAC))*F_UPDATE);
*psi_meas = ((m_psi - ahrs_mag_offset)*(float)(1<<(INT32_ANGLE_FRAC))*F_UPDATE);
}