Added SW test for Manual Boost

ArduCopter/test.pde

@@ -17,7 +17,7 @@ static int8_t	test_imu(uint8_t argc, 			const Menu::arg *argv);
 //static int8_t	test_dcm(uint8_t argc, 			const Menu::arg *argv);
 //static int8_t	test_omega(uint8_t argc, 		const Menu::arg *argv);
 static int8_t	test_battery(uint8_t argc, 		const Menu::arg *argv);
-//static int8_t	test_nav(uint8_t argc, 			const Menu::arg *argv);
+//static int8_t	test_boost(uint8_t argc, 		const Menu::arg *argv);
 //static int8_t	test_wp_nav(uint8_t argc, 		const Menu::arg *argv);
 //static int8_t	test_reverse(uint8_t argc, 		const Menu::arg *argv);
 static int8_t	test_tuning(uint8_t argc, 		const Menu::arg *argv);
@@ -70,7 +70,7 @@ const struct Menu::command test_menu_commands[] PROGMEM = {
 	//{"tri",			test_tri},
 	{"relay",		test_relay},
 	{"wp",			test_wp},
-	//{"nav",			test_nav},
+//	{"boost",		test_boost},
 #if HIL_MODE != HIL_MODE_ATTITUDE
 	{"altitude",	test_baro},
 	{"sonar",		test_sonar},
@@ -179,37 +179,26 @@ test_radio_pwm(uint8_t argc, const Menu::arg *argv)
 }*/
 
 /*
-//static int8_t
-//test_nav(uint8_t argc, const Menu::arg *argv)
+static int8_t
+//test_boost(uint8_t argc, const Menu::arg *argv)
 {
 	print_hit_enter();
 	delay(1000);
+	int16_t temp = MINIMUM_THROTTLE;
 
 	while(1){
-		delay(1000);
-		g_gps->ground_course = 19500;
-		calc_nav_rate2(g.waypoint_speed_max);
-		calc_nav_pitch_roll2();
-
-		g_gps->ground_course = 28500;
-		calc_nav_rate2(g.waypoint_speed_max);
-		calc_nav_pitch_roll2();
-
-		g_gps->ground_course = 1500;
-		calc_nav_rate2(g.waypoint_speed_max);
-		calc_nav_pitch_roll2();
-
-		g_gps->ground_course = 10500;
-		calc_nav_rate2(g.waypoint_speed_max);
-		calc_nav_pitch_roll2();
-
+		delay(20);
+		g.rc_3.control_in = temp;
+		adjust_altitude();
+		Serial.printf("tmp:%d, boost: %d\n", temp, manual_boost);
+		temp++;
 
-		//if(Serial.available() > 0){
+		if(temp > MAXIMUM_THROTTLE){
 			return (0);
-		//}
+		}
 	}
 }
-*/
+//*/
 
 static int8_t
 test_radio(uint8_t argc, const Menu::arg *argv)