diff --git a/ArduCopterMega/setup.pde b/ArduCopterMega/setup.pde
index a3e754d21b..5fb4ebfba9 100644
--- a/ArduCopterMega/setup.pde
+++ b/ArduCopterMega/setup.pde
@@ -266,7 +266,7 @@ setup_motors(uint8_t argc, const Menu::arg *argv)
 static int8_t
 setup_accel(uint8_t argc, const Menu::arg *argv)
 {
-	imu.init_accel();
+	imu.init_accel(mavlink_delay);
 	print_accel_offsets();
 	report_imu();
 	return(0);
diff --git a/ArduCopterMega/test.pde b/ArduCopterMega/test.pde
index 8abc79df82..10801dcc68 100644
--- a/ArduCopterMega/test.pde
+++ b/ArduCopterMega/test.pde
@@ -444,7 +444,8 @@ test_imu(uint8_t argc, const Menu::arg *argv)
 	//dcm.ki_yaw(0);
 
 	report_imu();
-	imu.init_gyro();
+	//imu.init_gyro();
+	imu.init_gyro(mavlink_delay);
 	report_imu();
 
 	print_hit_enter();