Corrected Yaw Calculation