remove analog_imu_offset_set

This commit is contained in:
Felix Ruess
2010-12-09 23:14:55 +01:00
parent 5db4e11728
commit 81f35d9705
3 changed files with 0 additions and 27 deletions
@@ -549,12 +549,6 @@ void init_ap( void ) {
#ifdef TRAFFIC_INFO
traffic_info_init();
#endif
#ifdef USE_ANALOG_IMU
//wait 10secs for init
sys_time_usleep(10000000);
analog_imu_offset_set();
#endif
}
@@ -43,8 +43,6 @@
// Debugging and output
#include "led.h"
#include "mcu_periph/uart.h"
//#include "downlink.h"
//#include "ap_downlink.h"
#include "sys_time.h"
#include "math/pprz_algebra_int.h"
@@ -57,24 +55,6 @@ float imu_pitch_neutral = RadOfDeg(IMU_PITCH_NEUTRAL_DEFAULT);
#if ! (defined SITL || defined HITL)
void analog_imu_offset_set( void ) {
// read IMU, really?
imu_periodic();
imu.gyro_neutral.p = analog_imu_values[0];
imu.gyro_neutral.q = analog_imu_values[1];
imu.gyro_neutral.r = analog_imu_values[2];
// do not set accel neutrals on startup, use the neutrals from the airfame file
//imu.accel_neutral.x = analog_imu_values[3];
//imu.accel_neutral.y = analog_imu_values[4];
//imu.accel_neutral.z = analog_imu_values[5];
// Z channel should read
// FIXME uugh...
//imu.accel_neutral.z += (9.81f / IMU_ACCEL_Z_SENS);
}
void estimator_update_state_analog_imu( void ) {
//FIXME run aligner to set gyro neutrals on ground
@@ -36,6 +36,5 @@ extern float imu_roll_neutral;
extern float imu_pitch_neutral;
void estimator_update_state_analog_imu( void );
void analog_imu_offset_set( void );
#endif // _ANALOGIMU_H_