mirror of https://github.com/ArduPilot/ardupilot
removed debug code
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1775 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
parent
323f2bfa59
commit
984e6c7928
|
@ -13,14 +13,12 @@ void arm_motors()
|
|||
if (arming_counter > ARM_DELAY) {
|
||||
motor_armed = true;
|
||||
} else{
|
||||
//Serial.printf("arm %d\n", arming_counter);
|
||||
arming_counter++;
|
||||
}
|
||||
}else if (g.rc_4.control_in < -2700) {
|
||||
if (arming_counter > DISARM_DELAY){
|
||||
motor_armed = false;
|
||||
}else{
|
||||
//Serial.printf("arm %d\n", arming_counter);
|
||||
arming_counter++;
|
||||
}
|
||||
}else{
|
||||
|
@ -159,7 +157,6 @@ set_servos_4()
|
|||
}
|
||||
|
||||
num++;
|
||||
|
||||
if (num > 50){
|
||||
num = 0;
|
||||
/*
|
||||
|
@ -197,7 +194,7 @@ set_servos_4()
|
|||
init_pids();
|
||||
//*/
|
||||
|
||||
///*
|
||||
/*
|
||||
write_int(motor_out[CH_1]);
|
||||
write_int(motor_out[CH_2]);
|
||||
write_int(motor_out[CH_3]);
|
||||
|
@ -215,13 +212,14 @@ set_servos_4()
|
|||
write_int((int)nav_roll);
|
||||
write_int((int)nav_pitch);
|
||||
|
||||
write_long(current_loc.lat); // 28
|
||||
write_long(current_loc.lng); // 32
|
||||
write_int((int)current_loc.alt); // 34
|
||||
//24
|
||||
write_long(current_loc.lat); //28
|
||||
write_long(current_loc.lng); //32
|
||||
write_int((int)current_loc.alt); //34
|
||||
|
||||
write_long(next_WP.lat);
|
||||
write_long(next_WP.lng);
|
||||
write_int((int)next_WP.alt); // 44
|
||||
write_int((int)next_WP.alt); //44
|
||||
|
||||
flush(10);
|
||||
//*/
|
||||
|
|
Loading…
Reference in New Issue