Use atan2 to calculate the yaw