《機(jī)器人技術(shù)概論》講義

1、 機(jī)器人技術(shù)概論講義目錄第一章 機(jī)器人概論 . . - 1 -機(jī)器人概論研究的內(nèi)容 . . - 1 - 什么是機(jī)器人？ . . - 1 - 機(jī)器人的發(fā)展 . . - 2 - 為什么要發(fā)展機(jī)器人？ . . - 3 - 機(jī)器人發(fā)展的三個(gè)階段 . . - 3 - 機(jī)器人學(xué) . . - 4 - 機(jī)器人的分類 . . - 4 -第二章 機(jī)器人的數(shù)學(xué)基礎(chǔ) . . - 6 -第一節(jié) 位置和姿態(tài)的表示 . . - 6 -第二節(jié) 坐標(biāo)變換 . . - 7 -第三節(jié) 齊次變換 . . - 8 -第三章 機(jī)器人運(yùn)動(dòng)學(xué) . . - 11 -第一節(jié) 機(jī)器人運(yùn)動(dòng)方程的表示 . . - 11 -第二節(jié) 連桿變換矩陣及其乘積

2、 . . - 12 -第四章 機(jī)器人的感覺系統(tǒng) . . - 18 -第一節(jié) 傳感器原理簡(jiǎn)介 . . - 18 -第二節(jié) 傳感器在機(jī)器人中的應(yīng)用 . . - 20 -第五章 機(jī)器人驅(qū)動(dòng)與控制技術(shù) . . - 28 -第一節(jié) 驅(qū)動(dòng)電機(jī) . . - 28 -第二節(jié) 位置控制 . . - 30 -第六章 機(jī)器人軌跡規(guī)劃 . . - 35 -第一節(jié) 軌跡規(guī)劃的一般性問題 . . - 35 -第二節(jié) 關(guān)節(jié)軌跡的插值 . . - 35 -第三節(jié) 移動(dòng)機(jī)器人路徑規(guī)劃 . . - 38 -機(jī)器人技術(shù)概論講義- 1 - 第一章 機(jī)器人概論機(jī)器人概論研究的內(nèi)容在機(jī)器人研究中，我們通常在三維空間中研究物體的位置。這些

3、物體可用兩個(gè)非常重要的特性來描述：位置和姿態(tài)。我們會(huì)首先研究如何用數(shù)學(xué)的方法表示和計(jì)算這些參量。運(yùn)動(dòng)學(xué)研究物體的運(yùn)動(dòng)，而不考慮引起這種運(yùn)動(dòng)的力。在運(yùn)動(dòng)學(xué)中，我們研究位置、速度、加速度和位置變量對(duì)于時(shí)間和其它變量的高階微分。其中，正運(yùn)動(dòng)學(xué)方程描述各個(gè)關(guān)節(jié)變量在工具坐標(biāo)系與基坐標(biāo)系間的函數(shù)關(guān)系；逆運(yùn)動(dòng)學(xué)通過給定工具坐標(biāo)系的位置和姿態(tài)，計(jì)算各個(gè)關(guān)節(jié)變量。機(jī)器人與外界環(huán)境相互作用時(shí)，在接觸的地方要產(chǎn)生力 和力矩 ，統(tǒng)稱為操作力矢量。n 個(gè)關(guān)節(jié)的驅(qū)動(dòng)力（或力矩）組成的n 維矢量，稱為關(guān)節(jié)力矢量。靜力學(xué)研究在靜態(tài)平衡狀態(tài)下，操作力向關(guān)節(jié)力映射存在著的線性關(guān)系。動(dòng)力學(xué)主要研究產(chǎn)生運(yùn)動(dòng)所需要的力。為了使操作臂

4、從靜止開始加速，使末端執(zhí)行器以一定的速度作直線運(yùn)動(dòng)，最后減速停止，必須通過關(guān)節(jié)驅(qū)動(dòng)器產(chǎn)生一組復(fù)雜的力矩函數(shù)來實(shí)現(xiàn)。機(jī)器人的感覺主要介紹產(chǎn)生機(jī)器人的力覺、視覺、觸覺、接近覺等相關(guān)的傳感器。機(jī)器人的控制在前面的基礎(chǔ)上設(shè)計(jì)位置控制系統(tǒng)，討論控制算法及給機(jī)器人編程等。什么是機(jī)器人？一般的理解：機(jī)器人是具有一些類似人的功能的機(jī)械電子裝置或者叫自動(dòng)化裝置，它是個(gè)機(jī)器。特點(diǎn)： 有類人的功能。作業(yè)功能；感知功能；行走功能；能完成各種動(dòng)作. 根據(jù)人的編程能自動(dòng)的工作。通過編程改變它的工作、動(dòng)作、工作的對(duì)象和工作的一些要求。 是人造的機(jī)器或機(jī)械電子裝置，仍然是個(gè)機(jī)器機(jī)器人的定義：機(jī)器人學(xué)是一門不斷發(fā)展的科學(xué)，上世

5、紀(jì)60年代，可實(shí)用機(jī)械機(jī)器人被稱為工業(yè)機(jī)器人；上世紀(jì)80年代到現(xiàn)在，正越來越向智能化方向發(fā)展。因此，對(duì)機(jī)器人的定義也隨其發(fā)展而變化。國(guó)際上對(duì)機(jī)器人的定義很多：The Webster dictionary (Webster, 1993 ：“An automatic device that performs functions normally ascribed to humans or a machine in the form of a human.” 一個(gè)自動(dòng)化設(shè)備，它能執(zhí)行通常由人執(zhí)行的任務(wù)；或一個(gè)人型的機(jī)器美國(guó)機(jī)器人學(xué)會(huì)（The Robot Institute of America，19

6、79 ：“A reprogrammable, multifunctional manipulator designed to move materials, parts, tools, or specialized devices through various programmed motions for the performance of a variety of tasks.” 一個(gè)可再編程的多功能操作器，用來移動(dòng)材料、零部件、工具等；或一個(gè)通過編程用于完成各種任務(wù)的專用設(shè)備。ISO ，1987：工業(yè)機(jī)器人是一種具有自動(dòng)控制的操作和移動(dòng)功能，能完成各種作業(yè)的可編程操作機(jī)。從完整的更為深

7、遠(yuǎn)的機(jī)器人定義來看，應(yīng)該更強(qiáng)調(diào)機(jī)器人智能，因此，機(jī)器人的定義是能夠感知環(huán)境，能夠有學(xué)習(xí)、情感和對(duì)外界一種邏輯判斷思維的機(jī)器。機(jī)器人是一種計(jì)算機(jī)控制的可以編程的自動(dòng)機(jī)械電子裝置，能感知環(huán)境，識(shí)別對(duì)象，理解指示命令，有記憶和學(xué)習(xí)功能，具有情感和邏輯判斷思維，能自身進(jìn)化，能計(jì)劃其操作程序來完成任務(wù)。機(jī)器人技術(shù)是集機(jī)械學(xué)、力學(xué)、電子學(xué)、 生物學(xué)、控制論、人工智能、系統(tǒng)工程等多種學(xué)科于一體的綜合性很強(qiáng)的新技術(shù)機(jī)器人的發(fā)展1954年，美國(guó)人G .Devol 和J.Engleberger 設(shè)計(jì)了一臺(tái)可編程的機(jī)器人 1961年，他們生產(chǎn)了世界上第一臺(tái)工業(yè)機(jī)器人“Unimates ”，并獲得了專利 1962年，

8、Engleberger 成立了Unimation 公司，他被稱為“機(jī)器人之父” 日本從上世紀(jì)70年代中后期開始開發(fā)工業(yè)機(jī)器人，15年后就成為產(chǎn)量最多、應(yīng)用最廣的世界工業(yè)機(jī)器人“王國(guó)”。1978年 美國(guó)Unimation 公司推出通用工業(yè)機(jī)器人PUMA ，這標(biāo)志著工業(yè)機(jī)器人技術(shù)已經(jīng)完全成熟。PUMA 至今仍然工作在工廠第一線。1984年 英格伯格再推機(jī)器人Helpmate ，這種機(jī)器人能在醫(yī)院里為病人送飯、送藥、送郵件。同年，他還預(yù)言：“我要讓機(jī)器人擦地板，做飯，出去幫我洗車，檢查安全”。1998年 丹麥樂高公司推出機(jī)器人(Mind-storms套件，讓機(jī)器人制造變得跟搭積木一樣，相對(duì)簡(jiǎn)單又能任

9、意拼裝，使機(jī)器人開始走入個(gè)人世界。1999年 日本索尼公司推出犬型機(jī)器人愛寶(AIBO，當(dāng)即銷售一空，從此娛樂機(jī)器人成為目前機(jī)器人邁進(jìn)普通家庭的途徑之一。2002年 丹麥iRobot 公司推出了吸塵器機(jī)器人Roomba ，它能避開障礙，自動(dòng)設(shè)計(jì)行進(jìn)路線，還能在電量不足時(shí)，自動(dòng)駛向充電座。Roomba 是目前世界上銷量最大、最商業(yè)化的家用機(jī)器人。2006年 6月，微軟公司推出Microsoft Robotics Studio ，機(jī)器人模塊化、平臺(tái)統(tǒng)一化的趨勢(shì)越來越明顯，比爾蓋茨預(yù)言，家用機(jī)器人很快將席卷全球主要機(jī)器人廠家日本：Motoman 、OTC 、Panasonic 、FANUC 等 美國(guó)

10、：Adept 等歐洲：奧地利IGM 、德國(guó)CLOOS 、KUKA 、瑞典ABB 韓國(guó)：HYUNDAI沈陽新松 首鋼莫托曼 上海ABB為什么要發(fā)展機(jī)器人？簡(jiǎn)單說，機(jī)器人有三個(gè)方面是我們必要去發(fā)展的理由：一個(gè)是機(jī)器人做人不愿意做的事，把人從有毒的、有害的、高溫的或危險(xiǎn)的，這樣的環(huán)境中解放出來，機(jī)器人可以做人做不好的活，比方說在汽車生產(chǎn)線上工人天天拿著一百多公斤的焊鉗，一天焊幾千個(gè)點(diǎn)，做重復(fù)性的勞動(dòng)，一方面他很累，但是產(chǎn)品的質(zhì)量仍然很低；另一方面機(jī)器人做人做不了的活，這也是非常重要的機(jī)器人發(fā)展的一個(gè)理由，比方說人們對(duì)太空的認(rèn)識(shí)，人上不去的時(shí)候，叫機(jī)器人上天，上月球，以及到海洋，進(jìn)入到人體的小機(jī)器人，

11、以及在微觀環(huán)境下，對(duì)原子分子進(jìn)行搬遷的機(jī)器人，都是人們不可達(dá)的工作。上述方面的三個(gè)問題，也就是說機(jī)器人發(fā)展的三個(gè)理由。機(jī)器人發(fā)展的三個(gè)階段第一代機(jī)器人，也叫示教再現(xiàn)型機(jī)器人，它是通過一個(gè)計(jì)算機(jī)，來控制一個(gè)多自由度的一個(gè)機(jī)械，通過示教存儲(chǔ)程序和信息，工作時(shí)把信息讀取出來，然后發(fā)出指令，機(jī)器人可以重復(fù)的根據(jù)人當(dāng)時(shí)示教的結(jié)果，再現(xiàn)出這種動(dòng)作，比方說汽車的點(diǎn)焊機(jī)器人，它只要把這個(gè)點(diǎn)焊的過程示教完以后，它總是重復(fù)這樣一種工作，它對(duì)于外界的環(huán)境沒有感知，這個(gè)力操作力的大小，這個(gè)工件存在不存在，焊的好與壞，它并不知道，第一代機(jī)器人存在這種缺陷。在20世紀(jì)70年代后期，人們開始研究第二代機(jī)器人，叫帶感覺的機(jī)器

12、人，這種帶感覺的機(jī)器人是類似人在某種功能的感覺，比如說力覺、觸覺、滑覺、視覺、聽覺和人進(jìn)行相類比，有了各種各樣的感覺，比方說在機(jī)器人抓一個(gè)物體的時(shí)候，它實(shí)際上力的大小能感覺出來，它能夠通過視覺，能夠去感受和識(shí)別它的形狀、大小、顏色。抓一個(gè)雞蛋，它能通過一個(gè)觸覺，知道它的力的大小和滑動(dòng)的情況。第三代機(jī)器人，是機(jī)器人學(xué)中一個(gè)理想的所追求的最高級(jí)的階段，叫智能機(jī)器人，只要告訴它做什么，不用告訴它怎么去做，它就能完成運(yùn)動(dòng)，感知思維和人機(jī)通訊的這種功能和機(jī)能，這個(gè)目前的發(fā)展還是相對(duì)的只是在局部有這種智能的概念和含義，但真正完整意義的這種智能機(jī)器人實(shí)際上并沒有存在，而只是隨著我們不斷的科學(xué)技術(shù)的發(fā)展，智能

13、的概念越來越豐富，它內(nèi)涵越來越寬。機(jī)器人學(xué)（1）機(jī)器人基礎(chǔ)理論與方法，如運(yùn)動(dòng)學(xué)和動(dòng)力學(xué)，作業(yè)與運(yùn)動(dòng)規(guī)劃、控制與感知理論與技術(shù)、機(jī)器人智能。（2）機(jī)器人設(shè)計(jì)理論與技術(shù)，機(jī)器人機(jī)構(gòu)分析和綜合、機(jī)器人結(jié)構(gòu)設(shè)計(jì)優(yōu)化、機(jī)器人關(guān)鍵器件設(shè)計(jì)、機(jī)器人仿真等。（3）機(jī)器人仿生學(xué)，仿生運(yùn)動(dòng)和動(dòng)力學(xué)、仿生機(jī)構(gòu)學(xué)、仿生感知和控制理論、仿生器件設(shè)計(jì)和制造等（4）機(jī)器人系統(tǒng)理論，多機(jī)器人系統(tǒng)理論、機(jī)器人-人融合、以及機(jī)器人與其它機(jī)器系統(tǒng)的協(xié)調(diào)和交互。（5）機(jī)器人操作和移動(dòng)理論，機(jī)器人裝配理論、機(jī)器人移動(dòng)理論、足式機(jī)器人步態(tài)理論等。（6）微機(jī)器人學(xué)，微機(jī)器人的分析、設(shè)計(jì)、制造和控制等理論方法機(jī)器人的分類機(jī)器人分類方法很多

14、按照技術(shù)水平劃分第一代：示教再現(xiàn)型，具有記憶能力。目前，絕大部分應(yīng)用中的工業(yè)機(jī)器人均屬于這一類。缺點(diǎn)是操作人員的水平影響工作質(zhì)量。第二代：初步智能機(jī)器人，對(duì)外界有反饋能力。部分已經(jīng)應(yīng)用到生產(chǎn)中。 第三代：智能機(jī)器人，具有高度的適應(yīng)性，有自行學(xué)習(xí)、推理、決策等功能，處在研究階段。 按照基本結(jié)構(gòu)劃分 直角坐標(biāo)型， 也稱“機(jī)床型” 圓柱坐標(biāo)型 球坐標(biāo)型全關(guān)節(jié)型 按照受控運(yùn)動(dòng)方式劃分點(diǎn)位控制（PTP ）型，Point to Point, 如點(diǎn)焊、搬運(yùn)機(jī)器人 連續(xù)軌跡控制（CP ）型，Continous Path，如弧焊、噴漆機(jī)器人 按驅(qū)動(dòng)方式劃分 氣壓驅(qū)動(dòng)（壓縮空氣）液壓驅(qū)動(dòng)（重型機(jī)器人，如搬運(yùn)、點(diǎn)焊

15、機(jī)器人） 電驅(qū)動(dòng)（電動(dòng)機(jī)），應(yīng)用最多 按照應(yīng)用領(lǐng)域劃分工業(yè)機(jī)器人，面向工業(yè)領(lǐng)域的多關(guān)節(jié)機(jī)械手或多自由度機(jī)器人。特種機(jī)器人，用于非制造業(yè)的各種機(jī)器人，服務(wù)機(jī)器人、水下機(jī)器人、農(nóng)業(yè)機(jī)器人、軍用機(jī)器人等第二章 機(jī)器人的數(shù)學(xué)基礎(chǔ)第一節(jié) 位置和姿態(tài)的表示研究機(jī)器人的機(jī)械系統(tǒng)的運(yùn)動(dòng)需要建立一套運(yùn)動(dòng)的表示方法。為了描述機(jī)器人本身各連桿之間、機(jī)器人和環(huán)境之間的運(yùn)動(dòng)關(guān)系，通常將它們看作剛體。剛體的位置和姿態(tài)描述 在直角坐標(biāo)系A(chǔ) 中，任意一點(diǎn)P 的位置可以用31列向量表示。稱為位置矢量 為了確定剛體B 的姿態(tài)（也稱方位），設(shè)一個(gè)坐標(biāo)系B 與該剛體固接。用坐標(biāo)系的三個(gè)單位主矢量x B ， y B ，z B 相對(duì)于參

16、考坐標(biāo)系A(chǔ) 的方向余弦組成的33矩陣表示剛體B 相對(duì)于坐標(biāo)系A(chǔ) 的姿態(tài)。(A A AABBBB R x y z =稱為旋轉(zhuǎn)矩陣，也可表示成：111213212223313233A B r r r R r r r r r r = 旋轉(zhuǎn)矩陣是正交的。 按照上述定義，繞 x 軸旋轉(zhuǎn)了為：同樣也可以寫出R （y ，），R （z ，），注意：旋轉(zhuǎn)方向按照右手法則x Ay z p p p p = 100(, 0cos sin 0sin cos R x =- cos 0sin (, 010sin 0cos R y = -cos sin 0(, sin cos 0001R z -= 總之，用位置矢量描述剛體的

17、位置，用旋轉(zhuǎn)矩陣描述剛體的姿態(tài)（方位） 為了完全描述剛體B 在空間的位置和姿態(tài)，通常將剛體B 與某一坐標(biāo)系相固接，通常記為B ，B 的原點(diǎn)一般選在剛體B 的特征點(diǎn)上，如質(zhì)心或?qū)ΨQ中心等。對(duì)弧焊機(jī)器人中的焊槍可以將原點(diǎn)選在焊槍電極端部。則相對(duì)于參考坐標(biāo)系A(chǔ) ，用位置矢量o AB P 和旋轉(zhuǎn)矩陣AB R 分別描述B 原點(diǎn)位置及坐標(biāo)系的方位，即剛體B 的位置和姿態(tài)可由坐標(biāo)系B 來描述：當(dāng)表示位置時(shí)，旋轉(zhuǎn)矩陣為單位陣； 當(dāng)表示姿態(tài)時(shí)，位置矢量等于零。第二節(jié) 坐標(biāo)變換1、坐標(biāo)平移坐標(biāo)系B 與A 具有相同的方位，但B 的原點(diǎn)與A 的原點(diǎn)不重合，則空間任意點(diǎn)P 在A 中的描述可以表示為：O AB A B p

18、 p p =+，稱為坐標(biāo)平移方程。 2、坐標(biāo)旋轉(zhuǎn)坐標(biāo)系B 與A 原點(diǎn)重合，但兩者的方位不同，則空間任意點(diǎn)P 在A 中的描述可以表示為：AA BB p R p =，稱為坐標(biāo)旋轉(zhuǎn)方程。3、一般變換坐標(biāo)系B 與A 既不共原點(diǎn)，方位亦不同，此時(shí)，,OAABB B R p =OAA B ABB p R p p =+例題2-1：已知坐標(biāo)系B 的初始位姿與A 重合，首先B 相對(duì)于坐標(biāo)系A(chǔ) 的A z 軸轉(zhuǎn)30度，再沿A 的A x 軸移動(dòng)12個(gè)單位，并沿A 的A y 軸移動(dòng)6個(gè)單位。求位置矢量o A B p 和旋轉(zhuǎn)矩陣AB R 。假設(shè)點(diǎn)p 在坐標(biāo)系B 中的描述為5, 9, 0TBp =，求它在坐標(biāo)系A(chǔ) 中的描述

19、A p 。解：根據(jù)題意得則第三節(jié) 齊次變換在空間直角坐標(biāo)系中，任意一點(diǎn)可用一個(gè)三維坐標(biāo)矩陣x y z表示。如果將該點(diǎn)用一個(gè)四維坐標(biāo)的矩陣Hx Hy Hz H表示時(shí)，則稱為齊次坐標(biāo)表示方法。在齊次坐標(biāo)中，最后一維坐標(biāo)H 稱為比例因子。比如齊次坐標(biāo)8,4,2、4,2,1表示的都是二維點(diǎn)2,1。 (1從普通坐標(biāo)轉(zhuǎn)換成齊次坐標(biāo)時(shí) 如果(x,y,z是個(gè)點(diǎn)，則變?yōu)?x,y,z,1； 如果(x,y,z是個(gè)向量，則變?yōu)?x,y,z,0 (2從齊次坐標(biāo)轉(zhuǎn)換成普通坐標(biāo)時(shí)如果是(x,y,z,1，則知道它是個(gè)點(diǎn)，變成(x,y,z； 如果是(x,y,z,0，則知道它是個(gè)向量，仍然變成(x,y,z 齊次坐標(biāo)變換用41列向

20、量表示三維空間坐標(biāo)系中的點(diǎn)： 稱為齊次坐標(biāo)，齊次坐標(biāo)具有不唯一性。x a y xyzb a b c z c = 0001001A B R R z -=1260o AB p =+=+=引入齊次坐標(biāo)后，一般變換變?yōu)椋?稱為齊次變換矩陣 例題2-2：已知點(diǎn)732u i j k =+，對(duì)它進(jìn)行繞軸z 旋轉(zhuǎn)90度至點(diǎn)v ，點(diǎn)v 繞y 軸旋轉(zhuǎn)90度至點(diǎn)w ，求點(diǎn)w 的坐標(biāo)。在此基礎(chǔ)上再進(jìn)行平移變換437i j k -+，求點(diǎn)w 的坐標(biāo)。 解：由旋轉(zhuǎn)齊次坐標(biāo)變換得同理AA BBp T p=0001O AAB B AB R p T = 000070100739090003100037909000(,90 20

21、01022001c s s c v Rot z u -=0010320=-經(jīng)過平移變換后，新的w 的坐標(biāo)為3100426010374(4,3,7 001731001000111oA B I p w Tans w w -=-=第三章 機(jī)器人運(yùn)動(dòng)學(xué)第一節(jié) 機(jī)器人運(yùn)動(dòng)方程的表示A 矩陣：一個(gè)描述連桿坐標(biāo)系間相對(duì)平移和旋轉(zhuǎn)的齊次變換 。 T 矩陣：A 矩陣的乘積對(duì)于六連桿機(jī)械手，有下列T 矩陣 ：6123456T A A A A A A =一個(gè)六連桿機(jī)械手可具有六個(gè)自由度，每個(gè)連桿含有一個(gè)自由度，并能在其運(yùn)動(dòng)范圍內(nèi)任意定位與定向。機(jī)械手的運(yùn)動(dòng)方向 原點(diǎn)由矢量p 表示。 接近矢量a ：z 向矢量 方向矢

22、量o ：y 向矢量法線矢量n ：它與矢量o 和a 一起構(gòu)成一個(gè)右手 矢量集合，并由矢量的交乘所規(guī)定：n o a =。因此，變換T6具有下列元素。601x x x x yy y y z z z z n o a p n o a p T n o a p =六連桿機(jī)械手的T 矩陣（ T6 ）可由指定其16個(gè)元素的數(shù)值來決定。在這16個(gè)元素中，只有12個(gè)元素具有實(shí)際含義。機(jī)械手的運(yùn)動(dòng)姿態(tài)由某個(gè)姿態(tài)變換規(guī)定之后，它在基系中的位置就能夠由左乘一個(gè)對(duì)應(yīng)于矢量p 的平移變換來確定：61000100010001x yz p p T p =某姿態(tài)變換第二節(jié) 連桿變換矩陣及其乘積廣義連桿相鄰坐標(biāo)系間及其相應(yīng)連桿可以用

23、齊次變換矩陣來表示。要求出操作手所需要的變換矩陣，每個(gè)連桿都要用廣義連桿來描述。在求得相應(yīng)的廣義變換矩陣之后，可對(duì)其加以修正，以適合每個(gè)具體的連桿。機(jī)器人機(jī)械手是由一系列連接在一起的連桿（桿件）構(gòu)成的。需要用兩個(gè)參數(shù)來描述一個(gè)連桿，即公共法線距離i a 和垂直于i a 所在平面內(nèi)兩軸的夾角i ；需要另外兩個(gè)參數(shù)來表示相鄰兩桿的關(guān)系，即兩連桿的相對(duì)位置i d 和兩連桿法線的夾角i ，如圖所示。一般稱為i a 連桿長(zhǎng)度，i 為連桿扭角，i d 為兩連桿距離，i 為兩連桿夾角。 機(jī)器人機(jī)械手上坐標(biāo)系的配置取決于機(jī)械手連桿連接的類型。有兩種連接轉(zhuǎn)動(dòng)關(guān)節(jié)和棱柱聯(lián)軸節(jié)。對(duì)于轉(zhuǎn)動(dòng)關(guān)節(jié)，其特征參數(shù)為, , ,

24、 i i i i a d ，i 為關(guān)節(jié)變量；對(duì)于棱柱聯(lián)軸節(jié)，其特征參數(shù)為, , i i i d ，i d 為關(guān)節(jié)變量，連桿長(zhǎng)度i a 沒有意義，令其為0。連桿坐標(biāo)系與連桿參數(shù)為了確定機(jī)器人各連桿之間的相對(duì)運(yùn)動(dòng)關(guān)系，需要確定連桿坐標(biāo)系，規(guī)定： 1. 坐標(biāo)系1i -的z 軸1i z -與關(guān)節(jié)軸1i -共線，指向任意；2. 坐標(biāo)系1i -的x 軸1i x -與與連桿1i -的公垂線重合，指向由關(guān)節(jié)1i -到關(guān)節(jié)i ； 3. 坐標(biāo)系1i -的y 軸1i y -按照右手法則規(guī)定，即111i i i y z x -=根據(jù)所設(shè)定的連桿坐標(biāo)系，相應(yīng)的連桿參數(shù)定義如下：11i i i a z x -=i-1從z

25、 到沿測(cè)量的距離；111=i i i i z z x -從到繞旋轉(zhuǎn)的角度；1i i i d -=i-1從x 到x 沿z 測(cè)量的距離；11=i i i -i 從x 到x 繞z 旋轉(zhuǎn)的角度； 如圖所示：i y 用A 矩陣表示T 矩陣機(jī)械手的末端裝置即為連桿6的坐標(biāo)系，它與連桿1i -坐標(biāo)系的關(guān)系可由16i T -表示為：1616i i i T A A A -+=可得連桿變換通式為 ：1111111111001ii i i i i i i i i i i i i i i i i i c s s c c c s d s T s s c s c d c -=例1：如圖所示為具有三個(gè)旋轉(zhuǎn)關(guān)節(jié)的3R 機(jī)械手

26、，求末端機(jī)械手在基坐標(biāo)系00X Y 下的運(yùn)動(dòng)學(xué)方程。 解：建立如圖所示的參考坐標(biāo)系 y1111022122120000010001c s L s c T -=33233230000010001c s L s c T -=12311212001c s L c L c sc L s L s T T T T -+=s =+=+例2：如圖所示的三自由度機(jī)械手（兩個(gè)旋轉(zhuǎn)關(guān)節(jié)加一個(gè)平移關(guān)節(jié)，簡(jiǎn)稱RPR 機(jī)械手），求末端機(jī)械手的運(yùn)動(dòng)學(xué)方程。 解：建立如圖的坐標(biāo)系，則各連桿的D-H 參數(shù)為： 3由連桿的齊次坐標(biāo)公式111111111100001i i i i i i i i i i i i i i i i i

27、 i i c s a s c c c s d s T s s c s c d c -=有111101100000010 33332320000001001c s s c T L -= 所以 c c s s s L s d s c s s c c L c d T T T T s c L -+-=式中 1111sin cos s c =例3 PUMA 560機(jī)器人運(yùn)動(dòng)學(xué)方程PUMA 560是屬于關(guān)節(jié)式機(jī)器人，6個(gè)關(guān)節(jié)都是轉(zhuǎn)動(dòng)關(guān)節(jié)。前3個(gè)關(guān)節(jié)確定手腕參考點(diǎn)的位置，后3個(gè)關(guān)節(jié)確定手腕的方位。各連桿坐標(biāo)系如下圖所示。相應(yīng)的連桿參數(shù)列于表3.1中。 表3.1 PUMA560機(jī)器人

28、的連桿參數(shù) 11110100000010001c s s c T -=22212220000100001c s d T s c -=-33233230000010001c s a s c T -= 443434440001000001c s a d T s c -=-55455500001000001c s T s c -=665666000010000001c s T s c -=-各連桿變換矩陣相乘，得PUMA 560的機(jī)械手變換矩陣：即126, , , 為關(guān)節(jié)變量的函數(shù)。第四章 機(jī)器人的感覺系統(tǒng)第一節(jié) 傳感器原理簡(jiǎn)介傳感器的定義傳感器：把被測(cè)非電量轉(zhuǎn)換成為與之有確定對(duì)應(yīng)關(guān)系，且便于應(yīng)用的

29、某些物理量（通常為電量）的測(cè)量裝置。 傳感器是測(cè)量裝置，能完成檢測(cè)任務(wù)； 它的輸入量是某一被測(cè)量，可能是物理量，也可能是化學(xué)量、生物量等； 它的輸出量是某種物理量，這種量要便于傳輸、轉(zhuǎn)換、處理、顯示等等，這種量可以是氣、光、電量，但主要是電量； 輸出輸入有對(duì)應(yīng)關(guān)系，且應(yīng)有一定的精確程度。傳感器的組成及類型 傳感器的組成 常見的傳感器類型： 電阻式傳感器 變阻抗式傳感器 光電式傳感器 電勢(shì)式傳感器傳感器的原理 應(yīng)變片：壓力 電阻 光敏電阻：光強(qiáng) 電阻 熱敏電阻： 溫度 電阻霍爾元件： 磁感應(yīng)強(qiáng)度 電壓非電學(xué)量 電學(xué)量傳感器示例-電阻式傳感器 原理：金屬的電阻應(yīng)變效應(yīng)當(dāng)金屬絲在外力作用下發(fā)生機(jī)械變

30、形時(shí)，其電阻值將發(fā)生變化。（公式略） 力形變 電阻變化 電壓應(yīng)變片的作用應(yīng)變式加速度傳感器 應(yīng)變式加速度傳感器結(jié)構(gòu)示意圖1等強(qiáng)度梁 2質(zhì)量塊 3殼體 4電阻應(yīng)變片在低頻（1060Hz）振動(dòng)測(cè)量中得到廣泛的應(yīng)用。傳感器示例-光電式傳感器 光敏電阻的工作原理及結(jié)構(gòu)當(dāng)無光照時(shí)，光敏電阻值(暗電阻 很大，電路中電流很小 當(dāng)有光照時(shí)，光敏電阻值(亮電阻 急劇減少，電流迅速增加光電碼盤傳感器-工作原理用光電方法把被測(cè)角位移轉(zhuǎn)換成以數(shù)字代碼形式表示的電信號(hào)的轉(zhuǎn)換部件。 1光源 2柱面鏡 3碼盤 4狹縫 5元件第二節(jié) 傳感器在機(jī)器人中的應(yīng)用多傳感器在移動(dòng)機(jī)器人中的應(yīng)用 幾種主要的機(jī)器人傳感器簡(jiǎn)介視覺 20世紀(jì)

31、50年代后期出現(xiàn)，發(fā)展十分迅速，是機(jī)器人中最重要的傳感器之一。 機(jī)器視覺從20世紀(jì)60年代開始首先處理積木世界，后來發(fā)展到處理室外的現(xiàn)實(shí)世界。 20世紀(jì)70年代以后，實(shí)用性的視覺系統(tǒng)出現(xiàn)了。視覺一般包括三個(gè)過程：圖像獲取、圖像處理和圖像理解。相對(duì)而言，圖像理解技術(shù)還很落后。 力覺 機(jī)器人力傳感器就安裝部位來講，可以分為關(guān)節(jié)力傳感器、腕力傳感器和指力傳感器。國(guó)際上對(duì)腕力傳感器的研究是從20世紀(jì)70年代開始的。 觸覺 作為視覺的補(bǔ)充，觸覺能感知目標(biāo)物體的表面性能和物理特性：柔軟性、硬度、彈性、粗糙度和導(dǎo)熱性等。對(duì)它的研究從20世紀(jì)80年代初開始，到20世紀(jì)90年代初已取得了大量的成果。接近覺 研究

32、它的目的是是使機(jī)器人在移動(dòng)或操作過程中獲知目標(biāo)（障礙）物的接近程度。移動(dòng)機(jī)器人可以實(shí)現(xiàn)避障，操作機(jī)器人可避免手爪對(duì)目標(biāo)物由于接近速度過快造成的沖擊。機(jī)器人傳感器的分類根據(jù)檢測(cè)對(duì)象的不同可分為內(nèi)部傳感器和外部傳感器。 a. 內(nèi)部傳感器用來檢測(cè)機(jī)器人本身狀態(tài)（如手臂間角度）的傳感器。多為檢測(cè)位置和角度的傳感器。（1）位置傳感器 （2）角度傳感器 b. 外部傳感器用來檢測(cè)機(jī)器人所處環(huán)境（如是什么物體，離物體的距離有多遠(yuǎn)等）及狀況（如抓取的物體是否滑落）的傳感器。具體有物體識(shí)別傳感器、物體探傷傳感器、接近覺傳感器、距離傳感器、力覺傳感器，聽覺傳感器等。 機(jī)器人的觸覺一般認(rèn)為觸覺包括接觸覺、壓覺、滑覺、

33、力覺四種，狹義的觸覺按字面上來看是指前三種感知接觸的感覺。 1. 接觸覺傳感器 例如，開關(guān)式觸覺傳感器 特點(diǎn)：外形尺寸十分大 空間分辨率低 利用陣列這一概念已開發(fā)了許多重要的傳感器。碳?xì)郑–SA ）碳?xì)郑–SA ）靈敏度高，具有較強(qiáng)的耐過載能力。缺點(diǎn)是有遲滯，線性差。 導(dǎo)電橡膠的電阻也會(huì)隨壓力的變化而變化，因此也常用來作為觸覺傳感器的敏感材料。 擬人化皮膚傳感器利用一種具有壓電和熱釋電性的高分子材料研制而成。 另外還有光學(xué)式觸覺傳感器、電容式陣列觸覺傳感器等。 2. 壓覺傳感器（略） 3. 力覺傳感器 力覺傳感器使用的主要元件是電阻應(yīng)變片。 通常我們將機(jī)器人的力傳感器分為三類：（1）裝在關(guān)節(jié)驅(qū)

34、動(dòng)器上的力傳感器，稱為關(guān)節(jié)力傳感器。用于控制中的力反饋。（2）裝在末端執(zhí)行器和機(jī)器人最后一個(gè)關(guān)節(jié)之間的力傳感器，稱為腕力傳感器。（3）裝在機(jī)器人手爪指關(guān)節(jié)（或手指上）的力傳感器，稱為指力傳感器。SRI 傳感器 SRI （Stanford Research Institute ）研制的六維腕力傳感器，如圖所示。它由一只直徑為75mm 的鋁管銑削而成，具有八個(gè)窄長(zhǎng)的彈性梁，每個(gè)梁的頸部只傳遞力，扭矩作用很小。梁的另一頭貼有應(yīng)變片。圖中從Px+到Qy-代表了8根應(yīng)變梁的變形信號(hào)的輸出。日本大和制衡株式會(huì)社林純一研制的腕力傳感器。它是一種整體輪輻式結(jié)構(gòu)，傳感器在十字梁與輪緣聯(lián)結(jié)處有一個(gè)柔性環(huán)節(jié)，在四根

35、交叉梁上共貼有32個(gè)應(yīng)變片（圖中以小方塊），組成8路全橋輸出 。 三梁腕力傳感器傳感器的內(nèi)圈和外圈分別固定于機(jī)器人的手臂和手爪，力沿與內(nèi)圈相切的三根梁進(jìn)行傳遞。每根梁上下、左右個(gè)貼一對(duì)應(yīng)變片，三根梁上共有6對(duì)應(yīng)變片，分別組成六組半橋，對(duì)這6組電橋信號(hào)進(jìn)行解耦可得到六維力（力矩）的精確解。 4. 滑覺傳感器機(jī)械手一般采用兩種抓取方式：硬抓取和軟抓取。硬抓?。o感知時(shí)采用） ：末端執(zhí)行器利用最大的夾緊力抓取工件。軟抓?。ㄓ谢X傳感器時(shí)采用）：末端執(zhí)行器使夾緊力保持在能穩(wěn)固抓取工件的最小值，以免損傷工件。 采用壓覺傳感器實(shí)現(xiàn)滑覺感知滾輪式滑覺傳感器 它由一個(gè)金屬球和觸針組成，金屬球表面分成許多個(gè)相間

36、排列的導(dǎo)電和絕緣小格。觸針頭很細(xì)，每次只能觸及一格。當(dāng)工件滑動(dòng)時(shí)，金屬球也隨之轉(zhuǎn)動(dòng)，在觸針上輸出脈沖信號(hào)，脈沖信號(hào)的頻率反映了滑移速度，個(gè)數(shù)對(duì)應(yīng)滑移的距離。 根據(jù)振動(dòng)原理制成的滑覺傳感器。鋼球指針與被抓物體接觸。若工件滑動(dòng)，則指針振動(dòng)，線圈輸出信號(hào)。機(jī)器人的接近覺 接近覺主要感知傳感器與對(duì)象物之間的接近程度?；魻栃?yīng)指的是金屬或半導(dǎo)體片置于磁場(chǎng)中，當(dāng)有電流流過時(shí)，在垂直于電流和磁場(chǎng)的方向上產(chǎn)生電動(dòng)勢(shì)。霍爾傳感器單獨(dú)使用時(shí)，只能檢測(cè)有磁性物體。當(dāng)與用磁體聯(lián)合使用時(shí)，可以用來檢測(cè)所有的鐵磁物體。傳感器附近沒有鐵磁物體時(shí)，霍爾傳感器感受一個(gè)強(qiáng)磁場(chǎng)；若有鐵磁物體時(shí)，由于磁力線被鐵磁物體旁路，傳感器感受

37、到的磁場(chǎng)將減弱。 其它還有光學(xué)接近覺、超聲波接近覺傳感器等。另外還有接觸覺、滑覺和接近覺三種感覺組合為一體的傳感器。 機(jī)器人的視覺 1、超聲波傳感器從廣義上講，我們也把它算成機(jī)器人視覺中的一種。超聲波探測(cè)原理比較簡(jiǎn)單，一般是采用時(shí)差法。=t 2其中（的函數(shù)）為超聲波波速，為環(huán)境攝氏溫度 超聲波傳感器主要用途：（1）實(shí)時(shí)地檢測(cè)自身所處空間的位置，用以進(jìn)行自定位； （2）實(shí)時(shí)地檢測(cè)障礙物，為行動(dòng)決策提供依據(jù)； （3）檢測(cè)目標(biāo)姿態(tài)以及進(jìn)行簡(jiǎn)單形體的識(shí)別； （4）用于導(dǎo)航目標(biāo)跟蹤。2、CCD （電荷耦合器件：charge coupled devices）CCD （電荷耦合器件）的基本結(jié)構(gòu)是一個(gè)間隙很小

38、的光敏電極陣列，即無數(shù)個(gè)CCD 單元組成，也稱為像素點(diǎn)（如448380）。它可以是一維的線陣，也可以是二維的面陣。 機(jī)器人的聽覺（略）多傳感器信息融合多傳感器信息融合技術(shù)是通過對(duì)這些傳感器及其觀測(cè)信息的合理支配和使用，把多個(gè)傳感器在時(shí)間和空間上的冗余或互補(bǔ)信息依據(jù)某種準(zhǔn)則進(jìn)行組合，以獲取被觀測(cè)對(duì)象的一致性解釋或描述。多傳感與單傳感的比較：多傳感器數(shù)據(jù)融合系統(tǒng)可更大程度獲取被探測(cè)目標(biāo)和環(huán)境的信息量。單傳感器信號(hào)處理或低層次的數(shù)據(jù)處理方式只是對(duì)人腦信息處理的一種低水平模仿。多傳感器融合系統(tǒng)主要特點(diǎn)是：（1）提供了冗余、互補(bǔ)信息。（2）信息分層的結(jié)構(gòu)特性。（3）實(shí)時(shí)性。（4）低代價(jià)性。三種結(jié)構(gòu)形式：

39、串聯(lián)、并聯(lián)和混合融合形式 多傳感器融合常用的方法有：加權(quán)平均法、貝葉斯估計(jì)、卡爾曼濾波、DS 證據(jù)推理、模糊邏輯、產(chǎn)生式規(guī)則、人工神經(jīng)網(wǎng)絡(luò)等人工智能的方法。第五章 機(jī)器人驅(qū)動(dòng)與控制技術(shù)第一節(jié) 驅(qū)動(dòng)電機(jī)驅(qū)動(dòng)器就是驅(qū)動(dòng)機(jī)器人運(yùn)動(dòng)的部件，最常用的是電機(jī)，此外還有液壓、氣動(dòng)等驅(qū)動(dòng)方式。 一個(gè)機(jī)器人最主要的控制量就是控制機(jī)器人的移動(dòng)，無論是自身的移動(dòng)還是手臂等關(guān)節(jié)的移動(dòng)，所以機(jī)器人驅(qū)動(dòng)器中最根本的問題就是控制電機(jī)?？刂齐姍C(jī)轉(zhuǎn)的圈數(shù)，就可以控制機(jī)器人移動(dòng)的距離和方向，機(jī)械手臂的彎曲的程度或者移動(dòng)的距離等。 第一個(gè)要解決的問題是如何讓電機(jī)能根據(jù)要求轉(zhuǎn)動(dòng)。一般來說，有專門的控制卡和控制芯片來進(jìn)行控制的。通過把

40、微控制器和控制卡連接起來，就可以用程序來控制電機(jī)了。 第二個(gè)問題是控制電機(jī)的速度，在機(jī)器人上的實(shí)際表現(xiàn)就是機(jī)器人或者手臂的實(shí)際運(yùn)動(dòng)速度。機(jī)器人運(yùn)動(dòng)的快慢全靠電機(jī)的轉(zhuǎn)速，因此，需要控制卡對(duì)電機(jī)有速度控制。電動(dòng)機(jī)是機(jī)器人驅(qū)動(dòng)系統(tǒng)中的執(zhí)行元件。常采用的電動(dòng)機(jī)為： 直流電機(jī) 步進(jìn)電機(jī) 直流、交流伺服電機(jī)直流電機(jī)是最普通的電機(jī)，速度控制相對(duì)比較簡(jiǎn)單。直流電機(jī)最大的問題是沒法精確控制電機(jī)轉(zhuǎn)的圈數(shù)，也就位置控制。必須加上一個(gè)編碼盤，來進(jìn)行反饋，來獲得實(shí)際轉(zhuǎn)的圈數(shù)。步進(jìn)電機(jī)顧名思義是一步一步前進(jìn)的，也就是說它可以一個(gè)角度一個(gè)角度旋轉(zhuǎn)，不象直流電機(jī)，可以很輕松的調(diào)節(jié)步進(jìn)電機(jī)的轉(zhuǎn)角位置。如果發(fā)出一個(gè)轉(zhuǎn)10圈的指令

41、，步進(jìn)電機(jī)就不會(huì)轉(zhuǎn)11圈，但是如果是直流電機(jī)，由于慣性作用，它可能轉(zhuǎn)11圈半。步進(jìn)電機(jī)的調(diào)速是通過控制電機(jī)的頻率來獲得的。一般控制信號(hào)頻率越高，電機(jī)轉(zhuǎn)的越快，頻率越低，轉(zhuǎn)的越慢。步進(jìn)電機(jī)經(jīng)常應(yīng)用于開環(huán)控制系統(tǒng)，特點(diǎn)為具有較大的低速轉(zhuǎn)矩，可直接驅(qū)動(dòng)。主要分為三類： 永磁式步進(jìn)電動(dòng)機(jī)：轉(zhuǎn)子由磁性材料制成，具有低力矩、低速度、低成本的特點(diǎn)。一般用于計(jì)算機(jī)外圍設(shè)備（打印機(jī)、光驅(qū)等） 變磁阻式步進(jìn)電動(dòng)機(jī)：沒有磁性材料，不通電時(shí)，沒有保持力矩，也稱感應(yīng)式步進(jìn)電機(jī)混合式步進(jìn)電動(dòng)機(jī)：上述原理的結(jié)合，是目前應(yīng)用越來越廣的一種。 直流伺服電機(jī)20世紀(jì)80年代中期以前被廣泛使用，優(yōu)點(diǎn)為易于控制，缺點(diǎn)是需要定期維護(hù)，

42、速度不 能太高，功率不能太大。定子磁場(chǎng)是永磁鐵提供的，線圈中通入電流，產(chǎn)生轉(zhuǎn)矩，轉(zhuǎn)一個(gè)角度后，需要換向器改變電流方向。受換向器（電刷）影響，需要定期維護(hù)，且速度不能太高。由于線圈繞在轉(zhuǎn)子上，散熱問題不易解決，功率不能太大。交流伺服電動(dòng)機(jī)轉(zhuǎn)子是永磁的，線圈繞在定子上，沒有電刷。線 圈中通交變電流。轉(zhuǎn)子上裝有碼盤傳感器，檢測(cè)轉(zhuǎn)子所處的位置，根據(jù)轉(zhuǎn)子的位置，控制通電方向。由于線圈繞在定子上，可以通過外殼散熱，可做成大功率電機(jī)。沒有電刷，免維護(hù)。是目前在機(jī)器人上應(yīng)用最多的電動(dòng)機(jī)。和步進(jìn)電機(jī)相比，伺服電機(jī)有以下幾點(diǎn)優(yōu)勢(shì)：1、實(shí)現(xiàn)了位置，速度和力矩的閉環(huán)控制；克服了步進(jìn)電機(jī)失步的問題；2、高速性能好，一般

43、額定轉(zhuǎn)速能達(dá)到20003000轉(zhuǎn)；3、抗過載能力強(qiáng)，能承受三倍于額定轉(zhuǎn)矩的負(fù)載，對(duì)有瞬間負(fù)載波動(dòng)和要求快速起動(dòng)的場(chǎng)合特別適用；4、低速運(yùn)行平穩(wěn)，低速運(yùn)行時(shí)不會(huì)產(chǎn)生類似于步進(jìn)電機(jī)的步進(jìn)運(yùn)行現(xiàn)象。5、電機(jī)加減速的動(dòng)態(tài)相應(yīng)時(shí)間短，一般在幾十毫秒之內(nèi)；6、發(fā)熱和噪音明顯降低。減速機(jī)一般情況下，電機(jī)都沒法直接帶動(dòng)輪子或者手臂等機(jī)器人部件，因?yàn)樗俣冗^高力矩不夠大，所以為了提高控制精度，增大驅(qū)動(dòng)力矩，一般均需配置減速機(jī)（減速箱）。配置減速機(jī)的代價(jià)是電機(jī)速度的減小。例如，一個(gè)1:250的齒輪減速箱，會(huì)讓電機(jī)的輸出力矩增大250倍，但速度只有原來的1/250。通常先計(jì)算出機(jī)器人所需要的速度與力矩大小，然后根據(jù)速

44、度與力矩選擇電機(jī)與減速器。 微型伺服電機(jī)示意圖第二節(jié) 位置控制工業(yè)機(jī)器人常用的控制結(jié)構(gòu)形式：機(jī)器人控制器具有多種結(jié)構(gòu)形式，包括非伺服控制、伺服控制、位置和速度反饋控制、力（力矩）控制、基于傳感器的控制、非線性控制、分解加速度控制、滑?？刂?、最優(yōu)控制、自適應(yīng)控制、遞階控制以及各種智能控制。機(jī)器人控制器的選擇是由機(jī)器人所執(zhí)行的任務(wù)決定的，技術(shù)水平越高的機(jī)器人所需要的“智能”越高機(jī)器人的主要控制層次分三個(gè)層次：人工智能級(jí)、控制模式級(jí)、伺服系統(tǒng)級(jí)1）人工智能級(jí)完成從機(jī)器人工作任務(wù)的語言描述 生成X(t；仍處于研究階段。2）控制模式級(jí)建立X(tT(t之間的雙向關(guān)系。( ( ( ( t t t t X C

45、 T電機(jī)模型傳動(dòng)模型關(guān)節(jié)動(dòng)力學(xué)模型機(jī)器人模型 ( ( ( ( t t t t T C X3）伺服系統(tǒng)級(jí)解決關(guān)節(jié)伺服控制問題 機(jī)器人是由多軸（關(guān)節(jié)）組成，每軸的運(yùn)動(dòng)都影響機(jī)器人未端的位置和姿態(tài)。如何協(xié)調(diào)各軸的運(yùn)動(dòng)，使機(jī)器人末端完成要求的軌跡， 是需要解決的問題。由于絕大多數(shù)機(jī)器人是關(guān)節(jié)式運(yùn)動(dòng)形式，很難直接檢測(cè)機(jī)器人末端的運(yùn)動(dòng)，只能對(duì)各關(guān)節(jié)進(jìn)行控制。屬于半閉環(huán)系統(tǒng)，即僅從電動(dòng)機(jī)軸上閉環(huán)。 微型伺服電機(jī)工作示例減速齒輪組由馬達(dá)驅(qū)動(dòng)，其終端（輸出端）帶動(dòng)一個(gè)線性的比例電位器作位置檢測(cè)，該電位器把轉(zhuǎn)角坐標(biāo)轉(zhuǎn)換為一比例電壓反饋給控制線路板，控制線路板將其與輸入的控制脈沖信號(hào)比較，產(chǎn)生糾正脈沖，并驅(qū)動(dòng)馬達(dá)正

46、向或反向地轉(zhuǎn)動(dòng)，使齒輪組的輸出位置與期望值相符，令糾正脈沖趨于為0，從而達(dá)到使伺服馬達(dá)精確定位的目的。 控制周期脈沖寬度為20ms 。送出不同的正脈沖寬度時(shí)，就可以得到不同的控制效果?？刂普}沖寬度如下：正脈沖寬度為0.3ms 時(shí)，伺服馬達(dá)反轉(zhuǎn)。 正脈沖寬度為2.5ms 時(shí)，伺服馬達(dá)正轉(zhuǎn)。 正脈沖寬度為1.4ms 時(shí)，伺服馬達(dá)回到中點(diǎn)。目前機(jī)器人基本操作方式為示教再現(xiàn)，示教時(shí)，不能將軌跡上的所有點(diǎn)都示教一遍，一是費(fèi)時(shí)，二是占用大量的存儲(chǔ)器。實(shí)際上，對(duì)于有規(guī)律的軌跡，僅示教幾個(gè)特征點(diǎn)。對(duì)直線軌跡，僅示教兩個(gè)端點(diǎn)；對(duì)圓弧軌跡，示教三點(diǎn)（起點(diǎn)、終點(diǎn)、中間點(diǎn)），軌跡上其它中間點(diǎn)的坐標(biāo)通過插補(bǔ)方法獲得。 插補(bǔ)方式： 定時(shí)插補(bǔ)每隔一定時(shí)間插補(bǔ)一次，插補(bǔ)時(shí)間間隔Ts 一般不超過25ms 定距插補(bǔ)每隔一定距離插補(bǔ)一次，可避免快速運(yùn)動(dòng)時(shí)，定時(shí)插補(bǔ)造成的軌跡失真。但也受伺服周期限制。插補(bǔ)算法： 直線插補(bǔ)將兩示教點(diǎn)之間按照直線規(guī)律計(jì)算中間點(diǎn)坐標(biāo)。 圓弧插補(bǔ)按圓弧規(guī)律計(jì)算中間點(diǎn)。 實(shí)際運(yùn)行中機(jī)器人的各個(gè)關(guān)節(jié)不是獨(dú)立運(yùn)動(dòng)的，而是協(xié)調(diào)運(yùn)動(dòng)的。即需要對(duì)各關(guān)節(jié)以協(xié)調(diào)的位置和速度進(jìn)行控制。因此，有必要研究機(jī)器人