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 @@ @@ -77,6 +77,7 @@
#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_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 *******************************************************/

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

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

2
src/modules/px4iofirmware/px4io.c

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

1
src/modules/px4iofirmware/px4io.h

@ -140,6 +140,7 @@ extern pwm_limit_t pwm_limit; @@ -140,6 +140,7 @@ extern pwm_limit_t pwm_limit;
#define LED_BLUE(_s) stm32_gpiowrite(GPIO_LED1, !(_s))
#define LED_AMBER(_s) stm32_gpiowrite(GPIO_LED2, !(_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

Loading…
Cancel
Save