《《機(jī)器人第四章》PPT課件.ppt》由會(huì)員分享，可在線閱讀，更多相關(guān)《《機(jī)器人第四章》PPT課件.ppt（58頁(yè)珍藏版）》請(qǐng)?jiān)谘b配圖網(wǎng)上搜索。

1、第四章 操作臂逆運(yùn)動(dòng)學(xué),4.1 概述 4.2 可解性 4.3 當(dāng)n<6時(shí)操作臂子空間的描述 4.4 代數(shù)解法與幾何解法 4.5 通過(guò)化簡(jiǎn)為多項(xiàng)式的解法 4.6 三軸相交的PIEPER解法（閱讀） 4.7 PUMA560機(jī)器人的逆運(yùn)動(dòng)學(xué)問(wèn)題（閱讀） 4.8 標(biāo)準(zhǔn)坐標(biāo)系 4.9 重復(fù)精度和定位精度 4.10 計(jì)算問(wèn)題,2,4.1 概述,操作臂的逆運(yùn)動(dòng)學(xué)：已知操作臂末端笛卡爾空間的位置和姿態(tài)，如何計(jì)算一系列滿足期望要求的關(guān)節(jié)角。,即已知齊次矩陣：H,求出滿足要求的關(guān)節(jié)變量：,3,4.2 可解性,求解操作臂的逆運(yùn)動(dòng)學(xué)是一個(gè)非線性方程。,對(duì)于PUMA560 中，旋轉(zhuǎn)矩陣生成9個(gè)方程，只有3個(gè)是獨(dú)立的

2、（因?yàn)檎痪仃囍挥腥齻€(gè)獨(dú)立參數(shù)）。再加上位置生成3個(gè)方程，共6個(gè)方程，6個(gè)未知數(shù)，是一個(gè)非線性超越方程。,對(duì)于PUMA560 中，有意義的方程一共12個(gè)。因?yàn)辇R次矩陣最后一行為0 0 0 1。,4,解的存在性,工作空間：操作臂末端執(zhí)行器所能達(dá)到的范圍。,靈巧工作空間：操作臂末端執(zhí)行器能夠從各個(gè)方向達(dá)到的空間區(qū)域。,可達(dá)工作空間：操作臂末端執(zhí)行器至少?gòu)囊粋€(gè)方向有一個(gè)方位可以達(dá)到的空間區(qū)域。,靈巧工作空間是可達(dá)工作空間的一個(gè)子集。,5,如果 可達(dá)工作空間為半徑為 的圓。而靈巧工作空間僅為單獨(dú)的一點(diǎn)（圓心）。,如果 則不存在靈巧工作空間，而可達(dá)空間為半徑為 的圓環(huán)。,如

3、果 ，而 ，則工作空間同上（圓環(huán)）而此時(shí)僅有一個(gè)方位可以達(dá)到工作空間的每一點(diǎn)。,當(dāng)一個(gè)操作臂少于6個(gè)自由度時(shí)，它在3維空間內(nèi)不可能達(dá)到全部位姿（因?yàn)橹辽傩枰?個(gè)自由度）。上圖中操作臂不能伸出平面，因此凡是Z坐標(biāo)不為0的點(diǎn)均不可達(dá)。,6,一個(gè)值得研究的問(wèn)題是：對(duì)于少于6個(gè)自由度的操作臂，它的工作空間是什么？給定一個(gè)確定的一般坐標(biāo)系，什么是最近的可達(dá)目標(biāo)坐標(biāo)系。,用戶關(guān)心的是工具坐標(biāo)系T的工作空間，而一般常去研究腕部坐標(biāo)系W的工作空間。我們研究的工作空間和用戶關(guān)心的工作空間是有區(qū)別的。但問(wèn)題的實(shí)質(zhì)是一樣的，即操作臂的逆運(yùn)動(dòng)學(xué)問(wèn)題（Inverse Kinematics）。,如果

4、腕部坐標(biāo)系的期望位姿在這個(gè)工作空間內(nèi)，那么至少存在一個(gè)解。,7,對(duì)于三連桿平面操作臂，虛線表示第二個(gè)解。此問(wèn)題存在兩個(gè)解。,多重解問(wèn)題（解的唯一性問(wèn)題）,8,對(duì)于多解問(wèn)題，應(yīng)選擇最小行程解。例如處于A點(diǎn)想要達(dá)到B點(diǎn)，就選擇上部虛線。這樣相當(dāng)于對(duì)逆運(yùn)動(dòng)學(xué)程序中輸入一個(gè)小的位移即可。,最小行程解可能有幾種確定方式。例如，有3個(gè)大的連桿，附帶有3個(gè)小的連桿。選擇側(cè)重于小的連桿，而不是大的連桿。但有障礙物的情況下，只能選擇較長(zhǎng)行程解。,9,解的個(gè)數(shù)取決于操作臂的關(guān)節(jié)數(shù)量，它是連桿參數(shù)和關(guān)節(jié)運(yùn)動(dòng)范圍的函數(shù)。,PUMA560機(jī)器人到達(dá)一個(gè)確定目標(biāo)有8個(gè)不同的解，下圖列出4個(gè)解，另外4個(gè)是：,10,連桿的非

5、零參數(shù)越多，達(dá)到某一特定目標(biāo)的方式越多；對(duì)于一個(gè)全部為旋轉(zhuǎn)關(guān)節(jié)的6自由度操作臂來(lái)說(shuō)，可能多大16種解。,11,解法,如果關(guān)節(jié)變量能夠通過(guò)一種算法確定，這種算法可以求出與已知位姿相關(guān)的全部關(guān)節(jié)變量，稱操作臂是可解的。,解法分為兩大類： （1）封閉解：有限次初等運(yùn)算得到的解； （2）數(shù)值解：經(jīng)過(guò)迭代得到的解。,12,封閉解又稱解析解，可以分為： （1）代數(shù)法 （2）幾何法,所有包含旋轉(zhuǎn)關(guān)節(jié)和移動(dòng)關(guān)節(jié)串連型6自由度機(jī)構(gòu)是可解的。但一般為數(shù)值解。只有在極少情況下存在解析解。存在解析解的操作臂具有如下特性：存在幾個(gè)正交軸或平行軸。 數(shù)值解一般比解析解耗時(shí)，因此在操作臂虛擬設(shè)計(jì)應(yīng)該考慮這個(gè)問(wèn)題。,具有6個(gè)

6、旋轉(zhuǎn)關(guān)節(jié)的操作臂存在封閉解的充分條件是相鄰的三個(gè)關(guān)節(jié)軸相交于一點(diǎn)。,13,4.3 當(dāng)n<6時(shí)操作臂子空間的描述,對(duì)于一個(gè)n自由度操作臂（n<6）,可達(dá)工作空間可看成是n自由度子空間的一部分。下圖為3R操作臂的子空間,式中x,y給出了腕關(guān)節(jié)的位置， 給出了末端連桿的姿態(tài)。當(dāng)x,y和 可以取任意值時(shí)，就得到了子空間。,14,例：如下圖給出兩自由度極坐標(biāo)操作臂 的子空間,解：一旦給定了x,y， 的方向也就確定了， 的方向向下，從而根據(jù)右手規(guī)則：,已知：,15,現(xiàn)在：,根據(jù)第二章旋轉(zhuǎn)矩陣的寫法：,則齊次矩陣為：,16,得到：,對(duì)于具有n個(gè)自由度操作臂的目標(biāo)點(diǎn)進(jìn)行定義，通常采用n個(gè)參數(shù)來(lái)確定這個(gè)目標(biāo)點(diǎn)

7、。也就是說(shuō)，確定的目標(biāo)點(diǎn)有6個(gè)自由度，一般自由度n<6的操作臂是無(wú)法達(dá)到這個(gè)目標(biāo)點(diǎn)的，在這種情況下，可尋找一個(gè)位于操作臂子空間內(nèi)的可達(dá)目標(biāo)點(diǎn)代替原目標(biāo)點(diǎn)，并且和原目標(biāo)點(diǎn)盡可能接近。,17,4.4 代數(shù)解法和幾何解法,代數(shù)解法 以3R操作臂為例,18,19,由于是平面操作臂，其變換形式只能是這種形式：,現(xiàn)在的問(wèn)題是：已知上述矩陣，并令和上述矩陣相等，如何求：,20,首先寫出矩陣元素對(duì)應(yīng)方程：,最后兩行平方相加：,利用下述公式：,21,得到,這要求上式右端的值在-1和1之間（利用這個(gè)約束可以檢查解是否存在）。便可求得正弦值：,這樣就得到,下面求,22,首先展開最后兩個(gè)等式：,其中：,作如下的變換,

8、則有：,4.1,23,代入,再根據(jù)余弦、正弦倍角公式：,再根據(jù)帶象限的反正切公式：,24,這樣就得到,利用前兩個(gè)等式，得到,由于 已經(jīng)求出，這樣就得到,這相當(dāng)于操作臂的逆運(yùn)動(dòng)學(xué)逆問(wèn)題就解決了。,25,幾何解法,求解方法是：將操作臂的空間 幾何參數(shù)分解成平面幾何參數(shù)。 然后應(yīng)用平面幾何方法進(jìn)行求解。,本例為3R操作臂，連桿在同一 平面內(nèi)，可以直接進(jìn)行求解。,本例連桿 、連桿 以及坐標(biāo)系0和坐標(biāo)系3的連線構(gòu)成一三角形，虛線表示另外一種情況。根據(jù)余弦定理：,注意，夾角的計(jì)算。,26,利用,得到,為了要求構(gòu)成三角形，即要求：,必須滿足條件：,取值范圍為：,上述方程的另外一個(gè)解為：,這樣就求得了,27

9、,下面求,根據(jù)圖，利用反正切公式和余弦公式可知,因?yàn)槭侨切蔚膬?nèi)角，規(guī)定,就得到：,其中正負(fù)號(hào)的取值和 的取值相對(duì)應(yīng) ：,上式取+,上式取-,28,平面內(nèi)的旋轉(zhuǎn)角度是可以相加的，因此,而,這樣就求得 。,29,4.5 通過(guò)化簡(jiǎn)為多項(xiàng)式的解法,把超越方程變換為代數(shù)方程,利用萬(wàn)能公式：,就可以化為多項(xiàng)式方程。,30,例：求解下述方程：,按照上述公式展開：,化簡(jiǎn),解得,得到：,31,如果,對(duì)于4次（或低于4次）的多項(xiàng)式一定存在封閉解，可以用4次（或低于4次）的多項(xiàng)式方程求解的操作臂，稱為封閉操作臂。,32,4.6 三軸相交的PIEPER解法,Pieper研究了3軸（最后三個(gè)軸）相交于一點(diǎn)的6R

10、操作臂。,最后三個(gè)軸456相交于一點(diǎn).,利用D-H參數(shù) 上述只利用了平移，沒(méi)有旋轉(zhuǎn)，所以沒(méi)有出現(xiàn)角度,33,進(jìn)一步計(jì)算得到：,利用D-H參數(shù)展開得：,式中：,34,現(xiàn)在寫出： 平方的表達(dá)式： 可以看出：,再一次利用D-H參數(shù)展開得：,式中：,35,得到：,寫出r和z方向的方程：,式中：,36,現(xiàn)在求解,（1） 僅為 的函數(shù)，可 以用萬(wàn)能公式求解。,（2） ，再次利用 萬(wàn)能公式進(jìn)行求解。,（3）否則，消除 得到：,利用萬(wàn)能公式，得到一個(gè)四次方程。進(jìn)而可以求解。,37,現(xiàn)在已經(jīng)求解出：,再根據(jù)：,求出：,再根據(jù)：,求出：,這

11、樣就求出：,38,現(xiàn)在求解：,因?yàn)? 已經(jīng)求出，所以 可以求出。,從而,求出。 這是一個(gè)3個(gè)Euler角 的旋轉(zhuǎn)矩陣,根據(jù)第二章,便可求出：,39,4.7 PUMA560機(jī)器人的逆運(yùn)動(dòng)學(xué)問(wèn)題,當(dāng)PUMA560 已知，通過(guò)下列方程,求解：,40,將含有 的部分移到方程的左邊：,將 轉(zhuǎn)置，得到：,令上述等式的元素（2，4）相等，在（313）中為： ，這樣得到：,41,利用三角恒等變換：,式中,因此,即,42,從而得到,因此,因此 的解為：,43,平方相加并且和課本（457）平方相加，得到,現(xiàn)在 已知。令課本式（456）中元素（1，4）和（3，4）元素

12、相等（注意課本（313）中的表達(dá)式）,其中,44,采用同樣的方法，得到 的解：,重新整理（454），使公式左邊只含有 為變量,即,45,式中 由第3章的式（311）確定。令上式兩邊的元素（1，4）和元素（2，4）相等，得到,聯(lián)立方程得：,46,上式分母相等，且均為正數(shù)，則：,根據(jù) 和 解的4種可能，根據(jù)上式計(jì)算 4個(gè)值：,令課本（457）中兩邊的元素（1，3）和（3，3）分別相等，得,47,只要 ，便可得出,當(dāng) 時(shí)，操作臂處于奇異位形，此時(shí)關(guān)節(jié)軸4和關(guān)節(jié)軸6成一條直線，機(jī)器人末端連桿的運(yùn)動(dòng)只有一種。在這種情況下，所有結(jié)果（所有可能的解）都是 和 的和或

13、差.,注意上式要求 ，即要求：,改寫式（454），使公式左邊均為已知的函數(shù)：,由下式給出,48,令（477）兩邊的元素（1，3）和元素（3，3）分別相等，得到，,由此可以得出,49,令（481）兩邊的元素（1，1）和元素（3，1）分別相等，得到：,再次利用上述方法，可以計(jì)算出 ，并將（454）寫成如下的形式：,式中：,50,由于在式（464）和式（468）中出現(xiàn)了 號(hào) ，因此這些方程可能有4種解。另外由于操作臂的翻轉(zhuǎn)可得到另外4種解，由腕關(guān)節(jié)的翻轉(zhuǎn)可得到,當(dāng)計(jì)算出所有8種答案以后，由于關(guān)節(jié)運(yùn)動(dòng)范圍的限制要將其中的一些解（甚至全部）舍去。在余下的有效解中，通常選取一個(gè)最接近

14、于當(dāng)前操作臂的解。,51,52,4.8 標(biāo)準(zhǔn)坐標(biāo)系,基坐標(biāo)系B 工作臺(tái)坐標(biāo)系S 腕坐標(biāo)系W 工具坐標(biāo)系T 目標(biāo)坐標(biāo)系G,53,1 由用戶確定工作臺(tái)坐標(biāo)系的位置，這個(gè)坐標(biāo)系可能在工作臺(tái)的角點(diǎn)上。工作臺(tái)坐標(biāo)系S是相對(duì)于基坐標(biāo)系B定義的。,54,2 由用戶確定工具坐標(biāo)系T。以不同的方式抓持相同的工具，工具坐標(biāo)系T的定義是不同的。工具坐標(biāo)系T是相對(duì)于腕坐標(biāo)系W定義的。,3 由用戶確定目標(biāo)坐標(biāo)系G。在許多系統(tǒng)中，工具坐標(biāo)系定義 是一個(gè)常量。,4 機(jī)器人運(yùn)動(dòng)需要計(jì)算一系列關(guān)節(jié)角，工具坐標(biāo)系從初始位置運(yùn)動(dòng)到T=G時(shí)結(jié)束。,55,4.9 操作臂求解,SOLVE可以作為逆運(yùn)動(dòng)學(xué)函數(shù)， SOLVE利用工具坐標(biāo)系

15、和工作臺(tái)坐標(biāo)系的定義來(lái)計(jì)算W相對(duì)于B的位置,然后，逆運(yùn)動(dòng)學(xué)將 作為輸入，計(jì)算 。,56,4.10 重復(fù)精度和定位精度,定位精度是指：操作臂實(shí)際達(dá)到的位置與目標(biāo)位置之差。,重復(fù)定位精度是指：操作臂重復(fù)定位于目標(biāo)位置的能力。,示教點(diǎn)：操作臂運(yùn)動(dòng)實(shí)際達(dá)到的點(diǎn)。,計(jì)算點(diǎn)：從未示教的點(diǎn)。,受D-H參數(shù)的影響。,57,4.11 計(jì)算問(wèn)題,求解關(guān)節(jié)角度的能力實(shí)際上是機(jī)器人控制系統(tǒng)的核心問(wèn)題。,在許多路徑控制方法中，需要以相當(dāng)高的速率計(jì)算操作臂的逆運(yùn)動(dòng)學(xué)問(wèn)題。比如30Hz，有的甚至更快。,（1）Atan2用查表法進(jìn)行計(jì)算； （2）用并行計(jì)算算出所有解； （3）多于多解問(wèn)題，計(jì)算第一個(gè)解相當(dāng)費(fèi)時(shí)，但通過(guò)計(jì)算角度的和或差以及加減pi等方法可以很快得到其余的解。,58,第四章習(xí)題,課本pp104105：Matlab習(xí)題,