巡檢機器人傳感器容錯控制技術(shù)的研究

王吉岱　徐希清

（山東科技大學(xué) 機械電子工程學(xué)院，青島 266590）

巡檢機器人傳感器容錯控制技術(shù)的研究

王吉岱徐希清

（山東科技大學(xué) 機械電子工程學(xué)院，青島 266590）

本文在介紹巡檢機器人分布式控制系統(tǒng)的基礎(chǔ)上，分析了傳感器的硬件配置和常見故障形式，提出了N模冗余容錯（硬件容錯）和時間冗余容錯（軟件容錯）相結(jié)合的容錯控制策略。實驗結(jié)果表明，基于該容錯控制策略的巡檢機器人控制系統(tǒng)具有較好的魯棒性，有效的保證了巡檢機器人成功完成各種越障動作。

巡檢機器人傳感器故障容錯控制分布式控制系統(tǒng)

引言

隨著經(jīng)濟的發(fā)展，電網(wǎng)容量日益增大，高壓、超高壓線路不斷延長，規(guī)模越來越大，對電網(wǎng)的巡檢維護變得更為重要。用巡線機器人對電網(wǎng)進行巡檢，為電網(wǎng)巡檢提供了一種新的自動巡檢方法，近年來已成為特種機器人領(lǐng)域的一個研究熱點。相對工業(yè)機器人而言，巡檢機器人還相對年輕，并且巡檢機器人既要在惡劣、復(fù)雜環(huán)境下工作，又要考慮長途巡視的高安全可靠性、電源補給和遠程通信等，因而，開展巡線機器人的研究與應(yīng)用無疑是一個極大的挑戰(zhàn)［1-3］。

通過對巡檢機器人的實際作業(yè)環(huán)境進行分析，結(jié)合對機器人控制系統(tǒng)的高安全可靠性要求，提出了硬件容錯和軟件容錯相結(jié)合的容錯控制方法以及故障處理策略。

1　巡檢機器人控制系統(tǒng)組成

巡檢機器人分布式控制系統(tǒng)結(jié)構(gòu)如圖1所示。機器人控制系統(tǒng)采用分級遞階的體系結(jié)構(gòu)，由管理級、控制級和現(xiàn)場級組成［4-6］。管理級主要由PC客戶端構(gòu)成，用于監(jiān)視、操作和管理全系統(tǒng)的信息；控制級主要由32位微處理器ARM1、ARM2和DVR構(gòu)成，實現(xiàn)傳感器數(shù)據(jù)信息采集與處理、電源管理、復(fù)位控制、驅(qū)動控制和圖像信息采集等功能，并按照通訊協(xié)議與管理級之間進行數(shù)據(jù)傳輸；現(xiàn)場級主要由各種傳感器、繼電器、電機、可見光云臺和紅外成像儀等構(gòu)成，用于完成各種機器人動作和采集各種數(shù)據(jù)信息。

圖1　巡檢機器人控制系統(tǒng)結(jié)構(gòu)框圖

圖2所示為巡檢機器人控制系統(tǒng)的運動控制流程圖。機器人規(guī)劃系統(tǒng)產(chǎn)生下個時間片機器人的位姿狀態(tài)，控制器通過將規(guī)劃系統(tǒng)得到的信息結(jié)果和采集到的傳感器信息進行比較，經(jīng)過算法計算出機器人行走速度、各個關(guān)節(jié)電機動作狀態(tài)，最后傳感器系統(tǒng)將機器人下個時間片的狀態(tài)信息采集傳送給控制器，由此構(gòu)成一個完整的閉環(huán)控制系統(tǒng)。

圖2　巡檢機器人運動控制流程圖

傳感器用于將機器人的當(dāng)前運行狀態(tài)信息傳送給機器人控制系統(tǒng)，如果傳感器在系統(tǒng)運行過程中出現(xiàn)故障，就可能導(dǎo)致整個系統(tǒng)癱瘓。為了解決由傳感器故障而造成的控制系統(tǒng)紊亂，保證巡檢機器人能夠順利完成作業(yè)任務(wù)，必然需要對傳感器信號進行有效的容錯控制處理［7］。

2　容錯控制技術(shù)與方法

2.1傳感器硬件配置及故障形式

巡檢機器人的傳感器硬件配置見表1。其中，光電傳感器（E3Z-D61、E3Z-D62）主要用于高壓輸電線路上障礙物（間隔棒、防震錘、懸置線夾等）的檢測；限位開關(guān)用于對機器人各個關(guān)節(jié)部位電機行程檢測；GPS用于機器人定位校準；激光測距儀用于檢測機器人下方障礙物與機器人之間距離。本文對巡檢機器人傳感器容錯控制技術(shù)的研究主要是針對影響機器人位姿狀態(tài)的傳感器，即對光電傳感器、限位開關(guān)和激光測距儀的容錯控制。

表1　巡檢機器人傳感器配置

巡檢機器人上述傳感器在實驗過程中通常出現(xiàn)3種故障形式，即：（1）機器人在行駛過程中遇到障礙時，傳感器輸出信息保持不變；（2）機器人在行駛過程中沒遇到障礙時，傳感器輸出信息在該時間段內(nèi)跳變；（3）機器人正常行駛過程中，傳感器輸出信息在一定范圍內(nèi)波動［8］。通常情況，E3Z-D61、E3Z-D62、限位開關(guān)可能出現(xiàn)第一、二種故障，激光測距儀三種故障均可能出現(xiàn)。對于激光測距儀出現(xiàn)第三種故障的情況，采取線性平滑的方法來處理。對于傳感器出現(xiàn)的第一、二種故障形式，均可以通過硬件容錯處理和軟件容錯處理進行有效改善，所以，提出了N模冗余容錯和時間冗余容錯相結(jié)合的傳感器故障處理措施。

2.2巡檢機器人傳感器容錯控制策略

圖3所示為巡檢機器人傳感器容錯控制系統(tǒng)流程圖。首先對外界環(huán)境信號采集應(yīng)用傳感器N模冗余容錯處理，得到一個正確的傳感器信號送給控制器，但是這種并行方式的容錯能力僅僅是物理隔離故障、對故障切換進行改進。為了更好的解決傳感器第一、二種故障形式，對N模冗余后得到的傳感器信號再進行時間冗余容錯處理［9］，消除傳感器的短暫性錯誤。通過應(yīng)用N模冗余容錯與時間冗余容錯相結(jié)合的方法，可以得到精準的機器人位姿狀態(tài)信息。

圖3　傳感器容錯控制系統(tǒng)流程圖

2.3N模冗余容錯技術(shù)

N模冗余容錯是一種傳統(tǒng)的容錯技術(shù)，采用N模冗余的方法，輸入信號由完全相同的N個模塊分別獨立處理，每個模塊生成一個運行結(jié)果交給決策器，由決策器進行判斷并輸出結(jié)果［10］。

為了解決傳感器第一、二種故障形式，本巡檢機器人采用傳感器N模冗余容錯技術(shù)如圖4所示，Xn為第n （n=0，1，2…）個傳感器模塊處理的結(jié)果，將n個處理結(jié)果同時交給決策器（本設(shè)計采用與門電路），Y為最后輸出結(jié)果。

圖4　傳感器N模冗余容錯

如上圖中，N模冗余容錯結(jié)構(gòu)可以看成一種并行結(jié)構(gòu)，與門電路信號處理表達式為：

其中Xn為傳感器輸出信號，Y為經(jīng)過與門電路處理之后輸出結(jié)果。圖5為與門電路原理圖與傳感器信號處理電路板實物圖。

圖5　與門電路與電路板

2.4時間冗余容錯技術(shù)

時間冗余容錯是以消耗時間資源為代價來達到故障容錯的目的，具體方式有指令重復(fù)執(zhí)行、程序卷回、降低設(shè)備運行速度等。為了更好的解決第一、二種故障形式，本設(shè)計采用了指令重復(fù)執(zhí)行方式來實現(xiàn)時間冗余容錯控制，指令重復(fù)執(zhí)行流程圖如圖6所示。

圖6　指令重復(fù)執(zhí)行流程圖

指令重復(fù)執(zhí)行時間冗余容錯技術(shù)，是在程序運行過程中，在程序適當(dāng)位置設(shè)置檢查點，在每一個檢查點處保存程序在該檢查點之前正確運行而得到的全部信息及標志。如果故障是暫時性的，則程序卷回到上一檢查點開始重新執(zhí)行，這樣可以完全消除暫時性錯誤。需要注意的是要合理設(shè)置檢查點數(shù)量，設(shè)置過多會增加程序處理時間，設(shè)置過少又會使程序卷回時間過長。

控制器時間冗余處理部分代碼如下所示：

3　實驗結(jié)果

搭建實驗平臺，對巡檢機器人進行實驗驗證，選用20m標準220kV單分裂實驗線路，線路上依次設(shè)有間隔棒、防震錘和懸垂線夾。實驗情況1：對巡檢機器人傳感器系統(tǒng)不進行容錯處理；實驗情況2：對巡檢機器人傳感器系統(tǒng)進行容錯處理。對以上2種實驗情況下的巡檢機器人進行自主越障實驗，機器人跨越防震錘實驗過程如圖7所示。

圖7　機器人越障實驗

對2種實驗情況各進行5組實驗測試，每組進行20次單向自主越障，對越障成功次數(shù)進行統(tǒng)計，結(jié)果見表2。

表2　越障成功次數(shù)

將上表中數(shù)據(jù)統(tǒng)計結(jié)果在同一坐標系下繪制成曲線如圖8所示。

圖8　越障成功次數(shù)曲線

對實驗測試數(shù)據(jù)進一步處理得到2種實驗情況下各組實驗成功率，結(jié)果見表3。

表3　越障成功率

圖8和表3表明，對于進行傳感器容錯處理的巡檢機器人控制系統(tǒng)明顯穩(wěn)定性更高、魯棒性更好。本設(shè)計采用的N模冗余容錯（硬件容錯）和時間冗余容錯（軟件容錯）相結(jié)合的容錯控制策略可以很好的解決傳感器通常出現(xiàn)的第一、二種故障形式。

4　結(jié)論

對于巡檢機器人傳感器常見的第一、二種故障，一般都是無法修復(fù)的硬件故障，采用本設(shè)計的傳感器容錯控制策略，可以最大程度的減小由這兩種故障形式造成的控制系統(tǒng)紊亂，大大提高了巡檢機器人順利完成作業(yè)任務(wù)的成功率，有效的提高了巡檢機器人控制系統(tǒng)可靠性，保證了巡檢機器人成功完成各種越障動作。

［1］吳功平，李誠，馬玉林，等.高壓電網(wǎng)巡檢機器人研究及應(yīng)用綜述［C］.中國電力企業(yè)聯(lián)合會科技開發(fā)服務(wù)中心：，2009：7.

［2］楊旭東，黃玉柱，李繼剛，等.變電站巡檢機器人研究現(xiàn)狀綜述［J］.山東電力技術(shù)，2015（01）：30-34.

［3］左岐，謝植，梁自澤，等.巡線機器人的發(fā)展與應(yīng)用［J］.機器人技術(shù)與應(yīng)用，2007（02）：37-42.

［4］毛吉貴，白玉成，肖清明，等.基于雙總線構(gòu)架的巡線機器人分布式控制系統(tǒng)［J］.武漢大學(xué)學(xué)報（工學(xué)版），2012（03）：379-384.

［5］邱寄帆，王海春.基于分布式控制系統(tǒng)的輪式智能機器人研究［J］.微計算機信息，2006（11）180-182+13.

［6］蔡自興，鄒小兵，王璐，等.移動機器人分布式控制系統(tǒng)的設(shè)計［J］.中南大學(xué)學(xué)報（自然科學(xué)版），2005（05）：13-18.

［7］方少吉，王麗榮，朱計華，等.水下機器人傳感器容錯控制技術(shù)的研究［J］.機器人，2007（02）：155-159+166.

［8］段琢華，蔡自興，于金霞.未知環(huán)境中移動機器人故障診斷與容錯控制技術(shù)綜述［J］.機器人，2005（04）：373-379.

［9］韓服善，趙中敏.基于容錯技術(shù)的過程控制系統(tǒng)的可靠性研究［J］.起重運輸機械，2009（01）：3-7.

［10］陸陽，王強，張本宏，等.計算機系統(tǒng)容錯技術(shù)研究［J］.計算機工程，2010（13）：230-235.

Sensor Fault-Tolerant Control of Autonomous Inspection Robot for Power Line

WANG Jidai，XU Xiqing
（College of Mechanical and Electronic Engineering，Shandong University of Science and Technology，Qingdao 266590，China）

In order to improve the reliability of the autonomous inspection robot control system，and ensure the autonomous inspection robot to complete the task in the complex environment of overhead transmission line，the autonomous inspection robot is required fault-tolerant control.Based on the introduction of robot distributed control system，this paper analyzes the sensor configuration and failure mode，and puts forward the fault-tolerant control strategy that N Modular Redundancy（NMR）fault-tolerant（hardware fault tolerance）combined with time redundancy（software fault tolerance）.The experimental results showed that the control system based on this fault-tolerant control strategy has good robustness，and guaranteeing that the successful completion of the inspection robot obstacle climbing motion.

autonomous inspection robot，sensor fault，fault-tolerant control，distributed control system