运动过程中 的最终姿态可由
依据上图表示的运动过程获得,过程如下所示:
1)典型体 相对于低序体
安装时的实际初始位姿估算:第一步
通过矢量
给
一个初始理想固定位姿,第二步再给
融入
得到
相对
的实际初始位姿;
2)典型体 在低序体
上的相对运动:第一步在
的实际初始位姿上设置
,最终明确误差运动
,最后得到
的最终位姿。
相邻典型体之间实际运动齐次变换矩阵可以由以下表达式来表示:
式中:
:相邻典型体实际运动位置变换矩阵
:相邻典型体相对静止时的理想位置变换矩阵
:相邻典型体相对静止时的位置误差变换矩阵
:相邻典型体相对运动时的理想位置变换矩阵
:相邻典型体相对运动时的位置误差变换矩阵
:相邻典型体实际运动姿态变换矩阵
:相邻典型体相对静止时的理想姿态变换矩阵
:相邻典型体相对静止时的姿态误差变换矩阵
:相邻典型体相对运动时的理想姿态变换矩阵
:相邻典型体相对运动时的姿态误差变换矩阵
相邻的两个典型体之间的理想运动位置变换矩阵可以用下面的表达式来反映:
相邻的两个典型体之间的理想运动姿态变换矩阵可以表示为: