Plane: removed demo_servos()

this really didn't help much and slows down startup

ArduPlane/Attitude.cpp

@@ -1305,22 +1305,6 @@ bool Plane::allow_reverse_thrust(void)
     return allow;
 }
 
-void Plane::demo_servos(uint8_t i) 
-{
-    while(i > 0) {
-        gcs_send_text(MAV_SEVERITY_INFO,"Demo servos");
-        demoing_servos = true;
-        servo_write(1, 1400);
-        hal.scheduler->delay(400);
-        servo_write(1, 1600);
-        hal.scheduler->delay(200);
-        servo_write(1, 1500);
-        demoing_servos = false;
-        hal.scheduler->delay(400);
-        i--;
-    }
-}
-
 /*
   adjust nav_pitch_cd for STAB_PITCH_DOWN_CD. This is used to make
   keeping up good airspeed in FBWA mode easier, as the plane will

ArduPlane/Plane.h

@@ -769,7 +769,6 @@ private:
     int32_t last_mixer_crc = -1;
 #endif // CONFIG_HAL_BOARD
     
-    void demo_servos(uint8_t i);
     void adjust_nav_pitch_throttle(void);
     void update_load_factor(void);
     void send_heartbeat(mavlink_channel_t chan);

ArduPlane/system.cpp

@@ -264,13 +264,6 @@ void Plane::startup_ground(void)
     delay(GROUND_START_DELAY * 1000);
 #endif
 
-    // Makes the servos wiggle
-    // step 1 = 1 wiggle
-    // -----------------------
-    if (ins.gyro_calibration_timing() != AP_InertialSensor::GYRO_CAL_NEVER) {
-        demo_servos(1);
-    }
-
     //INS ground start
     //------------------------
     //
@@ -289,12 +282,6 @@ void Plane::startup_ground(void)
     // initialise mission library
     mission.init();
 
-    // Makes the servos wiggle - 3 times signals ready to fly
-    // -----------------------
-    if (ins.gyro_calibration_timing() != AP_InertialSensor::GYRO_CAL_NEVER) {
-        demo_servos(3);
-    }
-
     // reset last heartbeat time, so we don't trigger failsafe on slow
     // startup
     failsafe.last_heartbeat_ms = millis();