CN117250623A - 激光雷达与互补定位融合的定位方法、系统及移动机器人 - Google Patents
激光雷达与互补定位融合的定位方法、系统及移动机器人 Download PDFInfo
- Publication number
- CN117250623A CN117250623A CN202311541709.8A CN202311541709A CN117250623A CN 117250623 A CN117250623 A CN 117250623A CN 202311541709 A CN202311541709 A CN 202311541709A CN 117250623 A CN117250623 A CN 117250623A
- Authority
- CN
- China
- Prior art keywords
- positioning
- complementary
- laser radar
- rtk
- complementary positioning
- 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.)
- Granted
Links
- 230000000295 complement effect Effects 0.000 title claims abstract description 144
- 238000000034 method Methods 0.000 title claims abstract description 46
- 230000004927 fusion Effects 0.000 title claims abstract description 23
- 238000010276 construction Methods 0.000 claims abstract description 17
- 238000013507 mapping Methods 0.000 claims description 16
- 238000001514 detection method Methods 0.000 claims description 12
- 230000009466 transformation Effects 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 238000010586 diagram Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 230000009191 jumping Effects 0.000 abstract description 4
- 238000004891 communication Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 230000009977 dual effect Effects 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 238000013519 translation Methods 0.000 description 2
- 241001417527 Pempheridae Species 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000012876 topography Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/485—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an optical system or imaging system
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/10—Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation
Abstract
本发明涉及一种激光雷达与互补定位融合的定位方法、系统及移动机器人，属于定位标定技术领域；利用RTK可以在室外卫星信号良好的情况下获取稳定可靠的定位信息，但在高楼林立及树木茂密的环境经常会无法提供持续稳定的定位信息，将其作为互补定位。激光雷达建图定位的方式同样可以提供稳定的定位信息，但是可能存在相似环境定位跳动等问题，在互补定位信号良好，优先使用互补定位信息，并使用互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标；在互补定位信号不好时，使用激光雷达定位的上次有效定位坐标来实现重定位，将激光雷达定位和RTK定位进行融合，实现简单可靠的定位。
Description
技术领域
本发明涉及一种激光雷达与互补定位融合的定位方法、系统及移动机器人，属于定位标定技术领域。
背景技术
单一的激光雷达建图定位，是通过激光雷达提前扫描作业区域地形，构建SLAM模型（扫描出作业区域的三维点云模型）。移动机器人自主作业工程中，通过车载激光雷达实时扫描周围环境，将车辆周围环静的实时三维点云模型与之前提前扫描好的模型进行特征匹配，从而确认移动机器人在作业区域中的所在位置。此方法的缺点在于，如果自主作业区域内环境重复率大，有布局与摆设非常接近的几块区域（例如完全相同的几栋楼，摆放非常整齐的厂区），这样的作业环境容易匹配到类似特征，造成定位错误。
例如，中国专利公开号CN112180396A，公开了一种激光雷达定位及地图创建方法，应用于无人机动平台，基于里程计和激光雷达匹配的联合优化定位，获取全路径后验状态，剔除错误激光雷达匹配信息后进行再估计，从而适应颠簸的环境。通过这样的技术方案，在对于无人机动平台无需额外添置设备的前提下在经过颠簸环境时能快速准确的完成定位，避免了由于颠簸导致的误差。
但是，依然存在如果自主作业区域内环境重复率大，有布局与摆设非常接近的几块区域，这样的作业环境容易匹配到类似特征，造成定位错误的问题。
因此，需要研究一种激光雷达与互补定位融合的定位方法、系统及移动机器人，实时更新分配策略，对电网台区用电负荷进行分配。
发明内容
本发明要解决的技术问题是：提供一种激光雷达与互补定位融合的定位方法、系统及移动机器人，实现简单可靠的定位。
本发明所述的一种激光雷达与互补定位融合的定位方法，包括：
步骤S1、启动激光雷达及互补定位算法；
步骤S2、互补定位检测：在互补定位信号良好时，使用互补定位信息；在互补定位信号无法提供厘米级定位数据时，则执行步骤S3；
步骤S3、使用激光雷达定位信息：在互补定位信号不好时，使用激光雷达定位信息，根据偏差角将其转到互补定位坐标系下，提供厘米级定位数据。
在室外互补定位信号良好的情况下获取稳定可靠的定位信息，但在高楼林立及树木茂密的环境经常会无法提供持续稳定的定位信息。此时，采用激光雷达定位的方式同样可以提供稳定的定位信息。两者融合，以实现简单可靠且轻量化的厘米级定位。
优选的，所述步骤S2中使用互补定位信息，是通过互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标。
通过互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标，使激光雷达与互补定位融合。
优选的，所述步骤S3具体包括如下步骤：
步骤S301、激光雷达定位检测：通过检测前后两侧激光雷达定位是否有跳动，来判断激光雷达定位是否有效，并时刻保存有效激光雷达定位；当定位失效时，执行步骤S302；
步骤S302、激光雷达重定位：在激光雷达定位发生跳动时，如果互补定位信号良好，优先使用互补定位信息，并使用互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标；在互补定位信号不好时，使用激光雷达定位的上次有效定位坐标来实现重新定位。
激光雷达建图定位的方式可以提供稳定的定位信息，但是可能存在相似环境定位跳动等问题。在激光雷达定位发生跳动时，如果互补定位信号良好，优先使用互补定位信息，并使用互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标；在互补定位信号不好时，使用激光雷达定位的上次有效定位坐标来实现重定位，以实现简单可靠的定位。
优选的，所述互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标，计算方法如下：
P’= R*P
其中， P为互补定位信息，θ为互补定位与建图坐标系方向偏差角；P’为互补定位对应在地图中的坐标，R为互补定位与建图坐标系方向偏差矩阵。
优选的，所述激光雷达定位算法采用正态分布变换算法获取位姿变换。
正态分布变换（NDT）算法是一个匹配算法，可以较好的获取前后两个目标之间的姿态变动关系以及匹配度等信息，故常用于匹配定位，地图构建等，而NDT最经典的应用就是激光点云的匹配，获取位姿变换，也就是旋转平移变化参数[R,t]。
优选的，所述互补定位算法采用与激光雷达定位相互补的技术，例如RTK定位技术，当然互补定位算法也可以采用其他与激光雷达定位相互补的技术，在此不做限定。
优选的，所述地图的建图方法包括：
步骤A1、启动建图系统：启动RTK设备及激光雷达SLAM建图算法，记录启动点RTK坐标 (Xrp,Yrp)及SLAM坐标(Xsp,Yxp)；
步骤A2、建图：操控建图设备，在需要导航的环境中行走，完成导航环境的扫描建图；
步骤A3、存储RTK及SLAM坐标：在建图过程中，自动按时间检测及距离存储RTK及SLAM坐标；
步骤A4、计算RTK与SLAM坐标系方向偏差角；
步骤A5、建图完成，保存地图。
采用RTK及激光雷达实现更加稳定可靠且轻量化的厘米级定位算法，通过以上步骤实现建图及标定。
优选的，所述RTK与SLAM坐标系方向偏差角的计算过程如下：
从步骤A3中存储的任意RTK点(Xrn,Yrn)及SLAM坐标(Xsn,Yxn)，计算各自在以(Xrp,Yrp)及(Xsp,Yxp)为原点坐标系下与X轴的夹角θr、θs，则RTK与SLAM坐标系方向偏差角为θ=θr-θs。
通过RTK与SLAM坐标点，计算坐标系方向偏差角，将激光雷达与互补定位进行融合。
本发明所述的一种用于上述的激光雷达与互补定位融合的定位方法的系统，包括：
启动模块：用于启动激光雷达及互补定位算法；
互补定位检测模块：用于在互补定位信号良好时，优选使用互补定位信息；在互补定位信号无法提供厘米级定位数据时，开启激光雷达定位模块；
激光雷达定位模块：用于在互补定位信号不好时，使用激光雷达定位信息，根据偏差角将其转到互补定位坐标系下，提供厘米级定位数据；
建图模块：用于地图的建图。
本发明所述的应用上述的激光雷达与互补定位融合的定位方法的移动机器人，包括：
RTK定位导航一体机：包含主机和定位、定向两只天线，分别起定位与定向作用，可提供厘米级定位以及定向信息。主机内置嵌入式处理器，根据云端服务器发送过来的下一目标点计算机器人运动方向以及速度，将方向与速度信号通过串口发送至执行模块；
执行模块：接收RTK定位导航一体机发送的运动方向与云顶速度信息，解析信息，将信息转换为移动机器人电机转速与转向的控制信号，输出电机转动指令；
定位基站：与RTK定位导航一体机组成差分网络，提供厘米级高精度定位；
超声波传感器：接入RTK定位导航一体机ADC检测接口，若前方无障碍物，则输出低电平，若检测到障碍物，则输出高电平；
云端服务器：用于转发数据、存储数据，接收操作端发来的作业指令，并将移动机器人位置方向、运动状态、电量、等信息发送给app；
操作端：用于对移动机器人进行操作，绘制自主作业区域与作业路线，给云端服务器发送作业指令。
与现有技术相比，本发明具有以下有益效果：
本发明所述的一种激光雷达与互补定位融合的定位方法、系统及移动机器人，利用RTK可以在室外卫星信号良好的情况下获取稳定可靠的定位信息，但在高楼林立及树木茂密的环境经常会无法提供持续稳定的定位信息，将其作为互补定位。激光雷达建图定位的方式同样可以提供稳定的定位信息，但是可能存在相似环境定位跳动等问题，在互补定位信号良好，优先使用互补定位信息，并使用互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标；在互补定位信号不好时，使用激光雷达定位的上次有效定位坐标来实现重定位，以实现简单可靠的定位。利用激光雷达定位和RTK定位的优势，将激光雷达定位和RTK定位进行融合，实现简单可靠的定位。
附图说明
图1是本发明所述一种激光雷达与互补定位融合的定位方法的流程图；
图2是本发明所述地图的建图方法的流程图。
具体实施方式
为了更清楚地说明本发明实施例或技术方案，下面将对实施例或技术方案描述作简单地介绍，显而易见地，下面描述仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些实施例获得其他的实施例。
实施例1
如图1-图2所述，本实施例公开了一种激光雷达与互补定位融合的定位方法，包括：
步骤S1、启动激光雷达及互补定位算法；
步骤S2、互补定位检测：在互补定位信号良好时，优选使用互补定位信息；在互补定位信号无法提供厘米级定位数据时，则执行步骤S3；
步骤S3、使用激光雷达定位信息：在互补定位信号不好时，使用激光雷达定位信息，根据偏差角将其转到互补定位坐标系下，提供厘米级定位数据。
在室外互补定位信号良好的情况下获取稳定可靠的定位信息，但在高楼林立及树木茂密的环境经常会无法提供持续稳定的定位信息。此时，采用激光雷达定位的方式同样可以提供稳定的定位信息。两者融合，以实现简单可靠且轻量化的厘米级定位。
具体的，所述激光雷达定位算法采用正态分布变换算法获取位姿变换。
正态分布变换（NDT）算法是一个匹配算法，可以较好的获取前后两个目标之间的姿态变动关系以及匹配度等信息，故常用于匹配定位，地图构建等，而NDT最经典的应用就是激光点云的匹配，获取位姿变换，也就是旋转平移变化参数[R,t]。
所述互补定位算法采用RTK定位技术，RTK定位原理是运用卫星定位以及定位基站卫星数据，通过差分计算，得到厘米级的卫星定位、定向信息。此方法在云层厚且上方有建筑或树遮挡的情况下容易出现遮挡卫星信号，定位差的情况。
在此，网络RTK由基准站、数据处理中心和数据通信链组成。基准站上应配备双频双码GPS接收机，它能供应精确的伪距观测值，基准站的大地坐标应精确已知，站上应配备数据通信设备和气象仪器。基准站将观测值通过数据通信链与数据处理中心、流动用户进行实时的数据交换，修正误差以获得精确的定位结果。
所述步骤S3具体包括如下步骤：
步骤S301、激光雷达定位检测：通过检测前后两侧激光雷达定位是否有跳动，来判断激光雷达定位是否有效，并时刻保存有效激光雷达定位；当定位失效时，执行步骤S302；
步骤S302、激光雷达重定位：在激光雷达定位发生跳动时，如果互补定位信号良好，优先使用互补定位信息，并使用互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标；在互补定位信号不好时，使用激光雷达定位的上次有效定位坐标来实现重定位。
激光雷达建图定位的方式可以提供稳定的定位信息，但是可能存在相似环境定位跳动等问题。在激光雷达定位发生跳动时，如果互补定位信号良好，优先使用互补定位信息，并使用互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标；在互补定位信号不好时，使用激光雷达定位的上次有效定位坐标来实现重定位，以实现简单可靠的定位。
所述步骤S2中使用互补定位信息，是通过互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标，使激光雷达与互补定位融合。
具体的，所述互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标，计算方法如下：
P’= R*P
其中， P为互补定位信息，θ为互补定位与建图坐标系方向偏差角，P’为互补定位对应在地图中的坐标，R为互补定位与建图坐标系方向偏差矩阵。
为了实现地图的建图，所述地图的建图方法包括：
步骤A1、启动建图系统：启动RTK设备及激光雷达SLAM建图算法，记录启动点RTK坐标 (Xrp,Yrp)及SLAM坐标(Xsp,Yxp)；
步骤A2、建图：操控建图设备，在需要导航的环境中行走，完成导航环境的扫描建图；
步骤A3、存储RTK及SLAM坐标：在建图过程中，自动按时间检测及距离存储RTK及SLAM坐标；
步骤A4、计算RTK与SLAM坐标系方向偏差角；
步骤A5、建图完成，保存地图。
采用RTK及激光雷达实现更加稳定可靠且轻量化的厘米级定位算法，通过以上步骤实现建图及标定。
所述RTK与SLAM坐标系方向偏差角的计算过程如下：
从步骤A3中存储的任意RTK点(Xrn,Yrn)及SLAM坐标(Xsn,Yxn)，计算各自在以(Xrp,Yrp)及(Xsp,Yxp)为原点坐标系下与X轴的夹角θr、θs，则RTK与SLAM坐标系方向偏差角为θ=θr-θs。
通过RTK与SLAM坐标点，计算坐标系方向偏差角，将激光雷达与互补定位进行融合。
通过RTK+激光雷达两种定位方式融合定位，有效解决空旷环境下激光雷达扫描周围环境，特征点不够或相似特正点太多造成定位匹配失败的问题，以及解决空中有遮挡的环境下，RTK定位微信信号差，定位不准确的问题。
本方案适用于低速自主驾驶的移动机器人（自主作业巡检机器人，割草机，环卫用扫地机，工厂洗地机，工厂转运小车，消防巡检小车等），不是适用于乘用车辆，移动机器人作业速度不会超过30km/h，速度通常小于6km/h。
实施例2
当将实施例1所述的一种激光雷达与互补定位融合的定位方法，应用至机器人上时，在室外环境下，将RTK定位作为主定位，将激光雷达定位作为辅助定位。当RTK定位出现定位信号差、卫星信号被遮挡或定位点突然发生异常漂移的情况下，将自动切换到激光雷达的定位的方式，以此解决卫星被遮挡时RTK定位差的的问题。当移动机器人进入室内环境时，系统自动判断无卫星信号（RTK信号），系统将自动切换为激光雷达定位导航的工作模式。
该移动机器人主要包括：
RTK定位导航一体机：包含主机和定位、定向两只天线，分别起定位与定向作用，可提供厘米级定位以及定向信息。内置嵌入式处理器，根据云端服务器发送过来的下一目标点计算机器人运动方向以及速度，将方向与速度信号通过串口发送至VCU。内置4G通讯模块，将机器人实时位置与方向发送给云端服务器，接受云端服务器指令。
执行模块：接收RTK定位导航一体机发送的运动方向与云顶速度信息，解析信息，将信息转换为移动机器人电机转速与转向的控制信号，通过CAN、PWM、485通信输出电机转动指令。用户将CAN、PWM、485信号接入机器电机驱动器从而控制电机旋转，实现底盘的运动。通过ABC信号采集超声波传感器信号，若感应到障碍物，便电机停转；无障碍物，电机正常转动。
定位基站：与RTK定位导航一体机组成差分网络，提供厘米级高精度定位。
超声波传感器：可输出开关量，接入RTK定位导航一体机ADC检测接口，若前方无障碍物，则输出低电平，若检测到障碍物，则输出高电平。
云端服务器：起转发数据，存储数据的作用，接受移动APP发来的作业指令，并将移动机器人位置方向、运动状态、电量、等信息发送给APP。接收移动机器人发送过来的信息，将自主作业路线、目标点坐标发送给移动机器人。存储移动机器人设备信息，作业路线、用户账号等信息。
移动APP：即操作端，对移动机器人进行操作，绘制自主作业区域与作业路线，给云端服务器发送作业指令。接收并显示移动机器人方向位置等信息。
实施例3
本实施例公开了一种用于实施例1所述的激光雷达与互补定位融合的定位方法的系统，包括：
启动模块：用于启动激光雷达及互补定位算法；
互补定位检测模块：用于在互补定位信号良好时，优选使用互补定位信息；在互补定位信号无法提供厘米级定位数据时，开启激光雷达定位模块；
激光雷达定位模块：用于在互补定位信号不好时，使用激光雷达定位信息，根据偏差角将其转到互补定位坐标系下，提供厘米级定位数据；
建图模块：用于地图的建图。
上述实施例仅仅是对本发明的优选实施例进行描述，而不是限定性的，因此本发明并不限于具体实施方式中所述的实施例，凡是由本领域技术人员根据本发明的技术方案得出的其他实施方式，同样属于本发明保护的范围。
Claims (10)
1.一种激光雷达与互补定位融合的定位方法，其特征在于，包括：
步骤S1、启动激光雷达及互补定位算法；
步骤S2、互补定位检测：在互补定位信号良好时，使用互补定位信息；在互补定位信号无法提供厘米级定位数据时，则执行步骤S3；
步骤S3、使用激光雷达定位信息：在互补定位信号不好时，使用激光雷达定位信息，根据偏差角将其转到互补定位坐标系下，提供厘米级定位数据。
2.根据权利要求1所述的激光雷达与互补定位融合的定位方法，其特征在于，所述步骤S2中使用互补定位信息，通过互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标。
3.根据权利要求2所述的激光雷达与互补定位融合的定位方法，其特征在于，所述步骤S3具体包括如下步骤：
步骤S301、激光雷达定位检测：通过检测前后两侧激光雷达定位是否有跳动，来判断激光雷达定位是否有效，并时刻保存有效激光雷达定位；当定位失效时，执行步骤S302；
步骤S302、激光雷达重定位：在激光雷达定位发生跳动时，如果互补定位信号良好，优先使用互补定位信息，并使用互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标；在互补定位信号不好时，使用激光雷达定位的上次有效定位坐标来实现重新定位。
4.根据权利要求3所述的激光雷达与互补定位融合的定位方法，其特征在于，所述互补定位与建图坐标系方向偏差角来计算互补定位对应在地图中的坐标，计算方法如下：
P’= R*P
其中， P为互补定位信息，θ为互补定位与建图坐标系方向偏差角，P’为互补定位对应在地图中的坐标，R为互补定位与建图坐标系方向偏差矩阵。
5.根据权利要求1所述的激光雷达与互补定位融合的定位方法，其特征在于，所述激光雷达定位算法采用正态分布变换算法获取位姿变换。
6.根据权利要求1所述的激光雷达与互补定位融合的定位方法，其特征在于，所述互补定位算法采用RTK定位技术。
7.根据权利要求6所述的激光雷达与互补定位融合的定位方法，其特征在于，所述地图的建图方法包括：
步骤A1、启动建图系统：启动RTK设备及激光雷达SLAM建图算法，记录启动点RTK坐标(Xrp,Yrp)及SLAM坐标(Xsp,Yxp)；
步骤A2、建图：操控建图设备，在需要导航的环境中行走，完成导航环境的扫描建图；
步骤A3、存储RTK及SLAM坐标：在建图过程中，自动按时间检测及距离存储RTK及SLAM坐标；
步骤A4、计算RTK与SLAM坐标系方向偏差角；
步骤A5、建图完成，保存地图。
8.根据权利要求7所述的激光雷达与互补定位融合的定位方法，其特征在于，所述RTK与SLAM坐标系方向偏差角的计算过程如下：
从步骤A3中存储的任意RTK点(Xrn,Yrn)及SLAM坐标(Xsn,Yxn)，计算各自在以(Xrp,Yrp)及(Xsp,Yxp)为原点坐标系下与X轴的夹角θr、θs，则RTK与SLAM坐标系方向偏差角为θ=θr-θs。
9.一种用于实现权利要求1-8任一项所述的激光雷达与互补定位融合的定位方法的系统，其特征在于，包括：
启动模块：用于启动激光雷达及互补定位算法；
互补定位检测模块：用于在互补定位信号良好时，使用互补定位信息；在互补定位信号无法提供厘米级定位数据时，开启激光雷达定位模块；
激光雷达定位模块：用于在互补定位信号不好时，使用激光雷达定位信息，根据偏差角将其转到互补定位坐标系下，提供厘米级定位数据；
建图模块：用于地图的建图。
10.一种应用权利要求1-8任一项所述的激光雷达与互补定位融合的定位方法的移动机器人，其特征在于，包括：
RTK定位导航一体机：包含主机和定位、定向两只天线，分别起定位与定向作用；主机内置嵌入式处理器，根据云端服务器发送过来的下一目标点计算机器人运动方向以及速度，将方向与速度信号通过串口发送至执行模块；
执行模块：接收RTK定位导航一体机发送的运动方向与云顶速度信息，解析信息，将信息转换为移动机器人电机转速与转向的控制信号，输出电机转动指令；
定位基站：与RTK定位导航一体机组成差分网络，提供厘米级高精度定位；
超声波传感器：接入RTK定位导航一体机ADC检测接口，若前方无障碍物，则输出低电平，若检测到障碍物，则输出高电平；
云端服务器：用于转发数据、存储数据，接收操作端发来的作业指令，并将移动机器人位置方向、运动状态、电量、信息发送给APP；
操作端：用于对移动机器人进行操作，绘制自主作业区域与作业路线，给云端服务器发送作业指令。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311541709.8A CN117250623B (zh) | 2023-11-20 | 2023-11-20 | 激光雷达与互补定位融合的定位方法、系统及移动机器人 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311541709.8A CN117250623B (zh) | 2023-11-20 | 2023-11-20 | 激光雷达与互补定位融合的定位方法、系统及移动机器人 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN117250623A true CN117250623A (zh) | 2023-12-19 |
| CN117250623B CN117250623B (zh) | 2024-02-27 |
Family
ID=89135449
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202311541709.8A Active CN117250623B (zh) | 2023-11-20 | 2023-11-20 | 激光雷达与互补定位融合的定位方法、系统及移动机器人 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN117250623B (zh) |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108303710A (zh) * | 2018-06-12 | 2018-07-20 | 江苏中科院智能科学技术应用研究院 | 基于三维激光雷达的无人机多场景定位建图方法 |
| CN111025366A (zh) * | 2019-12-31 | 2020-04-17 | 芜湖哈特机器人产业技术研究院有限公司 | 基于ins及gnss的网格slam的导航系统及方法 |
| CN111044991A (zh) * | 2018-10-12 | 2020-04-21 | 百度（美国）有限责任公司 | 用于自动驾驶的基于预收集静态反射图的自动lidar校准 |
| CN111522043A (zh) * | 2020-04-30 | 2020-08-11 | 北京联合大学 | 一种无人车激光雷达快速重新匹配定位方法 |
| CN112904396A (zh) * | 2021-02-03 | 2021-06-04 | 深圳亿嘉和科技研发有限公司 | 一种基于多传感器融合的高精度定位方法及系统 |
| US20210333411A1 (en) * | 2020-04-22 | 2021-10-28 | Qualcomm Incorporated | Determining correct location in the presence of gnss spoofing |
| US20220113422A1 (en) * | 2020-10-13 | 2022-04-14 | Red Leader Technologies, Inc. | Lidar system and method of operation |
| CN115343745A (zh) * | 2021-07-30 | 2022-11-15 | 香港理工大学 | 三维激光雷达辅助的高精度卫星定位方法 |
| CN115407357A (zh) * | 2022-07-05 | 2022-11-29 | 东南大学 | 基于大场景的低线束激光雷达-imu-rtk定位建图算法 |
-
2023
- 2023-11-20 CN CN202311541709.8A patent/CN117250623B/zh active Active
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108303710A (zh) * | 2018-06-12 | 2018-07-20 | 江苏中科院智能科学技术应用研究院 | 基于三维激光雷达的无人机多场景定位建图方法 |
| CN111044991A (zh) * | 2018-10-12 | 2020-04-21 | 百度（美国）有限责任公司 | 用于自动驾驶的基于预收集静态反射图的自动lidar校准 |
| CN111025366A (zh) * | 2019-12-31 | 2020-04-17 | 芜湖哈特机器人产业技术研究院有限公司 | 基于ins及gnss的网格slam的导航系统及方法 |
| US20210333411A1 (en) * | 2020-04-22 | 2021-10-28 | Qualcomm Incorporated | Determining correct location in the presence of gnss spoofing |
| CN111522043A (zh) * | 2020-04-30 | 2020-08-11 | 北京联合大学 | 一种无人车激光雷达快速重新匹配定位方法 |
| US20220113422A1 (en) * | 2020-10-13 | 2022-04-14 | Red Leader Technologies, Inc. | Lidar system and method of operation |
| CN112904396A (zh) * | 2021-02-03 | 2021-06-04 | 深圳亿嘉和科技研发有限公司 | 一种基于多传感器融合的高精度定位方法及系统 |
| CN115343745A (zh) * | 2021-07-30 | 2022-11-15 | 香港理工大学 | 三维激光雷达辅助的高精度卫星定位方法 |
| CN115407357A (zh) * | 2022-07-05 | 2022-11-29 | 东南大学 | 基于大场景的低线束激光雷达-imu-rtk定位建图算法 |
Non-Patent Citations (2)
| Title |
|---|
| 倪志康;厉茂海;林睿;孙立宁;刘仕琦;: "基于三维激光雷达与RTK融合的SLAM研究", 制造业自动化, no. 07, pages 51 - 54 * |
| 刘慧等: "果园移动机器人激光雷达双源信息融合实时导航方法", 农业机械学报, vol. 54, no. 8, pages 249 - 258 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN117250623B (zh) | 2024-02-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107167141B (zh) | 基于双一线激光雷达的机器人自主导航系统 | |
| WO2021254367A1 (zh) | 机器人系统及定位导航方法 | |
| Goel et al. | Robust localization using relative and absolute position estimates | |
| CN102866706B (zh) | 一种采用智能手机导航的清扫机器人及其导航清扫方法 | |
| CN111308490B (zh) | 基于单线激光雷达的平衡车室内定位与导航系统 | |
| Patz et al. | A practical approach to robotic design for the DARPA urban challenge | |
| Yoshida et al. | A sensor platform for outdoor navigation using gyro-assisted odometry and roundly-swinging 3D laser scanner | |
| CN109917786A (zh) | 一种面向复杂环境作业的机器人感知系统及系统运行方法 | |
| US20200363212A1 (en) | Mobile body, location estimation device, and computer program | |
| CN112629522B (zh) | 一种反光板与激光slam融合的agv定位方法及系统 | |
| CN205121338U (zh) | 基于图像识别与无线网络的agv导航系统 | |
| CN113587930B (zh) | 基于多传感融合的自主移动机器人室内外导航方法及装置 | |
| CN110658828A (zh) | 一种地貌自主探测方法及无人机 | |
| CN110988949A (zh) | 定位方法、定位装置、计算机可读存储介质与可移动设备 | |
| CN117250623B (zh) | 激光雷达与互补定位融合的定位方法、系统及移动机器人 | |
| Höffmann et al. | Coverage path planning and precise localization for autonomous lawn mowers | |
| CN113607166A (zh) | 基于多传感融合的自主移动机器人室内外定位方法及装置 | |
| CN110568849A (zh) | 室外割草机器人基于gps和在线地图的草坪边缘界定方法 | |
| JP6734764B2 (ja) | 位置推定装置、地図情報作製装置、移動体、位置推定方法及びプログラム | |
| US20220339786A1 (en) | Image-based trajectory planning method and movement control method and mobile machine using the same | |
| EP4010738A2 (en) | A lidar device, system and a control method of the same | |
| WO2019176278A1 (ja) | 情報処理装置、情報処理方法、プログラム、及び移動体 | |
| CN111056490A (zh) | 一种无人激光叉车的车载系统 | |
| Jin et al. | Development of an autonomous outdoor patrol robot in private road environment | |
| Chiang et al. | Multisensor-based outdoor tour guide robot NTU-I |
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 | ||
| CB02 | Change of applicant information |
Country or region after: China Address after: Building 43, Zone A, Energy Conservation and Environmental Protection Innovation Park, No. 199, Hongwu Avenue, Tangqiao Town, Zhangjiagang City, Suzhou City, Jiangsu Province, 215600 Applicant after: Suzhou New Coordinates Intelligent Equipment Co.,Ltd. Address before: 255086 4th floor, building 10, MEMS Industrial Park, No. 158, Zhongrun Avenue, Zibo City, Shandong Province Applicant before: Shandong new coordinate Intelligent Equipment Co.,Ltd. Country or region before: China |
|
| CB02 | Change of applicant information | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |