可穿戴上肢外骨骼機(jī)器人的算法和仿真

吳 攀,張恕遠(yuǎn),譚 越,李 瀟,劉 川,鄧 勇,呂光遠(yuǎn)

(1.西華大學(xué)機(jī)械工程學(xué)院，四川 成都 610039;2.95685部隊(duì)，云南 昆明 650000；3.成都航天通信設(shè)備有限責(zé)任公司，四川 成都 610051)

可穿戴上肢外骨骼機(jī)器人的算法和仿真

吳 攀1,張恕遠(yuǎn)1,譚 越1,李 瀟2,劉 川3,鄧 勇1,呂光遠(yuǎn)1

(1.西華大學(xué)機(jī)械工程學(xué)院，四川 成都 610039;2.95685部隊(duì)，云南 昆明 650000；3.成都航天通信設(shè)備有限責(zé)任公司，四川 成都 610051)

針對(duì)可穿戴上肢外骨骼機(jī)器人的傳統(tǒng)PID控制算法穩(wěn)定時(shí)間長(zhǎng)、偏差較大等特點(diǎn)，分析了可穿戴上肢外骨骼工作原理和結(jié)構(gòu)，建立了人體上肢外骨骼的控制模型，提出了具有自適應(yīng)性、精確性、快速響應(yīng)性等特點(diǎn)的自抗擾控制算法，從而達(dá)到外骨骼快速跟隨手臂和手臂平穩(wěn)控制外骨骼的目的。通過(guò)對(duì)PID算法、非線性跟蹤微分器(TD)、非線性擴(kuò)張狀態(tài)觀測(cè)器(ESO)、自抗擾控制算法的理論分析和Matlab仿真，得到了更直觀的運(yùn)動(dòng)學(xué)數(shù)據(jù)：關(guān)節(jié)的最大偏差和達(dá)到穩(wěn)定的時(shí)間。比較分析這幾種算法的數(shù)據(jù)可知，自抗擾控制具有響應(yīng)迅速、動(dòng)態(tài)補(bǔ)償、超調(diào)量小的優(yōu)點(diǎn)。制作了試樣關(guān)節(jié)、控制電路、驅(qū)動(dòng)電路，并編寫(xiě)了對(duì)應(yīng)的調(diào)試程序。試驗(yàn)結(jié)果表明，自抗擾控制算法可以更好地控制上肢外骨骼機(jī)器人，具有良好的實(shí)際控制效果。

機(jī)器人； 可穿戴上肢外骨骼; 智能控制； 控制算法； 自抗擾； PID算法

0 引言

上肢關(guān)節(jié)的控制算法作為整個(gè)外骨骼機(jī)器人系統(tǒng)的“靈魂”，關(guān)系到系統(tǒng)的穩(wěn)定性和安全性?？纱┐魃现夤趋雷鳛檩o助人體的機(jī)械設(shè)備，可跟隨手臂運(yùn)動(dòng)，輔助搬運(yùn)物體。在此過(guò)程中，搬運(yùn)的物體質(zhì)量存在不確定性，系統(tǒng)的摩擦力隨外界溫度、系統(tǒng)的使用時(shí)間變化也存在不確定性[1]。

針對(duì)上述系統(tǒng)的時(shí)變特點(diǎn)，需要控制算法具有自適應(yīng)性、精確性、快速響應(yīng)性，使外骨骼快速跟隨手臂。由于傳統(tǒng)的PID算法輸入信號(hào)為差值，輸出的快速性和超調(diào)性存在矛盾，所以PID算法存在一定的缺陷。由于手臂存在柔性，從控制整體的精度來(lái)看，控制精確性要求不高。但是控制過(guò)程中的超調(diào)量(過(guò)沖)，特別是在卸載過(guò)程中，會(huì)對(duì)手臂造成傷害。因此，選擇自抗擾控制算法來(lái)實(shí)現(xiàn)對(duì)關(guān)節(jié)的快速、精確、平穩(wěn)控制。

1 PID控制算法的理論基礎(chǔ)和仿真實(shí)現(xiàn)

PID控制算法是較常用的算法。本文通過(guò)PID控制算法對(duì)外骨骼進(jìn)行控制，再觀察控制結(jié)果，從而對(duì)機(jī)械骨骼特性有更直觀的認(rèn)識(shí)[1-2]。

PID控制率為：

(1)

整理得到：

(2)

式中：u(t)為輸出，在這里為轉(zhuǎn)矩；e(t)為控制器輸入的偏差信號(hào)；kp、ki、kd分別為比例、積分和微分所占比例系數(shù)，這三個(gè)系數(shù)的選取關(guān)系到算法的響應(yīng)速度、超調(diào)量和靜差。

建立控制模型，關(guān)于轉(zhuǎn)矩的方程為：

(3)

為了簡(jiǎn)化過(guò)程,先忽略摩擦力和外部擾動(dòng)，數(shù)學(xué)模型中的參數(shù)和動(dòng)力學(xué)仿真中相同。

初始條件kp、ki、kd分別為150、120、20，關(guān)節(jié)3的角度不變，關(guān)節(jié)4的階躍為90°。觀察階躍響應(yīng)下的輸出比較如圖1所示。

圖1 采用PID控制算法的關(guān)節(jié)角度響應(yīng)曲線圖

從圖1可以看出，加入積分分量可消除靜差，但是積分分量在消除靜差的同時(shí)也帶來(lái)了超調(diào)，且誤差越大積分越快。如果在平衡位置積分量過(guò)大會(huì)造成超調(diào)，超調(diào)的誤差為負(fù)誤差，積分量減小，從而漸漸達(dá)到平衡。

關(guān)節(jié)3的角度響應(yīng)如圖1(a)所示，出現(xiàn)誤差后積分分量作用于積分，出現(xiàn)超調(diào)后積分分量減小，角度也減小，積分逐步穩(wěn)定。此過(guò)程太慢且不穩(wěn)定，6 s后完全消除了靜差。關(guān)節(jié)4的角度響應(yīng)如圖1(b)所示，在3 s后完全消除了靜差，從而達(dá)到穩(wěn)定。

2 自抗擾算法的理論和仿真

自抗擾控制器[4]由非線性跟蹤微分器(tracking differentiator，TD)[5]、非線性擴(kuò)張狀態(tài)觀測(cè)器(extended state observer，ESO)[6]和非線性PID組合[7]而成。

非線性跟蹤微分器對(duì)輸入信號(hào)進(jìn)行跟蹤和微分，同時(shí)具有濾波的作用，可用于對(duì)系統(tǒng)控制的輸入信號(hào)進(jìn)行過(guò)渡和濾波，并得到輸入信號(hào)的微分。

非線性擴(kuò)張觀測(cè)器完成對(duì)系統(tǒng)未知干擾和不確定部分的估計(jì)。

非線性PID組合是在非線性范圍內(nèi)尋找更優(yōu)的組合形式。其中，非線性跟蹤微分器和觀測(cè)補(bǔ)償是控制器的必備和主要功能，非線性PID組合形式可結(jié)合自身功能需要確定[8]。

2.1 非線性TD的理論基礎(chǔ)和仿真實(shí)現(xiàn)

韓京清教授設(shè)計(jì)的跟蹤微分器可對(duì)階躍信號(hào)完成過(guò)渡處理，并對(duì)輸入信號(hào)進(jìn)行濾波，最終得到其微分。

x1(k+1)=x1(k)+hx2(k)

(4)

x2(k+1)=x2(k)+h×fst{[x1(k)-v(k)],x2,δ}

(5)

式中:x1為跟蹤信號(hào)；h為采樣周期；x2為跟蹤的微分信號(hào)；fst{[x1(k)-v(k)],x2,δ}為最速控制的綜合函數(shù)；v為輸入信號(hào)；δ為跟蹤輸入函數(shù)快慢的參數(shù)，數(shù)值越大表示跟蹤越快。

利用Matlab對(duì)加入干擾的階躍信號(hào)進(jìn)行跟蹤。確定采樣周期h=0.01，δ=250，干擾信號(hào)為隨機(jī)信號(hào)，幅度為0.5，階躍信號(hào)幅值為10。跟蹤信號(hào)仿真結(jié)果如圖2所示。

由圖2(a)可知，輸出信號(hào)能夠平穩(wěn)地跟蹤階躍信號(hào)完成過(guò)渡過(guò)程，并濾除干擾信號(hào)以還原原始信號(hào)。由圖2(b)可知，與跟蹤信號(hào)對(duì)比，微分有明顯的加速和減速過(guò)程，完成微分量穩(wěn)定到0的過(guò)渡，且基本不受干擾影響。

2.2 ESO的理論基礎(chǔ)與仿真實(shí)現(xiàn)

在外骨骼的控制系統(tǒng)運(yùn)行過(guò)程中，變量無(wú)法在線測(cè)試并存在未知的外部擾動(dòng)，對(duì)控制有很大的干擾和影響。如果能將這些變化量統(tǒng)一地表示出來(lái)，補(bǔ)償?shù)娇刂戚敵鲋幸韵獠坎淮_定因素的影響，則可以提高系統(tǒng)的控制精度和適應(yīng)性。觀測(cè)器的作用是估計(jì)系統(tǒng)中不能直接測(cè)量的狀態(tài)變量。

圖2 跟蹤信號(hào)仿真結(jié)果

根據(jù)韓京清教授所設(shè)計(jì)的擴(kuò)張狀態(tài)觀測(cè)器，動(dòng)力關(guān)節(jié)是一個(gè)獨(dú)立的控制單元，所以輸入和輸出都應(yīng)該為該關(guān)節(jié)自身可以檢測(cè)的量，關(guān)節(jié)間的力擾動(dòng)、外部干擾等均采用觀測(cè)器作為外部擾動(dòng)進(jìn)行觀測(cè)。動(dòng)力關(guān)節(jié)模型表示為：

x1=x2

(6)

x3=x4

(7)

x2=f1(x,u2)+b1u1

(8)

x4=f2(x,u1)+b2u2

(9)

y1=x1

(10)

y2=x2

(11)

式中：[x1x2x3x4]=[θ3θ3θ4θ4]；f1(x1,u2)、f2(x,u1)分別為關(guān)于[x1x2x3x4]和關(guān)節(jié)輸入轉(zhuǎn)矩[u1u2]的復(fù)雜函數(shù)，很難直接確定函數(shù)參數(shù)。因此，把不確定的外部擾動(dòng)和內(nèi)部擾動(dòng)作為未知參數(shù)。ESO可表示為：

e=z1-y

(12)

z1=z2-β1e

(13)

z2=z3-β2fal(e,α1,δ)+bu

(14)

z3=-β3fal(e,α2,δ)

(15)

式中：fal(e,α,δ)為飽和函數(shù)。將β1=100、β2=250、β3=800、δ=0.01代入ESO函數(shù)中，其他的模型參數(shù)原理也是一樣。利用Matlab進(jìn)行仿真，將動(dòng)力學(xué)模型用S函數(shù)Model表示[9]，同時(shí)也將觀測(cè)器需要觀測(cè)的部分輸出，以便查看觀測(cè)器是否正確運(yùn)行。

將觀測(cè)器的輸出代入PID控制中進(jìn)行補(bǔ)償，只要將PID控制器中的kp、ki、kd分別設(shè)為150、0、20，即可得關(guān)節(jié)角度響應(yīng)曲線如圖3所示。

圖3 采用ESO的關(guān)節(jié)角度響應(yīng)曲線圖

圖3(a)為關(guān)節(jié)3的角度響應(yīng)曲線圖。關(guān)節(jié)3受到關(guān)節(jié)4的作用力向負(fù)方向運(yùn)動(dòng)，最大角度為-100°，最大偏差為10°，小于單純PID控制的關(guān)節(jié)3偏差，在0.6 s后達(dá)到穩(wěn)定且無(wú)明顯超調(diào)。圖3(b)為關(guān)節(jié)4的角度響應(yīng)曲線圖。關(guān)節(jié)4設(shè)定的目標(biāo)角度為90°，在0.5 s內(nèi)快速、平穩(wěn)到達(dá)設(shè)定角度，并且無(wú)超調(diào)。

2.3 自抗擾控制算法的仿真實(shí)現(xiàn)

將非線性PID、擴(kuò)張觀測(cè)器和非線性跟蹤微分器三者有機(jī)地組合在一起，形成自抗干擾控制器。自抗干擾器電路[10]如圖4所示。

圖4 自抗干擾器電路圖

圖4中：V(t)為輸入信號(hào);Y(t)為輸出信號(hào);v1能夠快速無(wú)超調(diào)跟蹤上輸入信號(hào);b0為比例增益;v2為v1的一個(gè)微分信號(hào);z1為y的觀測(cè)量;z2為控制器的y的微分的觀測(cè)量。

利用Matlab進(jìn)行仿真[11]，仿真條件和上文一致，得到結(jié)果如圖5所示。關(guān)節(jié)3受到關(guān)節(jié)4的作用力，向負(fù)方向運(yùn)動(dòng)最大達(dá)到-95°，最大偏差為5°，比單純使用觀測(cè)器的偏差要小，在0.7 s后達(dá)到穩(wěn)定且無(wú)明顯超調(diào)。關(guān)節(jié)4設(shè)定的目標(biāo)角度為90°，在0.6 s內(nèi)快速平穩(wěn)到達(dá)設(shè)定角度且無(wú)超調(diào)。

圖5 采用自抗擾控制算法的關(guān)節(jié)角度響應(yīng)曲線圖

外骨骼關(guān)節(jié)在PID算法和自抗擾算法中的數(shù)據(jù)對(duì)比如表1所示。

表1 PID算法和自抗擾算法的數(shù)據(jù)對(duì)比

相對(duì)于PID算法，自抗擾控制具有響應(yīng)迅速，超調(diào)量小的優(yōu)點(diǎn)[12]。其觀測(cè)器可以實(shí)現(xiàn)對(duì)外部干擾和不確定參數(shù)的估計(jì)，以及控制系統(tǒng)的動(dòng)態(tài)補(bǔ)償。對(duì)外骨骼動(dòng)力關(guān)節(jié)的控制具有重要的意義。

3 可穿戴上肢外骨骼試驗(yàn)

為了對(duì)可穿戴上肢外骨骼動(dòng)力關(guān)節(jié)進(jìn)行進(jìn)一步的分析，設(shè)計(jì)并建立試驗(yàn)平臺(tái)，制作動(dòng)力關(guān)節(jié)試驗(yàn)樣品，驗(yàn)證了動(dòng)力關(guān)節(jié)控制算法及特性。

首先對(duì)系統(tǒng)控制電路板進(jìn)行焊接調(diào)試，測(cè)試電路的基本功能。檢測(cè)PWM輸出、MOS管驅(qū)動(dòng)器是否工作，并完成電流采集放大電路的放大倍數(shù)調(diào)節(jié)等。然后，制作動(dòng)力關(guān)節(jié)加工試驗(yàn)樣品。無(wú)刷電機(jī)通過(guò)關(guān)節(jié)的齒輪減速器輸出動(dòng)力，編碼器通過(guò)白色的塑料安裝架安裝在電機(jī)上面。通過(guò)安裝在主軸上的磁編碼器檢測(cè)關(guān)節(jié)角度，將總質(zhì)量為7 kg的鋁排作為關(guān)節(jié)的負(fù)載進(jìn)行驅(qū)動(dòng)，達(dá)到了理想的驅(qū)動(dòng)效果。

4 結(jié)束語(yǔ)

針對(duì)傳統(tǒng)PID控制器對(duì)外骨骼動(dòng)力關(guān)節(jié)控制存在的對(duì)部干擾敏感、超調(diào)過(guò)大和響應(yīng)過(guò)慢等問(wèn)題，利用自抗擾控制算法設(shè)計(jì)了自抗擾控制器，實(shí)現(xiàn)了對(duì)外骨骼動(dòng)力關(guān)節(jié)的控制。在對(duì)可穿戴上肢外骨骼結(jié)構(gòu)設(shè)計(jì)及控制算法進(jìn)行研究的基礎(chǔ)上，建立試驗(yàn)平臺(tái)，制作動(dòng)力關(guān)節(jié)樣品，驗(yàn)證動(dòng)力關(guān)節(jié)控制算法及特性。試驗(yàn)結(jié)果表明，動(dòng)力關(guān)節(jié)驅(qū)動(dòng)能力強(qiáng)，完全滿足要求；控制算法對(duì)輸入信號(hào)響應(yīng)迅速且無(wú)明顯超調(diào)。

[1] ASTROM K J，HAGGLUND T.PID controllers:theory,design and tuning[M].Instrument Society of America,1995.

[2] RAD A B，LO W L.Predictive PI controller[J].INT J Control,1994,60(5):953-975.

[3] 劉金琨．先進(jìn)PID控制及其Matlab仿真[M].3版.北京:電子工業(yè)出版社，2002．

[4] 韓京清,王偉.跟蹤微分器[J].系統(tǒng)科學(xué)與數(shù)學(xué),1994,14(2):177-183.

[5] 韓京清．從PID技術(shù)到“自抗擾控制”技術(shù)[J]．控制工程,2002,9(3):13-18．

[6] 韓京清．一類不確定對(duì)象的擴(kuò)張狀態(tài)觀測(cè)器[J]．控制與決策,1995,10(1):85-88．

[7] 韓京清．非線性PID控制器[J]．自動(dòng)化學(xué)報(bào),1994,20(4):487-490．

[8] 韓京清．非線性狀態(tài)誤差反饋控制律—NlsEF[J]．控制與決策,1995,10(3):221-225．

[9] 馮惕,王儉.基于S-函數(shù)計(jì)算機(jī)控制算法的Simulink仿真[J].福建電腦,2006(12):117-118.

[10]韓京清．自抗擾控制器及其應(yīng)用[J]．控制與決策,1998,13(1):19-23．

[11]薛定宇,陳陽(yáng)泉．基于Matlab/simulink的系統(tǒng)仿真技術(shù)與應(yīng)用[M]．北京：清華大學(xué)出版社，2002．

[12]韓京清.自抗擾控制技術(shù)[J].前沿科學(xué)，2007(1):25-32.

Algorithm and Simulation of Wearable Upper Limb Exoskeleton Robot

WU Pan1，ZHANG Shuyuan1，TAN Yue1，LI Xiao2，LIU Chuan3，DENG Yong1，LGuangyuan1

(1.School of Mechanical Engineering，Xihua University ，Chengdu 610039，China;2.95685 Troops，Kunming 650000，China; 3.Chengdu Space Communication Equipment Co.，Ltd.，Chengdu 610051，China)

According to the characteristics of the traditional control algorithm of wearable upper limb exoskeleton robot,i.e.,long stable time and large deviation,the operational principle and structure of the wearable upper limb exoskeleton are analyzed,and the control model of human upper limb exoskeleton is set up,the auto-disturbance-rejection control algorithm featuring adaptive,accurate,and fast response is put forward,which achieves the purpose that exoskeleton fast follows up the arm,and the arm smoothly controls exoskeleton.Though the theoretical analysis and MATLAB simulation of PID algorithm,nonlinear tracking differentiator,nonlinear extended state observer,and auto-disturbance-rejection control algorithm, more intuitive kinematic data are obtained:maximum deviation of the joints,the period for reaching stable state.Comparative analysis of the data of these several kinds of algorithms shows that the immunity control has the advantages of quick response,dynamic compensation and less overshoot.The sample joint,control circuit and drive circuit are fabricated,and corresponding debugging program is written,to verify that the auto-disturbance rejection control algorithm can better control the upper limb exoskeleton robot with practical control effects.

Robot； Wearable upper limb exoskeleton； Intelligent control； Control algorithm； Auto-disturbance-rejection； PID algorithm

四川省教育廳基金資助項(xiàng)目(JYBFX-YQ-1)

吳攀(1990—)，男，在讀碩士研究生，主要從事機(jī)電一體化方向的研究。E-mail:960496380@qq.com。

TH132;TP273

A

10.16086/j.cnki.issn 1000-0380.201702011

修改稿收到日期：2016-10-21