Corrected use of yaw to determine heading