Rover: reset AHRS trim after levelling

This commit is contained in:
Andrew Tridgell 2013-02-20 11:56:38 +11:00
parent 0a0b51cc63
commit 0f239ae92c

View File

@ -417,6 +417,7 @@ static void startup_INS_ground(bool force_accel_level)
// levelling on each boot, and instead rely on the user to do
// it once via the ground station
ins.init_accel(flash_leds);
ahrs.set_trim(Vector3f(0, 0, 0));
}
ahrs.reset();