CN115060276A - 一种多环境适应性自动驾驶车辆定位设备、系统及方法 - Google Patents
一种多环境适应性自动驾驶车辆定位设备、系统及方法 Download PDFInfo
- Publication number
- CN115060276A CN115060276A CN202210657369.4A CN202210657369A CN115060276A CN 115060276 A CN115060276 A CN 115060276A CN 202210657369 A CN202210657369 A CN 202210657369A CN 115060276 A CN115060276 A CN 115060276A
- Authority
- CN
- China
- Prior art keywords
- point cloud
- information
- rtk
- data
- gnss
- 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
Images
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/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
-
- 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
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/41—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
-
- 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
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Abstract
本发明公开了一种多环境适应性自动驾驶车辆定位设备、系统及方法,其包括处理器,处理器具有数据采集模块、数据存储模块和位姿解算模块;数据采集模块具有传感器时间同步单元和数据采集单元,传感器时间同步单元用于根据室外RTK‑GNSS信号的状态,按如下情形向数据采集单元发出触发信号:第一种情形下,室外RTK‑GNSS信号的状态良好,数据采集单元根据触发信号,同时采集RTK‑GNSS数据以及Lidar数据;第二种情形下,室外RTK‑GNSS信号丢失,数据采集单元根据触发信号,仅限于采集Lidar数据;位姿解算模块用于根据从数据采集模块接收到的RTK‑GNSS数据中的车辆初步位姿信息与Lidar数据中的Lidar点云信息、以及从数据存储模块调用到的局部点云地图信息,提供联合优化,获得最终车辆定位信息。
Description
技术领域
本发明涉及实时导航定位技术领域,特别是关于一种多环境适应性自动驾驶车辆定位设备、系统及方法。
背景技术
实时导航定位技术为自动驾驶车辆的实时控制、决策和路径规划提供了重要保障,是实现自动驾驶车辆智能化、无人化的真正关键技术。自动驾驶车辆常通过搭载的GNSS(Global Navigation Satellites System,全球卫星定位导航系统)以及Lidar(激光雷达)来实现高精度的姿态解算,为自动驾驶车辆提供定位支持。但是,RTK-GNSS导航定位系统具有定位信号易受障碍物遮挡的缺点,故在遮挡路段常常使用Lidar里程计对车辆进行位姿估计。Lidar里程计对自动驾驶车辆所处环境具有较高适应性,可以稳定运行于地下停车场、城市道路、乡间区域等,并且不受光照影响,能够实现全天工作。然而,Lidar里程计的定位精度受限于由Lidar获得的点云质量,当RTK-GNSS信号丢失且自动驾驶车辆周围具有动态障碍物时,定位效果将受到影响,定位精度将不可避免下降。
目前,常见的导航定位系统或面向室内场景、或面向室外场景、或既能用于室内场景又能用于室外场景,但是不具有动态障碍物剔除功能而稳定性和准确性差。
发明内容
本发明的目的在于提供一种多环境适应性自动驾驶车辆定位设备、系统及方法,其能够提高自动驾驶车辆实时导航定位系统的稳定性与准确性,同时又保证定位系统的适用性。
为实现上述目的,本发明提供一种多环境适应性自动驾驶车辆定位设备,其包括处理器,所述处理器具有数据采集模块、数据存储模块和位姿解算模块;
其中,所述数据采集模块具有传感器时间同步单元和数据采集单元,
所述传感器时间同步单元用于根据室外RTK-GNSS信号的状态,按如下情形向数据采集单元发出触发信号:
第一种情形下,室外RTK-GNSS信号的状态良好,所述数据采集单元根据所述触发信号,同时采集RTK-GNSS数据以及Lidar数据;
第二种情形下,室外RTK-GNSS信号丢失,所述数据采集单元根据所述触发信号,仅限于采集所述Lidar数据;
所述位姿解算模块用于根据从所述数据采集模块接收到的所述RTK-GNSS数据中的车辆初步位姿信息与所述Lidar数据中的Lidar点云信息、以及从所述数据存储模块调用到的局部点云地图信息,提供联合优化,获得最终车辆定位信息。
进一步地,所述位姿解算模块具有定位预处理单元、点云动态障碍物剔除单元以及位姿优化单元,其中,
所述定位预处理单元用于根据当前先验位姿信息,将已被剔除掉无效点的所述Lidar数据中的点云通过三维空间变换转换到全局坐标系下,获得第一点云,其中,所述全局坐标系为系统初始时刻对应的Lidar坐标系;所述当前先验位姿信息分如下情形确定:
所述第一种情形下,所述定位预处理单元用于将所述RTK-GNSS数据中的车辆初步位姿信息转换到系统初始时刻对应的Lidar坐标系下,并将转换好的位姿信息作为当前先验位姿信息;
所述第二种情形下,当前时刻所述定位预处理单元结合上一时刻所述位姿优化单元解算得到的后验位姿信息以及匀速模型假设得到当前时刻定位系统先验位姿信息;
点云动态障碍物剔除单元用于根据由所述位姿优化单元维护的局部点云地图,将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除,获得第二点云;
位姿优化单元用于根据所述当前先验位姿信息以及所述第二点云,通过优化解算得到最终车辆定位信息。
进一步地,所述点云动态障碍物剔除单元将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除的方法具体包括:
根据所述局部点云地图,建立k-d搜索树;
将所述第一点云中距离第一点云中心预设半径范围内的点云根据k-d搜索树进行筛选,当该点云在k-d搜索树中的筛选距离大于筛选阈值时,将该点作为动态障碍物点进行剔除。
进一步地,所述位姿优化单元优化解算的方法具体包括:
将系统初始时刻前的预设帧数的点云作为初始化局部点云地图,系统正常运行时,每运动预设长度选取一帧新关键帧,并剔除最开始的关键帧,保持关键帧序列长度始终保持在预设长度内,当局部点云地图包含点云帧个数不少于预设帧数时,根据所述第二点云以及局部点云地图信息,通过建立最优估计模型获得激光里程计位姿信息,并分如下情形获得所述最终车辆定位信息:
所述第一种情形下,通过联合优化融合所述RTK-GNSS数据和所述激光里程计位姿信息,实时纠正误差获得所述最终车辆定位信息;
所述第二种情形下,利用激光里程计技术,对已被剔除掉动态障碍物点云的所述Lidar数据中的点云信息进行处理,得到所述最终车辆定位信息。
进一步地,根据GNSS信号强度识别所述RTK-GNSS信号,其具体包括:
当RTK-GNSS定位系统的双天线接收到的卫星信号个数均大于预设值时,则判定为所述室外RTK-GNSS信号良好;否则判定为所述室外RTK-GNSS信号丢失。
本发明还提供一种包括如上所述的多环境适应性自动驾驶车辆定位设备的定位系统,其还包括GNSS设备和Lidar设备。
本发明提供一种多环境适应性自动驾驶车辆定位方法,其包括:
步骤S1,根据室外RTK-GNSS信号的状态,按如下情形发出触发信号:
第一种情形下,室外RTK-GNSS信号的状态良好,根据所述触发信号,同时采集RTK-GNSS数据以及Lidar数据;
第二种情形下,室外RTK-GNSS信号丢失,根据所述触发信号,仅限于采集所述Lidar数据;
步骤S2,根据所述RTK-GNSS数据中的车辆初步位姿信息与所述Lidar数据中的Lidar点云信息、以及局部点云地图信息,提供联合优化,获得最终车辆定位信息。
进一步地,所述步骤S2具体包括:
步骤S21,根据当前先验位姿信息,将已被剔除掉无效点的所述Lidar数据中的点云通过三维空间变换转换到全局坐标系下,获得第一点云,其中,所述全局坐标系为系统初始时刻对应的Lidar坐标系;所述当前先验位姿信息分如下情形确定:
所述第一种情形下,将所述RTK-GNSS数据中的车辆初步位姿信息转换到系统初始时刻对应的Lidar坐标系下,并将转换好的位姿信息作为当前先验位姿信息;
所述第二种情形下,将当前时刻结合上一时刻解算得到的后验位姿信息以及匀速模型假设得到当前时刻定位系统先验位姿信息;
步骤S22,根据所述局部点云地图,将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除,获得第二点云;
步骤S23,根据所述当前先验位姿信息以及所述第二点云,通过优化解算得到最终车辆定位信息。
进一步地,所述步骤S22中将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除的方法具体包括:
根据所述局部点云地图,建立k-d搜索树;
将所述第一点云中距离中心预设半径范围内的点云根据k-d搜索树进行筛选,当该点云在k-d搜索树中的筛选距离大于筛选阈值时,将该点作为动态障碍物点云。
进一步地,所述步骤S23中优化解算的方法具体包括:
将系统初始时刻前的预设帧数的点云作为初始化局部点云地图,系统正常运行时,每运动预设长度选取一帧新关键帧,并剔除最开始的关键帧,保持关键帧序列长度始终保持在预设长度内,当局部点云地图包含点云帧个数不少于预设帧数时,根据所述第二点云以及局部点云地图信息,通过建立最优估计模型获得激光里程计位姿信息,并分如下情形获得所述最终车辆定位信息:
所述第一种情形下,根据联合优化,融合所述RTK-GNSS数据和所述激光里程计位姿信息,并实时纠正误差,获得所述最终车辆定位信息;
所述第二种情形下,利用激光里程计技术,对已被剔除掉动态障碍物点云的所述Lidar数据中的点云信息进行处理,得到所述最终车辆定位信息。
本发明由于采取以上技术方案,其具有以下优点:
1、根据对RTK-GNSS以及Lidar融合模式的判断进而选择合适的定位模式,表现出对室外、室内环境都具有较好适应性,以及良好车辆自主性;
2、根据对Lidar提供的点云进行动态障碍物剔除,能够有效降低外部无效噪声对定位系统的影响,提高定位系统的准确性以及稳定性。
附图说明
图1是本发明实施例提供的具有多环境适应性及动态障碍物剔除功能的面向自动驾驶车辆的定位系统的结构安装示意图。
图2是本发明的一个实施例提供的具有多环境适应性及动态障碍物剔除功能的面向自动驾驶车辆的定位系统的原理示意图。
图3是本发明的另一个实施例提供的具有多环境适应性及动态障碍物剔除功能的面向自动驾驶车辆的定位系统的原理示意图。
具体实施方式
在附图中,使用相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面结合附图对本发明的实施例进行详细说明。
在本发明的描述中,术语“中心”、“纵向”、“横向”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明保护范围的限制。
在不冲突的情况下,本发明各实施例及各实施方式中的技术特征可以相互组合,并不局限于该技术特征所在的实施例或实施方式中。
下面结合附图以及具体实施例对本发明做进一步的说明,需要指出的是,下面仅以一种最优化的技术方案对本发明的技术方案以及设计原理进行详细阐述,但本发明的保护范围并不仅限于此。
本文涉及下列术语,为便于理解,对其含义说明如下。本领域技术人员应当理解,下列术语也可能有其它名称,但在不脱离其含义的情形下,其它任何名称都应当被认为与本文所列术语一致。
如图1所示,图1示出的是一种定位系统,包括多环境适应性自动驾驶车辆定位设备1、GNSS设备2和Lidar设备3,其中:
多环境适应性自动驾驶车辆定位设备1用于通过判断RTK-GNSS信号丢失与否来确定定位模式的选取,解算输出高精度的位姿信息,为车辆提供定位支持。
作为多环境适应性自动驾驶车辆定位设备1的一种实现方式,如图2所示,其数据处理主板包括处理器11、GNSS模块12、以及Lidar模块13,其中:
GNSS模块12与安装于车辆的GNSS设备2连接,用于接收RTK-GNSS数据。GNSS设备2可以采用RTK-GNSS定位系统,其主要用于设置信号采样频率以及对RTK-GNSS定位系统提供的RTK-GNSS数据进行解析以及处理,输出车辆的初步位姿信息以及RTK-GNSS信号。其中,初步位姿信息包括由经纬度和高度表示的位置信息、以及由角度表示的姿态信息。GNSS模块12在室外RTK-GNSS信号的状态良好情形下为车辆提供绝对位姿定位信息。
Lidar模块13与安装于车辆的Lidar设备3连接,用于接收Lidar数据。具体地,Lidar设备3可以安装于车顶,通过固定设置定位销以及安装孔的方式,将GNSS设备2安装位置与Lidar设备3的安装位置相对固定。Lidar设备3在本实施例中采用的是多线Lidar,Lidar模块13主要用于设置Lidar扫描模式、采样频率以及对Lidar数据进行解析,为车辆提供四周三维环境信息。
本实施例提供的定位系统具有多环境适应性,在面对多种不同运行环境时都能为自动驾驶车辆提供稳定可靠的位姿解算结果,同时能够保证定位系统在RTK-GNSS信号丢失且面临动态障碍物场景时的准确性和稳定性。
结合图3,本发明实施例提供的处理器11,其包括数据采集模块111、数据存储模块112和位姿解算模块113。其中:
数据采集模块111采集实时数据,具体地,其具有传感器时间同步单元1111和数据采集单元1112。
其中,传感器时间同步单元1111用于根据室外RTK-GNSS信号的状态,按如下情形向数据采集单元1112发出触发信号:
第一种情形下,室外RTK-GNSS信号的状态良好,数据采集单元1112根据所述触发信号,同时采集RTK-GNSS数据以及Lidar数据。
第二种情形下,室外RTK-GNSS信号丢失,数据采集单元1112根据所述触发信号,仅限于采集所述Lidar数据。其中,“室外RTK-GNSS信号丢失”可能是室外RTK-GNSS受遮挡,也可能是处于室内环境下,还可能是其他情形。
在一个实施例中,根据GNSS信号强度识别由GNSS模块所述RTK-GNSS信号,其具体包括:
当GNSS设备2的双天线接收到的卫星信号个数均大于预设值时,该预设值一般为8,则判定为所述室外RTK-GNSS信号良好;否则判定为所述室外RTK-GNSS信号丢失。
数据存储模块112用于将所述RTK-GNSS数据RTK-GNSS定位系统解析得到的车辆位姿信息、由Lidar得到的所述Lidar数据中的激光雷达点云信息、所述位姿解算模块113解算得到的位姿信息、以及局部点云地图信息进行本地化存储。通过数据存储模块112对数据的本地化存储,可以实现车辆作业后的数据再分析,能够根据具体环境进行针对性求解,可以得到具有更高精度的全局一致点云地图。
位姿解算模块113用于根据从数据采集模块111接收到的RTK-GNSS数据中的车辆初步位姿信息与所述Lidar数据中的Lidar点云信息、以及从数据存储模块112调用到的局部点云地图信息,提供联合优化,获得最终车辆定位信息。
在一个实施例中,所述位姿解算模块113具有定位预处理单元1131、点云动态障碍物剔除单元1132以及位姿优化单元1133,其中,
定位预处理单元1131用于根据当前先验位姿信息,将已被剔除掉无效点的所述Lidar数据中的点云通过三维空间变换转换到全局坐标系下,获得全局坐标系下的第一点云,其中,所述全局坐标系为系统初始时刻对应的Lidar坐标系;所述当前先验位姿信息分如下情形确定:
所述第一种情形下,所述定位预处理单元1131用于将所述RTK-GNSS数据中的车辆初步位姿信息转换到系统初始时刻对应的Lidar坐标系下,将系统初始时刻Lidar坐标系作为定位系统全局坐标系,并将转换好的车辆初步位姿信息作为当前先验位姿信息。
所述第二种情形下,当前时刻所述定位预处理单元1131结合上一时刻所述位姿优化单元1133解算得到的后验位姿信息并结合匀速模型,获得当前时刻定位系统先验位姿信息。其中,当系统为初始时刻时此先验估计为系统初始值。
其中,定位预处理单元1131剔除的无效点指的是Lidar数据中的“NAN”点,即为激光中的无穷远点。提出方法可以选用现有方法实现,在此不再一一列举。
点云动态障碍物剔除单元1132用于根据由位姿优化单元1133维护的局部点云地图,将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除,获得第二点云。
例如,所述点云动态障碍物剔除单元1132将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除时,其具体包括:
根据所述局部点云地图,建立k-d搜索树;
将所述第一点云中距离中心预设半径(例如:半径10m)范围内的点云根据k-d搜索树进行筛选,当该点云在k-d搜索树中的筛选距离大于筛选阈值时,将该点作为动态障碍物点云,该筛选阈值一般取0.01m。
位姿优化单元1133用于根据所述当前先验位姿信息以及所述第二点云,通过优化解算得到最终车辆定位信息。
其中,“通过优化解算得到最终车辆定位信息”的方法具体包括:
将系统初始时刻前的预设帧数(比如30帧)的点云作为初始化局部点云地图,系统正常运行时,每运动预设长度(比如2米)选取一帧新关键帧,并剔除最开始的关键帧,保持关键帧序列长度始终保持在预设帧数内。当局部点云地图包含点云帧个数不少于预设帧数时,将所述第二点云以及局部点云地图信息建立最优估计模型根据第二点云以及局部点云的对应关系,构建最优估计模型,获得激光里程计位姿信息,并分如下情形获得所述最终车辆定位信息:
所述第一种情形下,通过联合优化,比如因子图优化理论等优化方法,融合所述RTK-GNSS数据和所述激光里程计位姿信息,并实时纠正误差,获得高精度所述最终车辆定位信息,最后由所述最终车辆定位信息对所述第二点云进行转换,得到全局一致高精度地图。
所述第二种情形下,利用激光里程计技术,对已被剔除掉动态障碍物点云的所述Lidar数据中的点云信息进行处理,得到所述最终车辆定位信息。其中,“对已被剔除掉动态障碍物点云的所述Lidar数据中的点云信息进行处理,得到所述最终车辆定位信息”的方法指的是,对第二点云中角点特征以及面点特征在局部点云地图中进行对应点匹配,根据得到的匹配关系构建最小二乘估计问题,解算得到激光里程计位姿信息,该激光里程计位姿信息即为所述最终车辆定位信息。
上述实施例中,“构建最优估计模型,获得激光里程计位姿信息”的方法具体包括:
对第二点云中角点特征以及面点特征在局部点云地图中进行对应点匹配,根据得到的匹配关系构建最小二乘估计问题,解算得到激光里程计位姿信息。
本发明实施例提供的多环境适应性自动驾驶车辆定位方法包括:
步骤S1,根据室外RTK-GNSS信号的状态,按如下情形发出触发信号:
第一种情形下,室外RTK-GNSS信号的状态良好,根据所述触发信号,同时采集RTK-GNSS数据以及Lidar数据;
第二种情形下,室外RTK-GNSS信号丢失,根据所述触发信号,仅限于采集所述Lidar数据;
步骤S2,根据所述RTK-GNSS数据中的车辆初步位姿信息与所述Lidar数据中的Lidar点云信息、以及局部点云地图信息,提供联合优化,获得最终车辆定位信息。
在一个实施例中,步骤S2具体包括:
步骤S21,根据当前先验位姿信息,将已被剔除掉无效点的所述Lidar数据中的点云通过三维空间变换转换到全局坐标系下,获得第一点云,其中,所述全局坐标系为系统初始时刻对应的Lidar坐标系;所述当前先验位姿信息分如下情形确定:
所述第一种情形下,将所述RTK-GNSS数据中的车辆初步位姿信息转换到系统初始时刻对应的Lidar坐标系下,并将转换好的位姿信息作为当前先验位姿信息;
所述第二种情形下,将当前时刻结合上一时刻解算得到的后验位姿信息以及匀速模型假设得到当前时刻定位系统先验位姿信息;
步骤S22,根据所述局部点云地图,将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除,获得第二点云;
步骤S23,根据所述当前先验位姿信息以及所述第二点云,通过优化解算得到最终车辆定位信息。
在一个实施例中,所述步骤S22中将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除的方法具体包括:
根据所述局部点云地图,建立k-d搜索树;
将所述第一点云中距离中心预设半径范围内的点云根据k-d搜索树进行筛选,当该点云在k-d搜索树中的筛选距离大于筛选阈值时,将该点作为动态障碍物点云。
在一个实施例中,所述步骤S23中优化解算的方法具体包括:
将系统初始时刻前的预设帧数的点云作为初始化局部点云地图,系统正常运行时,每运动预设长度选取一帧新关键帧,并剔除最开始的关键帧,保持关键帧序列长度始终保持在预设长度内,当局部点云地图包含点云帧个数不少于预设帧数时,根据所述第二点云以及局部点云地图信息,通过建立最优估计模型获得激光里程计位姿信息,并分如下情形获得所述最终车辆定位信息:
所述第一种情形下,根据联合优化,融合所述RTK-GNSS数据和所述激光里程计位姿信息,并实时纠正误差,获得所述最终车辆定位信息;
所述第二种情形下,利用激光里程计技术,对已被剔除掉动态障碍物点云的所述Lidar数据中的点云信息进行处理,得到所述最终车辆定位信息。
本发明能有效提高自动驾驶车辆在各种环境下的适用性,并因为具有点云动态障碍物剔除模块,能够同时达到提高定位系统定位精度、稳定性的效果。
最后需要指出的是:以上实施例仅用以说明本发明的技术方案,而非对其限制。本领域的普通技术人员应当理解:可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种多环境适应性自动驾驶车辆定位设备(1),其特征在于,包括处理器(11),所述处理器(11)具有数据采集模块(111)、数据存储模块(112)和位姿解算模块(113);
其中,所述数据采集模块(111)具有传感器时间同步单元(1111)和数据采集单元(1112),
所述传感器时间同步单元(1111)用于根据室外RTK-GNSS信号的状态,按如下情形向数据采集单元(1112)发出触发信号:
第一种情形下,室外RTK-GNSS信号的状态良好,所述数据采集单元(1112)根据所述触发信号,同时采集RTK-GNSS数据以及Lidar数据;
第二种情形下,室外RTK-GNSS信号丢失,所述数据采集单元(1112)根据所述触发信号,仅限于采集所述Lidar数据;
所述位姿解算模块(113)用于根据从所述数据采集模块(111)接收到的所述RTK-GNSS数据中的车辆初步位姿信息与所述Lidar数据中的Lidar点云信息、以及从所述数据存储模块(112)调用到的局部点云地图信息,提供联合优化,获得最终车辆定位信息。
2.如权利要求1所述的多环境适应性自动驾驶车辆定位设备(1),其特征在于,所述位姿解算模块(113)具有定位预处理单元(1131)、点云动态障碍物剔除单元(1132)以及位姿优化单元(1133),其中,
所述定位预处理单元(1131)用于根据当前先验位姿信息,将已被剔除掉无效点的所述Lidar数据中的点云通过三维空间变换转换到全局坐标系下,获得第一点云,其中,所述全局坐标系为系统初始时刻对应的Lidar坐标系;所述当前先验位姿信息分如下情形确定:
所述第一种情形下,所述定位预处理单元(1131)用于将所述RTK-GNSS数据中的车辆初步位姿信息转换到系统初始时刻对应的Lidar坐标系下,并将转换好的位姿信息作为当前先验位姿信息;
所述第二种情形下,当前时刻所述定位预处理单元(1131)结合上一时刻所述位姿优化单元(1133)解算得到的后验位姿信息以及匀速模型假设得到当前时刻定位系统先验位姿信息;
点云动态障碍物剔除单元(1132)用于根据由所述位姿优化单元(1133)维护的局部点云地图,将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除,获得第二点云;
位姿优化单元(1133)用于根据所述当前先验位姿信息以及所述第二点云,通过优化解算得到最终车辆定位信息。
3.如权利要求2所述的多环境适应性自动驾驶车辆定位设备(1),其特征在于,所述点云动态障碍物剔除单元(1132)将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除的方法具体包括:
根据所述局部点云地图,建立k-d搜索树;
将所述第一点云中距离第一点云中心预设半径范围内的点云根据k-d搜索树进行筛选,当该点云在k-d搜索树中的筛选距离大于筛选阈值时,将该点作为动态障碍物点进行剔除。
4.如权利要求2所述的多环境适应性自动驾驶车辆定位设备(1),其特征在于,所述位姿优化单元(1133)优化解算的方法具体包括:
将系统初始时刻前的预设帧数的点云作为初始化局部点云地图,系统正常运行时,每运动预设长度选取一帧新关键帧,并剔除最开始的关键帧,保持关键帧序列长度始终保持在预设长度内,当局部点云地图包含点云帧个数不少于预设帧数时,根据所述第二点云以及局部点云地图信息,通过建立最优估计模型获得激光里程计位姿信息,并分如下情形获得所述最终车辆定位信息:
所述第一种情形下,通过联合优化融合所述RTK-GNSS数据和所述激光里程计位姿信息,实时纠正误差获得所述最终车辆定位信息;
所述第二种情形下,利用激光里程计技术,对已被剔除掉动态障碍物点云的所述Lidar数据中的点云信息进行处理,得到所述最终车辆定位信息。
5.如权利要求1-4中任一项所述的多环境适应性自动驾驶车辆定位设备(1),其特征在于,根据GNSS信号强度识别所述RTK-GNSS信号,其具体包括:
当GNSS设备(2)的双天线接收到的卫星信号个数均大于预设值时,则判定为所述室外RTK-GNSS信号良好;否则判定为所述室外RTK-GNSS信号丢失。
6.一种包括如权利要求1-6中任一项多环境适应性自动驾驶车辆定位设备(1)的定位系统,其特征在于,还包括GNSS设备(2)和Lidar设备(3)。
7.一种多环境适应性自动驾驶车辆定位方法,其特征在于,包括:
步骤S1,根据室外RTK-GNSS信号的状态,按如下情形发出触发信号:
第一种情形下,室外RTK-GNSS信号的状态良好,根据所述触发信号,同时采集RTK-GNSS数据以及Lidar数据;
第二种情形下,室外RTK-GNSS信号丢失,根据所述触发信号,仅限于采集所述Lidar数据;
步骤S2,根据所述RTK-GNSS数据中的车辆初步位姿信息与所述Lidar数据中的Lidar点云信息、以及局部点云地图信息,提供联合优化,获得最终车辆定位信息。
8.如权利要求7所述的多环境适应性自动驾驶车辆定位方法,其特征在于,所述步骤S2具体包括:
步骤S21,根据当前先验位姿信息,将已被剔除掉无效点的所述Lidar数据中的点云通过三维空间变换转换到全局坐标系下,获得第一点云,其中,所述全局坐标系为系统初始时刻对应的Lidar坐标系;所述当前先验位姿信息分如下情形确定:
所述第一种情形下,将所述RTK-GNSS数据中的车辆初步位姿信息转换到系统初始时刻对应的Lidar坐标系下,并将转换好的位姿信息作为当前先验位姿信息;
所述第二种情形下,将当前时刻结合上一时刻解算得到的后验位姿信息以及匀速模型假设得到当前时刻定位系统先验位姿信息;
步骤S22,根据所述局部点云地图,将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除,获得第二点云;
步骤S23,根据所述当前先验位姿信息以及所述第二点云,通过优化解算得到最终车辆定位信息。
9.如权利要求8所述的多环境适应性自动驾驶车辆定位方法,其特征在于,所述步骤S22中将所述第一点云中的车辆四周区域内点云动态障碍物进行剔除的方法具体包括:
根据所述局部点云地图,建立k-d搜索树;
将所述第一点云中距离中心预设半径范围内的点云根据k-d搜索树进行筛选,当该点云在k-d搜索树中的筛选距离大于筛选阈值时,将该点作为动态障碍物点云。
10.如权利要求8所述的多环境适应性自动驾驶车辆定位设备(1),其特征在于,所述步骤S23中优化解算的方法具体包括:
将系统初始时刻前的预设帧数的点云作为初始化局部点云地图,系统正常运行时,每运动预设长度选取一帧新关键帧,并剔除最开始的关键帧,保持关键帧序列长度始终保持在预设长度内,当局部点云地图包含点云帧个数不少于预设帧数时,根据所述第二点云以及局部点云地图信息,通过建立最优估计模型获得激光里程计位姿信息,并分如下情形获得所述最终车辆定位信息:
所述第一种情形下,根据联合优化,融合所述RTK-GNSS数据和所述激光里程计位姿信息,并实时纠正误差,获得所述最终车辆定位信息;
所述第二种情形下,利用激光里程计技术,对已被剔除掉动态障碍物点云的所述Lidar数据中的点云信息进行处理,得到所述最终车辆定位信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210657369.4A CN115060276B (zh) | 2022-06-10 | 2022-06-10 | 一种多环境适应性自动驾驶车辆定位设备、系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210657369.4A CN115060276B (zh) | 2022-06-10 | 2022-06-10 | 一种多环境适应性自动驾驶车辆定位设备、系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115060276A true CN115060276A (zh) | 2022-09-16 |
CN115060276B CN115060276B (zh) | 2023-05-12 |
Family
ID=83200808
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210657369.4A Active CN115060276B (zh) | 2022-06-10 | 2022-06-10 | 一种多环境适应性自动驾驶车辆定位设备、系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115060276B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017135583A1 (en) * | 2016-02-05 | 2017-08-10 | Samsung Electronics Co., Ltd. | Vehicle and method of recognizing position of vehicle based on map |
CN109470240A (zh) * | 2018-11-15 | 2019-03-15 | 安徽酷哇机器人有限公司 | 自动驾驶定位方法 |
CN111551186A (zh) * | 2019-11-29 | 2020-08-18 | 福瑞泰克智能系统有限公司 | 一种车辆实时定位方法、系统及车辆 |
CN112162297A (zh) * | 2020-09-24 | 2021-01-01 | 燕山大学 | 一种剔除激光点云地图中动态障碍伪迹的方法 |
CN112484738A (zh) * | 2020-11-24 | 2021-03-12 | 深圳市优必选科技股份有限公司 | 机器人建图方法、装置、计算机可读存储介质及机器人 |
CN112862894A (zh) * | 2021-04-12 | 2021-05-28 | 中国科学技术大学 | 一种机器人三维点云地图构建与扩充方法 |
CN112923931A (zh) * | 2019-12-06 | 2021-06-08 | 北理慧动(常熟)科技有限公司 | 一种基于固定路线下的特征地图匹配与gps定位信息融合方法 |
CN113566833A (zh) * | 2021-07-28 | 2021-10-29 | 上海工程技术大学 | 一种多传感器融合的车辆定位方法及系统 |
CN114111775A (zh) * | 2021-12-20 | 2022-03-01 | 国汽(北京)智能网联汽车研究院有限公司 | 一种多传感器融合定位方法、装置、存储介质及电子设备 |
CN114459470A (zh) * | 2022-01-19 | 2022-05-10 | 国网江西省电力有限公司超高压分公司 | 基于多传感器融合的巡检机器人定位方法 |
-
2022
- 2022-06-10 CN CN202210657369.4A patent/CN115060276B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017135583A1 (en) * | 2016-02-05 | 2017-08-10 | Samsung Electronics Co., Ltd. | Vehicle and method of recognizing position of vehicle based on map |
CN109470240A (zh) * | 2018-11-15 | 2019-03-15 | 安徽酷哇机器人有限公司 | 自动驾驶定位方法 |
CN111551186A (zh) * | 2019-11-29 | 2020-08-18 | 福瑞泰克智能系统有限公司 | 一种车辆实时定位方法、系统及车辆 |
CN112923931A (zh) * | 2019-12-06 | 2021-06-08 | 北理慧动(常熟)科技有限公司 | 一种基于固定路线下的特征地图匹配与gps定位信息融合方法 |
CN112162297A (zh) * | 2020-09-24 | 2021-01-01 | 燕山大学 | 一种剔除激光点云地图中动态障碍伪迹的方法 |
CN112484738A (zh) * | 2020-11-24 | 2021-03-12 | 深圳市优必选科技股份有限公司 | 机器人建图方法、装置、计算机可读存储介质及机器人 |
CN112862894A (zh) * | 2021-04-12 | 2021-05-28 | 中国科学技术大学 | 一种机器人三维点云地图构建与扩充方法 |
CN113566833A (zh) * | 2021-07-28 | 2021-10-29 | 上海工程技术大学 | 一种多传感器融合的车辆定位方法及系统 |
CN114111775A (zh) * | 2021-12-20 | 2022-03-01 | 国汽(北京)智能网联汽车研究院有限公司 | 一种多传感器融合定位方法、装置、存储介质及电子设备 |
CN114459470A (zh) * | 2022-01-19 | 2022-05-10 | 国网江西省电力有限公司超高压分公司 | 基于多传感器融合的巡检机器人定位方法 |
Non-Patent Citations (3)
Title |
---|
JIACHEN ZHANG等: "GNSS-RTK Adaptively Integrated with LiDAR/IMU Odometry for Continuously Global Positioning in Urban Canyons", APPLIED SCIENCES * |
秦晓辉等: "基于车辆模型紧耦合的封闭园区车辆定位方法", 汽车工程 * |
郑壮壮等: "动态环境下无人地面车辆点云地图快速重定位方法", 兵工学报 * |
Also Published As
Publication number | Publication date |
---|---|
CN115060276B (zh) | 2023-05-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111522043B (zh) | 一种无人车激光雷达快速重新匹配定位方法 | |
EP3371671B1 (en) | Method, device and assembly for map generation | |
KR101534056B1 (ko) | 교통 신호 맵핑 및 검출 | |
CN114199240B (zh) | 无gps信号下二维码、激光雷达与imu融合定位系统及方法 | |
Perea-Strom et al. | GNSS integration in the localization system of an autonomous vehicle based on particle weighting | |
CN110082783B (zh) | 一种悬崖检测的方法及装置 | |
CN113269878B (zh) | 一种基于多传感器的建图方法及系统 | |
CN110210384B (zh) | 一种道路全局信息实时提取与表示系统 | |
Brenner | Vehicle localization using landmarks obtained by a lidar mobile mapping system | |
CN111506069B (zh) | 一种全天候全地面起重机障碍识别系统及方法 | |
KR20230014724A (ko) | 차량 국부화 시스템 및 방법 | |
CN114413909A (zh) | 一种室内移动机器人定位方法及系统 | |
CN114485654A (zh) | 一种基于高精地图的多传感器融合定位方法及装置 | |
CN116047565A (zh) | 一种多传感器数据融合定位系统 | |
CN115236673A (zh) | 一种大型车辆多雷达融合感知系统和方法 | |
US11821752B2 (en) | Method for localizing and enhancing a digital map by a motor vehicle; localization device | |
CN112486172A (zh) | 道路边缘检测方法及机器人 | |
KR102105590B1 (ko) | 저가 상용 gnss의 측위 정확도 개선 시스템 및 방법 | |
CN115060276B (zh) | 一种多环境适应性自动驾驶车辆定位设备、系统及方法 | |
CN112698315B (zh) | 移动设备定位系统、方法及设备 | |
Iannucci et al. | Cross-Modal Localization: Using automotive radar for absolute geolocation within a map produced with visible-light imagery | |
CN114152955A (zh) | 一种基于slam技术的障碍物高精度识别系统 | |
US20230332917A1 (en) | Feature data generation system, feature database update system, and feature data generation method | |
Cheng et al. | An accurate autonomous vehicles positioning method based on gps/lidar/camera in v2v communication environment | |
EP4220580A1 (en) | Method for vehicle driving assistance within delimited area |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |