CN108638125A - 一种双目相机和差分gps联合的机器人定位方法 - Google Patents

一种双目相机和差分gps联合的机器人定位方法 Download PDF

Info

Publication number
CN108638125A
CN108638125A CN201810162886.8A CN201810162886A CN108638125A CN 108638125 A CN108638125 A CN 108638125A CN 201810162886 A CN201810162886 A CN 201810162886A CN 108638125 A CN108638125 A CN 108638125A
Authority
CN
China
Prior art keywords
binocular camera
differential gps
robot
information
personal computer
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
CN201810162886.8A
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 CN201810162886.8A priority Critical patent/CN108638125A/zh
Publication of CN108638125A publication Critical patent/CN108638125A/zh
Pending legal-status Critical Current

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02—Sensing devices
    • B25J19/04—Viewing devices
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

本发明提供了一种双目相机和差分GPS联合的机器人定位方法，环境识别传感器将采集的外部环境信息传递给工控机并绘制环境地图，通过相互之间的配合来判断机器人自身的位姿以及是否移动到目标的区域，通过传感器数据的配合使用可以对机器人进行良好的定位。本发明通过双目相机和差分GPS的配合使用，向机器人传达了更丰富的环境信息，解决了二维激光环境信息少，三维激光成本高的问题，同时也提供了更加准确的室外定位信息。

Description

一种双目相机和差分GPS联合的机器人定位方法
技术领域
本发明涉及一种机器人定位方法，具体涉及双目相机和差分GPS联合的机器人定位方法。
背景技术
随着计算能力和传感器等技术的不断增强，室外巡逻型和安防型机器人的功能也变得日益增大，与此同时，多传感器数据的混合使用也变得日益多样。此时，机器人不再局限于单一的传感器的使用，而可以通过多传感器数据的相互配合从而获得更加准备的环境以及位姿信息。多传感器数据的相互配合使用做位机器人定位的重要手段，需要比较强的计算能力，现在计算机的发展正好为此条件提供了良好的基础。
现有的机器人定位方法大多使用多个二维传感器获取环境信息，多个二维传感器配合使用的必然缺陷导致机器人定位精度不是很高，这样的机器人会出现在导航定位中的效果相对较差，且可拓展性也不足的问题；获取三维环境信息的三维激光成本又高。
发明内容
有鉴于此，本发明提供了一种双目相机和差分GPS联合的机器人定位方法，通过双目相机和差分GPS的配合使用，向机器人传达了更丰富的环境信息，解决了二维激光环境信息少，三维激光成本高的问题，同时也提供了更加准确的室外定位信息。
一种双目相机和差分GPS联合的机器人定位方法，定位步骤如下：
步骤一：标定双目相机，得到双目相机的内参和外参以纠正双目相机的畸变偏差；
步骤二：双目相机和差分GPS同时采集机器人外部的三维环境信息及位姿信息并传递给工控机，分别建立完整的离线三维特征环境信息及离线环境位姿信息；
步骤三：工控机对离线三维特征环境信息和离线环境位姿信息进行映射匹配处理，得到差分GPS和双目相机的匹配关系K1；
步骤四：将差分GPS获取的机器人实时位姿信息S1传递给工控机，工控机利用差分GPS和双目相机的匹配关系K1对机器人实时位姿信息S1进行处理，得到关键帧位姿信息S1′；
将双目相机扫描的实时三维环境信息S2传递给工控机；
步骤五：对关键帧位姿信息S1′和实时三维环境信息S2进行加权处理，得到机器人的当前定位姿态信息S。
进一步地，所述映射匹配为非线性化映射匹配或局部线性映射匹配。
进一步地，所述双目相机和差分GPS的扫描频率一致。
进一步地，所述差分GPS的天线安装直线与机器人偏航方向平行；若不平行，二者进行对应的坐标变换。
有益效果：
1、本发明中双目相机使机器人可以获取三维环境信息，差分GPS可以获取机器人的位置信息，通过双目相机和GPS数据的配合使用，向机器人传达了更丰富的环境信息，解决了二维激光环境信息少，三维激光成本高的问题，并且可以在单一传感器失效的情况下另外一个传感器也能继续完成任务，能够满足室外安防机器人定位的需要，同时也提供了更加准确的室外定位信息。
2、本发明采用多样性的算法应用与双目相机结合起来，使得其对机器人定位有一定的可扩展性。
3、本发明采用非线性映射匹配或局部线性映射，是为了保证位于同一个坐标系下，并且提高了鲁棒性。
4、本发明双目相机和差分GPS的扫描频率一致，保证采集外部环境信息的精确性。
5、本发明差分GPS的天线安装直线与机器人偏航方向平行，若不平行，二者进行对应的坐标变换，保证采集外部环境信息的精确性。
附图说明
附图图1为本发明的结构原理图。
具体实施方式
下面结合附图并举实施例，对本发明进行详细描述。
本发明提供了一种双目相机和差分GPS联合的机器人定位方法，如附图所示，环境识别传感器将采集的外部环境信息传递给工控机并绘制环境地图，通过相互之间的配合来判断机器人自身的位姿以及是否移动到目标的区域，通过传感器数据的配合使用可以对机器人进行良好的定位。
本发明的环境识别传感器包括：双目相机和差分GPS。
具体定位步骤如下：
步骤一：标定双目相机，得到双目相机的内参和外参以纠正双目相机的畸变偏差；
步骤二：将差分GPS的定位姿频率设为10hz，天线安装直线与机器人偏航方向平行，若不平行，二者进行对应的坐标变换；将双目相机的扫描的频率同样设为10hz，双目相机的广角采用70度；
编译ORBSLAM，采用建图模式对外部信息进行离线建特征点图，双目相机和差分GPS同时采集机器人外部的三维环境信息及位姿信息并传递给工控机，采用建图模式，分别建立完整的离线三维特征环境信息及离线环境位姿信息；
步骤三：工控机对离线三维特征环境信息和离线环境位姿信息进行非线性化映射匹配处理，得到差分GPS和双目相机的匹配关系K1；
此处的映射匹配方法也可以采用局部线性映射匹配，需要先将离线二维环境栅格地图、离线三维特征环境信息及离线环境位姿信息进行分块处理，然后再进行局部线性映射匹配，实现功能与非线性化映射匹配相同，保证进行映射的坐标系位于同一个坐标系下；
步骤四：将匹配关系带入双目相机中，目的是为了让双目相机和其他传感器的坐标系一致，得到最终双目相机的输出结果；
在定位模式下，将差分GPS获取的机器人实时位姿信息S1传递给工控机，工控机利用差分GPS和双目相机的匹配关系K1对机器人实时位姿信息S1进行处理，得到关键帧位姿信息S1′；
将双目相机扫描的实时三维环境信息S2传递给工控机；
步骤五：对关键帧位姿信息S1′和实时三维环境信息S2进行加权处理，得到机器人的当前定位姿态信息S。
此时得到的当前定位姿态信息S较为精确。
综上所述，以上仅为本发明的较佳实施例而已，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (4)

1.一种双目相机和差分GPS联合的机器人定位方法，其特征在于，定位步骤如下：
步骤一：标定双目相机，得到双目相机的内参和外参以纠正双目相机的畸变偏差；
步骤二：双目相机和差分GPS同时采集机器人外部的三维环境信息及位姿信息并传递给工控机，分别建立完整的离线三维特征环境信息及离线环境位姿信息；
步骤三：工控机对离线三维特征环境信息和离线环境位姿信息进行映射匹配处理，得到差分GPS和双目相机的匹配关系K1；
步骤四：将差分GPS获取的机器人实时位姿信息S1传递给工控机，工控机利用差分GPS和双目相机的匹配关系K1对机器人实时位姿信息S1进行处理，得到关键帧位姿信息S1′；
将双目相机扫描的实时三维环境信息S2传递给工控机；
步骤五：对关键帧位姿信息S1′与实时三维环境信息S2进行加权处理，得到机器人的当前定位姿态信息S。
2.如权利要求1所述的双目相机和差分GPS联合的机器人定位方法，其特征在于，所述映射匹配为非线性化映射匹配或局部线性映射匹配。
3.如权利要求1所述的双目相机和差分GPS联合的机器人定位方法，其特征在于，所述双目相机和差分GPS的扫描频率一致。
4.如权利要求1所述的双目相机和差分GPS联合的机器人定位方法，其特征在于，所述差分GPS的天线安装直线与机器人偏航方向平行；若不平行，二者进行对应的坐标变换。
CN201810162886.8A 2018-02-26 2018-02-26 一种双目相机和差分gps联合的机器人定位方法 Pending CN108638125A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810162886.8A CN108638125A (zh) 2018-02-26 2018-02-26 一种双目相机和差分gps联合的机器人定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810162886.8A CN108638125A (zh) 2018-02-26 2018-02-26 一种双目相机和差分gps联合的机器人定位方法

Publications (1)

Publication Number Publication Date
CN108638125A true CN108638125A (zh) 2018-10-12

Family

ID=63744309

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810162886.8A Pending CN108638125A (zh) 2018-02-26 2018-02-26 一种双目相机和差分gps联合的机器人定位方法

Country Status (1)

Country Link
CN (1) CN108638125A (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111007545A (zh) * 2019-11-20 2020-04-14 北京国电富通科技发展有限责任公司 定位导引装置、定位系统和方法及电子设备
CN111947666A (zh) * 2020-08-21 2020-11-17 广州高新兴机器人有限公司 一种室外激光导航位置丢失自动找回方法
CN112291701A (zh) * 2019-07-25 2021-01-29 科沃斯商用机器人有限公司 定位验证方法、装置、机器人、外部设备和存储介质

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2879300A1 (fr) * 2004-12-10 2006-06-16 Vincent Piraud Appareil binoculaire permettant de fournir automatiquement des informations relatives a un panorama
CN101537613A (zh) * 2009-01-21 2009-09-23 上海广茂达伙伴机器人有限公司 开放式移动机器人系统
CN102085664A (zh) * 2011-01-04 2011-06-08 北京林业大学 自主作业林业机器人智能控制系统
CN102944224A (zh) * 2012-11-09 2013-02-27 大连理工大学 一种无人驾驶车的自动环境感知系统及其工作方法
CN104914863A (zh) * 2015-05-13 2015-09-16 北京理工大学 一种一体式无人运动平台环境理解系统及其工作方法
CN105674993A (zh) * 2016-01-15 2016-06-15 武汉光庭科技有限公司 基于双目相机的高精度视觉定位地图生成系统及方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2879300A1 (fr) * 2004-12-10 2006-06-16 Vincent Piraud Appareil binoculaire permettant de fournir automatiquement des informations relatives a un panorama
CN101537613A (zh) * 2009-01-21 2009-09-23 上海广茂达伙伴机器人有限公司 开放式移动机器人系统
CN102085664A (zh) * 2011-01-04 2011-06-08 北京林业大学 自主作业林业机器人智能控制系统
CN102944224A (zh) * 2012-11-09 2013-02-27 大连理工大学 一种无人驾驶车的自动环境感知系统及其工作方法
CN104914863A (zh) * 2015-05-13 2015-09-16 北京理工大学 一种一体式无人运动平台环境理解系统及其工作方法
CN105674993A (zh) * 2016-01-15 2016-06-15 武汉光庭科技有限公司 基于双目相机的高精度视觉定位地图生成系统及方法

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112291701A (zh) * 2019-07-25 2021-01-29 科沃斯商用机器人有限公司 定位验证方法、装置、机器人、外部设备和存储介质
CN112291701B (zh) * 2019-07-25 2023-02-17 科沃斯商用机器人有限公司 定位验证方法、装置、机器人、外部设备和存储介质
CN111007545A (zh) * 2019-11-20 2020-04-14 北京国电富通科技发展有限责任公司 定位导引装置、定位系统和方法及电子设备
CN111947666A (zh) * 2020-08-21 2020-11-17 广州高新兴机器人有限公司 一种室外激光导航位置丢失自动找回方法

Similar Documents

Publication Publication Date Title
CN108680156A (zh) 一种多传感器数据融合的机器人定位方法
CN108608466A (zh) 一种双目相机和激光雷达联合的机器人定位方法
CN108571971B (zh) 一种agv视觉定位系统及方法
US9020301B2 (en) Method and system for three dimensional mapping of an environment
CN108594245A (zh) 一种目标物运动监测系统及方法
CN102589530B (zh) 基于二维相机和三维相机融合的非合作目标位姿测量方法
CN108638125A (zh) 一种双目相机和差分gps联合的机器人定位方法
CN107063229A (zh) 基于人工路标的移动机器人定位系统及方法
CN110308729A (zh) 基于视觉与imu或里程计的agv组合导航定位方法
CN106504287B (zh) 基于模板的单目视觉目标空间定位系统
US11847741B2 (en) System and method of scanning an environment and generating two dimensional images of the environment
CN106323286B (zh) 一种机器人坐标系与三维测量坐标系的变换方法
Mi et al. A vision-based displacement measurement system for foundation pit
CN106651957B (zh) 基于模板的单目视觉目标空间定位方法
CN208350997U (zh) 一种目标物运动监测系统
Bok et al. Extrinsic calibration of a camera and a 2D laser without overlap
Müller et al. LACI: Low-effort automatic calibration of infrastructure sensors
CN104318610B (zh) 大空间三维实体放线方法
Lin et al. A robust epipolar rectification method of stereo pairs
Lee Use of infrared light reflecting landmarks for localization
CN108731679A (zh) 移动机器人环境特征定位方法
JP2016057079A (ja) モデル化データ算出方法及びモデル化データ算出装置
Adámek et al. Analytical Models for Pose Estimate Variance of Planar Fiducial Markers for Mobile Robot Localisation
Xue et al. Visual-marker based localization for flat-variation scene
Li et al. A single-shot pose estimation approach for a 2D laser rangefinder

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: 20181012