STM32F4 hardware support for SMACCMPilot on the PX4FMU