CN113532472A - 一种检测激光建图里程计与组合导航定位偏差的方法及系统 - Google Patents
一种检测激光建图里程计与组合导航定位偏差的方法及系统 Download PDFInfo
- Publication number
- CN113532472A CN113532472A CN202010293823.3A CN202010293823A CN113532472A CN 113532472 A CN113532472 A CN 113532472A CN 202010293823 A CN202010293823 A CN 202010293823A CN 113532472 A CN113532472 A CN 113532472A
- Authority
- CN
- China
- Prior art keywords
- track
- deviation
- point
- data
- laser
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000013507 mapping Methods 0.000 title claims abstract description 24
- 238000007781 pre-processing Methods 0.000 claims abstract description 10
- 230000008859 change Effects 0.000 claims description 7
- 238000004458 analytical method Methods 0.000 claims description 3
- 238000000605 extraction Methods 0.000 claims description 3
- 238000001514 detection method Methods 0.000 abstract description 7
- 230000008569 process Effects 0.000 abstract description 3
- 238000004364 calculation method Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000002159 abnormal effect Effects 0.000 description 3
- 238000004140 cleaning Methods 0.000 description 3
- 238000013461 design Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 3
- 241001417527 Pempheridae Species 0.000 description 2
- 238000005034 decoration Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000008030 elimination Effects 0.000 description 2
- 238000003379 elimination reaction Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000003252 repetitive effect Effects 0.000 description 2
- OKTJSMMVPCPJKN-UHFFFAOYSA-N Carbon Chemical compound [C] OKTJSMMVPCPJKN-UHFFFAOYSA-N 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 229910052799 carbon Inorganic materials 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 125000004122 cyclic group Chemical group 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000012800 visualization Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- 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
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C22/00—Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种检测激光建图里程计与组合导航定位偏差的方法,包括如下步骤:(1)轨迹数据的预处理;(2)建立偏差方程;(3)计算轨迹点偏差值;(4)判断并输出差值较大点坐标。与上述方法相对应地,本发明提供了一种检测激光建图里程计与组合导航定位偏差的系统。应用本发明可以实现快速的定位到某一个点处两者偏差较大,并给出偏差值,从而在高精地图的建图过程中,大大提高了建图效率;同时对于质量检测人员,可以更加高效的实现大规模场景下高精地图质量,可以有效把控无人驾驶激光定位精确度与可靠性,进而推动大规模场景高精地图应用落地。
Description
技术领域
本发明涉及无人驾驶车高精地图技术领域,具体涉及一种检测激光建图里程计与组合导航定位偏差的方法及系统。
背景技术
随着近年来科技水平的不断提升,人工智能飞速发展,其广泛运用了到各个领域之中。其中,由于自动驾驶车辆能够高效利用交通资源,缓解交通拥堵、减少碳排放,因此,自动驾驶技术越来越成为人们所关注的焦点。当前,乘用车自动驾驶距真正商业化还有一定的距离,而限定环境内的小型低速环卫清扫车为自动驾驶技术的落地提供了具体的应用场景。另一方面,由于人口老龄化的加剧,国内劳动力的成本逐年呈上升趋势,且繁重的重复性体力劳动增加了人们的工作负担,例如,对于公园、校园、大型商场、工业园区等场景的环境卫生清扫作业,环卫工人需要长时间进行重复性的体力劳动,作业繁重,故由智能化的无人驾驶自动清扫代替繁重的人工清扫势不可挡。
小型低速环卫清扫车能够实现高精度定位、路径规划等技术离不开高精度地图,而高精度地图的关键在于创建点云地图的技术,即基于激光传感器的同时定位与建图(Simultaneously Localization and Mapping,SLAM)。通过3D激光匹配算法进行点云帧间匹配构建点云地图(匹配形成的轨迹成为激光里程计),并结合组合导航(GPS、轮速计、惯性测量单元等多传感器融合方法)观测信息来优化点云地图。但是实际应用中,由于环境、地形和人为因素的影响激光里程计与组合导航轨迹无法实现完全重合,两者偏差过大会导致:1、点云地图与实际物理环境不符2、点云地图存在局部重影和畸变,影响激光匹配与多传感器融合定位效果。
然而,高精度地图制作中不同轨迹间偏差检测尚没有成熟方案,大多分别通过计算3D激光匹配的轨迹点和MSF轨迹点,再通过曲线拟合的方式建立两条插值曲线,并进行可视化。在高精地图制作和质量检测中,以上两者轨迹偏差完全由建图人员用经验去判断。凭借建图人员经验去判断两条轨迹点偏差变化虽然可以实现一定区域内或者某个时间段内大偏差检测,但效率低易出现误检,无法判断以万为数量级的轨迹点中两者误差大小和异常点的具体位置,严重影响高精地图的建图质量及检测效果。
发明内容
本发明提供了一种检测激光建图里程计与组合导航定位偏差的方法及系统,其将两者轨迹点的坐标(离散型的)进行处理,同时要实现其平滑过渡,再通过设定阈值找出两者偏差较大点,输出其对应点的坐标,进而帮助高精地图建图人员快速定位地图中异常点,有效提高高精地图自动化检测。
为实现本发明的目的,本发明提供的一种检测激光建图里程计与组合导航定位偏差的方法,其特征在于,包括如下步骤:
(1)轨迹数据的预处理;
(2)建立偏差方程;
(3)计算轨迹点偏差值;
(4)判断并输出差值较大点坐标。
优选地,在步骤(1)中,首先建立激光点云地图,对点云进行合理的抽析,通过设定关键帧的距离来控制点云的密度,在初步建立点云地图后,通过激光匹配的方法推算地图采集平台的轨迹数据,存储的数据中包含了位置和航向信息;对组合导航进行有效性进行判断,保存其轨迹数据,其中包含了位置和航向信息。
优选地,在步骤(2)中,采用最小二乘法对激光匹配轨迹进行局部拟合,给定数据点pi(xi,yi,zi),其中i=1,2,…,m,求近似曲线并且使得近似曲线与y=f(x)的偏差最小,近似曲线在点pi处的偏差曲线拟合公式如下:
建立一个激光匹配轨迹点数组队列,将其按顺序填入a个轨迹点的位置坐标,通过最小二乘公式建立直线方程,然后,在a个轨迹点头部去除1个数据,最后在尾部循环填入一个数据,以此类推会按顺序建立N个直线方程;同理在时间对齐的情况下,组合导航轨迹线也采用相同的方法按顺序建立N个直线方程。
优选地,在步骤(3)中,选择激光匹配轨迹线和组合导航轨迹线两条轨迹中一条轨迹的N个直线方程,再使用其相对轨迹线的轨迹点,通过点到直线的距离公式,即可得到两条轨迹偏差。
优选地,在步骤(4)中,将轨迹点的坐标组成一个队列,在队列中建立一个滑动窗口,将位置与航向作差后的数据按顺序取b个值放入滑动窗口中,计算滑动窗口中数据的方差并记录,窗口中第一个数据会实时弹出,并在窗口尾部按顺序加入新的航位插值,以此类推,能够得到整条轨迹线上每个点对应航位变化的方差,通过航位方差与预设阈值比对,能够判断出两条轨迹出现偏差的较大点的位置,并根据轨迹点的ID输出对应轨迹点的坐标值。
与上述方法相对应地,本发明提供了一种检测激光建图里程计与组合导航定位偏差的系统,包括:
(1)轨迹数据的预处理单元;
(2)建立偏差方程单元;
(3)计算轨迹点偏差值单元;
(4)判断并输出差值较大点坐标单元。
优选地,所述轨迹数据的预处理单元用于,首先建立激光点云地图,对点云进行合理的抽析,通过设定关键帧的距离来控制点云的密度,在初步建立点云地图后,通过激光匹配的方法推算地图采集平台的轨迹数据,存储的数据中包含了位置和航向信息;对组合导航进行有效性进行判断,保存其轨迹数据,其中包含了位置和航向信息。
优选地,所述建立偏差方程单元用于,采用最小二乘法对激光匹配轨迹进行局部拟合,给定数据点pi(xi,yi,zi),其中i=1,2,…,m,求近似曲线并且使得近似曲线与y=f(x)的偏差最小,近似曲线在点pi处的偏差 曲线拟合公式如下:
建立一个激光匹配轨迹点数组队列,将其按顺序填入a个轨迹点的位置坐标,通过最小二乘公式建立直线方程,然后,在a个轨迹点头部去除1个数据,最后在尾部循环填入一个数据,以此类推会按顺序建立N个直线方程;同理在时间对齐的情况下,组合导航轨迹线也采用相同的方法按顺序建立N个直线方程。
优选地,所述计算轨迹点偏差值单元用于,选择激光匹配轨迹线和组合导航轨迹线两条轨迹中一条轨迹的N个直线方程,再使用其相对轨迹线的轨迹点,通过点到直线的距离公式,即可得到两条轨迹偏差。
优选地,所述判断并输出差值较大点坐标单元用于,将轨迹点的坐标组成一个队列,在队列中建立一个滑动窗口,将位置与航向作差后的数据按顺序取b个值放入滑动窗口中,计算滑动窗口中数据的方差并记录,窗口中第一个数据会实时弹出,并在窗口尾部按顺序加入新的航位插值,以此类推,能够得到整条轨迹线上每个点对应航位变化的方差,通过航位方差与预设阈值比对,能够判断出两条轨迹出现偏差的较大点的位置,并根据轨迹点的ID输出对应轨迹点的坐标值。
与现有技术相比,本发明的有益效果为,应用本发明可以实现快速的定位到某一个点处两者偏差较大,并给出偏差值,从而在高精地图的建图过程中,大大提高了建图效率;同时对于质量检测人员,可以更加高效的实现大规模场景下高精地图质量,可以有效把控无人驾驶激光定位精确度与可靠性,进而推动大规模场景高精地图应用落地。
附图说明
图1所示为本申请的方法流程示意图;
图2所示为本申请激光匹配与组合导航轨迹示意图;
图3所示为本申请轨迹线与轨迹点示意图;
图4所示为本申请轨迹偏差计算示意图;
图5所示为本申请轨迹偏差计算结果示意图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
以下结合附图和具体实施例对本发明作进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
实施例1
本发明提供了一种检测激光建图里程计与组合导航定位偏差的方法,包括如下四个步骤:如图1所示,
S1.轨迹数据的预处理
首先,建立激光点云地图,对点云进行合理的抽析,通过设定关键帧的距离来控制点云的密度,在初步建立点云地图后,通过激光匹配的方法推算地图采集平台的轨迹数据,存储的数据中包含了位置(x,y)和航向信息,如图2所示,然后对组合导航进行有效性进行判断,保存其轨迹数据其中也包含了包含了x、y和航向信息,如图3所示。
S2.建立偏差方程
由于激光匹配轨迹点并不是线性的存在,而是离散的分布在轨迹线的两侧,根据其分布特点,采用海因里希·奥尔伯斯提出最小二乘法对轨迹进行局部拟合,给定数据点pi(xi,yi,zi),其中i=1,2,…,m,求近似曲线并且使得近似曲线与y=f(x)的偏差最小,近似曲线在点pi处的偏差曲线拟合公式如下:
为了计算的合理性,我们首先建立一个数组队列,将其按顺序填入a个轨迹点的x、y坐标,通过最小二乘公式建立直线方程,然后在这a个轨迹点头部去除1个数据,最后在尾部循环填入一个数据,以此类推会按顺序建立N个直线方程。同理在时间对齐的情况下,组合导航轨迹线也采用相同的方法按顺序建立N个直线方程。上面的a的取值,可以为10个、9个或8个,在此不做数量限定。
S3.计算轨迹点偏差值
由于激光匹配轨迹点与组合导航轨迹点是通过时间戳进行对应,因此在两条轨迹线之间就可以建立N组直线对。可以只需要选择两条轨迹中一条轨迹的N个直线方程,再使用其相对轨迹线的轨迹点,通过点到直线的距离公式,即可得到两条轨迹偏差,轨迹偏差计算,如图4所示。
S4.判断并输出差值较大点坐标
将轨迹点的坐标组成一个队列,在队列中建立一个滑动窗口,将位置与航向作差后的数据按顺序取b个值放入滑动窗口中,计算滑动窗口中数据的方差并记录;窗口中第一个数据会实时弹出,并在窗口尾部按顺序加入新的航位(位置、航向)插值;以此类推,则可以得到整条轨迹线上每个点对应航位变化的方差,通过航位方差与预设阈值比对,可以判断出两条轨迹出现偏差的较大点的位置,并根据轨迹点的ID输出对应轨迹点的坐标值,如图5所示。需要说明的是,上面的a的取值,可以为5个、6个或7个,在此不做数量限定。
本实施例按时间戳顺序读取轨迹线上的10个轨迹点建立直线方程,并进行循环剔除和填充,最大化的剔除局部跳变对轨迹线偏差计算精度的影响,实现了最平滑情况下的距离的计算的设计方法;其中,轨迹线上的轨迹点通过使用最小二乘法,在离散点间拟合局部直线方程,用于计算离散点与拟合轨迹线之间的距离;本实施例设计了一个固定长度的滑动窗口,有效过滤轨迹中异常点对航向的影响;获取航向变化时引入方差的计算方法;在滑动窗口中计算每个航位点和其前后两个航位值组成的数组的方差,该方差代表这一点航向数据波动。在判断两条轨迹线的变化幅度时,本实施例设计了判断航向方差值大小和位置偏差最大值来自动检测两条轨迹偏差较大的范围点。
与上述方法对应地,本发明还提供了一种检测激光建图里程计与组合导航定位偏差的系统,包括:
(1)轨迹数据的预处理单元;
(2)建立偏差方程单元;
(3)计算轨迹点偏差值单元;
(4)判断并输出差值较大点坐标单元。
优选地,所述轨迹数据的预处理单元用于,首先建立激光点云地图,对点云进行合理的抽析,通过设定关键帧的距离来控制点云的密度,在初步建立点云地图后,通过激光匹配的方法推算地图采集平台的轨迹数据,存储的数据中包含了位置和航向信息;对组合导航进行有效性进行判断,保存其轨迹数据,其中包含了位置和航向信息。
优选地,所述建立偏差方程单元用于,采用最小二乘法对激光匹配轨迹进行局部拟合,给定数据点pi(xi,yi,zi),其中i=1,2,…,m,求近似曲线并且使得近似曲线与y=f(x)的偏差最小,近似曲线在点pi处的偏差 曲线拟合公式如下:
建立一个激光匹配轨迹点数组队列,将其按顺序填入a个轨迹点的位置坐标,通过最小二乘公式建立直线方程,然后,在a个轨迹点头部去除1个数据,最后在尾部循环填入一个数据,以此类推会按顺序建立N个直线方程;同理在时间对齐的情况下,组合导航轨迹线也采用相同的方法按顺序建立N个直线方程。
优选地,所述计算轨迹点偏差值单元用于,选择激光匹配轨迹线和组合导航轨迹线两条轨迹中一条轨迹的N个直线方程,再使用其相对轨迹线的轨迹点,通过点到直线的距离公式,即可得到两条轨迹偏差。
优选地,所述判断并输出差值较大点坐标单元用于,将轨迹点的坐标组成一个队列,在队列中建立一个滑动窗口,将位置与航向作差后的数据按顺序取b个值放入滑动窗口中,计算滑动窗口中数据的方差并记录,窗口中第一个数据会实时弹出,并在窗口尾部按顺序加入新的航位插值,以此类推,能够得到整条轨迹线上每个点对应航位变化的方差,通过航位方差与预设阈值比对,能够判断出两条轨迹出现偏差的较大点的位置,并根据轨迹点的ID输出对应轨迹点的坐标值。
以上所述仅是本发明的优选实施方式,应当指出的是,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (10)
1.一种检测激光建图里程计与组合导航定位偏差的方法,其特征在于,包括如下步骤:
(1)轨迹数据的预处理;
(2)建立偏差方程;
(3)计算轨迹点偏差值;
(4)判断并输出差值较大点坐标。
2.根据权利要求1所述的一种检测激光建图里程计与组合导航定位偏差的方法,其特征在于,
在步骤(1)中,首先建立激光点云地图,对点云进行合理的抽析,通过设定关键帧的距离来控制点云的密度,在初步建立点云地图后,通过激光匹配的方法推算地图采集平台的轨迹数据,存储的数据中包含了位置和航向信息;对组合导航进行有效性进行判断,保存其轨迹数据,其中包含了位置和航向信息。
4.根据权利要求3所述的一种检测激光建图里程计与组合导航定位偏差的方法,其特征在于,
在步骤(3)中,选择激光匹配轨迹线和组合导航轨迹线两条轨迹中一条轨迹的N个直线方程,再使用其相对轨迹线的轨迹点,通过点到直线的距离公式,即可得到两条轨迹偏差。
5.根据权利要求4所述的一种检测激光建图里程计与组合导航定位偏差的方法,其特征在于,
在步骤(4)中,将轨迹点的坐标组成一个队列,在队列中建立一个滑动窗口,将位置与航向作差后的数据按顺序取b个值放入滑动窗口中,计算滑动窗口中数据的方差并记录,窗口中第一个数据会实时弹出,并在窗口尾部按顺序加入新的航位插值,以此类推,能够得到整条轨迹线上每个点对应航位变化的方差,通过航位方差与预设阈值比对,能够判断出两条轨迹出现偏差的较大点的位置,并根据轨迹点的ID输出对应轨迹点的坐标值。
6.一种检测激光建图里程计与组合导航定位偏差的系统,其特征在于,包括:
(1)轨迹数据的预处理单元;
(2)建立偏差方程单元;
(3)计算轨迹点偏差值单元;
(4)判断并输出差值较大点坐标单元。
7.根据权利要求6所述的一种检测激光建图里程计与组合导航定位偏差的系统,其特征在于,
所述轨迹数据的预处理单元用于,首先建立激光点云地图,对点云进行合理的抽析,通过设定关键帧的距离来控制点云的密度,在初步建立点云地图后,通过激光匹配的方法推算地图采集平台的轨迹数据,存储的数据中包含了位置和航向信息;对组合导航进行有效性进行判断,保存其轨迹数据,其中包含了位置和航向信息。
8.根据权利要求7所述的一种检测激光建图里程计与组合导航定位偏差的系统,其特征在于,
所述建立偏差方程单元用于,采用最小二乘法对激光匹配轨迹进行局部拟合,给定数据点pi(xi,yi,zi),其中i=1,2,…,m,求近似曲线并且使得近似曲线与y=f(x)的偏差最小,近似曲线在点pi处的偏差i=1,2,...,m,曲线拟合公式如下:
建立一个激光匹配轨迹点数组队列,将其按顺序填入a个轨迹点的位置坐标,通过最小二乘公式建立直线方程,然后,在a个轨迹点头部去除1个数据,最后在尾部循环填入一个数据,以此类推会按顺序建立N个直线方程;同理在时间对齐的情况下,组合导航轨迹线也采用相同的方法按顺序建立N个直线方程。
9.根据权利要求8所述的一种检测激光建图里程计与组合导航定位偏差的系统,其特征在于,
所述计算轨迹点偏差值单元用于,选择激光匹配轨迹线和组合导航轨迹线两条轨迹中一条轨迹的N个直线方程,再使用其相对轨迹线的轨迹点,通过点到直线的距离公式,即可得到两条轨迹偏差。
10.根据权利要求9所述的一种检测激光建图里程计与组合导航定位偏差的系统,其特征在于,
所述判断并输出差值较大点坐标单元用于,将轨迹点的坐标组成一个队列,在队列中建立一个滑动窗口,将位置与航向作差后的数据按顺序取b个值放入滑动窗口中,计算滑动窗口中数据的方差并记录,窗口中第一个数据会实时弹出,并在窗口尾部按顺序加入新的航位插值,以此类推,能够得到整条轨迹线上每个点对应航位变化的方差,通过航位方差与预设阈值比对,能够判断出两条轨迹出现偏差的较大点的位置,并根据轨迹点的ID输出对应轨迹点的坐标值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010293823.3A CN113532472A (zh) | 2020-04-15 | 2020-04-15 | 一种检测激光建图里程计与组合导航定位偏差的方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010293823.3A CN113532472A (zh) | 2020-04-15 | 2020-04-15 | 一种检测激光建图里程计与组合导航定位偏差的方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113532472A true CN113532472A (zh) | 2021-10-22 |
Family
ID=78088168
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010293823.3A Pending CN113532472A (zh) | 2020-04-15 | 2020-04-15 | 一种检测激光建图里程计与组合导航定位偏差的方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113532472A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116840820A (zh) * | 2023-08-29 | 2023-10-03 | 上海仙工智能科技有限公司 | 一种检测2d激光定位丢失的方法及系统、存储介质 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110320155A1 (en) * | 2010-06-23 | 2011-12-29 | Aisin Aw Co., Ltd. | Track information generating device, track information generating method, and computer-readable storage medium |
CN102621554A (zh) * | 2011-01-21 | 2012-08-01 | 德国福维克控股公司 | 用于确定可自动移动设备的位置的方法 |
CN104180821A (zh) * | 2014-08-27 | 2014-12-03 | 北京航空航天大学 | 一种基于同步测量与定位计算的里程计标定方法 |
JP2017003363A (ja) * | 2015-06-08 | 2017-01-05 | 株式会社パスコ | 位置推定方法、位置推定装置及び位置推定プログラム |
CN106500727A (zh) * | 2016-10-21 | 2017-03-15 | 北京自动化控制设备研究所 | 一种基于路径匹配的惯导系统误差修正方法 |
CN107577646A (zh) * | 2017-08-23 | 2018-01-12 | 上海莫斐信息技术有限公司 | 一种高精度轨迹运算方法及系统 |
CN108645413A (zh) * | 2018-06-06 | 2018-10-12 | 江苏海事职业技术学院 | 一种移动机器人的同时定位与地图创建的动态纠正方法 |
CN110595479A (zh) * | 2019-09-23 | 2019-12-20 | 云南电网有限责任公司电力科学研究院 | 一种基于icp算法的slam轨迹评估方法 |
US20200041285A1 (en) * | 2017-03-30 | 2020-02-06 | Pioneer Corporation | Determination device, determination method and program |
-
2020
- 2020-04-15 CN CN202010293823.3A patent/CN113532472A/zh active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110320155A1 (en) * | 2010-06-23 | 2011-12-29 | Aisin Aw Co., Ltd. | Track information generating device, track information generating method, and computer-readable storage medium |
CN102621554A (zh) * | 2011-01-21 | 2012-08-01 | 德国福维克控股公司 | 用于确定可自动移动设备的位置的方法 |
CN104180821A (zh) * | 2014-08-27 | 2014-12-03 | 北京航空航天大学 | 一种基于同步测量与定位计算的里程计标定方法 |
JP2017003363A (ja) * | 2015-06-08 | 2017-01-05 | 株式会社パスコ | 位置推定方法、位置推定装置及び位置推定プログラム |
CN106500727A (zh) * | 2016-10-21 | 2017-03-15 | 北京自动化控制设备研究所 | 一种基于路径匹配的惯导系统误差修正方法 |
US20200041285A1 (en) * | 2017-03-30 | 2020-02-06 | Pioneer Corporation | Determination device, determination method and program |
CN107577646A (zh) * | 2017-08-23 | 2018-01-12 | 上海莫斐信息技术有限公司 | 一种高精度轨迹运算方法及系统 |
CN108645413A (zh) * | 2018-06-06 | 2018-10-12 | 江苏海事职业技术学院 | 一种移动机器人的同时定位与地图创建的动态纠正方法 |
CN110595479A (zh) * | 2019-09-23 | 2019-12-20 | 云南电网有限责任公司电力科学研究院 | 一种基于icp算法的slam轨迹评估方法 |
Non-Patent Citations (3)
Title |
---|
章大勇: "激光雷达/惯性组合导航系统的一致性与最优估计问题研究", 中国博士学位论文全文数据库 (信息科技辑), 15 August 2011 (2011-08-15), pages 136 - 81 * |
谢辉: "结构化道路中动态车辆的轨迹预测", 汽车安全与节能学报, 15 December 2019 (2019-12-15), pages 413 - 422 * |
陈洪: "GPS在机载激光雷达技术中的应用", 中国优秀硕士学位论文全文数据库 (基础科学辑), 15 October 2012 (2012-10-15), pages 008 - 83 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116840820A (zh) * | 2023-08-29 | 2023-10-03 | 上海仙工智能科技有限公司 | 一种检测2d激光定位丢失的方法及系统、存储介质 |
CN116840820B (zh) * | 2023-08-29 | 2023-11-24 | 上海仙工智能科技有限公司 | 一种检测2d激光定位丢失的方法及系统、存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109341706B (zh) | 一种面向无人驾驶汽车的多特征融合地图的制作方法 | |
CN110400490B (zh) | 轨迹预测方法和装置 | |
CN105957342B (zh) | 基于众包时空大数据的车道级道路测图方法及系统 | |
CN109084786B (zh) | 一种地图数据的处理方法 | |
CN110008872B (zh) | 一种结合车辆轨迹和遥感图像的路网提取方法 | |
CN114812581B (zh) | 一种基于多传感器融合的越野环境导航方法 | |
CN102208036B (zh) | 车辆位置检测系统 | |
CN109410586A (zh) | 一种基于多元数据融合的交通状态检测方法 | |
EP2591443B1 (en) | Method for assisting vehicle guidance over terrain | |
CN106710208A (zh) | 交通状态的获取方法及装置 | |
CN109459047A (zh) | 车辆高精度定位数据与导航地图精确匹配及变道行为探测方法 | |
CN107664504A (zh) | 一种路径规划装置 | |
CN108508471A (zh) | 一种无人驾驶车辆定位方法及装置 | |
CN114005280A (zh) | 一种基于不确定性估计的车辆轨迹预测方法 | |
CN105225478A (zh) | 智能车辆行为记录及评价方法 | |
CN112633602B (zh) | 一种基于gis地图信息的交通拥堵指数预测方法及装置 | |
CN111257853B (zh) | 一种基于imu预积分的自动驾驶系统激光雷达在线标定方法 | |
Fu et al. | Path planning and decision making for autonomous vehicle in urban environment | |
CN115635961A (zh) | 样本数据生成方法及应用其的轨迹预测方法、装置 | |
CN113532472A (zh) | 一种检测激光建图里程计与组合导航定位偏差的方法及系统 | |
CN111562605B (zh) | 自适应的gps错误观测值识别方法 | |
CN114842660B (zh) | 一种无人车道路轨迹预测方法、装置和电子设备 | |
Wang et al. | DRR-LIO: A dynamic-region-removal-based LiDAR inertial odometry in dynamic environments | |
CN113447039B (zh) | 一种基于测绘信息的高精度道路最短路径计算方法 | |
CN111323026A (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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20220222 Address after: 401122 No.1, 1st floor, building 3, No.21 Yunzhu Road, Yubei District, Chongqing Applicant after: Chongqing landshipu Information Technology Co.,Ltd. Address before: B416 (b4-006), maker Plaza, 338 Huilongguan East Street, Changping District, Beijing, 102208 Applicant before: Beijing Idriverplus Technology Co.,Ltd. |
|
TA01 | Transfer of patent application right |