AS为对角阵BS对角线上的元素为或CS中元素为的位置，在S，中对应元素为DS是该机械臂旋转矩阵R的反对称阵