一種基于串結構的自主巡檢路徑規劃方法

李小寧 郭光瑞

摘要：本文介紹了一種基于串結構的自主巡檢路徑規劃方法，通過對串結構的最短路徑進行路徑規劃，并對串結構進行排序，計算巡檢點順序，實現了桿塔巡檢的自動執行。該方法能夠自動計算每個目標點的安全距離上的拍攝點和無人機載荷的姿態，確保整個串結構都能被拍攝到。同時，該方法能夠自動計算拍攝塔基、全塔和塔號等目標點的拍攝點，具有選點少、自動化程度高的特點。通過使用該路徑規劃方法，可以降低人工選點的數量，同時提高巡檢的效率和質量。

關鍵詞：無人機；桿塔；線路；巡檢；路徑；規劃；串結構

針對輸電線路巡檢作業，國網公司提出加強巡檢技術應用，以取代傳統的依靠人力為主的巡檢方式。這種技術應用具有巡視范圍廣、巡檢手段全面和作業效率高的優勢。隨著該技術在電力行業的廣泛應用，對電力巡檢的智能化和自主化水平提出了更高要求。

目前，應輸電線路巡檢的技術應用多種多樣，其中大疆產品應用最為廣泛。然而，大疆類產品自帶的軟件并不專門針對電網應用需求而研制，導致在真實巡檢作業中存在一些問題。例如，巡檢作業主要依賴手機獲取影像，并要求無人機的位置精確，這限制了每次作業的效率。此外，目前的巡檢作業大多為手控方式，缺乏智能化，且操作風險較高。專業人員稀缺和人工成本的制約也限制了輸電線路巡檢的規模發展。

另外，國內其他電力桿塔自主規劃算法多以點云上某個目標點作為算法輸入，需要人工或算法獲得更多的目標點，并進行無人機和載荷的姿態設計。

鑒于上述問題，本文旨在提出一種基于串結構的自主巡檢路徑規劃方法，以解決現有技術方案中基于點的航跡規劃需要人工選取點云的問題，同時也解決無人機和載荷姿態需要人工調節的困難，這兩個問題增加了人工成本并引入了人為誤差。本文將通過算法設計、航線仿真、航線導出，以及算法驗證結果四個方面來闡述基于串結構的自主巡檢路徑規劃方法。

一、算法設計

本文所述的基于串結構的自主巡檢路徑規劃方法以串結構為最短路徑進行路徑規劃，并對串結構進行排序，計算巡檢點順序，執行桿塔巡檢。在串結構巡檢過程中，路徑規劃的最短距離可能是指絕緣子串的長度，即沿著絕緣子串進行巡檢的最短路徑，以確保覆蓋所有檢查點。

（一）總體方法以串結構為單位進行路徑規劃

根據串結構的信息，將其作為最小的巡檢單元進行路徑規劃。同時，對串結構進行排序，以確定巡檢順序；

判斷拍攝覆蓋范圍：根據串結構的幅寬，計算串結構端點的拍攝范圍是否能夠覆蓋整個塔。如果無法覆蓋，根據幅寬反算得到中間拍攝點，該點拍攝的照片能夠覆蓋整個串結構。

計算拍照點和姿態：根據兩個地線掛點的位置，自動計算得到串結構、塔基以及其他目標點的拍照點。同時，根據目標點的特點，可以自動計算出相應的無人機和載荷姿態，以便進行合適的拍照操作。

計算其他目標點的拍照點和姿態：除了串結構和塔基等目標點，還可以根據需要自動計算其他目標點（如全塔）的拍照點和相應的無人機和載荷姿態。

（二）具體方法

（1）參數輸入：在點云上拾取兩類串結構，即絕緣子串和地線掛點。絕緣子串是有方向的線段組成的串結構，地線掛點是單獨的點組成的特殊的串結構。將塔上的左、中、右、上、中、下絕緣子串及最上面兩個地線掛點在拾取后得到各個點的三維坐標和方向屬性，構造成算法需要的串結構。

①定向：沿著線路走向的方向，分左右側。以線路走向為分界線，將各個串結構區分出左右屬性。

②內容：具有包含①中方向屬性的桿塔左右側地線掛點和串結構的xyh坐標。對串結構的方向屬性描述例如左側地線掛點，右側中絕緣子串。這樣串結構具有方向、屬性、三維位置坐標，是進行后續計算的數學基礎。

（2）尋找桿塔最上面兩端的地線掛點：根據（1）中參數輸入的具有方向屬性的桿塔左右側地線掛點和串結構，遍歷查找到屬性為左側或右側地線掛點的串結構。

（3）根據步驟（2）中兩個地線掛點信息，計算塔參數：方位角、單位向量、法向量、塔頂中心坐標、塔基中心坐標等。塔的單位向量是兩個地線掛點組成的向量歸一化后的單位向量v1；塔的法向量是v1沿著線路走向旋轉90度構成的單位向量v2。

（4）將所有串拆分成左右串結構的集合L1，L2。

（5）左右串結構的集合L1，L2分別進行步驟（6）到（13）的操作。

（6）以串結構為單位，計算所有串結構的中心點。對于線段組成的串結構，中心點是兩個端點坐標的平均值；對于單點如地線掛點組成的串結構，中心點就是本身。然后計算每兩串結構中心點的距離，放在二維數組中，行列號都表示每個串結構索引0，1…，存放的數據是行號點到列號點的距離。同時記錄高度值最大的值hmax和對應點的索引號。

（7）步驟（6）中最大高度對應的索引點作為起算點，尋找距離此點最近的點，將其索引放入新數組中。下次以此最近的點作為起算點，尋找距離此點最近且不在新數組中的點，將其索引放入新數組中。循環遍歷得到由高到低依次排序的存放由串結構的有序數組。

（8）對有序數組中的串結構計算對應緩沖串結構，即安全串結構。通過沿著塔的單位向量的縮放平移，將串結構平移至安全距離，得到串結構對應的安全串結構，將得到的安全串結構加入新數組，并逆序排列，形成從下往上的有序數組。這個有序數組表示的是在此位置相對桿塔是安全的，無論是做拍照動作還是做過渡飛行動作。有了安全距離上的航線基礎，才能進行進一步的拍照姿態的計算。沒有安全，其他動作無從談起。

（9）在安全串結構上計算對原始串結構的目標拍照點，對步驟（8）中安全串的端點即無人機航點，計算無人機對著目標點的無人機姿態和載荷姿態，并估算幅寬，對于兩個端點不能覆蓋到全串結構的情況，根據串結構長度反向計算中間拍照點，該點能夠拍攝全串結構。要么兩個端點能夠覆蓋全串結構，不需要增加輔助拍照點；要么兩個端點能夠覆蓋不了全串結構，需要增加輔助拍照點，而這個輔助點是基于串中心點外延算出來的。

（10）通過沿著塔的單位向量的縮放旋轉平移，計算地線掛點的安全點，并計算無人機對著目標點的無人機姿態和載荷姿態，即地線掛點拍照點。

（11）計算無人機載荷對準塔基的點，即看塔基的點，并計算無人機對著目標點的無人機姿態和載荷姿態，就是對塔基的拍照點。

（12）計算過渡點，用于安全地從上往下過渡。該點是左側串結構上的端點、地線掛點、塔基三種點中距離塔中心點的水平投影距離最大，高度與塔頂一樣的點。選取從塔頂端飛行出于安全考慮，塔下方的環境包括人、建筑、植被等不確定因素，塔上方環境更多的是空曠天空。

（13）整理左側航線，依次為：過渡點，塔基拍照點，串結構的目標拍照點，地線掛點拍照點，過渡點。過渡點不拍照，姿態不做計算，用于無人機過渡航線用。

（14）計算進入全塔的點：看全塔的點，計算無人機對著全塔的無人機航點和載荷姿態，即全塔拍照點。桿塔的塔基到塔頂作為一個塔身的向量，塔身向天空方向加高h米，計算無人機距離多遠，俯視多少角度能看全這個塔。

（15）計算看塔號的點，并計算無人機對著目標點的無人機姿態和載荷姿態，即塔號拍照點。塔號在點云上看不到，但是相同或類似塔形的桿塔塔號一般都在同一個位置。這里的塔號約定在塔頭位置。基于兩個地線掛點的中點沿著桿塔法向量延長一定長度，作為拍攝桿塔塔號的航點，將無人機的載荷向下俯視一定角度（基于不同塔型，角度有一個經驗值）。以此得到無人機對著目標點的無人機航點位置和載荷姿態。

（16）計算退出全塔的點：在塔正上方俯視塔基開始拍照或錄像的點，計算無人機對著目標點的無人機姿態和載荷姿態，即導線拍照或錄像點。無人機以此點開始飛向下一個桿塔，在飛行過程中正對導線，通過視頻或拍照形式，記錄導線的此刻狀態。

（17）整理規劃航線。左側航線和右側航線重復6-13步驟，結合14-16的航點，得到規劃后的航線，整理順序依次為：全塔拍照點，左側航線，塔號拍照點，右側航線，導線拍照或錄像點。這里說的航線是針對一個桿塔的巡線航線，基于桿塔單元的航線將整條線路上所有桿塔的巡線航線連接起來，就是一整條無人機自動巡檢的航線。

二、航線仿真

航線仿真是指對設計好的巡檢單塔的航線進行模擬仿真，通過動畫演示來動態展示無人機的巡檢順序和姿態，并利用三維仿真來輔助預判航線的安全性和合理性。本文所述的基于串結構的自主巡檢路徑規劃方法所得到的完整無人機自動巡檢航線在投入實際外場飛行之前，需要經過航線仿真這一重要環節，而仿真模塊則顯得至關重要。仿真模塊具有兩個主要功能，即安全預警和飛行仿真。

安全預警，是指通過設置安全距離，并借助碰撞檢測算法來判斷各個航道和桿塔之間的距離是否在安全閾值范圍內，從而對當前的航跡規劃進行危險點檢測。危險點檢測的結果將直接展示在航線上，對航點和航線分別進行高亮標注，并提供危險點的統計信息，包括危險點的起止航點、危險距離等信息，便于清晰統計。

飛行仿真，是指以無人機的第一人稱角度來觀察各個航點下無人機在該姿態下的載荷視線內容，即觀察該位置處的串結情況。支持手動調整無人機航點和姿態參數，可實時調整載荷俯仰角和安全距離，得到調整后的視線內容。仿真模塊在航點列表及點云視圖中刪除所選航點信息；選中航點列表中的某一航點數據后，該航點的飛機姿態、載荷姿態和安全距離信息會顯示在航點規劃參數設置相應文本框中，可通過按鈕來修改具體數據。對于需要修改整塔安全距禇，可在“整塔安全距離”文本框中輸入數據后進行修改。

任何航線規劃后必須進行仿真，只有在安全性得到保證的基礎上再進行業務功能的驗證，才能確保實際外場飛行的正常完成。

三、航線導出

航線導出是指根據輸入的起始桿塔和終止桿塔，生成無人機飛行所需的航線格式。當起始桿塔和終止桿塔相同時，即為巡檢單塔；否則，為巡檢特定桿塔線路。

航線導出包括兩種格式：①算法自定義格式：該格式的航線坐標以測量坐標系XYH為基準，用于軟件內部的導入和導出；②KML格式（大疆無人機支持）：該格式的航線坐標使用相對坐標系，相對于無人機起飛點，因此在導出前需要輸入無人機起飛點的高度。導出后，可以在支持KML格式的三維軟件中打開并進行預覽。

航線導出還支持雙機巡檢模式的選擇，包括異側同向和雙機異向：①異側同向：兩架無人機沿著桿塔線路的同一個側面、同一個方向飛行，分別巡檢相同桿塔的不同關鍵點；②雙機異向：飛行任務被劃分為兩個段落，每架無人機負責巡檢若干個桿塔，航線巡檢的桿塔不同。

根據飛行任務的需求，選擇相應的雙機巡檢模式進行航線導出。

四、算法驗證結果

本文所述的基于串結構的自主巡檢路徑規劃方法在飛行驗證過程中，設置安全距離為3或4米，并將算法得到的航線導出成大疆KML格式，然后使用大疆無人機進行實地飛行測試。盡管距離是安全的，但由于距離過近，在地線掛點處觸發了大疆避障功能。因此，選擇關閉避障功能以繼續航行。

在與其他同類軟件進行用戶試用時，基于串結構的自主巡檢路徑規劃方法和軟件收到用戶的反饋，稱自動計算航線航點和姿態的流程自動化程度高。

該基于串結構的自主巡檢路徑規劃方法已成功應用于桿塔巡檢項目中。通過多次飛行巡檢任務，對規劃仿真數據和實際拍攝效果進行分析和經驗值調整，例如調整拍攝塔頭的俯視角度。實際拍攝結果顯示，照片中的銷釘清晰可見，全塔拍攝完整，塔基拍攝清晰，絕緣子串拍攝完整，并且達到了預期的拍攝效果，絕緣子串和銷釘清晰可見。

五、結束語

相對于現有技術，本文所述的基于串結構的自主巡檢路徑規劃方法具有多項優勢。首先，該方法能夠自動計算每個目標點上的安全拍照點以及無人機和載荷的姿態，確保整個串結構都能被拍攝到。此外，該方法還能夠自動計算塔基、全塔、塔號等拍攝點，大大減少了人工選點的數據量，提高了路徑規劃的精度和效率。

這種基于串結構的自主巡檢路徑規劃方法在工程實際中能夠滿足自動化巡檢的需求，并能夠顯著提升巡檢作業的效率。同時，通過應用該方法，積累了關于自主巡檢的技術和經驗，為未來研發通用的巡檢工具奠定了基礎。

作者單位：李小寧 郭光瑞 天津航天中為數據系統科技有限公司

參考文獻

[1]廖逍，李君海，胡浩瀚，等.一種電力桿塔巡檢用無人機自主巡檢方法： CN111256702A[P].2020.06.09

[2]魏明磊，王朗，林藝城.一種輸電線巡檢路徑規劃方法及系統： CN106327013A[P].2017.01.11

[3]毛先胤，馬曉紅，彭赤，等.一種基于激光點云的無人機自主巡檢絕緣子路徑規劃方法與流程： CN110780681A[P].2020.02.11

[4]羅顯躍，高吉普，龍征，等.一種巡檢機器人智能路徑規劃方法[J].湖南科技大學學報：自然科學版， 2018（4）：75-82.

[5]張廣林，胡小梅，柴劍飛，等.路徑規劃算法及其應用綜述[J].現代機械，2011（5）：85-90.

李小寧（1986.06-），女，漢族，河南安陽，碩士，中級工程師，研究方向：三維地理信息和無人機航跡規劃；

郭光瑞（1988.01-），男，漢族，山西運城，碩士，中級工程師，研究方向：測控數傳一體化地面站。