基于激光傳感器的變電站巡檢機(jī)器人導(dǎo)航*

馮 坤, 馬 磊, 孫永奎

(西南交通大學(xué) 電氣工程學(xué)院，四川 成都 610031)

0 引 言

變電站巡檢是保證變電站設(shè)備正常、可靠運(yùn)行的一項(xiàng)日常工作[1,2]。傳統(tǒng)的人工巡檢勞動(dòng)強(qiáng)度大，效率低，惡劣天氣下存在安全隱患[3]。文獻(xiàn)[4]介紹了一種基于Clearpath Robotics Husky A200移動(dòng)平臺(tái)的變電站巡檢機(jī)器人，攜帶可見(jiàn)光攝像機(jī)和熱成像儀進(jìn)行巡檢任務(wù)，同時(shí)具有遙控裝置，可以進(jìn)行遙控操作。文獻(xiàn)[5]介紹了多種變電站巡檢機(jī)器人，可以利用視覺(jué)和射頻識(shí)別(radio frequency identification,RFID)技術(shù)實(shí)現(xiàn)機(jī)器人定位，對(duì)變電站設(shè)備、發(fā)電廠和供熱廠等進(jìn)行巡檢。

目前國(guó)內(nèi)的巡檢機(jī)器人導(dǎo)航根據(jù)使用的傳感器有磁導(dǎo)航方式[4，5]、差分全球定位系統(tǒng)(global positioning system,GPS)方式[6,7]、視覺(jué)導(dǎo)航[8,10]、激光導(dǎo)航等[9,11]。磁導(dǎo)航方式需要預(yù)先埋設(shè)磁軌以及RFID，部署以及維護(hù)成本高?；诓罘諫PS的導(dǎo)航穩(wěn)定性差，會(huì)受到變電站環(huán)境的干擾。視覺(jué)導(dǎo)航方式對(duì)于光線的依賴強(qiáng)，不適合用作室外的導(dǎo)航。而激光傳感器因?yàn)榉€(wěn)定性強(qiáng)，探測(cè)范圍遠(yuǎn)，越來(lái)越多地用于變電站巡檢機(jī)器人。

本文介紹了整個(gè)變電站巡檢機(jī)器人的硬件組成及結(jié)構(gòu)，實(shí)現(xiàn)了基于激光雷達(dá)數(shù)據(jù)與里程計(jì)的建圖、定位，在此基礎(chǔ)上設(shè)計(jì)了基于巡檢點(diǎn)、任務(wù)點(diǎn)的最優(yōu)路徑規(guī)劃，以及點(diǎn)對(duì)點(diǎn)的導(dǎo)航算法，最后在室內(nèi)以及室外進(jìn)行了精度測(cè)試。

1 系統(tǒng)構(gòu)成

1.1 系統(tǒng)結(jié)構(gòu)設(shè)計(jì)

如圖1所示，巡檢系統(tǒng)大致由巡檢機(jī)器人、部署終端、局域網(wǎng)絡(luò)、監(jiān)控后臺(tái)組成。巡檢機(jī)器人攜帶巡檢設(shè)備，在變電站執(zhí)行巡檢任務(wù)。部署終端用于配合巡檢機(jī)器人在變電站進(jìn)行建圖、部署巡檢點(diǎn)等任務(wù)。監(jiān)控后臺(tái)用于記錄巡檢數(shù)據(jù)，監(jiān)控巡檢機(jī)器人的執(zhí)行情況等。

圖1 巡檢系統(tǒng)結(jié)構(gòu)

1.2 巡檢機(jī)器人硬件設(shè)計(jì)

巡檢機(jī)器人的硬件框圖如圖2所示，熱成像傳感器、可見(jiàn)光傳感器以及工控機(jī)通過(guò)交換機(jī)和監(jiān)控后臺(tái)通信。激光雷達(dá)直接和工控機(jī)連接。數(shù)據(jù)處理板融合慣性測(cè)量單元(inertial measurement unit,IMU)和編碼器數(shù)據(jù)計(jì)算里程，并且具體和充電房、驅(qū)動(dòng)板通信。

圖2 巡檢機(jī)器人硬件

1.3 巡檢機(jī)器人軟件設(shè)計(jì)

如圖3所示，是巡檢機(jī)器人的工控機(jī)中的軟件框圖，軟件基于ROS的開(kāi)源操作系統(tǒng)分模塊設(shè)計(jì)，總體上分為3個(gè)部分：驅(qū)動(dòng)層、運(yùn)動(dòng)控制層、功能層。驅(qū)動(dòng)層包括激光雷達(dá)和數(shù)據(jù)處理板的驅(qū)動(dòng)，用來(lái)獲取激光傳感器以及聲吶、里程計(jì)、機(jī)器人運(yùn)行情況等數(shù)據(jù)，并發(fā)布速度、角速度以及配置指令。

圖3 巡檢機(jī)器人軟件框圖

運(yùn)動(dòng)控制層包括建圖、定位、路徑規(guī)劃、導(dǎo)航4個(gè)模塊。建圖模塊使用Gmmaping算法生成環(huán)境地圖。Gmmaping基于粒子濾波算法，使用原始里程計(jì)的數(shù)據(jù)以及激光雷達(dá)的數(shù)據(jù)建立地圖。應(yīng)用自適應(yīng)蒙特卡洛定位(adaptive Monte Carlo localization,AMCL)。路徑規(guī)劃模塊根據(jù)預(yù)先部署好的一些路徑關(guān)鍵點(diǎn)進(jìn)行路徑搜索，尋找最優(yōu)路徑。導(dǎo)航模塊是最后的執(zhí)行單元，引導(dǎo)機(jī)器人完成相鄰2個(gè)點(diǎn)之間的行駛。功能層包括部署、任務(wù)調(diào)度、手動(dòng)操作3個(gè)模塊，用來(lái)配合運(yùn)動(dòng)控制層運(yùn)作，并提供外部接口和監(jiān)控后臺(tái)交互。

2 路徑規(guī)劃

在變電站進(jìn)行巡檢的路徑規(guī)劃方案是根據(jù)一張掃描好的地圖提前規(guī)劃好可行的路徑點(diǎn)、任務(wù)點(diǎn)以及將這些點(diǎn)連接起來(lái)的可行的邊，這樣就能將可行的路徑組成一個(gè)帶邊權(quán)重的無(wú)向圖。然后在此基礎(chǔ)上采取圖搜索的方法進(jìn)行2點(diǎn)間的最短路徑搜索。如圖4所示。

圖4 變電站行駛路徑示意

巡檢路徑規(guī)劃是要求取過(guò)一些指定巡檢點(diǎn)的最優(yōu)路徑，當(dāng)要求回到起始點(diǎn)時(shí)是一個(gè)旅行商問(wèn)題(travelling salesman problem,TSP)問(wèn)題，采用LKH(Lin-Kernighan heuristic)算法解決，當(dāng)不要求回到起始點(diǎn)時(shí)采用動(dòng)態(tài)規(guī)劃算法求解。

3 導(dǎo)航設(shè)計(jì)

導(dǎo)航的任務(wù)就是將車(chē)從當(dāng)前位姿(xi,yi,θ1)移動(dòng)到目標(biāo)位姿(x2,y2,θ2)，如圖5所示。

圖5 直線導(dǎo)航軌跡示意

1)朝向調(diào)整

如圖6所示，首先控制車(chē)自轉(zhuǎn)，調(diào)整車(chē)位，使得車(chē)頭朝向目標(biāo)位置，其中

(1)

根據(jù)誤差θe=α1-θ1的正負(fù)，選擇恒定的角速度ω來(lái)自轉(zhuǎn)，到指定的角度精度時(shí)停止。

圖6 初始調(diào)整車(chē)的位姿

2)直行

直行時(shí)，考慮距離誤差以及角度誤差

(2)

式中α2的定義同α1。

圖7 直行任務(wù)示意

使用比例-積分-微分(proportional integral differential,PID)控制器來(lái)調(diào)節(jié)角度，對(duì)于線速度是預(yù)先給一個(gè)線速度vref基準(zhǔn)，在此基礎(chǔ)上進(jìn)行調(diào)節(jié)

(3)

3)最后調(diào)整

調(diào)整位姿方式與第一步的朝向調(diào)整相同，如圖8所示。

圖8 最后調(diào)整車(chē)位姿

4)避障

如圖9所示為避障的示意。設(shè)立減速區(qū)域S1以及停止區(qū)域S2。根據(jù)激光雷達(dá)的數(shù)據(jù)判斷障礙物是否處于S1或者S2區(qū)域，當(dāng)障礙物處于S1區(qū)域時(shí)，讓車(chē)線速度以一定比例衰減，當(dāng)處于S2區(qū)域時(shí)，讓車(chē)線速度為0，待在原地。

圖9 避障示意

4 實(shí) 驗(yàn)

分別在室內(nèi)以及室外的條件下進(jìn)行定點(diǎn)導(dǎo)航實(shí)驗(yàn)，通過(guò)在地面進(jìn)行標(biāo)定來(lái)測(cè)量4個(gè)輪子的位置，然后求得車(chē)的中心點(diǎn)坐標(biāo)以及車(chē)身的偏角θ。其中,兩次標(biāo)定中y軸平行于行駛方向。

4.1 室內(nèi)測(cè)量實(shí)驗(yàn)

如圖10為8次試驗(yàn)中分別根據(jù)4個(gè)輪子的位置求得的車(chē)中心的x,y坐標(biāo)值以及偏角θ。根據(jù)測(cè)試樣本分別求得極差以及偏離平均值的最大誤差、平均絕對(duì)誤差。

圖10 室內(nèi)測(cè)量的位置以及角度數(shù)據(jù)

從表1可以看出，移動(dòng)機(jī)器人在室內(nèi)測(cè)量具有特別好的效果?？紤]到測(cè)量的誤差，從測(cè)量樣本來(lái)看在室內(nèi)環(huán)境下最大位置誤差小于2 cm，角度最大誤差小于2°。

表1 室內(nèi)測(cè)量誤差數(shù)據(jù)

4.2 室外測(cè)量實(shí)驗(yàn)

如圖11為室外環(huán)境下測(cè)得的數(shù)據(jù)。同樣根據(jù)測(cè)試樣本分別求得極差以及偏離平均值的最大誤差、平均絕對(duì)誤差。

圖11 室外測(cè)量的位置以及角度數(shù)據(jù)

從表2可以看到，測(cè)試條件下室外導(dǎo)航精度要小于室內(nèi)。其中x方向誤差略大于室內(nèi)情況下，角度誤差與室內(nèi)情況下接近。y方向的最大誤差比室內(nèi)大許多，然而平均絕對(duì)誤差1.53 cm，在可接受的范圍內(nèi)。

表2 室外測(cè)量誤差數(shù)據(jù)

室外導(dǎo)航精度要小于室內(nèi)的原因可能來(lái)自于室外的地面不平導(dǎo)致的建圖，定位質(zhì)量下降。而且室外地面的摩擦力大會(huì)導(dǎo)致車(chē)在轉(zhuǎn)動(dòng)的時(shí)候4個(gè)輪子的速度不一致而引起車(chē)心偏移。在測(cè)試時(shí)環(huán)境的變動(dòng)也會(huì)引起誤差。另外，此次室外的實(shí)驗(yàn)場(chǎng)地是在兩棟建筑中間的走廊形狀場(chǎng)地，沿著y方向兩邊是墻，接近于一條直線，特征點(diǎn)比較單一很可能給y方向的定位帶來(lái)了一些誤差。

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

本文研究了基于激光雷達(dá)的變電站巡檢機(jī)器人設(shè)計(jì)，重點(diǎn)介紹了路徑規(guī)劃以及導(dǎo)航的實(shí)現(xiàn)，并且在室內(nèi)以及室外進(jìn)行了測(cè)試以及誤差分析。測(cè)試結(jié)果表明:機(jī)器人能在室內(nèi)外有效工作。對(duì)于室外的情況，接下來(lái)會(huì)做進(jìn)一步調(diào)試和改進(jìn)。