OpticalFlow: switch order of sin_yaw, cos_yaw
Copter: Jason's faster cos_yaw, sin_yaw