fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-23 01:43:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

Added LED_TOGGLE for normal LEDs

Browse Source
This commit is contained in:
Julian Oes
2013-08-15 17:34:49 +02:00
parent f51320d1af
commit 0c4e3dce0e
4 changed files with 38 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/boards/px4fmu-v1/px4fmu_led.c
+19
View File
@@ -57,6 +57,7 @@ __BEGIN_DECLS
extern void led_init(); extern void led_init();
extern void led_on(int led); extern void led_on(int led);
extern void led_off(int led); extern void led_off(int led);
extern void led_toggle(int led);
__END_DECLS __END_DECLS
__EXPORT void led_init() __EXPORT void led_init()
@@ -94,3 +95,21 @@ __EXPORT void led_off(int led)
stm32_gpiowrite(GPIO_LED2, true); 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);
}
}
src/drivers/boards/px4fmu-v2/px4fmu2_led.c
+12
View File
@@ -57,6 +57,7 @@ __BEGIN_DECLS
extern void led_init(); extern void led_init();
extern void led_on(int led); extern void led_on(int led);
extern void led_off(int led); extern void led_off(int led);
extern void led_toggle(int led);
__END_DECLS __END_DECLS
__EXPORT void led_init() __EXPORT void led_init()
@@ -83,3 +84,14 @@ __EXPORT void led_off(int led)
stm32_gpiowrite(GPIO_LED1, true); 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);
}
}
src/drivers/drv_led.h
+1
View File
@@ -54,6 +54,7 @@
#define LED_ON _IOC(_LED_BASE, 0) #define LED_ON _IOC(_LED_BASE, 0)
#define LED_OFF _IOC(_LED_BASE, 1) #define LED_OFF _IOC(_LED_BASE, 1)
#define LED_TOGGLE _IOC(_LED_BASE, 2)
__BEGIN_DECLS __BEGIN_DECLS
src/drivers/led/led.cpp
+6
View File
@@ -52,6 +52,7 @@ __BEGIN_DECLS
extern void led_init(); extern void led_init();
extern void led_on(int led); extern void led_on(int led);
extern void led_off(int led); extern void led_off(int led);
extern void led_toggle(int led);
__END_DECLS __END_DECLS
class LED : device::CDev class LED : device::CDev
@@ -98,6 +99,11 @@ LED::ioctl(struct file *filp, int cmd, unsigned long arg)
led_off(arg); led_off(arg);
break; break;
case LED_TOGGLE:
led_toggle(arg);
break;
default: default:
result = CDev::ioctl(filp, cmd, arg); result = CDev::ioctl(filp, cmd, arg);
} }