CN108732603B - 用于定位车辆的方法和装置 - Google Patents
用于定位车辆的方法和装置 Download PDFInfo
- Publication number
- CN108732603B CN108732603B CN201710249842.4A CN201710249842A CN108732603B CN 108732603 B CN108732603 B CN 108732603B CN 201710249842 A CN201710249842 A CN 201710249842A CN 108732603 B CN108732603 B CN 108732603B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- positioning
- map
- satellite
- matching
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 57
- 238000004364 calculation method Methods 0.000 claims abstract description 18
- 238000005259 measurement Methods 0.000 claims description 34
- 230000004927 fusion Effects 0.000 claims description 23
- 230000008859 change Effects 0.000 claims description 22
- 238000004590 computer program Methods 0.000 claims description 10
- 238000004422 calculation algorithm Methods 0.000 claims description 7
- 238000000819 phase cycle Methods 0.000 claims description 6
- 238000011084 recovery Methods 0.000 claims 1
- 238000012545 processing Methods 0.000 description 15
- 230000008569 process Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 9
- 238000005516 engineering process Methods 0.000 description 8
- 238000004891 communication Methods 0.000 description 7
- 230000006870 function Effects 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 4
- 239000011159 matrix material Substances 0.000 description 4
- 230000003287 optical effect Effects 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 239000000835 fiber Substances 0.000 description 2
- 230000008520 organization Effects 0.000 description 2
- 230000000644 propagated effect Effects 0.000 description 2
- 230000008439 repair process Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001934 delay Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 239000005436 troposphere Substances 0.000 description 1
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
-
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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
-
- 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
- G01S17/42—Simultaneous measurement of distance and other co-ordinates
-
- 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/88—Lidar systems specially adapted for specific applications
-
- 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/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- 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
-
- 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/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/123—Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams
- G08G1/133—Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams within the vehicle ; Indicators inside the vehicles or at stops
- G08G1/137—Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams within the vehicle ; Indicators inside the vehicles or at stops the indicator being in the form of a map
Abstract
本申请公开了用于定位车辆的方法和装置。该方法的一实施方式包括:获取车载惯导系统在上一定位时刻与当前定位时刻之间进行捷联解算而确定的车辆在当前定位时刻的先验位置;使用先验位置在激光点云反射值地图中确定待搜索地图区域;将对车辆的车载激光雷达采集到的实时激光点云进行投影而生成的投影区域的反射值特征与待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置;使用先验位置结合车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置;对先验位置、地图匹配位置以及卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果。该实施方式实现了高精度的定位。
Description
技术领域
本申请涉及计算机技术领域,具体涉及定位技术领域,尤其涉及用于定位车辆的方法和装置。
背景技术
定位技术是无人车自动驾驶系统的核心技术之一,定位输出是无人驾驶系统中感知、路径规划等操作的关键输入。定位技术,需要具有高精度、高可靠性、高可用性和连续性强等性能,才能满足无人车应用场景的需求。
然而,现有的定位方式通常使用单一的技术进行定位,而每一种定位技术都存在其固有的一些缺陷,因此输出的位置精确度较低,无法满足无人驾驶以及其他需要精确定位的领域的需要。
发明内容
本申请的目的在于提出一种改进的用于定位车辆的方法和装置,来解决以上背景技术部分提到的技术问题。
第一方面,本申请实施例提供了一种用于定位车辆的方法,方法包括:获取待定位的车辆的车载惯导系统在上一定位时刻与当前定位时刻之间进行捷联解算而确定的车辆在当前定位时刻的先验位置;使用先验位置在激光点云反射值地图中确定预定范围的待搜索地图区域;将对车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置;使用先验位置结合车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置;对先验位置、地图匹配位置以及卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果。
在一些实施例中,上述方法还包括:对以车辆在每个定位时刻的车辆位置误差、车辆速度误差、车辆姿态误差、车载惯导系统中加速度计和陀螺仪的零偏误差以及车载全球卫星导航系统GNSS接收机的钟差与钟漂为状态变量的卡尔曼滤波器进行时间更新;以及,对先验位置、地图匹配位置以及卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果,包括:将地图匹配位置与先验位置之差和/或卫星定位位置与先验位置之差作为卡尔曼滤波器的观测值,对卡尔曼滤波器进行量测更新;使用量测更新后的车辆位置误差,对先验位置进行修正,以生成定位结果。
在一些实施例中,将对车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置,包括:计算投影区域的反射值特征与待搜索地图区域的各个样本位置所对应地图区域的反射值特征匹配的测量匹配概率;根据各个样本位置的坐标以及对应的测量匹配概率,生成地图匹配位置的坐标。
在一些实施例中,将对车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置,还包括:针对每个样本位置,将投影区域的中心与样本位置进行重合,确定激光点云反射值地图中与投影区域重合的区域为样本位置对应的地图区域。
在一些实施例中,上述方法还包括激光点云反射值地图生成步骤,包括:将地球表面在世界坐标系的地平面内划分为相同大小和形状的多个地图网格,每个地图网格与样本位置对应;将针对每个样本位置采集的样本激光点云的反射值特征存储在样本位置对应的地图网格中。
在一些实施例中,反射值特征包括激光点云的反射值均值;以及,计算投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率,包括:确定投影区域与样本位置对应的地图区域在各个地图网格上的反射值均值之差;以投影区域在各个地图网格中对应的激光点数量为权重,对各个地图网格上的反射值均值之差进行加权平均,根据所得到的加权平均值确定投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率。
在一些实施例中,根据对激光点云进行投影而得到的投影区域的反射值特征与待搜索地图区域的各个样本位置所对应地图区域的反射值特征匹配的测量匹配概率确定地图匹配位置,包括:根据先验位置以及卡尔曼滤波器进行时间更新所得到的先验位置的误差先验分布,确定车辆在当前时刻处于各个样本位置的预测概率;使用样本位置的预测概率对测量匹配概率进行修正,得到后验匹配概率;以样本位置对应的后验匹配概率作为权重,对各个样本位置的坐标进行加权平均,得到地图匹配位置所对应的坐标。
在一些实施例中,使用先验位置结合车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置,包括:根据先验位置设置车辆的车载GNSS接收机在当前时刻对每颗定位卫星进行观测所得到的观测数据的融合权重。
在一些实施例中,上述根据先验位置设置车辆的车载GNSS接收机在当前时刻对每颗定位卫星进行观测所得到的观测数据的融合权重,包括:根据先验位置以及每颗定位卫星的卫星位置对车辆与每个定位卫星的距离进行计算,得到计算值;获取车载GNSS接收机对每颗定位卫星进行观测得到的、车辆与每个定位卫星的距离的观测值,以确定每颗定位卫星所对应距离的残差;按照每颗定位卫星所对应的残差设置定位卫星所对应的观测数据的权重,其中定位卫星所对应的权重与定位卫星所对应的距离残差反相关。
在一些实施例中,上述使用先验位置结合车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置,包括:构建上一定位时刻与当前时刻的伪距观测方程以及载波单差观测方程,并将先验位置与上一定位时刻的定位结果之差设置为伪距观测方程以及载波单差观测方程中的坐标增量的初始值;根据伪距观测方程以及载波单差观测方程,确定车载GNSS接收机所对应的全球定位系统的载波相位周跳并修复,对坐标增量以及钟差变化进行抗差估计,得到估计值;在GNSS接收机与GNSS接收机对应的基准站之间构建双差观测方程,并将估计值设置为双差观测方程中坐标增量以及钟差变化的初始值;使用LAMBDA算法固定双差观测方程中的双差模糊度,以更新坐标增量以及钟差变化;使用更新后的坐标增量以及上一定位时刻的定位结果确定卫星定位位置。
第二方面,本申请实施例提供了一种用于定位车辆的装置,该装置包括:先验位置确定单元,用于获取待定位的车辆的车载惯导系统在上一定位时刻与当前定位时刻之间进行捷联解算而确定的车辆在当前定位时刻的先验位置;区域确定单元,用于使用先验位置在激光点云反射值地图中确定预定范围的待搜索地图区域;匹配单元,用于将对车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置;卫星定位单元,用于使用先验位置结合车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置;融合单元,用于对先验位置、地图匹配位置以及卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果。
在一些实施例中,上述装置还包括:时间更新单元,用于对以车辆在每个定位时刻的车辆位置误差、车辆速度误差、车辆姿态误差、车载惯导系统中加速度计和陀螺仪的零偏误差以及车载全球卫星导航系统GNSS接收机的钟差与钟漂为状态变量的卡尔曼滤波器进行时间更新;以及,融合单元进一步用于:将地图匹配位置与先验位置之差和/或卫星定位位置与先验位置之差作为卡尔曼滤波器的观测值,对卡尔曼滤波器进行量测更新;使用量测更新后的车辆位置误差,对先验位置进行修正,以生成定位结果。
在一些实施例中,匹配单元包括:计算子单元,用于计算投影区域的反射值特征与待搜索地图区域的各个样本位置所对应地图区域的反射值特征匹配的测量匹配概率;生成子单元,用于根据各个样本位置的坐标以及对应的测量匹配概率,生成地图匹配位置的坐标。
在一些实施例中,匹配单元还包括:确定子单元,用于针对每个样本位置,将投影区域的中心与样本位置进行重合,确定激光点云反射值地图中与投影区域重合的区域为样本位置对应的地图区域。
在一些实施例中,匹配单元还包括:确定子单元,用于针对每个样本位置,将投影区域的中心与样本位置进行重合,确定激光点云反射值地图中与投影区域重合的区域为样本位置对应的地图区域。
在一些实施例中,上述装置还包括激光点云反射值地图生成单元,用于:将地球表面在世界坐标系的地平面内划分为相同大小和形状的多个地图网格,每个地图网格与样本位置对应;将针对每个样本位置采集的样本激光点云的反射值特征存储在样本位置对应的地图网格中。
在一些实施例中,反射值特征包括激光点云的反射值均值;以及,计算子单元进一步用于:确定投影区域与样本位置对应的地图区域在各个地图网格上的反射值均值之差;以投影区域在各个地图网格中对应的激光点数量为权重,对各个地图网格上的反射值均值之差进行加权平均,根据所得到的加权平均值确定投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率。
在一些实施例中,生成子单元进一步用于:根据先验位置以及卡尔曼滤波器进行时间更新所得到的先验位置的误差先验分布,确定车辆在当前时刻处于各个样本位置的预测概率;使用样本位置的预测概率对测量匹配概率进行修正,得到后验匹配概率;以样本位置对应的后验匹配概率作为权重,对各个样本位置的坐标进行加权平均,得到地图匹配位置所对应的坐标。
在一些实施例中,卫星定位单元包括:设置子单元,用于根据先验位置设置车辆的车载GNSS接收机在当前时刻对每颗定位卫星进行观测所得到的观测数据的融合权重。
在一些实施例中,设置子单元进一步用于:根据先验位置以及每颗定位卫星的卫星位置对车辆与每个定位卫星的距离进行计算,得到计算值;获取车载GNSS接收机对每颗定位卫星进行观测得到的、车辆与每个定位卫星的距离的观测值,以确定每颗定位卫星所对应距离的残差;按照每颗定位卫星所对应的残差设置定位卫星所对应的观测数据的权重,其中定位卫星所对应的权重与定位卫星所对应的距离残差反相关。
在一些实施例中,卫星定位单元还包括周跳修复子单元,用于:构建上一定位时刻与当前时刻的伪距观测方程以及载波单差观测方程,并将先验位置与上一定位时刻的定位结果之差设置为伪距观测方程以及载波单差观测方程中的坐标增量的初始值;根据伪距观测方程以及载波单差观测方程,确定车载GNSS接收机所对应的全球定位系统的载波相位周跳并修复,对坐标增量以及钟差变化进行抗差估计,得到估计值;在GNSS接收机与GNSS接收机对应的基准站之间构建双差观测方程,并将估计值设置为双差观测方程中坐标增量以及钟差变化的初始值;使用LAMBDA算法固定双差观测方程中的双差模糊度,以更新坐标增量以及钟差变化;使用更新后的坐标增量以及上一定位时刻的定位结果确定卫星定位位置。
第三方面,本申请实施例提供了一种车辆,包括:一个或多个处理器;存储装置,用于存储一个或多个程序;车载GNSS接收机、车载惯导系统以及车载激光雷达;当一个或多个程序被一个或多个处理器执行,使得一个或多个处理器实现如第一方面中任一项所描述的方法。
第四方面,本申请实施例提供了一种定位服务器,包括:一个或多个处理器;存储装置,用于存储一个或多个程序;当一个或多个程序被一个或多个处理器执行,使得一个或多个处理器实现如第一方面中任一项所描述的方法。
第五方面,本申请实施例提供了一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如第一方面中任一项所描述的方法。
本申请提供的用于定位车辆的方法和装置,使用惯导系统预测出的先验位置确定地图匹配时所使用的待搜索地图区域,并可以将该先验位置辅助进行卫星定位,使得地图匹配流程和卫星定位可以根据该先验位置大大减小计算量,大大提高了融合定位的处理效率,从而能及时融合三种方式的定位数据以生成准确的定位结果。
附图说明
通过阅读参照以下附图所作的对非限制性实施例所作的详细描述,本申请的其它特征、目的和优点将会变得更明显:
图1是本申请可以应用于其中的示例性系统架构图;
图2是根据本申请的用于定位车辆的方法的一个实施例的流程图;
图3是图2实施例的方法中一个步骤的流程图;
图4是根据本申请的用于定位车辆的装置的一个实施例的结构示意图;
图5是根据本申请的车辆的一个实施例的结构示意图;
图6是适于用来实现本申请实施例的车辆的车载计算设备或定位服务器的计算机系统的结构示意图。
具体实施方式
下面结合附图和实施例对本申请作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释相关发明,而非对该发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与有关发明相关的部分。
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。
图1示出了可以应用本申请的用于定位车辆的方法或用于定位车辆的装置的实施例的示例性系统架构100。
如图1所示,系统架构100可以包括车辆101、网络102和服务器103。网络102用以在车辆101和服务器103之间提供通信链路的介质。网络102可以包括各种连接类型,例如有线、无线通信链路或者光纤电缆等等。
车辆101可通过网络102与服务器103交互,以接收或发送消息等。车辆101上可以安装有激光点云采集装置、通信装置、处理器等。
服务器103可以是提供各种服务的服务器,例如对车辆101采集到的激光点云反射值数据进行处理的服务器。服务器103可以对接收到的激光点云反射值数据进行分析等处理,并将处理结果(例如车辆的定位信息)反馈给车辆101。
需要说明的是,本申请实施例所提供的用于定位车辆的方法可以由车辆101执行,或者由服务器103执行,或者一部分步骤由车辆101执行且另一部分步骤由服务器103执行。相应地,用于定位车辆的装置可以设置于服务器103中,或者设置于车辆101中,或者一部分模块设置在服务器103中且另一部分设置在车辆101中。
应该理解,图1中的车辆101、网络102和服务器103的数目仅仅是示意性的。根据实现需要,可以具有任意数目的车辆101、网络102和服务器103。
继续参考图2,示出了根据本申请的用于定位车辆的方法的一个实施例的流程200。该车辆可以设置有车载GNSS接收机、车载惯导系统以及车载激光雷达等可用于定位的车载设备。该用于定位车辆的方法,包括以下步骤:
步骤201,获取待定位的车辆的车载惯导系统在上一定位时刻与当前定位时刻之间进行捷联解算而确定的车辆在当前定位时刻的先验位置。
在本实施例中,用于定位车辆的方法所针对的车辆上可以安装有车载惯导系统,车载惯导系统中可以包括加速度计和陀螺仪。车载惯导系统可以通过捷联惯导解算,得到车辆在每个定位时刻的先验位置。具体的,车载惯导系统可以在上一定位时刻所确定的定位结果的基础上,依据加速度计和陀螺仪测出的加速度以及角速度进行积分,从而可以利用车辆在上一定位时刻与当前定位时刻之间的位置变化量和姿态变化量以及上一定位时刻的定位结果以确定车辆在当前定位时刻的先验位置。通常,车载惯导系统可以预先对加速度计和陀螺仪进行加速度和角速率的零偏校正。之后,惯导系统还可以对四元素进行积分,求解姿态矩阵;根据加速度值,在消除有害加速度后完成速度积分,进而完成位置积分更新,从而得到上一定位时刻到当前定位时刻车辆的位姿变化量。
步骤202,使用先验位置在激光点云反射值地图中确定预定范围内的待搜索地图区域。
在本实施例中,基于步骤201中得到的先验位置,电子设备可以首先利用该先验位置确定激光点云反射值地图中确定待搜索地图区域。具体的,所确定的待搜索地图区域的范围大小可以是预先设定的,该待搜索地图区域在激光点云反射值地图中的具体位置则可以是根据先验位置所确定的。激光点云反射值地图可以是对预先采集到的激光点云进行投影后根据每个投影区域的反射值特征生成的。该步骤可以将惯导系统提供的先验位置作为搜索区域初始值,能够有效降低搜索范围。
步骤203,将对车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置。
在本实施例中,车辆的车载激光雷达可以在定位过程中不断的扫描周围环境以生成激光点云帧。电子设备可以将激光点云帧投影到某一个平面上,得到投影区域。通常,对激光点云帧进行投影时可以参考激光点云反射值地图的数据组织结构,以便于后续匹配。所使用的激光点云有相同的组织形式。之后,电子设备可以根据该投影区域的反射值特征与待搜索地图区域中的反射值特征进行匹配,以确定以根据匹配结果确定车辆的位置,该位置可以称为地图匹配位置。
步骤204,使用先验位置结合车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置。
在本实施例中,电子设备还基于步骤201所得到的先验位置,电子设备可以依据先验位置对使用车辆的车载GNSS接收机的定位进行辅助,例如可以将该先验位置作为GNSS定位的先验位置,以减小定位所需要执行的计算操作的计算量,提高效率。
步骤205,对先验位置、地图匹配位置以及卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果。
在本实施例中,电子设备可以按照一定的方式对先验位置、地图匹配位置以及卫星定位位置进行融合计算,以得到最终的定位结果。例如,可以通过三种不同方式确定的位置的误差,再对误差进行补偿,从而得到最终的定位结果。
在本实施例的一些可选实现方式中,该方法还可以包括:对以车辆在每个定位时刻的车辆位置误差、车辆速度误差、车辆姿态误差、车载惯导系统中加速度计和陀螺仪的零偏误差以及车载全球卫星导航系统GNSS接收机的钟差与钟漂为状态变量的卡尔曼滤波器进行时间更新。此外,上述步骤205可以包括:对先验位置、地图匹配位置以及卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果,包括:将地图匹配位置与先验位置之差和/或卫星定位位置与先验位置之差作为卡尔曼滤波器的观测值,对卡尔曼滤波器进行量测更新;使用量测更新后的车辆位置误差,对先验位置进行修正,以生成定位结果。其中,时间更新可以包括状态转移矩阵计算、增益矩阵和噪声矩阵计算。在量测更新时,可以使用卫星定位位置和/或地图匹配位置与惯导系统的先验位置之差作为观测值,从而可以估计出位置误差、速度误差、姿态误差、加速度计零偏、陀螺仪零偏、GNSS接收机钟差与钟漂等状态的最佳值,从而可以利用这些最佳值及时对相关的参数进行及时修正,以供下一定位时刻继续使用本实施例的方法。可选的,上述卡尔曼滤波器可以是扩展卡尔曼滤波器。该实现方式利用了卡尔曼滤波器,可以利用卫星定位系统和/或地图匹配过程提供的位置与惯导系统提供的先验位置之差作为观测值,对位置误差、速度误差、姿态误差、加速度计零偏、陀螺仪零偏、GNSS接收机钟差与钟漂等误差不断估计最优值,从而使得设备测量精度始终保持在很高的程度,使得最终输出的定位结果达到很高的精度。
在本实施例的一些可选实现方式中,步骤203可以包括:计算投影区域的反射值特征与待搜索地图区域的各个样本位置所对应地图区域的反射值特征匹配的测量匹配概率;根据各个样本位置的坐标以及对应的测量匹配概率,生成地图匹配位置的坐标。在该实现方式中,电子设备可以将投影区域的反射值特征与各个样本位置所对应地图区域的反射值特征进行匹配,以求取与样本位置匹配的匹配概率,该匹配概率可以称为测量匹配概率。之后,可以依据各个样本位置对应的测量匹配概率生成地图匹配位置的坐标。例如,确定地图匹配位置的方式可以是当某个样本位置对应的测量匹配概率大于一定阈值将该样本位置确定为地图匹配位置,也可以是某一样本位置的测量匹配概率最高且与其他样本位置之差大于一定阈值时将该样本位置确定为地图匹配位置。需要说明的是,电子设备可以使用其他数据对测量匹配概率进行进一步处理,并根据进一步处理后的数据确定地图匹配位置。
在本实施例的一些可选实现方式中,步骤203还可以包括:针对每个样本位置,将投影区域的中心与样本位置进行重合,确定激光点云反射值地图中与投影区域重合的区域为样本位置对应的地图区域。在该实现方式中,可以将样本位置与投影区域的中心重合时激光点云反射值地图中与投影区域重合的区域用于后续的反射值特征匹配。如图3所示,投影区域301为对激光点云帧进行投影所形成的。虚线框示出的区域为根据先验位置在激光点云反射值地图302中确定的待搜索区域303。待搜索区域303可以是5×5的地图网格组成的。在需要计算测量匹配概率时,可以将投影区域301的中心与待搜索区域303中每个网格对应的样本位置进行重合,并将此时激光点云反射值地图302中与投影区域301重合的区域作为该样本位置对应的地图区域。图3中加斜线阴影的区域304即为将投影区域301的中心与待搜索区域303中的一个网格的样本位置进行重合时样本位置对应的地图区域。此时,电子设备可以计算该投影区域的反射值特征与样本位置对应的地图区域303中的反射值特征匹配的测量匹配概率。在图3的示例中,投影区域301可以与待搜索区域的25个地图网格分别的样本位置进行重合,从而可以在后续步骤中求取这25个样本位置分别对应的测量匹配概率。
在本实施例的一些可选实现方式中,上述方法还包括激光点云反射值地图生成步骤,该激光点云反射值地图生成步骤可以包括:将地球表面在世界坐标系的地平面内划分为相同大小和形状的地图网格,每个地图网格与样本位置对应;将针对每个样本位置采集的样本激光点云的反射值特征存储在样本位置对应的地图网格中。通常,激光点云反射值地图生成步骤可以在车辆在行驶之前预先执行。可选的,上述世界坐标系可以采用通用横墨卡托(UTM,Universal Transverse Mercator)坐标系。其中,将地球表面在世界坐标系的地平面内划分为相同大小和形状的地图网格时,可以首先将世界坐标系划分成相同大小和形状的大小的块,每个块覆盖一定的范围,这样在已知块的大小和排列规则时,可以根据坐标就能计算出该坐标所在的块。之后,可以将每个块再划分成m×n(例如1024×1024)的地图网格,每个地图网格与样本位置对应。将针对每个样本位置采集的样本激光点云的反射值特征存储在样本位置对应的地图网格中时,可以对落入同一个地图网格的点云数据做聚合,每个地图网格里存储聚合后的数据,使得每个块中的数据量是固定的。
在本实施例的一些可选实现方式中,上述反射值特征包括激光点云的反射值均值。此时,上述计算投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率可以包括:确定投影区域与样本位置对应的地图区域在各个地图网格上的反射值均值之差;以投影区域在各个地图网格中对应的激光点数量为权重,对各个地图网格上的反射值均值之差进行加权平均,根据所得到的加权平均值确定投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率。例如,测量匹配概率可以通过式(1)求取。
在式(1)中,z是代表全部当前帧测量值,P(z|x,y)是根据当前帧的测量值估测出车辆当前处于每个网格所对应的样本位置(x,y)的匹配概率。测量值中,为激光点云反射值地图中的地图网格对应的反射值均值,为投影区域内与地图网格对应的区域的反射值均值和激光点的数量。α为一个常数参数。按上述方法,即可分别计算出投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率。可选的,反射值特征还可以包括激光点云的反射值方差。此时,测量匹配概率可以通过其他相应的概率计算公式求取。该实现方式可以利用反射值均值结合激光点数作为计算匹配概率的因素,能够有效抑制反射值变化梯度小引入的匹配不稳定问题。
在本实施例的一些可选实现方式中,上述根据各个样本位置的坐标以及对应的测量匹配概率,生成地图匹配位置的坐标,包括可以:根据先验位置以及卡尔曼滤波器进行时间更新所得到的先验位置的误差先验分布,确定车辆在当前时刻处于各个样本位置的预测概率;使用样本位置的预测概率对测量匹配概率进行修正,得到后验匹配概率;以样本位置对应的后验匹配概率作为权重,对各个样本位置的坐标进行加权平均,得到地图匹配位置所对应的坐标。在该实现方式中,系统同时维护一个不考虑当前帧测量值而仅根据历史值推测车辆当前处于(x,y)的概率,即预测概率其中,该预测概率可以通过先验位置以及卡尔曼滤波器进行时间更新所得到的先验位置的误差先验分布进行确定。之后,电子设备可以使用预测概率对测量匹配概率P(z|x,y)进行修正,从而得到后验匹配概率P(x,y)。可选的,该修正过程可以如式(2)所示。
在式(2)中,η为归一化系数。
在得到每个网格的样本位置对应的后验匹配概率后,电子设备可以以样本位置对应的后验匹配概率作为权重,对各个样本位置的坐标进行加权平均,得到地图匹配位置所对应的坐标。可选的,该过程可以通过式(3)表征,其中式(3)中的α为一个常数参数。
在本实施例的一些可选实现方式中,步骤204可以包括:根据先验位置设置车辆的车载GNSS接收机在当前时刻对每颗定位卫星进行观测所得到的观测数据的融合权重。该融合权重可用于后续步骤中进行卫星定位时选择用于参与计算的观测数据以及计算数据的权重,即电子设备可以依据该权重对至少一颗定位卫星所对应的观测数据进行融合计算,从而得到卫星定位位置。例如,当某一颗定位卫星对应的权重为0时,可以在求取车辆的卫星定位位置时舍弃这颗定位卫星对应的观测数据。该实现方式可以利用先验位置设置各个卫星所对应的观测数据对定位结果的影响度,有利于提高定位精度。
在本实施例的一些可选实现方式中,步骤204可以包括:根据先验位置以及每颗定位卫星的卫星位置对车辆与每个定位卫星的距离进行计算,得到计算值;获取车载GNSS接收机对每颗定位卫星进行观测得到的、车辆与每个定位卫星的距离的观测值,以确定每颗定位卫星所对应距离的残差;按照每颗定位卫星所对应的残差设置定位卫星所对应的观测数据的权重,其中定位卫星所对应的权重与定位卫星所对应的距离残差反相关。该实现方式可以利用先验位置反算出的距离计算值验证各个卫星所对应观测值的可靠性,从而减小可靠性较弱的数据的权重,甚至可以将一些偏差较大的数据直接舍弃,有利于提高定位精度。
在本实施例的一些可选实现方式中,步骤204还可以包括:构建上一定位时刻与当前时刻的伪距观测方程以及载波单差观测方程,并将先验位置与上一定位时刻的定位结果之差设置为伪距观测方程以及载波单差观测方程中的坐标增量的初始值;根据伪距观测方程以及载波单差观测方程,确定车载GNSS接收机所对应的全球定位系统的载波相位周跳并修复,对坐标增量以及钟差变化进行抗差估计,得到估计值;在GNSS接收机与GNSS接收机对应的基准站之间构建双差观测方程,并将估计值设置为双差观测方程中坐标增量以及钟差变化的初始值;使用LAMBDA算法固定双差观测方程中的双差模糊度,以更新坐标增量以及钟差变化;使用更新后的坐标增量以及上一定位时刻的定位结果确定卫星定位位置。
在该实现方式中,可以利用先验位置对GNSS接收机进行周跳检测与修复。实践中,在使用每颗卫星对应的观测数据进行定位时,可以首先基于载波时间差分进行周跳探测与位移估计。具体的,可以在相邻历元(即上一定位时刻与当前定位时刻)间构建伪距和载波单差观测方程,这两个方程如式(4)。
其中,为卫地的伪距的变化值,为卫地距离的变化值,dtk,k-1为卫星与接收机的钟差变化,和分别为对流层和电离层延迟的变化造成的观测距离偏差,ε为噪声常数,为接收机观测到的相位变化,为载波相位的周跳值,为观测方向余弦,dx为待估计状态量:包括坐标增量和钟差变化。
当在本系统中GNSS更新频率较大(例如为10Hz)时,在一次更新中可认为对流层和电离层的变化不大,则可以满足式(5)。
之后,可以利用结合基准站提供的观测数据进行载波相位差分定位。载波相位差分定位时可以先构建如式(6)所示的双差观测方程。双差观测方程中坐标增量以及钟差变化的初始值,即式(6)中dx的初始值可以使用前述估计值。
对于式(6)中,可以使用LAMBDA算法固定双差模糊度,以更新dx估计值,即可得到更新后的坐标增量以及钟差变化。电子设备可以使用更新后的坐标增量以及上一定位时刻的定位结果确定卫星定位位置。该实现方式可以利用惯导系统提供的先验位置及时进行周跳修复,使得在典型的城市环境中由于GNSS信号受到遮挡等影响导致载波相位发生周跳频繁出现时,不会因为未及时探测并修复周跳对定位产生非常严重的影响。可见,该方式可以尽可能地减少误差,保障载波相位差分定位的定位精度。
本申请的上述实施例提供的方法,使用惯导系统预测出的先验位置确定地图匹配时所使用的待搜索地图区域,并可以将该先验位置辅助进行卫星定位,使得地图匹配流程和卫星定位可以根据该先验位置大大减小计算量,大大提高了融合定位的处理效率,从而能及时融合三种方式的定位数据以生成准确的定位结果。
进一步参考图4,作为对上述各图所示方法的实现,本申请提供了一种用于定位车辆的装置的一个实施例,该装置实施例与图2所示的方法实施例相对应,该装置具体可以应用于车辆或定位服务器中。
如图4所示,用于定位车辆的装置400包括:先验位置确定单元401、区域确定单元402、匹配单元403、卫星定位单元404、融合单元405。其中,先验位置确定单元401用于获取待定位的车辆的车载惯导系统在上一定位时刻与当前定位时刻之间进行捷联解算而确定的先验位置;区域确定单元402用于使用先验位置在激光点云反射值地图中确定预定范围的待搜索地图区域;匹配单元403用于将对车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置;卫星定位单元404用于使用先验位置结合车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置;融合单元405用于对先验位置、地图匹配位置以及卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果。
在本实施例中,用于定位车辆的装置400的先验位置确定单元401、区域确定单元402、匹配单元403、卫星定位单元404、融合单元405的具体处理可以分别参考图2对应实施例中的步骤201、步骤202、步骤203、步骤204和步骤205,这里不再赘述。
在本实施例的一些可选实现方式中,装置400还包括:时间更新单元(未示出),用于对以车辆在每个定位时刻的车辆位置误差、车辆速度误差、车辆姿态误差、车载惯导系统中加速度计和陀螺仪的零偏误差以及车载全球卫星导航系统GNSS接收机的钟差与钟漂为状态变量的卡尔曼滤波器进行时间更新;以及,融合单元405进一步用于:将地图匹配位置与先验位置之差和/或卫星定位位置与先验位置之差作为卡尔曼滤波器的观测值,对卡尔曼滤波器进行量测更新;使用量测更新后的车辆位置误差,对先验位置进行修正,以生成定位结果。该实现方式的具体处理可以参考图2对应实施例中相应的实现方式,这里不再赘述。
在本实施例的一些可选实现方式中,匹配单元403包括:计算子单元(未示出),用于计算投影区域的反射值特征与待搜索地图区域的各个样本位置所对应地图区域的反射值特征匹配的测量匹配概率;生成子单元(未示出),用于根据各个样本位置的坐标以及对应的测量匹配概率,生成地图匹配位置的坐标。该实现方式的具体处理可以参考图2对应实施例中相应的实现方式,这里不再赘述。
在本实施例的一些可选实现方式中,匹配单元403还包括:确定子单元(未示出),用于针对每个样本位置,将投影区域的中心与样本位置进行重合,确定激光点云反射值地图中与投影区域重合的区域为样本位置对应的地图区域。该实现方式的具体处理可以参考图2对应实施例中相应的实现方式,这里不再赘述。
在本实施例的一些可选实现方式中,装置400还包括激光点云反射值地图生成单元(未示出)。该激光点云反射值地图生成单元可以用于:将地球表面在世界坐标系的地平面内划分为相同大小和形状的地图网格,每个地图网格与样本位置对应;将针对每个样本位置采集的样本激光点云的反射值特征存储在样本位置对应的地图网格中。该实现方式的具体处理可以参考图2对应实施例中相应的实现方式,这里不再赘述。
在本实施例的一些可选实现方式中,上述反射值特征包括激光点云的反射值均值;以及,上述计算子单元进一步用于:确定投影区域与样本位置对应的地图区域在各个地图网格上的反射值均值之差;以投影区域在各个地图网格中对应的激光点数量为权重,对各个地图网格上的反射值均值之差进行加权平均,根据所得到的加权平均值确定投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率。该实现方式的具体处理可以参考图2对应实施例中相应的实现方式,这里不再赘述。
在本实施例的一些可选实现方式中,生成子单元进一步用于:根据先验位置以及卡尔曼滤波器进行时间更新所得到的先验位置的误差先验分布,确定车辆在当前时刻处于各个样本位置的预测概率;使用样本位置的预测概率对测量匹配概率进行修正,得到后验匹配概率;以样本位置对应的后验匹配概率作为权重,对各个样本位置的坐标进行加权平均,得到地图匹配位置所对应的坐标。该实现方式的具体处理可以参考图2对应实施例中相应的实现方式,这里不再赘述。
在本实施例的一些可选实现方式中,卫星定位单元404包括:设置子单元(未示出),用于根据先验位置设置车辆的车载GNSS接收机在当前时刻对每颗定位卫星进行观测所得到的观测数据的融合权重。该实现方式的具体处理可以参考图2对应实施例中相应的实现方式,这里不再赘述。
在本实施例的一些可选实现方式中,设置子单元进一步用于:根据先验位置以及每颗定位卫星的卫星位置对车辆与每个定位卫星的距离进行计算,得到计算值;获取车载GNSS接收机对每颗定位卫星进行观测得到的、车辆与每个定位卫星的距离的观测值,以确定每颗定位卫星所对应距离的残差;按照每颗定位卫星所对应的残差设置定位卫星所对应的观测数据的权重,其中定位卫星所对应的权重与定位卫星所对应的距离残差反相关。该实现方式的具体处理可以参考图2对应实施例中相应的实现方式,这里不再赘述。
在本实施例的一些可选实现方式中,卫星定位单元还包括周跳修复子单元,用于:构建上一定位时刻与当前时刻的伪距观测方程以及载波单差观测方程,并将先验位置与上一定位时刻的定位结果之差设置为伪距观测方程以及载波单差观测方程中的坐标增量的初始值;根据伪距观测方程以及载波单差观测方程,确定车载GNSS接收机所对应的全球定位系统的载波相位周跳并修复,对坐标增量以及钟差变化进行抗差估计,得到估计值;在GNSS接收机与GNSS接收机对应的基准站之间构建双差观测方程,并将估计值设置为双差观测方程中坐标增量以及钟差变化的初始值;使用LAMBDA算法固定双差观测方程中的双差模糊度,以更新坐标增量以及钟差变化;使用更新后的坐标增量以及上一定位时刻的定位结果确定卫星定位位置。该实现方式的具体处理可以参考图2对应实施例中相应的实现方式,这里不再赘述。
参考图5,本申请还提供车辆的一个实施例。如图5所示,该车辆101包括:一个或多个处理器501;存储装置502,用于存储一个或多个程序;车载GNSS接收机503;车载惯导系统504以及车载激光雷达505。当一个或多个程序被处理器501执行时,使得处理器501实现如图2对应实施例或任一实现方式所描述的方法。
此外,本申请还提供定位服务器的一个实施例,该定位服务器包括:一个或多个处理器;存储装置,用于存储一个或多个程序;当一个或多个程序被一个或多个处理器执行,使得一个或多个处理器实现如图2对应实施例或任一实现方式所描述的方法。
下面参考图6,其示出了适于用来实现本申请实施例的车辆的车载计算设备或定位服务器计算机系统600的结构示意图。图6示出的计算机系统仅仅是一个示例,不应对本申请实施例的功能和使用范围带来任何限制。
如图6所示,计算机系统600包括中央处理单元(CPU)601,其可以根据存储在只读存储器(ROM)602中的程序或者从存储部分608加载到随机访问存储器(RAM)603中的程序而执行各种适当的动作和处理。在RAM 603中,还存储有系统600操作所需的各种程序和数据。CPU 601、ROM 602以及RAM 603通过总线604彼此相连。输入/输出(I/O)接口605也连接至总线604。
以下部件连接至I/O接口605:包括键盘、鼠标等的输入部分606;输出部分607;存储部分608;以及通信部分609。通信部分609经由诸如因特网的网络执行通信处理。驱动器610也根据需要连接至I/O接口605。可拆卸介质611根据需要安装在驱动器610上,以便于从其上读出的计算机程序根据需要被安装入存储部分608。
特别地,根据本公开的实施例,上文参考流程图描述的过程可以被实现为计算机软件程序。例如,本公开的实施例包括一种计算机程序产品,其包括承载在计算机可读介质上的计算机程序,该计算机程序包含用于执行流程图所示的方法的程序代码。在这样的实施例中,该计算机程序可以通过通信部分609从网络上被下载和安装,和/或从可拆卸介质611被安装。在该计算机程序被中央处理单元(CPU)601执行时,执行本申请的方法中限定的上述功能。
需要说明的是,本申请所描述的计算机可读介质可以是计算机可读信号介质或者计算机可读存储介质或者是上述两者的任意组合。计算机可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件,或者任意以上的组合。计算机可读存储介质的更具体的例子可以包括但不限于:具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机访问存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本申请中,计算机可读存储介质可以是任何包含或存储程序的有形介质,该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。而在本申请中,计算机可读的信号介质可以包括在基带中或者作为载波一部分传播的数据信号,其中承载了计算机可读的程序代码。这种传播的数据信号可以采用多种形式,包括但不限于电磁信号、光信号或上述的任意合适的组合。计算机可读的信号介质还可以是计算机可读存储介质以外的任何计算机可读介质,该计算机可读介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。计算机可读介质上包含的程序代码可以用任何适当的介质传输,包括但不限于:无线、电线、光缆、RF等等,或者上述的任意合适的组合。
附图中的流程图和框图,图示了按照本申请各种实施例的系统、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段、或代码的一部分,该模块、程序段、或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在有些作为替换的实现中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个接连地表示的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合,可以用执行规定的功能或操作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令的组合来实现。
描述于本申请实施例中所涉及到的单元可以通过软件的方式实现,也可以通过硬件的方式来实现。所描述的单元也可以设置在处理器中,例如,可以描述为:一种处理器包括先验位置确定单元、区域确定单元、匹配单元、卫星定位单元和融合单元。其中,这些单元的名称在某种情况下并不构成对该单元本身的限定,例如,融合单元还可以被描述为“对先验位置、地图匹配位置以及卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果”。
作为另一方面,本申请还提供了一种计算机可读介质,该计算机可读介质可以是上述实施例中描述的装置中所包含的;也可以是单独存在,而未装配入该装置中。上述计算机可读介质承载有一个或者多个程序,当上述一个或者多个程序被该装置执行时,使得该装置:获取待定位的车辆的车载惯导系统在上一定位时刻与当前定位时刻之间进行捷联解算而确定的位置变化量,并根据所述车辆在上一定位时刻的定位结果以及所述位置变化量确定所述车辆在当前定位时刻的先验位置;使用所述先验位置在激光点云反射值地图中确定预定范围的待搜索地图区域;将对所述车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与所述待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置;使用所述先验位置结合所述车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置;对所述先验位置、所述地图匹配位置以及所述卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果。
以上描述仅为本申请的较佳实施例以及对所运用技术原理的说明。本领域技术人员应当理解,本申请中所涉及的发明范围,并不限于上述技术特征的特定组合而成的技术方案,同时也应涵盖在不脱离上述发明构思的情况下,由上述技术特征或其等同特征进行任意组合而形成的其它技术方案。例如上述特征与本申请中公开的(但不限于)具有类似功能的技术特征进行互相替换而形成的技术方案。
Claims (23)
1.一种用于定位车辆的方法,其特征在于,所述方法包括:
获取待定位的车辆的车载惯导系统在上一定位时刻与当前定位时刻之间进行捷联解算而确定的所述车辆在当前定位时刻的先验位置;
使用所述先验位置在激光点云反射值地图中确定预定范围的待搜索地图区域;
将对所述车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与所述待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置;
使用所述先验位置结合所述车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置;
对所述先验位置、所述地图匹配位置以及所述卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果。
2.根据权利要求1所述的方法,其特征在于,所述方法还包括:
对以所述车辆在每个定位时刻的车辆位置误差、车辆速度误差、车辆姿态误差、所述车载惯导系统中加速度计和陀螺仪的零偏误差以及所述车载全球卫星导航系统GNSS接收机的钟差与钟漂为状态变量的卡尔曼滤波器进行时间更新;以及
所述对所述先验位置、所述地图匹配位置以及所述卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果,包括:
将所述地图匹配位置与所述先验位置之差和/或所述卫星定位位置与所述先验位置之差作为所述卡尔曼滤波器的观测值,对所述卡尔曼滤波器进行量测更新;
使用量测更新后的车辆位置误差,对所述先验位置进行修正,以生成所述定位结果。
3.根据权利要求2所述的方法,其特征在于,所述将对所述车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与所述待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置,包括:
计算所述投影区域的反射值特征与所述待搜索地图区域的各个样本位置所对应地图区域的反射值特征匹配的测量匹配概率;
根据各个样本位置的坐标以及对应的测量匹配概率,生成所述地图匹配位置的坐标。
4.根据权利要求3所述的方法,其特征在于,所述将对所述车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与所述待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置,还包括:
针对每个样本位置,将所述投影区域的中心与样本位置进行重合,确定所述激光点云反射值地图中与所述投影区域重合的区域为样本位置对应的地图区域。
5.根据权利要求3所述的方法,其特征在于,所述方法还包括激光点云反射值地图生成步骤,包括:
将地球表面在世界坐标系的地平面内划分为相同大小和形状的多个地图网格,每个地图网格与样本位置对应;
将针对每个样本位置采集的样本激光点云的反射值特征存储在样本位置对应的地图网格中。
6.根据权利要求5所述的方法,其特征在于,所述反射值特征包括激光点云的反射值均值;以及
所述计算所述投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率,包括:
确定所述投影区域与样本位置对应的地图区域在各个地图网格上的反射值均值之差;
以所述投影区域在各个地图网格中对应的激光点数量为权重,对各个地图网格上的反射值均值之差进行加权平均,根据所得到的加权平均值确定所述投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率。
7.根据权利要求3所述的方法,其特征在于,所述根据各个样本位置的坐标以及对应的测量匹配概率,生成所述地图匹配位置的坐标,包括:
根据所述先验位置以及所述卡尔曼滤波器进行时间更新所得到的所述先验位置的误差先验分布,确定所述车辆在当前时刻处于各个样本位置的预测概率;
使用样本位置的预测概率对测量匹配概率进行修正,得到后验匹配概率;
以样本位置对应的后验匹配概率作为权重,对各个样本位置的坐标进行加权平均,得到所述地图匹配位置所对应的坐标。
8.根据权利要求2所述的方法,其特征在于,所述使用所述先验位置结合所述车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置,包括:
根据所述先验位置设置所述车辆的车载GNSS接收机在当前时刻对每颗定位卫星进行观测所得到的观测数据的融合权重。
9.根据权利要求8所述的方法,其特征在于,所述根据所述先验位置设置所述车辆的车载GNSS接收机在当前时刻对每颗定位卫星进行观测所得到的观测数据的融合权重,包括:
根据所述先验位置以及每颗定位卫星的卫星位置对所述车辆与每个定位卫星的距离进行计算,得到计算值;
获取所述车载GNSS接收机对每颗定位卫星进行观测得到的、所述车辆与每个定位卫星的距离的观测值,以确定每颗定位卫星所对应距离的残差;
按照每颗定位卫星所对应的残差设置定位卫星所对应的观测数据的权重,其中定位卫星所对应的权重与定位卫星所对应的距离残差反相关。
10.根据权利要求8所述的方法,其特征在于,所述使用所述先验位置结合所述车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置,包括:
构建上一定位时刻与当前时刻的伪距观测方程以及载波单差观测方程,并将所述先验位置与上一定位时刻的定位结果之差设置为所述伪距观测方程以及所述载波单差观测方程中的坐标增量的初始值;
根据所述伪距观测方程以及所述载波单差观测方程,确定所述车载GNSS接收机所对应的全球定位系统的载波相位周跳并修复,对所述坐标增量以及钟差变化进行抗差估计,得到估计值;
在所述GNSS接收机与所述GNSS接收机对应的基准站之间构建双差观测方程,并将所述估计值设置为所述双差观测方程中坐标增量以及钟差变化的初始值;
使用LAMBDA算法固定所述双差观测方程中的双差模糊度,以更新所述坐标增量以及钟差变化;
使用更新后的坐标增量以及上一定位时刻的定位结果确定所述卫星定位位置。
11.一种用于定位车辆的装置,其特征在于,所述装置包括:
先验位置确定单元,用于获取待定位的车辆的车载惯导系统在上一定位时刻与当前定位时刻之间进行捷联解算而确定的所述车辆在当前定位时刻的先验位置;
区域确定单元,用于使用所述先验位置在激光点云反射值地图中确定预定范围的待搜索地图区域;
匹配单元,用于将对所述车辆的车载激光雷达在当前定位时刻对周围环境进行扫描而采集到的实时激光点云进行投影而生成的投影区域的反射值特征与所述待搜索地图区域的反射值特征进行匹配,以根据匹配结果得到地图匹配位置;
卫星定位单元,用于使用所述先验位置结合所述车辆的车载全球卫星导航系统GNSS接收机的观测数据进行定位,得到卫星定位位置;
融合单元,用于对所述先验位置、所述地图匹配位置以及所述卫星定位位置进行融合,以生成对车辆在当前时刻进行定位的定位结果。
12.根据权利要求11所述的装置,其特征在于,所述装置还包括:
时间更新单元,用于对以所述车辆在每个定位时刻的车辆位置误差、车辆速度误差、车辆姿态误差、所述车载惯导系统中加速度计和陀螺仪的零偏误差以及所述车载全球卫星导航系统GNSS接收机的钟差与钟漂为状态变量的卡尔曼滤波器进行时间更新;以及
所述融合单元进一步用于:
将所述地图匹配位置与所述先验位置之差和/或所述卫星定位位置与所述先验位置之差作为所述卡尔曼滤波器的观测值,对所述卡尔曼滤波器进行量测更新;
使用量测更新后的车辆位置误差,对所述先验位置进行修正,以生成所述定位结果。
13.根据权利要求12所述的装置,其特征在于,所述匹配单元包括:
计算子单元,用于计算所述投影区域的反射值特征与所述待搜索地图区域的各个样本位置所对应地图区域的反射值特征匹配的测量匹配概率;
生成子单元,用于根据各个样本位置的坐标以及对应的测量匹配概率,生成所述地图匹配位置的坐标。
14.根据权利要求13所述的装置,其特征在于,所述匹配单元还包括:
确定子单元,用于针对每个样本位置,将所述投影区域的中心与样本位置进行重合,确定所述激光点云反射值地图中与所述投影区域重合的区域为样本位置对应的地图区域。
15.根据权利要求13所述的装置,其特征在于,所述装置还包括激光点云反射值地图生成单元,用于:
将地球表面在世界坐标系的地平面内划分为相同大小和形状的多个地图网格,每个地图网格与样本位置对应;
将针对每个样本位置采集的样本激光点云的反射值特征存储在样本位置对应的地图网格中。
16.根据权利要求15所述的装置,其特征在于,所述反射值特征包括激光点云的反射值均值;以及
所述计算子单元进一步用于:
确定所述投影区域与样本位置对应的地图区域在各个地图网格上的反射值均值之差;
以所述投影区域在各个地图网格中对应的激光点数量为权重,对各个地图网格上的反射值均值之差进行加权平均,根据所得到的加权平均值确定所述投影区域的反射值特征与样本位置对应的地图区域中的反射值特征匹配的测量匹配概率。
17.根据权利要求13所述的装置,其特征在于,所述生成子单元进一步用于:
根据所述先验位置以及所述卡尔曼滤波器进行时间更新所得到的所述先验位置的误差先验分布,确定所述车辆在当前时刻处于各个样本位置的预测概率;
使用样本位置的预测概率对测量匹配概率进行修正,得到后验匹配概率;
以样本位置对应的后验匹配概率作为权重,对各个样本位置的坐标进行加权平均,得到所述地图匹配位置所对应的坐标。
18.根据权利要求12所述的装置,其特征在于,所述卫星定位单元包括:
设置子单元,用于根据所述先验位置设置所述车辆的车载GNSS接收机在当前时刻对每颗定位卫星进行观测所得到的观测数据的融合权重。
19.根据权利要求18所述的装置,其特征在于,所述设置子单元进一步用于:
根据所述先验位置以及每颗定位卫星的卫星位置对所述车辆与每个定位卫星的距离进行计算,得到计算值;
获取所述车载GNSS接收机对每颗定位卫星进行观测得到的、所述车辆与每个定位卫星的距离的观测值,以确定每颗定位卫星所对应距离的残差;
按照每颗定位卫星所对应的残差设置定位卫星所对应的观测数据的权重,其中定位卫星所对应的权重与定位卫星所对应的距离残差反相关。
20.根据权利要求18所述的装置,其特征在于,所述卫星定位单元还包括周跳修复子单元,用于:
构建上一定位时刻与当前时刻的伪距观测方程以及载波单差观测方程,并将所述先验位置与上一定位时刻的定位结果之差设置为所述伪距观测方程以及所述载波单差观测方程中的坐标增量的初始值;
根据所述伪距观测方程以及所述载波单差观测方程,确定所述车载GNSS接收机所对应的全球定位系统的载波相位周跳并修复,对所述坐标增量以及钟差变化进行抗差估计,得到估计值;
在所述GNSS接收机与所述GNSS接收机对应的基准站之间构建双差观测方程,并将所述估计值设置为所述双差观测方程中坐标增量以及钟差变化的初始值;
使用LAMBDA算法固定所述双差观测方程中的双差模糊度,以更新所述坐标增量以及钟差变化;
使用更新后的坐标增量以及上一定位时刻的定位结果确定所述卫星定位位置。
21.一种车辆,包括:
一个或多个处理器;
存储装置,用于存储一个或多个程序;
车载GNSS接收机、车载惯导系统以及车载激光雷达;
当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现如权利要求1-10中任一所述的方法。
22.一种定位服务器,包括:
一个或多个处理器;
存储装置,用于存储一个或多个程序;
当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现如权利要求1-10中任一所述的方法。
23.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1-10中任一所述的方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710249842.4A CN108732603B (zh) | 2017-04-17 | 2017-04-17 | 用于定位车辆的方法和装置 |
US15/876,008 US11009355B2 (en) | 2017-04-17 | 2018-01-19 | Method and apparatus for positioning vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710249842.4A CN108732603B (zh) | 2017-04-17 | 2017-04-17 | 用于定位车辆的方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108732603A CN108732603A (zh) | 2018-11-02 |
CN108732603B true CN108732603B (zh) | 2020-07-10 |
Family
ID=63791826
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710249842.4A Active CN108732603B (zh) | 2017-04-17 | 2017-04-17 | 用于定位车辆的方法和装置 |
Country Status (2)
Country | Link |
---|---|
US (1) | US11009355B2 (zh) |
CN (1) | CN108732603B (zh) |
Families Citing this family (62)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DK179767B1 (da) * | 2017-11-22 | 2019-05-14 | Danfoss A/S | Varmeoverføringsplade til plade-og-skal-varmeveksler og plade-og-skal-varmeveksler med samme |
JP2019197009A (ja) * | 2018-05-10 | 2019-11-14 | ソニー株式会社 | 情報処理装置、情報処理方法およびプログラム |
EP3594712B1 (en) | 2018-07-12 | 2023-11-22 | Cohda Wireless Pty Ltd. | A method and system for estimating range between and position of objects using a wireless communication system |
EP3617735A1 (en) * | 2018-08-31 | 2020-03-04 | Cohda Wireless Pty Ltd. | A method for estimating the position of an object |
CN111174777A (zh) * | 2018-11-09 | 2020-05-19 | 阿里巴巴集团控股有限公司 | 定位方法、装置以及电子设备 |
CN109581380B (zh) * | 2018-12-29 | 2023-04-07 | 百度在线网络技术(北京)有限公司 | 基于雷达的车辆位置检测方法、装置和计算机设备 |
CN111380514A (zh) * | 2018-12-29 | 2020-07-07 | 深圳市优必选科技有限公司 | 机器人位姿估计方法、装置、终端及计算机存储介质 |
CN110109138A (zh) * | 2019-01-31 | 2019-08-09 | 浙江工业大学 | 一种基于激光雷达点云数据的车辆外廓视图绘制方法 |
CN109870157B (zh) * | 2019-02-20 | 2021-11-02 | 苏州风图智能科技有限公司 | 确定车体位姿的方法及装置、制图方法 |
CN109725329B (zh) * | 2019-02-20 | 2021-12-07 | 苏州风图智能科技有限公司 | 一种无人车定位方法及装置 |
CN109931939B (zh) * | 2019-02-27 | 2020-11-03 | 杭州飞步科技有限公司 | 车辆的定位方法、装置、设备及计算机可读存储介质 |
CN111679308A (zh) * | 2019-03-11 | 2020-09-18 | 武汉小狮科技有限公司 | 一种基于多传感器融合的无人车定位方法 |
CN110082779A (zh) * | 2019-03-19 | 2019-08-02 | 同济大学 | 一种基于3d激光雷达的车辆位姿定位方法及系统 |
CN111352141B (zh) * | 2019-04-24 | 2022-06-21 | 贵州宽凳智云科技有限公司 | 一种基于高精地图的车载卫星精密单点实时定位方法 |
DE102019207302A1 (de) * | 2019-05-20 | 2020-11-26 | Robert Bosch Gmbh | Verfahren zum Betreiben einer Sensorvorrichtung eines Fahrzeugs |
CN113874681A (zh) * | 2019-05-23 | 2021-12-31 | 北京嘀嘀无限科技发展有限公司 | 点云地图质量的评估方法和系统 |
CN110954113B (zh) * | 2019-05-30 | 2021-10-15 | 北京初速度科技有限公司 | 一种车辆位姿的修正方法和装置 |
CN112241016A (zh) * | 2019-07-19 | 2021-01-19 | 北京初速度科技有限公司 | 一种泊车地图地理坐标的确定方法和装置 |
WO2021016803A1 (zh) * | 2019-07-29 | 2021-02-04 | 深圳市大疆创新科技有限公司 | 高精度地图定位方法、系统、平台及计算机可读存储介质 |
CN112393735B (zh) * | 2019-08-15 | 2023-05-30 | 纳恩博(北京)科技有限公司 | 定位方法及装置、存储介质、电子装置 |
CN110515110B (zh) * | 2019-09-05 | 2021-08-10 | 北京百度网讯科技有限公司 | 数据评估的方法、装置、设备和计算机可读存储介质 |
CN112455503A (zh) * | 2019-09-09 | 2021-03-09 | 中车株洲电力机车研究所有限公司 | 基于雷达的列车定位方法及装置 |
CN112639882B (zh) * | 2019-09-12 | 2021-12-14 | 华为技术有限公司 | 定位方法、装置及系统 |
WO2021056438A1 (zh) * | 2019-09-27 | 2021-04-01 | 深圳市大疆创新科技有限公司 | 点云数据处理方法及其装置、激光雷达、可移动平台 |
CN110889808B (zh) * | 2019-11-21 | 2023-02-28 | 广州文远知行科技有限公司 | 一种定位的方法、装置、设备及存储介质 |
CN110879400A (zh) * | 2019-11-27 | 2020-03-13 | 炬星科技(深圳)有限公司 | 激光雷达与imu融合定位的方法、设备及存储介质 |
CN111060099B (zh) * | 2019-11-29 | 2023-08-04 | 畅加风行(苏州)智能科技有限公司 | 一种无人驾驶汽车实时定位方法 |
CN111102978B (zh) * | 2019-12-05 | 2022-03-29 | 深兰科技(上海)有限公司 | 一种车辆运动状态确定的方法、装置及电子设备 |
CN110967011B (zh) * | 2019-12-25 | 2022-06-28 | 苏州智加科技有限公司 | 一种定位方法、装置、设备及存储介质 |
CN113050140A (zh) * | 2019-12-27 | 2021-06-29 | 中移智行网络科技有限公司 | 一种定位方法、装置、存储介质和服务器 |
CN113375661A (zh) * | 2020-02-25 | 2021-09-10 | 郑州宇通客车股份有限公司 | 一种无人驾驶系统的定位导航方法及系统 |
CN111323802B (zh) * | 2020-03-20 | 2023-02-28 | 阿波罗智能技术(北京)有限公司 | 智能驾驶车辆定位方法、装置及设备 |
CN111553353B (zh) * | 2020-05-11 | 2023-11-07 | 北京小马慧行科技有限公司 | 3d点云的处理方法、装置、存储介质与处理器 |
CN111708043B (zh) | 2020-05-13 | 2023-09-26 | 阿波罗智能技术(北京)有限公司 | 定位方法及装置 |
CN111707262B (zh) * | 2020-05-19 | 2022-05-27 | 上海有个机器人有限公司 | 基于最近点向量投影的点云匹配方法、介质、终端和装置 |
CN111707279B (zh) * | 2020-05-19 | 2023-09-08 | 上海有个机器人有限公司 | 一种激光点云与地图的匹配评价方法、介质、终端和装置 |
CN113721599B (zh) * | 2020-05-25 | 2023-10-20 | 华为技术有限公司 | 定位方法和定位装置 |
CN111578932B (zh) * | 2020-05-28 | 2021-12-24 | 长沙中联重科环境产业有限公司 | 一种基于多线激光雷达的建图方法、装置、介质及设备 |
DK3926300T3 (da) * | 2020-06-18 | 2022-09-26 | Sick Ag | Bestemmelse af egenposition og navigationsanordning |
CN111830544B (zh) * | 2020-07-02 | 2024-01-05 | 合肥移顺信息技术有限公司 | 车辆定位的方法、装置、系统及存储介质 |
CN113916243B (zh) * | 2020-07-07 | 2022-10-14 | 长沙智能驾驶研究院有限公司 | 目标场景区域的车辆定位方法、装置、设备和存储介质 |
CN111949943B (zh) * | 2020-07-24 | 2022-08-30 | 北京航空航天大学 | 一种面向高级自动驾驶的v2x和激光点云配准的车辆融合定位方法 |
CN111830491B (zh) * | 2020-08-04 | 2023-06-27 | 三一机器人科技有限公司 | 一种导航系统中反光体的监测方法、装置及电子设备 |
CN111983582A (zh) * | 2020-08-14 | 2020-11-24 | 北京埃福瑞科技有限公司 | 列车的定位方法及系统 |
CN114200481A (zh) * | 2020-08-28 | 2022-03-18 | 华为技术有限公司 | 一种定位方法、定位系统和车辆 |
CN111929693B (zh) * | 2020-09-18 | 2021-01-08 | 雷熵信息科技(潍坊)有限公司 | 一种基于激光点云距离序列的井下定位方法 |
CN112285738B (zh) * | 2020-10-23 | 2023-01-31 | 中车株洲电力机车研究所有限公司 | 一种轨道交通车辆的定位方法及其装置 |
CN112444246B (zh) * | 2020-11-06 | 2024-01-26 | 北京易达恩能科技有限公司 | 高精度的数字孪生场景中的激光融合定位方法 |
CN114088093A (zh) * | 2020-11-09 | 2022-02-25 | 北京京东乾石科技有限公司 | 一种点云地图构建方法、装置、系统及存储介质 |
CN112764053B (zh) * | 2020-12-29 | 2022-07-15 | 深圳市普渡科技有限公司 | 一种融合定位方法、装置、设备和计算机可读存储介质 |
CN113029137B (zh) * | 2021-04-01 | 2023-02-28 | 清华大学 | 一种多源信息自适应融合定位方法及系统 |
CN113378694B (zh) * | 2021-06-08 | 2023-04-07 | 北京百度网讯科技有限公司 | 生成目标检测和定位系统及目标检测和定位的方法及装置 |
CN113534227B (zh) * | 2021-07-26 | 2022-07-01 | 中国电子科技集团公司第五十四研究所 | 一种适用于复杂非合作场景的多传感器融合绝对定位方法 |
CN113777635B (zh) * | 2021-08-06 | 2023-11-03 | 香港理工大学深圳研究院 | 一种全球导航卫星数据校准方法、装置、终端及存储介质 |
CN113611120A (zh) * | 2021-08-16 | 2021-11-05 | 智道网联科技(北京)有限公司 | 车辆位置信息预测方法、装置及设备 |
CN113777644B (zh) * | 2021-08-31 | 2023-06-02 | 盐城中科高通量计算研究院有限公司 | 基于弱信号场景的无人驾驶定位方法 |
CN113819918B (zh) * | 2021-09-17 | 2023-05-16 | 中国第一汽车股份有限公司 | 一种定位方法、装置、电子设备以及存储介质 |
CN113984044A (zh) * | 2021-10-08 | 2022-01-28 | 杭州鸿泉物联网技术股份有限公司 | 一种基于车载多感知融合的车辆位姿获取方法及装置 |
CN114137563B (zh) * | 2021-11-29 | 2023-03-10 | 重庆赛迪奇智人工智能科技有限公司 | 机车和机车定位方法、装置、设备及存储介质 |
CN114234969B (zh) * | 2021-12-17 | 2023-09-15 | 上海华测导航技术股份有限公司 | 一种导航定位方法、装置和电子设备 |
CN114485632B (zh) * | 2021-12-31 | 2024-03-22 | 深圳市易成自动驾驶技术有限公司 | 车辆定位方法、系统及计算机可读存储介质 |
CN117250647A (zh) * | 2022-06-09 | 2023-12-19 | 腾讯科技(深圳)有限公司 | 定位方法、装置、设备及存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103885443A (zh) * | 2012-12-20 | 2014-06-25 | 联想(北京)有限公司 | 用于即时定位与地图构建单元的设备、系统和方法 |
CN104764457A (zh) * | 2015-04-21 | 2015-07-08 | 北京理工大学 | 一种用于无人车的城市环境构图方法 |
CN105045263A (zh) * | 2015-07-06 | 2015-11-11 | 杭州南江机器人股份有限公司 | 一种基于Kinect的机器人自定位方法 |
KR101625486B1 (ko) * | 2014-11-14 | 2016-05-30 | 재단법인대구경북과학기술원 | 지도 기반 측위 시스템 및 그 방법 |
CN106023210A (zh) * | 2016-05-24 | 2016-10-12 | 百度在线网络技术(北京)有限公司 | 无人车、无人车定位方法、装置和系统 |
CN106097444A (zh) * | 2016-05-30 | 2016-11-09 | 百度在线网络技术(北京)有限公司 | 高精地图生成方法和装置 |
CN106225790A (zh) * | 2016-07-13 | 2016-12-14 | 百度在线网络技术(北京)有限公司 | 一种无人车定位精度的确定方法及装置 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8374783B2 (en) * | 2007-10-10 | 2013-02-12 | Leica Geosystems Ag | Systems and methods for improved position determination of vehicles |
WO2011061587A2 (en) * | 2009-11-17 | 2011-05-26 | Topcon Positioning Systems, Inc. | Detection and correction of anomalous measurements and ambiguity resolution in a global navigation satellite system receiver |
US9760996B2 (en) * | 2015-08-11 | 2017-09-12 | Nokia Technologies Oy | Non-rigid registration for large-scale space-time 3D point cloud alignment |
US10452926B2 (en) * | 2016-12-29 | 2019-10-22 | Uber Technologies, Inc. | Image capture device with customizable regions of interest |
US20180188380A1 (en) * | 2016-12-29 | 2018-07-05 | Qualcomm Incorporated | Controlling sampling rate in non-causal positioning applications |
US10520592B2 (en) * | 2016-12-31 | 2019-12-31 | Waymo Llc | Light detection and ranging (LIDAR) device with an off-axis receiver |
US9953236B1 (en) * | 2017-03-10 | 2018-04-24 | TuSimple | System and method for semantic segmentation using dense upsampling convolution (DUC) |
-
2017
- 2017-04-17 CN CN201710249842.4A patent/CN108732603B/zh active Active
-
2018
- 2018-01-19 US US15/876,008 patent/US11009355B2/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103885443A (zh) * | 2012-12-20 | 2014-06-25 | 联想(北京)有限公司 | 用于即时定位与地图构建单元的设备、系统和方法 |
KR101625486B1 (ko) * | 2014-11-14 | 2016-05-30 | 재단법인대구경북과학기술원 | 지도 기반 측위 시스템 및 그 방법 |
CN104764457A (zh) * | 2015-04-21 | 2015-07-08 | 北京理工大学 | 一种用于无人车的城市环境构图方法 |
CN105045263A (zh) * | 2015-07-06 | 2015-11-11 | 杭州南江机器人股份有限公司 | 一种基于Kinect的机器人自定位方法 |
CN106023210A (zh) * | 2016-05-24 | 2016-10-12 | 百度在线网络技术(北京)有限公司 | 无人车、无人车定位方法、装置和系统 |
CN106097444A (zh) * | 2016-05-30 | 2016-11-09 | 百度在线网络技术(北京)有限公司 | 高精地图生成方法和装置 |
CN106225790A (zh) * | 2016-07-13 | 2016-12-14 | 百度在线网络技术(北京)有限公司 | 一种无人车定位精度的确定方法及装置 |
Non-Patent Citations (2)
Title |
---|
Visual Localization within LIDAR Maps for Automated Urban Driving;Ryan W.Wolcott et al.;《2014 IEEE/RSJ International Conference on Intelligent Robots and System》;20140918;第176-183页 * |
移动车载激光点云的道路标线自动识别与提取;邹晓亮 等;《测绘与空间地理信息》;20120925;第35卷(第9期);第5-8页 * |
Also Published As
Publication number | Publication date |
---|---|
US20180299273A1 (en) | 2018-10-18 |
CN108732603A (zh) | 2018-11-02 |
US11009355B2 (en) | 2021-05-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108732603B (zh) | 用于定位车辆的方法和装置 | |
EP3875985B1 (en) | Method, apparatus, computing device and computer-readable storage medium for positioning | |
CN109410735B (zh) | 反射值地图构建方法和装置 | |
CN109407073B (zh) | 反射值地图构建方法和装置 | |
CN112113574B (zh) | 用于定位的方法、装置、计算设备和计算机可读存储介质 | |
CN111708043B (zh) | 定位方法及装置 | |
CN107884800B (zh) | 观测时滞系统的组合导航数据解算方法、装置及导航设备 | |
CN111461981B (zh) | 点云拼接算法的误差估计方法和装置 | |
CN110208823B (zh) | 确定用于基于卫星确定车辆位置的数据简档的方法 | |
CN113050142B (zh) | 终端设备的定位方法、装置、电子设备及可读存储介质 | |
US11579628B2 (en) | Method for localizing a vehicle | |
CN114111775A (zh) | 一种多传感器融合定位方法、装置、存储介质及电子设备 | |
CN113984044A (zh) | 一种基于车载多感知融合的车辆位姿获取方法及装置 | |
KR20130036145A (ko) | 이동 정보 결정 장치, 수신기 및 그에 의한 방법 | |
CN112946681B (zh) | 融合组合导航信息的激光雷达定位方法 | |
CN114442133A (zh) | 无人机定位方法、装置、设备及存储介质 | |
CN114061611A (zh) | 目标对象定位方法、装置、存储介质和计算机程序产品 | |
CN112526573A (zh) | 对象定位方法和装置、存储介质及电子设备 | |
KR20220039709A (ko) | 적어도 하나의 환경-특정 gnss 프로파일을 나타내기 위한 모델을 결정하는 방법 | |
US11762104B2 (en) | Method and device for locating a vehicle | |
CN112595330B (zh) | 车辆定位方法、装置、电子设备和计算机可读介质 | |
CN115032672A (zh) | 一种基于定位子系统的融合定位方法及系统 | |
US11340356B2 (en) | System and method for integer-less GNSS positioning | |
CN113179480B (zh) | 用于定位车辆的方法和设备 | |
CN115242297B (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 |