CN107525501A - 一种gps和激光雷达联合的地图构建方法 - Google Patents

一种gps和激光雷达联合的地图构建方法 Download PDF

Info

Publication number
CN107525501A
CN107525501A CN201710409305.1A CN201710409305A CN107525501A CN 107525501 A CN107525501 A CN 107525501A CN 201710409305 A CN201710409305 A CN 201710409305A CN 107525501 A CN107525501 A CN 107525501A
Authority
CN
China
Prior art keywords
gps
map
laser radar
odometer
coordinate system
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201710409305.1A
Other languages
English (en)
Inventor
刘鹏
韩锐
王坤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Krund Artificial Intelligence Technology Co Ltd
Original Assignee
Beijing Krund Artificial Intelligence Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Krund Artificial Intelligence Technology Co Ltd filed Critical Beijing Krund Artificial Intelligence Technology Co Ltd
Priority to CN201710409305.1A priority Critical patent/CN107525501A/zh
Publication of CN107525501A publication Critical patent/CN107525501A/zh
Pending legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS

Abstract

本发明提供了一种GPS和激光雷达联合的地图构建方法，在机器人机体上安装激光雷达、里程计及GPS，将GPS和里程计获取的机器人方位坐标结合起来构建地图，然后将激光雷达的扫描数据标注在所述地图中。通过GPS和激光雷达联合的配合使用，消除在如小区，工业园等大环境下的地图出现交叉，平移，错配的问题，解决环形地图无法闭合的问题。

Description

一种GPS和激光雷达联合的地图构建方法
技术领域
本发明涉及一种机器人地图构建方法，具体涉及一种激光雷达和GPS联合的地图构建方法。
背景技术
一般来说，地图共分为三种：第一种我们称为尺度地图，每一个地点都可以用坐标来表示；第二种我们称为拓扑地图，每一个地点用一个点来表示，用边来连接相邻的点；第三种我们称为语义地图，其中每一个地点和道路都会用标签的集合来表示。
在机器人领域，尺度地图常用于定位于地图构建、定位和同时定位与地图构建，拓扑地图常用于路径规划，而语义地图常用于人机交互。
通常情况下进行地图构建的传感器是激光传感器和里程计，通过里程计来获得一个准确的机器人位置和姿态，通过激光雷达进行修正，并且通过激光雷达进行地图构建。激光雷达和里程计都有一定的误差，激光并不能完全消除里程计的误差，虽然在小区域内激光雷达和里程计的联合地图构建能够起到一定的效果，但是对于大环境(小区，工业园等)下的地图构建却并不能达到特别好的效果，误差的叠加会导致里程计定位出现偏移，最终导致地图出现交叉，平移，错配，环形地图无法闭合等问题。
发明内容
有鉴于此，本发明提供了一种GPS和激光雷达联合的地图构建方法，通过GPS和激光雷达联合的配合使用，消除在如小区，工业园等大环境下的地图出现交叉，平移，错配的问题，解决环形地图无法闭合的问题。
一种GPS和激光雷达联合的地图构建方法，在机器人机体上安装激光雷达、里程计及GPS，将GPS和里程计获取的机器人方位坐标结合起来构建地图，然后将激光雷达的扫描数据标注在所述地图中。
进一步地，具体构建步骤如下：
步骤一：将里程计的坐标系与GPS坐标系统一；
步骤二：实际运动中，将GPS坐标作为关键帧，在关键帧之间用里程计更新的机器人方位坐标值进行补充定位；
步骤三：将激光雷达的扫描数据固定到统一的高斯直角坐标系下，标注出激光雷达扫描到的二维信息。
进一步地，步骤一的具体过程为：
步骤101，将GPS经纬度转为大地坐标系；
步骤102，将大地坐标系转换为高斯直角坐标系，坐标系的x轴指向东，y轴指向北，z轴指向天；
步骤103，将里程计的初始位置和姿态初始化在采用高斯直角坐标系的坐标下，与GPS坐标系统一。
有益效果：
本发明中GPS更新频率较慢，因此将GPS坐标作为关键帧，在关键帧之间用里程计的更新的机器人方位坐标值进行补充，这样总体就能够在一个统一的坐标系下平滑的过渡，GPS和激光雷达联合的配合使用，向机器人传达了更丰富的环境信息。激光雷达建立的地图本身具有绝对信息，不存在错配的问题，所以再结合激光雷达的扫描信息，环形地图就可以进行闭合。
具体实施方式
下面结合实施例，对本发明进行详细描述。
本发明提供了一种GPS和激光雷达联合的地图构建方法，在如小区，工业园等大环境下进行地图构建时，在机器人机体上安装激光雷达、里程计及GPS，将GPS和里程计获取的机器人方位坐标结合起来构建地图，然后将激光雷达的扫描数据标注在所述地图中。
结合实施例，具体说明构建地图的方法。现要构建一个地图并在地图上标注出障碍物的信息。具体步骤如下：
步骤一：将GPS经纬度转为大地坐标系；
步骤二：将大地坐标系转换为高斯直角坐标系，坐标系的x轴指向东，y轴指向北，z轴指向天；
步骤三：将里程计的初始位置和姿态初始化在采用高斯直角坐标系的坐标下，与GPS坐标系统一；
步骤四：实际运动中，GPS更新频率较慢，将GPS坐标作为关键帧，在关键帧之间用里程计更新的机器人方位坐标值进行补充定位；
步骤五：当确定好GPS和里程计更新的机器人稳定位置和姿态后，然后将激光雷达的扫描数据固定到统一的高斯直角坐标系下，标注出当前激光雷达扫描到的每一个障碍物的二维信息，此时每一个障碍物点均具有位置信息和障碍物的信息。
由于位置具有绝对信息，因此采用激光雷达建立的地图也同样具有绝对信息，不存在错配的问题，环形地图也就可以闭合。
综上所述，以上仅为本发明的较佳实施例而已，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (3)

1.一种GPS和激光雷达联合的地图构建方法，其特征在于，在机器人机体上安装激光雷达、里程计及GPS，将GPS和里程计获取的机器人方位坐标结合起来构建地图，然后将激光雷达的扫描数据标注在所述地图中。
2.如权利要求1所述的GPS和激光雷达联合的地图构建方法，其特征在于，具体构建步骤如下：
步骤一：将里程计的坐标系与GPS坐标系统一；
步骤二：实际运动中，将GPS坐标作为关键帧，在关键帧之间用里程计更新的机器人方位坐标值进行补充定位；
步骤三：将激光雷达的扫描数据固定到统一的高斯直角坐标系下，标注出激光雷达扫描到的二维信息。
3.如权利要求2所述的GPS和激光雷达联合的地图构建方法，其特征在于，步骤一的具体过程为：
步骤101，将GPS经纬度转为大地坐标系；
步骤102，将大地坐标系转换为高斯直角坐标系，坐标系的x轴指向东，y轴指向北，z轴指向天；
步骤103，将里程计的初始位置和姿态初始化在采用高斯直角坐标系的坐标下，与GPS坐标系统一。
CN201710409305.1A 2017-06-02 2017-06-02 一种gps和激光雷达联合的地图构建方法 Pending CN107525501A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710409305.1A CN107525501A (zh) 2017-06-02 2017-06-02 一种gps和激光雷达联合的地图构建方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710409305.1A CN107525501A (zh) 2017-06-02 2017-06-02 一种gps和激光雷达联合的地图构建方法

Publications (1)

Publication Number Publication Date
CN107525501A true CN107525501A (zh) 2017-12-29

Family

ID=60748677

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710409305.1A Pending CN107525501A (zh) 2017-06-02 2017-06-02 一种gps和激光雷达联合的地图构建方法

Country Status (1)

Country Link
CN (1) CN107525501A (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108897836A (zh) * 2018-06-25 2018-11-27 广州视源电子科技股份有限公司 一种机器人基于语义进行地图构建的方法和装置
CN109144056A (zh) * 2018-08-02 2019-01-04 上海思岚科技有限公司 移动机器人的全局自定位方法及设备
CN109358340A (zh) * 2018-08-27 2019-02-19 广州大学 一种基于激光雷达的agv室内地图构建方法及系统
WO2022007791A1 (zh) * 2020-07-06 2022-01-13 苏州宝时得电动工具有限公司 自移动设备地图生成方法、系统和自动工作系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101907714A (zh) * 2010-06-25 2010-12-08 陶洋 基于多传感器数据融合的gps辅助定位系统及其定位方法
CN103649683A (zh) * 2011-06-03 2014-03-19 罗伯特·博世有限公司 组合的雷达和gps定位系统
CN104573733A (zh) * 2014-12-26 2015-04-29 上海交通大学 一种基于高清正射影像图的高精细地图生成系统及方法
CN104764457A (zh) * 2015-04-21 2015-07-08 北京理工大学 一种用于无人车的城市环境构图方法
CN108181636A (zh) * 2018-01-12 2018-06-19 中国矿业大学 石化工厂巡检机器人环境建模与地图构建装置和方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101907714A (zh) * 2010-06-25 2010-12-08 陶洋 基于多传感器数据融合的gps辅助定位系统及其定位方法
CN103649683A (zh) * 2011-06-03 2014-03-19 罗伯特·博世有限公司 组合的雷达和gps定位系统
CN104573733A (zh) * 2014-12-26 2015-04-29 上海交通大学 一种基于高清正射影像图的高精细地图生成系统及方法
CN104764457A (zh) * 2015-04-21 2015-07-08 北京理工大学 一种用于无人车的城市环境构图方法
CN108181636A (zh) * 2018-01-12 2018-06-19 中国矿业大学 石化工厂巡检机器人环境建模与地图构建装置和方法

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108897836A (zh) * 2018-06-25 2018-11-27 广州视源电子科技股份有限公司 一种机器人基于语义进行地图构建的方法和装置
CN108897836B (zh) * 2018-06-25 2021-01-29 广州视源电子科技股份有限公司 一种机器人基于语义进行地图构建的方法和装置
CN109144056A (zh) * 2018-08-02 2019-01-04 上海思岚科技有限公司 移动机器人的全局自定位方法及设备
CN109144056B (zh) * 2018-08-02 2021-07-06 上海思岚科技有限公司 移动机器人的全局自定位方法及设备
CN109358340A (zh) * 2018-08-27 2019-02-19 广州大学 一种基于激光雷达的agv室内地图构建方法及系统
WO2022007791A1 (zh) * 2020-07-06 2022-01-13 苏州宝时得电动工具有限公司 自移动设备地图生成方法、系统和自动工作系统

Similar Documents

Publication Publication Date Title
Gao et al. Review of wheeled mobile robots’ navigation problems and application prospects in agriculture
CN108680156B (zh) 一种多传感器数据融合的机器人定位方法
CN107525501A (zh) 一种gps和激光雷达联合的地图构建方法
CN103064416B (zh) 巡检机器人室内外自主导航系统
CN105045263B (zh) 一种基于Kinect深度相机的机器人自定位方法
KR100748245B1 (ko) 인공표식과 지역좌표계를 이용한 이동로봇의 환경지도 작성방법 및 이동 방법
CN105806345B (zh) 一种用于变电站巡检机器人激光导航的初始化定位方法
CN106168805A (zh) 基于云计算的机器人自主行走的方法
CN105698807A (zh) 一种适用于变电站智能巡检机器人的激光导航系统
CN107688184A (zh) 一种定位方法以及系统
CN110211228A (zh) 用于建图的数据处理方法及装置
CN106405605A (zh) 一种机器人基于ros和gps的室内外无缝定位方法和定位系统
CN108608466A (zh) 一种双目相机和激光雷达联合的机器人定位方法
CN102506867B (zh) 基于Harris角点匹配的SINS/SMANS组合导航方法及系统
EP3450918B1 (en) Alignment of multiple digital maps used in an automated vehicle
CN106292698A (zh) 植保无人机的精准作业方法和系统
CN111024059A (zh) 用于厂区内三维空间的高精度人员定位系统及方法
EP4348379A1 (en) Topology processing for waypoint-based navigation maps
CN110389369A (zh) 基于rtk-gps和移动二维激光扫描的冠层点云获取方法
CN105022399A (zh) 对于作业机构具有改进的地面跟随农机控制系统
WO2023226574A1 (zh) 一种煤矿机械手扫描观测系统
CN114608600A (zh) 一种自动驾驶系统的搭建方法及终端
CN104050869B (zh) Gis地图覆盖物布点响应方法和系统
CN109445432A (zh) 基于图像的无人机和地面移动机器人编队定位方法
CN206095257U (zh) 智能巡视机器人组合导航系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20171229