mirror of https://github.com/ArduPilot/ardupilot
Added SW test for Manual Boost
This commit is contained in:
parent
9169fe2bfe
commit
2a5a7fa245
|
@ -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)
|
||||||
|
|
Loading…
Reference in New Issue