Added SW test for Manual Boost

This commit is contained in:
Jason Short 2012-02-19 12:39:40 -08:00
parent 9169fe2bfe
commit 2a5a7fa245
1 changed files with 13 additions and 24 deletions

View File

@ -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();
delay(20);
g.rc_3.control_in = temp;
adjust_altitude();
Serial.printf("tmp:%d, boost: %d\n", temp, manual_boost);
temp++;
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();
//if(Serial.available() > 0){
if(temp > MAXIMUM_THROTTLE){
return (0);
//}
}
}
}
*/
//*/
static int8_t
test_radio(uint8_t argc, const Menu::arg *argv)