[發明專利]一種基于路燈桿的車輛位姿的修正方法和裝置

有效

• 申請號: 201910253287.1
• 申請日: 2019-03-29
• 公開（公告）號: CN111750881B
• 公開（公告）日: 2022-05-13
• 發明（設計）人: 侯政華;杜志穎;管守奎
• 申請（專利權）人: 北京魔門塔科技有限公司
• 主分類號: G01C21/34
• 分類號: G01C21/34
• 代理公司: 北京科領智誠知識產權代理事務所(普通合伙) 11782
• 代理人: 陳士騫

本發明實施例公開了一種基于路燈桿的車輛位姿的修正方法和裝置，應用于交通標志匱乏路段，該方法包括：基于導航地圖中車道當前位置對應的車道線信息，對預設定位裝置提供的車輛的高程進行修正；從導航地圖中選擇與感知圖像中相匹配的目標路燈桿；基于目標路燈桿的位置，對導航地圖中車輛的位姿進行第一修正處理；根據第一修正處理后車輛的位姿和高程，確定導航地圖和感知圖像中相匹配的路燈桿之外其他類型的指示標志；基于目標路燈桿和相匹配的其他類型的指示標志的位置，對導航地圖中的車輛位姿進行第二修正處理，通過采用上述技術方案，在交通標志匱乏的路段等應用場景下，達到了使用消費級預設定位裝置也能進行高精度定位的技術效果。

技術領域

本發明涉及自動駕駛技術領域，具體涉及一種基于路燈桿的車輛位姿的修正方法和裝置。

背景技術

在自動駕駛領域，導航定位至關重要。近年來，深度學習等技術的成果，極大促進了圖像語義分割、圖像識別領域的發展，這為導航地圖及導航定位提供了堅實的基礎。

在基于高精度地圖的定位方案中，當無人駕駛車輛第一次進入高精度地圖時，需要獲得一個全局而精準的位置信息進行初始化，繼而可以使用高精度地圖進行精準定位，即絕對位置精度可達到厘米級。但在消費級設備，例如單點GPS(Global PositioningSystem，全球定位系統)與廉價IMU(Inertial measurement unit，慣性測量單元)的定位方案中，由于單點GPS所提供的定位精度信息的誤差較大，利用單點GPS所提供的位置，將高精度地圖中的交通標志信息與利用深度學習感知模型感知出圖像中的交通標志，一般指交通指示牌，進行重投影匹配時，容易造成車道線左右匹配錯誤，路燈桿前后向匹配錯誤等問題。如果利用錯誤的匹配信息對車體位置進行修正，不僅不能利用高精地圖使車體的位置精度達到厘米級，反而可能會使車體的位置與真實位置偏離更大。特別是在導航地圖中交通標志相對匱乏的路段，交通標志的匱乏將更加影響了利用交通標志對車輛位姿的修正結果，使得后續車輛的定位出現較大偏差。

發明內容

本發明實施例公開了一種基于路燈桿的車輛位姿的修正方法和裝置，解決了使用消費級預設定位裝置定位精度不高的問題，在交通標志相對匱乏的路段等應用場景下，達到了使用消費級預設定位裝置也能進行高精度定位的技術效果。

第一方面，本發明實施例公開了一種基于路燈桿的車輛位姿的修正，該方法包括：

獲取預設定位裝置提供的車輛的當前位置，并基于導航地圖中所述當前位置對應的車道線信息，對所述預設定位裝置提供的車輛的高程進行修正；

從所述導航地圖中選擇與感知圖像中相匹配的目標路燈桿；

基于所述目標路燈桿的位置，對所述導航地圖中車輛的位姿進行第一修正處理；

根據第一修正處理后車輛的位姿和高程，確定所述導航地圖和所述感知圖像中相匹配的所述路燈桿之外其他類型的指示標志，所述其他類型的指示標志至少包括車道線；

基于所述目標路燈桿和相匹配的其他類型的指示標志的位置，對第一修正處理后的車輛位姿進行第二修正處理，使得所述導航地圖中各種類型的指示標志的位置根據所述第二修正處理后的車輛位姿，與所述感知圖像中對應類型的指示標志的位置相匹配。

可選的，基于所述目標路燈桿的位置，對所述導航地圖中車輛的位姿進行第一修正處理，包括：

基于所述目標路燈桿的位置，通過非線性優化算法對車輛的六自由度中的位置三自由度進行第一修正處理，以使所述導航地圖和所述感知圖像中的各個路燈桿基于第一修正處理后的車輛位置在預設標準化平面上的投影誤差小于第一預設距離。

可選的，基于所述目標路燈桿和相匹配的其他類型的指示標志的位置，對第一修正處理后的車輛位姿進行第二修正處理，使得所述導航地圖中各種類型的指示標志的位置根據所述第二修正處理后的車輛位姿，與所述感知圖像中對應類型的指示標志的位置相匹配，包括：