mirror of https://github.com/ArduPilot/ardupilot
bug fixes and updates
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1751 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
parent
b0e6f40562
commit
6b99e76fcb
|
@ -206,8 +206,6 @@ const char* flight_mode_strings[] = {
|
|||
8 TBD
|
||||
*/
|
||||
|
||||
long error_a;
|
||||
|
||||
// Radio
|
||||
// -----
|
||||
int motor_out[4];
|
||||
|
|
|
@ -75,6 +75,7 @@ handle_process_now()
|
|||
void
|
||||
handle_no_commands()
|
||||
{
|
||||
if (command_must_ID) return;
|
||||
switch (control_mode){
|
||||
case LAND:
|
||||
// don't get a new command
|
||||
|
@ -84,6 +85,7 @@ handle_no_commands()
|
|||
// set_mode(LOITER);
|
||||
|
||||
default:
|
||||
if()
|
||||
set_mode(RTL);
|
||||
//next_command = get_LOITER_home_wp();
|
||||
//SendDebug("MSG <load_next_command> Preload RTL cmd id: ");
|
||||
|
|
|
@ -63,6 +63,7 @@ void init_rc_out()
|
|||
APM_RC.OutputCh(CH_3, g.rc_3.radio_min);
|
||||
APM_RC.OutputCh(CH_4, g.rc_3.radio_min);
|
||||
|
||||
|
||||
APM_RC.OutputCh(CH_7, g.rc_3.radio_min);
|
||||
APM_RC.OutputCh(CH_8, g.rc_3.radio_min);
|
||||
}
|
||||
|
|
|
@ -11,7 +11,7 @@ static int8_t test_gps(uint8_t argc, const Menu::arg *argv);
|
|||
static int8_t test_adc(uint8_t argc, const Menu::arg *argv);
|
||||
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_omega(uint8_t argc, const Menu::arg *argv);
|
||||
static int8_t test_battery(uint8_t argc, const Menu::arg *argv);
|
||||
static int8_t test_current(uint8_t argc, const Menu::arg *argv);
|
||||
static int8_t test_relay(uint8_t argc, const Menu::arg *argv);
|
||||
|
@ -52,7 +52,7 @@ const struct Menu::command test_menu_commands[] PROGMEM = {
|
|||
#endif
|
||||
{"imu", test_imu},
|
||||
//{"dcm", test_dcm},
|
||||
{"omega", test_omega},
|
||||
//{"omega", test_omega},
|
||||
{"battery", test_battery},
|
||||
{"current", test_current},
|
||||
{"relay", test_relay},
|
||||
|
@ -238,7 +238,6 @@ test_stabilize(uint8_t argc, const Menu::arg *argv)
|
|||
control_mode = STABILIZE;
|
||||
Serial.printf_P(PSTR("g.pid_stabilize_roll.kP: %4.4f\n"), g.pid_stabilize_roll.kP());
|
||||
Serial.printf_P(PSTR("max_stabilize_dampener:%d\n\n "), max_stabilize_dampener);
|
||||
Serial.printf_P(PSTR("max_yaw_dampener:%d\n\n "), max_yaw_dampener);
|
||||
|
||||
trim_radio();
|
||||
|
||||
|
@ -286,21 +285,14 @@ test_stabilize(uint8_t argc, const Menu::arg *argv)
|
|||
set_servos_4();
|
||||
|
||||
ts_num++;
|
||||
if (ts_num > 0){
|
||||
if (ts_num > 10){
|
||||
ts_num = 0;
|
||||
/*
|
||||
Serial.printf_P(PSTR("r: %d, p:%d, rc1:%d, "),
|
||||
(int)(dcm.roll_sensor/100),
|
||||
(int)(dcm.pitch_sensor/100),
|
||||
g.rc_1.pwm_out);
|
||||
*/
|
||||
|
||||
Serial.printf_P(PSTR("e:%ld, 4out:%d, O%4.4f\n"),
|
||||
error_a,
|
||||
g.rc_4.servo_out,
|
||||
omega.z);
|
||||
|
||||
//print_motor_out();
|
||||
print_motor_out();
|
||||
}
|
||||
// R: 1417, L: 1453 F: 1453 B: 1417
|
||||
|
||||
|
@ -619,8 +611,7 @@ test_dcm(uint8_t argc, const Menu::arg *argv)
|
|||
}
|
||||
*/
|
||||
|
||||
///*
|
||||
static int8_t
|
||||
/*static int8_t
|
||||
test_omega(uint8_t argc, const Menu::arg *argv)
|
||||
{
|
||||
static byte ts_num;
|
||||
|
|
Loading…
Reference in New Issue