fixed yaw and more trys for stafety