FMUv5: Fix RGB led usage - these are individual status leds.

PX4 · Jun 6, 2018 · f87fa91 · f87fa91
1 parent 02eaf2c
commit f87fa91
Show file tree

Hide file tree

Showing 2 changed files with 5 additions and 1 deletion.
diff --git a/cmake/configs/nuttx_px4fmu-v5_default.cmake b/cmake/configs/nuttx_px4fmu-v5_default.cmake
@@ -31,7 +31,8 @@ set(config_module_list
 	drivers/px4fmu
 	drivers/px4io
 	drivers/rgbled
-	drivers/rgbled_pwm
+	# Enable the line below to put the three leds into PWM RGB mode
+	#drivers/rgbled_pwm
 	drivers/stm32
 	drivers/stm32/adc
 	drivers/stm32/tone_alarm

diff --git a/src/modules/commander/commander_helper.cpp b/src/modules/commander/commander_helper.cpp
@@ -288,6 +288,9 @@ int led_init()
 		return PX4_ERROR;
 	}
 
+	/* the green LED is only available on FMUv5 */
+	(void)h_leds.ioctl(LED_ON, LED_GREEN);
+
 	/* the blue LED is only available on AeroCore but not FMUv2 */
 	(void)h_leds.ioctl(LED_ON, LED_BLUE);