第四章 操作臂逆運動學(xué)【（一）4.1-4.11】

（一）概述

1、為求出要求的關(guān)節(jié)角以放置相對于工作臺坐標(biāo)系{S}的工具坐標(biāo)系{T}，可將這個問題分為兩部分（1）進(jìn)行坐標(biāo)變換求出相對于基坐標(biāo){B}的腕部坐標(biāo)系{W}。（2）應(yīng)用逆運動學(xué)求關(guān)節(jié)角。

（二）可解性

1、解的存在性

（1）解是否存在完全取決于操作臂的工作空間。工作空間十操作臂末端執(zhí)行器所能到達(dá)的范圍，若解存在，則被制定的目標(biāo)點必須在工作空間內(nèi)。

（2）工作空間分為靈巧工作空間和可達(dá)工作區(qū)間。前者指機(jī)器人的末端執(zhí)行器能夠從各個方向到達(dá)的空間區(qū)域，即可以從任意方向到達(dá)靈巧工作空間的每一個點。后者至至少從一個方向上有一個方位可以達(dá)到的空間。顯然，靈巧工作空間十可達(dá)工作空間的子集。

2、多重解問題

（1）解的個數(shù)取決于操作臂的關(guān)節(jié)數(shù)量，也是連桿參數(shù)（

）

（2）通常，連桿的非零參數(shù)越多，達(dá)到某一特定目標(biāo)的方式也越多。對于一個全部為旋轉(zhuǎn)關(guān)節(jié)的6自由度操作臂來說，可能多達(dá)16種解

（3）再給這個積木一個鏡頭！簡單易懂

country：機(jī)器人學(xué)---第四章?zhuanlan.zhihu.com

（1）與線性方程組不同，非線性方程組沒有通用的求解算法，最好對已知操作臂“解”的構(gòu)成形式加以定義。

（2）操作臂的求解方法分為兩類：分閉解法和數(shù)值解法。

（3）數(shù)值解法的迭代性質(zhì)，導(dǎo)致他要比封閉解法求解速度慢很多，所以一般不用。

（4）分閉形式，指基于解析形式的解法，或者意指對于不高于四次的多項式不用迭代便可完全求解。封閉解的求解方法分為兩類，代數(shù)法和幾何法。有時它們的區(qū)別不明顯，任何幾何方法中都引入了代數(shù)描述，這兩種方法的區(qū)別或許僅是求解過程的不同。

（5）所有包含轉(zhuǎn)動關(guān)節(jié)和移動關(guān)節(jié)的串聯(lián)型6自由度機(jī)構(gòu)均是可解的。但這種解一般是數(shù)值解。對于6自由度機(jī)器人來說，只有在特殊情況下才有解析解。

（6）存在封閉解的充要條件是，相鄰的三個關(guān)節(jié)軸線相交于一點。

（三）當(dāng)n＜6時操作臂子空間的描述

1、對于一個n自由度操作臂（n＜6），可達(dá)工作空間可看成是n自由度子空間的一部分。如圖4-1中，兩連桿機(jī)器人的子空間時一個平面，其工作空間時該平面的一個子集，即當(dāng)

時，為一個半徑為 的圓。

2、對于少于6個自由度的操作臂來說，當(dāng)確定一般目標(biāo)點時，求解方法如下

（四）代數(shù)解法與幾何解法

用代數(shù)和幾何兩種方法對一個簡單的平面三連桿操作臂進(jìn)行求解

注解：

1、代數(shù)解法：共5步驟

（1）建立方程式

（2）解

（3）將求得的

代入方程式

（4）變數(shù)變換

（5）求解

及 。

（6）三角函數(shù)方程式求解

2、幾何解

（1）將空間幾何切割成平面幾何

（五）通過化簡為多項式的代數(shù)解法

（六）三軸相交的PIEPER解法

略過，描述了如何證明，6個關(guān)節(jié)均為旋轉(zhuǎn)關(guān)節(jié)，且后面3個軸相交的操作臂。具有分閉解。

具體可看下面鏈接：有詳細(xì)推導(dǎo)公式

country：機(jī)器人學(xué)---第四章?zhuanlan.zhihu.com

（七）操作臂逆運動學(xué)實例

1、The Unimation PUMA 560機(jī)器人。共8種答案

2、Yasukawa Motoman L-3型機(jī)器人

Motoman L-3與PUMA機(jī)器人有三個不同特征，

（1）操作臂只有五個關(guān)節(jié)，因此它的末端執(zhí)行器的位姿不能保證達(dá)到一般目標(biāo)坐標(biāo)系

（2）這種四桿機(jī)構(gòu)以及鏈傳動方式使得一個驅(qū)動器需要同時驅(qū)動兩個甚至更多關(guān)節(jié)。

（3）驅(qū)動器的運動范圍不是常數(shù)，而是取決于其他啟動器的位置，因此判斷一組驅(qū)動器運動是否在某一范圍內(nèi)是沒有意義的。

其余略過

（八）標(biāo)準(zhǔn)坐標(biāo)系

在一般的機(jī)器人系統(tǒng)中，我們按照如下方法應(yīng)用這些坐標(biāo)系

1、由用戶確定系統(tǒng)中工作臺坐標(biāo)系{S}的位置。它是相對于基坐標(biāo)系{B}定義的。

2、用戶通過規(guī)定坐標(biāo)系{T}給出機(jī)器人所用工具的描述。對于每種末端執(zhí)行器，機(jī)器人抓持的每一種工具都應(yīng)當(dāng)有一個相應(yīng)的工具坐標(biāo)系{T}。注意，以不同的方式抓取相同的工具，工具坐標(biāo)系{T}的定義是不同的。工具坐標(biāo)系{T}是相對于腕部坐標(biāo)系{W}定義的，即

。

3、用戶通過給定目標(biāo)坐標(biāo)系{G}相對于工作臺坐標(biāo)系的描述來指定機(jī)器人運動的目標(biāo)點。{T}和{S}的定義經(jīng)常保持不變，這時，用戶僅需給出一系列{G}的規(guī)定。工具坐標(biāo)系

一般是常量。

4、機(jī)器人系統(tǒng)需要計算一系列關(guān)節(jié)角度使關(guān)節(jié)一次運動，工具坐標(biāo)系{T}從初始位置以連續(xù)方式運動，直至{T}={G}時運動結(jié)束

（九）操作臂求解

（十）重復(fù)精度和定位精度

1、示教點，指操作臂運動實際達(dá)到的點，然后關(guān)節(jié)位置傳感器讀取關(guān)節(jié)角并存儲。

2、當(dāng)制造商在確定操作臂返回示教點的精度時，就是在確定操作臂的重復(fù)精度。

3、計算點，對于可以將目標(biāo)位置描述為笛卡爾坐標(biāo)的系統(tǒng)，它可以將操作臂移動到工作空間中一個從未示教過的點，這些點或許以前從未到達(dá)過，這些點稱為計算點。

4、到達(dá)某個計算點的精度稱為操作臂的定位精度。

5、操作臂的定位精度收到重復(fù)精度的影響，且受到運動學(xué)方程中參數(shù)精度的影響。因此一般重復(fù)精度非常好，但定位精度較差。標(biāo)定技術(shù)能通過對操作臂運動學(xué)參數(shù)的估計提高定位精度

（十一）計算問題

---

例4.1

試描述第三章中圖3-6所示三連桿操作臂

的子空間。

解答：{W}為腕關(guān)節(jié)坐標(biāo)系，{B}基坐標(biāo)系

例4.2

試描述圖4-6所示兩自由度極坐標(biāo)操作臂

的子空間。

解答：

例4.3

將超越方程

變換成含有半角正切的一次多項式，以求解 。

解答：利用萬能公式即可求解

由于原來的超越方程可能不存在實根，因此

是很復(fù)雜的。注意，若 ，自變量反正切值將無窮大，因此 ，所以應(yīng)該預(yù)先檢查是否為0。

當(dāng)（4-38）中二次項消除后，這個二次方程就簡化為線性方程。四次多項式便具有封閉形式的解，所以用4階（或低于4階）的代數(shù)方程求解操作臂是簡單的。稱為分閉解操作臂。

至P99

總結(jié)

以上是生活随笔為你收集整理的利用逆矩阵解线性方程组_机器人学导论---第四章 操作臂逆运动学（一）4.1-4.11...的全部內(nèi)容，希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網(wǎng)站內(nèi)容還不錯，歡迎將生活随笔推薦給好友。