盧國(guó)健，高國(guó)琴，方志明

（江蘇大學(xué)電氣信息工程學(xué)院，江蘇鎮(zhèn)江 212013）

0 引言

鋼箱梁為大型橋梁的主要結(jié)構(gòu)（見圖1），在使用前對(duì)其進(jìn)行噴砂除銹等預(yù)處理可增強(qiáng)大橋的耐腐蝕性。目前噴砂除銹機(jī)器人主要為桁架式結(jié)構(gòu)，結(jié)構(gòu)復(fù)雜且龐大，難以運(yùn)輸，僅適用于室內(nèi)作業(yè)，與橋梁露天建設(shè)且作業(yè)地點(diǎn)流動(dòng)性強(qiáng)的特點(diǎn)相悖。我國(guó)研制的爬壁式除銹機(jī)器人［1-2］由于結(jié)構(gòu)原因承載力差、除銹效率低，不能處理復(fù)雜表面，難以勝任鋼箱梁的除銹工作?；诖耍菊n題組設(shè)計(jì)了一款如圖2 所示的噴砂除銹并聯(lián)機(jī)器人，其由移動(dòng)平臺(tái)、升降機(jī)構(gòu)、六自由度并聯(lián)操作機(jī)構(gòu)和末端噴槍構(gòu)成，具有工作空間大、承載性好、噴砂效率高的特點(diǎn)。

為確保除銹工作的穩(wěn)定性和高效性，作為承重機(jī)構(gòu)，移動(dòng)平臺(tái)對(duì)期望路線的精確跟蹤尤為重要。文獻(xiàn)［3-6］對(duì)移動(dòng)平臺(tái)在普通路面上的軌跡跟蹤控制進(jìn)行了研究，取得了較好效果。然而，噴砂除銹造成的鋼砂堆積路面黏著系數(shù)低［7］，在移動(dòng)平臺(tái)加速或經(jīng)過不平整路面時(shí)，極易產(chǎn)生空轉(zhuǎn)現(xiàn)象，嚴(yán)重影響移動(dòng)平臺(tái)的軌跡跟蹤精度?；谏鲜龇治?，本課題擬建立一種能夠克服鋼砂路面空轉(zhuǎn)問題的軌跡跟蹤控制算法。

1 相關(guān)研究

建立精確描述系統(tǒng)特性的數(shù)學(xué)模型是控制器設(shè)計(jì)的關(guān)鍵步驟，對(duì)于考慮滑移的移動(dòng)平臺(tái)模型，許多學(xué)者進(jìn)行了相關(guān)研究。文獻(xiàn)［8］將縱向滑移距離帶入運(yùn)動(dòng)學(xué)方程，并對(duì)滑移距離進(jìn)行估計(jì)，確保了移動(dòng)機(jī)器人軌跡跟蹤的精確性；文獻(xiàn)［9］將農(nóng)田環(huán)境中的橫向與縱向距離帶入運(yùn)動(dòng)學(xué)方程，并對(duì)距離的位置參數(shù)設(shè)計(jì)了自適應(yīng)更新率，確保了農(nóng)田拖拉機(jī)的自導(dǎo)式行駛。上述文獻(xiàn)僅從運(yùn)動(dòng)學(xué)層面對(duì)滑移率進(jìn)行了建模，無法精確描述打滑情況下移動(dòng)平臺(tái)的動(dòng)力學(xué)特性，難以運(yùn)用于動(dòng)力學(xué)控制器設(shè)計(jì)。根據(jù)滑移率特性曲線［10］，適量滑移可以給驅(qū)動(dòng)輪提供足夠大的地面切向力，但過度滑移會(huì)使移動(dòng)平臺(tái)切向力大幅度減小，最終導(dǎo)致空轉(zhuǎn)現(xiàn)象，嚴(yán)重影響移動(dòng)平臺(tái)軌跡跟蹤精度。文獻(xiàn)［11］基于文獻(xiàn)［12］對(duì)滑移動(dòng)力學(xué)特性的定量研究，將滑移現(xiàn)象視為驅(qū)動(dòng)力的干擾項(xiàng)并帶入動(dòng)力學(xué)方程，較為精確地描述了打滑情況下的移動(dòng)平臺(tái)動(dòng)力學(xué)模型，但該模型不能將滑移率設(shè)置為控制量，難以用于防空轉(zhuǎn)控制?；诖?，本文根據(jù)滑移特性曲線定量計(jì)算出滑移率對(duì)驅(qū)動(dòng)力的“削弱量”，建立結(jié)合滑移特性的移動(dòng)平臺(tái)動(dòng)力學(xué)模型。相較于上述文獻(xiàn)中的模型，本文模型更為精確地描述了打滑情況下的動(dòng)力學(xué)特性，且可將滑移率作為控制量，為防空轉(zhuǎn)高性能控制算法研究奠定基礎(chǔ)。

由于移動(dòng)平臺(tái)在滑移情況下模型呈高度非線性，參數(shù)多且復(fù)雜，在滑移情況下進(jìn)行移動(dòng)平臺(tái)軌跡跟蹤控制器設(shè)計(jì)一直是難點(diǎn)。文獻(xiàn)［13-14］利用極點(diǎn)搜索法尋找最佳滑移率作為期望滑移率，實(shí)現(xiàn)了在低附著地面上的車輛防滑控制。該方法僅采用滑移率控制解決打滑問題，未考慮軌跡跟蹤誤差，因此車體軌跡跟蹤精度不高；文獻(xiàn)［15］基于觀測(cè)器對(duì)滑移進(jìn)行實(shí)時(shí)觀測(cè)并進(jìn)行了補(bǔ)償；文獻(xiàn)［16］采用各類傳感器實(shí)現(xiàn)對(duì)路面參數(shù)的辨識(shí)并進(jìn)行了補(bǔ)償。以上方法僅從運(yùn)動(dòng)學(xué)角度將滑移距離作為外部擾動(dòng)進(jìn)行補(bǔ)償，只能實(shí)現(xiàn)滑移率較小情況下的軌跡跟蹤控制，當(dāng)滑移率大于最佳滑移率時(shí)，軌跡跟蹤效果不理想?；诖?，為解決噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)鋼砂路面軌跡跟蹤的空轉(zhuǎn)問題，本文設(shè)計(jì)了基于切換控制的防空轉(zhuǎn)高性能軌跡跟蹤控制算法。相較于上述文獻(xiàn)中的控制算法，本文算法既可以保證軌跡跟蹤的精確性，又能實(shí)現(xiàn)不同滑移程度下的防空轉(zhuǎn)控制。

基于上述分析，本文擬創(chuàng)新點(diǎn)為：①以噴砂除銹機(jī)器人移動(dòng)平臺(tái)為控制對(duì)象，建立鋼砂堆積環(huán)境下考慮滑移特性的噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)動(dòng)力學(xué)模型，克服了以往模型精確度不高的缺點(diǎn)，可以精確描述該結(jié)構(gòu)在空轉(zhuǎn)情況下的動(dòng)力學(xué)特性；②基于上述模型設(shè)計(jì)一種防空轉(zhuǎn)高性能軌跡跟蹤控制算法，克服前人研究無法進(jìn)行防滑情況下的軌跡跟蹤或僅適用于輕微滑移的缺點(diǎn)，可以實(shí)現(xiàn)在未發(fā)生空轉(zhuǎn)、發(fā)生完全空轉(zhuǎn)、發(fā)生不完全空轉(zhuǎn)三種情況下移動(dòng)平臺(tái)防滑軌跡的跟蹤控制。

2 噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)建模

2.1 結(jié)構(gòu)簡(jiǎn)述

噴砂除銹機(jī)器人實(shí)物圖如圖2 所示，由上至下分別為末端噴槍、六自由度并聯(lián)操作機(jī)構(gòu)、升降機(jī)構(gòu)、移動(dòng)平臺(tái)。為避免移動(dòng)平臺(tái)在鋼砂堆積路面上發(fā)生偏航角變化以及橫向打滑，移動(dòng)平臺(tái)設(shè)有8 個(gè)車輪，4 個(gè)為1 組，分別控制橫向和縱向運(yùn)動(dòng)。橫向運(yùn)動(dòng)由2 個(gè)電機(jī)同步但獨(dú)立驅(qū)動(dòng)，并設(shè)有電動(dòng)缸控制轉(zhuǎn)向輪，保證平臺(tái)始終與鋼箱梁保持平行。

Fig.1 Physical drawing of steel box girder圖1 鋼箱梁實(shí)物圖

Fig.2 Physical picture of sandblasting and rust removal parallel robot圖2 噴砂除銹并聯(lián)機(jī)器人實(shí)物圖

2.2 移動(dòng)平臺(tái)運(yùn)動(dòng)學(xué)模型

參考如圖3 所示的車式移動(dòng)平臺(tái)X 軸方向運(yùn)動(dòng)示意圖，l表示前輪與后輪的軸間距，b表示車輪左右軸之間的距離。使用向量q=[x y θ φ]T表示移動(dòng)平臺(tái)在世界坐標(biāo)系XOY下位姿，x,y為移動(dòng)平臺(tái)的位置坐標(biāo)，θ為移動(dòng)平臺(tái)正方向與X 軸的夾角。在不考慮移動(dòng)平臺(tái)側(cè)向滑移的情況下，可以得到如下運(yùn)動(dòng)學(xué)方程［17］：

式中，φ為前輪轉(zhuǎn)角角度，w為前輪轉(zhuǎn)角角速度，v為移動(dòng)平臺(tái)線速度，?為車輪轉(zhuǎn)速。為簡(jiǎn)化運(yùn)動(dòng)學(xué)模型，定義曲率σ：

得到簡(jiǎn)化的運(yùn)動(dòng)學(xué)模型為：

Fig.3 Motion diagram of the moving platform of the robot in the X-axis direction圖3 噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)X 軸方向運(yùn)動(dòng)示意圖

假設(shè)噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)只有前進(jìn)方向的速度而沒有側(cè)向滑移，該移動(dòng)平臺(tái)非完整約束可以表示為：

描述為矩陣的形式：

式中：

2.3 鋼砂堆積路面結(jié)合滑移特性的噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)動(dòng)力學(xué)模型

基于圖4 所示的驅(qū)動(dòng)輪受力模型，首先建立不考慮鋼砂阻力水平、垂直受力的平衡方程和轉(zhuǎn)矩平衡方程：

式中，mw為車輪質(zhì)量，v為車輪速度，F(xiàn)p為車輪產(chǎn)生的切向力，J為車輪轉(zhuǎn)動(dòng)慣量，Tm為車輪驅(qū)動(dòng)力，μ為粘著系數(shù)。

Fig.4 Bekker pressure model of driving wheel圖4 驅(qū)動(dòng)輪Bekker 承壓模型

如圖5 所示，當(dāng)滑移率處于峰值時(shí)，移動(dòng)平臺(tái)獲得牽引力最大值，當(dāng)滑移率大于最佳滑移率時(shí)，驅(qū)動(dòng)力會(huì)被嚴(yán)重削弱，最終導(dǎo)致空轉(zhuǎn)。

Fig.5 Slip characteristic curve of steel emery圖5 鋼砂滑移特性曲線

由于移動(dòng)平臺(tái)縱向運(yùn)動(dòng)最高速度為0.14m/s，此處忽略轉(zhuǎn)動(dòng)慣量，得到驅(qū)動(dòng)輪電機(jī)力矩與移動(dòng)平臺(tái)驅(qū)動(dòng)輪牽引力的關(guān)系為：

當(dāng)不發(fā)生空轉(zhuǎn)時(shí)，式（8）成立；當(dāng)發(fā)生空轉(zhuǎn)時(shí)，由滑移特性曲線得到不同滑移率下車輪牽引力的實(shí)際值?；铺匦郧€可近似表示為：

式中，C1、C2、C3為鋼砂滑移特性參數(shù)。滑移率λ大于最佳滑移率λmax時(shí)，牽引力的削弱量為：

式中，F(xiàn)p max為最佳滑移率對(duì)應(yīng)的驅(qū)動(dòng)力。

然后，根據(jù)驅(qū)動(dòng)輪Bekker 承壓模型［18］計(jì)算鋼砂路面行駛阻力，地面顆粒的法向應(yīng)力σ大小從θ0變化到最大值θm再到θ1=0，兩個(gè)區(qū)間的應(yīng)力公式［19］為：

式中，kc為鋼砂粘聚模量，k?為鋼砂摩擦模量，n 為鋼砂變形指數(shù)。式（11）的分段函數(shù)過于復(fù)雜，為了后期控制方便，對(duì)其進(jìn)行簡(jiǎn)化與近似化處理：

近似化1：當(dāng)該輪為驅(qū)動(dòng)輪時(shí)，θm在θ1中點(diǎn)附近，經(jīng)過近似化得到θm=(θ0+θ1)。

近似化2：根據(jù)鋼砂實(shí)驗(yàn)圖可將上述分段函數(shù)線性化，得到：

為進(jìn)一步簡(jiǎn)化，通過近似對(duì)稱性可以將θ0到θ1的應(yīng)力視為θ0到θm應(yīng)力的2 倍。此時(shí)，可以得到鋼砂阻力為：

本文采用拉格朗日法建立噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)動(dòng)力學(xué)模型，拉格朗日函數(shù)（L）定義為系統(tǒng)的動(dòng)能（T）與勢(shì)能（P）之差，即L=T-P。該拉格朗日方程可表示為：

式中，H(q)為非完整約束矩陣，γ為非完整約束項(xiàng)。

移動(dòng)平臺(tái)不考慮重力勢(shì)能（U=0），故拉格朗日函數(shù)L可以描述為車體動(dòng)能Lp、前輪動(dòng)能Lfw、后輪動(dòng)能Lrw之和，代入式（14）整理可得噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)標(biāo)準(zhǔn)動(dòng)力學(xué)模型為：

式中，M(q)為慣量矩陣，C(q,)為哥氏力項(xiàng)，N(q)為輸入轉(zhuǎn)換矩陣，τ為力矩輸出矩陣。mp和mw分別為移動(dòng)平臺(tái)質(zhì)量和車輪質(zhì)量，Ip和Iw分別為移動(dòng)平臺(tái)轉(zhuǎn)動(dòng)慣量和車輪轉(zhuǎn)動(dòng)慣量，τv和τσ分別為旋轉(zhuǎn)力矩和轉(zhuǎn)向力矩。

為消除非完整約束項(xiàng)γ，在式（15）的基礎(chǔ)上左乘JT，得到：

結(jié)合式（10）、式（13）和式（15），最終建立鋼砂堆積路面結(jié)合滑移特性的噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)動(dòng)力學(xué)模型：

式中，τx=Fx/r 為滑移導(dǎo)致的驅(qū)動(dòng)力矩的削弱量，r為車輪半徑。

3 防空轉(zhuǎn)高性能軌跡跟蹤控制器設(shè)計(jì)

采用車載加速度計(jì)和編碼器計(jì)算滑移率誤差λe并判斷移動(dòng)平臺(tái)是否發(fā)生空轉(zhuǎn)。移動(dòng)平臺(tái)未發(fā)生空轉(zhuǎn)(0 <λe≤K1)時(shí)，系統(tǒng)進(jìn)行跟蹤誤差的光滑滑模軌跡跟蹤控制（SSFSSC）；發(fā)生完全空轉(zhuǎn)(K2<λe≤1)時(shí)，系統(tǒng)根據(jù)鋼砂路面滑移特性確定最佳滑移率，進(jìn)行滑移率誤差控制（SC）。在發(fā)生不完全空轉(zhuǎn)(K1<λe≤K2)時(shí)，系統(tǒng)以一定的權(quán)值系數(shù)進(jìn)行SSFSSC 和SC 的復(fù)合控制。同時(shí)設(shè)計(jì)了以滑移率誤差及其導(dǎo)數(shù)為輸入，以復(fù)合控制權(quán)值系數(shù)為輸出的模糊規(guī)則，以降低移動(dòng)平臺(tái)軌跡跟蹤過程中的滑移率誤差，提高軌跡跟蹤精度，由此實(shí)現(xiàn)防空轉(zhuǎn)高性能軌跡跟蹤控制（圖6 為整體控制框圖）。

Fig.6 Schematic diagram of controller圖6 控制器原理框圖

3.1 移動(dòng)平臺(tái)不發(fā)生打滑時(shí)的SSFSSC

串聯(lián)/并聯(lián)機(jī)器人的動(dòng)力學(xué)方程一般描述為世界坐標(biāo)系位姿與關(guān)節(jié)力矩的關(guān)系。由于移動(dòng)機(jī)平臺(tái)的非完整約束，只能將其動(dòng)力學(xué)方程描述為移動(dòng)平臺(tái)速度、曲率與驅(qū)動(dòng)輪力矩的關(guān)系。因此，移動(dòng)平臺(tái)的動(dòng)力學(xué)控制一般采用雙閉環(huán)控制結(jié)構(gòu)，即速度外環(huán)控制器以世界坐標(biāo)位姿誤差為輸入，以速度和曲率為輸出；內(nèi)環(huán)動(dòng)力學(xué)控制器以速度外環(huán)控制器的輸出作為期望輸入，以驅(qū)動(dòng)輪力矩為輸出。

由參考文獻(xiàn)［20］得到外環(huán)運(yùn)動(dòng)控制器的控制率，即動(dòng)力學(xué)控制器的期望輸入Vc為：

式中，kx、ky、kθ為常數(shù)，vc≠0。

內(nèi)環(huán)動(dòng)力學(xué)控制器的控制目標(biāo)為使移動(dòng)平臺(tái)的實(shí)際速度V=[v σ]，在有限時(shí)間內(nèi)跟蹤期望速度Vc=[vc σc]。

設(shè)計(jì)滑模變量S：

式中，sv(t)、sσ(t)分別為速度和曲率的滑模變量，βv、βσ為常數(shù)。當(dāng)滑模變量sv(t)、sσ(t)收斂，速度跟蹤誤差ev=vc-v與曲率跟蹤誤差eσ=σc-σ也會(huì)隨之收斂。

對(duì)滑模變量函數(shù)對(duì)時(shí)間求導(dǎo)，得：

為求等效控制項(xiàng)，可令：

當(dāng)移動(dòng)平臺(tái)不發(fā)生打滑時(shí)，結(jié)合滑移特性的噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)動(dòng)力學(xué)模型中的牽引力削弱量τx=0，結(jié)合式（21）可得：

等效控制項(xiàng)可以保證在沒有外界隨機(jī)干擾的情況下，系統(tǒng)狀態(tài)在滑模面上。由于鋼砂除銹作業(yè)時(shí)存在噴槍射流反推力、鋼砂阻力等諸多不確定項(xiàng)，需要設(shè)計(jì)切換控制項(xiàng)τsw以提升系統(tǒng)魯棒性，取控制率τ為：

由于函數(shù)sgn(s)運(yùn)用在實(shí)際控制系統(tǒng)中會(huì)存在嚴(yán)重的抖振問題，為減小抖振，使用連續(xù)函數(shù)s(t)代替函數(shù)sgn(s)，式（24）改寫為：

選取Lyapunov 函數(shù)：

對(duì)式（26）兩邊求導(dǎo)，帶入控制率（25）得到：

式中，k>0，ST?S≥0，因此V≤0。根據(jù)Lyapunov 穩(wěn)定性定理，所設(shè)計(jì)的跟蹤誤差光滑滑模軌跡跟蹤控制算法穩(wěn)定。

由式（13）計(jì)算出的鋼砂阻力值得到鋼砂阻力前饋補(bǔ)償跟蹤誤差光滑滑模軌跡跟蹤控制率為：

3.2 移動(dòng)平臺(tái)發(fā)生完全打滑時(shí)的SC

定義驅(qū)動(dòng)輪空轉(zhuǎn)下的滑移率為：

式中，w為驅(qū)動(dòng)輪速度，由伺服電機(jī)編碼器反饋，移動(dòng)平臺(tái)縱向打滑時(shí)車體速度等于驅(qū)動(dòng)輪的移動(dòng)速度，r為車輪半徑。對(duì)滑移率微分可得：

代入驅(qū)動(dòng)輪動(dòng)力學(xué)模型，可以得到滑移率λ的微分方程為：

設(shè)計(jì)滑模面s=λd-λ，為使系統(tǒng)在有限時(shí)間內(nèi)到達(dá)切換面，選擇形式簡(jiǎn)單、易于實(shí)現(xiàn)的等速趨近律：

用1 個(gè)連續(xù)函數(shù)s(t)代替函數(shù)sgn(s(t))，得到：

最終得到鋼砂路面下各個(gè)驅(qū)動(dòng)輪空轉(zhuǎn)wr-v時(shí)的光滑滑?；坡士刂坡剩?/p>

3.3 發(fā)生不完全空轉(zhuǎn)時(shí)SSFSSC 與SC 的復(fù)合控制

當(dāng)移動(dòng)平臺(tái)發(fā)生不完全空轉(zhuǎn)時(shí)，驅(qū)動(dòng)輪的牽引力被削弱，若此時(shí)僅進(jìn)行SSFSSC，由于空轉(zhuǎn)造成的軌跡跟蹤誤差會(huì)產(chǎn)生較大控制力矩輸出。由滑移特性曲線可知，較大的力矩輸出會(huì)造成更嚴(yán)重的空轉(zhuǎn)。若此時(shí)僅進(jìn)行SC，則不會(huì)進(jìn)行軌跡跟蹤閉環(huán)控制，嚴(yán)重影響軌跡跟蹤精度。因此，本文根據(jù)文獻(xiàn)［21］的復(fù)合控制方法提出一種SSFSSC 與SC的復(fù)合控制，并設(shè)計(jì)以滑移率誤差及其導(dǎo)數(shù)為輸入，以復(fù)合控制權(quán)值系數(shù)為輸出的模糊規(guī)則。由此確定SSFSSC 和SC 的作用權(quán)重，可用式（35）來表示：

式中，Tm和Tn分別為滑移率誤差控制輸出和光滑滑模軌跡控制輸出，Tm'和Tn'為經(jīng)過權(quán)值調(diào)整后的控制輸出，a(0 ≤a≤1)為復(fù)合控制的權(quán)值系數(shù)。

權(quán)值系數(shù)a的選取規(guī)則如下：

（1）當(dāng)滑移率誤差小時(shí)，權(quán)值系數(shù)a取大，系統(tǒng)主要進(jìn)行SSFSSC，并以SC 作為力矩補(bǔ)償。

（2）當(dāng)滑移率誤差中等時(shí)，權(quán)值系數(shù)a取值中等，系統(tǒng)均等地進(jìn)行SSFSSC 與SC。

（3）當(dāng)滑移率誤差大時(shí)，權(quán)值系數(shù)a取小，系統(tǒng)主要進(jìn)行SC，并以SSFSSC 作為力矩補(bǔ)償。

按照上述規(guī)則設(shè)計(jì)模糊Fuzzy 規(guī)則，具體如表1 所示。

Table 1 Weight coefficient fuzzy rule表1 權(quán)值系數(shù)模糊規(guī)則

由此得到SSFSSC 與SC 的復(fù)合控制率為：

4 仿真試驗(yàn)與結(jié)果分析

為驗(yàn)證本文控制算法的正確性與有效性，以式（17）所示的鋼砂堆積路面結(jié)合滑移特性的噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)動(dòng)力學(xué)模型為被控對(duì)象，在施加突變縱向空轉(zhuǎn)的情況下，使用SSFSSC、SSFSSC+SC 直接切換控制與結(jié)合SS?FSSC、SC、FUZZY 的防空轉(zhuǎn)高性能軌跡跟蹤控制進(jìn)行MAT?LAB 仿真研究，并對(duì)比三者在突變空轉(zhuǎn)情況下的控制效果。其中，噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)動(dòng)力學(xué)主要參數(shù)如表2 所示。

噴砂除銹并聯(lián)機(jī)器人樣機(jī)以光柵型軌跡模擬噴砂除銹作業(yè)，需要移動(dòng)平臺(tái)在X 方向進(jìn)行直線運(yùn)動(dòng)，由此設(shè)計(jì)移動(dòng)平臺(tái)的期望軌跡為：

Table 2 Moving platform parameters表2 移動(dòng)平臺(tái)參數(shù)

由圖5 和式（10）可知，滑移率從最佳滑移率0.17 突變到0.5，造成的驅(qū)動(dòng)力矩削弱量為99.47N。在10s 時(shí)施加上述滑移率突變，以模擬移動(dòng)平臺(tái)突然發(fā)生縱向空轉(zhuǎn)的場(chǎng)景。此外，施加縱向外部隨機(jī)干擾d(t)=sin(3t)。由圖5所示的滑移特性曲線設(shè)置K1=0.18,K2=0.3。圖7 為移動(dòng)平臺(tái)X 方向的位置跟蹤曲線，圖8 為移動(dòng)平臺(tái)速度跟蹤曲線，圖9 為移動(dòng)平臺(tái)滑移率跟蹤曲線，圖10 為移動(dòng)平臺(tái)驅(qū)動(dòng)輪驅(qū)動(dòng)力矩圖。

由圖7 可知，本文提出的結(jié)合SSFSSC、SC、FUZZY 的防空轉(zhuǎn)高性能軌跡跟蹤控制以鋼砂堆積路面結(jié)合滑移特性的噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)動(dòng)力學(xué)模型為被控對(duì)象，在運(yùn)行過程中發(fā)生嚴(yán)重空轉(zhuǎn)（滑移率從0.17 突變?yōu)?.5）的情況下，其X 方向的軌跡跟蹤效果遠(yuǎn)優(yōu)于相同條件下SS?FSSC 的控制效果，略優(yōu)于SSFSSC+SC 直接切換的控制效果。

Fig.7 Position tracking curve of the X direction of the moving platform圖7 移動(dòng)平臺(tái)X 方向的位置跟蹤曲線

Fig.8 Moving platform speed tracking curve圖8 移動(dòng)平臺(tái)速度跟蹤曲線

Fig.9 Curve of slip rate tracking圖9 滑移率跟蹤曲線

Fig.10 Driving torque of the driving wheel of the moving platform圖10 移動(dòng)平臺(tái)驅(qū)動(dòng)輪的驅(qū)動(dòng)力矩

由圖8、圖9 和圖10 可知，SSFSSC 控制器在發(fā)生滑移率突變時(shí)，其力矩輸出由于滑移率誤差產(chǎn)生驅(qū)動(dòng)力而被削弱，且SSFSSC 控制器沒有滑移率控制閉環(huán)，只能增大控制力矩以達(dá)到跟蹤期望速度，但不能消除滑移率誤差。SS?FSSC+SC 直接切換控制在滑移率發(fā)生突變時(shí)切換為SC 控制，此時(shí)系統(tǒng)無法進(jìn)行軌跡跟蹤的閉環(huán)控制。SC 控制為消除滑移率誤差，產(chǎn)生較低力矩輸出，雖然可以在0.28s 內(nèi)消除滑移率誤差，但在此過程中造成了較大軌跡跟蹤誤差。而本文設(shè)計(jì)的結(jié)合SSFSSC、SC、FUZZY 的防空轉(zhuǎn)高性能軌跡跟蹤控制在發(fā)生大于K2的滑移率突變時(shí)，首先切換為SC控制，在約0.1s 內(nèi)先將滑移率下降到0.3，然后系統(tǒng)進(jìn)行約0.48s 的SSFSSC 與SC 的復(fù)合控制，在此過程中，系統(tǒng)在保證跟蹤速度的前提下消除了滑移率誤差，具有良好的軌跡跟蹤效果。

上述仿真結(jié)果表明，結(jié)合SSFSSC、SC 與FUZZY 的防空轉(zhuǎn)高性能軌跡跟蹤控制在發(fā)生嚴(yán)重空轉(zhuǎn)的情況下，不僅能快速消除滑移率誤差，而且對(duì)期望軌跡有較好的跟蹤效果，保證了移動(dòng)平臺(tái)在空轉(zhuǎn)情況下的軌跡跟蹤精度。

5 結(jié)論

本文針對(duì)噴砂除銹并聯(lián)機(jī)器人移動(dòng)平臺(tái)鋼砂路面軌跡跟蹤的空轉(zhuǎn)問題，提出一種結(jié)合SSFSSC、SC 與FUZZY 的防空轉(zhuǎn)高性能軌跡跟蹤控制算法，并通過仿真實(shí)驗(yàn)驗(yàn)證了該算法的有效性。仿真結(jié)果表明，該算法在移動(dòng)平臺(tái)發(fā)生縱向突變空轉(zhuǎn)時(shí)，可在保證軌跡跟蹤效果的基礎(chǔ)上實(shí)現(xiàn)防空轉(zhuǎn)控制。本文僅研究了移動(dòng)平臺(tái)縱向滑移情況下的防空轉(zhuǎn)軌跡跟蹤控制。然而在實(shí)際場(chǎng)景中，噴槍射流反推力以及其他外部不確定因素可能會(huì)導(dǎo)致橫向滑移。因此，在后續(xù)研究中可同時(shí)針對(duì)橫向和縱向滑移設(shè)計(jì)相應(yīng)控制算法，以提高算法的實(shí)用性和通用性。