機械手的控制課件

機械手的控制

ControlofRoboticManipulator3.1機械人系統(tǒng)的構(gòu)成3.2傳遞函數(shù)和方框圖3.3PID控制3.4機械手的位置控制3.5機械手的力控制3.6其他控制方式簡介感謝你的觀看12019年7月19機械手的控制

ControlofRoboticManiRobotics控制3.1機械人系統(tǒng)的組成3.1.1機械人系統(tǒng)示意機器人的功能：①動作和運動的控制②末端操作器/手爪的軌跡和力的再現(xiàn)③運動狀態(tài)顯示、參數(shù)設(shè)定功能感謝你的觀看22019年7月19Robotics控制3.1機械人系統(tǒng)的組成感謝你的觀看22Robotics控制3.1機械人系統(tǒng)的組成3.1.2機械人框圖感謝你的觀看32019年7月19Robotics控制3.1機械人系統(tǒng)的組成感謝你的觀看32Robotics控制3.2傳遞函數(shù)和方框圖3.2.1傳遞函數(shù)感謝你的觀看42019年7月19Robotics控制3.2傳遞函數(shù)和方框圖感謝你的觀看42Robotics控制3.2傳遞函數(shù)和方框圖3.2.1傳遞函數(shù)感謝你的觀看52019年7月19Robotics控制3.2傳遞函數(shù)和方框圖感謝你的觀看52Robotics控制3.2傳遞函數(shù)和方框圖3.2.1傳遞函數(shù)感謝你的觀看62019年7月19Robotics控制3.2傳遞函數(shù)和方框圖感謝你的觀看62Robotics控制3.2傳遞函數(shù)和方框圖3.2.1傳遞函數(shù)L=0感謝你的觀看72019年7月19Robotics控制3.2傳遞函數(shù)和方框圖L=0感謝你的Robotics控制3.2傳遞函數(shù)和方框圖3.2.1傳遞函數(shù)感謝你的觀看82019年7月19Robotics控制3.2傳遞函數(shù)和方框圖感謝你的觀看82Robotics控制3.2傳遞函數(shù)和方框圖3.2.2方框圖感謝你的觀看92019年7月19Robotics控制3.2傳遞函數(shù)和方框圖感謝你的觀看92Robotics控制3.2傳遞函數(shù)和方框圖3.2.2方框圖感謝你的觀看102019年7月19Robotics控制3.2傳遞函數(shù)和方框圖感謝你的觀看10Robotics控制3.2傳遞函數(shù)和方框圖3.2.2方框圖感謝你的觀看112019年7月19Robotics控制3.2傳遞函數(shù)和方框圖感謝你的觀看11Robotics控制3.2傳遞函數(shù)和方框圖3.2.2方框圖感謝你的觀看122019年7月19Robotics控制3.2傳遞函數(shù)和方框圖感謝你的觀看12Robotics控制3.3PID控制3.3.1PID控制的基本形式感謝你的觀看132019年7月19Robotics控制3.3PID控制感謝你的觀看13201Robotics控制3.3PID控制3.3.1PID控制的基本形式感謝你的觀看142019年7月19Robotics控制3.3PID控制感謝你的觀看14201Robotics控制3.3PID控制3.3.1PID控制的基本形式感謝你的觀看152019年7月19Robotics控制3.3PID控制感謝你的觀看15201Robotics控制3.3PID控制3.3.2實用的PID控制感謝你的觀看162019年7月19Robotics控制3.3PID控制感謝你的觀看16201Robotics控制3.3PID控制3.3.2實用的PID控制（1）微分超前型PD控制感謝你的觀看172019年7月19Robotics控制3.3PID控制感謝你的觀看17201Robotics控制3.3PID控制3.3.2實用的PID控制（1）微分超前型PD控制感謝你的觀看182019年7月19Robotics控制3.3PID控制感謝你的觀看18201Robotics控制3.3PID控制3.3.2實用的PID控制（1）微分超前型PD控制感謝你的觀看192019年7月19Robotics控制3.3PID控制感謝你的觀看19201Robotics控制3.3PID控制3.3.2實用的PID控制（2）I-PD控制感謝你的觀看202019年7月19Robotics控制3.3PID控制感謝你的觀看20201Robotics控制3.4機械手的位置控制3.4.1手爪位置控制（1）使用逆運動學(xué)和關(guān)節(jié)角控制的方法感謝你的觀看212019年7月19Robotics控制3.4機械手的位置控制感謝你的觀看21Robotics控制3.4機械手的位置控制3.4.1手爪位置控制（2）注重靜力學(xué)關(guān)系的方法感謝你的觀看222019年7月19Robotics控制3.4機械手的位置控制感謝你的觀看22Robotics控制3.4機械手的位置控制3.4.2動態(tài)控制感謝你的觀看232019年7月19Robotics控制3.4機械手的位置控制感謝你的觀看23Robotics控制3.4機械手的位置控制3.4.2動態(tài)控制感謝你的觀看242019年7月19Robotics控制3.4機械手的位置控制感謝你的觀看24Robotics控制3.5機械手的力控制3.5.1單自由度機械系統(tǒng)的阻抗控制感謝你的觀看252019年7月19Robotics控制3.5機械手的力控制感謝你的觀看252Robotics控制3.5機械手的力控制3.5.1單自由度機械系統(tǒng)的阻抗控制感謝你的觀看262019年7月19Robotics控制3.5機械手的力控制感謝你的觀看262Robotics控制3.5機械手的力控制3.5.1單自由度機械系統(tǒng)的阻抗控制（1）外力矩可計測的場合感謝你的觀看272019年7月19Robotics控制3.5機械手的力控制感謝你的觀看272Robotics控制3.5機械手的力控制3.5.1單自由度機械系統(tǒng)的阻抗控制（2）關(guān)節(jié)角加速度可以檢出的場合感謝你的觀看282019年7月19Robotics控制3.5機械手的力控制感謝你的觀看282Robotics控制3.5機械手的力控制3.5.2機械手的阻抗控制手爪位置：手爪速度：手爪加速度：

靜力學(xué)關(guān)系式：控制對象：期望的動作：

（3.65）

感謝你的觀看292019年7月19Robotics控制3.5機械手的力控制手爪位置：手爪速度Robotics控制3.5機械手的力控制3.5.2機械手的阻抗控制（1）外力可以計測的情況感謝你的觀看302019年7月19Robotics控制3.5機械手的力控制感謝你的觀看302Robotics控制3.5機械手的力控制3.5.2機械手的阻抗控制（2）關(guān)節(jié)角加速度可以檢出的情況感謝你的觀看312019年7月19Robotics控制3.5機械手的力控制感謝你的觀看312Robotics控制3.5機械手的力控制3.5.2機械手的阻抗控制（3）既不需要檢出外力也不需要檢出關(guān)節(jié)角加速度

左乘感謝你的觀看322019年7月19Robotics控制3.5機械手的力控制感謝你的觀看322Robotics控制3.5機械手的力控制3.5.2機械手的阻抗控制感謝你的觀看332019年7月19Robotics控制3.5機械手的力控制感謝你的觀看332Robotics控制3.5機械手的力控制3.5.2機械手的阻抗控制（4）若手臂慢慢動作感謝你的觀看342019年7月19Robotics控制3.5機械手的力控制感謝你的觀看342Robotics控制3.5機械手的力控制3.5.3機械手的混合控制手爪偏差提?。?/p>

力偏差提?。?/p>

位置控制規(guī)律：

力控制規(guī)律：

感謝你的觀看352019年7月19Robotics控制3.5機械手的力控制手爪偏差提?。毫obotics控制3.5機械手的力控制3.5.3機械手的混合控制

感謝你的觀看362019年7月19Robotics控制3.5機械手的力控制感謝你的觀東南大學(xué)遠程教育機器人原理及應(yīng)用第三十一講主講教師：王興松感謝你的觀看372019年7月19東南大學(xué)遠程教育機器人原理及應(yīng)用第三十一講主講教師：王興Robotics控制3.6機械手的其他控制方式3.6.1機械手的模糊控制如果機器人的關(guān)節(jié)位置誤差為：則其PID控制為

感謝你的觀看382019年7月19Robotics控制3.6機械手的其他控制方式感謝你的觀東南大學(xué)遠程教育機器人原理及應(yīng)用第二十二講主講教師：王興松感謝你的觀看392019年7月19東南大學(xué)遠程教育機器人原理及應(yīng)用第二十二講主講教師：王興Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.2模糊集合與模糊邏輯的基本概念一、模糊集合與集合計算符定義1模糊集合：設(shè)U為若干事件的總和，如U=Rn，我們稱U為論域，一個定義在U上的模糊集合F，由隸屬度函數(shù)來表征，這里的表示在模糊集合F上的隸屬程度。經(jīng)典的集合（確定集合）的隸屬度函數(shù)只取兩個值{0,1}。要么屬于，要么不屬于。因此模糊集合是經(jīng)典集合的推廣。感謝你的觀看402019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.2模糊集合與模糊邏輯的基本概念定義2交集、并集和補集：設(shè)A和B是U上的兩個模糊集合。對所有的，A和B的交集是定義在U上的一個模糊集合，其隸屬度函數(shù)定義為：對所有的，A和B的并集是定義在U上的一個模糊集合，其隸屬度函數(shù)定義為：對所有的，A的補集是定義在U上的一個模糊集合，其隸屬度函數(shù)為：感謝你的觀看412019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.2模糊集合與模糊邏輯的基本概念定義3模糊關(guān)系設(shè)U和V是兩個論域。模糊關(guān)系R是積空間UxV上的一個模糊集合，即當(dāng)時，R的隸屬函數(shù)為.

定義4模糊蘊涵設(shè)A和B分別為定義在U和V上的模糊集合,則由所表示的模糊蘊涵是定義在UxV上的一個特殊模糊關(guān)系,其隸屬度函數(shù)定義為:模糊與:模糊或:實質(zhì)蘊涵:命題演算:感謝你的觀看422019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你東南大學(xué)遠程教育機器人原理及應(yīng)用第二十三講主講教師：王興松感謝你的觀看432019年7月19東南大學(xué)遠程教育機器人原理及應(yīng)用第二十三講主講教師：王興Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.2模糊集合與模糊邏輯的基本概念定義5廣義取式推理:前提1x為A’

前提2如果x為A,則y為B

結(jié)論y為B’

其中A‘、A、B’、B為模糊集合，x、y為語言變量定義6廣義取式推理:前提1y為B’

前提2如果x為A,則y為B

結(jié)論x為A’其中A‘、A、B’、B為模糊集合，x、y為語言變量感謝你的觀看442019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.3模糊規(guī)則與模糊推理模糊規(guī)則是由如下形式的“如果---則”規(guī)則的總和組成R（l）：如果x1為F1l，且…，且xn為Fnl，則y為Gl；

Fil、Gl為模糊集合，xi為模糊變量。將變量模糊化后，經(jīng)過按照模糊規(guī)則的運算，獲得模糊結(jié)果，這個過程稱為一個模糊推理。模糊推理得到的模糊輸出，再經(jīng)過反模糊化，即可得到模糊推理的精確解。感謝你的觀看452019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.4模糊控制工作原理一個典型的模糊控制系統(tǒng)感謝你的觀看462019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.4模糊控制工作原理例：一熱處理用的電熱爐，按工藝要求須保持爐溫600O不變。由于爐溫受零件數(shù)量、體積、環(huán)境溫度變化、電網(wǎng)電壓波動等影響，會出現(xiàn)波動所以要設(shè)計控制器?？刂品绞剑和ㄟ^改變可控硅的導(dǎo)通角實現(xiàn)；也可以通過PWM方式調(diào)節(jié)。人工調(diào)節(jié)時，通過面板上的電位器實現(xiàn)，計算機調(diào)節(jié)通過驅(qū)動線路實現(xiàn)。

感謝你的觀看472019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.4模糊控制工作原理典型的溫度控制電路如圖

INT1，INT2過零檢測，PB7觸發(fā)控制，AN0傳感器輸入A/D。感謝你的觀看482019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.4模糊控制工作原理人工操作時，根據(jù)經(jīng)驗，控制規(guī)則可以用語言描述如下：

如果爐穩(wěn)低于600OC則升壓，低得越多升壓越高；如果爐穩(wěn)高于600OC則降壓，高得越多降壓越低；如果爐穩(wěn)等于600OC則保持電壓不變；采用模糊控制時，其工作原理如下：1、模糊控制器的輸入變量與輸出變量設(shè)定爐溫t0=600，測量爐穩(wěn)t（K），則將誤差e(K)=t0-t(K)作為模糊控制的輸入變量。

輸出變量為：控制電壓u，可通過改變可控硅的導(dǎo)通角或PWM比例實現(xiàn)。感謝你的觀看492019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.4模糊控制工作原理2、輸入變量及輸出變量的模糊語言描述（模糊化）設(shè)描述輸入及輸出變量的語言值的模糊子集為：

{負大，負小，0，正小，正大}或記為{NB，NS，0，PS，PB}設(shè)誤差e的論域為X，并將誤差大小分為七個等級，為：-3，-2，-1，0，1，2，3，則有：X={-3，-2，-1，0，1，2，3}選控制變量u的論域為Y，并將其也分為七個等級，為：-3，-2，-1，0，1，2，3，則有：Y={-3，-2，-1，0，1，2，3}定義其隸屬度函數(shù)如圖：感謝你的觀看502019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.4模糊控制工作原理

由此得模糊變量賦值表：感謝你的觀看512019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.4模糊控制工作原理3、模糊控制規(guī)則的語言描述根據(jù)手動控制策略，規(guī)則為：（1）若e負大，則u正大；（2）若e負小，則u正小；（3）若e為零，則u為零；（4）若e正小，則u負??；（5）若e正大，則u負大；由此可得控制規(guī)則表：感謝你的觀看522019年7月19Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法感謝你Robotics控制3.6機器人關(guān)節(jié)控制的模糊算法3.6.4模糊控制工作原理