国产欧美日韩精品a在线观看-国产欧美日韩精品一区二区三区-国产欧美日韩精品综合-国产欧美中文字幕-一区二区三区精品国产-一区二区三区精品国产欧美

★ 國網(wǎng)北京市電力公司電纜分公司 冀然，吳建旺

★ 北京卓越電力建設(shè)有限公司 張東，高祥，王辰松，張亮

近年來隨著高壓電纜體量的快速增長(zhǎng)，完成必需的巡檢工作所需的人力也大幅增加，因此巡檢工作的智能化替代是必不可少的。與固定式在線監(jiān)測(cè)設(shè)備負(fù)責(zé)重要節(jié)點(diǎn)全天候?qū)崟r(shí)監(jiān)測(cè)相互補(bǔ)，巡檢機(jī)器人可以滿足電纜全長(zhǎng)溫度監(jiān)測(cè)、隧道環(huán)境監(jiān)測(cè)等移動(dòng)監(jiān)測(cè)工作。目前主流的隧道巡檢機(jī)器人可分為軌道式和無軌道式。常見的軌道式巡檢機(jī)器人其運(yùn)行軌道固定在隧道的頂板上，因此機(jī)器人在軌道長(zhǎng)度內(nèi)可以自由活動(dòng)。同時(shí)由于其懸掛在吊軌上，其自身重量、電池容量均無太大限制所以可搭載的監(jiān)測(cè)設(shè)備也更加全面。但是因?yàn)榻ㄔO(shè)軌道式巡檢機(jī)器人其投資巨大，因此要想建設(shè)覆蓋全部高壓電纜隧道的軌道式機(jī)器人其花費(fèi)難以估量。也正因如此軌道式巡檢機(jī)器人尚未大面積普及。目前主流的無軌道巡檢機(jī)器人分為無人機(jī)和地面巡視兩類，本文主要討論地面巡視類機(jī)器人的路徑規(guī)劃思路。地面巡檢機(jī)器人在電纜隧道中運(yùn)行時(shí)由于隧道內(nèi)空間較為狹窄，因此在自主前進(jìn)時(shí)對(duì)行進(jìn)路線有較為嚴(yán)格的要求。以某市高壓電纜隧道為例，其剖面圖如圖1所示。

圖1 高壓電纜隧道截面圖

如圖中所示其可供地面巡視機(jī)器人通行的寬度約為50厘米，目前大部分地面巡視機(jī)器人機(jī)體寬度約為40~50厘米，因此對(duì)機(jī)器人路徑規(guī)劃的要求極為嚴(yán)苛，稍有偏差即有可能導(dǎo)致機(jī)器人無法繼續(xù)前進(jìn)。目前巡檢機(jī)器人普遍采用標(biāo)示線法進(jìn)行路徑規(guī)劃，即人為在可通過路徑中心或?qū)ΨQ位置粘貼一條或兩條顏色鮮明的標(biāo)示線，機(jī)器人攝像頭識(shí)別標(biāo)示線并以此為依據(jù)判斷前進(jìn)路徑。此方法簡(jiǎn)單可行，但是需要人為粘貼大量標(biāo)示線顯然難以滿足大規(guī)模應(yīng)用需要。因此識(shí)別隧道內(nèi)固有特征并轉(zhuǎn)化為路徑規(guī)劃依據(jù)具有較高的實(shí)用性。在常見高壓電纜隧道中步道是供巡視人員行走的通路，步道表面較為平直可供機(jī)器人通過，其高于左右兩側(cè)地面約10cm，因此其結(jié)構(gòu)特征可以作為良好的路徑規(guī)劃依據(jù)。

1 點(diǎn)云數(shù)據(jù)采集與存儲(chǔ)

在本文中獲取場(chǎng)景的點(diǎn)云數(shù)據(jù)信息和普通圖像信息使用的是用ASU SXtion PRO Live攝像頭。ASU SXtion PRO Live設(shè)備包含一個(gè)可見光RGB攝像頭和一個(gè)深度攝像頭。深度攝像頭與紅外發(fā)生器配合得到視場(chǎng)內(nèi)的深度信息。通過此設(shè)備可直接得到寬度×高度為640×480的RGB圖像及深度圖像。與常用的Microsoft Kinect攝像頭相比ASUS Xtion PRO Live的USB2.0接口可以同時(shí)完成供電與數(shù)據(jù)傳輸兩項(xiàng)功能，因此當(dāng)搭載在機(jī)器人上時(shí)其占用的硬件資源更少。

PCD文件格式是一種用于點(diǎn)云存儲(chǔ)的文件格式。相較于PLY、STL、OBJ等常規(guī)格式，其使得組織化點(diǎn)云的處理更方便。組織化點(diǎn)云數(shù)據(jù)一般來源于體感、立體攝像機(jī)、飛行時(shí)間攝像機(jī)等具有結(jié)構(gòu)化行列信息的設(shè)備，其毗鄰的點(diǎn)與點(diǎn)之間有明確的空間關(guān)系。PCL的IO模塊將XtionPRO獲取的RGB圖像與深度圖像融合為組織化的點(diǎn)云數(shù)據(jù)。

本文采用行列為640×480的點(diǎn)云輸入，因此每幀包含307200個(gè)點(diǎn)，每個(gè)點(diǎn)均附帶空間中三維坐標(biāo)值及RGB色彩值。隧道內(nèi)步道RGB圖像和深度圖像如圖2所示。

圖2  隧道RGB圖像和深度圖像

2 路徑規(guī)劃流程

圖3為自主導(dǎo)航流程框圖，描述了從點(diǎn)云數(shù)據(jù)采集到最終完成路徑規(guī)劃的幾個(gè)主要步驟。

圖3 自主導(dǎo)航流程框圖

3 點(diǎn)云精簡(jiǎn)算法

深度攝像頭所采集到的點(diǎn)云數(shù)據(jù)中有大量的噪聲點(diǎn)和冗余點(diǎn)，在輸入神經(jīng)網(wǎng)絡(luò)訓(xùn)練之前需要通過點(diǎn)云精簡(jiǎn)的方法盡可能多的去掉噪聲點(diǎn)和冗余點(diǎn)，用以提高神經(jīng)網(wǎng)絡(luò)的訓(xùn)練效率和訓(xùn)練效果。下文主要介紹幾種常見的點(diǎn)云精簡(jiǎn)方法。

3.1 空間劃分和點(diǎn)云特征

基于空間劃分和點(diǎn)云特征的方法中空間劃分使用的方法通常有kd-tree、八叉樹、均勻網(wǎng)格，點(diǎn)云特征一般使用曲率、法向量或鄰域點(diǎn)距離。

3.2 均勻網(wǎng)格法

均勻網(wǎng)格法（even grid）^[3]，首先對(duì)整個(gè)點(diǎn)云構(gòu)建一個(gè)大的方形網(wǎng)格，然后在X軸、Y軸、Z軸上設(shè)定最小步長(zhǎng)，將包裹全部點(diǎn)的大網(wǎng)格分割為若干個(gè)小的網(wǎng)格，最后使用每個(gè)小網(wǎng)格中離網(wǎng)格中心最近的一個(gè)點(diǎn)，代替小網(wǎng)格中的所有點(diǎn)。此種方法可以較大程度上減少冗余點(diǎn)的出現(xiàn)，但是個(gè)別離群的采樣點(diǎn)由于單獨(dú)處于一個(gè)小網(wǎng)格中因此仍然無法消除。并且從圖2中可以發(fā)現(xiàn)深度攝像頭對(duì)于處在攝像頭中心近距離步道的采集密度遠(yuǎn)高于兩側(cè)噪聲點(diǎn)，通過均勻網(wǎng)格法將會(huì)使全部最小網(wǎng)格內(nèi)的采樣點(diǎn)密度下降到同一水平，反而放大了需要過濾的噪聲，因此均勻網(wǎng)格法不適用于此種適用環(huán)境。

3.3 曲率法

曲率法是另一種基于區(qū)域特征的精簡(jiǎn)方法，這個(gè)方法首先找出每個(gè)點(diǎn)的K個(gè)近鄰點(diǎn)然后再使用這些點(diǎn)的擬合成一個(gè)曲面。這個(gè)曲面的曲率可以反映這個(gè)區(qū)域的復(fù)雜度。其中曲率比較大的區(qū)域則是形狀較為復(fù)雜的區(qū)域因此應(yīng)保留更多的點(diǎn)。此方法旨在使模型較為復(fù)雜的地方保留更多的點(diǎn)，在較為平坦的區(qū)域舍棄更多的點(diǎn)。在本文討論的適用場(chǎng)景下我們關(guān)注的反而是較為平坦的步道區(qū)域，因此無需保留模型復(fù)雜處的點(diǎn)。同時(shí)由于曲率計(jì)算需要復(fù)雜的矩陣運(yùn)算，尤其是當(dāng)處理大量點(diǎn)云數(shù)據(jù)時(shí)其運(yùn)算量巨大，因此其運(yùn)算時(shí)間和功耗都是需要實(shí)時(shí)解算的巡檢機(jī)器人難以承受的。因此本方法也不適用于本文討論的高壓電纜隧道巡檢機(jī)器人。

3.4 隨機(jī)精簡(jiǎn)法

隨機(jī)精簡(jiǎn)的方式是指使用隨機(jī)抽取的方法，按照設(shè)定比例抽取部分點(diǎn)構(gòu)成新的精簡(jiǎn)點(diǎn)云的方式。這種做法有兩個(gè)特點(diǎn)。第一，能夠降低系統(tǒng)誤差，隨機(jī)方法的實(shí)現(xiàn)和思想雖然簡(jiǎn)單，但是由于選取點(diǎn)的隨機(jī)性，使得精簡(jiǎn)后的模型在全局的精簡(jiǎn)度都比較的均勻。第二隨機(jī)精簡(jiǎn)的方式計(jì)算量小，實(shí)現(xiàn)簡(jiǎn)單，但是在精簡(jiǎn)過程中容易失去模型部分特征，因?yàn)殡S機(jī)精簡(jiǎn)在特征密集區(qū)域和平坦區(qū)域的采樣程度是一樣的，這就會(huì)導(dǎo)致在平坦區(qū)域采集過多的點(diǎn)，而在特征集中的區(qū)域采樣點(diǎn)不足，從而造成誤差增加。在本文所討論的隧道環(huán)境下，需要分割的反而是比較平坦的步道區(qū)域，因此隨機(jī)精簡(jiǎn)法的缺點(diǎn)將成為其優(yōu)點(diǎn)。在實(shí)驗(yàn)中發(fā)現(xiàn)保留20%點(diǎn)時(shí)點(diǎn)云中的目標(biāo)平面特征依舊明顯，即精簡(jiǎn)80%的數(shù)據(jù)后識(shí)別效果無明顯影響。

4 提取平面

點(diǎn)云經(jīng)過精簡(jiǎn)后需要對(duì)所需的步道平面點(diǎn)進(jìn)行篩選用于后續(xù)計(jì)算。文獻(xiàn)^[1]中通過對(duì)點(diǎn)云的法向特征進(jìn)行聚類來分割場(chǎng)景中的平面。首先，計(jì)算點(diǎn)云數(shù)據(jù)的法向量。然后，將法向一致的點(diǎn)云聚類到一起。最后，對(duì)每一簇點(diǎn)云在這一簇點(diǎn)云中心方向上進(jìn)行距離空間的聚類便可獲得各自獨(dú)立的平面點(diǎn)簇。本文在第二步聚類時(shí)，使用第3節(jié)中獲取的平面參數(shù)作為指導(dǎo)，從第一步聚類的結(jié)果中選取最接近運(yùn)動(dòng)平面法向量的類簇，然后單獨(dú)在這一類簇上進(jìn)行距離空間上的聚類，省去了對(duì)無關(guān)類簇的計(jì)算。表面法向計(jì)算采用文獻(xiàn)^[2]中的SDC（Smoothed Depth Changes）算法來計(jì)算點(diǎn)云的法向量。SDC算法的本質(zhì)上是通過相鄰點(diǎn)的特征關(guān)系來擬合一個(gè)局部平面片。即位于（x,y）處點(diǎn)p的曲面法向可通過計(jì)算其相鄰點(diǎn)的叉積得到。從組織化點(diǎn)云中選取行列上4個(gè)鄰點(diǎn)。如圖4所示，由橫向兩鄰點(diǎn)計(jì)算，由縱向兩個(gè)鄰點(diǎn)計(jì)算。

深度信息在計(jì)算點(diǎn)云空間位置時(shí)起到重要作用，而噪聲的影響會(huì)造成計(jì)算所得點(diǎn)云的空間位置不準(zhǔn)確，在通過式（1）計(jì)算法向時(shí)在平面邊緣處往往得不到應(yīng)有的結(jié)果，可通過均值化來平滑深度信息上的噪聲。為了避免平滑過程中目標(biāo)邊緣信息的丟失，在遇到潛在的邊緣時(shí)調(diào)整平滑區(qū)域的半徑。在本文討論的使用場(chǎng)景下，由于步道左右對(duì)稱，因此邊緣信息的丟失也呈對(duì)稱狀，通過試驗(yàn)對(duì)比發(fā)現(xiàn)去掉均值化步驟對(duì)步道中心線的識(shí)別無明顯影響，因此省略此步驟。

5 基于法向信息的平面分割

若需判斷兩個(gè)平面共面，應(yīng)滿足文獻(xiàn)^[3]中所述的兩個(gè)條件：（1）局部平面的法向量具有一致性，即在同一平面上的各個(gè)點(diǎn)鄰域內(nèi)法向的朝向應(yīng)該是一致的。（2）兩個(gè)平面上各取兩點(diǎn)構(gòu)成的向量在各自局部平面法向上的內(nèi)投影應(yīng)足夠小。文獻(xiàn)^[4]中將上述兩個(gè)條件以數(shù)學(xué)方式表示為：

其中，n1與n2分別是兩個(gè)局部平面片的法向量；α_thresh為夾角閾值；d_thresh為投影長(zhǎng)度閾值如圖5（a）所示。

對(duì)于已被歸一化的法向量，本文近似用歐氏距離代替角度可將第一個(gè)公式調(diào)整為

其中，emax為法向距離閾值，即在法向空間上兩者的歐式距離應(yīng)足夠接近。對(duì)已具有共向性的點(diǎn)簇，應(yīng)滿足

其中，，其中A=[a,b,c,d]為平面系數(shù)；p=(x,y,z)為具有共向性點(diǎn)簇中的一點(diǎn)；d_max為平面片間的最大距離閾值。平面系數(shù)A的前3個(gè)元素描述了平面法向的朝向，可用具有共向性點(diǎn)簇的朝向來代替。任選一點(diǎn)p另ax+by+cz+d=0可解出d的值。式

（4）表示點(diǎn)族內(nèi)兩點(diǎn)到平面距離的差值應(yīng)足夠小。

圖5 平面共面判別條件

圖6 平面分割效果

6 聚類識(shí)別步道平面

在得到各點(diǎn)的法向量后需要判斷哪些點(diǎn)屬于同一個(gè)平面，此時(shí)需要運(yùn)用K-means聚類算法。K-means算法屬于無監(jiān)督學(xué)習(xí)算法，可以在缺少分類標(biāo)簽的情況下依據(jù)每個(gè)點(diǎn)自身的法向量判斷其是否在一個(gè)平面內(nèi)，其算法流程如下：第一步首先隨機(jī)初始化k個(gè)“質(zhì)心”，計(jì)算各個(gè)點(diǎn)到每個(gè)質(zhì)心的距離，在本文中距離以各點(diǎn)法向量的夾角余弦值代表。

第二步遍歷完全部點(diǎn)后將得到k個(gè)點(diǎn)簇，計(jì)算每個(gè)點(diǎn)簇中各點(diǎn)的平均法向量以及各點(diǎn)法向量與質(zhì)心向量的方差，將平均法向量作為新的質(zhì)心，并重新進(jìn)行第一步。通過多次迭代可以發(fā)現(xiàn)各點(diǎn)簇的向量方差將逐步收斂，證明擁有相似法向量的點(diǎn)被劃分成了一類。由于深度攝像機(jī)視角內(nèi)最大的平面就是隧道的地面，因此只需選取包含點(diǎn)數(shù)最多的點(diǎn)簇即可完成屬于水平面上點(diǎn)的篩選。

由于步道和兩側(cè)地面為平行關(guān)系，因此僅通過法向量聚類無法區(qū)分步道和兩側(cè)地面。此時(shí)需要對(duì)這一簇點(diǎn)舍棄掉x、y維度的信息，僅以高度數(shù)據(jù)進(jìn)行一次k值為2的一維聚類。這樣就可以完成步道平面和兩側(cè)地平面的區(qū)分，其中高度較高的一簇即為從步道上所采集到的點(diǎn)。

7 邊界提取

由于路徑規(guī)劃依靠識(shí)別步道的中線并計(jì)算攝像頭中心線與步道中心線的關(guān)系進(jìn)而修正前進(jìn)路線，因此還需要識(shí)別出步道兩端的邊緣。對(duì)于點(diǎn)云圖像邊緣的提取^[5]中介紹了很成熟的算法。其原理為利用數(shù)據(jù)點(diǎn)的拓?fù)潢P(guān)系以及數(shù)據(jù)點(diǎn)法矢等信息構(gòu)造最小二乘平面，然后根據(jù)鄰域內(nèi)數(shù)據(jù)點(diǎn)在平面上的投影點(diǎn)之間分布均勻性提取邊界。設(shè)點(diǎn)p為點(diǎn)云中的某一點(diǎn)，先利用kd-tree檢索該點(diǎn)的k鄰域，然后構(gòu)建最小二乘平面，并將鄰近點(diǎn)投影到其最小二乘平面上（如圖7所示），過p點(diǎn)作平行于坐標(biāo)軸平面xoy，xoz，yoz的平面xpy，xpz，ypz，以xpy，xpz，ypz為參考平面，當(dāng)其鄰近點(diǎn)中位于某一平面一側(cè)的點(diǎn)與位于另外一側(cè)的點(diǎn)數(shù)差與鄰近點(diǎn)總數(shù)的比大于一定閾值時(shí)，該點(diǎn)即為邊界點(diǎn)。

邊界點(diǎn)的具體計(jì)算流程如下：

（1）由p點(diǎn)的鄰近點(diǎn)，計(jì)算出p點(diǎn)的法向量，然后構(gòu)造最小二乘平面T;

（2）將p點(diǎn)的鄰近點(diǎn)投影到平面T上；

（3）過p點(diǎn)作平行于xoy,xoz,yoz的平面，并計(jì)算出位于三個(gè)平面兩側(cè)的點(diǎn)；

（4）若位于平面兩側(cè)的點(diǎn)數(shù)之差占鄰近點(diǎn)總數(shù)的比例大于或等于某一閾值，該點(diǎn)即為邊界點(diǎn)。

由于經(jīng)過前文中對(duì)點(diǎn)云數(shù)據(jù)的特征提取已經(jīng)從點(diǎn)云中提取了平面特征，因此在應(yīng)用上述算法提取邊界時(shí)可以進(jìn)一步簡(jiǎn)化算法。算法可以簡(jiǎn)化為先利用kd-tree檢索該點(diǎn)的k鄰域，確定點(diǎn)p的臨近點(diǎn)，過p點(diǎn)做平行于面xoz的平面，計(jì)算出其鄰近點(diǎn)在平面的哪一側(cè)，若位于平面兩側(cè)的點(diǎn)數(shù)之差占鄰近點(diǎn)總數(shù)的比例大于或等于閾值，該點(diǎn)即為邊界點(diǎn)。這樣避免了計(jì)算最小二乘平面以及計(jì)算臨近點(diǎn)投影的計(jì)算量，進(jìn)一步減小了處理器的運(yùn)算壓力。邊界提取效果如圖8所示。

圖8 邊界提取效果

8 解算控制信息

提取到左右兩側(cè)邊界點(diǎn)后，取其x坐標(biāo)相等的點(diǎn)為一對(duì)計(jì)算其中心點(diǎn)，得到此x坐標(biāo)下的步道中心。多個(gè)中心點(diǎn)連線即是步道中線。在步道中線上取三個(gè)點(diǎn)進(jìn)行擬合可以得到步道的基本走勢(shì)。若擬合曲線通過視角底部中點(diǎn)則可以判斷當(dāng)前機(jī)器人位于步道中心。若擬合曲線端點(diǎn)在鏡頭右側(cè)則表明機(jī)器人當(dāng)前處于步道中心偏左位置需要向右平移，反之需要向左移動(dòng)。取擬合曲線下方末端切線，切線朝向即位當(dāng)前位置隧步道走向，因此機(jī)器人向切線方向旋轉(zhuǎn)即可保證機(jī)器人前進(jìn)方向始終與步道走向一致。中心線擬合效果如圖9所示。

圖9 中心線擬合效果

9 總結(jié)與展望

本文提出了一種針對(duì)高壓電纜隧道步道點(diǎn)云特征的機(jī)器人路徑規(guī)劃方法。本方法可以基本滿足輪式和四足式巡檢機(jī)器人在步道中的導(dǎo)航需求。但是本方法還存在諸多不足之處有待改進(jìn)以滿足更多場(chǎng)景的應(yīng)用。（1）高壓電纜隧道中存在集水坑等特殊地形，本方法無法識(shí)別。（2）本方法無法識(shí)別步道上的臺(tái)階碎石等障礙物。對(duì)于上述崎嶇地形條件，基于點(diǎn)云的路徑規(guī)劃應(yīng)該比視覺、SLAM等其他路徑規(guī)劃方式更加有優(yōu)勢(shì)，值得繼續(xù)研究開發(fā)。同時(shí)本方法的實(shí)驗(yàn)數(shù)據(jù)計(jì)算均基于筆記本電腦處理器，其運(yùn)算效率和搭載在機(jī)器人上的微型處理器有很大差距，因此計(jì)算的實(shí)時(shí)性還需要另外加以驗(yàn)證，若無法滿足實(shí)時(shí)解算的要求則機(jī)器人的控制效果將大打折扣。若運(yùn)算時(shí)間無法滿足要求則可以考慮在點(diǎn)云精簡(jiǎn)時(shí)進(jìn)一步提高精簡(jiǎn)率以更少的點(diǎn)云提取特征，犧牲一部分準(zhǔn)確性換取運(yùn)算速度提升。

作者簡(jiǎn)介：

冀然（1996-），男，山西平遙人，助理工程師，碩士，現(xiàn)就職于國網(wǎng)北京市電力公司電纜分公司，從事電纜運(yùn)維檢修工作。

吳建旺（1977-），男，北京人，助理工程師，現(xiàn)就職于國網(wǎng)北京市電力公司電纜分公司，從事電纜運(yùn)維檢修工作。

張東（1989-），男，北京人，工程師，學(xué)士，現(xiàn)就職于北京卓越電力建設(shè)有限公司，從事電纜運(yùn)維檢修工作。

高祥（1992-），男，北京人，助理工程師，現(xiàn)就職于北京卓越電力建設(shè)有限公司，從事電纜運(yùn)維檢修工作。

王辰松（1988-），男，北京人，工程師，學(xué)士，現(xiàn)就職于北京卓越電力建設(shè)有限公司，從事電纜運(yùn)維檢修工作。

張亮（1985-），男，北京人，助理工程師，現(xiàn)就職于北京卓越電力建設(shè)有限公司，從事電纜運(yùn)維檢修工作。

摘自《自動(dòng)化博覽》2022年11月刊