劉春明 王全宇 歐陽樂 黃旭東

隨著人工智能技術(shù)的發(fā)展和應(yīng)用，自動化集裝箱碼頭（以下簡稱“自動化碼頭”）建設(shè)蓬勃興起。青島港自動化碼頭和上海港洋山深水港區(qū)自動化碼頭相繼投產(chǎn)運營，在港口行業(yè)內(nèi)產(chǎn)生良好的示范效應(yīng)，很多碼頭對半自動化或全自動化方案表示出濃厚興趣。作為自動化碼頭重要的水平運輸設(shè)備，基于磁釘定位系統(tǒng)的自動導(dǎo)引車雖然已成功應(yīng)用于自動化碼頭生產(chǎn)作業(yè)，但也存在一定局限性：首先，磁釘定位系統(tǒng)的初期投資成本和后期維護成本較高，很多新建碼頭受制于資金壓力而無法應(yīng)用該系統(tǒng);其次，磁釘定位系統(tǒng)的施工過程復(fù)雜，大部分老舊碼頭因場地布局、基礎(chǔ)設(shè)施和作業(yè)模式等難以改變而無法應(yīng)用該系統(tǒng)。為此，本文提出基于激光雷達和環(huán)境特征的水平運輸車輛定位系統(tǒng)（以下簡稱“激光雷達定位系統(tǒng)”），從而以較低的投資和維護成本、較小的施工難度、較高的精度滿足自動化碼頭對水平運輸車輛定位和導(dǎo)航的要求。

1 激光雷達定位系統(tǒng)基本原理

自動化碼頭水平運輸車輛的自動駕駛系統(tǒng)通過人工智能算法規(guī)劃車道和路徑，并向制動、轉(zhuǎn)向、加速等控制器下達指令，從而控制車輛開往目的地，實現(xiàn)車輛自動駕駛。在此過程中，高精度地圖的精確定位、輔助環(huán)境感知、路徑規(guī)劃和決策等功能[1]發(fā)揮著重要作用，其中：精確定位功能是實現(xiàn)路徑規(guī)劃和決策功能的前提，其通過對比車輛傳感器感知的環(huán)境信息與高精度地圖標(biāo)注的環(huán)境信息，得到車輛在地圖上的精確位置;輔助環(huán)境感知功能通過在高精度地圖上標(biāo)注詳細(xì)的道路信息，輔助汽車在環(huán)境感知的過程中驗證相關(guān)信息;路徑規(guī)劃和決策功能則利用云平臺采集傳感器感知區(qū)域以外的路況信息，控制車輛提前避讓。

激光雷達是通過發(fā)射激光束探測目標(biāo)位置和速度等特征量的雷達探測裝置，其工作原理如下：激光雷達向目標(biāo)發(fā)射探測信號（激光束），并通過比較目標(biāo)反射回來的信號與發(fā)射信號，獲得目標(biāo)距離、方位、高度、速度、姿態(tài)、形狀等參數(shù)。激光雷達具有測距精度和分辨率較高、體積較小、質(zhì)量較輕、隱蔽性較好、抗有源干擾能力較強等優(yōu)點。

本文結(jié)合高精度地圖的功能和激光雷達的優(yōu)點，提出激光雷達定位系統(tǒng)，其基本原理如下：首先，在道路上布置一定數(shù)量的標(biāo)志物，并建立這些標(biāo)志物的點云地圖;然后，利用激光雷達點云數(shù)據(jù)和聚類算法識別標(biāo)志物，并將識別出的標(biāo)志物點云數(shù)據(jù)與點云地圖進行匹配;最后，將車輛碼盤的里程計和慣性測量單元、激光雷達里程計、標(biāo)志物點云匹配結(jié)果進行融合，輸出車輛位置信息。

2 激光雷達定位系統(tǒng)構(gòu)成

如圖1所示，激光雷達定位系統(tǒng)主要由車載多線激光雷達、車載控制器和環(huán)境特征組成。

（1）車載多線激光雷達 車載多線激光雷達每秒發(fā)射上萬個激光點，并接收其反射光，然后采用飛行時間測距法計算多線激光雷達與探測點之間的距離，并獲得激光反射強度信息。

（2）車載控制器 車載控制器利用多線激光雷達收集的目標(biāo)表面大量密集點的三維坐標(biāo)、反射率和紋理等信息，得到被測目標(biāo)的三維模型以及線、面、體等數(shù)據(jù)，據(jù)此構(gòu)建三維點云地圖并繪制環(huán)境地圖。在車輛行駛過程中，車載控制器對激光雷達獲取的實時掃描數(shù)據(jù)與預(yù)存的高精度地圖進行連續(xù)匹配，從而達到環(huán)境感知和車輛定位的目的。由于光速極快，激光飛行時間極短，測量設(shè)備必須具備非常高的精度。從效果上來看，激光雷達的維度（線束）越多，測量精度就越高，安全性也就越高。

（3）環(huán)境特征 環(huán)境特征的設(shè)計選用反光柱。反光柱的特殊材質(zhì)具有高反光率，使激光雷達能夠在環(huán)境中迅速獲取激光反射強度信息，從而實現(xiàn)精準(zhǔn)定位。激光反射強度的可控性使其即使在雨、霧、雪等惡劣天氣下也有很強的魯棒性，定位精度達到。反光柱立桿可以利用碼頭燈桿為載體，其布置效果見圖2。

3 激光雷達定位系統(tǒng)定位方法

3.1 定位方法架構(gòu)

激光雷達定位系統(tǒng)定位方法架構(gòu)如圖3所示：首先，在車輛行駛的道路兩旁布置一定數(shù)量的反光柱立桿作為標(biāo)志物，并建立標(biāo)志物點云地圖;然后，利用激光雷達點云數(shù)據(jù)和聚類算法識別標(biāo)志物，并將識別出的標(biāo)志物點云數(shù)據(jù)與點云地圖進行匹配;最后，將車輛碼盤的里程計和慣性測量單元、激光雷達里程計、標(biāo)志物點云匹配結(jié)果進行融合，輸出車輛位置信息。

3.2 激光雷達里程計的實現(xiàn)

從長期來看，環(huán)境處于動態(tài)變化的過程中;但在很短的時間（如100 ms）內(nèi)，環(huán)境是固定不變的?；诃h(huán)境的這一特點，可采用迭代最近點（iterative closest point，ICP）算法匹配激光雷達前后幀數(shù)據(jù)，計算水平運輸車輛在短時間內(nèi)的位移和旋轉(zhuǎn)情況，從而實現(xiàn)激光雷達里程計的定位功能。

ICP算法的基本原理是：按照一定的約束條件，分別在待匹配的目標(biāo)點云P和源點云Q中，找到最鄰近點（pi，qi），然后計算最優(yōu)匹配參數(shù)R和t，使得誤差函數(shù)E（R，t）最小。[2]誤差函數(shù)

式中：n為最鄰近點對的數(shù)量;pi為目標(biāo)點云P中的一點;qi為源點云Q中與pi對應(yīng)的最近點;R為旋轉(zhuǎn)矩陣;t為平移向量。ICP算法的計算步驟如下。

（1）在目標(biāo)點云P中取點集pi∈P。

（2）找出源點云Q中的對應(yīng)點集qi，qi∈Q，使得最小。

（3）計算旋轉(zhuǎn)矩陣R和平移向量t，使得誤差函數(shù)E（R，t）最小。

（4）用上一步求得的旋轉(zhuǎn)矩陣R和平移向量t對pi進行旋轉(zhuǎn)和平移變換，得到新的對應(yīng)點集=Rpi + t，pi∈P。

（5）計算與對應(yīng)點集qi的平均距離d，即

（6）如果d小于某一給定的閾值或大于預(yù)設(shè)的最大迭代次數(shù)，則停止迭代計算;否則，返回第二步，直到滿足收斂條件為止。

（7）采用ICP算法不斷匹配激光雷達前后幀數(shù)據(jù)，并累計平移和旋轉(zhuǎn)數(shù)據(jù)，最后輸出激光雷達里程計的定位結(jié)果。

3.3 立桿點云匹配

首先，采用全站型電子測距儀測量立桿位置，獲取立桿在全局坐標(biāo)系下的坐標(biāo)，并形成全局坐標(biāo)系下的立桿點云格式地圖（見圖4）;然后，通過篩選強度信息（只有反光柱區(qū)域才能產(chǎn)生密集反光點）并采用點云聚類和識別算法識別立桿（見圖5）;最后，采用ICP算法完成立桿點云匹配，從而獲得車輛定位結(jié)果。

3.4 定位結(jié)果融合

激光雷達定位結(jié)果的融合方法是：通過對車輛碼盤的里程計和慣性測量單元進行預(yù)積分得到里程計數(shù)據(jù)，再利用擴展卡爾曼濾波（extended Kalman filter，EKF）算法融合激光雷達里程計、立桿點云匹配定位、車輛里程計，最終得到激光雷達定位結(jié)果。EKF是標(biāo)準(zhǔn)卡爾曼濾波在非線性情形下的擴展形式。作為一種高效率的遞歸濾波器（自回歸濾波器），EKF的基本思想是利用泰勒級數(shù)展開算法將非線性系統(tǒng)線性化，然后采用卡爾曼濾波框架對信號進行濾波處理;因此，EKF是一種次優(yōu)濾波，也是目前智能駕駛框架中常見的數(shù)據(jù)融合算法。

4 激光雷達定位系統(tǒng)測試

（1）靜態(tài)測試 在靜態(tài)測試中，水平運輸車輛停在相應(yīng)的坐標(biāo)點處，記錄車輛靜止?fàn)顟B(tài)下激光雷達定位系統(tǒng)和磁釘定位系統(tǒng)的定位結(jié)果。經(jīng)比較，在車輛靜止?fàn)顟B(tài)下，激光雷達定位系統(tǒng)與磁釘定位系統(tǒng)的定位誤差不超過10 cm。

（2）動態(tài)測試 動態(tài)測試分為直行測試和轉(zhuǎn)彎測試：在直行測試中，水平運輸車輛分別以2 m/s和的速度在直行車道上行駛，記錄車輛行駛過程中激光雷達定位系統(tǒng)和磁釘定位系統(tǒng)的定位結(jié)果;在轉(zhuǎn)彎測試中，水平運輸車輛在直行車道上沿直角轉(zhuǎn)入與當(dāng)前車道垂直的另一條直行車道，記錄車輛行駛過程中激光雷達定位系統(tǒng)和磁釘定位系統(tǒng)的定位結(jié)果。經(jīng)比較，在車輛行駛過程中，激光雷達定位系統(tǒng)與磁釘定位系統(tǒng)的定位誤差不超過25 cm。

5 結(jié)束語

測試結(jié)果顯示：激光雷達定位系統(tǒng)與磁釘定位系統(tǒng)的靜態(tài)定位誤差不超過10 cm，動態(tài)定位誤差不超過25 cm，基本能夠滿足自動化碼頭對水平運輸車輛定位精度的要求。除了定位精度滿足要求外，激光雷達定位系統(tǒng)還具有投資和維護成本較低、施工難度較小、適用范圍較廣等優(yōu)點，可作為磁釘定位系統(tǒng)的替代方案應(yīng)用于新建碼頭和老舊碼頭。

參考文獻：

[1] 宮慧琪，牛芳. 自動駕駛關(guān)鍵技術(shù)與產(chǎn)業(yè)發(fā)展態(tài)勢研究[J]. 信息通信技術(shù)與政策，2018（8）：45-50.

[2] 孫宇，項志宇，劉濟林. 未知室外環(huán)境下移動機器人的三維場景重建[J]. 浙江大學(xué)學(xué)報（工學(xué)版），2007，41（12）：1949-1954.

（編輯：張敏 收稿日期：2020-03-09）