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

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

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);