機(jī)器人控制,參考書目,Bruno Siciliano, Lorenzo Sciavicco, et al. Robotics: Modeling, planning and control. 蔡自興. 機(jī)器人學(xué)（第二版）. 北京：清華大學(xué)出版社，2009 譚民，徐德，侯增廣等.先進(jìn)機(jī)器人控制. 北京：高等教育出版社， 2007.,本章內(nèi)容,機(jī)器人控制概述 機(jī)器人控制分類 機(jī)器人控制系統(tǒng)硬件配置及結(jié)構(gòu) 機(jī)器人的位置控制 機(jī)器人的力控制 總結(jié),學(xué)習(xí)目標(biāo),了解機(jī)器人控制的基本概念 掌握機(jī)器人控制的分類及特點(diǎn) 掌握機(jī)器人的位置控制方法 深入理解機(jī)器人的力控制方法，包括直接力控制，阻抗控制等,一. 機(jī)器人控制技術(shù)綜述,“控制”的目的 是使被控對(duì)象產(chǎn)生控制者所期望的行為方式 “控制”的基本條件是了解被控對(duì)象的特性 “實(shí)質(zhì)”是對(duì)驅(qū)動(dòng)器輸出力矩的控制,輸入X,被控對(duì)象的模型,輸出Y,目 的,機(jī)器人控制的兩個(gè)問題：1）求機(jī)器人的動(dòng)態(tài)模型（動(dòng)力學(xué)問題）；2）根據(jù)動(dòng)態(tài)模型設(shè)計(jì)控制規(guī)律,機(jī)器人技術(shù)與控制學(xué)科的關(guān)系,機(jī)器人控制國(guó)際視野,IEEE/RSJ International Conference on Intelligent Robots and Systems,二. 機(jī)器人控制的分類,1）按照有無反饋分為： 開環(huán)控制 閉環(huán)控制,開環(huán)精確控制的條件：精確地知道被控對(duì)象的模型，并且這一模型在控制過程中保持不變,如果被控對(duì)象的模型能夠精確知道，但模型是變化的，怎么辦？,如果模型的變化是可以預(yù)測(cè)的,開環(huán)預(yù)測(cè)控制,如果模型的變化是可以實(shí)時(shí)辯識(shí)的,開環(huán)辨識(shí)控制,以被控對(duì)象的實(shí)際輸出構(gòu)成某種評(píng)價(jià)標(biāo)準(zhǔn)來修正控制器的輸入信號(hào)，以使對(duì)象的輸出接近期望值-閉環(huán)反饋控制,被控對(duì)象的特性（數(shù)學(xué)模型）不能完全確定或完全不能確定的情況下，怎么辦？,最常用的評(píng)價(jià)標(biāo)準(zhǔn)就是輸入與輸出（期望的輸出與實(shí)際輸出）之間的偏差,例如：,按照期望控制量分為：位置控制，力控制,智能化的控制方式,模糊控制(fuzzy control ) 自適應(yīng)控制（ adaptive control ） 最優(yōu)控制(optimal control) 神經(jīng)網(wǎng)絡(luò)控制(neuro control ) 模糊神經(jīng)網(wǎng)絡(luò)控制 專家控制(expert control) Others,三. 控制系統(tǒng)硬件配置及結(jié)構(gòu),電氣硬件 軟件架構(gòu),高性能機(jī)器人運(yùn)動(dòng)控制卡,主控芯片,單片機(jī) dsp tms320c6713 DSP Digital signal processing Samsung S5L8900B01ARM FPGA Field Programmable Gate Array （現(xiàn)場(chǎng)可編程邏輯陣列）,架構(gòu),Code Composer Studio (CCStudio) 集成開發(fā)環(huán)境,編程環(huán)境,例：靈巧手控制系統(tǒng),底層由手指DSP和FPGA實(shí)現(xiàn)傳感器數(shù)據(jù)采集、處理及電機(jī)驅(qū)動(dòng)； 在通訊層由手掌FPGA傳遞傳感器信號(hào)并且為各手指分配控制命令； 高層由高速浮點(diǎn)DSP執(zhí)行各種任務(wù)規(guī)劃及多指協(xié)調(diào) 整個(gè)系統(tǒng)控制周期為200s 頂層由計(jì)算機(jī)來提供多種人機(jī)接口,總體架構(gòu) 1）傳感器信號(hào)采集及處理系統(tǒng),驅(qū)動(dòng)電路系統(tǒng),基于PWM的三相全橋控制,電源系統(tǒng),實(shí)現(xiàn)電壓轉(zhuǎn)換,PID控制器的基本原理,反饋控制實(shí)例：PID,被控參數(shù)（位置、力、速度、溫度、流量、液位等）以怎樣的途徑，多長(zhǎng)時(shí)間到達(dá)期望值,PID 控制方法,以單個(gè)關(guān)節(jié)的角度控制為例,定義e(t)為輸入輸出之差的時(shí)間函數(shù),控制器公式,比例+積分控制器（P+I）,比例+積分+微分控制器（PID）,比例+微分控制器（PD）,比例控制器（P）,數(shù)字PID控制算法,計(jì)算機(jī)控制系統(tǒng)多數(shù)是采樣-數(shù)據(jù)控制系統(tǒng)。連續(xù)-時(shí)間信號(hào)采樣、量化數(shù)字量 積分，微分采用數(shù)值逼近的方法。,采用矩形積分,差分代替微分,代入的公式整理,做代換,得：,當(dāng)不需要控制量的絕對(duì)值，而是增量時(shí)（例如控制步進(jìn)電機(jī)）采用增量式控制方法,做差,優(yōu)點(diǎn)：抗積分飽和（當(dāng)控制變量達(dá)到一定值后，系統(tǒng)的輸出不再增長(zhǎng)）,算法流程,Matlab/simulink 模型,仿真結(jié)果分析,PID控制器具有一定的魯棒性，但對(duì)干擾抑制效果不是很好,PID參數(shù)對(duì)控制系統(tǒng)性能的影響,Kp-影響系統(tǒng)的響應(yīng)速度，Kp越大，響應(yīng)速度越快,增大Kp可能會(huì)引起系統(tǒng)超調(diào)，甚至振蕩和不穩(wěn)定；,Ki-影響系統(tǒng)的靜態(tài)精度，有利于消除系統(tǒng)的靜態(tài)誤差，但Ki過大也可能會(huì)引起系統(tǒng)超調(diào)，甚至振蕩和不穩(wěn)定；,Kd-影響系統(tǒng)的響應(yīng)速度，通常可加快系統(tǒng)的穩(wěn)定時(shí)間，但微分環(huán)節(jié)也會(huì)把外部的干擾放大，微分作用過強(qiáng)，可能會(huì)引起系統(tǒng)的振蕩和不穩(wěn)定；,傳統(tǒng)PID參數(shù)整定方法,PID控制器參數(shù)整定的一般規(guī)律,先調(diào)節(jié) Kp, 至系統(tǒng)出現(xiàn)振蕩,設(shè)此時(shí)比例增益為Kp 取Kp = Kp/2, 逐漸增大Ki,直至出現(xiàn)振蕩,記Ki 取Ki=Ki/3, 調(diào)節(jié)Kd, 直至獲得滿意的系統(tǒng)特性,機(jī)器人的位置控制,機(jī)器人系統(tǒng)的特點(diǎn)：電機(jī)驅(qū)動(dòng)，動(dòng)態(tài)特性非線性，關(guān)節(jié)彈性及摩擦存在,在建立模型時(shí)，提出下列兩個(gè)假設(shè)： （1）機(jī)器人的各段是理想剛體，因而所有關(guān)節(jié)都是理想的，不存在摩擦和間隙。 （2）相鄰兩連桿間只有一個(gè)自由度，要么為完全旋轉(zhuǎn)的要么是完全平移的。,笛卡爾空間位置控制,Xd為笛卡爾空間期望位置，Xe為實(shí)際位置,從穩(wěn)定性和精度的觀點(diǎn)看，要獲得滿意的伺服傳動(dòng)性能，必須在伺服電路內(nèi)引入補(bǔ)償網(wǎng)絡(luò)。,1機(jī)器人位置控制任務(wù)分類：點(diǎn)到點(diǎn)的控制(如搬運(yùn)、點(diǎn)焊機(jī)器人)或連續(xù)路徑的控制（如弧焊、噴漆機(jī)器人）。,2. 位置控制方法：關(guān)節(jié)空間控制結(jié)構(gòu)和直角坐標(biāo)空間控制結(jié)構(gòu)，分別見圖5.11（a）和（b）所示。,位置、速度反饋控制,速度環(huán)：使關(guān)節(jié)電機(jī)表現(xiàn)出期望的速度特性，通常通過驅(qū)動(dòng)器的電流環(huán)控制 位置環(huán)：使關(guān)節(jié)電機(jī)運(yùn)動(dòng)到期望的位置，由控制器實(shí)現(xiàn)。,速度、加速度前饋補(bǔ)償控制,當(dāng)機(jī)器人處于高度運(yùn)動(dòng)時(shí)，位置、速度反饋的精度大幅降低，此時(shí)通過速度、加速度前饋補(bǔ)償提高跟蹤精度。,速度、加速度前饋補(bǔ)償,鎖住機(jī)器人的其他各關(guān)節(jié)而依次移動(dòng)一個(gè)關(guān)節(jié)，這種工作方法顯然是低效率的。這種工作過程使執(zhí)行規(guī)定任務(wù)的時(shí)間變得過長(zhǎng)，因而是不經(jīng)濟(jì)的。不過，如果要讓一個(gè)以上的關(guān)節(jié)同時(shí)運(yùn)動(dòng)，那么各運(yùn)動(dòng)關(guān)節(jié)間的力和力矩會(huì)產(chǎn)生互相作用，而且不能對(duì)每個(gè)關(guān)節(jié)適當(dāng)?shù)貞?yīng)用前述位置控制器。因此，要克服這種互相作用，就必須附加補(bǔ)償作用。要確定這種補(bǔ)償，就需要分析機(jī)器人的動(dòng)態(tài)特征。 1動(dòng)態(tài)方程的拉格朗日公式 動(dòng)態(tài)方程式表示一個(gè)系統(tǒng)的動(dòng)態(tài)特征。我們已討論過動(dòng)態(tài)方程的一般形式的拉格朗日方程如下：,多關(guān)節(jié)位置控制器,二自由度機(jī)械手簡(jiǎn)圖,二自由度機(jī)械手的動(dòng)力學(xué)方程,分解控制,基于計(jì)算力矩前饋補(bǔ)償?shù)亩嚓P(guān)節(jié)分解控制,專家控制系統(tǒng)(Expert Control System) 幾乎所有的專家控制都包括：knowledge base(知識(shí)庫), reasoning engineer (推理機(jī)), rule set (控制規(guī)則集) and/or control algorithm.,模糊控制系統(tǒng)(Fuzzy Control System) A new mechanism of control law of knowledge-based (rule-based) and even language-description. An improved alternative method to non-linear control.,神經(jīng)控制系統(tǒng)(Neuro-Control System) 控制系統(tǒng)基于 Artificial Neural Network (ANN-based control), 簡(jiǎn)稱為neural control or NN control.,教師學(xué)習(xí) Supervised neural controller structure,例：基于神經(jīng)網(wǎng)絡(luò)的位置控制,五. 機(jī)器人的力控制,力控制簡(jiǎn)介 直接力控制（Direct force control） 間接力控制（Indirect force control） 應(yīng)用舉例,力控制簡(jiǎn)介,目的: 控制機(jī)器人各關(guān)節(jié)使其末端表現(xiàn)出一定的力或力矩特性。,為什么采用力控制？,軸孔配合,形狀適應(yīng)性,接觸碰撞,直接力控制,作用：實(shí)現(xiàn)機(jī)器人與環(huán)境作用力的精確控制 實(shí)例：力的PI控制方法,特點(diǎn)：直接力控制具有力回路，直接控制期望力,直接力控制,間接力控制,分類：主動(dòng)柔順-阻抗控制；被動(dòng)柔順-變剛度,特點(diǎn)：間接力控制（阻抗控制、力/位混合控制）通過控制位置實(shí)現(xiàn)力控制，沒有明確力回路,單自由度系統(tǒng)柔順控制,寫成狀態(tài)圖的形式為：,在PD控制下,聯(lián)立得：,閉環(huán)系統(tǒng)狀態(tài)圖為：,傳遞函數(shù)為：,閉環(huán)系統(tǒng)的拉氏變換為：,穩(wěn)態(tài)位置為：,穩(wěn)態(tài)接觸力為：,當(dāng)：,二自由度機(jī)械臂與平面接觸的柔順控制,包含阻尼項(xiàng)的阻抗控制模型,阻抗控制分類,區(qū)別在內(nèi)環(huán),基于位置的笛卡爾空間阻抗控制,基于力的笛卡爾空間阻抗控制,例：機(jī)械臂笛卡爾阻抗控制,末端期望軌跡：X-Y平面內(nèi)直徑300mm的圓。 障礙物：圓柱形杯子。,各關(guān)節(jié)位置響應(yīng),笛卡爾位置響應(yīng),機(jī)械臂末端接觸力響應(yīng)曲線,末端接觸力,各關(guān)節(jié)力矩響應(yīng)曲線,關(guān)節(jié)力矩,被動(dòng)柔順控制,目的：基于安全性考慮 阿西莫夫三定律： 1950年,美國(guó)作家埃薩克·阿西莫夫在科幻小說I，Robot中首次使用了“Robotics” ，即“機(jī)器人學(xué)”。阿西莫夫提出了“機(jī)器人三定律”： 1、機(jī)器人不應(yīng)傷害人類,且在人類受到傷害時(shí)不可袖手旁觀； 2、機(jī)器人應(yīng)遵守人類的命令，與第一條違背的命令除外； 3、機(jī)器人應(yīng)能保護(hù)自己，與第一條相抵觸者除外。,工業(yè)機(jī)器人通常遠(yuǎn)離人，但當(dāng)人進(jìn)入其工作范圍，會(huì)造成意外傷害,與人交互需求,安全性是第一位的,從仿人的角度,變剛度,人體關(guān)節(jié)構(gòu)造,前臂肘關(guān)節(jié),仿生機(jī)器人關(guān)節(jié),