5.2.9 约束下姿态的计算