fixed #282; Fixed YAW issue