機械人動力學方程比較複雜,通常每乙個引數矩陣都非常龐大,這裡介紹幾個簡單結構的動力學方程,對於一般的控制演算法,可以在這幾個動力學方程中進行驗證。
(不考慮摩擦和末端受力)可以寫成:∑j
=1nd
ij(q
)q¨j
+∑i=
1n∑j
=1nc
ijk(
q)qi
˙qj˙
+gi(
q)=τ
i∑j=1ndij(q)q¨j+∑i=1n∑j=1ncijk(q)qi˙qj˙+gi(q)=τi
用矩陣形式表示為: d(
q)q¨
+c(q
,q˙)
q˙+g
(q)=
τd(q)q¨+c(q,q˙)q˙+g(q)=τ
其中:cij
k=12
(∂bi
j∂qk
+∂bi
k∂qj
−∂bj
k∂qi
)cijk=12(∂bij∂qk+∂bik∂qj−∂bjk∂qi)
注:分別計算連桿和電機轉子的質量、轉動慣量。
完整動力學方程為: (m
l1+m
m2+i
m1+i
l2)d
1¨+(
ml1+
ml2+
mm2)
g=τ1
(ml2
+im2
)d2¨
=τ2(ml1+mm2+im1+il2)d1¨+(ml1+ml2+mm2)g=τ1(ml2+im2)d2¨=τ2
其中,mli
mli 表示連桿的質量, mm
immi
表示電機轉子的質量, im
iimi
表示電機轉子關於其轉動軸的轉動慣量。gg
表示重力加速度向量, di
di 表示平動關節的關節變數。 τi
τi 表示關節所需力矩。
直角座標機械人還廣泛運用於教學演示、物料搬運、碼垛、工具機上下料、點膠、噴塗、檢測、3c 裝配、包裝等領域。
注:連桿和電機看做整體。
其中, h=
−m2l
1lc2
sin(
q2)h=−m2l1lc2sin(q2)g1
=(m1
lc1+
m2l1
)gco
s(q1
)+m2
lc2g
cos(
q1+q
2))g1=(m1lc1+m2l1)gcos(q1)+m2lc2gcos(q1+q2))g2
=m2l
c2gc
os(q
1+q2
)g2=m2lc2gcos(q1+q2)
完整動力學方程為:d11
q1¨+
d12q2
¨+c11
q1˙+
c12q2
˙+g1
=τ1d11q1¨+d12q2¨+c11q1˙+c12q2˙+g1=τ1d21
q1¨+
d22q2
¨+c21
q1˙+
c22q2
˙+g2
=τ2d21q1¨+d22q2¨+c21q1˙+c22q2˙+g2=τ2
其中,mimi
表示連桿的質量, li
li 表示連桿的長度, lc
ilci
表示連桿質心的長度, ii
ii 表示連桿關於其轉動軸的轉動慣量。gg
表示重力加速度向量, qi
qi 表示連桿的轉動角度**動關節的關節變數)。
兩連桿機械臂是最簡單的多連桿轉動關節串聯機械人,大量的控制演算法研究和驗證都是在兩連桿機械臂上完成的。只要賦予其引數值,就可以完成控制演算法的研究中模型的建模。
一組可行的賦值方案是:g=
9.81
g=9.81l1
=l2=
1l1=l2=1lc
1=lc
2=0.5lc1=lc2=0.5m1
=m2=
50m1=m2=50i1
=i2=
10i1=i2=10
注:連桿和電機看做整體。
完整動力學方程為:d11
p1¨+
d12p2
¨+c11
p1˙+
g1=τ
1d21p
1¨+d
22p2¨
+c22p
2˙+g
2=τ2
d11p1¨+d12p2¨+c11p1˙+g1=τ1d21p1¨+d22p2¨+c22p2˙+g2=τ2
其中,mimi
表示連桿的質量, li
li 表示連桿的長度, lc
ilci
表示連桿質心的長度, ii
ii 表示連桿關於其轉動軸的轉動慣量。gg
表示重力加速度向量, pi
pi 表示連桿的轉動角度**動關節的關節變數)。
可以看到,當第二個連桿電機固定在基座上的時候,第一、二連桿之間的科氏力消失。
因此,具體分析的時候,當驅動該連桿的電機不在該連桿上的時候,要把連桿和電機拆開,分別進行計算。
馬克 w. 斯龐等著,賈振中譯,機械人建模和控制(robot modeling and control),機械工業出版社,2016.07bruno siciliano etc 著,張國良等譯,機械人學 建模、規劃與控制(robotics:modelling,planning and control),西安交通大學出版社,2015.11
機械人運動學與動力學
運動學,從幾何的角度 指不涉及物體本身的物理性質和加在物體上的力 描述和研究物體位置隨時間的變化規律的力學分支。以研究質點和剛體這兩個簡化模型的運動為基礎,並進一步研究變形體 彈性體 流體等 的運動。研究後者的運動,須把變形體中微團的剛性位移和應變分開。點的運動學研究點的運動方程 軌跡 位移 速度 ...
機械人基礎 機械人的運動學控制和動力學控制
機械人運動學 機械人運動學就是用來解決位置控制問題的,常見的問題有兩個 1 正解建模知道當前幾個電機的轉角,通過運動學方程得知機械人末端的位置 2 逆解建模需要將機械人末端移動到指定位置,如何根據動力學方程來設計各個電機的轉角 舉例 機械人末端移動到指定點 機械人動力學 機械人運動學用來研究機械人運...
機器學習助推分子動力學模擬
今天介紹一篇文章,使用神經網路將分子動力學第一原理計算推進到新的尺度和精度。分子動力學模擬一般被用來揭示化學反應的微觀物理過程,用於光合作用,新藥尋找,奈米材料性質 等等。劉慈欣告訴我們,經典力學下的三體運動已經非常複雜,而量子力學統治下的多體相互作用,計算複雜度更是高到天際。分子動力學模擬要根據每...