yaw improvement

this should stop the copter from carrying on spinning at high yaw rates.
Merge pull request #120 from luggi/yaw

yaw improvement