Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 08:38:36 -04:00
Code Issues Packages Projects Releases Wiki Activity

Plane: ensure ahrs.init() is called

Browse Source
This commit is contained in:
Andrew Tridgell 2013-01-13 16:04:18 +11:00
parent 36e38eeef7
commit 28352b3548
3 changed files with 15 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
ArduPlane/setup.pde
View File

@ -313,6 +313,10 @@ static int8_t
setup_accel_scale(uint8_t argc, const Menu::arg *argv)
{
cliSerial->println_P(PSTR("Initialising gyros"));
ahrs.init();
ahrs.set_fly_forward(true);
ins.init(AP_InertialSensor::COLD_START,
ins_sample_rate,
flash_leds);

9
ArduPlane/system.pde
View File

@ -227,12 +227,13 @@ static void init_ardupilot()
//----------------
//read_EEPROM_airstart_critical();
#if HIL_MODE != HIL_MODE_ATTITUDE
ahrs.init();
ahrs.set_fly_forward(true);
ins.init(AP_InertialSensor::WARM_START,
ins_sample_rate,
flash_leds);
ahrs.init();
ahrs.set_fly_forward(true);
#endif
// This delay is important for the APM_RC library to work.
@ -442,6 +443,9 @@ static void startup_INS_ground(bool force_accel_level)
gcs_send_text_P(SEVERITY_MEDIUM, PSTR("Beginning INS calibration; do not move plane"));
mavlink_delay(1000);
ahrs.init();
ahrs.set_fly_forward(true);
ins.init(AP_InertialSensor::COLD_START,
ins_sample_rate,
flash_leds);
@ -453,7 +457,6 @@ static void startup_INS_ground(bool force_accel_level)
ins.init_accel(flash_leds);
}
#endif
ahrs.set_fly_forward(true);
ahrs.reset();
#if HIL_MODE != HIL_MODE_ATTITUDE

5
ArduPlane/test.pde
View File

@ -466,6 +466,9 @@ static int8_t
test_ins(uint8_t argc, const Menu::arg *argv)
{
//cliSerial->printf_P(PSTR("Calibrating."));
ahrs.init();
ahrs.set_fly_forward(true);
ins.init(AP_InertialSensor::COLD_START,
ins_sample_rate,
flash_leds);
@ -525,6 +528,8 @@ test_mag(uint8_t argc, const Menu::arg *argv)
cliSerial->println_P(PSTR("Compass initialisation failed!"));
return 0;
}
ahrs.init();
ahrs.set_fly_forward(true);
ahrs.set_compass(&compass);
report_compass();