• 设为首页
  • 点击收藏
  • 手机版
    手机扫一扫访问
    迪恩网络手机版
  • 关注官方公众号
    微信扫一扫关注
    公众号

机器人学(MATLAB机器人工具箱10.x)——4.1-雅克比矩阵(1)

原作者: [db:作者] 来自: [db:来源] 收藏 邀请

我们首先研究关节坐标的微小变化如何影响末端执行器的位姿。使用齐次坐标变换表示位姿,我们可以通过一个一阶微分近似得到位姿相对于关节坐标的导数:
dTdqT(q+δq)T(q)δq \dfrac{\text{d}T}{\text{d}q}\approx\dfrac{T(q+\delta_q)-T(q)}{\delta_q} 根据 TT定义,可以得到
dTdq1δq(R(q+δq)R(q)δxδyδz0000)(1) \tag{1} \dfrac{\text{d}T}{\text{d}q}\approx\dfrac{1}{\delta_q} \left( \begin{matrix} R\left( q+\delta _q \right) -R\left( q \right)& \begin{array}{c} \delta _x\\ \delta _y\\ \delta _z\\ \end{array}\\ \begin{matrix} 0& 0& 0\\ \end{matrix}& 0\\ \end{matrix} \right) 其中,(δx,δy,δz)(\delta_x,\delta_y,\delta_z) 表示末端执行器的平移位移。下面我们举个例子

>> mdl_puma560
>> T0 = p560.fkine(qn);
>> dq = 1e-6;
>> Tp = p560.fkine(qn + [dq 0 0 0 0 0]);
>> dTdq1 = (Tp - T0) / dq
dTdq1 =
    0.0000   -1.0000   -0.0000    0.1500
   -0.0000   -0.0000    1.0000    0.5963
         0         0         0         0
         0         0         0         0

得到的 矩阵显然不是齐次变换矩阵,其左上角的 3×33\times3 矩阵不是正交矩阵,右下角元素不为1。这说明了什么呢?

我们将dTdq1中的第四列元素与方程 (1)(1) 的矩阵中相应元素相等,得到
(δxδyδz)=(0.15000.59630)δq1 \left( \begin{array}{c} \delta _x\\ \delta _y\\ \delta _z\\ \end{array} \right) =\left( \begin{array}{c} 0.1500\\ 0.5963\\ 0\\ \end{array} \right) \delta _{q_1}
它代表了 q1q_1 的变化引起的末端执行器位置的变化。

从图中我们能更容易地理解——腰关节(q1q_1)的一个微小的旋转将使得末端执行器在世界坐标系水平的 xyxy 平面内移动,但却不产生垂直方向上的移动。

>> Tp = p560.fkine(qn + [0 dq 0 0 0 0]);
>> dTdq2 = (Tp - T0) / dq

dTdq2 =

    1.0000   -0.0000   -0.0000    0.0144
    0.0000         0    0.0000         0
    0.0000    0.0000    1.0000    0.5963
         0         0         0         0

同样可以写出
(δxδyδz)=(0.014400.5963)δq2 \left( \begin{array}{c} \delta _x\\ \delta _y\\ \delta _z\\ \end{array} \right) =\left( \begin{array}{c} 0.0144\\ 0\\ 0.5963\\ \end{array} \right) \delta _{q_2}
正如我们所预料的,肩关节 q2q_2 的一个微小转动会引起末端执行器在垂直的 xzxz 平面内的运动,而没有 yy 方向运动。等式两边同除以一个无限小的时间长度 δt\delta_t,则得到关节角速度和末端执行器速度之间的一个关系:
(x˙y˙z˙)=(0.014400.5963)q˙2 \left( \begin{array}{c} \dot x\\ \dot y\\ \dot z\\ \end{array} \right) =\left( \begin{array}{c} 0.0144\\ 0\\ 0.5963\\ \end{array} \right) {\dot q_2}
现在考虑方程 (1)(1) 的矩阵中左上方的 3×33×3 子矩阵。我们将其乘以 δq/δt\delta_q/\delta_t ,从而得到 RR 的一阶近似导数:
R˙(R(q+δq)R(q)δq)δqδt \dot{R}\approx \left( \frac{R\left( q+\delta _q \right) -R\left( q \right)}{\delta _q} \right) \frac{\delta _q}{\delta _t}


鲜花

握手

雷人

路过

鸡蛋
该文章已有0人参与评论

请发表评论

全部评论

专题导读
上一篇:
C#调用Delphi的dll的两种方法发布时间:2022-07-18
下一篇:
delphixe5android开发数据访问手机端解决乱码的办法发布时间:2022-07-18
热门推荐
阅读排行榜

扫描微信二维码

查看手机版网站

随时了解更新最新资讯

139-2527-9053

在线客服(服务时间 9:00~18:00)

在线QQ客服
地址:深圳市南山区西丽大学城创智工业园
电邮:jeky_zhao#qq.com
移动电话:139-2527-9053

Powered by 互联科技 X3.4© 2001-2213 极客世界.|Sitemap