测绘通报 ›› 2020, Vol. 0 ›› Issue (1): 21-25.doi: 10.13474/j.cnki.11-2246.2020.0005

• 导航与位置服务 • 上一篇    下一篇

预建高精度地图的封闭区域UGV自动驾驶导航定位

王一文, 钱闯, 唐健, 温景仁, 牛小骥   

  1. 武汉大学卫星导航定位技术研究中心, 湖北 武汉 430079
  • 收稿日期:2019-08-13 修回日期:2019-09-23 发布日期:2020-02-10
  • 作者简介:王一文(1997-),男,硕士生,主要研究方向为激光雷达SLAM。E-mail:2014301610122@whu.edu.cn
  • 基金资助:
    国家重点研发计划(2016YFB0501803;2016YFB0502202);中央高校基本科研基金(2042018KF00242)

UGV's automated driving navigation and localization in closed areas with pre-established high precision planar map

WANG Yiwen, QIAN Chuang, TANG Jian, WEN Jingren, NIU Xiaoji   

  1. GNSS Research Center, Wuhan University, Wuhan 430079, China
  • Received:2019-08-13 Revised:2019-09-23 Published:2020-02-10

摘要: 针对封闭区域UGV自动驾驶应用,本文提出了一种基于平面高精度地图的导航定位方法。该方法利用三维激光扫描数据采用预定义的栅格地图概率值建立多分辨率地图,在保证定位精度的同时提高定位效率,采用极大似然估计获取载体位姿初值并将IMU数据用于计算高斯-牛顿法搜索初值。试验结果表明,基于激光扫描的二维地图构建与匹配定位方法能有效解决帧与帧匹配误差快速累积问题,可以高效地使用已有地图进行连续高精度的载体定位。

关键词: 三维激光扫描, 多分辨率栅格地图, 激光匹配定位, 高斯-牛顿搜索, 导航定位

Abstract: Aiming at the application of UGV automated driving in closed areas,a high precision planar map based navigation and localization method is proposed in this paper. This method establishes multiple resolution grid maps of pre-defined probability with the 3D laser scan, which improves the localization efficiency and insures the map accuracy at the same time. Maximum likelihood estimation is adopted to obtain the initial pose of the carrier, IMU data is used to obtain a reasonable starting value of the carrier's pose for Gauss-Newton search. Field experiment proves it a proper method which efficiently resolves the quick accumulation of scan-scan matching's localization errors that locating with LiDAR scan and the prior map, it's able to provide the carrier's continuous location of high accuracy.

Key words: 3D laser scan, multiple resolution grid map, laser scan matching localization, Gauss-Newton search, navigation and location

中图分类号: