Pull request from chsw/MavLink_FrSkySPort