fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-30 13:14:06 +08:00
Code Issues Packages Projects Releases Wiki Activity

Initialize error counts high enough

Browse Source
This commit is contained in:
Lorenz Meier 2015-02-09 16:52:34 +01:00
parent 3a151a9d00
commit df2ad183e3
1 changed files with 15 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
src/modules/sensors/sensors.cpp
View File

@ -2074,6 +2074,21 @@ Sensors::task_main()
raw.adc_voltage_v[2] = 0.0f;
raw.adc_voltage_v[3] = 0.0f;
/* set high initial error counts to deselect gyros */
raw.gyro_errcount = 100000;
raw.gyro1_errcount = 100000;
raw.gyro2_errcount = 100000;
/* set high initial error counts to deselect accels */
raw.accelerometer_errcount = 100000;
raw.accelerometer1_errcount = 100000;
raw.accelerometer2_errcount = 100000;
/* set high initial error counts to deselect mags */
raw.magnetometer_errcount = 100000;
raw.magnetometer1_errcount = 100000;
raw.magnetometer2_errcount = 100000;
memset(&_battery_status, 0, sizeof(_battery_status));
_battery_status.voltage_v = -1.0f;
_battery_status.voltage_filtered_v = -1.0f;