動態(tài)約束下可重構模塊機器人自適應滑?？刂品椒?/h1>
2022-09-19 01:27劉先學
機械設計與制造工程 2022年8期
劉先學，李 婕
(山東省諸城市機關事務服務中心，山東 諸城 262200)
由于現(xiàn)代機器人自動化程度較高，可在一定程度上代替人力勞動，因此其研發(fā)備受關注。經(jīng)過多年的研究與發(fā)展，該項技術已經(jīng)被應用于工業(yè)、航天、娛樂、采礦、探險和醫(yī)學等多個領域，存在部分功能無法完善的缺點，應用效果有待提升。目前部分機器人受到性能的影響無法應用于特定環(huán)境，或無法具有多項功能，隨著科技的發(fā)展，機器人的能力將不斷得到完善，其應用范圍也會逐漸擴大。由于目前機器人可實現(xiàn)的功能過于簡單，針對復雜任務，通常會采用具備不同特性的機器人來完成，該方法需要增加大量的成本。
目前，模塊化設計概念正在電力電子工程、計算機軟件工程、機械工程等多個領域中發(fā)揮作用，其基本思路是把一個復雜、繁瑣的系統(tǒng)切割為具有各種功能的模塊，讓這些模塊處于相互獨立的狀態(tài)，既易于維護，又能更好地保證各模塊之間應用邏輯清晰。為提升固定結構機器人的應用性能，部分學者將模塊化設計的概念引入機器人設計中，提出了可重構模塊機器人的概念。為研究多自由度串聯(lián)機器人的動力學模型，鄭銀湖等[1]提出基于雙曲正切函數(shù)的工業(yè)機器人滑模控制方法。該方法主要是將機器人的滑模控制算法與雙曲正切函數(shù)相結合，對其進行優(yōu)化，從而在保障其原有不變性和抗擾動性的基礎上大幅削減其輸入信號的抖振，以解決電機沖擊力大的問題。該方法在應用的過程中自適應能力一般，且對末端的約束力較差。郭文東等[2]提出基于模糊干擾觀測器的自適應滑模跟蹤控制方法，基于反演技術設計運動控制器和動力控制器，在運動控制器中采用分流技術克服了軌跡跟蹤初期經(jīng)常存在的速度跳變問題，在動力控制器中將模糊干擾觀測器與自適應滑?？刂葡嘟Y合，解決未知擾動對其的影響。該方法在應用過程中自適應能力較好，但跟蹤性能較差。針對上述問題，本文提出了動態(tài)約束下可重構模塊機器人自適應滑?？刂品椒ā?/p>
1 基于可重構模塊的機器人運動學關系分析
在研究機器人滑?？刂魄埃雀鶕?jù)運動學原理分析機器人各模塊間的運動學關系。通過改變模塊的裝配方式可完成不同機器人的構形。一個n自由度可重構模塊機器人的幾何構形可用下面三維構形矩陣R描述：
(1)
式中：On代表第n個可重構模塊機器人關節(jié)模塊的輸出口類型；L0代表可重構模塊機器人第一個關節(jié)模塊和基座模塊的連接方位；Ln代表可重構模塊機器人末端工具模塊與第n個關節(jié)模塊的連接方位；I1,I2,I3代表可重構模塊機器人關節(jié)模塊輸入口的類型；0元素代表占位符。兩個三自由度的可重構模塊機器人構形及其構形矩陣如圖1所示。
圖1 機器人構形及構形矩陣
通過可重構模塊機器人的主要架構構建兩端坐標系[3]?；K與工具模塊的特征函數(shù)為：
B=Trans(0,0,l)
(2)
T=Trans(0,0,l)
(3)
式中：B為基座模塊特征函數(shù)；T為工具模塊特征函數(shù)；Trans(0,0,l)為調用函數(shù)，即沿x,y,z軸分別移動0,0,l的距離。
在可重構模塊機器人關節(jié)模塊上建立坐標系。o為模塊坐標系，其z軸與關節(jié)模塊的旋轉軸重合，I[1]和I[2]為輸入口坐標系，O[1]和O[2]為輸出口坐標系[4]。根據(jù)牛頓-歐拉迭代方程建立動力學模型，其中一個關節(jié)模塊的幾何參數(shù)可用下面4個齊次變換矩陣描述：
JI[1],o(0)=Trans(0,0,d)
(4)
(5)
Jo,O[1](0)=Trans(0,0,d)
(6)
(7)
了解每個模塊的幾何參數(shù)以及它們之間的聯(lián)系后，可得到模塊之間的運動學關系。n自由度可重構模塊化機器人的運動學關系可表示為：
(8)
(9)
將式(8)、式(9)相乘，得到可重構模塊機器人的運動學方程：
T0,n+1(q)=T0,1(q1)T0,2(q2)…T0,n(qn)Tn,n+1
(10)
2 自適應滑?？刂品椒?/h2>
得到機器人各模塊間運動學方程后，為提高機器人的自適應能力，基于等效控制徑向基(RBF)神經(jīng)網(wǎng)絡設計自適應滑?？刂品椒?。選擇可重構模塊機器人滑模面，對其進行控制，跟蹤誤差方程s(t)為：
(11)
式中：λ為位姿誤差控制系數(shù)；ec為可重構模塊機器人的位姿跟蹤誤差；t為時間。選取2個輸入、N個隱藏單元及2個輸出的網(wǎng)絡結構，將RBF神經(jīng)網(wǎng)絡的輸入與跟蹤誤差方程相結合[5]，獲得的RBF神經(jīng)網(wǎng)絡的輸出BNN(i)為：
(12)
式中：Wi為網(wǎng)絡向量；Hi為徑向向量。RBF神經(jīng)網(wǎng)絡的穩(wěn)定函數(shù)hij表示為
(13)
式中：exp(·)為調動函數(shù)；xi為RBF神經(jīng)網(wǎng)絡第i個輸入節(jié)點函數(shù)；cij和σij分別為RBF神經(jīng)網(wǎng)絡第i個輸入的第j個節(jié)點的中心和底部寬度，均大于0。假設神經(jīng)網(wǎng)絡逼近的最佳值BNN為：
(14)
式中：W1,W2為網(wǎng)絡向量；H1,H2為徑向向量。則BNN的等效控制變量B1為：
B1=BNN+ε
(15)
(16)
A=βiHiec(i) i=1,2
(17)
式中：βi為學習率；ec(i)為可重構模塊機器人的位姿跟蹤誤差函數(shù)。為彌補由于網(wǎng)絡不確定性對系統(tǒng)模型的影響，切換控制規(guī)則，提出一種基于比例控制的自適應滑模控制方法，以克服網(wǎng)絡的初始學習錯誤，提高系統(tǒng)的暫態(tài)響應。
(18)
式中：Bhc為自適應控制權值；kp為比例系數(shù)；Bsw為切換的控制系數(shù)。Bsw可表示為：
Bsw=Γsgn(s)
(19)
式中：Γ為滑模控制的增益；sgn(s)為階躍函數(shù)。當時間t≥0時，機械手的滑移運動軌跡誤差公式如下：
(20)
速度跟蹤誤差公式為：
(21)
此時，神經(jīng)滑模控制方程B2為：
(22)
在控制過程中，除引入開關控制以消除錯誤外，還針對抖動，引入RBF神經(jīng)網(wǎng)絡對Γ進行調節(jié)。則RBF神經(jīng)網(wǎng)絡的輸出Γi為：
(23)
式中：Ai為網(wǎng)絡的權向量；ψi為徑向基向量[7]。由此，徑向基函數(shù)的輸出φij可用下式表示：
j=1,2,…,m
(24)
(25)
(26)
(27)
式中：κi為學習率；si為速度跟蹤誤差。由此，可得可重構模塊機器人自適應滑?？刂品匠藼3為：
(28)
3 實驗結果與分析
為驗證所提控制方法的有效性，對具有兩個自由度的可重構模塊機器人進行實驗分析。實驗平臺為MATLAB，被測試的可重構模塊機器人實物圖如圖2所示，實驗參數(shù)見表1。
圖2 可重構模塊機器人
表1 實驗參數(shù)
選用傳統(tǒng)一階滑?？刂品椒ㄗ鳛閷Ρ确椒ǎc本文所提的控制方法進行對比分析，得到應用兩種方法后構形A位置及力矩模擬曲線如圖3、圖4所示。
結合圖3、圖4可知，傳統(tǒng)的滑模控制器在初期會出現(xiàn)較大顫動，因此本文采用了一種新的自適應滑模控制器，該控制器不僅可對初值偏差進行補償，還可在較小的時間段中得到預期的錯誤特性，從而對抖動進行有效抑制。通過對傳統(tǒng)滑?？刂破鞯母櫰罘治霰砻?，該控制器具有很好的控制精度，但它無法按照實際情況對控制精度進行調節(jié)，具有很大的周期性偏差；由電動機的輸出扭矩和聯(lián)合估算的扭矩分布可發(fā)現(xiàn)，在使用滑?？刂破鲿r，電動機的轉矩會出現(xiàn)顯著顫動，從而使綜合估算的扭矩出現(xiàn)較大顫動；在應用本文所提控制方法后，電機輸出轉矩和聯(lián)合估計轉矩的抖振明顯減小，達到了理想的控制效果。通過實驗證明，本文方法可對可重構模塊機器人的關節(jié)運動進行良好的跟蹤控制。
圖3 應用傳統(tǒng)方法后構形A位置、力矩曲線
圖4 應用本文方法獲得的構形A位置、力矩曲線
在結構B型鉸鏈中，由于外部約束的作用，其關節(jié)位置和控制扭矩均為零。通過實驗得到應用兩種方法后構形B位置、力矩模擬曲線的結果，如圖5、圖6所示。
圖6 采用本文方法獲得的構形B位置、力矩曲線
由圖5和6可知，這種滑模控制算法是行之有效的，而且在不改變控制參數(shù)的前提下有較好的適應性。
圖5 采用傳統(tǒng)方法獲得的構形B位置、力矩曲線
采用本文方法獲得的機器人末端約束力及軌跡追蹤曲線如圖7所示。
圖7 采用本文方法獲得的機器人末端約束力及軌跡跟蹤曲線
由圖7可知，在機器人末端受到外部約束力的情況下，所提出的方法能夠有效實現(xiàn)機器人末端的運動目標，滿足可重組模塊機器人的可達性要求，取得了較好的控制效果。
4 結束語
可重組模塊機器人是由一組帶有標準連接界面的連桿組件和鉸鏈組件構成，能夠根據(jù)不同的工作環(huán)境，迅速裝配出運動參數(shù)不同的機器人。本文針對現(xiàn)有機器人運動控制方法運動軌跡跟蹤性能不佳、自適應能力差等問題進行研究，提出了基于動態(tài)約束下可重構模塊機器人自適應滑?？刂品椒?。實驗表明，與傳統(tǒng)控制方法相比，本文方法跟蹤誤差較小，且具有較好的適應性，在機器人末端受到外力約束的情況下可有效實現(xiàn)機器人末端運動目標，具有較好的應用效果，可為今后機器人運動控制研究與發(fā)展打下基礎。
猜你喜歡
滑模及分數(shù)階理論在電機控制系統(tǒng)中的應用大電機技術(2022年2期)2022-06-05 雙星跟飛立體成像的構形保持控制空間科學學報(2021年6期)2021-03-09 復合切割機器人的運動學分析與仿真研究電子制作(2019年15期)2019-08-27 使用SGCMGs航天器滑模姿態(tài)容錯控制北京航空航天大學學報(2017年4期)2017-11-23 北京航空航天大學學報(2016年7期)2016-11-16 基于運動學特征的新型滑板對速滑蹬冰動作模擬的有效性冰雪運動(2016年5期)2016-04-16 北京航空航天大學學報(2016年4期)2016-02-27 基于運動學原理的LBI解模糊算法海軍航空大學學報(2015年1期)2015-11-11 InSAR衛(wèi)星編隊構形多約束優(yōu)化設計方法研究上海航天(2014年6期)2014-12-31 履帶式推土機行駛系統(tǒng)運動學分析筑路機械與施工機械化(2014年8期)2014-03-01
劉先學，李 婕
(山東省諸城市機關事務服務中心，山東 諸城 262200)
由于現(xiàn)代機器人自動化程度較高，可在一定程度上代替人力勞動，因此其研發(fā)備受關注。經(jīng)過多年的研究與發(fā)展，該項技術已經(jīng)被應用于工業(yè)、航天、娛樂、采礦、探險和醫(yī)學等多個領域，存在部分功能無法完善的缺點，應用效果有待提升。目前部分機器人受到性能的影響無法應用于特定環(huán)境，或無法具有多項功能，隨著科技的發(fā)展，機器人的能力將不斷得到完善，其應用范圍也會逐漸擴大。由于目前機器人可實現(xiàn)的功能過于簡單，針對復雜任務，通常會采用具備不同特性的機器人來完成，該方法需要增加大量的成本。
目前，模塊化設計概念正在電力電子工程、計算機軟件工程、機械工程等多個領域中發(fā)揮作用，其基本思路是把一個復雜、繁瑣的系統(tǒng)切割為具有各種功能的模塊，讓這些模塊處于相互獨立的狀態(tài)，既易于維護，又能更好地保證各模塊之間應用邏輯清晰。為提升固定結構機器人的應用性能，部分學者將模塊化設計的概念引入機器人設計中，提出了可重構模塊機器人的概念。為研究多自由度串聯(lián)機器人的動力學模型，鄭銀湖等[1]提出基于雙曲正切函數(shù)的工業(yè)機器人滑模控制方法。該方法主要是將機器人的滑模控制算法與雙曲正切函數(shù)相結合，對其進行優(yōu)化，從而在保障其原有不變性和抗擾動性的基礎上大幅削減其輸入信號的抖振，以解決電機沖擊力大的問題。該方法在應用的過程中自適應能力一般，且對末端的約束力較差。郭文東等[2]提出基于模糊干擾觀測器的自適應滑模跟蹤控制方法，基于反演技術設計運動控制器和動力控制器，在運動控制器中采用分流技術克服了軌跡跟蹤初期經(jīng)常存在的速度跳變問題，在動力控制器中將模糊干擾觀測器與自適應滑?？刂葡嘟Y合，解決未知擾動對其的影響。該方法在應用過程中自適應能力較好，但跟蹤性能較差。針對上述問題，本文提出了動態(tài)約束下可重構模塊機器人自適應滑?？刂品椒ā?/p>
1 基于可重構模塊的機器人運動學關系分析
在研究機器人滑?？刂魄埃雀鶕?jù)運動學原理分析機器人各模塊間的運動學關系。通過改變模塊的裝配方式可完成不同機器人的構形。一個n自由度可重構模塊機器人的幾何構形可用下面三維構形矩陣R描述：
(1)
式中：On代表第n個可重構模塊機器人關節(jié)模塊的輸出口類型；L0代表可重構模塊機器人第一個關節(jié)模塊和基座模塊的連接方位；Ln代表可重構模塊機器人末端工具模塊與第n個關節(jié)模塊的連接方位；I1,I2,I3代表可重構模塊機器人關節(jié)模塊輸入口的類型；0元素代表占位符。兩個三自由度的可重構模塊機器人構形及其構形矩陣如圖1所示。
圖1 機器人構形及構形矩陣
通過可重構模塊機器人的主要架構構建兩端坐標系[3]?；K與工具模塊的特征函數(shù)為：
B=Trans(0,0,l)
(2)
T=Trans(0,0,l)
(3)
式中：B為基座模塊特征函數(shù)；T為工具模塊特征函數(shù)；Trans(0,0,l)為調用函數(shù)，即沿x,y,z軸分別移動0,0,l的距離。
在可重構模塊機器人關節(jié)模塊上建立坐標系。o為模塊坐標系，其z軸與關節(jié)模塊的旋轉軸重合，I[1]和I[2]為輸入口坐標系，O[1]和O[2]為輸出口坐標系[4]。根據(jù)牛頓-歐拉迭代方程建立動力學模型，其中一個關節(jié)模塊的幾何參數(shù)可用下面4個齊次變換矩陣描述：
JI[1],o(0)=Trans(0,0,d)
(4)
(5)
Jo,O[1](0)=Trans(0,0,d)
(6)
(7)
了解每個模塊的幾何參數(shù)以及它們之間的聯(lián)系后，可得到模塊之間的運動學關系。n自由度可重構模塊化機器人的運動學關系可表示為：
(8)
(9)
將式(8)、式(9)相乘，得到可重構模塊機器人的運動學方程：
T0,n+1(q)=T0,1(q1)T0,2(q2)…T0,n(qn)Tn,n+1
(10)
2 自適應滑?？刂品椒?/h2>
得到機器人各模塊間運動學方程后，為提高機器人的自適應能力，基于等效控制徑向基(RBF)神經(jīng)網(wǎng)絡設計自適應滑?？刂品椒?。選擇可重構模塊機器人滑模面，對其進行控制，跟蹤誤差方程s(t)為：
(11)
式中：λ為位姿誤差控制系數(shù)；ec為可重構模塊機器人的位姿跟蹤誤差；t為時間。選取2個輸入、N個隱藏單元及2個輸出的網(wǎng)絡結構，將RBF神經(jīng)網(wǎng)絡的輸入與跟蹤誤差方程相結合[5]，獲得的RBF神經(jīng)網(wǎng)絡的輸出BNN(i)為：
(12)
式中：Wi為網(wǎng)絡向量；Hi為徑向向量。RBF神經(jīng)網(wǎng)絡的穩(wěn)定函數(shù)hij表示為
(13)
式中：exp(·)為調動函數(shù)；xi為RBF神經(jīng)網(wǎng)絡第i個輸入節(jié)點函數(shù)；cij和σij分別為RBF神經(jīng)網(wǎng)絡第i個輸入的第j個節(jié)點的中心和底部寬度，均大于0。假設神經(jīng)網(wǎng)絡逼近的最佳值BNN為：
(14)
式中：W1,W2為網(wǎng)絡向量；H1,H2為徑向向量。則BNN的等效控制變量B1為：
B1=BNN+ε
(15)
(16)
A=βiHiec(i) i=1,2
(17)
式中：βi為學習率；ec(i)為可重構模塊機器人的位姿跟蹤誤差函數(shù)。為彌補由于網(wǎng)絡不確定性對系統(tǒng)模型的影響，切換控制規(guī)則，提出一種基于比例控制的自適應滑模控制方法，以克服網(wǎng)絡的初始學習錯誤，提高系統(tǒng)的暫態(tài)響應。
(18)
式中：Bhc為自適應控制權值；kp為比例系數(shù)；Bsw為切換的控制系數(shù)。Bsw可表示為：
Bsw=Γsgn(s)
(19)
式中：Γ為滑模控制的增益；sgn(s)為階躍函數(shù)。當時間t≥0時，機械手的滑移運動軌跡誤差公式如下：
(20)
速度跟蹤誤差公式為：
(21)
此時，神經(jīng)滑模控制方程B2為：
(22)
在控制過程中，除引入開關控制以消除錯誤外，還針對抖動，引入RBF神經(jīng)網(wǎng)絡對Γ進行調節(jié)。則RBF神經(jīng)網(wǎng)絡的輸出Γi為：
(23)
式中：Ai為網(wǎng)絡的權向量；ψi為徑向基向量[7]。由此，徑向基函數(shù)的輸出φij可用下式表示：
j=1,2,…,m
(24)
(25)
(26)
(27)
式中：κi為學習率；si為速度跟蹤誤差。由此，可得可重構模塊機器人自適應滑?？刂品匠藼3為：
(28)
3 實驗結果與分析
為驗證所提控制方法的有效性，對具有兩個自由度的可重構模塊機器人進行實驗分析。實驗平臺為MATLAB，被測試的可重構模塊機器人實物圖如圖2所示，實驗參數(shù)見表1。
圖2 可重構模塊機器人
表1 實驗參數(shù)
選用傳統(tǒng)一階滑?？刂品椒ㄗ鳛閷Ρ确椒ǎc本文所提的控制方法進行對比分析，得到應用兩種方法后構形A位置及力矩模擬曲線如圖3、圖4所示。
結合圖3、圖4可知，傳統(tǒng)的滑模控制器在初期會出現(xiàn)較大顫動，因此本文采用了一種新的自適應滑模控制器，該控制器不僅可對初值偏差進行補償，還可在較小的時間段中得到預期的錯誤特性，從而對抖動進行有效抑制。通過對傳統(tǒng)滑?？刂破鞯母櫰罘治霰砻?，該控制器具有很好的控制精度，但它無法按照實際情況對控制精度進行調節(jié)，具有很大的周期性偏差；由電動機的輸出扭矩和聯(lián)合估算的扭矩分布可發(fā)現(xiàn)，在使用滑?？刂破鲿r，電動機的轉矩會出現(xiàn)顯著顫動，從而使綜合估算的扭矩出現(xiàn)較大顫動；在應用本文所提控制方法后，電機輸出轉矩和聯(lián)合估計轉矩的抖振明顯減小，達到了理想的控制效果。通過實驗證明，本文方法可對可重構模塊機器人的關節(jié)運動進行良好的跟蹤控制。
圖3 應用傳統(tǒng)方法后構形A位置、力矩曲線
圖4 應用本文方法獲得的構形A位置、力矩曲線
在結構B型鉸鏈中，由于外部約束的作用，其關節(jié)位置和控制扭矩均為零。通過實驗得到應用兩種方法后構形B位置、力矩模擬曲線的結果，如圖5、圖6所示。
圖6 采用本文方法獲得的構形B位置、力矩曲線
由圖5和6可知，這種滑模控制算法是行之有效的，而且在不改變控制參數(shù)的前提下有較好的適應性。
圖5 采用傳統(tǒng)方法獲得的構形B位置、力矩曲線
采用本文方法獲得的機器人末端約束力及軌跡追蹤曲線如圖7所示。
圖7 采用本文方法獲得的機器人末端約束力及軌跡跟蹤曲線
由圖7可知，在機器人末端受到外部約束力的情況下，所提出的方法能夠有效實現(xiàn)機器人末端的運動目標，滿足可重組模塊機器人的可達性要求，取得了較好的控制效果。
4 結束語
可重組模塊機器人是由一組帶有標準連接界面的連桿組件和鉸鏈組件構成，能夠根據(jù)不同的工作環(huán)境，迅速裝配出運動參數(shù)不同的機器人。本文針對現(xiàn)有機器人運動控制方法運動軌跡跟蹤性能不佳、自適應能力差等問題進行研究，提出了基于動態(tài)約束下可重構模塊機器人自適應滑?？刂品椒?。實驗表明，與傳統(tǒng)控制方法相比，本文方法跟蹤誤差較小，且具有較好的適應性，在機器人末端受到外力約束的情況下可有效實現(xiàn)機器人末端運動目標，具有較好的應用效果，可為今后機器人運動控制研究與發(fā)展打下基礎。
猜你喜歡
大電機技術(2022年2期)2022-06-05
空間科學學報(2021年6期)2021-03-09
電子制作(2019年15期)2019-08-27
北京航空航天大學學報(2017年4期)2017-11-23
冰雪運動(2016年5期)2016-04-16
海軍航空大學學報(2015年1期)2015-11-11
上海航天(2014年6期)2014-12-31
筑路機械與施工機械化(2014年8期)2014-03-01
