yaw improvement

this should stop the copter from carrying on spinning at higher yaw rates.