机器人雅可比矩阵的求法_构造法
機(jī)器人雅可比矩陣的求法_構(gòu)造法
雅可比矩陣對于機(jī)器人運(yùn)動學(xué)逆解、靜力學(xué)分析和動力學(xué)分析有重要意義,是機(jī)器人位置\力控制的基礎(chǔ)。這篇文章主要講如何用構(gòu)造法求解雅可比矩陣。 上一篇文章中講到,D-H矩陣中的坐標(biāo)系建立有兩種方法,本文就針對對這兩種坐標(biāo)系建立方法分別求出雅可比矩陣。一、(后置法)雅可比矩陣求法
很多教材中的雅可比構(gòu)造法都是針對后置法(第二種方法)建立的坐標(biāo)系而言的,第二種坐標(biāo)系的雅可比矩陣求法簡單介紹如下:線速度和角速度對時間的導(dǎo)數(shù)可以表示為:P˙e=∑i=1n?Pe?qi=∑i=1nJpiq˙i
ωe=∑i=1nJOiq˙i
這種情況下的雅可比矩陣用構(gòu)造法可以表示為:
J=????JPi?JOi???JPn?JOn????
其中:
具體的推導(dǎo)過程不再贅述。下面來比較兩種坐標(biāo)系下牙科臂矩陣的關(guān)系。通過以上公式可以看到,雅可比矩陣只和各關(guān)節(jié)坐標(biāo)系的Z 軸和坐標(biāo)系原點(diǎn)的坐標(biāo)有關(guān)。通過比較兩種坐標(biāo)系的 Z 軸和坐標(biāo)系原點(diǎn)的關(guān)系,可以得出第一種坐標(biāo)系下的雅可比矩陣的求法。
二、(前置法)雅可比矩陣求法
通過上圖中的比較可以看到,左圖中的Zi 和右圖中的 Zi?1 重合,而左圖中的 Pi 與右圖中的 Pi?1 重合,他們都可以用相同的方法求得雅可比矩陣的公式。因此,只要對右圖對應(yīng)的雅可比矩陣做相應(yīng)的變換,就可以得到左圖坐標(biāo)系下的雅可比矩陣。
變換的方法是:(1)、把 Zi?1 換成 Zi ;(2)、把 Pi?1 換成 Pi 。得到的雅可比矩陣是:
三、參考文獻(xiàn)。
1) John J Craig, 機(jī)器人學(xué)導(dǎo)論(第三版),機(jī)械工業(yè)出版社,2006.6.
2) Saeed B.Niku 等,機(jī)器人學(xué)導(dǎo)論——分析、系統(tǒng)及應(yīng)用,電子工業(yè)出版社,2004.1.
3) Bruno Siciliano 等,機(jī)器人學(xué) 建模、規(guī)劃與控制,西安交通大學(xué)出版社,2013.11.
總結(jié)
以上是生活随笔為你收集整理的机器人雅可比矩阵的求法_构造法的全部內(nèi)容,希望文章能夠幫你解決所遇到的問題。
- 上一篇: 机器人运动学_不同D-H矩阵的对比
- 下一篇: 运动学与雅可比矩阵举例