From 0c4e3dce0ef82ea3a7dd2b7bed8b23108f34205d Mon Sep 17 00:00:00 2001
From: Julian Oes <julian@oes.ch>
Date: Thu, 15 Aug 2013 17:34:49 +0200
Subject: Added LED_TOGGLE for normal LEDs

---
 src/drivers/boards/px4fmu-v2/px4fmu2_led.c | 12 ++++++++++++
 1 file changed, 12 insertions(+)

(limited to 'src/drivers/boards/px4fmu-v2')

diff --git a/src/drivers/boards/px4fmu-v2/px4fmu2_led.c b/src/drivers/boards/px4fmu-v2/px4fmu2_led.c
index 5ded4294e..a856ccb02 100644
--- a/src/drivers/boards/px4fmu-v2/px4fmu2_led.c
+++ b/src/drivers/boards/px4fmu-v2/px4fmu2_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()
@@ -83,3 +84,14 @@ __EXPORT void led_off(int led)
 		stm32_gpiowrite(GPIO_LED1, true);
 	}
 }
+
+__EXPORT void led_toggle(int led)
+{
+	if (led == 1)
+	{
+		if (stm32_gpioread(GPIO_LED1))
+			stm32_gpiowrite(GPIO_LED1, false);
+		else
+			stm32_gpiowrite(GPIO_LED1, true);
+	}
+}
-- 
cgit v1.2.3