2025/6/61于薇薇西北工業(yè)大學(xué)機(jī)電學(xué)院機(jī)器人控制一、概述控制是機(jī)器人技術(shù)中的一個(gè)關(guān)鍵問題，而控制系統(tǒng)的性能則是機(jī)器人發(fā)展水平一個(gè)重要標(biāo)志。

機(jī)器人控制是控制領(lǐng)域的一個(gè)子集,一個(gè)獨(dú)具特色的子集。機(jī)器人控制系統(tǒng)是一個(gè)與機(jī)構(gòu)學(xué)、運(yùn)動(dòng)學(xué)和動(dòng)力學(xué)原理密切相關(guān)的、耦合緊密的、非線性和時(shí)變的多變量控制系統(tǒng)。機(jī)器人控制系統(tǒng)一般由計(jì)算機(jī)和伺服控制器組成。2025/6/62工業(yè)機(jī)器人控制系統(tǒng)工作過程

2025/6/63

機(jī)器人控制過程示意圖

內(nèi)部反饋根據(jù)外界環(huán)境確定任務(wù)確定運(yùn)動(dòng)軌跡（點(diǎn)動(dòng)或軌跡）計(jì)算目標(biāo)任務(wù)在笛卡爾空間的位姿任務(wù)執(zhí)行電機(jī)的伺服控制轉(zhuǎn)換為電機(jī)的給定值轉(zhuǎn)換為關(guān)節(jié)空間角度外部反饋?zhàn)鳂I(yè)控制器組織層伺服控制器執(zhí)行層運(yùn)動(dòng)控制器協(xié)調(diào)層（1）人工智能級(jí)—組織層—作業(yè)控制器

（2）控制模式級(jí)—協(xié)調(diào)層—運(yùn)動(dòng)控制器

（3）伺服系統(tǒng)級(jí)—執(zhí)行層—驅(qū)動(dòng)控制器

——幾種不同的稱謂2025/6/64

機(jī)器人控制系統(tǒng)在物理上分為兩級(jí)：工控機(jī)與伺服控制器，但在邏輯上一般分為三級(jí)（層）：

2025/6/65作業(yè)控制器驅(qū)動(dòng)控制器3驅(qū)動(dòng)控制器1驅(qū)動(dòng)控制器2驅(qū)動(dòng)控制器4運(yùn)動(dòng)控制器機(jī)器人本體

機(jī)器人控制系統(tǒng)的構(gòu)成分析各層（級(jí)）的關(guān)系與區(qū)別

知識(shí)粒度數(shù)據(jù)處理功能類別作業(yè)控制級(jí)

粗模糊決策運(yùn)動(dòng)控制級(jí)

中精確任務(wù)分解驅(qū)動(dòng)控制級(jí)

細(xì)精確控制

通過分層遞階的組織形式才能完成復(fù)雜任務(wù)2025/6/66工業(yè)機(jī)器人典型控制方式

點(diǎn)位式（PTP，pointtopoint）

實(shí)現(xiàn)點(diǎn)的位置控制，而點(diǎn)與點(diǎn)之間的軌跡卻無關(guān)緊要。如自動(dòng)插件機(jī)，在貼片機(jī)上安插元件，點(diǎn)焊、搬運(yùn)、裝配等。

軌跡式

(CP,continuouspath)

指定點(diǎn)與點(diǎn)之間的運(yùn)動(dòng)軌跡為所要求的曲線，如直線或圓弧。在進(jìn)行弧焊、噴漆、切割等作業(yè)時(shí)十分必要。

速度控制方式

對(duì)于機(jī)器人的行程要求遵循一定的速度變化曲線。

力（力矩）控制方式

要求對(duì)末端施加在對(duì)象上的力進(jìn)行控制，如抓放操作、去毛刺、研磨和組裝等作業(yè)。

智能控制方式

在不確定或未知條件下作業(yè)，通過傳感器，內(nèi)部的知識(shí)庫，自主完成給定任務(wù)。

2025/6/67機(jī)器人控制的特點(diǎn)

與機(jī)構(gòu)學(xué)、運(yùn)動(dòng)學(xué)及動(dòng)力學(xué)密切相關(guān)。

描述機(jī)器人狀態(tài)和運(yùn)動(dòng)的數(shù)學(xué)模型是一個(gè)具有時(shí)變結(jié)構(gòu)和參數(shù)的非線性模型，各關(guān)節(jié)變量之間存在緊密耦合。

一個(gè)簡(jiǎn)單的機(jī)器人至少也有3-5個(gè)自由度，于是機(jī)器人控制系統(tǒng)必須是一個(gè)計(jì)算機(jī)控制的多級(jí)遞階控制系統(tǒng)。

機(jī)器人的動(dòng)作常?？梢酝ㄟ^不同的方式和路徑來完成，手臂解不唯一，這樣便要處理在一定約束條件下的優(yōu)化決策與控制問題。

伺服系統(tǒng)要求較高的位置精度，較大的調(diào)速范圍，各關(guān)節(jié)的速度誤差系數(shù)應(yīng)盡量一致。

系統(tǒng)的靜差率要小，位置無超調(diào)，動(dòng)態(tài)響應(yīng)盡量快。

2025/6/68常用伺服控制策略

各種PID控制方式

PID控制是將偏差的比例（P）、積分（I）和微分（D）通過線性組合構(gòu)成控制量，算法簡(jiǎn)單，魯棒性好，可靠性高；但反饋增益是常量，它不能在有效載荷變化的情況下改變反饋增益。

最優(yōu)控制（OptimalControl）

基于某種性能指標(biāo)的極大（?。┛刂?，稱之為最優(yōu)控制。在高速機(jī)器人中，除了選擇最佳路徑外，還普遍采用最短時(shí)間控制，即所謂“砰—砰”控制。

2025/6/69常用伺服控制策略(續(xù))

自適應(yīng)控制

自適應(yīng)控制則是根據(jù)系統(tǒng)運(yùn)行的狀態(tài)，自動(dòng)補(bǔ)償模型中各不確定因素，從而顯著改善機(jī)器人的性能。分為模型參考自適應(yīng)控制器、自校正自適應(yīng)控制器和線性攝動(dòng)自適應(yīng)控制等。解耦控制

機(jī)器人各自由度之間存在著耦合，即某處的運(yùn)動(dòng)對(duì)另一處的運(yùn)動(dòng)有影響。在耦合嚴(yán)重的情況下，必須考慮一些解耦措施。

2025/6/610各種先進(jìn)控制策略

模糊控制

通常的模糊控制是借助熟練操作者經(jīng)驗(yàn)，通過“語言變量”表述和模糊推理來實(shí)現(xiàn)的無模型控制。

神經(jīng)控制——人工神經(jīng)網(wǎng)絡(luò)控制

神經(jīng)控制便是由神經(jīng)網(wǎng)絡(luò)組成的控制系統(tǒng)結(jié)構(gòu)。

魯棒控制

魯棒控制的基本特征，是用一個(gè)結(jié)構(gòu)和參數(shù)都是固定不變的控制器，來保證即使不確定性對(duì)系統(tǒng)的性能品質(zhì)影響最惡劣的時(shí)候也能滿足設(shè)計(jì)要求。2025/6/611各種先進(jìn)控制策略(續(xù))

滑?？刂?/p>

滑模變結(jié)構(gòu)控制系統(tǒng)的特點(diǎn)是：在動(dòng)態(tài)控制過程中，系統(tǒng)的結(jié)構(gòu)根據(jù)系統(tǒng)當(dāng)時(shí)的狀態(tài)偏差及其各階導(dǎo)數(shù)值，以躍變的方式按設(shè)定的規(guī)律作相應(yīng)改變，該類控制系統(tǒng)預(yù)先在狀態(tài)空間設(shè)定一個(gè)特殊的超越曲面，由不連續(xù)的控制規(guī)律，不斷變換控制系統(tǒng)結(jié)構(gòu)，使其沿著這個(gè)特定的超越曲面向平衡點(diǎn)滑動(dòng)，最后漸近穩(wěn)定至平衡點(diǎn)。

學(xué)習(xí)控制

產(chǎn)生自主運(yùn)動(dòng)的認(rèn)知控制系統(tǒng)，包括感知層、數(shù)據(jù)處理層、概念產(chǎn)生層、目標(biāo)感知層、控制知識(shí)／數(shù)據(jù)庫、結(jié)論產(chǎn)生層等。2025/6/6122025/6/613

機(jī)器人學(xué)習(xí)控制系統(tǒng)結(jié)構(gòu)圖傳感器層數(shù)據(jù)處理層存儲(chǔ)層控制層執(zhí)行層感知部分認(rèn)知部分外部世界機(jī)器人控制問題

機(jī)器人的動(dòng)力學(xué)方程通式：

稱為慣量矩陣，是離心力、科氏力向量，為黏性摩擦系數(shù)矩陣，為重力項(xiàng)的向量。其中：為廣義關(guān)節(jié)向量，為驅(qū)動(dòng)力矩向量。機(jī)器人控制問題

機(jī)器人動(dòng)力學(xué)的特點(diǎn)：

1）、非線性：引起非線性的因數(shù)很多，如：機(jī)構(gòu)構(gòu)型、傳動(dòng)機(jī)構(gòu)、驅(qū)動(dòng)機(jī)構(gòu)等。

2）、強(qiáng)耦合：某一關(guān)節(jié)的運(yùn)動(dòng)，會(huì)對(duì)其他關(guān)節(jié)產(chǎn)生動(dòng)力效應(yīng)，使得每個(gè)關(guān)節(jié)都要承受其他關(guān)節(jié)運(yùn)動(dòng)所產(chǎn)生的擾動(dòng)。

3）、時(shí)變：動(dòng)力學(xué)參數(shù)隨關(guān)節(jié)運(yùn)動(dòng)位置的改變而變化。機(jī)器人控制問題基本控制原則：

1）、盡可能使問題簡(jiǎn)化。

2）、將復(fù)雜的總體系統(tǒng)控制問題盡可能簡(jiǎn)化為多個(gè)低階子系統(tǒng)的控制問題。

3）、一般情況下，機(jī)器人的基本控制技術(shù)可歸結(jié)為單關(guān)節(jié)控制技術(shù)和多關(guān)節(jié)控制技術(shù)，前者需要考慮誤差補(bǔ)償問題，后者可考慮耦合作用的補(bǔ)償。5機(jī)器人控制問題控制任務(wù)：機(jī)器人以指定的速度、精度、運(yùn)動(dòng)軌跡抓取物體。機(jī)器人控制問題規(guī)劃末端執(zhí)行器的運(yùn)動(dòng)軌跡X(t)。計(jì)算機(jī)器人關(guān)節(jié)向量θ(t)。計(jì)算控制關(guān)節(jié)力矩C(t)。控制電流或電壓V(t)。電動(dòng)機(jī)輸出力矩T(t)。機(jī)器人控制問題4.1.2控制系統(tǒng)組成結(jié)構(gòu)機(jī)器人控制系統(tǒng)可分為四部分：1）機(jī)器人工作任務(wù)，即給定值。2）機(jī)器人本體，即被控對(duì)象。3）機(jī)器人控制器，它是控制系統(tǒng)的核心部分。4）機(jī)器人感知器，即傳感器。機(jī)器人控制問題機(jī)器人控制系統(tǒng)硬件：一般包括三部分：

1）感知部分，

2）控制裝置：基于高性能微處理器，多處理器技術(shù)。

3）伺服驅(qū)動(dòng)部分。機(jī)器人控制系統(tǒng)軟件：實(shí)時(shí)多任務(wù)操作系統(tǒng)。機(jī)器人控制算法。機(jī)器人的控制需基于計(jì)算機(jī)控制理論與技術(shù)。機(jī)器人控制問題一種控制方案：?jiǎn)屋S開環(huán)控制InvKinXdcontroljoint1q1δq1controljoint1q2δq2controljoint1qnδqnq1）動(dòng)力學(xué)模型的不完全。2）噪聲、干擾的存在。機(jī)器人控制問題另一種方案（半閉環(huán)）：J-1Xdcontroljoint1q1δq1controljoint1q2δq2controljoint1qnδqnqForwardKinematicsx-δxδq從關(guān)節(jié)傳感器引回反饋，構(gòu)成反饋控制系統(tǒng)。機(jī)器人控制問題控制性能要求考慮到機(jī)器人的多變量、時(shí)變、非線性、強(qiáng)耦合以及建模困難、干擾因數(shù)多等特點(diǎn)，必須根據(jù)實(shí)際工作的要求提出合理可行的控制性能指標(biāo)。除一般的控制性能指標(biāo)外，機(jī)器人通常注重如下控制性能要求：

1）在工作空間的可空性。

2）穩(wěn)定性或相對(duì)穩(wěn)定性。

3）動(dòng)態(tài)響應(yīng)性能。

4）定位精度、軌跡跟蹤精度。機(jī)器人控制問題

針對(duì)一些特殊用途的機(jī)器人，還可以進(jìn)一步提出一些性能要求。如仿人機(jī)器人，他的關(guān)節(jié)多達(dá)32個(gè)以上，并雙足行走：多軸運(yùn)動(dòng)協(xié)調(diào)控制。高穩(wěn)定性。位置無超調(diào)、動(dòng)態(tài)響應(yīng)速度快。處理器具有很高的處理速度。具有較高的智能。結(jié)構(gòu)緊湊。機(jī)器人的軌跡控制軌跡控制問題：在給定期望運(yùn)動(dòng)軌跡情況下，選擇一種控制策略，在關(guān)節(jié)驅(qū)動(dòng)力矩的作用下，使機(jī)器人再現(xiàn)該運(yùn)動(dòng)軌跡。該控制策略應(yīng)對(duì)初始條件誤差、傳感器噪聲、模型誤差等應(yīng)具有較好的魯棒性。這里，一般不考慮驅(qū)動(dòng)器的動(dòng)力學(xué)問題，并假定可以對(duì)關(guān)節(jié)施加任意的力矩。機(jī)器人的軌跡控制問題的提出總體思路：從已知的末端執(zhí)行器軌跡Xd(t)，根據(jù)逆運(yùn)動(dòng)學(xué)問題，求出個(gè)關(guān)節(jié)的位移、速度和加速度；進(jìn)而根據(jù)動(dòng)力學(xué)關(guān)系求出所需要的關(guān)節(jié)力矩。

定義伺服誤差：?jiǎn)栴}：為使伺服誤差趨于零，如何計(jì)算驅(qū)動(dòng)力矩或如何設(shè)計(jì)控制器？機(jī)器人的軌跡控制單關(guān)節(jié)軌跡控制機(jī)器人的動(dòng)力學(xué)方程是高度耦合的。當(dāng)機(jī)器人在低速小負(fù)載運(yùn)動(dòng)時(shí)，各關(guān)節(jié)動(dòng)力學(xué)特性中的重力和關(guān)節(jié)間耦合可以忽略，當(dāng)慣量參數(shù)變化不大時(shí)，機(jī)器人可以采用單關(guān)節(jié)位置伺服反饋控制來實(shí)現(xiàn)有效的控制，使機(jī)器人的控制問題大大簡(jiǎn)化。并在實(shí)際中得到大量的應(yīng)用。單關(guān)節(jié)伺服控制技術(shù)原理是在機(jī)器人各關(guān)節(jié)單獨(dú)控制時(shí)，采用經(jīng)典反饋控制方法，根據(jù)穩(wěn)定性和誤差設(shè)計(jì)準(zhǔn)則，設(shè)計(jì)線性反饋控制器。山東大學(xué)機(jī)械工程學(xué)院機(jī)電工程研究所2010/09/02二、伺服控制器

2025/6/628位置輸入信號(hào)方向判別誤差調(diào)節(jié)D/A速度控制器功放負(fù)載直流伺服電機(jī)測(cè)速電機(jī)計(jì)數(shù)碼盤位置反饋速度反饋直流電動(dòng)機(jī)伺服傳動(dòng)系統(tǒng)原理圖+_2025/6/629電樞控制直流電機(jī)的等效電路圖NSJeffτ,θmLaUaRaia

機(jī)械傳動(dòng)等效慣量

齒數(shù)比2025/6/630單關(guān)節(jié)驅(qū)動(dòng)系統(tǒng)傳遞函數(shù)Jeff=Jm+n2JL

feff=fm+n2fL

折合到電機(jī)軸上的總的等效慣性矩Jeff和等效摩擦系數(shù)feff齒數(shù)比為齒數(shù)

齒數(shù)比說明：齒數(shù)比與傳動(dòng) 比互為倒數(shù)2025/6/631電氣部分的模型由電機(jī)電樞繞組內(nèi)的電壓平衡方程來描述

電機(jī)力矩平衡方程

機(jī)械部分與電氣部分的耦合關(guān)系對(duì)以上各式進(jìn)行拉普拉斯變換得Ka——電機(jī)電流—力矩比例常數(shù)Kb——感應(yīng)電勢(shì)常數(shù)2025/6/632重新組合上式，得驅(qū)動(dòng)系統(tǒng)傳遞函數(shù)

忽略電樞的電感La，可簡(jiǎn)化為

其中，電機(jī)增益常數(shù)為

電機(jī)時(shí)間常數(shù)為

單關(guān)節(jié)控制系統(tǒng)所加電壓與關(guān)節(jié)角位移之間的傳遞函數(shù)

2025/6/633單關(guān)節(jié)的建模與角度反饋比例控制于是得到為系統(tǒng)誤差

進(jìn)而可得式中kp——位置反饋增益，n

為齒數(shù)比位置控制器（比例）直流驅(qū)動(dòng)單關(guān)節(jié)系統(tǒng)+－2025/6/634系統(tǒng)傳遞函數(shù)推導(dǎo)誤差驅(qū)動(dòng)信號(hào)E(s)與實(shí)際位移之間的開環(huán)傳遞函數(shù)

由此得系統(tǒng)閉環(huán)傳遞函數(shù)

上式表明關(guān)節(jié)機(jī)器人的比例控制器是一個(gè)二階系統(tǒng)。當(dāng)系統(tǒng)參數(shù)均為正時(shí)，系統(tǒng)總是穩(wěn)定的。

位置控制器（比例）直流驅(qū)動(dòng)單關(guān)節(jié)系統(tǒng)+－伺服系統(tǒng)分塊示意圖2025/6/635三、基于非線性模型的機(jī)器人解耦控制2025/6/636n關(guān)節(jié)機(jī)械手的封閉形式動(dòng)力學(xué)方程的一般結(jié)構(gòu)當(dāng)考慮關(guān)節(jié)的摩擦效應(yīng)時(shí)，還應(yīng)加入摩擦項(xiàng)，動(dòng)力學(xué)方程應(yīng)寫為Θ為表示旋轉(zhuǎn)關(guān)節(jié)或平移關(guān)節(jié)位移的n×1向量;式中為n×n的慣性矩陣為n×1的哥氏項(xiàng)或向心項(xiàng)向量；為n×1的重力項(xiàng)向量；為n×1的摩擦力項(xiàng)向量；為表示旋轉(zhuǎn)關(guān)節(jié)力矩或平移關(guān)節(jié)力的n×1向量基于非線性模型的線性化控制法則

基于數(shù)學(xué)分析的計(jì)算力矩法的基本思想是：設(shè)計(jì)一個(gè)非線性的基于模型的控制法則，用它來抵消被控制系統(tǒng)的非線性；把系統(tǒng)簡(jiǎn)化為線性系統(tǒng)，它可以用單位質(zhì)量系統(tǒng)中導(dǎo)出的簡(jiǎn)單的線性伺服法則來進(jìn)行控制。從某種意義上說，線性化控制法則是提供了一個(gè)受控系統(tǒng)的“反模型”。系統(tǒng)中的非線性與反模型中的非線性相抵消，這一點(diǎn)與伺服法則一起構(gòu)成了一個(gè)線性閉環(huán)系統(tǒng)。2025/6/6372025/6/638機(jī)械手系統(tǒng)方程基于模型的控制法則為令

并且于是得到完全解耦系統(tǒng)－－單位質(zhì)量系統(tǒng)對(duì)解耦系統(tǒng)實(shí)行比例－微分控制，即伺服法則為其中為設(shè)定值機(jī)械手機(jī)械手2025/6/639伺服控制系統(tǒng)設(shè)計(jì)與分析機(jī)械手＋＋＋＋＋＋＋－－非線性補(bǔ)償解耦系統(tǒng)分析2025/6/640理想情況（完全補(bǔ)償，充分解耦，沒有時(shí)滯）顯然無法做到。因?yàn)椋簾o法精確建模，必然存在未建模動(dòng)態(tài)和隨機(jī)干擾；補(bǔ)償器中無法實(shí)現(xiàn)純微分環(huán)節(jié)，無法完全補(bǔ)償控制對(duì)象中的時(shí)間滯后；控制對(duì)象是連續(xù)時(shí)間過程，補(bǔ)償器只能是離散時(shí)間過程，無法完全匹配。需要線性反饋閉環(huán)控制2025/6/641

各種誤差集中表現(xiàn)為擾動(dòng)力矩?？紤]到未知的擾動(dòng)力矩,系統(tǒng)的誤差方程為式中。由此不難分析系統(tǒng)的穩(wěn)定性。系統(tǒng)實(shí)現(xiàn)中的幾個(gè)問題：需要認(rèn)真推導(dǎo)、辨識(shí)控制對(duì)象的動(dòng)力學(xué)模型，這是實(shí)行補(bǔ)償控制的基礎(chǔ)，而摩擦項(xiàng)等難于建模；非線性補(bǔ)償計(jì)算量較大，常常需要另一臺(tái)計(jì)算機(jī)在線計(jì)算動(dòng)力學(xué)部分；鑒于機(jī)械系統(tǒng)的慣性較大，動(dòng)力學(xué)計(jì)算速率可以適當(dāng)?shù)陀谒欧?jì)算的速率（60Hz/200Hz)。7.3.3基于直角坐標(biāo)的控制系統(tǒng)在上面討論的機(jī)械手的控制方式中,都假定那些期望的軌跡是由關(guān)節(jié)的位置、速度和加速度的時(shí)間順序表示的。我們常常期望機(jī)器人的手爪沿著迪卡爾空間的直線(或者其他曲線)軌跡運(yùn)動(dòng)。為此，可以計(jì)算出對(duì)應(yīng)于直角坐標(biāo)空間軌跡的關(guān)節(jié)空間軌跡。軌跡變換的計(jì)算量比較大，目前所有的系統(tǒng)都進(jìn)行這種計(jì)算。2025/6/642式中表示對(duì)求解逆運(yùn)動(dòng)學(xué);

為在笛卡爾坐標(biāo)系下的手爪的位姿期望。2025/6/643基于直角坐標(biāo)的控制系統(tǒng)方框圖機(jī)械手＋＋＋＋＋＋＋－－這里的動(dòng)力學(xué)方程為式中為直角坐標(biāo)下的力向量。機(jī)械手通用控制方案輸入為直角坐標(biāo)軌跡的基于關(guān)節(jié)的分布式控制方案：1.期望軌跡在笛卡爾坐標(biāo)系中給出；2.通過求解運(yùn)動(dòng)學(xué)逆問題變換為各關(guān)節(jié)的期望軌跡；3.各關(guān)節(jié)單獨(dú)閉環(huán)，分別實(shí)現(xiàn)各關(guān)節(jié)的位置、速度（和加速度）控制；4.系統(tǒng)結(jié)構(gòu)為分層遞階的分布式計(jì)算機(jī)控制系統(tǒng)。2025/6/644