fixed yawDiff bug in autopilot