CN116642501A - 一种惯性为核心的车道线辅助定位的多源融合方法 - Google Patents
一种惯性为核心的车道线辅助定位的多源融合方法 Download PDFInfo
- Publication number
- CN116642501A CN116642501A CN202310913664.6A CN202310913664A CN116642501A CN 116642501 A CN116642501 A CN 116642501A CN 202310913664 A CN202310913664 A CN 202310913664A CN 116642501 A CN116642501 A CN 116642501A
- Authority
- CN
- China
- Prior art keywords
- lane line
- representing
- lane
- positioning
- 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
- 238000007500 overflow downdraw method Methods 0.000 title claims abstract description 13
- 238000000034 method Methods 0.000 claims description 25
- 238000001914 filtration Methods 0.000 claims description 15
- 230000008569 process Effects 0.000 claims description 11
- 238000005259 measurement Methods 0.000 claims description 9
- 230000002159 abnormal effect Effects 0.000 claims description 8
- 239000011159 matrix material Substances 0.000 claims description 8
- 238000001514 detection method Methods 0.000 claims description 7
- 239000002245 particle Substances 0.000 claims description 6
- 238000009499 grossing Methods 0.000 claims description 5
- 238000003708 edge detection Methods 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 230000004807 localization Effects 0.000 claims 4
- 230000004927 fusion Effects 0.000 abstract description 4
- 238000005457 optimization Methods 0.000 abstract description 2
- 230000000007 visual effect Effects 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 238000000605 extraction Methods 0.000 description 2
- 239000000243 solution Substances 0.000 description 2
- FGUUSXIOTUKUDN-IBGZPJMESA-N C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 Chemical compound C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 FGUUSXIOTUKUDN-IBGZPJMESA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010790 dilution Methods 0.000 description 1
- 239000012895 dilution Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000007499 fusion processing Methods 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
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/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
-
- 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/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种惯性为核心的车道线辅助定位的多源融合方法,属于多源传感器融合定位技术领域,引入性能指标来衡量卫星的可用性和特征点几何分布的优度,并将其作为参与优化的准则;引入高精度地图,将其识别的车道线距离与相机预测的车辆到车道线距离作为侧向约束,带入到多状态约束下的卡尔曼滤波器MSCKF(Multi‑State Constraint Kalman Filter)中,提高***的定位精度。本发明有效抑制误差的发散且不会引入地图匹配的误差,提供了连续、可靠的定位结果。
Description
技术领域
本发明属于多源传感器融合定位技术领域,具体涉及一种惯性(IMU,InertialMeasurement Unit)为核心的车道线辅助定位的多源融合方法。
背景技术
近年来,智能驾驶、无人导航定位等新兴技术的快速发展,其对于高精度定位的需求也越来越高,任何单一的传感器已经无法满足复杂环境下的定位,实现高精度、高可靠的定位是只能驾驶发展的关键,因此,多源传感器融合已成为工业界关注的热点。
惯性导航***INS (Inertial Navigation System, INS) 因其航迹推算的定位方式,由于积分的影响,误差会随着时间的延续而积累,造成定位结果的发散。目前成熟的算法GNSS/INS组合定位的方式,可以对INS误差进行补偿,而INS预测信息也能辅助GNSS的模糊度固定。然而在城市环境下(楼群、高架桥、隧道等)GNSS信号受干扰比较严重,可能导致卫星信号长时间失锁或者定位异常,INS的误差也不能得到补偿,定位精度大大下降,因此需要其他传感器的辅助定位。视觉传感器定位能在一定程度上缓解GNSS长时间不可用的情况,作为一种匹配定位的方式,其定位精度受到环境光照强度、纹理强弱等影响,从而特征点的误匹配,影响定位精度,在应用过程中也会受到一定程度上的限制。
目前,高精度地图辅助GNSS/INS/视觉定位基本采用的地图匹配的方法识别车道线,地图匹配主要分为点-点、点-线、线-线三种匹配方式,点-点匹配依赖于节点的数量,需要大量的定位节点,点-线匹配算法需要先识别出一些线段,然后进行搜索最短线段,线-线匹配方式精度较高,但算法复杂,实时性较差,且相机识别的车道线与高精度地图匹配融合之后得到的定位结果,在融合的过程中,地图匹配中的误差也会引入。在GNSS挑战环境下,如城市峡谷,由于GNSS卫星分布不均匀,可能只分布于某一方向,导致GNSS/INS/视觉集成定位结果的可靠性较差,另一方面,由于特征点的分布也是视觉定位的关键,在一些环境下,特征点的几何分布结构较差,也会导致最终定位结果不准确。因此,在GNSS/INS/视觉集成定位时,需要综合考虑到GNSS卫星的分布与有效卫星数和特征点的分布情况。
发明内容
为了解决上述问题,本发明提出一种惯性为核心的车道线辅助定位的多源融合方法。一方面,对GNSS的状态进行检核,处于失锁或定位异常状态均不参与结算;另外,在城市复杂环境下,GNSS卫星与特征点的分布也会影响定位的精度,本发明引入性能指标来衡量卫星的可用性和特征点几何分布的优度,并将其作为是否将该传感器测量值添加到滤波器的标准,实现选择性集成定位,***具有灵活性;另一方面,引入高精度地图,通过识别车辆运行时两侧的车道线,并计算车辆到左侧车道线的距离,将该距离与相机预测的车辆到车道线距离做差,作为一种侧向约束,带入到MSCKF滤波中,提高***的定位精度。
本发明实现其目的所采取的技术方案是:
一种惯性为核心的车道线辅助定位的多源融合方法,包括如下步骤:
步骤(1)对于信号失锁的情况,通过检测一段时间内卫星颗数,在时间长度k内,若有效卫星颗数持续少于4颗,则GNSS信号不参与解算;
步骤(2)对于定位异常的情况,检测一段时间内卫星分布的空间几何强度因子PDOP与有效卫星颗数的跳变情况;
步骤(3)引入高精度地图,通过高精度地图识别车辆所在的车道线信息,进而测量出车辆距离车道线的距离;
步骤(4)使用单目相机通过高斯滤波平滑、边缘点检测提取车道线轮廓信息,通过多项式建模建立车道线模型,通过车道线轮廓信息和车道线模型分别计算出车辆到车道线之间的距离;
步骤(5)将步骤(4)中通过车道线轮廓信息和车道线建模分别计算出的车辆到车道线之间的距离做差并带入滤波中优化解算载***置信息;
步骤(6)以惯性为核心,引入性能指标以选择性集成多传感器,当有效卫星颗数不足或者测量特征点数量较少时,通过性能指标识别与判断。
本发明的有益效果在于:
针对GNSS/INS/视觉多源传感器融合定位,以INS为核心,首先对于GNSS的卫星颗数及定位状态进行检测,然后根据性能指标来判断GNSS与视觉是否参与集成解算,定位方式灵活。加入高精度地图的辅助,将相机识别到的车道线距离与高精度地图计算得到的车道线距离,将两者直接做差来提供横约束加入到卡尔曼滤波中,有效抑制误差的发散且不会引入地图匹配的误差,提供了连续、可靠的定位结果。
附图说明
图1为本发明的一种惯性为核心的车道线辅助定位的多源融合方法流程示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明引入性能指标来衡量卫星的可用性和特征点几何分布的优度,并将其作为参与优化的准则;引入高精度地图,将其识别的车道线距离与相机预测的车辆到车道线距离作为侧向约束,带入到MSCKF滤波中,提高***的定位精度。
城市环境下GNSS信号可能受遮挡严重,会出现信号失锁或定位异常,此时添加判断来识别是否参与解算。信号失锁是指GNSS接收机接收不到信号或者有效卫星数少于4颗,定位异常是指由于信号的遮挡导致卫星的可见卫星数变化较大,卫星分布的空间几何强度因子PDOP (Position Dilution of Precision, PDOP) 值也变化较大。
如图1所示,本发明的一种惯性为核心的车道线辅助定位的多源融合方法具体包括如下步骤:
步骤a) 对于信号失锁的情况,可通过检测一段时间内卫星颗数,认为在时间段k内,如果有效卫星颗数持续少于4颗,则GNSS信号不参与解算。
(1)
式中,k表示时间长度,表示k时间段内单历元有效卫星颗数/>少于的次数,/>为设定的阈值。当/>大于一定的阈值时,表示GNSS信号失锁,此时GNSS不参与解算。
步骤b) 对于定位异常的情况,可通过检测一段时间内卫星分布的空间几何强度因子PDOP与有效卫星颗数的跳变情况。记相邻两个历元之间的卫星颗数变化之差和空间几何强度因子PDOP变化之差为:
(2)
(3)
式中,、/>分别表示i历元和i-1历元的卫星颗数,/>、/>分别表示i历元和i-1历元的卫星PDOP值,/>、/>分别表示相邻两个历元之间的卫星颗数之差与空间几何强度因子PDOP之差。
时间长度k内,、/>超过一定的阈值与时间长度k之间的比值记为:
(4)
(5)
式中,、/>为设定的阈值,/>表示k时间段内相邻两个历元卫星颗数之差/>大于/>的次数,/>表示k时间段内相邻两个历元PDOP值之差/>大于/>的次数。当/>或/>大于一定阈值时,认为GNSS定位状态异常,此时GNSS信号不参与解算。
步骤c)引入高精度地图,通过地图识别车辆所在的车道线信息,进而测量出车辆距离车道线的距离,具体包括:
通过惯性导航***预测的位置信息,识别到当前车辆最近的车道线,然后将当前车辆位置投影于车道线上,计算得到车辆与车道线之间的距离。假设P点为距离车辆最近的相机正前方的点,则惯性导航***机械编排估计得到的P点的位置信息可以得到高精度地图中的车道线信息,进一步地,利用点到直线关系,P点投影到车道线得到,即可得到P点到车道线的距离。需要注意的是,惯性导航***预测是车辆在IMU(Inertial MeasurementUnit, IMU)坐标系下的位置,需要用过杆臂补偿的方式归算得到P点的位置。
(6)
式中,表示P点在导航坐标系n系的位置信息,/>表示惯性导航***估计得到的车辆在导航坐标系n系下的位置信息,/>表示从载体坐标系b系转换到导航坐标系n系的方向余弦矩阵,/>表示相机与惯性导航***之间的杆臂。
定义相机坐标系以车辆前进方向为x轴,y轴垂直于x轴指向左为正,惯性导航***坐标系x轴与y轴均与相机坐标系平行,z轴垂直于xoy平面构成右手坐标系。由于车道线只是对于载体的横向误差进行约束,所以只考虑横向车辆到车道线的距离,且假设车道线为直线。
步骤d)单目相机可以通过高斯滤波平滑、边缘点检测等识别出轮廓信息,进一步多项式建模得到车道线,也可以计算出车辆到车道线之间的距离。将两种方式计算得到的车辆到车道线之间的距离做差,代入到MSCKF滤波中进行优化解算,从而得到车辆位置信息。
相机探测识别车道线主要分为两大部分,轮廓提取与建模。车道线轮廓提取主要是计算机视觉相关内容,包括相片的高斯滤波平滑、边缘检测、轮廓信息的生成及过滤非轮廓信息等步骤。车道线建模主要是采用霍夫变换及曲线拟合的方式建立车道线模型。根据相机坐标系及车道线函数模型即可表示出车道线与相机之间的关系。
步骤e) 高精度地图识别得到的车道线距离与相机识别检测得到的车道线距离之差作为观测值,可得:
(7)
式中,、/>分别表示地图得到的车线距离观测量与相机识别检测得到的车道线距离。可将该式加入到卡尔曼滤波的观测方程中形成约束。
步骤f)以惯性导航***为核心,引入性能指标来选择性集成多传感器,假设卡尔曼滤波(MSCKF)总的观测方程为:
(8)
式中,表示观测向量,/>表示系数矩阵,/>表示状态向量,/>表示测量噪声。假设每个GNSS测量值与相机的测量值之间独立,权重函数一般与协方差矩阵成反比,可以定义为:
(9)
(10)
式中,W为权重,表示尺度常数用来定义权重,/>表示GNSS的误差协方差,表示特征点的误差协方差,/>表示/>的协方差矩阵,/>的协方差矩阵可以写成:
(11)
(12)
式中,表示状态向量,H表示系数矩阵。
性能指标WDOP记为:
(13)
式中,Trace表示求迹符号。
由于卫星的分布以及特征点的几何分布会影响最终的定位性能,当特征点分布在较窄的区域或卫星在水平方向与特征点分布方向一致时,会导致定位结果不准确,因此引入性能指标来选择性集成解算,当有效卫星颗数不足或者测量特征点数量较少的情况会被性能指标WDOP识别与判断。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种惯性为核心的车道线辅助定位的多源融合方法,其特征在于,包括如下步骤:
步骤(1)对于信号失锁的情况,通过检测一段时间内卫星颗数,在时间长度k内,若有效卫星颗数持续少于4颗,则GNSS信号不参与解算;
步骤(2)对于定位异常的情况,检测一段时间内卫星分布的空间几何强度因子PDOP与有效卫星颗数的跳变情况;
步骤(3)引入高精度地图,通过高精度地图识别车辆所在的车道线信息,进而测量出车辆距离车道线的距离;
步骤(4)使用单目相机通过高斯滤波平滑、边缘点检测提取车道线轮廓信息,通过多项式建模建立车道线模型,通过车道线轮廓信息和车道线模型分别计算出车辆到车道线之间的距离;
步骤(5)将步骤(4)中通过车道线轮廓信息和车道线建模分别计算出的车辆到车道线之间的距离做差并带入滤波中优化解算载***置信息;
步骤(6)以惯性为核心,引入性能指标以选择性集成多传感器,当有效卫星颗数不足或者测量特征点数量不足时,通过性能指标识别与判断。
2.根据权利要求1所述的一种惯性为核心的车道线辅助定位的多源融合方法,其特征在于,所述步骤(2)包括:
记相邻两个历元之间的卫星颗数变化之差和空间几何强度因子PDOP变化之差为:
(2)
(3)
式中,、/>分别表示i历元和i-1历元的卫星颗数,/>、/>分别表示i历元和i-1历元的卫星的空间几何强度因子PDOP值,/>、/>分别表示相邻两个历元之间的卫星颗数之差与空间几何强度因子PDOP之差;
时间长度k内,、/>超过阈值与时间长度k之间的比值记为:
(4)
(5)
式中,、/>为设定的阈值,/>表示k时间段内相邻两个历元卫星颗数之差大于/>的次数,/>表示k时间段内相邻两个历元的空间几何强度因子PDOP值之差/>大于/>的次数;当/>或/>大于阈值时,认为GNSS定位状态异常,GNSS信号不参与解算。
3.根据权利要求2所述的一种惯性为核心的车道线辅助定位的多源融合方法,其特征在于,所述步骤(3)包括:
通过惯性导航***预测的位置信息,识别到当前车辆最近的车道线,然后将当前车辆的位置投影于车道线上,计算得到当前车辆与车道线之间的距离;假设P点为距离当前车辆最近的相机正前方的点,则通过惯性导航***机械编排估计得到的P点的位置信息得到高精度地图中的车道线信息,利用点到直线关系,P点投影到车道线得到,即得到P点到车道线的距离。
4.根据权利要求3所述的一种惯性为核心的车道线辅助定位的多源融合方法,其特征在于,所述步骤(4)中,提取车道线轮廓信息包括对单目相机获得的相片进行高斯滤波平滑、边缘检测、轮廓信息的生成及过滤非轮廓信息;采用霍夫变换及曲线拟合的方式建立车道线模型。
5.根据权利要求4所述的一种惯性为核心的车道线辅助定位的多源融合方法,其特征在于,所述步骤(5)包括:
高精度地图识别得到的车道线距离与单目相机识别检测得到的车道线距离之差作为观测值,得到:
(7)
式中,、/>分别表示高精度地图得到的车道线距离与单目相机识别检测得到的车道线距离;将式(7)加入到卡尔曼滤波的观测方程中形成约束。
6.根据权利要求5所述的一种惯性为核心的车道线辅助定位的多源融合方法,其特征在于,所述步骤(6)包括:
假设卡尔曼滤波总的观测方程为:
(8)
式中,表示观测向量,/>表示系数矩阵,/>表示状态向量,/>表示测量噪声;假设每个GNSS测量值与单目相机的测量值之间独立,权重函数与协方差矩阵成反比,定义为:
(9)
(10)
式中,W为权重,表示尺度常数用来定义权重,/>表示GNSS的误差协方差,/>表示特征点的误差协方差,/>表示/>的协方差矩阵,/>的协方差矩阵写成:
(11)
(12)
式中:表示状态向量,H表示系数矩阵;E[]表示状态函数;
性能指标WDOP记为:
(13)
式中,Trace表示求迹符号。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310913664.6A CN116642501B (zh) | 2023-07-25 | 2023-07-25 | 一种惯性为核心的车道线辅助定位的多源融合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310913664.6A CN116642501B (zh) | 2023-07-25 | 2023-07-25 | 一种惯性为核心的车道线辅助定位的多源融合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116642501A true CN116642501A (zh) | 2023-08-25 |
CN116642501B CN116642501B (zh) | 2023-09-29 |
Family
ID=87640334
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310913664.6A Active CN116642501B (zh) | 2023-07-25 | 2023-07-25 | 一种惯性为核心的车道线辅助定位的多源融合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116642501B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120150437A1 (en) * | 2010-12-13 | 2012-06-14 | Gm Global Technology Operations Llc. | Systems and Methods for Precise Sub-Lane Vehicle Positioning |
CN107703528A (zh) * | 2017-09-25 | 2018-02-16 | 武汉光庭科技有限公司 | 自动驾驶中结合低精度gps的视觉定位方法及*** |
CN107782321A (zh) * | 2017-10-10 | 2018-03-09 | 武汉迈普时空导航科技有限公司 | 一种基于视觉和高精度地图车道线约束的组合导航方法 |
CN110411462A (zh) * | 2019-07-22 | 2019-11-05 | 武汉大学 | 一种gnss/惯性/车道线约束/里程计多源融合方法 |
US20200218906A1 (en) * | 2019-01-08 | 2020-07-09 | Qualcomm Incorporated | Robust lane association by projecting 2-d image into 3-d world using map information |
CN112731496A (zh) * | 2020-12-07 | 2021-04-30 | 中国科学院空天信息创新研究院 | 一种面向智能终端的gnss精密单点定位数据质量控制方法 |
US11002859B1 (en) * | 2020-02-27 | 2021-05-11 | Tsinghua University | Intelligent vehicle positioning method based on feature point calibration |
CN113029137A (zh) * | 2021-04-01 | 2021-06-25 | 清华大学 | 一种多源信息自适应融合定位方法及*** |
US20210278549A1 (en) * | 2018-08-23 | 2021-09-09 | The Regents Of The University Of California | Lane-level navigation system for ground vehicles with lidar and cellular signals |
CN114002725A (zh) * | 2021-11-01 | 2022-02-01 | 武汉中海庭数据技术有限公司 | 一种车道线辅助定位方法、装置、电子设备及存储介质 |
US20220292711A1 (en) * | 2021-03-10 | 2022-09-15 | Beijing Tusen Zhitu Technology Co., Ltd. | Pose estimation method and device, related equipment and storage medium |
-
2023
- 2023-07-25 CN CN202310913664.6A patent/CN116642501B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120150437A1 (en) * | 2010-12-13 | 2012-06-14 | Gm Global Technology Operations Llc. | Systems and Methods for Precise Sub-Lane Vehicle Positioning |
CN107703528A (zh) * | 2017-09-25 | 2018-02-16 | 武汉光庭科技有限公司 | 自动驾驶中结合低精度gps的视觉定位方法及*** |
CN107782321A (zh) * | 2017-10-10 | 2018-03-09 | 武汉迈普时空导航科技有限公司 | 一种基于视觉和高精度地图车道线约束的组合导航方法 |
US20210278549A1 (en) * | 2018-08-23 | 2021-09-09 | The Regents Of The University Of California | Lane-level navigation system for ground vehicles with lidar and cellular signals |
US20200218906A1 (en) * | 2019-01-08 | 2020-07-09 | Qualcomm Incorporated | Robust lane association by projecting 2-d image into 3-d world using map information |
CN110411462A (zh) * | 2019-07-22 | 2019-11-05 | 武汉大学 | 一种gnss/惯性/车道线约束/里程计多源融合方法 |
US11002859B1 (en) * | 2020-02-27 | 2021-05-11 | Tsinghua University | Intelligent vehicle positioning method based on feature point calibration |
CN112731496A (zh) * | 2020-12-07 | 2021-04-30 | 中国科学院空天信息创新研究院 | 一种面向智能终端的gnss精密单点定位数据质量控制方法 |
US20220292711A1 (en) * | 2021-03-10 | 2022-09-15 | Beijing Tusen Zhitu Technology Co., Ltd. | Pose estimation method and device, related equipment and storage medium |
CN113029137A (zh) * | 2021-04-01 | 2021-06-25 | 清华大学 | 一种多源信息自适应融合定位方法及*** |
CN114002725A (zh) * | 2021-11-01 | 2022-02-01 | 武汉中海庭数据技术有限公司 | 一种车道线辅助定位方法、装置、电子设备及存储介质 |
Non-Patent Citations (4)
Title |
---|
JIN-YAN HSU; KUN-LUNG KU; TONG-KAI JHANG;等: "Implementation of phase lead controller for lane following system based on identified vehicle lateral model", 2017 INTERNATIONAL AUTOMATIC CONTROL CONFERENCE * |
刘华;刘彤;张继伟;: "陆地车辆GNSS/MEMS惯性组合导航机体系约束算法研究", 北京理工大学学报, vol. 33, no. 05 * |
汤勇刚;杨建文;吴文启;胡小平;: "无源北斗/捷联惯导(SINS)紧组合导航技术的应用研究", 电光与控制, vol. 14, no. 02 * |
郭延熹: "融合定位技术在港口自动驾驶车辆中的应用", 河南科技, no. 26 * |
Also Published As
Publication number | Publication date |
---|---|
CN116642501B (zh) | 2023-09-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110411462B (zh) | 一种gnss/惯导/车道线约束/里程计多源融合方法 | |
CN112268559B (zh) | 复杂环境下融合slam技术的移动测量方法 | |
CN102529975B (zh) | 用于精确的分车道车辆定位的***和方法 | |
CN107782321B (zh) | 一种基于视觉和高精度地图车道线约束的组合导航方法 | |
CN111707272B (zh) | 一种地下车库自动驾驶激光定位*** | |
CN103940434B (zh) | 基于单目视觉和惯性导航单元的实时车道线检测*** | |
CN114526745B (zh) | 一种紧耦合激光雷达和惯性里程计的建图方法及*** | |
CN107064974A (zh) | 一种抑制城市峡谷多径卫星信号的定位方法和*** | |
CN105667518A (zh) | 车道检测的方法及装置 | |
Randeniya et al. | Vision–IMU integration using a slow-frame-rate monocular vision system in an actual roadway setting | |
CN104240536A (zh) | 一种带有电子水平仪的车道监控方法 | |
CN111742326A (zh) | 车道线的检测方法、电子设备与存储介质 | |
JP2001331787A (ja) | 道路形状推定装置 | |
CN105865461A (zh) | 一种基于多传感器融合算法的汽车定位***及方法 | |
CN112346103A (zh) | 基于v2x的智能网联汽车动态协同定位方法与装置 | |
CN114966734A (zh) | 一种结合多线激光雷达的双向深度视觉惯性位姿估计方法 | |
CN112147651B (zh) | 一种异步多车协同目标状态鲁棒估计方法 | |
CN106443742A (zh) | 一种基于惯性组合导航的精度指示方法及装置、车辆 | |
CN111487960A (zh) | 一种基于定位能力估计的移动机器人路径规划方法 | |
CN111267912B (zh) | 基于多源信息融合的列车定位方法和*** | |
CN115930977A (zh) | 特征退化场景的定位方法、***、电子设备和可读存介质 | |
CN112967316B (zh) | 一种面向3d多目标追踪的运动补偿优化方法及*** | |
Guo et al. | A lane-level localization method via the lateral displacement estimation model on expressway | |
Zhao et al. | An improved particle filter based on gravity measurement feature in gravity-aided inertial navigation system | |
CN116642501B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |