Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-23 00:04:02 -04:00
Code Issues Packages Projects Releases Wiki Activity

APM_OBC: changed termination servo values, and added loop counter

Browse Source
This commit is contained in:
Andrew Tridgell 2012-09-08 11:26:18 +10:00
parent cde7d8c5e7
commit 8458607928
1 changed files with 6 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
libraries/APM_OBC/Failsafe_Board/Failsafe_Board.pde
View File

@ -121,7 +121,7 @@ static void set_servos_terminate(uint8_t obc_mode)
{
set_mux_mode(MUX_MODE_MICRO);
if (obc_mode) {
set_servos(2000, 2000, 1000, 2000);
set_servos(1000, 2000, 1000, 1000);
} else {
set_servos(1500, 1500, 1200, 1500);
}
@ -161,6 +161,9 @@ void loop()
static uint8_t led_state;
static bool has_terminated = false;
static uint8_t termination_counter;
static uint16_t loop_counter;
loop_counter++;
// check for heartbeat
update_heartbeat();
@ -188,8 +191,10 @@ void loop()
Serial.print(" TERM1:"); Serial.print(terminate_primary);
Serial.print(" TERM2:"); Serial.print(terminate_backup);
Serial.print(" TERMINATED:"); Serial.print(has_terminated);
Serial.print(" LOOP:"); Serial.print(loop_counter);
Serial.println();
delayMicroseconds(5000);
loop_counter = 0;
// flash LED once a second so we know failsafe board
// is working
led_state = !led_state;