摘 要：煤礦井下輔助作業(yè)機器人位姿控制是提高機器人作業(yè)效率和質量的重要手段，目前控制效果不佳，機器人控制誤差較大，因此本文提出基于三維點云處理的煤礦井下輔助作業(yè)機器人位姿控制方法。對煤礦井下進行三維激光掃描，獲取井下三維點云數(shù)據(jù)，進行三維點云處理，搭建井下空間三維場景模型，提供識別障礙物和作業(yè)目標，確定機器人位姿調控量，基于三維點云處理對煤礦井下輔助作業(yè)機器人進行位姿控制。試驗證明，當采用本文方法時，機器人避障效果較好，位置跟蹤誤差較低，機器人作業(yè)位置與目標位置誤差僅為0.1 m，可以對煤礦井下輔助作業(yè)機器人位姿進行精準控制。

關鍵詞：三維點云處理；輔助作業(yè)機器人；位姿控制；三維激光掃描；障礙物；作業(yè)目標

中圖分類號：TP 242" " " " " 文獻標志碼：A

隨著煤炭工業(yè)快速發(fā)展，煤礦井下作業(yè)效率和安全性成為行業(yè)內關注的焦點。為了提升井下作業(yè)的效率和安全性，在煤礦生產中采用智能化設備。煤礦井下輔助作業(yè)機器人是一種新型的智能化設備，其具有自主導航、作業(yè)執(zhí)行以及信息感知等功能，其可以通過傳感器和定位系統(tǒng)獲取周圍環(huán)境的信息，利用計算機視覺和人工智能技術進行識別和判斷。當執(zhí)行作業(yè)任務時，機器人可以利用預設路徑或者自主探索方式進行移動，完成各種井下作業(yè)任務，例如鉆孔、搬運、噴漿和巡檢等，節(jié)約生產成本，降低事故發(fā)生的概率，保障井下作業(yè)安全。機器人還可以為礦工提供更好的工作環(huán)境，減輕勞動強度，提高工作效率。目前，煤礦井下輔助作業(yè)機器人在采礦行業(yè)中廣泛應用，位姿控制是煤礦井下輔助作業(yè)機器人高效、安全作業(yè)的關鍵技術之一。

1 井下作業(yè)空間三維激光掃描

煤礦井下作業(yè)空間狹窄，環(huán)境惡劣，巷道崎嶇不平，障礙物較多，光線條件較差，提高了機器人定位建圖難度。因此，本文采用三維點云處理技術虛擬化井下作業(yè)空間場景，識別場景內機器人作業(yè)目標和周圍障礙物，為機器人位姿控制提供依據(jù)。為實現(xiàn)該目標，需要對煤礦井下作業(yè)空間進行三維激光掃描，獲取井下作業(yè)空間的三維點云數(shù)據(jù)[1]。將型號為OYTAS-A7F7的三維激光掃描儀安裝在機器人上方，探頭與地面平行，采用串并聯(lián)的方式將其接入機器人電源總線上，使兩者同步運行。根據(jù)實際情況設定三維激光掃描儀掃描范圍、周期以及頻率等技術方面參數(shù)。在掃描過程中，激光測距儀發(fā)射一束激光脈沖信號，當接觸物體表面時，信號發(fā)生漫反射并沿著原路徑反向傳導至信號接收器，可以得到機器人與掃描點之間的距離，如公式（1）所示[2]。

（1）

式中：h為激光掃描儀與掃描點之間的距離，即機器人與掃描點之間的距離；v為激光脈沖信號傳播速度；t1、t2分別為激光脈沖信號發(fā)射時間與反射時間。電機驅動三維激光掃描儀上部轉動，根據(jù)掃描儀豎向鏡垂直方向與水平方向轉過的角度，得到三維激光掃描儀觀測角度值，將測量值映射至掃描儀坐標系中，得到掃描點的坐標，如公式（2）所示[3]。

（2）

式中：Q為掃描儀坐標系；X、Y和Z分別為掃描點在三維激光掃描儀中的橫坐標、縱坐標和斜坐標；α為水平方向觀測角度；β為垂直方向觀測角度。采集煤礦井下作業(yè)空間三維點云數(shù)據(jù)，上傳至計算機，用于三維點云處理。

2 基于三維點云處理的作業(yè)三維場景搭建

處理三維激光掃描得到的井下作業(yè)空間三維點云數(shù)據(jù)，搭建井下作業(yè)三維虛擬場景。將采集的三維點云數(shù)據(jù)中的重復部分刪除，對異常和缺失數(shù)據(jù)進行插值處理，保證三維點云數(shù)據(jù)完整性[4]。當三維激光掃描時會受井下作業(yè)噪聲干擾，采集的點云數(shù)據(jù)存在噪聲。為了保證控制精度，采用均值濾波法對三維點云濾波進行去噪處理，如公式（3）所示。

（3）

式中：X*、Y*和Z*為三維點云坐標；Qt-1、Qt+1分別為前一個時刻和下一個時刻掃描點坐標值。根據(jù)均值對三維點云數(shù)據(jù)中的離散點進行平滑處理，去除原始點云數(shù)據(jù)中的噪聲分量。將處理好的三維點云數(shù)據(jù)上傳至UFH三維建模軟件中，利用轉換矩陣將掃描儀坐標系轉換為大地坐標系，對三維點云數(shù)據(jù)進行拼接處理，如公式（4）所示。

（4）

式中：S（x，y，z）為大地坐標系中掃描點位置坐標；x為水平方向坐標；y為豎直方向坐標；z為垂直于兩者方向的坐標；E為旋轉矩陣；F為平移矩陣。將三維點云數(shù)據(jù)映射至大地坐標系中，搭建煤礦井下輔助作業(yè)空間三維場景模型，為后續(xù)機器人位姿控制奠定基礎。

3 作業(yè)目標定位及機器人位姿控制

在上述基礎上識別三維空間場景的障礙物，在三維空間場景中，如果掃描點縱向坐標值高于機器人位置縱向坐標值，則視該點為障礙物，如公式（5）所示。

（5）

式中：g為障礙物識別結果；1為掃描點障礙物；0為掃描點無障礙物；a為機器人縱坐標。利用公式（5）識別得到三維場景中的障礙物，并將機器人作業(yè)目標標記在大地坐標系中，在未識別障礙物的情況下，機器人向作業(yè)目標成直線移動；當識別到障礙物時，根據(jù)機器人當前位姿以及障礙物位置，確定機器人位姿調控量。機器人運動學模型如公式（6）所示。

（6）

式中：b為機器人橫坐標；γ為機器人姿態(tài)角。

機器人動力學模型如公式（7）所示。

（7）

式中：M為機器人移動慣性，即加速度；C為機器人速度與位置有關的向心力；μ為機器人約束反力。利用加速度傳感器進行測量，得到機器人的移動慣性，為了改變機器人的運動方向，須改變機器人運動模型中的姿態(tài)角。機器人姿態(tài)控制可以改變機器人姿態(tài)角，越過障礙物向目標位置移動，因此其位姿控制量的計算方法如公式（8）所示。

（8）

式中：υγ為煤礦井下輔助作業(yè)機器人位姿控制量；δ為機器人作業(yè)目標位置；S*（x，y，z）為機器人前方障礙物坐標。對機器人進行位姿調控，改變機器人移動方向，越過障礙物。將以上計算的控制量發(fā)送至控制器中，利用控制器對機器人位姿進行調控，對基于三維點云處理的煤礦井下輔助作業(yè)機器人進行位姿控制。

4 試驗論證

4.1 試驗工況

煤礦井下采掘工作面風流溫度為28 ℃～30 ℃，作業(yè)地點的風流速度為2.5 m/s～3.0 m/s，濕度為80%～100%，大氣壓為103 hPa～108 hPa，甲烷含量為0.1%～15.0%，井下輔助作業(yè)機器人承壓為5.5 MPa，導熱系數(shù)為0.02 W/（m·℃）。

4.2 試驗準備與設計

為驗證設計方法能否應用于煤礦井下作業(yè)環(huán)境，對煤礦井下輔助作業(yè)機器人進行試驗，機器人型號為KHFA-SG455，移動速度為1.5 m/s，井下巷道寬度為5.14 m，長度為1 564.52 m，利用本文方法對煤礦井下輔助作業(yè)機器人進行位姿控制。試驗過程為在井下輔助作業(yè)機器人上安裝1臺三維激光掃描儀，采集井下三維激光掃描數(shù)據(jù)0.26 GB，分析并處理三維激光掃描數(shù)據(jù)，搭建井下三維場景，控制機器人位姿，使其完成井下500 m作業(yè)任務，煤礦井下輔助作業(yè)機器人位姿作業(yè)任務如圖1所示。從圖1可以看出，在對機器人進行位姿控制的過程中，機器人能夠繞開所有障礙物并按照規(guī)定路線向目標移動，說明本文方法基本可以完成煤礦井下輔助作業(yè)機器人位姿控制任務。

4.3 試驗結果

4.3.1 煤礦井下輔助作業(yè)機器人避障效果測試

應用設計方法后的機器人位姿作業(yè)路徑與煤礦井下輔助作業(yè)機器人位姿作業(yè)任務路徑軌跡越一致，方法避障能力越強。具體測試結果如圖2所示。

根據(jù)圖2可知，設計方法采用三維點云處理技術，利用激光雷達傳感器獲取井下環(huán)境的點云數(shù)據(jù)，這些數(shù)據(jù)包括豐富的空間信息和幾何特征，因此設計方法與煤礦井下輔助作業(yè)機器人位姿作業(yè)任務路徑基本一致。處理并分析這些點云數(shù)據(jù)，得到包括周圍障礙物的位置、形狀和大小等準確的煤礦井下作業(yè)空間環(huán)境信息，構建井下作業(yè)空間的三維模型，識別機器人作業(yè)目標和周圍障礙物。由于避障路徑的規(guī)劃基于準確的三維模型和障礙物信息，因此，當遇到障礙物時，煤礦井下輔助作業(yè)機器人能夠做出快速、準確的反應，避免與障礙物發(fā)生碰撞。

4.3.2 煤礦井下輔助作業(yè)機器人位置跟蹤誤差測試

位置跟蹤誤差測試能夠直接反映煤礦井下輔助作業(yè)機器人的定位精度，對評估機器人的導航和定位能力十分重要。利用EFly智能航測軟件，采用自動數(shù)據(jù)采集終端采集設計方法的煤礦井下輔助作業(yè)機器人位置信息。獲取機器人在X軸、Y軸和Z軸的平均位置跟蹤誤差，誤差越低，煤礦井下輔助作業(yè)機器人位姿控制效果越好。具體測試結果如圖3所示。

由圖3可知，采用均值濾波法對三維點云數(shù)據(jù)進行濾波去噪處理，并對離散點進行平滑處理，有效去除原始數(shù)據(jù)中的噪聲分量，減少數(shù)據(jù)中的隨機誤差和異常值，點云數(shù)據(jù)更平滑和連續(xù)。因此，利用本文方法控制的礦井下輔助作業(yè)機器人在X軸、Y軸和Z軸的平均位置跟蹤誤差均較低，三維軸向的誤差波動較平緩。將處理好的三維點云數(shù)據(jù)上傳至UFH三維建模軟件中，及時調整機器人的路徑和姿態(tài)，完成動態(tài)避障。利用轉換矩陣將掃描儀坐標系轉換為大地坐標系，對三維點云數(shù)據(jù)進行拼接處理，使機器人在井下作業(yè)過程中的位置數(shù)據(jù)與實際環(huán)境坐標系一致，提高了機器人位姿控制精度。

4.3.3 煤礦井下輔助作業(yè)機器人位姿控制精度測試

極值搜索算法是一種自適應控制方法，其可以在時變環(huán)境中尋找系統(tǒng)的最佳性能點。優(yōu)化機器人位姿參數(shù)，利用極值搜索算法取得最佳作業(yè)效果。模糊PID控制算法是一種結合了模糊邏輯和傳統(tǒng)PID控制的方法，利用模糊化處理系統(tǒng)輸入和輸出，改善傳統(tǒng)PID控制器對非線性、時變系統(tǒng)的控制性能。模糊PID控制算法根據(jù)機器人當前位姿誤差和誤差變化率動態(tài)調整PID控制參數(shù)，提升機器人在復雜環(huán)境中的位姿控制性能。為了驗證方法效果，試驗選擇極值搜索算法（傳統(tǒng)方法一）和模糊PID控制算法（傳統(tǒng)方法二）與本文方法進行對比。試驗統(tǒng)計了7次機器人作業(yè)任務中目標點位置與實際位置的數(shù)據(jù)，機器人作業(yè)位置與目標位置越近，機器人位姿控制精度越高，效果越好，統(tǒng)計數(shù)據(jù)見表1。

根據(jù)表1的數(shù)據(jù)得出結論，應用本文方法，機器人作業(yè)位置與目標位置最大誤差僅為0.1 m，傳統(tǒng)方法一的最大誤差為1.2 m，傳統(tǒng)方法二的最大誤差為1.8 m，大于本文方法的最大誤差。試驗結果說明采用本文方法，機器人位姿控制精度較高。

5 結語

本文提出一種基于三維點云處理的煤礦井下輔助作業(yè)機器人位姿控制方法。經過試驗驗證，本文方法能夠對煤礦井下輔助作業(yè)機器人進行精確定位和姿態(tài)控制，提高機器人在井下作業(yè)的效率，保障安全。該方法還可以為其他類似的機器人系統(tǒng)提供一種有效的位姿控制方法。該方法在實際應用中仍然存在一些挑戰(zhàn)。例如，井下環(huán)境的復雜性和動態(tài)性可能導致點云數(shù)據(jù)的獲取和處理難度較大；機器人在井下的運動受到限制和約束，需要更精確的軌跡規(guī)劃和姿態(tài)控制。為了解決這些問題，從以下2個方面進行研究。1）進一步研究點云數(shù)據(jù)的獲取和處理技術，提高數(shù)據(jù)的準確性和實時性。2）探索更有效的位姿估計方法，提高機器人的定位和姿態(tài)控制精度。

參考文獻

[1]趙喜江，楊志強，張宇.煤礦豎井井筒三維激光掃描的誤差分析與控制[J].黑龍江科技大學學報，2022，32（4）：6.

[2]毛成林，于瑞強，宋愛國.基于各向異性空間投影的地鐵列車底部巡檢機器人避障研究[J].機械與電子， 2023，41（8）：76-80.

[3]李鳴昊，王輝，伍思歡，等.考慮執(zhí)行器最優(yōu)分配的空間站艙內機器人位姿耦合控制[J].宇航學報，2023，44（7）：1073-1083.

[4]韓勇，霍迎秋，費攀鋒.基于模糊PID的電力鐵塔攀爬機器人末端位姿控制研究[J].工業(yè)儀表與自動化裝置，2023（3）：80-84，87.