《機(jī)器人學(xué)導(dǎo)論第4章1課件》由會員分享，可在線閱讀，更多相關(guān)《機(jī)器人學(xué)導(dǎo)論第4章1課件（34頁珍藏版）》請?jiān)谘b配圖網(wǎng)上搜索。

1、單擊此處編輯母版標(biāo)題樣式,單擊此處編輯母版文本樣式,第二級,第三級,第四級,第五級,*,單擊此處編輯母版標(biāo)題樣式,單擊此處編輯母版文本樣式,第二級,第三級,第四級,第五級,*,第4章 力分析及柔順控制,學(xué)習(xí)內(nèi)容：1 動力學(xué)分析,2 靜力學(xué)分析,3 坐標(biāo)系間力和力矩的變換,4 柔順控制,學(xué)習(xí)重點(diǎn)：1 動力學(xué)方程的簡化,2 柔順坐標(biāo)系,為了使物體加速必須對其施加力，使旋轉(zhuǎn)物體產(chǎn)生角加速度必須對其施加力矩，所施加力、力矩大小為：,為使機(jī)器人連桿加速，驅(qū)動器必須有足夠大的力、力矩驅(qū)動機(jī)器人連桿和關(guān)節(jié)，以使他們能以期望的加速度和速度運(yùn)動。為此，必須計(jì)算每個驅(qū)動器所需的驅(qū)動力。設(shè)計(jì)者可根據(jù)這些方程并考慮機(jī)

2、器人外部載荷計(jì)算出驅(qū)動器可能承受的最大載荷，并進(jìn)而設(shè)計(jì)出能夠提供足夠力及力矩的驅(qū)動器。,事實(shí)上，除最簡單情況外，求解全部機(jī)器人動力學(xué)方程是不可能的。一般只需求解用這些方程確定出必要的力、力矩，以便在機(jī)器人連桿上產(chǎn)生期望的速度、加速度。,拉格朗日方程是基于能量對系統(tǒng)變量及時間微分的。簡單情況比牛頓力學(xué)煩瑣，隨著系統(tǒng)復(fù)雜程度的增加，運(yùn)用該方程將變得簡單。,4.1 拉格朗日方程,式中：L是拉格朗日函數(shù)，K是系統(tǒng)動能，P是系統(tǒng)勢能。,式中：F是所有線運(yùn)動外力之和，T是所有轉(zhuǎn)動外力矩之和，x 是系統(tǒng)變量。,例4.1 分別用拉格朗日方程及牛頓方程推倒如圖所示的單自由度系統(tǒng)的力和加速度關(guān)系。,于是，小車的運(yùn)

3、動方程為：,用牛頓方程：,機(jī)械手和環(huán)境之間的接觸將在接觸處產(chǎn)生相互作用的力和力矩。每個機(jī)械手的關(guān)節(jié)運(yùn)動都是由各自的執(zhí)行裝置驅(qū)動的。相應(yīng)的關(guān)節(jié)輸入力矩，經(jīng)手臂的連桿傳送到抓具，并在抓具處引起對環(huán)境的力和力矩。,對于象焊接、噴漆、搬運(yùn)等工作，通常只需要單純的位姿控制；而如裝配、切割、研磨、打毛刺、擦玻璃等作業(yè)，機(jī)器人的末端工具需要與被操作的物體或環(huán)境接觸，通過相互之間的作用力完成一定的作業(yè)，對于這些工作，只采用位姿控制是不夠的，因?yàn)槲⑿〉恼`差可能使工具與環(huán)境脫離接觸或產(chǎn)生很大的相互作用力。這時的控制就易采用柔順方法。,即在易使工具與環(huán)境脫離接觸或產(chǎn)生很大作用力的方向采用柔順控制。其方法是：假想在此

4、方向，末端剛度很低，對其采用力控制。,4.2 力和力矩分析,4.2.1 力和力矩的平衡,這一節(jié)推導(dǎo)表示機(jī)械手靜力學(xué)特性的基本方程。我們首先考慮在開環(huán)運(yùn)動鏈上的一個單獨(dú)連接的自由實(shí)體的圖形。圖4-1表示作用在連桿i上的力和力矩。連桿i通過關(guān)節(jié)i+1與連桿i-1和連桿i+1連接起來。用 表示第i-1連桿作用在第i連桿上的力，也就是作用在 坐標(biāo)系原點(diǎn) O,i-1,上的作用力。,同樣，表示連桿i作用在連桿i+1上的作用力，那么連桿i+1對連桿i的作用力就可由 給出。表示作用在重心C,i,的重力，m,i,為連桿i的質(zhì)量，而g是3,1的重力加速度矢量。根據(jù)力的平衡原理有,其中所有矢量都是表示在基坐標(biāo)系 中

5、。,圖4-2 作用在連桿i上的力和力矩,下面研究力矩的平衡情況。由連桿i-1施加在連桿i上的力矩用N,i-1,i,來表示，因此，由連桿i+1施加給連桿i的力矩是-N,i-1,i,，同時，力f,i-1,i,和-f,i-1,i,也會對重心C,i,產(chǎn)生力矩。因而相對于重心C,i,的力矩平衡式為：,這里r,i-1,i,是從O,i-1,到O,i,的3,1位置矢量，而r,i,ci,表示從O,i,到C,i,的位置矢量。力f,i-1,i,和力矩N,i-1,i,是相鄰連桿i和i-1之間的耦合力和力矩。,當(dāng)i=1時，耦合力f,0,1,和力矩N,0,1,和可解釋為基座對手臂的作用力和力矩(見圖4-2(a),。,當(dāng)i

6、=n時，耦合力和力矩為f,n,n+1,和N,n,n+1,，如圖4-2(b)所示。當(dāng)抓具(即連桿n)與環(huán)境接觸時，這個作用力和力矩的反作用力和力矩就作用于最后一個連桿。,為了方便，我們把環(huán)境考慮為附加的連桿n+1,而用-f,n,n+1,和N,n,n+1,分別表示連桿n+1對連桿n的作用力和力矩。,圖4-3 基座和環(huán)境所施加的力和力矩,上述方程(4.1)和(4.2)適用于除基座外的全部連桿。這樣總的矢量方程個數(shù)為2n，而其中包含的耦合力和力矩是2(n+1)個。因此，有兩個耦合力和力矩必須給定，否則便不能解出該方程組。末端的耦合力f,n,n+1,和耦合力矩N,n,n+1,是機(jī)械手對環(huán)境施加的力和力矩

7、。為了完成一定的作業(yè)，機(jī)械手必須施加一定的力和力矩。因此，我們認(rèn)為這個耦合力和力矩是給定的，從而可解出以上2n個方程。為了方便，我們把f,n,n+1,和N,n,n+1,寫成下面一個6維矢量,我們稱F為末端力和力矩矢量，簡稱末端力。,(4.3),4.2.2 等效關(guān)節(jié)力矩,對于由執(zhí)行裝置施加的力矩與引起的末端力之間的函數(shù)關(guān)系。假定，每個關(guān)節(jié)由獨(dú)立的執(zhí)行裝置驅(qū)動，執(zhí)行裝置在相鄰連桿之間施加一個驅(qū)動力矩或者力，設(shè) 是驅(qū)動關(guān)節(jié)i的驅(qū)動力矩或力。,對于滑移關(guān)節(jié)，驅(qū)動力 是沿第i關(guān)節(jié)軸的方向（即i-1坐標(biāo)系的z,i-1,軸方向），見圖4-3。假設(shè)關(guān)節(jié)的機(jī)械特性是光滑的，即沒有摩擦，這樣就可以把連桿i-1和連

8、桿i之間的耦合力f,i-1,i,與關(guān)節(jié)力 聯(lián)系起來，其關(guān)系為,（4.4）,這里b,i-1,表示指向關(guān)節(jié)軸i方向的單位矢量。而a,T,b表示矢量a和b的內(nèi)積。方程(4.4)意味著執(zhí)行裝置承受的僅僅是f,i-1,i,沿關(guān)節(jié)軸方向的分量，而其它方向上的分量都是由關(guān)節(jié)結(jié)構(gòu)承受，這些耦合力分量是內(nèi)部的約束力，它們不做功。,對于旋轉(zhuǎn)關(guān)節(jié)，表示驅(qū)動力矩。這個驅(qū)動力矩與沿關(guān)節(jié)軸i方向的耦合力矩N,i-1,i,的分量平衡,其它的耦合力矩N,i-1,i,的分量由關(guān)節(jié)結(jié)構(gòu)承受，它們是無功的約束力矩。,（,4.5,）,圖4-4 滑移關(guān)節(jié)的耦合力和關(guān)節(jié)力,我們把全部關(guān)節(jié)力和關(guān)節(jié)力矩合在一起定義n維向量為,(,4.6,)

9、,我們稱 為關(guān)節(jié)力矩或力的矢量，或簡稱關(guān)節(jié)力矩。關(guān)節(jié)力矩表示執(zhí)行裝置對手臂連桿的輸入力矩。下面的定理給出了關(guān)節(jié)力矩 和末端力矢量F之間的關(guān)系。,定理 假設(shè)關(guān)節(jié)機(jī)械無摩擦，那么為產(chǎn)生任意的末端力F所需的關(guān)節(jié)力矩 為,這里J為6,n雅可比矩陣。它聯(lián)系著關(guān)節(jié)的微分位移dq和抓具的微分位移ds，即ds=J dq,在上述（4.7）式中，關(guān)節(jié)力矩中不包括重力矩或任何其它力矩。它們是與末端力和力矩平衡的凈力矩。我們稱方程（4.7）的 為與末端力F對應(yīng)的等效力矩。,（4.7）,4.3.1 柔順坐標(biāo)系的建立,為了便于描述柔順運(yùn)動的任務(wù)及對其進(jìn)行控制，需要定義一種新的正交坐標(biāo)系，我們稱它為柔順坐標(biāo)系(compli

10、ance frame)，有時也稱之為任務(wù)坐標(biāo)系或作業(yè)坐標(biāo)系(task frame)。在該坐標(biāo)系中，任務(wù)可以被描述成沿各個坐標(biāo)軸的位置控制和力的控制。對于其中的任何一個方向的自由度(沿三個正交軸的移動和繞三個軸的旋轉(zhuǎn)),或者要求是力的控制，或者是位置的控制，不可能在同一個自由度既進(jìn)行力的控制，又進(jìn)行位置的控制，二者必居其一。,4.3 柔順運(yùn)動控制的基本概念和方法,(1)黑板上寫字：這時柔順坐標(biāo)系的選擇如圖4-4所示.其中黑板平面即為柔順坐標(biāo)系的XcYc平面，Zc軸垂直于黑板平面,坐標(biāo)原點(diǎn)Oc可以選為黑板上固定的某一點(diǎn)，這時柔順坐標(biāo)系相對基坐標(biāo)是固定的。也可以選Oc為粉筆與黑板的接觸點(diǎn)，這時柔順坐

11、標(biāo)系是時不變的，它與基坐標(biāo)系及抓手坐標(biāo)系均無固定的關(guān)系。,圖4-4,黑板上寫字,當(dāng)機(jī)械手向黑板移動而尚未接觸到黑板時，這時6個自由度均為位置控制。由于這時機(jī)械手末端在空間是自由的，無任何反作用，因此無力的自由度。當(dāng)粉筆接觸到黑板時，這時沿Zc軸方向朝黑板的進(jìn)一步運(yùn)動受到限制，也即該方向的位置的自由度沒有了，而代之以力的自由度，也就是說這時可以控制沿Zc軸方向的壓力。如果粉筆被完全粘在黑板上,它既不能移動也不能轉(zhuǎn)動，這時只有力和力矩的自由度，而無任何位置的自由度。,(2)銷釘插孔，如圖4-5所示。在例中，柔順坐標(biāo)系坐標(biāo)系固定在銷釘上，其原點(diǎn)在銷釘軸上，Zc軸與銷釘?shù)闹行妮S相重合。這里沿著Zc軸方

12、向的移動及繞著Zc軸的轉(zhuǎn)動需要位置控制，而其余的自由度均為力或力矩控制。若抓手與銷釘之間無相對運(yùn)動，則柔順坐標(biāo)系與抓手坐標(biāo)系的關(guān)系是固定的。,圖4-5,銷釘插孔,(3)擰螺釘：如圖4-6所示。這時柔順坐標(biāo)系固定在螺釘上，原點(diǎn)Oc在螺釘?shù)妮S線上，Zc軸與螺釘軸重合。該柔順坐標(biāo)系與基坐標(biāo)系及抓手坐標(biāo)系均無固定的關(guān)系，而和被操作的物體具有固定的關(guān)系。在該例中，繞Zc軸的轉(zhuǎn)動及沿Yc方向的移動需要進(jìn)行位置控制，而其余自由度均需進(jìn)行力的控制。,圖4-6,擰螺釘,(4)轉(zhuǎn)動曲柄：如圖4-7所示。這時柔順坐標(biāo)系放置在曲柄的搖把上，Zc軸與搖把的軸重合，Xc軸指向曲柄的中心軸。這時繞著Zc軸的旋轉(zhuǎn)及沿Yc軸的

13、移動需要進(jìn)行位置控制，所有其它自由度均需進(jìn)行力的控制。在該例中，柔順坐標(biāo)系固定在曲柄上，因而相對基坐標(biāo)系或抓手坐標(biāo)系卻是不固定的。,圖4-7,轉(zhuǎn)動曲柄,(5)關(guān)門：如圖4-8所示。這時柔順坐標(biāo)系的原點(diǎn)放在門的鉸鏈軸上，Zc軸與鉸鏈軸重合，Xc軸與門的法線方向一致，該坐標(biāo)系隨門的轉(zhuǎn)動而轉(zhuǎn)動。這時除繞Zc軸的旋轉(zhuǎn)需進(jìn)行位置控制外，其余自由度均需進(jìn)行力的控制。,圖4-8,關(guān)門,通過以上例子可以看出，柔順坐標(biāo)系具有以下幾個特點(diǎn)：,(1)柔順坐標(biāo)系是正交坐標(biāo)系，利用它便于描述作業(yè)任務(wù)；,(2)一般來說，柔順坐標(biāo)系是時變的。但根據(jù)作業(yè)任務(wù)的不同，它可以是下面幾種情況的一種：,(a)柔順坐標(biāo)系相對基坐標(biāo)系是

14、固定的。如在黑板上寫字(圖4-4)時將其固定在黑板上的情況；,(b)柔順坐標(biāo)系相對于機(jī)械手末端的工具是固定的。如銷釘插孔(圖4-5)時將柔順坐標(biāo)系固定在銷釘上；,(c)柔順坐標(biāo)系相對于被操作的物體是固定的。如擰螺釘(圖4-6)、轉(zhuǎn)動曲柄(圖4-7)及關(guān)門(圖4-8)等情況；,(d)與任何預(yù)先定義的坐標(biāo)系均無固定的關(guān)系。如在黑板上寫字(圖4-4)時坐標(biāo)原點(diǎn)隨接觸點(diǎn)移動的情況。,4.3.2 自然約束和人為約束,在建立柔順坐標(biāo)系時已經(jīng)說到，柔順坐標(biāo)系的每個自由度或是位置控制，或是力控制，兩者必居其一。這說明，當(dāng)某個自由度是位置的自由度時，它必然受到力的約束，因此只能對它進(jìn)行位置的控制，而不能進(jìn)行力的

15、控制。反之亦然。這種位置和力的控制的對偶關(guān)系可以通過自然約束（natural constraints）和人為約束（artificial constraits）這兩個術(shù)語來描述。自然約束是由任務(wù)的幾何結(jié)構(gòu)所確定的約束關(guān)系。人為約束則是根據(jù)任務(wù)的要求人為給定的期望的運(yùn)動和力。下面對前面已列舉的5個例子給出具體的分析。,（1）黑板上寫字（圖4-4）：由于黑板的存在，沿軸方向的位置受到限制，這是自然約束。如果假定粉筆與黑板之間是無摩擦的，那么沿黑板切線方向的力必須為零，從而,f,z=0和,f,y=0也是兩個自然約束。繞三個軸也存在反抗力矩，因此mx=0、my=0和mz=0是另外三個自然約束。認(rèn)為約束包

16、括沿xc、yc方向的期望的運(yùn)動。最后歸納得到如下的結(jié)果：,自然約束：,人為約束：,在上面的約束中，所以關(guān)于位置的約束均用速度來表示。它比直接用位置表示更加明確，尤其是饒各個軸轉(zhuǎn)動的情況更是如此。對于每一個自由度來說，如果其位置是自然約束，那么力必然是人為約束：或者若力是自然約束，則相應(yīng)的位置必然為人為約束。因此，自然約束和人為約束的數(shù)目均等于柔順坐標(biāo)系的自由度數(shù)（一般為6）。,（2）銷釘插孔（圖4-5）按照與上面相類似的分析，可以列出該例中的自然約束和人為約束為：,自然約束：,人為約束：,（3）擰螺釘（圖4-6）,自然約束：,自然約束：,自然約束：,人為約束：,人為約束：,人為約束：,（4）轉(zhuǎn)動曲柄（圖4-7,）,（5）關(guān)門（圖4-8）,4.3.3 被動柔順和主動柔順,為了能在黑板上用粉筆寫字或?qū)N釘插入孔中，可以在機(jī)械手末端安裝包括有彈簧和阻尼的機(jī)械裝置。這樣可以使機(jī)械手具有柔順功能。這樣獲得的柔順功能稱為被動柔順（,passive compliance,）。圖4-9所示為一典型的被動柔順裝置，通常稱它為RCC(,Remote,Center Compliance,)。該裝置可以使得銷