CN106225790B - 一种无人车定位精度的确定方法及装置 - Google Patents
一种无人车定位精度的确定方法及装置 Download PDFInfo
- Publication number
- CN106225790B CN106225790B CN201610551165.7A CN201610551165A CN106225790B CN 106225790 B CN106225790 B CN 106225790B CN 201610551165 A CN201610551165 A CN 201610551165A CN 106225790 B CN106225790 B CN 106225790B
- Authority
- CN
- China
- Prior art keywords
- unmanned vehicle
- information
- moment
- error
- positioning accuracy
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- 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/49—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 inertial position system, e.g. loosely-coupled
-
- 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
- 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
- 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
-
- 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/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3833—Creation or updating of map data characterised by the source of data
- G01C21/3841—Data obtained from two or more sources, e.g. probe vehicles
-
- 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
- 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/40—Correcting position, velocity or attitude
-
- 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/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
- 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/51—Relative positioning
Abstract
本发明实施例公开了一种无人车定位精度的确定方法及装置。该方法包括:获取依据无人车的传感定位数据实时定位得到的定位坐标信息;依据所述无人车的GPS数据、IMU数据和激光点云数据,确定所述无人车的真实坐标信息;将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度。本发明实施例的技术方案,能够确定无人车的定位精度,且定位精度的准确度较高,为基于定位结果确定无人车的行驶路线做好准备工作。
Description
技术领域
本发明涉及定位技术领域,尤其涉及一种无人车定位精度的确定方法及装置。
背景技术
无人车作为一种智能化的移动交通工具,能够代替人类驾驶员完成一系列驾驶行为。无人车是一个集环境感知、导航定位以及决策控制等多功能于一体的综合系统。导航定位功能能够使无人车“了解”自身的位置、速度或方向等信息,以使决策控制功能依据无人车的定位信息做出相应的决策,规划出行驶路径并最终控制无人车按照决策和路径进行驾驶。综上,定位精度是影响无人车智能驾驶性能的关键因素,然而目前仍然缺乏无人车定位精度的确定方式。
发明内容
有鉴于此,本发明实施例提供一种无人车定位精度的确定方法及装置,以确定无人车的定位精度。
第一方面,本发明实施例提供了一种无人车定位精度的确定方法,包括:
获取依据无人车的传感定位数据实时定位得到的定位坐标信息;
依据所述无人车的GPS数据、IMU数据和激光点云数据,确定所述无人车的真实坐标信息;
将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度。
第二方面,本发明实施例提供了一种无人车定位精度的确定装置,包括:
定位信息获取模块,用于获取依据无人车的传感定位数据实时定位得到的定位坐标信息;
真实信息确定模块,用于依据所述无人车的GPS数据、IMU数据和激光点云数据,确定所述无人车的真实坐标信息;
定位精度确定模块,用于将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度。
本发明实施例提供的技术方案,通过依据无人车的GPS定位数据、IMU数据和激光点云数据确定高准确度的无人车的真实坐标信息,并将无人车的高准确度的真实坐标信息与依据无人车的传感器数据实时定位得到的定位坐标信息进行匹配,依据匹配结果确定无人车中定位模块的定位精度。该方法能够确定无人车的定位精度,且定位精度的准确度较高,为基于定位结果确定无人车的行驶路线做好准备工作。
附图说明
图1是本发明实施例一提供的一种无人车定位精度的确定方法的流程图;
图2a是本发明实施例二提供的一种无人车定位精度的确定方法的流程图;
图2b是本发明实施例二提供的误差确定过程的示例图;
图3a是本发明实施例三提供的一种无人车定位精度的确定方法的流程图;
图3b是本发明实施例三提供的无人车的真实坐标信息确定过程的示意图;
图4是本发明实施例四提供的一种无人车定位精度的确定装置的结构图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构。
实施例一
图1是本发明实施例一提供的一种无人车定位精度的确定方法的流程图。本实施例的方法可以由无人车定位精度的确定装置来执行,该装置可通过硬件和/或软件的方式实现,且本实施例提供的方法一般可适用于无人车定位精度的测试情形。参考图1,本实施例提供的无人车定位精度的确定方法具体可以包括如下:
S11、获取依据无人车的传感定位数据实时定位得到的定位坐标信息。
其中,传感定位数据指的是通过无人车中定位传感器采集的数据。以无人车采用惯性导航系统(Inertial Navigation System,INS)进行定位为例,定位传感器可以包括陀螺仪和加速度传感器等,传感定位数据可以包括加速度数据和角速度数据等,INS从起点位置依据连续测得的无人车航向角和速度推算出无人车下一点的定位坐标信息,从而可连续测出无人车在每一时刻的定位坐标信息。
需要说明的是,本实施例中对无人车中定位系统不作具体限定,如无人车也可以采用全球定位系统(Global Positioning System,GPS)或北斗卫星导航系统(BeiDouNavigation Satellite System,BDS)进行定位。
S12、依据所述无人车的GPS数据、惯性测量单元(Inertial measurement unit,IMU)数据和激光点云数据,确定所述无人车的真实坐标信息。
在本实施例中,无人车中配置有GPS模块、惯性测量单元IMU和激光雷达等,在无人车行驶过程中可以实时获取差分GPS数据、IMU数据和激光点云数据,随后,可以将差分GPS数据和激光点云数据用迭代最近点算法(IterativeClosest Points,ICP)算法进行离线配准,得到精确的无人车的真实坐标信息;也可以将获取的差分GPS数据、IMU数据和激光点云数据与预先确定的高精地图进行比较,得到无人车的真实坐标信息。由于差分GPS数据的定位精度可以达到厘米级,再结合激光点云数据利用ICP算法进行离线配准确定的真实坐标信息的准确度高于厘米级。
S13、将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度。
具体的,可以依据时间戳将无人车在每一时刻的定位坐标信息与真实坐标信息进行比较,并依据二者之间的差值确定无人车的定位精度,如若99%的差值均小于或等于1cm,则可以确定无人车的定位精度是1cm。
本实施例提供的技术方案,通过依据无人车的GPS定位数据、IMU数据和激光点云数据确定高准确度的无人车的真实坐标信息,并将无人车的高准确度的真实坐标信息与依据无人车的传感器数据实时定位得到的定位坐标信息进行匹配,依据匹配结果确定无人车中定位模块的定位精度,该方法能够确定无人车的定位精度,且定位精度的准确度较高,为基于定位结果确定无人车的行驶路线做好准备工作。
示例性的,将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度,可以包括:
将所述无人车的定位坐标信息与所述真实坐标信息进行匹配,确定所述无人车的定位误差;
依据所述无人车的定位误差确定所述无人车的定位精度。
实施例二
本实施例在上述实施例一的基础上提供了一种新的无人车定位精度的确定方法。在本实施例中具体提供了一种依据定位坐标信息与真实坐标信息的匹配结果确定无人车的定位精度的方式。2a是本发明实施例二提供的无人车定位精度的确定方法的流程图。参考图2a本实施例提供的无人车定位精度的确定方法具体可以包括如下:
S21、获取依据无人车的传感定位数据实时定位得到的定位坐标信息。
S22、依据所述无人车的GPS数据、IMU数据和激光点云数据,确定所述无人车的真实坐标信息。
S23、依据所述的定位坐标信息与所述真实坐标信息,在世界坐标系下确定所述无人车的直线误差和高度误差。
具体的,针对每一时刻,确定无人车在该时刻的定位坐标信息在世界坐标系xoy面上投影,与真实坐标信息在xoy面上投影的距离,将确定的距离作为无人车在该时刻的直线误差。并且,针对每一时刻,确定无人车在该时刻的定位坐标信息与真实坐标信息在世界坐标系z轴方向上的距离,将确定的距离作为无人车在该时刻的高度误差。
S24、依据所述无人车的真实坐标信息,构建所述无人车在每一时刻的运动坐标系。
参考图2b,针对每一时刻,将由无人车在该时刻之前的历史时刻(如该时刻的前一时刻)的真实坐标信息Pt-1到无人车在该时刻的真实坐标信息Pt的方向作为无人车在该时刻的运动坐标系的纵轴正方向o'y',将水平面上垂直于纵轴正方向o'y'的方向确定为横轴正方向o'x'且横轴正方向o'x'与纵轴正方向o'y'在无人车在历史时刻的真实坐标信息Pt-1处相交,即构建了无人车在每一时刻的运动坐标系的水平面x'o'y'。
S25、依据所述的定位坐标信息与所述真实坐标信息,在构建得到的运动坐标系下确定所述无人车的横向误差和纵向误差。
参考图2b,针对每一时刻,将该时刻的定位坐标信息Zt与真实坐标信息Pt在该时刻运动坐标系的横轴方向o'x'上的投影间距Dh确定为该时刻的横向误差,并将该时刻的定位坐标信息Zt与真实坐标信息Pt在该时刻运动坐标系的纵轴方向o'y'上的投影间距Dv确定为该时刻的纵向误差。
S26、依据所述无人车的线误差、高度误差、横向误差和纵向误差,确定所述无人车的定位精度。
分别统计无人车在每一时刻的直线误差、高度误差、横向误差和纵向误差,例如统计5w-10w帧定位数据,若统计得到直线误差、高度误差、横向误差和纵向误差99.99%在某一个误差范围内,则可以将该误差范围确定为无人车的定位精度。
本实施例提供的技术方案,获取无人车实时定位得到的定位坐标信息以及无人车的真实坐标信息,并依据真实坐标信息构建无人车的运动坐标系,随后,依据无人车的定位坐标信息以及真实坐标信息确定无人车在世界坐标系下的直线误差和高度误差,并且确定无人车在运动坐标系下的横向误差和纵向误差,最后,统计无人车的直线误差、高度误差、横向误差和纵向误差,并依据统计结果确定无人车的定位精度。该方法从直线误差、高度误差、横向误差和纵向误差四个方面确定无人车的定位精度,定位精度的准确度较高,为基于定位结果确定无人车的行驶路线做好准备工作。
实施例三
本实施例在上述实施例一的基础上提供了一种新的无人车定位精度的确定方法。在本实施例中具体提供了一种确定无人车的真实坐标信息的方式。3a是本发明实施例三提供的无人车定位精度的确定方法的流程图。参考图3a本实施例提供的无人车定位精度的确定方法具体可以包括如下:
S31、获取依据无人车的传感定位数据实时定位得到的定位坐标信息。
S32、对所述无人车的激光点云数据进行标志点匹配,识别所述激光点云数据中包含的障碍物,并确定在每一时刻所述无人车与所述障碍物之间的相对位置信息。
具体的,参考图3b,可以采用ICP对无人车的激光点云数据进行标志点匹配,得到激光点云数据中包含的障碍物O,并通过点云识别确定在每一时刻无人车Xt与障碍物Oi的相对位置信息,其中t=1,2,3…且i=1,2,3…。
S33、依据所述无人车的GPS数据确定所述无人车在每一时刻的位置信息,并依据所述无人车的IMU数据确定所述无人车在每一时刻的运动信息。
参考图3b,具体的,依据无人车的GPS数据可以确定在世界坐标系下无人车在每一时刻的位置信息Xt,依据IMU数据可以确定无人车在每一时刻的运动信息ut,其中运动信息ut可以是加速度信息、方向信息和速度信息等。
S34、依据所述无人车在每一时刻的位置信息和运动信息,确定所述无人车的运动误差。
示例性的,依据所述无人车在每一时刻的位置信息和运动信息,确定所述无人车的运动误差,可以包括:依据所述无人车在每一时刻的运动信息以及在该时刻之前的历史时刻的位置信息,确定所述无人车在该时刻的预估位置;依据所述无人车在每一时刻的位置信息以及预估位置,确定所述无人车的运动误差。例如,依据如下公式计算无人车的运动误差ept:ept=xt-f(xt-1,ut),其中f(xt-1,ut)是无人车在t时刻的预估位置,xt-1是无人车在t-1时刻的位置信息。
S35、依据在每一时刻所述无人车与所述障碍物之间的相对位置信息和所述运动信息,确定IMU的观测误差。
示例性的,依据在每一时刻所述无人车与所述障碍物之间的相对位置信息和所述运动信息,确定IMU的观测误差,可以包括:依据所述无人车在每一时刻的运动信息以及在该时刻之前的历史时刻所述无人车与所述障碍物的相对位置信息,确定在该时刻所述无人车与所述障碍物的预估相对位置信息;依据在每一时刻所述无人车与所述障碍物的相对位置信息以及预估相对位置信息,确定所述IMU的观测误差。例如,依据如下公式计算IMU的观测误差eLt:eLt=zt-g(zt-1,ut),其中g(zt-1,ut)是在t时刻无人车与障碍物的预估相对位置信息,zt-1是t-1时刻无人车与障碍物的相对位置信息,zt是t时刻无人车与障碍物的相对位置信息。
S36、依据每一时刻的运动误差和观测误差,以及所述无人车在每一时刻的位置信息,确定所述无人车在每一时刻的真实坐标信息。
具体的,依据如下公式确定每一时刻的最小误差min error:
min error=∑t(ept)2+∑i(eLt)2
依据无人车在每一时刻的位置信息和最小误差得到每一时刻的真实坐标信息,其中无人车在每一时刻的位置信息可以依据无人车的GPS数据得到。
S37、将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度。
本实施例提供的技术方案,通过获取无人车实时定位得到的定位坐标信息。并且,识别无人车的激光点云数据中包含的障碍物,确定无人车与障碍物之间的相对位置信息,依据无人车的GPS数据确定无人车的位置信息,依据无人车的IMU数据确定无人车的运动信息。随后,依据无人车的位置信息和运动信息确定无人车的运动误差,以及依据无人车与障碍物之间的相对位置信息和运动信息确定IMU的观测误差,并依据无人车的位置信息、运动误差和观测误差,确定无人车的真实坐标信息,提高了真实坐标信息的准确度,因而提高了后续依据无人车的定位坐标信息与真实坐标信息确定的无人车的定位精度的准确度。
实施例四
图4是本发明实施例四提供的一种无人车定位精度的确定装置的结构图,且本实施例提供的装置可适用于无人车定位精度的测试情形。参见图4,本实施例提供的无人车定位精度的确定装置的具体结构可以如下:
定位信息获取模块41,用于获取依据无人车的传感定位数据实时定位得到的定位坐标信息;
真实信息确定模块42,用于依据所述无人车的GPS数据、IMU数据和激光点云数据,确定所述无人车的真实坐标信息;
定位精度确定模块43,用于将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度。
示例性的,定位精度确定模块43可以包括:
误差确定子模块,用于将所述无人车的定位坐标信息与所述真实坐标信息进行匹配,确定所述无人车的定位误差;
定位精度确定子模块,用于依据所述无人车的定位误差确定所述无人车的定位精度。
示例性的,误差确定子模块可以包括:
第一误差单元,用于依据所述的定位坐标信息与所述真实坐标信息,在世界坐标系下确定所述无人车的直线误差和高度误差;
运动坐标系单元,用于依据所述无人车的真实坐标信息,构建所述无人车在每一时刻的运动坐标系;
第二误差单元,用于依据所述的定位坐标信息与所述真实坐标信息,在构建得到的运动坐标系下确定所述无人车的横向误差和纵向误差。
示例性的,真实信息确定模块42可以包括:
相对位置子模块,用于对所述无人车的激光点云数据进行标志点匹配,识别所述激光点云数据中包含的障碍物,并确定在每一时刻所述无人车与所述障碍物之间的相对位置信息;
位置运动子模块,用于依据所述无人车的GPS数据确定所述无人车在每一时刻的位置信息,并依据所述无人车的IMU数据确定所述无人车在每一时刻的运动信息;
运动误差子模块,用于依据所述无人车在每一时刻的位置信息和运动信息,确定所述无人车的运动误差;
观测误差子模块,用于依据在每一时刻所述无人车与所述障碍物之间的相对位置信息和所述运动信息,确定IMU的观测误差;
真实信息子模块依据每一时刻的运动误差和观测误差,以及所述无人车在每一时刻的位置信息,确定所述无人车在每一时刻的真实坐标信息。
示例性的,运动误差子模块可以包括:
预估位置单元,用于依据所述无人车在每一时刻的运动信息以及在该时刻之前的历史时刻的位置信息,确定所述无人车在该时刻的预估位置;
运动误差单元,用于依据所述无人车在每一时刻的位置信息以及预估位置,确定所述无人车的运动误差。
示例性的,观测误差子模块可以包括:
预估相对位置单元,用于依据所述无人车在每一时刻的运动信息以及在该时刻之前的历史时刻所述无人车与所述障碍物的相对位置信息,确定在该时刻所述无人车与所述障碍物的预估相对位置信息;
观测误差单元,用于依据在每一时刻所述无人车与所述障碍物的相对位置信息以及预估相对位置信息,确定所述IMU的观测误差。
本实施例提供的无人车定位精度的确定装置,与本发明任意实施例所提供的无人车定位精度的确定方法属于同一发明构思,可执行本发明任意实施例所提供的无人车定位精度的确定方法,具备执行无人车定位精度的确定方法相应的功能模块和有益效果。未在本实施例中详尽描述的技术细节,可参见本发明任意实施例提供的无人车定位精度的确定方法。
注意,上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解,本发明不限于这里所述的特定实施例,对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此,虽然通过以上实施例对本发明进行了较为详细的说明,但是本发明不仅仅限于以上实施例,在不脱离本发明构思的情况下,还可以包括更多其他等效实施例,而本发明的范围由所附的权利要求范围决定。
Claims (10)
1.一种无人车定位精度的确定方法,包括:
获取依据无人车的传感定位数据实时定位得到的定位坐标信息;
对所述无人车的激光点云数据进行标志点匹配,识别所述激光点云数据中包含的障碍物,并确定在每一时刻所述无人车与所述障碍物之间的相对位置信息;
依据所述无人车的GPS数据确定所述无人车在每一时刻的位置信息,并依据所述无人车的IMU数据确定所述无人车在每一时刻的运动信息;
依据所述无人车在每一时刻的位置信息和运动信息,确定所述无人车的运动误差;
依据在每一时刻所述无人车与所述障碍物之间的相对位置信息和所述运动信息,确定IMU的观测误差;
依据每一时刻的运动误差和观测误差,以及所述无人车在每一时刻的位置信息,确定所述无人车在每一时刻的真实坐标信息;
将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度。
2.根据权利要求1所述的方法,其特征在于,将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度,包括:
将所述无人车的定位坐标信息与所述真实坐标信息进行匹配,确定所述无人车的定位误差;
依据所述无人车的定位误差确定所述无人车的定位精度。
3.根据权利要求2所述的方法,其特征在于,将所述无人车的定位坐标信息与所述真实坐标信息进行匹配,确定所述无人车的定位误差,包括:
依据所述的定位坐标信息与所述真实坐标信息,在世界坐标系下确定所述无人车的直线误差和高度误差;
依据所述无人车的真实坐标信息,构建所述无人车在每一时刻的运动坐标系;
依据所述的定位坐标信息与所述真实坐标信息,在构建得到的运动坐标系下确定所述无人车的横向误差和纵向误差。
4.根据权利要求1所述的方法,其特征在于,依据所述无人车在每一时刻的位置信息和运动信息,确定所述无人车的运动误差,包括:
依据所述无人车在每一时刻的运动信息以及在该时刻之前的历史时刻的位置信息,确定所述无人车在该时刻的预估位置;
依据所述无人车在每一时刻的位置信息以及预估位置,确定所述无人车的运动误差。
5.根据权利要求1所述的方法,其特征在于,依据在每一时刻所述无人车与所述障碍物之间的相对位置信息和所述运动信息,确定IMU的观测误差,包括:
依据所述无人车在每一时刻的运动信息以及在该时刻之前的历史时刻所述无人车与所述障碍物的相对位置信息,确定在该时刻所述无人车与所述障碍物的预估相对位置信息;
依据在每一时刻所述无人车与所述障碍物的相对位置信息以及预估相对位置信息,确定所述IMU的观测误差。
6.一种无人车定位精度的确定装置,包括:
定位信息获取模块,用于获取依据无人车的传感定位数据实时定位得到的定位坐标信息;
真实信息确定模块,用于依据所述无人车的GPS数据、IMU数据和激光点云数据,确定所述无人车的真实坐标信息;
定位精度确定模块,用于将获取的定位坐标信息与确定的真实坐标信息进行匹配,依据匹配结果确定所述无人车的定位精度;
其中,所述真实信息确定模块包括:
相对位置子模块,用于对所述无人车的激光点云数据进行标志点匹配,识别所述激光点云数据中包含的障碍物,并确定在每一时刻所述无人车与所述障碍物之间的相对位置信息;
位置运动子模块,用于依据所述无人车的GPS数据确定所述无人车在每一时刻的位置信息,并依据所述无人车的IMU数据确定所述无人车在每一时刻的运动信息;
运动误差子模块,用于依据所述无人车在每一时刻的位置信息和运动信息,确定所述无人车的运动误差;
观测误差子模块,用于依据在每一时刻所述无人车与所述障碍物之间的相对位置信息和所述运动信息,确定IMU的观测误差;
真实信息子模块依据每一时刻的运动误差和观测误差,以及所述无人车在每一时刻的位置信息,确定所述无人车在每一时刻的真实坐标信息。
7.根据权利要求6所述的装置,其特征在于,定位精度确定模块包括:
误差确定子模块,用于将所述无人车的定位坐标信息与所述真实坐标信息进行匹配,确定所述无人车的定位误差;
定位精度确定子模块,用于依据所述无人车的定位误差确定所述无人车的定位精度。
8.根据权利要求7所述的装置,其特征在于,误差确定子模块包括:
第一误差单元,用于依据所述的定位坐标信息与所述真实坐标信息,在世界坐标系下确定所述无人车的直线误差和高度误差;
运动坐标系单元,用于依据所述无人车的真实坐标信息,构建所述无人车在每一时刻的运动坐标系;
第二误差单元,用于依据所述的定位坐标信息与所述真实坐标信息,在构建得到的运动坐标系下确定所述无人车的横向误差和纵向误差。
9.根据权利要求6所述的装置,其特征在于,运动误差子模块包括:
预估位置单元,用于依据所述无人车在每一时刻的运动信息以及在该时刻之前的历史时刻的位置信息,确定所述无人车在该时刻的预估位置;
运动误差单元,用于依据所述无人车在每一时刻的位置信息以及预估位置,确定所述无人车的运动误差。
10.根据权利要求6所述的装置,其特征在于,观测误差子模块包括:
预估相对位置单元,用于依据所述无人车在每一时刻的运动信息以及在该时刻之前的历史时刻所述无人车与所述障碍物的相对位置信息,确定在该时刻所述无人车与所述障碍物的预估相对位置信息;
观测误差单元,用于依据在每一时刻所述无人车与所述障碍物的相对位置信息以及预估相对位置信息,确定所述IMU的观测误差。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610551165.7A CN106225790B (zh) | 2016-07-13 | 2016-07-13 | 一种无人车定位精度的确定方法及装置 |
US15/425,109 US10921461B2 (en) | 2016-07-13 | 2017-02-06 | Method and apparatus for determining unmanned vehicle positioning accuracy |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610551165.7A CN106225790B (zh) | 2016-07-13 | 2016-07-13 | 一种无人车定位精度的确定方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106225790A CN106225790A (zh) | 2016-12-14 |
CN106225790B true CN106225790B (zh) | 2018-11-02 |
Family
ID=57520265
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610551165.7A Active CN106225790B (zh) | 2016-07-13 | 2016-07-13 | 一种无人车定位精度的确定方法及装置 |
Country Status (2)
Country | Link |
---|---|
US (1) | US10921461B2 (zh) |
CN (1) | CN106225790B (zh) |
Families Citing this family (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106643801B (zh) * | 2016-12-27 | 2019-11-19 | 纳恩博(北京)科技有限公司 | 一种定位准确度的检测方法及电子设备 |
CN108732603B (zh) * | 2017-04-17 | 2020-07-10 | 百度在线网络技术(北京)有限公司 | 用于定位车辆的方法和装置 |
CN109085620A (zh) * | 2017-06-13 | 2018-12-25 | 百度在线网络技术(北京)有限公司 | 无人驾驶车辆定位异常校准方法、装置、设备及存储介质 |
CN107704870B (zh) * | 2017-09-07 | 2021-04-20 | 武汉大学 | 基于ble指纹定位与imu动作识别融合的可靠人车临近感知装置与方法 |
CN109521756B (zh) * | 2017-09-18 | 2022-03-08 | 阿波罗智能技术(北京)有限公司 | 用于无人驾驶车辆的障碍物运动信息生成方法和装置 |
CN108398705A (zh) * | 2018-03-06 | 2018-08-14 | 广州小马智行科技有限公司 | 地图生成方法、装置及车辆定位方法、装置 |
CN111936820A (zh) * | 2018-03-30 | 2020-11-13 | 丰田自动车欧洲公司 | 用于调整车辆外部位置信息的系统和方法 |
CN110657801B (zh) * | 2018-06-29 | 2022-02-08 | 阿里巴巴(中国)有限公司 | 定位方法、装置以及电子设备 |
EP3612854B1 (en) * | 2018-07-02 | 2023-03-15 | Beijing Didi Infinity Technology and Development Co., Ltd. | Vehicle navigation system using pose estimation based on point cloud |
CN109297500B (zh) * | 2018-09-03 | 2020-12-15 | 武汉中海庭数据技术有限公司 | 基于车道线特征匹配的高精度定位装置及方法 |
WO2020092179A1 (en) * | 2018-10-29 | 2020-05-07 | Dji Technology, Inc. | A movable object for performing real-time mapping |
CN109633725B (zh) * | 2018-10-31 | 2021-03-30 | 百度在线网络技术(北京)有限公司 | 定位初始化的处理方法、装置及可读存储介质 |
CN109405826B (zh) * | 2018-11-16 | 2020-12-29 | 北京兆维电子(集团)有限责任公司 | 一种机器人定位方法和系统 |
CN109556634A (zh) * | 2018-12-14 | 2019-04-02 | 北京百度网讯科技有限公司 | 车辆定位能力的检测方法、装置、设备及可读存储介质 |
CN109507689A (zh) * | 2018-12-25 | 2019-03-22 | 肖湘江 | 带障碍物记忆功能的多激光雷达数据融合方法 |
CN111721283B (zh) * | 2019-03-18 | 2023-08-15 | 深圳市速腾聚创科技有限公司 | 定位算法的精度检测方法、装置、计算机设备和存储介质 |
CN109883448B (zh) * | 2019-03-28 | 2021-10-15 | 北京经纬恒润科技股份有限公司 | 地图盒子测试方法及系统 |
CN110058288B (zh) * | 2019-04-28 | 2021-04-06 | 北京微克智飞科技有限公司 | 无人机ins/gnss组合导航系统航向误差修正方法及系统 |
CN110220513B (zh) * | 2019-04-30 | 2022-10-04 | 中国科学院深圳先进技术研究院 | 一种目标定位的方法、系统、无人机及存储介质 |
CN110160540B (zh) * | 2019-06-12 | 2020-12-18 | 禾多科技(北京)有限公司 | 基于高精度地图的车道线数据融合方法 |
CN112149659B (zh) * | 2019-06-27 | 2021-11-09 | 浙江商汤科技开发有限公司 | 定位方法及装置、电子设备和存储介质 |
CN110988949A (zh) * | 2019-12-02 | 2020-04-10 | 北京京东乾石科技有限公司 | 定位方法、定位装置、计算机可读存储介质与可移动设备 |
CN111323802B (zh) * | 2020-03-20 | 2023-02-28 | 阿波罗智能技术(北京)有限公司 | 智能驾驶车辆定位方法、装置及设备 |
US11859994B1 (en) * | 2021-02-18 | 2024-01-02 | Aurora Innovation, Inc. | Landmark-based localization methods and architectures for an autonomous vehicle |
CN113885559B (zh) * | 2021-09-28 | 2023-04-11 | 佛山中科云图智能科技有限公司 | 无人机紧急返航高度路径获取方法、装置、介质和设备 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000112523A (ja) * | 1998-09-30 | 2000-04-21 | Honda Motor Co Ltd | 自動追従走行システム |
CN101609149A (zh) * | 2009-07-13 | 2009-12-23 | 北京航空航天大学 | 一种提高机载激光雷达定姿精度的方法 |
CN102393744A (zh) * | 2011-11-22 | 2012-03-28 | 湖南大学 | 一种无人驾驶汽车的导航方法 |
CN102998679A (zh) * | 2012-11-25 | 2013-03-27 | 北京理工大学 | 一种应用于无人车的gis数据获取方法 |
CN103499350A (zh) * | 2013-09-28 | 2014-01-08 | 长安大学 | Gps盲区下融合多源信息的车辆高精度定位方法及装置 |
CN104197953A (zh) * | 2014-08-13 | 2014-12-10 | 北京航天控制仪器研究所 | 一种惯性导航系统两维落点精度估计方法 |
CN104573733A (zh) * | 2014-12-26 | 2015-04-29 | 上海交通大学 | 一种基于高清正射影像图的高精细地图生成系统及方法 |
CN105004340A (zh) * | 2015-07-14 | 2015-10-28 | 沈向东 | 结合惯性导航技术和指纹定位技术的定位误差修正方法 |
Family Cites Families (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
IT1235330B (it) * | 1989-01-30 | 1992-06-26 | Aeroel Di Spizzamiglio Ing A & | Sistema per la compensazione automatica dell'oscillazione trasversale del piano di scansione in un profilometro a luce laser, ottenuto mediante un apposito dispositivo |
US7202776B2 (en) * | 1997-10-22 | 2007-04-10 | Intelligent Technologies International, Inc. | Method and system for detecting objects external to a vehicle |
CH693378A5 (fr) * | 1999-04-09 | 2003-07-15 | Bobst Sa | Procédé de positionnement d'éléments en plaque dans la station d'introduction d'une machine de traitement et dispositif pour la mise en oeuvre du procédé. |
US7289906B2 (en) * | 2004-04-05 | 2007-10-30 | Oregon Health & Science University | Navigation system applications of sigma-point Kalman filters for nonlinear estimation and sensor fusion |
US8838374B2 (en) * | 2005-07-05 | 2014-09-16 | Mi-Jack Products, Inc. | Automatic correction of past position errors for location and inventory tracking |
US8065060B2 (en) * | 2006-01-18 | 2011-11-22 | The Board Of Regents Of The University And Community College System On Behalf Of The University Of Nevada | Coordinated joint motion control system with position error correction |
US20080033645A1 (en) * | 2006-08-03 | 2008-02-07 | Jesse Sol Levinson | Pobabilistic methods for mapping and localization in arbitrary outdoor environments |
AU2008283845A1 (en) * | 2007-08-06 | 2009-02-12 | Trx Systems, Inc. | Locating, tracking, and/or monitoring personnel and/or assets both indoors and outdoors |
US8301374B2 (en) * | 2009-08-25 | 2012-10-30 | Southwest Research Institute | Position estimation for ground vehicle navigation based on landmark identification/yaw rate and perception of landmarks |
US9372088B2 (en) * | 2012-08-03 | 2016-06-21 | Robotic Research, Llc | Canine handler operations positioning system |
US9043072B1 (en) * | 2013-04-04 | 2015-05-26 | Google Inc. | Methods and systems for correcting an estimated heading using a map |
US9719801B1 (en) * | 2013-07-23 | 2017-08-01 | Waymo Llc | Methods and systems for calibrating sensors using road map data |
US9664784B2 (en) * | 2013-12-04 | 2017-05-30 | Trimble Inc. | System and methods for data point detection and spatial modeling |
US20150219767A1 (en) * | 2014-02-03 | 2015-08-06 | Board Of Regents, The University Of Texas System | System and method for using global navigation satellite system (gnss) navigation and visual navigation to recover absolute position and attitude without any prior association of visual features with known coordinates |
US20160327653A1 (en) * | 2014-02-03 | 2016-11-10 | Board Of Regents, The University Of Texas System | System and method for fusion of camera and global navigation satellite system (gnss) carrier-phase measurements for globally-referenced mobile device pose determination |
JP6132981B2 (ja) * | 2014-03-24 | 2017-05-24 | エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd | 飛行機の状態をリアルタイムに修正する方法および装置 |
US10365363B2 (en) * | 2015-05-08 | 2019-07-30 | Humatics Corporation | Mobile localization using sparse time-of-flight ranges and dead reckoning |
CN104850134B (zh) * | 2015-06-12 | 2019-01-11 | 北京中飞艾维航空科技有限公司 | 一种无人机高精度自主避障飞行方法 |
CN106023210B (zh) * | 2016-05-24 | 2017-12-12 | 百度在线网络技术(北京)有限公司 | 无人车、无人车定位方法、装置和系统 |
CN107818537A (zh) * | 2016-09-13 | 2018-03-20 | 北京百度网讯科技有限公司 | 数据处理方法和装置 |
CN107817503B (zh) * | 2016-09-14 | 2018-12-21 | 北京百度网讯科技有限公司 | 应用于激光点云数据的运动补偿方法和装置 |
CN107844115B (zh) * | 2016-09-20 | 2019-01-29 | 北京百度网讯科技有限公司 | 用于无人驾驶车辆的数据获取方法和装置 |
CN107871129B (zh) * | 2016-09-27 | 2019-05-10 | 北京百度网讯科技有限公司 | 用于处理点云数据的方法和装置 |
CN107945198B (zh) * | 2016-10-13 | 2021-02-23 | 北京百度网讯科技有限公司 | 用于标注点云数据的方法和装置 |
-
2016
- 2016-07-13 CN CN201610551165.7A patent/CN106225790B/zh active Active
-
2017
- 2017-02-06 US US15/425,109 patent/US10921461B2/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000112523A (ja) * | 1998-09-30 | 2000-04-21 | Honda Motor Co Ltd | 自動追従走行システム |
CN101609149A (zh) * | 2009-07-13 | 2009-12-23 | 北京航空航天大学 | 一种提高机载激光雷达定姿精度的方法 |
CN102393744A (zh) * | 2011-11-22 | 2012-03-28 | 湖南大学 | 一种无人驾驶汽车的导航方法 |
CN102998679A (zh) * | 2012-11-25 | 2013-03-27 | 北京理工大学 | 一种应用于无人车的gis数据获取方法 |
CN103499350A (zh) * | 2013-09-28 | 2014-01-08 | 长安大学 | Gps盲区下融合多源信息的车辆高精度定位方法及装置 |
CN104197953A (zh) * | 2014-08-13 | 2014-12-10 | 北京航天控制仪器研究所 | 一种惯性导航系统两维落点精度估计方法 |
CN104573733A (zh) * | 2014-12-26 | 2015-04-29 | 上海交通大学 | 一种基于高清正射影像图的高精细地图生成系统及方法 |
CN105004340A (zh) * | 2015-07-14 | 2015-10-28 | 沈向东 | 结合惯性导航技术和指纹定位技术的定位误差修正方法 |
Also Published As
Publication number | Publication date |
---|---|
US20180017682A1 (en) | 2018-01-18 |
CN106225790A (zh) | 2016-12-14 |
US10921461B2 (en) | 2021-02-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106225790B (zh) | 一种无人车定位精度的确定方法及装置 | |
CN101082493B (zh) | 一种农业机械导航的组合定位方法 | |
CN105509739B (zh) | 采用固定区间crts平滑的ins/uwb紧组合导航系统及方法 | |
US7619561B2 (en) | Managed traverse system and method to acquire accurate survey data in absence of precise GPS data | |
EP1865286A2 (en) | Object locating in restricted environments using personal navigation | |
CN106441275A (zh) | 一种机器人规划路径的更新方法及装置 | |
CN102706366B (zh) | 一种基于地球自转角速率约束的sins初始对准方法 | |
US11237005B2 (en) | Method and arrangement for sourcing of location information, generating and updating maps representing the location | |
CN108871336A (zh) | 一种车辆位置估算系统及方法 | |
CN111025366B (zh) | 基于ins及gnss的网格slam的导航系统及方法 | |
CN103438890B (zh) | 基于tds与图像测量的行星动力下降段导航方法 | |
CN104316058B (zh) | 一种采用交互多模型的移动机器人wsn/ins组合导航方法 | |
US20140249750A1 (en) | Navigational and location determination system | |
US20200249695A1 (en) | Method for localizing a vehicle | |
Tang et al. | OdoNet: Untethered speed aiding for vehicle navigation without hardware wheeled odometer | |
North et al. | Enhanced mobile robot outdoor localization using INS/GPS integration | |
Nguyen et al. | Improving the accuracy of the autonomous mobile robot localization systems based on the multiple sensor fusion methods | |
Hu et al. | Kilometer sign positioning-aided INS/odometer integration for land vehicle autonomous navigation | |
CN106843206A (zh) | 基于已有路网的辅助定位方法 | |
US10006770B2 (en) | Remote location determination system | |
US20140100776A1 (en) | Method for determining the position of moving objects | |
CN114435630B (zh) | 一种利用有限次视线测量对非合作目标进行相对定轨的方法 | |
TWI635302B (zh) | 載具即時精準定位系統 | |
CN107389060A (zh) | 基于CKF的IMU/Wi‑Fi信号的超紧组合室内导航方法 | |
CN109798893A (zh) | 室内复杂环境下的路径导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |