Sub: Refactor delay()

We don't need a dedicated file only to define a delay function.
This will also provide a preventitive measure for people trying to use
delay() without an understanding of the implications

ArduSub/Sub.h

@@ -697,7 +697,6 @@ private:
     void do_take_picture();
     void log_picture();
     uint8_t mavlink_compassmot(mavlink_channel_t chan);
-    void delay(uint32_t ms);
     bool acro_init(bool ignore_checks);
     void acro_run();
     void get_pilot_desired_angle_rates(int16_t roll_in, int16_t pitch_in, int16_t yaw_in, float &roll_out, float &pitch_out, float &yaw_out);

ArduSub/compat.cpp

@@ -1,6 +0,0 @@
-#include "Sub.h"
-
-void Sub::delay(uint32_t ms)
-{
-    hal.scheduler->delay(ms);
-}

ArduSub/radio.cpp

@@ -88,7 +88,7 @@ void Sub::init_rc_out()
     motors.Init();                                              // motor initialisation
 
     for(uint8_t i = 0; i < 5; i++) {
-        delay(20);
+    	hal.scheduler->delay(20);
         read_radio();
     }
 

ArduSub/setup.cpp

@@ -51,7 +51,7 @@ int8_t Sub::setup_factory(uint8_t argc, const Menu::arg *argv)
     AP_Param::erase_all();
     cliSerial->printf("\nReboot board");
 
-    delay(1000);
+    hal.scheduler->delay(1000);
 
     for (;; ) {
     }

ArduSub/system.cpp

@@ -88,7 +88,7 @@ void Sub::init_ardupilot()
         // least one second after powering up. Simplest solution for
         // now is to delay for 1 second. Something more elegant may be
         // added later
-        delay(1000);
+    	hal.scheduler->delay(1000);
     }
 
     // initialise serial port
@@ -226,7 +226,7 @@ void Sub::init_ardupilot()
         // the barometer begins updating when we get the first
         // HIL_STATE message
         gcs_send_text(MAV_SEVERITY_WARNING, "Waiting for first HIL_STATE message");
-        delay(1000);
+        hal.scheduler->delay(1000);
     }
 
     // set INS to HIL mode

ArduSub/test.cpp

@@ -40,7 +40,7 @@ int8_t Sub::test_baro(uint8_t argc, const Menu::arg *argv)
     init_barometer(true);
 
     while(1) {
-        delay(100);
+    	hal.scheduler->delay(100);
         read_barometer();
 
         if (!barometer.healthy()) {
@@ -92,7 +92,7 @@ int8_t Sub::test_compass(uint8_t argc, const Menu::arg *argv)
     print_hit_enter();
 
     while(1) {
-        delay(20);
+    	hal.scheduler->delay(20);
         if (millis() - fast_loopTimer > 19) {
             delta_ms_fast_loop      = millis() - fast_loopTimer;
             G_Dt                    = (float)delta_ms_fast_loop / 1000.0f;                       // used by DCM integrator
@@ -149,13 +149,13 @@ int8_t Sub::test_ins(uint8_t argc, const Menu::arg *argv)
     Vector3f gyro, accel;
     print_hit_enter();
     cliSerial->printf("INS\n");
-    delay(1000);
+    hal.scheduler->delay(1000);
 
     ahrs.init();
     ins.init(scheduler.get_loop_rate_hz());
     cliSerial->printf("...done\n");
 
-    delay(50);
+    hal.scheduler->delay(50);
 
     while(1) {
         ins.update();
@@ -169,7 +169,7 @@ int8_t Sub::test_ins(uint8_t argc, const Menu::arg *argv)
             (double)gyro.x, (double)gyro.y, (double)gyro.z,
             (double)test);
 
-        delay(40);
+        hal.scheduler->delay(40);
         if(cliSerial->available() > 0) {
             return (0);
         }
@@ -184,7 +184,7 @@ int8_t Sub::test_optflow(uint8_t argc, const Menu::arg *argv)
         print_hit_enter();
 
         while(1) {
-            delay(200);
+        	hal.scheduler->delay(200);
             optflow.update();
             const Vector2f& flowRate = optflow.flowRate();
             cliSerial->printf("flowX : %7.4f\t flowY : %7.4f\t flow qual : %d\n",
@@ -209,19 +209,19 @@ int8_t Sub::test_optflow(uint8_t argc, const Menu::arg *argv)
 int8_t Sub::test_relay(uint8_t argc, const Menu::arg *argv)
 {
     print_hit_enter();
-    delay(1000);
+    hal.scheduler->delay(1000);
 
     while(1) {
         cliSerial->printf("Relay on\n");
         relay.on(0);
-        delay(3000);
+        hal.scheduler->delay(3000);
         if(cliSerial->available() > 0) {
             return (0);
         }
 
         cliSerial->printf("Relay off\n");
         relay.off(0);
-        delay(3000);
+        hal.scheduler->delay(3000);
         if(cliSerial->available() > 0) {
             return (0);
         }
@@ -252,7 +252,7 @@ int8_t Sub::test_rangefinder(uint8_t argc, const Menu::arg *argv)
 
     print_hit_enter();
     while(1) {
-        delay(100);
+    	hal.scheduler->delay(100);
         rangefinder.update();
 
         cliSerial->printf("Primary: status %d distance_cm %d \n", (int)rangefinder.status(), rangefinder.distance_cm());