diff options
| author | Julian Oes <julian@oes.ch> | 2013-08-15 17:34:49 +0200 |
|---|---|---|
| committer | Julian Oes <julian@oes.ch> | 2013-08-15 17:34:49 +0200 |
| commit | 0c4e3dce0ef82ea3a7dd2b7bed8b23108f34205d (patch) | |
| tree | 99000c24de681415db725fe01d779193448a7faf /src/drivers/boards/px4fmu-v1 | |
| parent | f51320d1afac836085ee4d9dbdaeda7af18bcbda (diff) | |
| download | px4-firmware-0c4e3dce0ef82ea3a7dd2b7bed8b23108f34205d.tar.gz px4-firmware-0c4e3dce0ef82ea3a7dd2b7bed8b23108f34205d.tar.bz2 px4-firmware-0c4e3dce0ef82ea3a7dd2b7bed8b23108f34205d.zip | |
Added LED_TOGGLE for normal LEDs
Diffstat (limited to 'src/drivers/boards/px4fmu-v1')
| -rw-r--r-- | src/drivers/boards/px4fmu-v1/px4fmu_led.c | 19 |
1 files changed, 19 insertions, 0 deletions
diff --git a/src/drivers/boards/px4fmu-v1/px4fmu_led.c b/src/drivers/boards/px4fmu-v1/px4fmu_led.c index aa83ec130..ea91f34ad 100644 --- a/src/drivers/boards/px4fmu-v1/px4fmu_led.c +++ b/src/drivers/boards/px4fmu-v1/px4fmu_led.c @@ -57,6 +57,7 @@ __BEGIN_DECLS extern void led_init(); extern void led_on(int led); extern void led_off(int led); +extern void led_toggle(int led); __END_DECLS __EXPORT void led_init() @@ -94,3 +95,21 @@ __EXPORT void led_off(int led) stm32_gpiowrite(GPIO_LED2, true); } } + +__EXPORT void led_toggle(int led) +{ + if (led == 0) + { + if (stm32_gpioread(GPIO_LED1)) + stm32_gpiowrite(GPIO_LED1, false); + else + stm32_gpiowrite(GPIO_LED1, true); + } + if (led == 1) + { + if (stm32_gpioread(GPIO_LED2)) + stm32_gpiowrite(GPIO_LED2, false); + else + stm32_gpiowrite(GPIO_LED2, true); + } +} |