improved the yaw calculations
improved rotation processing