Problem: vehicle speed "runs away" to speed_max for any throttle value over 75%.
Cause: the desired_speed was calculated by interpolation between the current speed to speed_max, rather than the speed_default to speed_max. As current speed increases the desired speed increases although throttle is fixed. Hence the "runaway".
Fix: Now speed nudge interpolates between the desired speed and speed_max.
Tested:
modes: wp navigation, guided ,rtl
params: spped_max, wp_speed, rtl_speed, speed_max
do_change_speed
added get desired roll and pitch
Motors library adds set and get methods for roll and pitch
added roll and pitch to get_control_output
get_control_output returns roll and pitch values