mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-07 09:36:19 +08:00
remove analog_imu_offset_set
This commit is contained in:
@@ -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_
|
||||
|
||||
Reference in New Issue
Block a user