Fixed yaw error normalization issue