Merged in f5soh/librepilot/LP-504_MSP_speed_fix (pull request #413)