From 4c977f16ce2522c254af051912b710ed302181a2 Mon Sep 17 00:00:00 2001 From: khancyr Date: Tue, 22 Aug 2017 11:30:40 +0200 Subject: [PATCH] Rover: reduce ADC warm up time --- APMrover2/system.cpp | 7 +------ 1 file changed, 1 insertion(+), 6 deletions(-) diff --git a/APMrover2/system.cpp b/APMrover2/system.cpp index b5e5b9978f..30558fdbb0 100644 --- a/APMrover2/system.cpp +++ b/APMrover2/system.cpp @@ -242,13 +242,8 @@ bool Rover::set_mode(Mode &new_mode, mode_reason_t reason) void Rover::startup_INS_ground(void) { - gcs().send_text(MAV_SEVERITY_INFO, "Warming up ADC"); - mavlink_delay(500); - - // Makes the servos wiggle twice - about to begin INS calibration - HOLD LEVEL AND STILL!! - // ----------------------- gcs().send_text(MAV_SEVERITY_INFO, "Beginning INS calibration. Do not move vehicle"); - mavlink_delay(1000); + hal.scheduler->delay(100); ahrs.init(); // say to EKF that rover only move by goind forward