Yaw

Yaw corrections. Yaw Stab P can be set to normal ranges, was using wrong
modifier for motors.
Merge branch 'ArduCopter-3.1.1' of https://github.com/Dneault/ardupilot into ArduCopter-3.1.1