位置A:

位置B:


六轴:


位置A:

位置B:



角度A:

角度B:


第七轴约束面法向量(F7):

第七轴实际方向(R7):


第七轴期望方向(V7=F7 X AB):

第六轴角度差: