Adjust Yaw rotation speed and smothness in wp missions with user controlled heading

Ideas & Suggestions
51

@michaelderwin
Enterprise drones (M300 RTK, M2EA, etc) have some level of support but are not officially supported and tested.