無人駕駛車GPS自主導航與障礙規避系統設計與實現

方海洋，趙瑞妮，涂市委

?

無人駕駛車GPS自主導航與障礙規避系統設計與實現

方海洋，趙瑞妮，涂市委

（長安大學汽車學院，陜西 西安 710064）

提出一種基于Trimble BD982定位傳感器和ZED雙目視覺傳感器的無人車GPS自主導航與障礙規避系統設計與實現方案。利用RTK-GPS系統進行高精度定位，當ZED雙目相機檢測前方出現出現正負障礙物時，借助于ZED建立的三維障礙物模型對原來GPS采集的路網文件中的一部分路段進行點位整體偏移建立局部GPS路網，最終將局部GPS路網與整體GPS路網融合實現無人駕駛車GPS自主導航。

BD982；雙目視覺傳感器；RTK-GPS；路網融合

1 概述

本文所研究的無人駕駛車是基于高精度GPS定位系統實現自主導航，配合ZED雙目相機進行避障。由人工操作無人駕駛車提前進行GPS點位的采集，利用NURBS曲線插值法構建車輛運行的二維軌跡路徑。車輛的自主駕駛運行過程中采用NURBS曲線算法中尋找最近點的方法，實時尋找車輛運行的目標點，結合車輛的航向角計算出車輛所需的舵量以及適宜速度，利用中值濾波方法處理數據后，實時控制車輛線控系統，從而讓無人駕駛車沿著該軌跡運行。在行進的過程中當ZED雙目相機檢測到前方出現障礙物或坑洼時，制作局部GPS路網，并且根據車輛航向角和路網信息進行局部GPS路網和整體路網的融合。

2 高精度GPS地圖

2.1 GPS點位采集

本文采取載波相位差技術獲得無人車的準確位置，將BD982采集的WGS-84坐標通過高斯投影轉換為平面坐標。

圖1 系統整體工作流程圖

圖2 高斯坐標投影原理圖

高斯投影后轉換的平面坐標系是以是以子午線與赤道的交點為原點，x軸為中央子午線的投影，y軸為赤道的投影，大地坐標點（B,L）經高斯投影轉換后的平面坐標(x,y)如下：

式中D是指赤道至緯度B的子午線弧長，N為卯酉圈曲率半徑，為橢球的長軸半徑。

圖3 坐標系轉換

通過高斯投影變換后的坐標系x軸指向正北方，y軸指向正東方，不符合操作習慣，所以將坐標系進行矩陣變換如下：

2.2 路網制作

在本文中我們利用NURBS曲線插值法將離散的點位數據處理成平滑的曲線：

式中E()是m階B樣條基函數，q是權重因子，p是控制點。基函數E()通常由遞推公式定義如下：

2.3 無人駕駛GPS導航算法

根據實際道路情況在軟件中提前設定打舵參考行n，相當于選取距離車輛一定距離的GPS點位作為車輛打舵的目標點。

圖4 GPS導航示意圖

車輛前后自身安裝了2個GPS天線，根據這兩個天線位置計算出車輛與參考行GPS點位的連線與地球正北的夾角為：

由和車輛的航向角可以求得打舵角度為：

式中n為倍率系數。

對打舵角度進行中值濾波處理：

計算機將打舵角度δ發送給下位機，計算出車輛打舵的信號電壓二次多項式為：

無人駕駛車速度的控制采用設定一個和，反復試驗確定車速和打舵角度△θ之間的關系如下：

3 避障控制策略

3.1 障礙物建模

為了配合GPS導航，需要將障礙物的相機坐標系轉化為世界坐標系。

式中Xw代表世界坐標系，代cmn表旋轉矩陣，Xc代表相機坐標系，Dx代表平移矩陣。相機坐標系向世界坐標系的轉換過程可視為坐標系先繞Z軸旋轉，然后繞Y軸旋轉，最后繞X軸旋轉的過程，但最終還需要做出適當平移達到相互統一。

繞Z軸、Y軸、X軸旋轉即等同于將原來的坐標矩陣經過三次矩陣旋轉變換，三個旋轉矩陣按照順序如下：

無人車主要行駛在平坦道路，所以可認為車輛的俯仰角和側傾角為0，即=90°，=90°。此時車輛的航向角為，當＜90°，=90°-，即旋轉矩陣為=321。

3.2 局部GPS路網重建

當ZED雙目相機探測到前方出現障礙物時，本文采用兩步判斷法進行路網重建。首先基于可通過性判斷，當障礙物的一側仍然存在其他障礙物或坑洼，排除從該側避障的可能性；其次從左右側避障的路徑長度來判斷，分別計算車輛與左右角點的距離為d，d為：

當d-d≥3時選擇從右側避障；當d-d＞3時選擇從左側避障。

本論文按照障礙物橫向輪廓線方向平移，將靠近車輛一側的離散點位用最小二乘法回歸：

假設車輛從右側避障，由二次回歸直線的斜率可以求得直線與大地坐標系X軸正向的角度為：

計算GPS路網與障礙物第一個交點為(4,4)，根據該交點與右側角點(R,R)的距離計算向右偏移距離4。

偏移后點的坐標1為：

當車輛行駛至右側1點時，如果車輛的航向偏向右方，由于ZED雙目相機水平視場角有限，所以可能捕捉不到障礙物，因此必須預先按照障礙物右側邊緣與前側邊緣垂直的假設情形來偏移一段距離的GPS點位。系統遍歷E點之后50個GPS點位信息，并向右按照與當前航向垂直方向尋找障礙物右邊緣點坐標，計算每個GPS點位所需要偏移的距離d為：

當車輛通過1在障礙物右側的行進過程中,當雙目相機拍攝到障礙物的圖像時，按照上文提到的方法對障礙物建模，利用坐標系轉換求出該段所有GPS點位的平移距離，然后計算出更新后的GPS點位。如果障礙物在路徑方向的距離很長，ZED相機無法捕捉全景，所以要對障礙物的模型進行更新。考慮到車速和計算機性能，我們將障礙物模型個更新頻率設置為1HZ。采用算術平均值濾波方法對大量離散的GPS坐標數據進行濾波處理，具體做法是：選取若干個樣本框，對各個樣本框里點位的橫縱坐標進行平均后得到一個新的坐標。單個樣本框的確定取決于點位的數量，當GPS點位達到預設數量時就形成了一個樣本框。樣本框自身的個數由雙目相機前方的盲區區域大小確定，因為無法對盲區建模，所以不會有新的離散數據干擾濾波。在車輛前進時，盲區不斷向前擴展，系統根據新增的GPS點位生成樣本框，然后對樣本框的數據進行算術平均值濾波處理。

在車輛前進的過程中，當雙目相機檢測到前方沒有障礙物時，可能障礙物右側邊緣線向左側偏移，還有可能車輛已經通過障礙物區域。首先我們需要確定車輛是否通過障礙物，具體做法是：選取一個適宜的△，將此時車輛航向角由調整為△，使車輛向左側行駛，可以增大雙目相機左側的視場。將原來的坐標系順時針旋轉，相當于GPS點位逆時針旋轉，車輛航向向左側偏移。

當車輛向左側偏移后，雙目相機檢測到障礙物邊緣后，按照上述方法繼續建模，GPS偏移。如果車輛向左偏移后仍無法檢測到障礙物，此時系統認為車輛已經通過障礙物區域。

3.3 局部GPS路網和全局GPS路網的融合

首先根據偏移距離d確定車輛在距離E點d時就開始離開全局GPS路網（d正相關于d）。根據距離d遍歷E點之前的點位，尋找離開點F，統計F點和E點之間的GPS點位個數為n，假設第一個點位的偏移量為0.05m，按照等比數列設計其他點位的偏移量，等比數列的比例系數q為：

根據該比例系數計算每一個點位的偏移距離d,計算所有點位的偏移距離d=0.05(m-1)，然后再次使用NURBS曲線插值法構造該段路網曲線，通過障礙物之后的局部GPS路網偏移方法與此相同。

[1] 李陸浩,面向無人駕駛汽車的車道級導航研究[D].吉林大學.2014.

[2] 夏天,智能車速度規劃及路徑跟蹤控制方法研究[D].北京工業大學.2017.

[3] 王晨,無人駕駛智能車控制與規劃系統的設計與實現[D].上海交通大學.2009.

Design and implementation of GPS and Binocular camera for driverless car

Fang Haiyang, Zhao Ruini, Tu Shiwei

( Automobile College of Chang’an University, Shaanxi Xi’an 710064 )

This paper presents a design and implementation of driverless car based on Trimble BD982 positioning sensor and ZED binocular vision sensor. The difference with RTK-GPS system base station for high precision positioning. When obstacles or eliminate appears in front of the road is detected by ZED binocular camera, With the help of the 3D obstacle model established by ZED, the local GPS road network has been established by the point bit overall migration of some sections of the road network files which were collected by the GPS originally. Finally we integrate the local GPS road network with the overall GPS network to realize the GPS autonomous navigation of the driverless car.

BD982; binocular vision sensor; RTK-GPS; road network fusion

B

1671-7988(2018)24-30-04

U462

B

1671-7988(2018)24-30-04

U462

方海洋，長安大學汽車學院碩士研究生，研究方向：無人駕駛汽車，線控地盤改造，高精度GPS導航。

10.16638/j.cnki.1671-7988.2018.24.009