等效旋转矢量算法多子样MATLAB