Changing yaw threshold to 5