add manual override of rudder in stabilized modes

work in progress
current mod adds manual rudder input to output of yaw controller, rather than affecting the setpoint
This allows manual override of the rudder, which currently effects coordinated turns.