Browse Source

Merge pull request #1421 from PX4/ledring

Configure led ring and enable heartbeat on it
sbg
Lorenz Meier 11 years ago
parent
commit
dde42fdba9
  1. 1
      src/drivers/boards/px4io-v2/board_config.h
  2. 1
      src/drivers/boards/px4io-v2/px4iov2_init.c
  3. 2
      src/modules/px4iofirmware/px4io.c
  4. 1
      src/modules/px4iofirmware/px4io.h

1
src/drivers/boards/px4io-v2/board_config.h

@ -77,6 +77,7 @@
#define GPIO_LED1 (GPIO_OUTPUT|GPIO_CNF_OUTOD|GPIO_MODE_50MHz|GPIO_OUTPUT_SET|GPIO_PORTB|GPIO_PIN14) #define GPIO_LED1 (GPIO_OUTPUT|GPIO_CNF_OUTOD|GPIO_MODE_50MHz|GPIO_OUTPUT_SET|GPIO_PORTB|GPIO_PIN14)
#define GPIO_LED2 (GPIO_OUTPUT|GPIO_CNF_OUTOD|GPIO_MODE_50MHz|GPIO_OUTPUT_SET|GPIO_PORTB|GPIO_PIN15) #define GPIO_LED2 (GPIO_OUTPUT|GPIO_CNF_OUTOD|GPIO_MODE_50MHz|GPIO_OUTPUT_SET|GPIO_PORTB|GPIO_PIN15)
#define GPIO_LED3 (GPIO_OUTPUT|GPIO_CNF_OUTOD|GPIO_MODE_50MHz|GPIO_OUTPUT_SET|GPIO_PORTB|GPIO_PIN13) #define GPIO_LED3 (GPIO_OUTPUT|GPIO_CNF_OUTOD|GPIO_MODE_50MHz|GPIO_OUTPUT_SET|GPIO_PORTB|GPIO_PIN13)
#define GPIO_LED4 (GPIO_OUTPUT|GPIO_CNF_OUTOD|GPIO_MODE_50MHz|GPIO_OUTPUT_SET|GPIO_PORTA|GPIO_PIN11)
/* Safety switch button *******************************************************/ /* Safety switch button *******************************************************/

1
src/drivers/boards/px4io-v2/px4iov2_init.c

@ -108,6 +108,7 @@ __EXPORT void stm32_boardinitialize(void)
stm32_configgpio(GPIO_LED1); stm32_configgpio(GPIO_LED1);
stm32_configgpio(GPIO_LED2); stm32_configgpio(GPIO_LED2);
stm32_configgpio(GPIO_LED3); stm32_configgpio(GPIO_LED3);
stm32_configgpio(GPIO_LED4);
stm32_configgpio(GPIO_BTN_SAFETY); stm32_configgpio(GPIO_BTN_SAFETY);

2
src/modules/px4iofirmware/px4io.c

@ -124,6 +124,7 @@ heartbeat_blink(void)
{ {
static bool heartbeat = false; static bool heartbeat = false;
LED_BLUE(heartbeat = !heartbeat); LED_BLUE(heartbeat = !heartbeat);
LED_RING(heartbeat);
} }
static uint64_t reboot_time; static uint64_t reboot_time;
@ -191,6 +192,7 @@ user_start(int argc, char *argv[])
LED_AMBER(false); LED_AMBER(false);
LED_BLUE(false); LED_BLUE(false);
LED_SAFETY(false); LED_SAFETY(false);
LED_RING(false);
/* turn on servo power (if supported) */ /* turn on servo power (if supported) */
#ifdef POWER_SERVO #ifdef POWER_SERVO

1
src/modules/px4iofirmware/px4io.h

@ -140,6 +140,7 @@ extern pwm_limit_t pwm_limit;
#define LED_BLUE(_s) stm32_gpiowrite(GPIO_LED1, !(_s)) #define LED_BLUE(_s) stm32_gpiowrite(GPIO_LED1, !(_s))
#define LED_AMBER(_s) stm32_gpiowrite(GPIO_LED2, !(_s)) #define LED_AMBER(_s) stm32_gpiowrite(GPIO_LED2, !(_s))
#define LED_SAFETY(_s) stm32_gpiowrite(GPIO_LED3, !(_s)) #define LED_SAFETY(_s) stm32_gpiowrite(GPIO_LED3, !(_s))
#define LED_RING(_s) stm32_gpiowrite(GPIO_LED4, !(_s))
#ifdef CONFIG_ARCH_BOARD_PX4IO_V1 #ifdef CONFIG_ARCH_BOARD_PX4IO_V1

Loading…
Cancel
Save