機器人導(dǎo)論知識點總結(jié)

第1章 概論

第一節(jié) 機器人的基本概念

1、機器人名稱的由來

機器人的英文名詞是Robot，Robot一詞最早出現(xiàn)在1920年捷克作家卡雷爾·恰佩克（Karel Capek）所寫的一個劇本中，這個 劇本的名字為《Rossum’s Universal Robots》，中文意思是羅薩姆的萬能機器人。劇中的人造勞動者取名為Robota，捷克語的意思是“苦力”、“奴 隸”。英語的Robot一詞就是由此而來的，以后世界各國都用Robot作為機器人的代名詞。

2、機器人的定義

• 機器人的定義沒有一個統(tǒng)一的意見
• 原因之一是機器人還在發(fā)展，新的機型，新的功能不斷涌現(xiàn)
• 涉及到了人的概念，成為一個難以回答的哲學(xué)問題
• 有關(guān)代表性機器人定義：
  • （1）、美國機器人協(xié)會(RIA)的定義：機器人是一種用于移動各種材料、零件、工具或?qū)Ｓ醚b置的，通過可編程序動作來執(zhí)行種種任務(wù)的，并具有編程能力的多功能機械手 (manipulator)。
  • （2）、國際標(biāo)準(zhǔn)化組織(ISO)的定義：機器人是一種自動的、位置可控的、具有編程能力的多功能機械手，這種機械手具有幾個軸，能夠借助于可編程序操作來處理各種材料、零件、工具和專用裝置，以執(zhí)行種種任務(wù)。
  • （3）、美國國家標(biāo)準(zhǔn)局（NBS）的定義：機器人是一種能夠進行編程并在自動控制下執(zhí)行某些操作和移動作業(yè)任務(wù)的機械裝置。一種廣義的工業(yè)機器人定義。
  • （4）、英國簡明牛津字典的定義：機器人是貌似人的自動機，具有智力的和順從于人但不具人格的機器。一種理想的描述。
  • （5）、我國科學(xué)家對機器人的定義是：“機器人是一種自動化的機器，所不同的是這種機器具備一些與人或生物相似的智能能力，如感知能力、規(guī)劃能力、動作能力和協(xié)同能力，是一種具有高度靈活性的自動化機器。”

3、機器人的主要特點

四大特征：

仿生特征：機器人的動作機構(gòu)具有類似于人或其他生物體某些器官 ( 如肢體、感官等 ) 的功能；

柔性特征：機器人具有通用性，工作種類多樣，動作程序靈活易變，是柔性加工主要組成部分；

智能特征：機器人具有不同程度的智能，如記憶、感知、推理、決策、學(xué)習(xí)等；

自動特征：機器人具有獨立性，完整的機器人系統(tǒng)，在工作中可以一定程度上不依賴于人的干預(yù)。

機器人是包括“機器”和“人”兩部分的智能體

• “機器”是指根據(jù)不同的應(yīng)用需求，設(shè)計不同的構(gòu)型；“人”是指類人的感知、規(guī)劃、執(zhí)行。

第二節(jié) 機器人的發(fā)展歷程

1. 古代“機器人”——現(xiàn)代機器人的雛形

• 3000多年歷史
  • 西周時期，偃師研制出的歌舞藝人，是我國最早記載的機器人。
  • 春秋后期，魯班制造過一只木鳥。
  • 公元前2世紀，古希臘人戴達羅斯發(fā)明了最原始的機器人──太羅斯，它是以水、空氣和蒸汽壓力為動力的會動的青銅雕像。
  • 1800年前的漢代，大科學(xué)家張衡不僅發(fā)明了地動儀，而且發(fā)明了計里鼓車。
  • 后漢三國時期，諸葛亮成功地創(chuàng)造出了“木牛流馬”。
  • 1662年，日本的竹田近江利用鐘表技術(shù)發(fā)明了自動機器玩偶。
  • 1738年，法國天才技師雅克·德·瓦遜發(fā)明了一只機器鴨。
  • 1773年，著名的瑞士鐘表匠杰克·道羅斯和他的兒子利·路易·道羅斯制造出自動書寫玩偶、自動演奏玩偶等，他們創(chuàng)造的自動玩偶是利用齒輪和發(fā)條原理而制成的。

2. 現(xiàn)代機器人的發(fā)展歷史

• 1954年,美國戴沃爾最早提出了工業(yè)機器人的概念, 并申請了專利。該專利的要點是借助伺服技術(shù)控制機器人的關(guān)節(jié),利用人手對機器人進行動作示教, 機器人能實現(xiàn)動作的記錄和再現(xiàn)。這就是所謂的示教再現(xiàn)機器人, 現(xiàn)有的機器人差不多都采用這種控制方式。
• 1958年, 被譽為“工業(yè)機器人之父”的Joseph F. Engel Berger 創(chuàng)建了世界上第一個機器人公司——Unimation(Universal Automation)公司, 并參與設(shè)計了第一臺Unimate 機器人。

3、機器人未來的發(fā)展趨勢

• 語言交流功能越來越完美
• 各種動作的完美化
• 外形越來越酷似人類
• 邏輯分析能力越來越強
• 具備越來越多樣化功能

第三節(jié) 機器人的分類

• 按照應(yīng)用類型分類
  • 工業(yè)機器人：
    • 弧焊機器人
    • 噴漆機器人
  • 特種機器人（極限作業(yè)機器人）：
    • 空中無人飛行器
    • 水下機器人—蛟龍?zhí)?/li>
    • 空間機器人：月球車、火星車
  • 服務(wù)型機器人
• 按照控制方式分類
  • 操作機器人：由主、從機械手兩部分組成，可實現(xiàn)遠距離操作的機器人。人手操縱的部分稱為主動機械手，而從動機械手基本上與主動機械手類似，只是從動機械手要比主動機械手大一些，作業(yè)時的力量也更大。
  • 程序機器人：程序機器人按預(yù)先給定的程序、條件、位置進行作業(yè), 目前大部分機器人都采用這種控制方式工作。
  • 示教再現(xiàn)機器人：示教再現(xiàn)機器人同盒式磁帶的錄放一樣, 將所教的操作過程自動記錄在磁盤、磁帶等存儲器中, 當(dāng)需要再現(xiàn)操作時, 可重復(fù)所教過的動作過程。示教方法有手把手示教、有線示教和無線示教。
  • 智能機器人：智能機器人不僅可以進行預(yù)先設(shè)定的動作, 還可以按照工作環(huán)境的變化改變動作。
  • 綜合機器人：綜合機器人是由操作機器人、 示教再現(xiàn)機器人、 智能機器人組合而成的機器人, 如火星機器人。
• 按照坐標(biāo)形式分類
  • 直角坐標(biāo)型（直角坐標(biāo)／笛卡兒坐標(biāo)／臺架型(3P)）
    • 機器人由3個線性關(guān)節(jié)組成,這3個關(guān)節(jié)用來確定末端操作器的位置,通常還帶有附加的旋轉(zhuǎn)關(guān)節(jié)，用來確定末端操作器的姿態(tài)。
    • 機器人在x、y、z軸上的運動是獨立的,運動方程可獨立處理, 且方程是線性的, 因此很容易通過計算機控制實現(xiàn);
    • 可以兩端支撐, 對于給定的結(jié)構(gòu)長度, 剛性最大; 它的精度和位置分辨率不隨工作場合而變化, 容易達到高精度。
    • 操作范圍小, 手臂收縮的同時又向相反的方向伸出,既妨礙工作,又占地面積大,運動速度低,密封性不好。
  • 圓柱坐標(biāo)型(R2P)
    • 圓柱坐標(biāo)機器人由兩個滑動關(guān)節(jié)和一個旋轉(zhuǎn)關(guān)節(jié)來確定部件的位置, 再附加一個旋轉(zhuǎn)關(guān)節(jié)來確定部件的姿態(tài)。
    • 這種機器人可以繞中心軸旋轉(zhuǎn)一個角,工作范圍可以擴大,且計算簡單;
    • 直線部分可采用液壓驅(qū)動,可輸出較大的動力;
    • 能夠伸入型腔式機器內(nèi)部。但是，它的手臂可以到達的空間受到限制, 不能到達近立柱或近地面的空間;
    • 直線驅(qū)動部分難以密封、防塵;
    • 后臂工作時, 手臂后端會碰到工作范圍內(nèi)的其它物體。
  • 球坐標(biāo)型(2RP)
    • 球坐標(biāo)機器人采用球坐標(biāo)系, 它用一個滑動關(guān)節(jié)和兩個旋轉(zhuǎn)關(guān)節(jié)來確定部件的位置, 再用一個附加的旋轉(zhuǎn)關(guān)節(jié)確定部件的姿態(tài)。
    • 這種機器人可以繞中心軸旋轉(zhuǎn), 中心支架附近的工作范圍大,兩個轉(zhuǎn)動驅(qū)動裝置容易密封, 覆蓋工作空間較大。
    • 但該坐標(biāo)復(fù)雜, 難于控制, 且直線驅(qū)動裝置仍存在密封及工作死區(qū)的問題。
    • 球坐標(biāo)機器人的工作范圍呈球缺狀。
  • 關(guān)節(jié)坐標(biāo)型
    • 關(guān)節(jié)機器人的關(guān)節(jié)全都是旋轉(zhuǎn)的, 類似于人的手臂, 是工業(yè)機器人中最常見的結(jié)構(gòu)。
  • 平面關(guān)節(jié)型
    • 這種機器人可看做是關(guān)節(jié)坐標(biāo)式機器人的特例, 它只有平行的肩關(guān)節(jié)和肘關(guān)節(jié),關(guān)節(jié)軸線共面。
    • 如SCARA機器人有兩個并聯(lián)的旋轉(zhuǎn)關(guān)節(jié),可以使機器人在水平面上運動, 此外, 再用一個附加的滑動關(guān)節(jié)做垂直運動。
    • SCARA機器人常用于裝配作業(yè), 最顯著的特點是它們在x-y平面上的運動具有較大的柔性, 而沿z軸具有很強的剛性, 所以, 它具有選擇性的柔性。這種機器人在裝配作業(yè)中獲得了較好的應(yīng)用。
• 按照承載能力分類，根據(jù)提取重力的不同，可將機器人分為：
  • 微型機器人，提取重力在10N以下；
  • 小型機器人，提取重力為10-50N；
  • 中型機器人，提取重力為50-300N；
  • 大型機器人，提取重力為300-500N；
  • 重型機器人，提取重力在500N以上。
  • 目前實際應(yīng)用機器人一般為中、小型機器人。

第四節(jié) 機器人技術(shù)參數(shù)

工業(yè)機器人的基本組成

工業(yè)機器人由3大部分6個子系統(tǒng)組成：

• 3大部分是機械部分、傳感部分和控制部分。
• 6個子系統(tǒng)是驅(qū)動系統(tǒng)、機械結(jié)構(gòu)系統(tǒng)、感受系統(tǒng)、機器人-環(huán)境交互系統(tǒng)、人機交互系統(tǒng)和控制系統(tǒng)。
  • 驅(qū)動系統(tǒng)：驅(qū)動系統(tǒng)是按照控制系統(tǒng)發(fā)出的控制指令將信號放大，驅(qū)動執(zhí)行機構(gòu)運動的傳動裝置。
    • 常用的有電氣、液壓、氣動和機械等四種驅(qū)動方式。
    • 有些機器人采用這些驅(qū)動方式的組合。
  • 機械結(jié)構(gòu)系統(tǒng)：由基座、手臂、末端執(zhí)行器三大件組成，每一大件都有若干自由度, 構(gòu)成一個多自由度的機械系統(tǒng)。
  • 控制系統(tǒng)：是機器人的大腦，支配著機器人按規(guī)定的程序運動，并記憶人們給予的指令信息(如動作順序、運動軌跡、運動速度等)，同時按其控制系統(tǒng)的信息控制執(zhí)行機構(gòu)按規(guī)定要求動作。
  • 感受系統(tǒng)：由內(nèi)部傳感器模塊和外部傳感器模塊組成, 用以獲取內(nèi)部和外部環(huán)境狀態(tài)中有意義的信息。
  • 機器人-環(huán)境交互系統(tǒng)：實現(xiàn)工業(yè)機器人與外部環(huán)境中的設(shè)備相互聯(lián)系和協(xié)調(diào)的系統(tǒng)。
  • 人機交互系統(tǒng)：人機交互系統(tǒng)是使操作人員參與機器人控制并與機器人進行聯(lián)系的裝置，分為指令給定裝置和信息顯示裝置。

工業(yè)機器人的技術(shù)參數(shù)

工業(yè)機器人的技術(shù)參數(shù)是各工業(yè)機器人制造商在產(chǎn)品供貨時所提供的技術(shù)數(shù)據(jù)。 盡管各廠商提供的技術(shù)參數(shù)不完全一樣, 工業(yè)機器人的結(jié)構(gòu)、用途等有所不同, 且用戶的要求也不同, 但工業(yè)機器人的主要技術(shù)參數(shù)一般應(yīng)有自由度、重復(fù)定位精度、工作范圍、最大工作速度和承載能力等。

第2章 機器人本體結(jié)構(gòu)設(shè)計

第一節(jié)：工業(yè)機器人的總體設(shè)計

1、總體設(shè)計的步驟

• 系統(tǒng)分析
• 技術(shù)設(shè)計
• 仿真分析

2、主體結(jié)構(gòu)設(shè)計

主體結(jié)構(gòu)設(shè)計的關(guān)鍵是選擇由連桿件和運動副組成的坐標(biāo)形式

• 直角坐標(biāo)機器人。主體結(jié)構(gòu)有三個自由度，全為伸縮。
• 圓柱坐標(biāo)機器人。主體結(jié)構(gòu)有三個自由度，腰轉(zhuǎn)、升降、伸縮。
• 球面坐標(biāo)機器人。主體結(jié)構(gòu)有三個自由度，轉(zhuǎn)動、轉(zhuǎn)動和伸縮。
• 關(guān)節(jié)坐標(biāo)機器人。主體結(jié)構(gòu)有三個自由度，全為轉(zhuǎn)動。

3、傳動方式選擇

• 選擇驅(qū)動源和傳動裝置與關(guān)節(jié)部件的連接、驅(qū)動方式
• 工業(yè)機器人的傳動形式
  • 直接連接傳動
  • 遠距離連接傳動
  • 間接傳動
  • 直接驅(qū)動

4、模塊化結(jié)構(gòu)設(shè)計

模塊化工業(yè)機器人。由一些標(biāo)準(zhǔn)化、系列化的模塊件通過具有特殊功能的結(jié)合部用積木拼搭方式組成的工業(yè)機器人系統(tǒng)。

• 經(jīng)濟性
• 靈活性

模塊化工業(yè)機器人所存在的問題：

• 剛度比較差
• 整體重量有可能增加
• 尚未真正做到根據(jù)作業(yè)對象就可以合理進行模塊化分析和設(shè)計。

5、材料選擇

材料選擇基本要求

• 強度高
• 彈性模量大
• 重量輕
• 阻尼大
• 經(jīng)濟性好

機器人常用材料

• 碳素結(jié)構(gòu)鋼、合金結(jié)構(gòu)鋼
• 鋁、鋁合金及其它輕合金材料
• 纖維增強合金
• 陶瓷
• 纖維增強復(fù)合材料
• 粘彈性大阻尼材料

6、平衡系統(tǒng)設(shè)計

采用平衡系統(tǒng)的理由是：

• 安全
• 借助平衡系統(tǒng)能降低因機器人構(gòu)形變化而導(dǎo)致重力引起關(guān)節(jié)驅(qū)動力矩變化的峰值。
• 借助平衡系統(tǒng)能降低因機器人運動而導(dǎo)致慣性力矩引起關(guān)節(jié)驅(qū)動力矩變化的峰值。
• 借助平衡系統(tǒng)能減少動力學(xué)方程中內(nèi)部耦合項和非線性項，改進機器人動力特性。
• 借助平衡系統(tǒng)能減小機械臂結(jié)構(gòu)柔性所引起的不良影響。
• 借助平衡系統(tǒng)能使機器人運行穩(wěn)定，降低地面安裝要求。

平衡系統(tǒng)設(shè)計的主要途徑：

• 質(zhì)量平衡技術(shù)；
• 彈簧力平衡技術(shù)；
• 可控力平衡技術(shù)。

第二節(jié)：工業(yè)機器人的驅(qū)動與傳動

1、機器人驅(qū)動機構(gòu)

• 直線驅(qū)動機構(gòu)
  • 齒輪齒條裝置
  • 普通絲杠
  • 滾珠絲杠
  • 液壓驅(qū)動（直接平移）
  • 氣壓驅(qū)動（直接平移）
• 旋轉(zhuǎn)驅(qū)動機構(gòu)
  • 齒輪鏈
  • 同步皮帶
  • 諧波齒輪

2、傳動部件的設(shè)計

關(guān)節(jié)(如轉(zhuǎn)動關(guān)節(jié)與移動關(guān)節(jié))

• 轉(zhuǎn)動關(guān)節(jié)：轉(zhuǎn)動關(guān)節(jié)由回轉(zhuǎn)軸、軸承和驅(qū)動機構(gòu)組成。
  • 轉(zhuǎn)動關(guān)節(jié)的形式
  • 軸承
• 移動關(guān)節(jié)：移動關(guān)節(jié)由直線運動機構(gòu)和在整個運動范圍內(nèi)起直線導(dǎo)向作用的直線導(dǎo)軌部分組成。
  • 導(dǎo)軌部分分為滑動導(dǎo)軌、滾動導(dǎo)軌、靜壓導(dǎo)軌和磁懸浮導(dǎo)軌等形式。
  • 一般采用結(jié)構(gòu)緊湊且價格低廉的滾動導(dǎo)軌。
  • 滾動導(dǎo)軌可以按直線導(dǎo)軌的種類、軌道形狀和滾動體分為:
    • 按滾動體分類——球、圓柱滾子和滾針。
    • 按軌道分類——圓軸式、平面式和滾道式。
    • 按滾動體是否循環(huán)分類——循環(huán)式、非循環(huán)式。

傳動件的定位和消隙

• 傳動件的定位
  • 電氣開關(guān)定位
  • 機械擋塊定位
  • 伺服定位系統(tǒng)
• 傳動件的消隙
  • 消隙齒輪
  • 柔性齒輪消隙
  • 對稱傳動消隙
  • 偏心機構(gòu)消隙
  • 齒廓彈性覆層消隙

機器人傳動機構(gòu)(如齒輪、繩與鋼帶傳動等)

• 齒輪傳動
• 絲杠傳動
• 帶傳動與鏈傳動
• 繩傳動與鋼帶傳動
• 桿、連桿與凸輪傳動
• 流體傳動
• 鋼絲+滑輪

3、驅(qū)動裝置的類型和特點

• 電動驅(qū)動裝置
  • 電動驅(qū)動裝置的能源簡單，速度變化范圍大，效率高，速度和位置精度都很高。但它們多與減速裝置相聯(lián)，直接驅(qū)動比較困難
• 液壓驅(qū)動裝置
  • 優(yōu)點：功率大，可省去減速裝置直接與被驅(qū)動的桿件相連，結(jié)構(gòu)緊湊，剛度好，響應(yīng)快，伺服驅(qū)動具有較高的精度。
  • 缺點：需要增設(shè)液壓源，易產(chǎn)生液體泄漏，不適合高、低溫場合，故液壓驅(qū)動目前多用于特大功率的機器人系統(tǒng)。
• 氣動驅(qū)動裝置
  • 氣壓驅(qū)動的結(jié)構(gòu)簡單，清潔，動作靈敏，具有緩沖作用。
  • 但與液壓驅(qū)動裝置相比，功率較小，剛度差，噪音大，速度不易控制，所以多用于精度不高的點位控制機器人。
• 驅(qū)動裝置的選擇原則
  • 驅(qū)動裝置的選擇應(yīng)以作業(yè)要求、生產(chǎn)環(huán)境為先決條件，以價格高低、技術(shù)水平為評價標(biāo)準(zhǔn)。
  • 對于驅(qū)動裝置來說，最重要的指標(biāo)要求是起動力矩大，調(diào)速范圍寬，慣量小，尺寸小，同時還要有性能好、與之配套的數(shù)字控制系統(tǒng)。

4、新型驅(qū)動方式

• 磁致伸縮驅(qū)動
• 形狀記憶合金
• 靜電驅(qū)動器
• 超聲波電機
• 氣動肌肉

第三節(jié)：機身和臂部設(shè)計

1、機身結(jié)構(gòu)的基本形式和特點

機身與臂部的配置形式

• 橫梁式
• 立柱式
• 機座式
• 屈伸式

機身的典型結(jié)構(gòu)

• 回轉(zhuǎn)與升降機身
• 回轉(zhuǎn)與俯仰機身

機身驅(qū)動力(力矩)計算

手臂在總重量W的作用下有一個偏重力矩，而立柱支撐導(dǎo)套中有阻止手臂傾斜的力矩，顯然偏重力矩對升降運動的靈活性有很大影響。

機身設(shè)計要注意的問題

• 剛度和強度大，穩(wěn)定性要好
• 運動靈活，導(dǎo)套不宜過短，避免卡死
• 驅(qū)動方式適宜
• 結(jié)構(gòu)布置合理

2、臂部結(jié)構(gòu)的基本形式和特點

臂部的典型機構(gòu)

• 臂部伸縮機構(gòu)
• 手臂俯仰運動機構(gòu)
• 手臂回轉(zhuǎn)與升降機構(gòu)

3、機器人的平穩(wěn)性和臂桿平衡方法

• 質(zhì)量平衡方法
• 彈簧力平衡方法

第四節(jié)：腕部設(shè)計

1、腕部自由度

• 手腕關(guān)節(jié)的翻轉(zhuǎn)/滾轉(zhuǎn)和偏轉(zhuǎn)/彎轉(zhuǎn)
• RRR手腕

2、腕部典型結(jié)構(gòu)

• 單自由度回轉(zhuǎn)運動手腕
• 二自由度手腕
• 三自由度手腕

3、柔性手腕

• 柔順性裝配技術(shù)：
  • 主動柔順裝配是從檢測、控制的角度出發(fā), 采取各種不同的搜索方法, 實現(xiàn)邊校正邊裝配; 有的手爪還配有檢測元件, 如視覺傳感器力傳感器等
  • 被動柔順裝配。從結(jié)構(gòu)的角度出發(fā), 在手腕部配置一個柔順環(huán)節(jié), 以滿足柔順裝配的需要。

4、腕部設(shè)計注意的問題

• 結(jié)構(gòu)緊湊、重量輕
• 結(jié)構(gòu)簡單，有利于小臂對整機的靜力平衡
• 強度、剛度高
• 設(shè)計合理的與臂和手部的連接部位
• 動作靈活、平穩(wěn)，定位精度高

第五節(jié)：手部設(shè)計

1、手部的分類

• 按用途
• 按夾持原理
  • 機械手爪
  • 磁力吸盤
  • 真空式吸盤
• 按手指或吸盤數(shù)目
  • 按手指數(shù)目：
    • 二指手爪
    • 多指手爪
  • 按手指關(guān)節(jié)：
    • 單關(guān)節(jié)手指手爪
    • 多關(guān)節(jié)手指手爪
  • 吸盤式手爪按吸盤數(shù)目：
    • 單吸盤式手爪
    • 多吸盤式手爪
• 按智能化
  • 普通式（無傳感器）
  • 智能式（有傳感器）

2、手爪的設(shè)計和選用要求

• 被抓握的對象
• 物料饋送器或儲存裝置
• 機器人作業(yè)順序
• 手爪和機器人匹配
• 環(huán)境條件

3、典型的手爪結(jié)構(gòu)

• 夾鉗式取料手
  • 手指：直接與工件接觸的部件。手部松開和夾緊工件, 就是通過手指的張開與閉合來實現(xiàn)的。
    • 指端的形狀通常有兩類: V型指和平面指
    • 指面的形狀常有光滑指面、齒形指面和柔性指面等
  • 傳動機構(gòu)：向手指傳遞運動和動力, 以實現(xiàn)夾緊和松開動作的機構(gòu)。
    • 回轉(zhuǎn)型傳動機構(gòu)
    • 平移型傳動機構(gòu)
• 吸附式取料手
  • 氣吸附式取料手
    • 真空吸附取料手
    • 氣流負壓吸附取料手
    • 擠壓排氣式取料手
  • 磁吸附式取料手

機器人運動形式的選擇

• 直角坐標(biāo)型：機器人的主體結(jié)構(gòu)的關(guān)節(jié)都是移動關(guān)節(jié)。
  • 結(jié)構(gòu)簡單，剛度高。
  • 關(guān)節(jié)之間運動相互獨立，沒有耦合作用。
  • 占地面積大，導(dǎo)軌面防護比較困難
• 圓柱坐標(biāo)型：圓柱坐標(biāo)式機器人主體結(jié)構(gòu)具有三個自由度：腰轉(zhuǎn)、升降和伸縮。亦即具有一個旋轉(zhuǎn)運動和兩個直線運動
  • 通用性較強；結(jié)構(gòu)緊湊；
  • 機器人腰轉(zhuǎn)時將手臂縮回，減少了轉(zhuǎn)動慣量；
  • 受結(jié)構(gòu)限制，手臂不能抵達底部，減少了工作范圍。
• 球面坐標(biāo)式（極坐標(biāo)）：機器人主體結(jié)構(gòu)具有三個自由度，兩個旋轉(zhuǎn)運動和一個直線運動。
  • 工作范圍較大；
  • 占地面積小；
  • 控制系統(tǒng)復(fù)雜。
• SCARA機器人：有3個旋轉(zhuǎn)關(guān)節(jié)，其軸線相互平行，在平面內(nèi)進行定位和定向。另一個是移動關(guān)節(jié)。這種結(jié)構(gòu)輕便、響應(yīng)快。
  • 結(jié)構(gòu)輕便，響應(yīng)快；
  • 適用于平面定位和在垂直方向進行作業(yè)的場合。
• 關(guān)節(jié)式機器人：關(guān)節(jié)式機器人的主體結(jié)構(gòu)的三個自由度腰轉(zhuǎn)關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)全部是轉(zhuǎn)動關(guān)節(jié)。
  • 動作靈活，工作空間大；
  • 關(guān)節(jié)運動部位密封性好；
  • 運動學(xué)復(fù)雜，不便于控制。

第3章 機器人運動學(xué)

第一節(jié) 物體在空間中的位姿描述

1、點的位置描述 P13

在選定的直角坐標(biāo)系{A}，空間任一點P的位置可用3×1的位置矢量AP表示。

2、點的齊次坐標(biāo) P14

將一個n維空間的點用n+1維坐標(biāo)表示，則該n+1維坐標(biāo)稱為該n維空間點的齊次坐標(biāo)。

如用四個數(shù)組成(4×1)列陣

表示三維空間（n維）直角坐標(biāo)系{A}中點p，則列陣[px py pz 1]T稱為三維空間點p的齊次坐標(biāo)（n+1維）。

齊次坐標(biāo)的表示不唯一，仍然代表同一點

3、坐標(biāo)軸方向的描述 P15~19

i、j、k分別是直角坐標(biāo)系中X、Y、Z坐標(biāo)軸的單位向量。若用齊次坐標(biāo)來描述X、Y、Z軸的方向，則有X=[1 0 0 0]T，Y=[0 1 0 0]T，Z=[0 0 0 1]T。

規(guī)定：

• (4×1)列陣[a b c 0]T中第四個元素為零，且a2+b2+c2=1，則a、b、c表示某軸(某矢量)的方向；
• (4×1)列陣[a b c w]T中第四個元素不為零，則表示空間某點的位置。
• 矢量ν的方向用(4×1)列陣可表達為：v=[a b c 0]T，a=cosα,b=cosβ,c=cosγ
• 矢量ν坐落的點O為坐標(biāo)原點，可用(4×1)列陣可表達為：0=[0 0 0 1]T

4、動坐標(biāo)系位姿的描述

動坐標(biāo)系位姿的描述就是對動坐標(biāo)系原點位置的描述以及對動坐標(biāo)系各坐標(biāo)軸方向的描述：

（1）、剛體位置和姿態(tài)的描述

機器人的一個連桿可以看成一個剛體。若給定了剛體上某一點的位置和該剛體在空間的姿態(tài)，則這個剛體在空間上是完全確定的。

剛體Q在固定坐標(biāo)系OXYZ中的位置可用齊次坐標(biāo)形式的一個(4×1)列陣表示為：p=[x0 y0 z0 1]T

剛體的姿態(tài)可由動坐標(biāo)系的坐標(biāo)軸方向來表示。令n、o、a分別為X’、Y’、Z’坐標(biāo)軸的單位方向矢量，每個單位方向矢量在固定坐標(biāo)系上的分量為動坐標(biāo)系各坐標(biāo)軸的方向余弦，用齊次坐標(biāo)形式的(4×1)列陣分別表示為：n = [nx ny nz 0]T，o = [ox oy oz 0]T，a = [ax ay az 0]T。

剛體的位姿可用下面(4×4)矩陣來描述：T = [n o a p]

對剛體Q位姿的描述就是對固連于剛體Q的坐標(biāo)系O’X’Y’Z’位姿的描述。

（2）、手部位置和姿態(tài)的表示

• 機器人手部的位置和姿態(tài)也可以用固連于手部的坐標(biāo)系{B}的位姿來表示
• 關(guān)節(jié)軸為ZB，ZB軸的單位方向矢量α稱為接近矢量，指向朝外。
• 二手指的連線為YB軸，YB軸的單位方向矢量0稱為姿態(tài)矢量，指向可任意選定。
• XB軸與YB軸及ZB軸垂直，XB軸的單位方向矢量n稱為法向矢量，且n=o×α。
• 手部的位置矢量為固定參考系原點指向手部坐標(biāo)系{B}原點的矢量p，手部的方向矢量為n、o、α。于是手部的位姿可用(4×4)矩陣表示為：T = [n o a p]

第二節(jié) 齊次坐標(biāo)變換及換算

剛體的運動是由轉(zhuǎn)動和平移組成的。為了能用同一矩陣表示轉(zhuǎn)動和平移，有必要引入(4×4)的齊次坐標(biāo)變換矩陣。

1、平移的齊次變換 P33

x'=x+△x y'=y+△y z'=z+△z|x`| |1 0 0 △x||x| |y`|=|0 1 0 △y||y| |z`| |0 0 1 △z||z| |1 | |0 0 0 1||1|A'=Trans(△x,△y,△z)ATrans(△x,△y,△z)=|1 0 0 △x| |0 1 0 △y| |0 0 1 △z| |0 0 0 1|

• 若算子左乘，表示坐標(biāo)變換是相對固定坐標(biāo)系進行的；
• 假如相對動坐標(biāo)系進行坐標(biāo)變換，則算子應(yīng)該右乘。

2、旋轉(zhuǎn)的齊次變換

空間某一點A，坐標(biāo)為(x，y，z)，當(dāng)它繞z軸旋轉(zhuǎn)θ角后至A′點，坐標(biāo)為(x′y′z′)，A′點和A點的坐標(biāo)關(guān)系:

x'=xcosθ-ysinθ y'=xsinθ+ycosθ z'=z|x`| |cosθ -sinθ 0||x| |y`|=|sinθ cosθ 0||y| |z`| | 0 0 1||z|A'點和A點的齊次坐標(biāo)分別為[x' y' z' 1]T 和[x y z 1]T，因此A點的旋轉(zhuǎn)齊次變換過程為:|x`| |cosθ -sinθ 0 0||x| |y`|=|sinθ cosθ 0 0||y| |z`| | 0 0 1 0||z| |1 | | 0 0 0 1||1|也可簡寫為：α'=Rot(z, θ)αRot(z, θ)=|cosθ -sinθ 0 0| |sinθ cosθ 0 0| | 0 0 1 0| | 0 0 0 1|Rot(x, θ)=|1 0 0 0| |0 cosθ -sinθ 0| |0 sinθ cosθ 0| |0 0 0 1|Rot(y, θ)=|cosθ 0 sinθ 0| | 0 1 0 0| |-sinθ 0 cosθ 0| | 0 0 0 1|

與平移變換一樣，旋轉(zhuǎn)變換算子不僅僅適用于點的旋轉(zhuǎn)變換，而且也適用于矢量、坐標(biāo)系、物體等旋轉(zhuǎn)變換計算。若相對于固定坐標(biāo)系進行變換，則算子左乘；若相對于動坐標(biāo)系進行變換，則算子右乘。

3、平移加旋轉(zhuǎn)的齊次變換

平移變換和旋轉(zhuǎn)變換可以組合在一個齊次變換中，稱為復(fù)合變換。

平移加旋轉(zhuǎn)的齊次變換也稱為復(fù)合齊次變換或一般齊次變換，它并不限定平移變換或旋轉(zhuǎn)變換的次數(shù)或先后次序。

在運算時規(guī)則同前，凡相對固定坐標(biāo)系進行變換則算子左乘，凡相對動坐標(biāo)系進行變換則算子右乘。上面以點為例作平移和旋轉(zhuǎn)的一般齊次變換，當(dāng)然同樣適用于坐標(biāo)系的一般齊次變換。

第三節(jié) 變換方程的建立

1、多級坐標(biāo)變換

工業(yè)機器人都具有2個以上的自由度，從末端操作器把持中心的坐標(biāo)系到固定坐標(biāo)系的變換要經(jīng)過多級坐標(biāo)變換。

2、多種坐標(biāo)系的變換

為了描述機器人的運動，以便于編程控制，常常需要定義多種坐標(biāo)系。幾種常用的坐標(biāo)系有：基座(固定)坐標(biāo)系{B}、工作臺坐標(biāo)系{S}、手部坐標(biāo)系{H}、工具坐標(biāo)系{T}、工件坐標(biāo)系{G}及通用坐標(biāo)系{U}。

第四節(jié) 工業(yè)機器人連桿參數(shù)及其變換矩陣

Denavit-Hartenberg約定，簡稱DH約定。在此約定中，每個齊次變換矩陣Ai都可以表示為四個基本矩陣的乘積。

P60

其中，4個變量θi, di, ai, αi是與連桿i和關(guān)節(jié)i相關(guān)的參數(shù)。4個參數(shù)ai、 αi、di以及θi, 分別命名為連桿長度（link length）、連桿扭曲（link twist）、連桿偏置（link offset）以及關(guān)節(jié)角度（joint angle）。

1、機器人的連桿參數(shù)

連桿的幾何參數(shù)

連桿兩端有關(guān)節(jié)n和n+1。該連桿尺寸可以用兩個量來描述：一個是兩個關(guān)節(jié)軸線沿公垂線的距離an，稱為連桿長度；另一個是垂直于an的平面內(nèi)兩個軸線的夾角αn，稱為連桿扭角。這兩個參數(shù)為連桿的尺寸參數(shù)。

連桿的關(guān)系參數(shù)

考慮連桿i與相鄰連桿i+1的關(guān)系，若它們通過關(guān)節(jié)相連，其相對位置可用兩個參數(shù)di和θi來確定，其中di是沿關(guān)節(jié)i軸線兩個公垂線的距離，稱為連桿偏置。θi是垂直于關(guān)節(jié)i軸線的平面內(nèi)兩個公垂線的夾角，稱為關(guān)節(jié)角度。

對于轉(zhuǎn)動關(guān)節(jié)，θi為關(guān)節(jié)變量，其他三個連桿固定不變；
對于移動關(guān)節(jié)，di為關(guān)節(jié)變量，其他三個連桿固定不變;
這種用連桿參數(shù)描述機構(gòu)運動關(guān)系的規(guī)則稱為Denavit-Hartenberg參數(shù)，所以對于一個6轉(zhuǎn)動關(guān)節(jié)機器人，需要用18個參數(shù)就可以完全描述這些固定的運動學(xué)參數(shù)，可用6組(ai-1, αi-1, di) 表示。

2、連桿坐標(biāo)系的建立

為了描述每個連桿和相鄰連桿之間的相對位置關(guān)系,需要在每個連桿上定義一個固連坐標(biāo)系。

3、連桿坐標(biāo)系之間的變換矩陣

建立了各連桿坐標(biāo)系后，i-1系與i系間的變換關(guān)系可以用坐標(biāo)系的平移、旋轉(zhuǎn)來實現(xiàn)。

用一個變換矩陣Ai來綜合表示上述四次變換時應(yīng)注意到坐標(biāo)系在每次旋轉(zhuǎn)或平移后發(fā)生了變動，后一次變換都是相對于動系進行的，因此在運算中變換算子應(yīng)該右乘。

第五節(jié)：工業(yè)機器人運動學(xué)方程

1、機器人運動學(xué)方程

為機器人的每一個連桿建立一個坐標(biāo)系，并用齊次變換來描述這些坐標(biāo)系間的相對關(guān)系，也叫相對位姿。

通常把描述一個連桿坐標(biāo)系與下一個連桿坐標(biāo)系間相對關(guān)系的齊次變換矩陣叫做A變換矩陣或A矩陣。

對于六連桿機器人，有下列矩陣：T6 = A1A2A3A4A5A6，即機器人運動學(xué)方程

此式右邊表示了從固定參考系到手部坐標(biāo)系的各連桿坐標(biāo)系之間的變換矩陣的連乘，左邊T6表示這些變換矩陣的乘積，也就是手部坐標(biāo)系相對于固定參考系的位姿。

2、正向運動學(xué)及實例

正向運動學(xué)主要解決機器人運動學(xué)方程的建立及手部位姿的求解問題。

3、機器人逆向運動學(xué)

反向運動學(xué)解決的問題是：已知手部的位姿，求各個關(guān)節(jié)的變量。

第4章 機器人靜力學(xué)及動力學(xué)

第一節(jié)：工業(yè)機器人速度雅可比與速度分析

1、速度雅克比矩陣

數(shù)學(xué)上雅可比矩陣(Jacobian matrix)是一個多元函數(shù)/多變量的偏導(dǎo)矩陣。

假設(shè)有六個函數(shù)，每個函數(shù)有六個變量，即：

y1 = f1(x1, x2, x3, x4, x5, x6)
y2 = f2(x1, x2, x3, x4, x5, x6)
y3 = f3(x1, x2, x3, x4, x5, x6)
y4 = f4(x1, x2, x3, x4, x5, x6)
y5 = f5(x1, x2, x3, x4, x5, x6)
y6 = f6(x1, x2, x3, x4, x5, x6)

可寫成：Y = F(X)

將其微分，得：

dy1 = (?f1/?x1)dx1 + (?f1/?x2)dx2 + … + (?f1/?x6)dx6
dy2 = (?f2/?x1)dx1 + (?f2/?x2)dx2 + … + (?f2/?x6)dx6
dy3 = (?f3/?x1)dx1 + (?f3/?x2)dx2 + … + (?f3/?x6)dx6
dy4 = (?f4/?x1)dx1 + (?f4/?x2)dx2 + … + (?f4/?x6)dx6
dy5 = (?f5/?x1)dx1 + (?f5/?x2)dx2 + … + (?f5/?x6)dx6
dy6 = (?f6/?x1)dx1 + (?f6/?x2)dx2 + … + (?f6/?x6)dx6

可簡寫成dY = (?F/?X)dX，其中，?F/?X叫做雅可比矩陣，一般用符號J表示

將J稱為二自由度平面關(guān)節(jié)型工業(yè)機器人的速度雅可比，它反映了關(guān)節(jié)空間微小運動dθ與手部作業(yè)空間微小位移dX之間的關(guān)系。

若對雅可比矩陣進行運算，則2R工業(yè)機器人可寫出雅可比

dX反映了操作空間的微小運動，它由工業(yè)機器人手部微小線位移和微小角位移(微小轉(zhuǎn)動)組成。

對于n自由度機器人的情況，關(guān)節(jié)變量可用廣義關(guān)節(jié)變量：

q＝[qi q2 … qn]T

轉(zhuǎn)動關(guān)節(jié)：qi＝θi，移動關(guān)節(jié)：qi＝di

dq＝[dqi dqi … dqn]T反映了關(guān)節(jié)空間的微小運動

手部在操作空間的運動參數(shù)用X表示，它是關(guān)節(jié)變量的函數(shù)，即X＝X(q)，并且是一個6維列向量。

dX＝[dx dy dz δφx δφy δφz]T

dX反映了操作空間的微小運動，它由工業(yè)機器人手部微小線位移和微小角位移(微小轉(zhuǎn)動)組成。

因此，參照前面的式子可寫出類似的方程式，即：dX＝J(q)dq

式中J(q)是6×n的偏導(dǎo)數(shù)矩陣，稱為n自由度工業(yè)機器人速度雅可比矩陣。它反映了關(guān)節(jié)空間微小運動dq與手部作業(yè)空間微小運動dX之間的關(guān)系。

2、機器人速度分析

• 對式dX＝J(q)dq左、右兩邊各除以dt，得：V = J(q)q`，其中
  • V代表工業(yè)機器人手部在操作空間中的廣義速度，V = X’
  • q`代表工業(yè)機器人關(guān)節(jié)在關(guān)節(jié)空間中的關(guān)節(jié)速度
  • J(q)代表確定關(guān)節(jié)空間速度q`與操作空間速度V之間關(guān)系的雅可比矩陣

假如給定工業(yè)機器人手部速度，可由式V = J(q)q`解出相應(yīng)的關(guān)節(jié)速度，即：

q` = (J^-1)V

式中：J^-1稱為工業(yè)機器人逆速度雅可比。

當(dāng)希望工業(yè)機器人手部在空間按規(guī)定的速度進行作業(yè)，那么用上式可以計算出沿路徑上每一瞬時相應(yīng)的關(guān)節(jié)速度。

• 一般來說，求J^-1是比較困難的，有時還會出現(xiàn)奇異解，就無法解算關(guān)節(jié)速度。
• 通常J^-1出現(xiàn)奇異解的情況有下面兩種：
  • 工作域邊界上奇異。當(dāng)臂全部伸展開或全部折回而使手部處于工作域的邊界上或邊界附近時，出現(xiàn)J^-1奇異，這時工業(yè)機器人相應(yīng)的位形叫做奇異位形。
  • 工作域內(nèi)部奇異。奇異也可以是由兩個或更多個關(guān)節(jié)軸線重合所引起的。
• 當(dāng)工業(yè)機器人處在奇異形位時，就會產(chǎn)生退化現(xiàn)象，喪失一個或更多自由度。這意味著在空間某個方向(或子域)上，不管工業(yè)機器人關(guān)節(jié)速度怎樣選擇，手部也不可能實現(xiàn)移動。

總結(jié)：

奇異點不是機械特性，而是數(shù)學(xué)特性，因此奇異點只存在于軌跡運動（笛卡爾坐標(biāo)系）范圍內(nèi)，而在軸運動時不存在。

第二節(jié)：機器人靜力學(xué)分析計算

1、力和力矩分析

假如已知外界環(huán)境對工業(yè)機器人最末桿的作用力和力矩，那么可以由最后一個連桿向第零號連桿(機座)依次遞推，從而計算出每個連桿上的受力情況。

各關(guān)節(jié)驅(qū)動器的驅(qū)動力或力矩可寫成一個n維矢量的形式，即：

τ = [τ1 τ2 τ3 τ4 τ5 τ6]T

式中，n表示關(guān)節(jié)的個數(shù)，τ表示關(guān)節(jié)力矩(或關(guān)節(jié)力)矢量，簡稱廣義關(guān)節(jié)力矩。

2、工業(yè)機器人力的雅克比矩陣

虛功原理

約束力不做功的力學(xué)系統(tǒng)實現(xiàn)平衡的必要且充分條件是對結(jié)構(gòu)上允許的任意位移（虛位移）施力所做功之和為零。這里所指的虛位移（virtual displacement）是描述作為對象的系統(tǒng)力學(xué)結(jié)構(gòu)的位移，不同于隨時間一起產(chǎn)生的實際位移。

假定關(guān)節(jié)無摩擦，并忽略各桿件的重力，則廣義關(guān)節(jié)力矩τ與工業(yè)機器人手部端點力F 的關(guān)系可用下式描述：

τ＝(JT)F

式中：JT為n×6階工業(yè)機器人力雅可比矩陣或力雅可比。

很明顯，力雅可比JT正好是工業(yè)機器人速度雅可比J的轉(zhuǎn)置！

3、機器人靜力計算的兩類問題

• 從操作臂手部端點力F與廣義關(guān)節(jié)力矩τ之間的關(guān)系式τ＝(JT)F可 知，操作臂靜力學(xué)可分為兩類問題：
  • 已知外界環(huán)境對工業(yè)機器人手部作用力F’(即手部端點力F = -F’)，求相應(yīng)的滿足靜力學(xué)平衡條件的關(guān)節(jié)驅(qū)動力矩τ。
  • 已知關(guān)節(jié)驅(qū)動力矩τ，確定工業(yè)機器人手部對外界環(huán)境的作用力F或負荷的質(zhì)量。
• 第二類問題是第一類問題的逆解。這時F＝((JT)^-1)τ

運動學(xué)、靜力學(xué)、動力學(xué)的關(guān)系：

在機器人的手爪接觸環(huán)境時，手爪力F與驅(qū)動力τ的關(guān)系起重要作用，在靜止?fàn)顟B(tài)下處理這種關(guān)系稱為靜力學(xué)（statics）。

在考慮控制時，就要考慮在機器人的動作中，關(guān)節(jié)驅(qū)動力τ會產(chǎn)生怎樣的關(guān)節(jié)位置θ，關(guān)節(jié)速度θ’和關(guān)節(jié)加速度θ’’，處理這種關(guān)系稱為動力學(xué)（dynamics）。

第三節(jié)：機器人動力學(xué)分析

在控制方面，機器人的動態(tài)實時控制是機器人發(fā)展的必然要求。需要對機器人的動力學(xué)進行分析。機器人是一個非線性的復(fù)雜的動力學(xué)系統(tǒng)。

動力學(xué)研究物體的運動和作用力之間的關(guān)系。機器人動力學(xué)方程是機器人機械系統(tǒng)的運動方程，表示機器人各關(guān)節(jié)的位置、速度、加速度與各關(guān)節(jié)執(zhí)行器驅(qū)動力矩之間的關(guān)系。機器人動力學(xué)問題有下述兩類相反的問題：

• 給出已知的軌跡點上的θ, θ’, θ’’，即機器人關(guān)節(jié)位置、速度和加速度，求相應(yīng)的關(guān)節(jié)力矩向量T。這對實現(xiàn)機器人動態(tài)控制是相當(dāng)有用的。這是動力學(xué)逆問題。
• 已知關(guān)節(jié)驅(qū)動力矩，求機器人系統(tǒng)相應(yīng)的各瞬時的運動。也就是說，給出關(guān)節(jié)力矩向量τ，求機器人所產(chǎn)生的運動 θ, θ’, θ’’。這對模擬機器人的運動是非常有用的。這是動力學(xué)正問題。

機器人的動力學(xué)正問題主要用于機器人的運動仿真。

研究機器人動力學(xué)逆問題目的：

• 為了對機器人的運動進行有效的實時控制，以實現(xiàn)預(yù)期的軌跡運動，并達到良好的動態(tài)性能指標(biāo)。
• 由于機器人是個復(fù)雜的動力學(xué)系統(tǒng)，有多個連桿和關(guān)節(jié)組成，具有多個輸入和多個輸出，存在著錯綜復(fù)雜的關(guān)系和嚴重的非線性，所以動力學(xué)的實時計算很復(fù)雜，在實際控制時需要做一些簡化假設(shè)。

動力學(xué)正問題：機器人各關(guān)節(jié)的驅(qū)動力或力矩已知，求解機器人的運動，包括關(guān)節(jié)變量（位移、速度和加速度）在關(guān)節(jié)變量空間的軌跡或末端執(zhí)行器在笛卡爾空間的軌跡。主要用于仿真。

動力學(xué)逆問題：機器人在關(guān)節(jié)變量空間的軌跡（位移、速度和加速度）已確定，或末端執(zhí)行器在笛卡爾空間的軌跡已確定，求解機器人各關(guān)節(jié)的驅(qū)動力或力矩。主要用于控制。

1、牛頓—歐拉方程

牛頓—歐拉方法直接利用牛頓力學(xué)的剛體動力學(xué)知識，導(dǎo)出機器人逆動力學(xué)的遞推公式，即已知機器人各連桿的速度、角速度及轉(zhuǎn)動慣量，就可以利用牛頓—歐拉剛體動力學(xué)公式導(dǎo)出機器人各關(guān)節(jié)執(zhí)行器的驅(qū)動力及驅(qū)動力矩的遞推公式。然后再由它歸納出機器人動力學(xué)的數(shù)學(xué)模型—機器人機械系統(tǒng)的矩陣形式的運動方程。

連桿的速度與加速度分析

機器人一般由多個連桿通過轉(zhuǎn)動或移動關(guān)節(jié)連接而成，為了用牛頓—歐拉法建立機器人的動力學(xué)方程，需要討論機器人的瞬時運動狀態(tài)，分析組成機器人的各連桿的速度和加速度及其運動的傳遞。

動力學(xué)基本方程

一個剛體的運動可分解為固定在剛體上的任意一點的移動以及該剛體繞這一定點的轉(zhuǎn)動兩部分。剛體動力學(xué)方程也可以用兩個方程表達：一個用以描述質(zhì)心的移動，另一個描述質(zhì)心的轉(zhuǎn)動，前者稱為質(zhì)點運動方程（牛頓運動方程），后者稱為歐拉運動方程。

2、拉格朗日運動方程

拉格朗日方法不僅能以最簡單的形式求得非常復(fù)雜的系統(tǒng)動力學(xué)方程，而且具有顯式結(jié)構(gòu)，物理意義比較明確，對理解機器人動力學(xué)比較方便。

拉格朗日函數(shù)

拉格朗日函數(shù)L的定義是一個機械系統(tǒng)的動能Ek和勢能Ep之差

拉格朗日方程

Fi = (d/dt)(?L/?qi’) - (?L/?qi)

式中：Fi稱為關(guān)節(jié)廣義驅(qū)動力。如果是移動關(guān)節(jié)，則Fi為驅(qū)動力；如果是轉(zhuǎn)動關(guān)節(jié)，則Fi為驅(qū)動力矩。

用拉格朗日法建立機器人動力學(xué)方程的步驟

• 選取坐標(biāo)系，選定完全而且獨立的廣義關(guān)節(jié)變量qi，i=1,2, …, n。
• 選定相應(yīng)的關(guān)節(jié)上的廣義力Fi，當(dāng)qi是位移變量時，則Fi為力；當(dāng)qi是角度變量時，則Fi為力矩。
• 求出機器人各構(gòu)件的動能和勢能，構(gòu)造拉格朗日函數(shù)。
• 代入拉格朗日方程求得機器人系統(tǒng)的動力學(xué)方程。

第5章 機器人軌跡規(guī)劃

第一節(jié)：工業(yè)機器人軌跡規(guī)劃

1、工業(yè)機器人軌跡規(guī)劃的定義

軌跡規(guī)劃是指根據(jù)作業(yè)任務(wù)要求，確定軌跡參數(shù)并實時計算和生成運動軌跡。它是工業(yè)機器人控制的依據(jù)，所有控制的目的都在于精確實現(xiàn)所規(guī)劃的運動。

2、軌跡規(guī)劃的一般性問題

工業(yè)機器人的作業(yè)可以描述成工具坐標(biāo)系{T}相對于工作坐標(biāo)系{S}的一系列運動：

用工具坐標(biāo)系{T}相對于工作坐標(biāo)系{S}的運動來描述作業(yè)路徑是一種通用的作業(yè)描述方法

把作業(yè)路徑的描述與具體的機器人、手爪或工具分離開來，形成了模型化的作業(yè)描述方法。從而使這種描述既適用于不同的機器人，也適用于同一機器人上裝夾不同規(guī)格的工具。

• 當(dāng)需要更詳細地描述運動時，不僅要規(guī)定機器人的起始點和終止點，而且要給出介于起始點和終止點之間的中間點，也稱路徑點。

• 運動軌跡除了位姿約束外，還存在著各路徑點之間的時間分配問題。例如，在規(guī)定路徑的同時，必須給出兩個路徑點之間的運動時間。

• 機器人的運動應(yīng)當(dāng)平穩(wěn)，不平穩(wěn)的運動將加劇機械部件的磨損，并導(dǎo)致機器人的振動和沖擊。

  • 一階導(dǎo)數(shù)(速度)，有時甚至二階導(dǎo)數(shù)(加速度)也應(yīng)該連續(xù)。

• 軌跡規(guī)劃既可在關(guān)節(jié)空間中進行，也可在直角坐標(biāo)空間中進行。

  • 在關(guān)節(jié)空間中進行軌跡規(guī)劃是指將所有關(guān)節(jié)變量表示為時間的函數(shù)，用這些關(guān)節(jié)函數(shù)及其一階、二階導(dǎo)數(shù)描述機器人預(yù)期的運動。

• 在直角坐標(biāo)空間中進行軌跡規(guī)劃，是指將手爪位姿、速度和加速度表示為時間的函數(shù)，而相應(yīng)的關(guān)節(jié)位置、速度和加速度由手爪信息導(dǎo)出。

3、軌跡規(guī)劃的生成方式

• 運動軌跡的描述或生成有以下幾種方式：
  • 示教—再現(xiàn)運動
  • 即由人手把手示教機器人，定時記錄各關(guān)節(jié)變量，得到沿路徑運動時各關(guān)節(jié)的位移時間函數(shù)；再現(xiàn)時，按內(nèi)存中記錄的各點的值產(chǎn)生序列動作。
  • 關(guān)節(jié)空間運動
    • 這種運動直接在關(guān)節(jié)空間里進行。由于動力學(xué)參數(shù)及其極限值直接在關(guān)節(jié)空間中描述，所以用這種方式求費時最短的運動很方便。
  • 空間直線運動
    • 這是一種直角空間里的運動，它便于描述操作空間，計算量小，適宜于簡單的作業(yè)。
  • 空間曲線運動
    • 這是一種在描述空間中可用明確的函數(shù)表達的運動，如圓周運動、螺旋運動等。

第二節(jié)：關(guān)節(jié)空間法

• 機器人作業(yè)路徑點通常由工具坐標(biāo)系{T}相對于工作坐標(biāo)系{S}的位姿來表示，因此，在關(guān)節(jié)空間中進行軌跡規(guī)劃：
  • 首先需要將每個作業(yè)路徑點向關(guān)節(jié)空間變換，即用逆運動學(xué)方法把路徑點轉(zhuǎn)換成關(guān)節(jié)角度值，或稱關(guān)節(jié)路徑點；
  • 然后，為每個關(guān)節(jié)相應(yīng)的關(guān)節(jié)路徑點擬合光滑函數(shù)；
  • 這些關(guān)節(jié)函數(shù)分別描述了機器人各關(guān)節(jié)從起始點開始，依次通過路徑點，最后到達某目標(biāo)點的運動軌跡。由于每個關(guān)節(jié)在相應(yīng)路徑段運行的時間相同，這樣就保證了所有關(guān)節(jié)都將同時到達路徑點和目標(biāo)點，從而也保證了工具坐標(biāo)系在各路徑點具有預(yù)期的位姿。

1、三次多項式插值

在關(guān)節(jié)空間中用通過起始點關(guān)節(jié)角和終止點關(guān)節(jié)角的一個平滑軌跡函數(shù)θ(t)來表示末端操作器實現(xiàn)兩位姿的運動軌跡描述。

• 為了實現(xiàn)關(guān)節(jié)的平穩(wěn)運動，每個關(guān)節(jié)的軌跡函數(shù)θ(t)至少需要滿足四個約束條件：兩端點位置約束和兩端點速度約束：
  • 端點位置約束是指起始位姿和終止位姿分別所對應(yīng)的關(guān)節(jié)角度；
  • 為滿足關(guān)節(jié)運動速度的連續(xù)性要求，在起始點和終止點的關(guān)節(jié)速度可簡單地設(shè)定為零

2、過路徑點的三次多項式插值

機器人作業(yè)除在A、B點有位姿要求外，在路徑點C、D…也有位姿要求。對于這種情況，假如終端執(zhí)行器在路徑點停留，即各路徑點上速度為0，則軌跡規(guī)劃可連續(xù)直接使用前面介紹的三次多項式插值方法；但如果只是經(jīng)過，并不停留，就需要將前述方法推廣。

3、五次多項式插值

除了指定運動段的起始點和終止點的位置和速度外，也可以指定該運動段的起始點和終止點加速度。這樣，約束條件的數(shù)量就增加到了6個，相應(yīng)地可采用5次多
項式來規(guī)劃軌跡運動。

4、用拋物線過渡的線性插值

• 在關(guān)節(jié)空間軌跡規(guī)劃中，對于給定起始點和終止點的情況，選擇線性函數(shù)插值較為簡單。然而，單純線性插值會導(dǎo)致起始點和終止點的：
  • 關(guān)節(jié)運動速度不連續(xù)，
  • 以及加速度無窮大，
  • 顯然，這樣在兩端點會造成剛性沖擊。
• 為此，對線性函數(shù)插值方案進行修正，
  • 在線性插值兩端點的鄰域內(nèi)設(shè)置一段拋物線形緩沖區(qū)段。
  • 由于拋物線函數(shù)對于時間的二階導(dǎo)數(shù)為常數(shù)，即相應(yīng)區(qū)段內(nèi)的加速度恒定，
  • 這樣可保證起始點和終止點的速度平滑過渡，
  • 從而使整個軌跡上的位置和速度連續(xù)。

第三節(jié)：直角坐標(biāo)空間法

1、直角坐標(biāo)空間描述

假設(shè)末端操作器要在A、 B兩點之間畫一條直線。為使機器人從點A沿直線運動到點B，

• 將直線AB分成許多小段，并使機器人的運動經(jīng)過所有的中間點。
• 為了完成該任務(wù)，在每一個中間點處都要求解機器人的逆運動學(xué)方程，計算出一系列的關(guān)節(jié)量。
• 然后由控制器驅(qū)動關(guān)節(jié)到達下一目標(biāo)點。當(dāng)通過所有的中間目標(biāo)點時，機器人便到達了所希望到達的點B。
• 與前面提到的關(guān)節(jié)空間描述不同，這里機器人在所有時刻的位形運動都是已知的，機器人所產(chǎn)生的運動序列首先在直角坐標(biāo)空間描述，然后轉(zhuǎn)化為關(guān)節(jié)空間描述。

由此也容易看出，采用直角坐標(biāo)空間描述的計算量遠大于采用關(guān)節(jié)空間描述的，然而使用該方法能得到一條可控、可預(yù)知的路徑。

• 直角坐標(biāo)空間軌跡在常見的直角坐標(biāo)空間中表示，因此非常直觀，人們也能很容易地看到機器人末端操作器的軌跡。
• 然而，直角坐標(biāo)空間軌跡計算量大，需要較快的處理速度才能得到類似于關(guān)節(jié)空間軌跡的計算精度。
• 此外，雖然在直角坐標(biāo)空間中得到的軌跡非常直觀，但難以確保不存在奇異點。

現(xiàn)有的多數(shù)工業(yè)機器人軌跡規(guī)劃器都具有關(guān)節(jié)空間和直角坐標(biāo)空間軌跡生成兩種功能。用戶通常使用關(guān)節(jié)空間法，只有在必要時，才采用直角坐標(biāo)空間法。

2、直角坐標(biāo)空間的軌跡規(guī)劃

直角坐標(biāo)空間軌跡規(guī)劃與關(guān)節(jié)空間軌跡規(guī)劃的根本區(qū)別在于，關(guān)節(jié)空間軌跡規(guī)劃函數(shù)生成的值是關(guān)節(jié)變量，而直角坐標(biāo)空間軌跡規(guī)劃函數(shù)生成的值是機器人末端操作器的位姿，需要通過求解逆運動學(xué)方程才能轉(zhuǎn)化為關(guān)節(jié)變量。因此，進行直角坐標(biāo)空間軌跡規(guī)劃時必須反復(fù)求解逆運動學(xué)方程，以計算關(guān)節(jié)角。

第四節(jié)：軌跡的實時生成

1、關(guān)節(jié)空間軌跡的生成

按照關(guān)節(jié)空間軌跡規(guī)劃的方法所得的計算結(jié)果都是有關(guān)各個路徑段的數(shù)據(jù)。控制系統(tǒng)的軌跡生成器利用這些數(shù)據(jù)以軌跡更新的速率具體計算出關(guān)節(jié)的位置、速度和加速度。

對于三次多項式，軌跡生成器只需要隨 t 的變化不斷按公式計算位置、速度和加速度。當(dāng)?shù)竭_路徑段的終止點時，調(diào)用新路徑段的三次多項式系數(shù)，重新把 t 置成零，繼續(xù)生成軌跡即可。

2、直角坐標(biāo)空間軌跡的生成

先根據(jù)逆運動學(xué)求出關(guān)節(jié)運動軌跡，即先把操作空間變量轉(zhuǎn)換成關(guān)節(jié)角矢量，然后再由數(shù)值微分計算關(guān)節(jié)的速度和加速度。

最后，將軌跡規(guī)劃器所生成的關(guān)節(jié)的位置、速度和加速度送往機器人的控制系統(tǒng)。至此軌跡規(guī)劃的任務(wù)才算完成。

第6章 移動機器人

第一節(jié)：移動機器人的類型及特點

1、移動機器人的概述

移動機器人是一種自動執(zhí)行工作的機器裝置。它既可以接受人類指揮，又可以運行預(yù)先編排的程序，也可以根據(jù)以人工智能技術(shù)制定的原則綱領(lǐng)行動。

機器人行走結(jié)構(gòu)按照其運動軌跡可分為固定式軌跡和無固定式軌跡兩種。固定式軌跡主要用于工業(yè)機器人；無固定軌跡就是指具有移動功能的移動機器人。

從移動機器人所處環(huán)境看，可以分為結(jié)構(gòu)環(huán)境和非結(jié)構(gòu)環(huán)境兩類。 結(jié)構(gòu)環(huán)境一般采用車輪式移動結(jié)構(gòu)。非結(jié)構(gòu)環(huán)境領(lǐng)域，可參考自然界動物的移動機構(gòu)，也可以利用人們開發(fā)的履帶，設(shè)計履帶式移動機構(gòu)。

2、機器人行走結(jié)構(gòu)的特點及應(yīng)用

結(jié)構(gòu)形式優(yōu)點缺點

輪式移動機器人	承載大、機構(gòu)簡單、驅(qū)動和控制相對方便，工作效率高。	環(huán)境適應(yīng)力較差
履帶式移動結(jié)構(gòu)	附著性能和通過性能好，平穩(wěn)性高，良好的自復(fù)位能力	速度較慢、功耗較大、轉(zhuǎn)向時對地面破壞程度大
腿式機器人	能適應(yīng)復(fù)雜的地形	結(jié)構(gòu)自由度太多、機構(gòu)復(fù)雜，導(dǎo)致難于控制、移動速度慢
蛇行式移動結(jié)構(gòu)和跳躍式移動結(jié)構(gòu)	可適應(yīng)復(fù)雜環(huán)境、特殊環(huán)境，機動性強	承載能力低、運動平穩(wěn)性差
復(fù)合式機器人	能適應(yīng)復(fù)雜環(huán)境或某些特殊環(huán)境，可以變形	結(jié)構(gòu)及控制系統(tǒng)復(fù)雜

相比之下，輪式移動機器人由于其具有自重輕、承載大、機構(gòu)簡單、驅(qū)動和控制相對方便、行走速度快、機動靈活、工作效率高等優(yōu)點，而被大量應(yīng)用于工業(yè)、農(nóng)業(yè)、反恐防爆、家庭、空間探測等領(lǐng)域。

3、常見的行走結(jié)構(gòu)

• 車輪式移動結(jié)構(gòu)
• 履帶式移動結(jié)構(gòu)
• 步行式移動結(jié)構(gòu)
• 爬壁機器人
• 管內(nèi)外移動機器人

第二節(jié)：輪式移動機器人

1、地面移動機器人車輪形式

在輪式地面移動機器人中，車輪的形狀或結(jié)構(gòu)形式取決于地面的性質(zhì)和車輛的承載能力。室外路面行駛的采用充氣輪胎，室內(nèi)平坦地面上的可采用實心輪胎。

2、地面移動機器人車輪的配置和轉(zhuǎn)向機構(gòu)

車輪式移動機構(gòu)依據(jù)車輪的多少分為1輪、2輪、3輪、4輪以及多輪機構(gòu)。

1輪和2輪移動機構(gòu)在實現(xiàn)上的主要障礙是穩(wěn)定性問題。

實際應(yīng)用的輪式移動機構(gòu)多為3輪和4輪。

三輪移動機構(gòu)：

• 三輪移動結(jié)構(gòu)是車輪式機器人的基本移動結(jié)構(gòu)，其結(jié)構(gòu)是后輪用兩輪獨立驅(qū)動，前輪用小腳輪實現(xiàn)轉(zhuǎn)向。
  • 這種結(jié)構(gòu)的特點是結(jié)構(gòu)組成簡單，而且旋轉(zhuǎn)半徑可以從0到無限大，任意設(shè)定。
• 常見的三輪移動機構(gòu)布置方式有：
  • 兩個后輪獨立驅(qū)動，前輪僅起支承作用，靠后兩輪的轉(zhuǎn)動速度差實現(xiàn)轉(zhuǎn)向；
  • 也有采用前輪驅(qū)動前輪轉(zhuǎn)向的方式；
  • 還有利用后輪差動減速器驅(qū)動前輪轉(zhuǎn)向的方式。

四輪移動機構(gòu)：

四輪車的驅(qū)動機構(gòu)為兩輪獨立驅(qū)動，能夠?qū)崿F(xiàn)整車靈活的零半徑回轉(zhuǎn)，類似汽車的結(jié)構(gòu)方式，適合于高速行走，小型機器人不大采用。

其他移動機構(gòu)：

• 上下臺階車輪式結(jié)構(gòu)
• 全方位移動車
• 全向移動機器人靈活、自由度高
  • 三輪全向移動機器人
  • 四輪全向移動機器人
• 全向車輪技術(shù)可以使車輪沿任意方向移動，各個車輪的運動互不相干，使車輛不僅可以前進和側(cè)移，而且還可以沿對角線運動和做圓周運動。

全向移動機器人：運動學(xué)模型

• 正運動學(xué)模型（forward kinematic model）：通過四個輪子的速度計算底盤的運動狀態(tài)；
• 逆運動學(xué)模型（inverse kinematic model）：根據(jù)底盤的運動狀態(tài)解算四個輪子的速度

3、三輪移動機器人運動分析

兩后輪獨立驅(qū)動移動機構(gòu)的運動分析：

xoy為固定的基礎(chǔ)坐標(biāo)系。P點為小車上的固定點，后輪的驅(qū)動速度分別為v1和v2，跨度為B。θ為車體縱軸線與x軸的夾角，φ角為前輪相對于本體的偏轉(zhuǎn)角。

前輪驅(qū)動三輪移動機構(gòu)運動分析：

前輪驅(qū)動速度為v，操舵轉(zhuǎn)速為ω

第三節(jié)：履帶式移動機器人

1、履帶移動機器人的本體結(jié)構(gòu)

履帶機構(gòu)的形狀

• 常見的履帶移動機構(gòu)有兩種形式：
  • 驅(qū)動輪及導(dǎo)向輪兼作支承輪,增大了支承面面積，提高了穩(wěn)定性
  • 不作支承輪的驅(qū)動輪與導(dǎo)向輪，裝得高于地面，其好處是適合于穿越障礙。

支承輪

• 履帶式移動機器人的重力主要是通過支承輪壓于履帶板的軌道傳遞到地面上。根據(jù)履帶支承輪傳遞壓力的情況，分為：
• 多支點式
• 少支點式

履帶板

• 一般情況，每條履帶是由幾十塊履帶板和鏈軌等組成。根據(jù)履帶板的結(jié)構(gòu)不同，履帶板可分為：
  • 整體式
  • 組合式

驅(qū)動輪和向輪

履帶兩端的導(dǎo)向輪哪一個用來驅(qū)動更為合適與履帶機構(gòu)的形狀有關(guān)，驅(qū)動輪齒數(shù)通常為8～10。

履帶張緊裝置

履帶架

• 履帶移動機構(gòu)的承載架可以制成剛性的，也可以制成活動的：
  • 剛性履帶架：
    • 其優(yōu)點是結(jié)構(gòu)簡單；
    • 缺點是當(dāng)?shù)孛娌黄綍r，履帶受力極不均勻。
  • 活動的履帶架：
    • 可以大大改善載荷的不均勻
    • 但結(jié)構(gòu)比較復(fù)雜

2、履帶移動機器人的越障原理

帶前擺臂的關(guān)節(jié)式履帶移動機器人,只要保證行走機構(gòu)在結(jié)構(gòu)設(shè)計上至少能夠同時與兩個臺階點接觸，就可以使機器人在行走機構(gòu)的作用下向上爬。

第四節(jié)：足式機器人

• 足式機器人可以認為是“一種由計算機控制的用足機構(gòu)推進的表面移動機械電子裝置。足式機器人具有獨特的功能：
  • 足式運動具有較好的機動性
  • 足式運動系統(tǒng)可以主動隔振，即允許機身運動軌跡與足式運動軌跡解耦。盡管地面高低不平，機身運動仍可做到相當(dāng)平穩(wěn)。
  • 足式運動系統(tǒng)在不平地面和松軟地面上的運動速度較高，而能耗較少。
• 足式機器人主要設(shè)計難點是機器人跨步時自動轉(zhuǎn)移重心而保持平衡的問題。
• 足式機器人用于工程探險勘測或軍事偵察等人類無法完成的或危險的工作；也可開發(fā)成娛樂機器人玩具或家用服務(wù)機器人，具有廣泛的適應(yīng)性。

1、足式機器人的腿機構(gòu)

• 從運動角度出發(fā)，腿部機構(gòu)一般處于支撐狀態(tài)相對于機身走直線軌跡，同時支撐足驅(qū)動協(xié)調(diào)運動和機身姿態(tài)的控制。腿機構(gòu)必須具備與整機重量相適應(yīng)的剛性和承載能力。但結(jié)構(gòu)不能過于復(fù)雜，否則會導(dǎo)致結(jié)構(gòu)和傳動的實現(xiàn)發(fā)生困難。
• 足式機器人腿機構(gòu)分為開鏈機構(gòu)和閉鏈機構(gòu)兩大類：
  • 開鏈機構(gòu)的特點是工作空間大，結(jié)構(gòu)簡單，但承載能力小。
  • 閉鏈機構(gòu)一般剛性好，承載能力大，但工作空間有局限性。

2、足式機器人的發(fā)展過程

1968年，美國的R. Smosher試制了一臺叫“Rig”的操縱型雙足步行機器人機械，從而揭開了仿人機器人研制的序幕。

3、雙足機器人動力學(xué)模型

• 雙足機器人系統(tǒng)是相當(dāng)復(fù)雜的多變量時變非線性系統(tǒng)。其復(fù)雜程度與兩足機器人的自由度多少有關(guān)。
• 利用拉格朗日方程建立的兩足步行機構(gòu)WL-3型的動力學(xué)模型，為簡化分析，做
  如下假設(shè)：
  • 腿只在前進平面內(nèi)運動；
  • 腿由剛性桿件構(gòu)成，桿件之間用關(guān)節(jié)連接，關(guān)節(jié)軸與運動平面正交，各桿件質(zhì)量均布。
• 這一模型中，每條腿有4個自由度，分別為髖關(guān)節(jié)、膝關(guān)節(jié)、踝關(guān)節(jié)和腳尖關(guān)節(jié)。
  • 當(dāng)腿處于支撐相時，按3自由度倒立擺處理；
  • 當(dāng)腿處于懸空相時，以3自由度復(fù)擺處理，

混合機構(gòu)機器人

• 輪足式機器人
• 履帶-足式機器人

第7章 多指靈巧手

第一節(jié) 多指靈巧手的結(jié)構(gòu)設(shè)計

1、手指關(guān)節(jié)運動副形式

• 單軸關(guān)節(jié)：滑車關(guān)節(jié)和車軸關(guān)節(jié)兩種；
• 雙軸關(guān)節(jié)：橢圓關(guān)節(jié)和鞍狀關(guān)節(jié)兩種；
• 三軸關(guān)節(jié)：球窩關(guān)節(jié)。

2、手指數(shù)目

大部分的抓取任務(wù)可以用兩個手指來完成，而對于一些諸如高精度的圓球、圓盤等抓取，可以引入第三個手指來提高其穩(wěn)定。因此，有三個手指的手爪其抓取是絕對可靠的。一般靈巧手采用3—5個手指。

3、靈巧手關(guān)節(jié)的驅(qū)動方式

靈巧手的驅(qū)動方式有：電驅(qū)動、氣壓驅(qū)動和液壓驅(qū)動的方式，少數(shù)的靈巧手采用SMA（形狀記憶合金）驅(qū)動、壓電陶瓷驅(qū)動和PMA（氣動人工肌肉驅(qū)動）等新型驅(qū)動技術(shù)。

4、靈巧手關(guān)節(jié)的傳動方式

靈巧手的關(guān)節(jié)傳動方式有：繩加滑輪傳動、連桿機構(gòu)傳動、齒輪傳動、帶傳動、鏈傳動等傳動方式

5、多指靈巧手的設(shè)計

• 手指各關(guān)節(jié)桿的截面型式和材料：
  • 鋁合金
• 傳感器的選用和布置：
  • 力覺傳感器
• 手指各關(guān)節(jié)的尺寸和回轉(zhuǎn)角范圍：
  • 人手指根關(guān)節(jié)的屈伸角度極限一般是90°，中間關(guān)節(jié)的屈伸角度極限一般為110°，末關(guān)節(jié)的屈伸角度一般為80°。

第二節(jié) 單指機構(gòu)的運動學(xué)模型

連桿兩端有關(guān)節(jié)n和n+1。該連桿尺寸可以用兩個量來描述：一個是兩個關(guān)節(jié)軸線沿公垂線的距離an，稱為連桿長度；另一個是垂直于an的平面內(nèi)兩個軸線的夾角αn，稱為連桿扭角。這兩個參數(shù)為連桿的尺寸參數(shù)。

第三節(jié) 多手指協(xié)調(diào)運動學(xué)分析

• 靈巧手的抓取主要靠拇指、食指、中指三個手指來完成操作。
• 在抓取物體時，無名指和小指只是跟隨中指作輔助性操作。

坐標(biāo)系的標(biāo)準(zhǔn)命名：

• 基坐標(biāo)系{B}：基坐標(biāo)系位于靈巧手的基座上，它僅是賦予坐標(biāo)系{O}的另一個名稱。它固連在靈巧手上的靜止部位，是其他坐標(biāo)系的參考標(biāo)準(zhǔn)。
• 手指坐標(biāo)系{W}：包括拇指、食指、中指的坐標(biāo)系。
• 目標(biāo)坐標(biāo)系{G}：目標(biāo)坐標(biāo)系是對被抓取的物體的具體位置進行描述，靈巧手在抓取物體動作結(jié)束時，手指坐標(biāo)系的末端關(guān)節(jié)應(yīng)于目標(biāo)坐標(biāo)系重合。

第四節(jié) 三指位姿方程的逆向解

運動學(xué)逆問題就是己知手指坐標(biāo)系相對與手掌坐標(biāo)系的期望位置和姿態(tài)，計算一系列滿足期望要求的關(guān)節(jié)角。

第五節(jié) 靈巧手的靜力學(xué)分析

靜力學(xué)分析就是假定各關(guān)節(jié)“鎖住”力與手部所支持的載荷或受到外界環(huán)境作用的力達到靜力學(xué)平衡。如圖所示，抓取球體時，各個手指的彎曲情況簡圖。可求出拇指、食指和中指指端的受力，然后再通過靜力學(xué)分析求出手指各關(guān)節(jié)上的受力情況。

將手指的三個關(guān)節(jié)簡化成為三根通過鉸鏈連接的剛性桿，在二維平面內(nèi)彎曲角度坐標(biāo)。

第8章 并聯(lián)機器人

第一節(jié) 并聯(lián)機器人的定義與特點

1、并聯(lián)機器人的定義

并聯(lián)機器人（Parallel Manipulator）由動平臺、定平臺以及連接它們的兩個或者兩個以上的獨立運動支鏈組成，末端定平臺具有兩個或兩個以上自由度的可控執(zhí)行器。

2、并聯(lián)機器人的歷史

并聯(lián)機構(gòu)的出現(xiàn)可以追溯到1931年，Gwinnett獲得了并聯(lián)機構(gòu)式的娛樂設(shè)備的專利授權(quán)。

3、并聯(lián)機器人的特點

• 并聯(lián)機器人驅(qū)動裝置可以安放在基座或接近基座的位置，故其運動部件的質(zhì)量和慣量可以大大減小，因此動態(tài)性能好，可以實現(xiàn)高速運動。
• 并聯(lián)機器人一般可以實現(xiàn)基座驅(qū)動器的良好密封，故
  可以工作在諸如高溫、輻射、潮濕、太空和水下等惡劣的環(huán)境下。
• 并聯(lián)機器人運動學(xué)反解容易計算而正解相當(dāng)復(fù)雜，故在工作空間中進行并聯(lián)機器人的位置控制較容易。
• 并聯(lián)機器人由于不存在驅(qū)動器累積誤差，其位置精度較高。
• 并聯(lián)機器人的運動平臺通過幾個運動鏈以并聯(lián)方式與基座相連接，因此承載能力強、剛性好、結(jié)構(gòu)緊湊。
• 并聯(lián)機器人結(jié)構(gòu)通常采用對稱式結(jié)構(gòu)，故具有較好的各向同性。
• 聯(lián)機器人具有運動學(xué)奇異和力奇異，在奇異點處，機器人可能失去約束度，即獲得額外的自由度。
• 工作空間小、可操作性差是并聯(lián)機器人的缺點

4、并聯(lián)機器人的應(yīng)用

• 并聯(lián)機床
• 動態(tài)模擬
• 醫(yī)療器械
• 工業(yè)機器人
• 微納操作
• 力與力矩傳感器

第二節(jié) 典型的并聯(lián)機構(gòu)

• Stewart平臺
• Delta并聯(lián)機器人
  • Delta并聯(lián)機器人有兩種典型的結(jié)構(gòu)，一種為3自由度結(jié)構(gòu)，一種為6自由度機構(gòu)。
• Tricept機器人

第三節(jié) 并聯(lián)機構(gòu)自由度的計算

若在三維空間中有n個完全不受約束的物體，并且任選其中的一個為固定參照物，因每個物體相對參照物都有6個運動自由度，則n個物體相對參照物共有6（n一1）個運動自由度。若在所有的物體之間用運動副聯(lián)接起來，設(shè)第i個運動副的約束為ui，此約束可以是1和5之間的任何數(shù)，如果所有n個物體之間的運動副數(shù)目為g，則這時的運動自由度應(yīng)減去所有的約束數(shù)的總和，為機構(gòu)的自由度，即：

這里M表示自由度，fi為第i個運動副的相對自由度數(shù)

M = 6(n - g - 1) + (i=1~g)fi

l為獨立的環(huán)路數(shù)目：

M = (i=1~g)fi - 6l

第四節(jié) 并聯(lián)機構(gòu)的位置分析

機構(gòu)的位置分析是求解機構(gòu)的輸入與輸出構(gòu)件之間的位置關(guān)系，這是機構(gòu)運動分析的最基本的任務(wù)。

1、位置反解

若已知輸出件的位置和姿態(tài)，求解機構(gòu)輸入件的位置稱為機構(gòu)位置的反解。

2、位置正解的數(shù)值方法

在機構(gòu)的運動分析中，并聯(lián)機構(gòu)的位置正解分析是最基本也是最困難的。分析并聯(lián)機構(gòu)位置正解的方法很多，概括起來有：

• 迭代法
• 解析法
• 同倫算法
• 數(shù)學(xué)機械化方法

第9章 機器人感知

第一節(jié) 工業(yè)機器人傳感器概述

1、傳感器的定義

傳感器（transducer/sensor）是一種檢測裝置，能感受到被測量的信息，并能將感受到的信息，按一定規(guī)律變換成為電信號或其他所需形式的信息輸出，以滿足信息的傳輸、處理、存儲、顯示、記錄和控制等要求。

2、傳感器的分類

• 按檢測狀態(tài)分類：分為內(nèi)部傳感器和外部傳感器兩種。
  • 內(nèi)傳感器用于測量機器人自身狀態(tài)
  • 外部傳感器測量與機器人作業(yè)有關(guān)的外部環(huán)境或物體
• 按工作原理分類：是以檢測器件的工作原理命名的，如應(yīng)變式、壓電式、壓阻式、熱點式檢測器件等。

3、傳感器的性能指標(biāo)

• 靈敏度：靈敏度是指傳感器的輸出信號達到穩(wěn)定時，輸出信號變化與輸入信號變化的比值。假如輸出和輸入呈線性關(guān)系，其靈敏度為： s = △y/△x
• 線性度：線性度是指傳感器輸出信號與輸入信號之間的線性程度。
• 測量范圍：測量范圍是指被測量的最大允許值和最小允許值之差。
• 精度：精度是指傳感器的測量輸出值與實際被測量值之間的誤差。
• 重復(fù)性：重復(fù)性是指傳感器在對輸入信號按同一方式進行全量程連續(xù)多次測量時，相應(yīng)測試結(jié)果的變化程度。
• 分辨率：分辨率是指傳感器在整個測量范圍內(nèi)所能辨別的被測量的最小變化量，或者所能辨別的不同被測量的個數(shù)。
• 響應(yīng)時間：響應(yīng)時間是傳感器的動態(tài)特性指標(biāo)，是指傳感器的輸入信號變化后，其輸出信號隨之變化并達到一個穩(wěn)定值所需要的時間。
• 抗干擾能力：通常抗干擾能力是通過單位時間內(nèi)發(fā)生故障的概率來定義的，

4、傳感器的發(fā)展動向

機器人技術(shù)的發(fā)展大致經(jīng)歷了以下三個時期：

• 第一代示教再現(xiàn)機器人
  • 不配備任何傳感器，一般采用簡單的開關(guān)控制、示教再現(xiàn)控制和可編程序控制。工作過程中無法感知環(huán)境的改變而改善自身的性能。
• 第二代感覺型機器人
  • 配備了簡單的內(nèi)外部傳感器，能感知自身運行的速度、位置、姿態(tài)等物理量，并以這些信息的反饋構(gòu)成閉環(huán)控制，具有部分適應(yīng)外部環(huán)境的能力。
• 第三代智能型機器人
  • 具有多種外部傳感器組成的感覺系統(tǒng)，可通過對外部環(huán)境信息的獲取、處理，確切地描述外部環(huán)境，自主地完成某項任務(wù)。一般地，擁有自主知識庫、多信息處理系統(tǒng)，能根據(jù)環(huán)境的變化做出對應(yīng)的決策。

一方面開發(fā)研究機器人的各種外部傳感器，研究多信息處理系統(tǒng)（Robot Sensory System），使其具有更高的性能指標(biāo)和更寬的應(yīng)用范圍；

另一方面研究如何將多個傳感器得到的信息綜合利用（Multi-sensor Integration and Fusion），發(fā)展多信息處理技術(shù)，使機器人能更準(zhǔn)備、全面、低成本地獲取環(huán)境的信息。

傳感器發(fā)展趨勢：

• 研發(fā)新型傳感器。新型傳感器是指：
  • 采用新原理；
  • 填補傳感器空白；
  • 仿生傳感器等方面。
• 開發(fā)新材料。新型傳感器材料有：
  • 半導(dǎo)體敏感材料；
  • 陶瓷材料；
  • 磁性材料；
  • 智能材料等。
• 采用新工藝。
  • 微細加工技術(shù)，又稱微機械加工技術(shù)（MEMS）。
• 面向集成化、多功能化。
• 面向智能化發(fā)展。

第二節(jié) 位置和位移傳感器

1、位置傳感器

用來檢測位置，能感受被測物的位置并轉(zhuǎn)換成可用輸出信號。常用的位置傳感器有接觸式和接近式兩種。

• 行程開關(guān)
• 光電式位置傳感器
• 渦流式接近開關(guān)（電感式接近開關(guān)）
• 電容式接近開關(guān)
• 霍爾式接近開關(guān)
• 光電編碼器

2、位移傳感器

位移傳感器有電位器式、直線型、旋轉(zhuǎn)變壓器。

第三節(jié) 機器人的視覺技術(shù)

1、視覺傳感器的作用

• 進行位置的測量
• 進行圖象識別，了解對象物特征，以同其它物體相區(qū)別；
• 對加工零件進行檢驗，了解加工結(jié)果，檢查部件形狀和尺寸方面的缺陷。

2、視覺系統(tǒng)的性能

• 環(huán)境安排
• 實時性
• 高可靠性
• 通用性

3、機器人視覺系統(tǒng)的組成

視覺系統(tǒng)可以分為：

• 圖像輸入（獲取）
• 圖像處理
• 圖像理解
• 圖像存儲
• 圖像輸出

視覺系統(tǒng)的硬件組成：

• 視覺傳感器
  • 將景物的光信號轉(zhuǎn)換成電信號的器件。
• 攝像機和光源控制
  • 取景部分應(yīng)當(dāng)根據(jù)具體情況自動調(diào)節(jié)光圈的焦點，以便得到容易處理得圖像。
• 計算機
  • 得到的圖像信息要由計算機存儲和處理，然后根據(jù)各種目的輸出處理后的結(jié)果。
• 圖像處理機
  • 一般計算機都是串行運算的，要處理二維圖像很費時間。在要求較高的場合，需要設(shè)置一種專用的圖像處理機，以縮短計算時間。

第四節(jié) 機器人的觸覺

1、觸覺傳感器的一般要求

• 傳感器有很好的順應(yīng)性，并且耐磨；
• 空間分辨率為1～2mm，這種分辨率接近人指的分辨率；
• 每個指尖有50～200個觸覺單元；
• 觸點的力靈敏度小于0.05N，最好能達到0.01N左右；
• 輸出動態(tài)范圍最好能達到1000:1；
• 傳感器的穩(wěn)定性、重復(fù)性好，無滯后；
• 輸出信號單值，線性度良好；
• 輸出頻響100Hz—1kHz。

2、觸覺傳感器開關(guān)

用于檢測物體是否存在的一種最簡單的觸覺制動器件。

3、壓阻式觸覺傳感器

壓阻式觸覺傳感器是利用半導(dǎo)體材料的壓阻效應(yīng)和集成電路技術(shù)制成的傳感器。

優(yōu)點是靈敏度高、體積小、耗電少、動態(tài)響應(yīng)好、精度高、測量范圍寬、有正負兩種符號的應(yīng)力效應(yīng)，易于微型化和集成化；缺點是受溫度影響較大。

4、壓電式觸覺傳感器

壓電式傳感器用于測量力和能變換為力的非電物理量。

優(yōu)點是頻帶寬、靈敏度高、信噪比高、結(jié)構(gòu)簡單確實
、工作可靠和重量輕等。缺點是某些壓電材料需要防潮措施，而且輸出的直流響應(yīng)差。

5、光電式觸覺傳感器

光電式傳感器是將光通量轉(zhuǎn)換為電量的一種傳感器，光電式傳感器的基礎(chǔ)是光電轉(zhuǎn)換元件的光電效應(yīng)。

由于光電測量方法靈活多樣，可測參數(shù)眾多，具有非接觸，高精度，高可靠性和反應(yīng)快等特點，使得光電傳感器在檢測和控制領(lǐng)域獲得了廣泛的應(yīng)用。

第10章 機器人控制系統(tǒng)

第一節(jié) 機器人控制系統(tǒng)與控制方式

1、機器人控制系統(tǒng)的基本原理

• 控制的目的
• 控制的基本條件
• 控制的實質(zhì)

機器人能夠按照要求去完成特定的作業(yè)任務(wù)，需要以下四個過程：

• 示教過程
• 計算與控制
• 伺服驅(qū)動
• 傳感與檢測

2、機器人控制系統(tǒng)的組成

• 軟件組成：主要是指控制軟件，它包括運動軌跡規(guī)劃算法和關(guān)節(jié)伺服控制算法及相應(yīng)的動作程序。
• 硬件組成：主要包括中心控制器、傳感器、驅(qū)動放大器、執(zhí)行機構(gòu)、電源等。

3、機器人控制方式以及控制系統(tǒng)的分類

按其控制方式分類：

• 集中控制方式：一臺計算機實現(xiàn)全部控制功能，結(jié)構(gòu)簡單，成本低，但實時性差，難以擴展。
• 主從控制方式：采用主、從兩級處理器實現(xiàn)系統(tǒng)的全部控制功能，實時性較好，適于高精度、高速度控制，但其系統(tǒng)擴展性較差，維修困難。
• 分散控制方式：按系統(tǒng)的性質(zhì)和方式將系統(tǒng)控制分成幾個模塊，每一個模塊各有不同的控制任務(wù)和控制策略，實時性好，易于實現(xiàn)高速、高精度控制，易于擴展，可實現(xiàn)智能控制，是目前流行的方式。

按其運動控制方式分類：

• 位置控制方式：工業(yè)機器人位置控制又分為點位控制和連續(xù)軌跡控制兩類。
• 速度控制方式
• 力（力矩）控制方式
• 智能控制方式

4、機器人控制系統(tǒng)的要求、特點

一般要求：控制系統(tǒng)應(yīng)該滿足記憶、示教、與外圍設(shè)備聯(lián)系、坐標(biāo)設(shè)置、人機接口、傳感器接口、位置伺服、故障診斷安全保護等基本功能。

機器人控制系統(tǒng)的特點

與一般的伺服系統(tǒng)或過程控制系統(tǒng)相比，機器人控制系統(tǒng)有如下特點：

• 機器人的控制與機構(gòu)運動學(xué)及動力學(xué)密切相關(guān)。
• 一個簡單的機器人也至少有3~5個自由度，比較復(fù)雜的機器人有十幾個、甚至幾十個自由度。每個自由度一般包含一個伺服機構(gòu)，它們必須協(xié)調(diào)起來， 組成一個多變量控制系統(tǒng)。
• 把多個獨立的伺服系統(tǒng)有機地協(xié)調(diào)起來，使其按照人的意志行動，甚至賦予機器人一定的“智能”，這個任務(wù)只能由計算機來完成。因此，機器人控制系統(tǒng)必須是一個計算機控制系統(tǒng)。同時，計算機軟件擔(dān)負著艱巨的任務(wù)。
• 描述機器人狀態(tài)和運動的數(shù)學(xué)模型是一個非線性模型，隨著狀態(tài)的不同和外力的變化，其參數(shù)也在變化，各變量之間還存在耦合。
• 機器人的動作往往可以通過不同的方式和路徑來完成，因此存在一個“最優(yōu)”的問題。
• 總而言之，機器人控制系統(tǒng)是一個與運動學(xué)和動力學(xué)原理密切相關(guān)的、有耦合的、非線性的多變量控制系統(tǒng)。

第二節(jié) 基于運動坐標(biāo)的控制

1、基于關(guān)節(jié)坐標(biāo)的控制

• 位置控制問題：工業(yè)機器人位置控制的目的，就是要使機器人各關(guān)節(jié)實現(xiàn)預(yù)先所規(guī)劃的運動，最終保證工業(yè)機器人終端(手爪)沿預(yù)定的軌跡運行。
  • PTP(Point-to-Point)控制問題
  • CP(Continuous Path)控制問題
• 基于關(guān)節(jié)坐標(biāo)的控制：基于關(guān)節(jié)坐標(biāo)的伺服控制是目前工業(yè)機器人的主流控制方式，目前工業(yè)機器人的位置控制主要基于運動學(xué)而非動力學(xué)的控制，只適用于運動速度和加速度較小的應(yīng)用場所。對于快速運動、負載變化大和要求力控的機器人還必須考慮其動力學(xué)行為。

2、基于作業(yè)空間的控制

該控制方法即所謂把末端拉向目標(biāo)值的方法，不僅直觀上容易理解，而且最大的優(yōu)點是不含逆運動學(xué)計算，可提高控制運算速度。

第三節(jié) 基于運動參數(shù)的控制

1、機器人分解運動的速度控制

分解運動的速度控制要求各伺服系統(tǒng)的驅(qū)動器以不同的分速度同時聯(lián)合運行，能保證機器人的末端執(zhí)行器沿著笛卡兒坐標(biāo)軸穩(wěn)定地運行。控制時先把末端執(zhí)行器期望的笛卡兒位姿分解為各關(guān)節(jié)的期望速度，然后再對各關(guān)節(jié)進行伺服控制。

2、機器人分解運動的加速度控制

機器人分解運動的加速度控制是分解運動速度控制概念的擴展，其方法是把機器人末端執(zhí)行器在笛卡兒坐標(biāo)系下的加速度值分解為關(guān)節(jié)坐標(biāo)系下相應(yīng)各關(guān)節(jié)的加速度，這樣根據(jù)相應(yīng)的系統(tǒng)動力學(xué)模型就可以計算出所需施加到各關(guān)節(jié)電動機上的控制力矩。

3、力和力矩的控制

分解運動的力和力矩控制的基本思路是確定加于機器人各關(guān)節(jié)驅(qū)動器上的控制力矩，從而實現(xiàn)機器人末端執(zhí)行器在笛卡兒坐標(biāo)下的位姿和速度控制。力和力矩控制的依據(jù)是機器人的動力學(xué)模型，其計算方法是對逆動力學(xué)的求解。力和力矩的控制在機器人關(guān)節(jié)空間是閉環(huán)的

第四節(jié) 機器人的智能控制系統(tǒng)

• 遞階控制系統(tǒng)
• 專家控制系統(tǒng)
• 模糊控制系統(tǒng)
• 學(xué)習(xí)控制系統(tǒng)
• 神經(jīng)控制系統(tǒng)
• 進化控制系統(tǒng)

總結(jié)

以上是生活随笔為你收集整理的机器人导论知识点总结的全部內(nèi)容，希望文章能夠幫你解決所遇到的問題。

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