测量位姿和条件

在旋转轴垂直于地面且做水平运动期间执行关节 1 测量。

在旋转轴平行于地面且机器人在垂直于地面的向下运动中停止时执行关节 2 和关节 3 测量。