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_dcm(uint8_t argc, const Menu::arg *argv);
//static int8_t test_omega(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_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_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_reverse(uint8_t argc, const Menu::arg *argv);
static int8_t test_tuning(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}, //{"tri", test_tri},
{"relay", test_relay}, {"relay", test_relay},
{"wp", test_wp}, {"wp", test_wp},
//{"nav", test_nav}, // {"boost", test_boost},
#if HIL_MODE != HIL_MODE_ATTITUDE #if HIL_MODE != HIL_MODE_ATTITUDE
{"altitude", test_baro}, {"altitude", test_baro},
{"sonar", test_sonar}, {"sonar", test_sonar},
@ -179,37 +179,26 @@ test_radio_pwm(uint8_t argc, const Menu::arg *argv)
}*/ }*/
/* /*
//static int8_t static int8_t
//test_nav(uint8_t argc, const Menu::arg *argv) //test_boost(uint8_t argc, const Menu::arg *argv)
{ {
print_hit_enter(); print_hit_enter();
delay(1000); delay(1000);
int16_t temp = MINIMUM_THROTTLE;
while(1){ while(1){
delay(1000); delay(20);
g_gps->ground_course = 19500; g.rc_3.control_in = temp;
calc_nav_rate2(g.waypoint_speed_max); adjust_altitude();
calc_nav_pitch_roll2(); Serial.printf("tmp:%d, boost: %d\n", temp, manual_boost);
temp++;
g_gps->ground_course = 28500; if(temp > MAXIMUM_THROTTLE){
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){
return (0); return (0);
//} }
} }
} }
*/ //*/
static int8_t static int8_t
test_radio(uint8_t argc, const Menu::arg *argv) test_radio(uint8_t argc, const Menu::arg *argv)