3D仿真学习笔记(三)-- 相邻典型体间的误差齐次变换矩阵

        当 B_j 沿其低序体 B_i 的 x 方向平移后,B_j 的 x 方向上会产生 6 项误差:定位误差 \delta _{xX},直线度误差 \delta _{yX},\delta _{zX},滚转角误差 \varepsilon _{xX},俯仰角误差 \varepsilon _{yX},偏转角误差 \varepsilon _{zX}。将以上的 6 项误差带入相邻典型体位置变换矩阵,可得 B_j 沿着 B_i 的 X 轴方向平动时的位置误差变换矩阵:

\begin{matrix} \Delta T_{ij}(x,S) = \begin{bmatrix} cos \varepsilon_{yX} cos \varepsilon_{zX} & -cos\varepsilon_{yX}sin\varepsilon_{zX} & sin\varepsilon_{yX} & \delta_{xX} \\ sin\varepsilon_{xX}sin\varepsilon_{yX}cos\varepsilon_{zX}+cos\varepsilon_{xX}sin\varepsilon_{zX} & -sin\varepsilon_{xX}sin\varepsilon_{yX}sin\varepsilon_{zX}+cos\varepsilon_{xX}cos\varepsilon_{zX} & -sin\varepsilon_{xX}cos\varepsilon_{yX} & \delta_{yX} \\ -cos\varepsilon_{xX}sin\varepsilon_{yX}cos\varepsilon_{zX}+sin\varepsilon_{xX}sin\varepsilon_{zX} & cos\varepsilon_{xX}sin\varepsilon_{yX}sin\varepsilon_{zX}+sin\varepsilon_{xX}cos\varepsilon_{zX} & cos\varepsilon_{xX}cos\varepsilon_{yX} & \delta _{zX} \\ 0 & 0 & 0 & 1 \end{} &(1.19) \end{}

        通常,因角误差 \varepsilon_{xX},\varepsilon_{yX},\varepsilon_{zX} 数值较小,则满足 sin\varepsilon_{kx} \approx \varepsilon_{kx} 和 cos\varepsilon_{kx} \approx 1 的基本条件,同时将高阶无穷小忽略,可以获得以下表达式:

\begin{matrix} \Delta T_{ij}(x,S) = \begin{bmatrix} 1 & -\varepsilon_{zX} & \varepsilon_{yX} & \delta_{xX} \\ \varepsilon_{zX} & 1 & -\varepsilon_{xX} & \delta_{yX} \\ -\varepsilon_{yX} & \varepsilon_{xX} & 1 & \delta_{zX} \\ 0 & 0 & 0 &1 \end{} &(1.20) \end{}

        分别在 1.17 表达式中将滚转角误差 \varepsilon_{xX}、俯仰角误差 \varepsilon_{yX} 和偏摆角误差 \varepsilon_{zX} 代入,经过表达式的简化之后可以获得 B_j 沿着 B_i 平动时的姿态误差齐次变换矩阵,可以用式 (1.21) 表示:

\begin{matrix} \Delta T_{ijR}(x,S) = \begin{bmatrix} 1 & -\varepsilon_{zX} & \varepsilon_{yX} & 0 \\ \varepsilon_{zX} & 1 & -\varepsilon_{xX} & 0 \\ -\varepsilon_{yX} & \varepsilon_{xX} & 1 & 0 \\ 0 & 0 & 0 &1 \end{} &(1.21) \end{}

        同理,可以分别在 Y 轴和 Z 轴上进行平动,绕 X 轴、Y 轴和 Z 轴转动。同样可获得对应的位置、姿态变换矩阵。在相对运动中,相对静止是一种特殊类型的情况,借助以上推演过程,可获得相对静止时的位置、姿态误差变换矩阵。

  • 1
    点赞
  • 4
    收藏
    觉得还不错? 一键收藏
  • 4
    评论
评论 4
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值