基于单位四元数的姿态插补（Matlab）