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