Hopefully fixed yaw problems

Discovered that the rudder was only being used to control yaw in
HOVER_PID mode but not other two hover flight modes.  Fixed that problem
and also fixed the problem with the yaw controller being really bad
about oscillations so more normal rudder PID gains can be used now.
Hopefully that fixes the yaw problems.