姿态运动学及动力学(基于四元数)