gpio_led: PX4FMUv2 support

Bugs fixed, PX4FMUv2 support added.