aboutsummaryrefslogtreecommitdiff
path: root/src/modules/commander/commander.cpp
diff options
context:
space:
mode:
authorJulian Oes <julian@oes.ch>2013-08-15 17:48:28 +0200
committerJulian Oes <julian@oes.ch>2013-08-15 17:48:28 +0200
commitd75c3c4e7369510db1d91721c2793c23dcd873fa (patch)
treee354b08f4f65b7eef6b2389c3f32368049c7c65a /src/modules/commander/commander.cpp
parent901cef922cb286a247872bd2ea46ec13f779d61e (diff)
downloadpx4-firmware-d75c3c4e7369510db1d91721c2793c23dcd873fa.tar.gz
px4-firmware-d75c3c4e7369510db1d91721c2793c23dcd873fa.tar.bz2
px4-firmware-d75c3c4e7369510db1d91721c2793c23dcd873fa.zip
Try to open RGBLEDs in commander (WIP)
Diffstat (limited to 'src/modules/commander/commander.cpp')
-rw-r--r--src/modules/commander/commander.cpp9
1 files changed, 3 insertions, 6 deletions
diff --git a/src/modules/commander/commander.cpp b/src/modules/commander/commander.cpp
index 71f33d81b..4e6ecd1e4 100644
--- a/src/modules/commander/commander.cpp
+++ b/src/modules/commander/commander.cpp
@@ -1331,11 +1331,11 @@ toggle_status_leds(vehicle_status_s *status, actuator_armed_s *armed, vehicle_gp
} else if (armed->ready_to_arm) {
/* ready to arm, blink at 2.5Hz */
- if (leds_counter & 8) {
- led_on(LED_AMBER);
+ if (leds_counter % 8 == 0) {
+ led_toggle(LED_AMBER);
} else {
- led_off(LED_AMBER);
+ led_toggle(LED_AMBER);
}
} else {
@@ -1358,9 +1358,6 @@ toggle_status_leds(vehicle_status_s *status, actuator_armed_s *armed, vehicle_gp
}
leds_counter++;
-
- if (leds_counter >= 16)
- leds_counter = 0;
}
void