Avoid unneccesary cast
Merge branch 'master' of https://github.com/PX4/Firmware into px4_master