郭麗娟，唐彬，陳梁遠(yuǎn)，張玉波

廣西電網(wǎng)有限責(zé)任公司 電力科學(xué)研究院，廣西 南寧 530023

隨著我國(guó)變電站六氟化硫（SF6）充氣設(shè)備的廣泛使用，其SF6氣體泄漏檢測(cè)與維護(hù)成為變電站運(yùn)維的一項(xiàng)重要工作。傳統(tǒng)人工檢測(cè)危險(xiǎn)性高、檢測(cè)效率低、檢測(cè)效果不穩(wěn)定[1]。本文研究提出利用先進(jìn)移動(dòng)機(jī)器人技術(shù)開(kāi)展變電站電流互感器及斷路器中SF6氣體泄漏的檢測(cè)?？紤]到變電站路面相對(duì)狹窄、有臺(tái)階障礙、硬質(zhì)水泥路面或松散砂石路面以及電力設(shè)備位置較高的環(huán)境條件約束[2]，變電站SF6泄漏檢測(cè)機(jī)器人系統(tǒng)采用履帶車(chē)搭載絕緣云梯、機(jī)械臂和檢測(cè)儀器的方案。履帶車(chē)具有越障和爬坡性能好的特點(diǎn)，但轉(zhuǎn)向過(guò)程中的滑移問(wèn)題導(dǎo)致其運(yùn)動(dòng)精度低，難以快速準(zhǔn)確地調(diào)整方位。

變電站電流互感器與斷路器檢測(cè)點(diǎn)位置較高，作業(yè)范圍狹窄。履帶車(chē)需要頻繁地低速小半徑轉(zhuǎn)向以靠近作業(yè)目標(biāo)位置，此時(shí)其轉(zhuǎn)向滑移誤差大，速度不穩(wěn)定，履帶車(chē)不能快速準(zhǔn)確地到達(dá)作業(yè)位置，降低了檢測(cè)效率。因此有必要針對(duì)履帶車(chē)低速小半徑轉(zhuǎn)向力學(xué)模型進(jìn)行分析。

基于簡(jiǎn)化模型的履帶車(chē)轉(zhuǎn)向模型未考慮履帶車(chē)的滑移和滑轉(zhuǎn)，精度不高。而考慮滑移和滑轉(zhuǎn)及地面狀況的履帶車(chē)滑移轉(zhuǎn)向地面力學(xué)模型[3-8]過(guò)于復(fù)雜，無(wú)解析解，采用數(shù)值解法則耗費(fèi)時(shí)間長(zhǎng)，不滿足控制器實(shí)時(shí)性要求。中國(guó)北方車(chē)輛研究所提出了打滑修正系數(shù)替代滑移率的方式[9]，但解出該打滑系數(shù)仍然需要求解超越方程，求解時(shí)間長(zhǎng)；基于滑移參數(shù)實(shí)時(shí)估計(jì)的方法[10-13]解決了短時(shí)間內(nèi)固定轉(zhuǎn)向速度下計(jì)算的實(shí)時(shí)性和精度的問(wèn)題，但在狹窄區(qū)域小半徑轉(zhuǎn)向工作狀態(tài)下速度不穩(wěn)定，會(huì)造成其滑移參數(shù)估計(jì)誤差偏大。陸軍裝甲兵學(xué)院和中國(guó)北方車(chē)輛研究所[14]使用模糊PID算法等抑制滑移現(xiàn)象，在高速較大半徑下軌跡精度較高，但對(duì)低速小半徑轉(zhuǎn)向下的精度還待研究。本文針對(duì)現(xiàn)場(chǎng)實(shí)驗(yàn)中履帶車(chē)實(shí)際工況，建立履帶車(chē)的低速小半徑滑移轉(zhuǎn)向運(yùn)動(dòng)學(xué)模型，利用徑向基神經(jīng)網(wǎng)絡(luò)擬合任意曲線的特性[15]，擬合履帶車(chē)滑移轉(zhuǎn)向運(yùn)動(dòng)模型，實(shí)現(xiàn)了基于RBF的履帶車(chē)正逆運(yùn)動(dòng)學(xué)建模與求解，最后將該模型應(yīng)用于變電站檢測(cè)機(jī)器人系統(tǒng)的履帶車(chē)控制并開(kāi)展了樣機(jī)實(shí)驗(yàn)。

1 履帶車(chē)低速小半徑滑移轉(zhuǎn)向建模

圖1所示為變電站環(huán)境圖。在變電站內(nèi)，電流互感器檢測(cè)點(diǎn)位置較高，作業(yè)范圍狹窄。檢測(cè)作業(yè)過(guò)程：履帶車(chē)移動(dòng)到作業(yè)電流互感器附近；裝置被舉升到作業(yè)高度；檢測(cè)機(jī)械臂帶動(dòng)檢測(cè)裝置環(huán)繞電流互感器檢測(cè)。為完成檢測(cè)作業(yè)，履帶車(chē)需在復(fù)雜，狹窄的環(huán)境內(nèi)移動(dòng)，需要頻繁地低速小半徑轉(zhuǎn)向調(diào)姿，此工況下機(jī)器人轉(zhuǎn)向滑移誤差大，速度不穩(wěn)定，機(jī)器人不能準(zhǔn)確靠近作業(yè)位置，檢測(cè)效率低。因此有必要針對(duì)履帶車(chē)低速小半徑轉(zhuǎn)向模型進(jìn)行分析。

圖1 變電站環(huán)境圖和履帶車(chē)

為了建立硬質(zhì)地面環(huán)境履帶車(chē)轉(zhuǎn)向模型，進(jìn)行如下假設(shè)：

1) 變電站內(nèi)機(jī)器人低速轉(zhuǎn)向，忽略離心力對(duì)履帶上載荷分布的影響，不計(jì)履帶張力變化對(duì)接地段壓力的影響；

2) 地面被認(rèn)為是堅(jiān)實(shí)的，忽略履帶下沉和相應(yīng)的橫向推土力；

3) 剪應(yīng)力沿履帶縱向的分量構(gòu)成牽引力，沿橫向分量構(gòu)成履帶橫向阻力。橫向阻力對(duì)車(chē)體幾何中心取矩構(gòu)成轉(zhuǎn)向阻力矩；

4）履帶車(chē)在水平面內(nèi)做勻速轉(zhuǎn)向時(shí)，轉(zhuǎn)向中履帶機(jī)器人行駛阻力系數(shù)保持不變。

1.1 滑移轉(zhuǎn)向的運(yùn)動(dòng)學(xué)建模

基于硬質(zhì)地面力學(xué)建模方法[6-8]，建立履帶式移動(dòng)機(jī)器人的地面力學(xué)模型。

履帶機(jī)器人在硬質(zhì)地面上轉(zhuǎn)向，可視為平動(dòng)剛體，建立全局坐標(biāo)系xoy為，車(chē)體形心O初始位置位于全局坐標(biāo)系的x軸上，轉(zhuǎn)動(dòng)瞬心Oxoy為全局坐標(biāo)系坐標(biāo)原點(diǎn)。履帶卷繞速度為vqi(i=1,2)。

機(jī)器人轉(zhuǎn)向時(shí)內(nèi)外兩側(cè)履帶中心線Oi′(i=1,2)處的牽引速度(i=1,2)為

圖2給出了低速履帶與滑移轉(zhuǎn)向模型。

圖2 低速履帶車(chē)滑移轉(zhuǎn)向模型

根據(jù)圖2中的運(yùn)動(dòng)學(xué)關(guān)系，可以求履帶車(chē)在滑移/滑轉(zhuǎn)下實(shí)際轉(zhuǎn)向半徑：

引入滑轉(zhuǎn)率，計(jì)算公式為

基于式（1）～（6），建立履帶機(jī)器人運(yùn)動(dòng)學(xué)方程為式（7），其中，為履帶機(jī)器人形心速度，A按式（8）求得。

將履帶車(chē)的運(yùn)動(dòng)學(xué)方程更改為關(guān)于滑移率的方程，即將式（6）帶入式（5）和式（1），可求得

1.2 履帶車(chē)滑移轉(zhuǎn)向力學(xué)模型

由于忽略離心力對(duì)履帶上載荷分布的作用，內(nèi)外履帶所受重力大小是一樣的。重力載荷在內(nèi)外履帶上呈均勻分布。履帶接地段壓力分布情況如圖3所示。直線運(yùn)動(dòng)時(shí)，內(nèi)外兩側(cè)履帶接地段是靜摩擦，相對(duì)地面速度是0；轉(zhuǎn)向時(shí)，理想情況下內(nèi)外兩側(cè)行走履帶接地段的速度瞬心Osi(i=1,2)與該段幾何中心瞬心Oi(i=1,2)重合，但實(shí)際轉(zhuǎn)向時(shí)，由于履帶的滑移/滑轉(zhuǎn)使得行走履帶接地段的速度瞬心偏離履帶接地段的幾何中心產(chǎn)生縱向和橫向偏移量di和Ai(i=1,2)。實(shí)際轉(zhuǎn)向中心為Osi。

履帶車(chē)轉(zhuǎn)向過(guò)程中受到的阻力主要是地面的摩擦阻力。對(duì)內(nèi)外兩側(cè)的履帶建立坐標(biāo)系如圖4所示，內(nèi)外兩側(cè)履帶接地段dxdy微元內(nèi)的壓力大小為

式中：L為履帶接地段長(zhǎng)度；b為履帶接地段寬度。由庫(kù)倫摩擦定律，履帶上任一微元所受的剪應(yīng)力為

圖3 履帶車(chē)接地段壓力分布情況

圖4 履帶車(chē)接地段地面摩擦阻力

對(duì)式（12）積分得到履帶在橫向和縱向方向上的所受的合力為

履帶微元dxdy上剪應(yīng)力對(duì)履帶車(chē)的形心O取矩并積分，橫向摩擦力取力矩積分得到轉(zhuǎn)向摩擦阻力矩，縱向摩擦力取矩積分得到驅(qū)動(dòng)力矩：

履帶車(chē)所受的力平衡和力矩平衡方程為

2 基于RBF網(wǎng)絡(luò)的履帶車(chē)運(yùn)動(dòng)學(xué)重建

徑向基神經(jīng)網(wǎng)絡(luò)（RBF），是一種前向神經(jīng)網(wǎng)絡(luò)，具有全局逼近的性質(zhì)，不存在局部極小值的問(wèn)題，網(wǎng)絡(luò)對(duì)于每個(gè)輸入輸出數(shù)據(jù)對(duì)，只需要調(diào)整少量的權(quán)值，使得它的逼近、分類(lèi)和學(xué)習(xí)速度大大優(yōu)于傳統(tǒng)的BP網(wǎng)絡(luò)。理論上，徑向基神經(jīng)網(wǎng)絡(luò)作為多層前向網(wǎng)絡(luò)，能以任意精度逼近任意非線性映射[15-16]。廣義回歸神經(jīng)網(wǎng)絡(luò)（GRNN）和概率神經(jīng)網(wǎng)絡(luò)（PNN）作為徑向基神經(jīng)網(wǎng)絡(luò)的變化形式，同樣可以任意精度逼近非線性映射，廣泛實(shí)用于語(yǔ)音處理、圖像識(shí)別、電力系統(tǒng)信號(hào)處理、神經(jīng)信號(hào)處理等領(lǐng)域[17-23]。但GRNN和PNN隱含層神經(jīng)元的數(shù)目等于輸入樣本數(shù)，導(dǎo)致在擬合樣本數(shù)據(jù)量較大時(shí)，其神經(jīng)元數(shù)目過(guò)多[23]，計(jì)算量較大，不利于在嵌入式系統(tǒng)中實(shí)現(xiàn)。綜上所述，基于RBF實(shí)現(xiàn)履帶車(chē)運(yùn)動(dòng)學(xué)重建。

因此，若需要采用RBF網(wǎng)絡(luò)重建履帶車(chē)的正運(yùn)動(dòng)學(xué)模型，只需要將履帶的卷繞速度集作為模型輸入樣本，履帶車(chē)質(zhì)心速度集合作為模型輸出樣本，用以訓(xùn)練模型，則得到機(jī)器人的正向運(yùn)動(dòng)學(xué)模型重建。反之，將履帶車(chē)質(zhì)心速度集作為RBF網(wǎng)絡(luò)輸入樣本，履帶車(chē)相應(yīng)的卷繞速度集作為RBF網(wǎng)絡(luò)輸出樣本進(jìn)行訓(xùn)練，則得到履帶車(chē)的逆運(yùn)動(dòng)學(xué)模型重建。通過(guò)RBF重建后的正、逆運(yùn)動(dòng)學(xué)模型進(jìn)行計(jì)算，相比于實(shí)時(shí)迭代進(jìn)行數(shù)值求解機(jī)器人正、逆運(yùn)動(dòng)學(xué)，其計(jì)算過(guò)程簡(jiǎn)單、計(jì)算量小、耗時(shí)小，在實(shí)際運(yùn)行時(shí)，可有效提高履帶車(chē)的運(yùn)動(dòng)精度。

為提高履帶車(chē)對(duì)不同地面的適應(yīng)性，可針對(duì)不同地面實(shí)測(cè)摩擦系數(shù)范圍，按式（1）～（15）建立其地面力學(xué)模型并使用RBF分別進(jìn)行重建。因RBF模型計(jì)算量小，可同時(shí)編程實(shí)現(xiàn)多個(gè)模型，根據(jù)不同地面情況進(jìn)行選擇，從而提高履帶車(chē)對(duì)不同地面狀態(tài)的適應(yīng)性。

3 RBF模型重建實(shí)驗(yàn)

3.1 實(shí)驗(yàn)設(shè)置

設(shè)定履帶車(chē)轉(zhuǎn)向時(shí)左側(cè)履帶的卷繞速度在0～0.4 m·s-1，右側(cè)履帶的卷繞速度在 0～0.4 m·s-1，保證是左轉(zhuǎn)向的運(yùn)動(dòng)狀態(tài)下，采取精度0.005 m·s-1設(shè)立采樣點(diǎn)，如此共有6 400個(gè)速度對(duì)，6 400個(gè)速度對(duì)構(gòu)成訓(xùn)練用速度集，使用MATLAB求解得到這6 400個(gè)左右履帶速度點(diǎn)對(duì)應(yīng)的力學(xué)和運(yùn)動(dòng)學(xué)參數(shù)，得到用于訓(xùn)練的參數(shù)集合。與用于訓(xùn)練RBF網(wǎng)絡(luò)。

3.2 仿真結(jié)果

RBF模型重建結(jié)果如圖5所示。重建后的神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)簡(jiǎn)單，正逆運(yùn)動(dòng)學(xué)模型都只有兩層，且每層不超過(guò)3個(gè)神經(jīng)元，實(shí)現(xiàn)簡(jiǎn)單、計(jì)算量小。采用GRNN和PNN網(wǎng)絡(luò)也可獲得相近的精度，但所需的神經(jīng)元數(shù)目為速度曲面上所取速度對(duì)的數(shù)目，共6 400個(gè)。神經(jīng)元數(shù)目過(guò)大，計(jì)算量過(guò)多，不利于嵌入式控制器實(shí)現(xiàn)實(shí)時(shí)計(jì)算。

圖5 RBF正運(yùn)動(dòng)學(xué)模型的神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)

針對(duì)RBF重建的正向運(yùn)動(dòng)學(xué)模型進(jìn)行測(cè)試，實(shí)驗(yàn)結(jié)果如圖6和圖7所示。圖6中相同輸入條件下，簡(jiǎn)化模型求解得到的正向運(yùn)動(dòng)學(xué)解與理論輸出的誤差的絕對(duì)值在3.2 mm·s-1以?xún)?nèi)，是重建的RBF正向運(yùn)動(dòng)學(xué)模型誤差的2倍。且RBF正向運(yùn)動(dòng)學(xué)模型的解的誤差較為平均，隨著履帶速度差增大，誤差相比簡(jiǎn)化模型更小。圖7顯示，RBF重建正向運(yùn)動(dòng)學(xué)模型的解精度更高。

圖6 RBF模型與簡(jiǎn)化模型對(duì)輸出誤差

圖7 RBF正運(yùn)動(dòng)學(xué)模型與簡(jiǎn)化模型對(duì)輸出誤差

RBF重建的逆運(yùn)動(dòng)學(xué)模型網(wǎng)絡(luò)仿真結(jié)果如圖8、9所示。對(duì)測(cè)試集，RBF的左右履帶轉(zhuǎn)向輸出誤差也在±1 mm·s-1以?xún)?nèi)，而簡(jiǎn)化模型外側(cè)履帶（卷繞速度更大的履帶）的速度誤差則隨著履帶速度差的增大而增大，且遠(yuǎn)大于RBF模型的輸出誤差。與簡(jiǎn)化模型對(duì)比可確定，使用RBF重建機(jī)器人運(yùn)動(dòng)學(xué)模型，相比直接使用不考慮滑移的簡(jiǎn)化模型，能獲得更高的精度。

在實(shí)驗(yàn)過(guò)程中，通過(guò)MATLAB建立履帶車(chē)滑移轉(zhuǎn)向運(yùn)動(dòng)學(xué)和動(dòng)力學(xué)模型，對(duì)于模型參數(shù)的求解的計(jì)算時(shí)間較大。為了獲得6 400個(gè)測(cè)試集內(nèi)的正運(yùn)動(dòng)學(xué)解，簡(jiǎn)化傳統(tǒng)的MATLAB運(yùn)動(dòng)學(xué)模型之后，求解時(shí)間為13.882 h，但RBF模型訓(xùn)練完成之后對(duì)6 400個(gè)速度點(diǎn)的計(jì)算為0.183 8 s，求解時(shí)間極大縮短。同時(shí)因?yàn)榛屏繜o(wú)法確定，滑移轉(zhuǎn)向模型無(wú)法通過(guò)求微分和矩陣運(yùn)算的方式，將式(1)～(15)的方程轉(zhuǎn)變?yōu)槟孢\(yùn)動(dòng)學(xué)形式，則無(wú)法通過(guò)所需的履帶車(chē)質(zhì)心速度和轉(zhuǎn)化為所需要的履帶卷繞速度和。而通過(guò)RBF重建的運(yùn)動(dòng)學(xué)模型可以方便地求解，且相比簡(jiǎn)化模型具有更高精度。

圖8 RBF逆運(yùn)動(dòng)學(xué)模型與簡(jiǎn)化模型對(duì)輸出誤差

圖9 RBF逆運(yùn)動(dòng)學(xué)模型與簡(jiǎn)化模型對(duì)輸出誤差

基于此，采用RBF獲得履帶車(chē)的RBF正逆運(yùn)動(dòng)學(xué)模型，具有計(jì)算耗時(shí)小、模型精度高的特點(diǎn)，且RBF網(wǎng)絡(luò)模型神經(jīng)元數(shù)量小、模型計(jì)算所耗費(fèi)的控制器資源小。

3.3 樣機(jī)實(shí)驗(yàn)

圖10所示為變電站SF6泄漏檢測(cè)機(jī)器人系統(tǒng)現(xiàn)場(chǎng)實(shí)驗(yàn)照片。實(shí)驗(yàn)任務(wù)目標(biāo)是檢測(cè)電流互感器中六氟化硫氣體的泄漏狀況。為精準(zhǔn)檢測(cè)泄漏量，履帶車(chē)需進(jìn)入狹窄的工作區(qū)域并快速地調(diào)整方位，到達(dá)指定的目標(biāo)位置處，在此過(guò)程中，履帶車(chē)處于低速小半徑轉(zhuǎn)向運(yùn)動(dòng)狀態(tài)。

圖10 樣機(jī)實(shí)驗(yàn)

分別將前文基于RBF重建的運(yùn)動(dòng)學(xué)模型以及簡(jiǎn)化模型應(yīng)用于現(xiàn)場(chǎng)實(shí)驗(yàn)中履帶車(chē)的運(yùn)動(dòng)控制，實(shí)驗(yàn)結(jié)果表明，基于RBF重建的運(yùn)動(dòng)學(xué)模型具有求解速度快、精度高的特點(diǎn)，使得履帶車(chē)能夠快速調(diào)整方位，高效、準(zhǔn)確地運(yùn)動(dòng)到目標(biāo)位置，有效地提高了機(jī)器人系統(tǒng)的檢測(cè)效率。

4 結(jié)論

面向變電站復(fù)雜環(huán)境約束及SF6氣體泄漏檢測(cè)實(shí)際任務(wù)需求，本文針對(duì)履帶車(chē)轉(zhuǎn)向過(guò)程中的滑移問(wèn)題開(kāi)展研究。建立基于 RBF 重建的運(yùn)動(dòng)學(xué)模型并與簡(jiǎn)化模型進(jìn)行比較分析，仿真和樣機(jī)實(shí)驗(yàn)結(jié)果表明:

1)基于RBF的履帶車(chē)滑移轉(zhuǎn)向運(yùn)動(dòng)學(xué)重建方法具有計(jì)算耗時(shí)小、精度高的特點(diǎn)。

2)RBF 網(wǎng)絡(luò)模型神經(jīng)元數(shù)量小，模型計(jì)算所耗費(fèi)的控制器資源少。

3）該方法應(yīng)用于變電站 SF6 氣體泄漏檢測(cè)機(jī)器人系統(tǒng)的運(yùn)動(dòng)控制，有效提高了履帶車(chē)在低速小半徑轉(zhuǎn)向工況下的運(yùn)動(dòng)精度，使其能夠快速調(diào)整方位，高效、準(zhǔn)確地運(yùn)動(dòng)到目標(biāo)位置，進(jìn)而提高了檢測(cè)作業(yè)效率。