CN112505671B - Gnss信号缺失环境下毫米波雷达目标定位方法及装置 - Google Patents
Gnss信号缺失环境下毫米波雷达目标定位方法及装置 Download PDFInfo
- Publication number
- CN112505671B CN112505671B CN202110166370.2A CN202110166370A CN112505671B CN 112505671 B CN112505671 B CN 112505671B CN 202110166370 A CN202110166370 A CN 202110166370A CN 112505671 B CN112505671 B CN 112505671B
- Authority
- CN
- China
- Prior art keywords
- millimeter wave
- wave radar
- data
- lookup table
- current frame
- 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 39
- 238000012545 processing Methods 0.000 claims description 13
- 238000004590 computer program Methods 0.000 claims description 12
- 238000003860 storage Methods 0.000 claims description 7
- 238000009826 distribution Methods 0.000 claims description 5
- 238000013519 translation Methods 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 13
- 238000005259 measurement Methods 0.000 description 7
- 238000004891 communication Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 239000000779 smoke Substances 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 239000000428 dust Substances 0.000 description 2
- 230000004438 eyesight Effects 0.000 description 2
- 239000003897 fog Substances 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000000059 patterning Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000003190 augmentative effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000149 penetrating effect Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000004304 visual acuity Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/06—Systems determining position data of a target
-
- 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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/89—Radar or analogous systems specially adapted for specific applications for mapping or imaging
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种GNSS信号缺失环境下毫米波雷达目标定位方法及装置,方法包括:获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧位姿数据;根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图;根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图;根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表;将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据;根据所述当前帧位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。本发明可以在GNSS信号缺失环境下进行毫米波雷达目标定位,提高目标定位的准确性。
Description
技术领域
本发明涉及毫米波雷达点云处理技术领域,尤其涉及GNSS信号缺失环境下毫米波雷达目标定位方法及装置。
背景技术
准确的目标定位首先需要传感器的自己的绝对位置信息。实现传感器自主定位是移动机器人领域研究最广泛也是最核心的问题之一。在自动驾驶、增强现实、无人机等领域都有着重要地应用。目前已经有多种流行的定位技术,比如全球导航卫星系统(GlobalNavigation Satellite System,GNSS),最常见的是GPS,其中RTK-GPS可以达到厘米级的定位精度;移动机器人可通过轮式里程计、惯性导航装置(Inertial Measurement Unit,IMU)等本体传感器进行定位;另一种在封闭空间中常用的定位方法是基于合作目标定位系统,这种系统多数由合作目标与通信基站组成,采用的通信技术包括射频识别(RadioFrequency Identification,RFID)、ZigBee、WiFi和超宽带(Ultra Wide Band,UWB)等。这类定位系统需要目标随身携带通讯装置。
然而,上述这些方法在实际中存在很大局限性。比如GNSS信号无法在封闭空间和有严重遮挡的环境中使用;由于高精度的IMU成本过高、轮式里程计的打滑漂移引起累积误差等问题,单独依靠这些本体传感器并不能稳定的提供定位结果;合作目标方法定位的成败与否,取决于通信技术手段能否有效支撑,价格高昂且缺乏稳定性。
还有一种不依赖于其他辅助手段的传感器自定位技术,即同时定位与构图(Simultaneous Localization and Mapping,SLAM)。这种方法可以通过重复观测到的环境特征定位传感器自身的位置和姿态。常用的SLAM系统包括激光SLAM和视觉SLAM,即使用激光雷达或者视觉相机作为数据采集的传感器。但是在烟雾、雨雪等极端气候条件下,它们无法正常工作。
毫米波雷达是指发射毫米波波段的电磁波进行探测的雷达,它穿透雾、烟、灰尘的能力强,具有全天候全天时的优点。使用毫米波雷达作为SLAM传感器可以解决以上问题。但是由于其较小的数据量和较低的测量精度,这将严重降低SLAM定位的准确性,进而降低目标定位的准确性。
因此,亟需一种可以克服上述问题的用于GNSS信号缺失环境下的毫米波雷达目标定位方案。
发明内容
本发明实施例提供一种GNSS信号缺失环境下毫米波雷达目标定位方法,用以在GNSS信号缺失环境下进行毫米波雷达目标定位,提高目标定位的准确性,该方法包括:
获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧位姿数据;
根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图;
根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图;
根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表;
将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据;
根据所述当前帧位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。
本发明实施例提供一种GNSS信号缺失环境下毫米波雷达目标定位装置,用以在GNSS信号缺失环境下进行毫米波雷达目标定位,提高目标定位的准确性,该装置包括:
数据获得模块,用于获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧位姿数据;
地图建立模块,用于根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图;
子图确定模块,用于根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图;
查找表建立模块,用于根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表;
匹配模块,用于将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据;
目标定位模块,用于根据所述当前帧位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。
本发明实施例还提供一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述GNSS信号缺失环境下毫米波雷达目标定位方法。
本发明实施例还提供一种计算机可读存储介质,所述计算机可读存储介质存储有执行上述GNSS信号缺失环境下毫米波雷达目标定位方法的计算机程序。
本发明实施例通过获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧位姿数据;根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图;根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图;根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表;将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据;根据所述当前帧位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。本发明实施例不依赖于GNSS信号的辅助定位手段,根据RCS占据栅格地图的局部子图,建立椭圆栅格化查找表并将当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配得到当前帧位姿数据,解决了因毫米波雷达数据量小、测量精度低导致的定位不准确的问题,从而实现在GNSS信号缺失环境下进行毫米波雷达目标定位,提高目标定位的准确性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。在附图中:
图1为本发明实施例中GNSS信号缺失环境下毫米波雷达目标定位方法示意图;
图2为本发明实施例中雷达扫描示意图;
图3为本发明实施例中GNSS信号缺失环境下毫米波雷达目标定位装置结构图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚明白,下面结合附图对本发明实施例做进一步详细说明。在此,本发明的示意性实施例及其说明用于解释本发明,但并不作为对本发明的限定。
如前所述,目前虽然已经有多种流行的定位技术,但多数方法在实际中存在很大局限性。比如GNSS信号无法在封闭空间和有严重遮挡的环境中使用;由于高精度的IMU成本过高、轮式里程计的打滑漂移引起累积误差等问题,单独依靠这些本体传感器并不能稳定的提供定位结果;合作目标方法定位的成败与否,取决于通信技术手段能否有效支撑,价格高昂且缺乏稳定性。在使用SLAM方法进行定位和构图时,激光SLAM与视觉SLAM虽然具有各自的优点,但是他们在面对诸如雾、烟、灰尘等特殊条件的环境时,无法高效工作。毫米波雷达虽然可以全天时全天候地工作,但是由于其较小的数据量和较低的测量精度,这将严重降低SLAM定位的准确性,进而降低目标定位的准确性。
为了在GNSS信号缺失环境下进行毫米波雷达目标定位,提高目标定位的准确性,本发明实施例提供一种GNSS信号缺失环境下毫米波雷达目标定位方法,如图1所示,该方法可以包括:
步骤101、获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧位姿数据;
步骤102、根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图;
步骤103、根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图;
步骤104、根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表;
步骤105、将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据;
步骤106、根据所述当前帧位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。
由图1所示可以得知,本发明实施例通过获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧位姿数据;根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图;根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图;根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表;将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据;根据所述当前帧位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。本发明实施例不依赖于GNSS信号的辅助定位手段,根据RCS占据栅格地图的局部子图,建立椭圆栅格化查找表并将当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配得到当前帧位姿数据,解决了因毫米波雷达数据量小、测量精度低导致的定位不准确的问题,从而实现在GNSS信号缺失环境下进行毫米波雷达目标定位,提高目标定位的准确性。
实施例中,获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧位姿数据。
本实施例中,所述当前帧毫米波雷达采集数据包括:目标相对于雷达在笛卡尔坐标系中的当前横坐标和当前纵坐标,以及目标的当前雷达散射横截面积数据;所述历史帧毫米波雷达采集数据包括:目标相对于雷达在笛卡尔坐标系中的历史横坐标和历史纵坐标,以及目标的历史雷达散射横截面积数据。
具体实施时,首先将毫米波雷达固定在稳定的移动载体平台上,如:无人机、移动轨道、机器人或汽车,控制载体在空间中移动,对周围环境进行数据采集,雷达扫描示意图如图2所示。雷达开始工作后,开始对环境进行感知扫描。由于毫米波雷达的空间特性是二维的,它在高程上不具备分辨能力。定义雷达每帧检测到n个目标,第m个目标的测量值Z m 包含的三维特征为:
其中, 和是目标相对于雷达在笛卡尔坐标系中的坐标,rcs m 表示目标的雷达散射横截面积数据(RCS)。RCS表征了目标在雷达波照射下所产生回波强度的一种物理量,RCS低的目标是弱反射体,RCS高的目标为强反射体。反射体的RCS越低,它产生的回波强度也会越小,从而它被雷达检测到的概率也就越小。每一帧数据构成一个的矩阵。
实施例中,根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图。根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图。根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表。将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据。
本实施例中,根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图,包括:根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,分别建立高分辨率的第一RCS占据栅格地图和低分辨率的第二RCS占据栅格地图;根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图,包括:根据预先设置的边界阈值,确定高分辨率的第一RCS占据栅格地图的第一局部子图和低分辨率的第二RCS占据栅格地图的第二局部子图;根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表,包括:根据第一局部子图,建立第一椭圆栅格化查找表,根据第二局部子图,建立第二椭圆栅格化查找表;将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据,包括:将所述当前帧毫米波雷达采集数据与第一椭圆栅格化查找表和第二椭圆栅格化查找表进行匹配,得到当前帧位姿数据。
本实施例中,根据第一局部子图,建立第一椭圆栅格化查找表,根据第二局部子图,建立第二椭圆栅格化查找表,包括:利用二维高斯分布对第一局部子图和第二局部子图进行模糊拓展;根据第一局部子图模糊拓展后的结果,建立第一椭圆栅格化查找表,根据第二局部子图模糊拓展后的结果,建立第二椭圆栅格化查找表。
本实施例中,将所述当前帧毫米波雷达采集数据与第一椭圆栅格化查找表和第二椭圆栅格化查找表进行匹配,得到当前帧位姿数据,包括:将所述当前帧毫米波雷达采集数据投影到第二椭圆栅格化查找表中;建立三维搜索窗口,将投影后的当前帧毫米波雷达采集数据进行平移处理和旋转处理;在第二椭圆栅格化查找表中遍历查找当前帧毫米波雷达采集数据击中栅格的总分的第一最大值;将所述当前帧毫米波雷达采集数据投影到第一椭圆栅格化查找表中;建立三维搜索窗口,将投影后的当前帧毫米波雷达采集数据进行平移处理和旋转处理;在第一椭圆栅格化查找表中遍历查找当前帧毫米波雷达采集数据击中栅格的总分的第二最大值;根据所述第一最大值和第二最大值,得到当前帧位姿数据。
具体实施时,首先构造两个RCS占据栅格地图,即高分辨率的第一RCS占据栅格地图和低分辨率的第二RCS占据栅格地图,构造的步骤相同,区别在于分辨率大小不同。首先RCS占据栅格地图可以表示为M:
将地图M划分为个栅格,每个栅格相互独立。M x,y 表示每个栅格是否被目标占据,空闲为0,占据为1。P(M x,y )表示栅格是否被占用的概率,其中P(M x,y (t)=1)表示在t时刻栅格被占据的概率,P(M x,y (t)=0)表示在t时刻栅格空闲的概率。
为所有栅格建立后验概率P(M x,y (t)|z 1:t ,x 1:t ),其中z 1:t 为时刻1到t内雷达的所有测量值,x 1:t 为时刻1到t内雷达的所有位姿值。则地图M用如下公式表示:
为了避免概率接近0或1时引起的截断问题,使用概率比值的对数形式表示每个栅格被占用的概率,表示为:
通过公式变换,把栅格状态的更新变成了简单的加法,利于二元贝叶斯滤波的迭代更新,如下公式:
使用该公式来实时更新每个栅格的状态,进而可以得到全局RCS占据栅格地图的状态。其中L(M x,y (t-1))表示t-1时刻的概率比对数值,L(M x,y (0))表示t=0时刻的概率比对数值。
每个栅格的先验概率是0.5,即:P(M x,y (t)=1)= P(M x,y (t)=0)=0.5,所以L(M x,y (0))=0。 RCS x,y (t)表示t时刻雷达观测到的栅格的RCS值。这一公式将目标的RCS特征作为每个栅格的占用概率的权重。也就是说,此公式增强了地图中强反射体的占据概率,同时削弱了地图中弱反射体的占据概率。
由于毫米波雷达每帧扫描的数据量较小,不利于帧间的数据匹配。所以在进行数据匹配前,先根据历史帧数据(两个RCS占据栅格地图)分别建立两个栅格化查找表,两个栅格化查找表建立步骤相同。首先建立全局RCS占据栅格地图的局部子图。当新一帧的雷达数据来临,使用雷达上一时刻的位姿x t-1对当前帧中的n个目标进行平移和旋转,得到目标的绝对坐标,并分别确定x,y坐标的最小值和最大值,和。通过设置边界阈值B,最终得到全局地图的局部子图。
接下来估计雷达的位姿,雷达位姿x t 是对应于时间t的三维未知参数: 。先将当前帧的雷达扫描数据,利用x t-1投影到低分辨率地图的椭圆栅格化查找表中。建立三维搜索窗口S l ,将当前帧数据进行平移和旋转,在椭圆栅格化查找表中遍历查找当前帧数据击中栅格的总分的最大值。假设最大值出现在栅格i处,则位姿为,将最大值表示为L i 。
再将当前帧的雷达扫描数据,利用位姿投影到高分辨率地图的椭圆栅格化查找表中。根据i建立三维搜索窗口S h ,再次将当前帧数据进行平移和旋转,遍历查找当前帧数据击中栅格的总分的最大值。假设最大值为,出现最大值的位姿为。
对于在低分辨率椭圆栅格化查找表中得到的总分高于H i 的位姿,再次使用高分辨率椭圆栅格化查找表重新遍历查找该栅格。如果找到大于H i 的总分,则更新H i 与。最大的H i 对应的雷达三维位姿,即为雷达的最佳估计位姿x t 。
实施例中,根据所述当前帧位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。
具体实施时,根据最佳估计的当前帧位姿数据x t ,将当前帧数据进行平移和旋转,即把目标相对于雷达的相对位置转换为绝对位置,即可实现目标的绝对定位。同时把平移和旋转后的当前帧数据投影到两个分辨率的地图中,然后再次更新栅格地图。当下一帧数据来临,重复上述步骤进行毫米波雷达定位。
本发明实施例提供的GNSS信号缺失环境下毫米波雷达目标定位方案具备以下优势:
1、不依赖于其他辅助定位手段,使用SLAM方法实现毫米波雷达自定位,进而实现了目标的绝对定位。
2、相比于激光雷达与光学相机,使用毫米波雷达实现了全天时全天候的定位。
3、针对毫米波雷达数据量小、测量精度低,进而降低SLAM系统定位准确性的问题,提出了改进的数据匹配方法予以解决。
基于同一发明构思,本发明实施例还提供了一种GNSS信号缺失环境下毫米波雷达目标定位装置,如下面的实施例所述。由于这些解决问题的原理与GNSS信号缺失环境下毫米波雷达目标定位方法相似,因此装置的实施可以参见方法的实施,重复之处不再赘述。
图3为本发明实施例中GNSS信号缺失环境下毫米波雷达目标定位装置的结构图,如图3所示,该装置包括:
数据获得模块301,用于获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧位姿数据;
地图建立模块302,用于根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图;
子图确定模块303,用于根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图;
查找表建立模块304,用于根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表;
匹配模块305,用于将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据;
目标定位模块306,用于根据所述当前帧位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。
一个实施例中,所述地图建立模块302进一步用于:
根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,分别建立高分辨率的第一RCS占据栅格地图和低分辨率的第二RCS占据栅格地图;
所述子图确定模块进一步用于:根据预先设置的边界阈值,确定高分辨率的第一RCS占据栅格地图的第一局部子图和低分辨率的第二RCS占据栅格地图的第二局部子图;
所述查找表建立模块进一步用于:根据第一局部子图,建立第一椭圆栅格化查找表,根据第二局部子图,建立第二椭圆栅格化查找表;
所述匹配模块进一步用于:将所述当前帧毫米波雷达采集数据与第一椭圆栅格化查找表和第二椭圆栅格化查找表进行匹配,得到当前帧位姿数据。
一个实施例中,所述查找表建立模块304进一步用于:
利用二维高斯分布对第一局部子图和第二局部子图进行模糊拓展;
根据第一局部子图模糊拓展后的结果,建立第一椭圆栅格化查找表,根据第二局部子图模糊拓展后的结果,建立第二椭圆栅格化查找表。
综上所述,本发明实施例通过获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧位姿数据;根据所述历史帧毫米波雷达采集数据和历史帧位姿数据,建立RCS占据栅格地图;根据预先设置的边界阈值,确定所述RCS占据栅格地图的局部子图;根据所述RCS占据栅格地图的局部子图,建立椭圆栅格化查找表;将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配,得到当前帧位姿数据;根据所述当前帧位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。本发明实施例不依赖于GNSS信号的辅助定位手段,根据RCS占据栅格地图的局部子图,建立椭圆栅格化查找表并将当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配得到当前帧位姿数据,解决了因毫米波雷达数据量小、测量精度低导致的定位不准确的问题,从而实现在GNSS信号缺失环境下进行毫米波雷达目标定位,提高目标定位的准确性。
本领域内的技术人员应明白,本发明的实施例可提供为方法、系统、或计算机程序产品。因此,本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明是参照根据本发明实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
最后应说明的是:以上所述实施例,仅为本发明的具体实施方式,用以说明本发明的技术方案,而非对其限制,本发明的保护范围并不局限于此,尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,其依然可以对前述实施例所记载的技术方案进行修改或可轻易想到变化,或者对其中部分技术特征进行等同替换;而这些修改、变化或者替换,并不使相应技术方案的本质脱离本发明实施例技术方案的精神和范围,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应所述以权利要求的保护范围为准。
Claims (10)
1.一种GNSS信号缺失环境下毫米波雷达目标定位方法,其特征在于,包括:
获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧毫米波雷达位姿数据;
根据所述历史帧毫米波雷达采集数据和历史帧毫米波雷达位姿数据,建立占据栅格地图;
根据预先设置的局部子图的边界阈值,确定所述占据栅格地图的局部子图;
根据所述占据栅格地图的局部子图,建立栅格化查找表;
将所述当前帧毫米波雷达采集数据与栅格化查找表进行匹配,得到当前帧毫米波雷达位姿数据;
根据所述当前帧毫米波雷达位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。
2.如权利要求1所述的GNSS信号缺失环境下毫米波雷达目标定位方法,其特征在于,所述当前帧毫米波雷达采集数据包括:目标相对于雷达在笛卡尔坐标系中的当前横坐标和当前纵坐标,以及目标的当前雷达散射横截面积数据;
所述历史帧毫米波雷达采集数据包括:目标相对于雷达在笛卡尔坐标系中的历史横坐标和历史纵坐标,以及目标的历史雷达散射横截面积数据。
3.如权利要求1所述的GNSS信号缺失环境下毫米波雷达目标定位方法,其特征在于,根据所述历史帧毫米波雷达采集数据和历史帧毫米波雷达位姿数据,建立占据栅格地图,包括:
根据所述历史帧毫米波雷达采集数据和历史帧毫米波雷达位姿数据,分别建立高分辨率的第一占据栅格地图和低分辨率的第二占据栅格地图;
根据预先设置的局部子图的边界阈值,确定所述占据栅格地图的局部子图,包括:根据预先设置的局部子图的边界阈值,确定高分辨率的第一占据栅格地图的第一局部子图和低分辨率的第二占据栅格地图的第二局部子图;
根据所述占据栅格地图的局部子图,建立栅格化查找表,包括:根据第一局部子图,建立第一栅格化查找表,根据第二局部子图,建立第二栅格化查找表;
将所述当前帧毫米波雷达采集数据与栅格化查找表进行匹配,得到当前帧毫米波雷达位姿数据,包括:将所述当前帧毫米波雷达采集数据与第一栅格化查找表和第二栅格化查找表进行匹配,得到当前帧毫米波雷达位姿数据。
4.如权利要求3所述的GNSS信号缺失环境下毫米波雷达目标定位方法,其特征在于,根据第一局部子图,建立第一栅格化查找表,根据第二局部子图,建立第二栅格化查找表,包括:
利用二维高斯分布对第一局部子图和第二局部子图进行拓展;
根据第一局部子图拓展后的结果,建立第一栅格化查找表,根据第二局部子图拓展后的结果,建立第二栅格化查找表。
5.如权利要求3所述的GNSS信号缺失环境下毫米波雷达目标定位方法,其特征在于,将所述当前帧毫米波雷达采集数据与第一栅格化查找表和第二栅格化查找表进行匹配,得到当前帧毫米波雷达位姿数据,包括:
将所述当前帧毫米波雷达采集数据投影到第二栅格化查找表中;
建立三维搜索窗口,将投影到第二栅格化查找表后的当前帧毫米波雷达采集数据进行平移处理和旋转处理;
在第二栅格化查找表中遍历查找当前帧毫米波雷达采集数据对应栅格的概率之和的第一最大值;
将所述当前帧毫米波雷达采集数据投影到第一栅格化查找表中;
建立三维搜索窗口,将投影到第一栅格化查找表后的当前帧毫米波雷达采集数据进行平移处理和旋转处理;
在第一栅格化查找表中遍历查找当前帧毫米波雷达采集数据对应栅格的概率之和的第二最大值;
根据所述第一最大值和第二最大值,得到当前帧毫米波雷达位姿数据。
6.一种GNSS信号缺失环境下毫米波雷达目标定位装置,其特征在于,包括:
数据获得模块,用于获得当前帧毫米波雷达采集数据,历史帧毫米波雷达采集数据和历史帧毫米波雷达位姿数据;
地图建立模块,用于根据所述历史帧毫米波雷达采集数据和历史帧毫米波雷达位姿数据,建立占据栅格地图;
子图确定模块,用于根据预先设置的局部子图的边界阈值,确定所述占据栅格地图的局部子图;
查找表建立模块,用于根据所述占据栅格地图的局部子图,建立栅格化查找表;
匹配模块,用于将所述当前帧毫米波雷达采集数据与栅格化查找表进行匹配,得到当前帧毫米波雷达位姿数据;
目标定位模块,用于根据所述当前帧毫米波雷达位姿数据,进行GNSS信号缺失环境下毫米波雷达目标定位。
7.如权利要求6所述的GNSS信号缺失环境下毫米波雷达目标定位装置,其特征在于,所述地图建立模块还用于:
根据所述历史帧毫米波雷达采集数据和历史帧毫米波雷达位姿数据,分别建立高分辨率的第一占据栅格地图和低分辨率的第二占据栅格地图;
所述子图确定模块还用于:根据预先设置的局部子图的边界阈值,确定高分辨率的第一占据栅格地图的第一局部子图和低分辨率的第二占据栅格地图的第二局部子图;
所述查找表建立模块还用于:根据第一局部子图,建立第一栅格化查找表,根据第二局部子图,建立第二栅格化查找表;
所述匹配模块还用于:将所述当前帧毫米波雷达采集数据与第一栅格化查找表和第二栅格化查找表进行匹配,得到当前帧毫米波雷达位姿数据。
8.如权利要求7所述的GNSS信号缺失环境下毫米波雷达目标定位装置,其特征在于,所述查找表建立模块还用于:
利用二维高斯分布对第一局部子图和第二局部子图进行拓展;
根据第一局部子图拓展后的结果,建立第一栅格化查找表,根据第二局部子图拓展后的结果,建立第二栅格化查找表。
9.一种计算机设备,包括存储器、处理器及存储在存储器上并在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至5任一所述方法。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有执行权利要求1至5任一所述方法的计算机程序。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110166370.2A CN112505671B (zh) | 2021-02-07 | 2021-02-07 | Gnss信号缺失环境下毫米波雷达目标定位方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110166370.2A CN112505671B (zh) | 2021-02-07 | 2021-02-07 | Gnss信号缺失环境下毫米波雷达目标定位方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112505671A CN112505671A (zh) | 2021-03-16 |
CN112505671B true CN112505671B (zh) | 2021-05-25 |
Family
ID=74953188
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110166370.2A Active CN112505671B (zh) | 2021-02-07 | 2021-02-07 | Gnss信号缺失环境下毫米波雷达目标定位方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112505671B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113865580B (zh) * | 2021-09-15 | 2024-03-22 | 北京易航远智科技有限公司 | 构建地图的方法、装置、电子设备及计算机可读存储介质 |
FR3141534A1 (fr) * | 2022-10-26 | 2024-05-03 | Continental Autonomous Mobility Germany GmbH | Procédé de traitement de données acquises à partir d’un capteur radar |
CN115421505B (zh) * | 2022-11-04 | 2023-03-17 | 北京卓翼智能科技有限公司 | 一种无人机集群系统及无人机 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108596980A (zh) * | 2018-03-29 | 2018-09-28 | 中国人民解放军63920部队 | 圆形目标视觉定位精度评估方法、装置、存储介质和处理设备 |
CN110044371A (zh) * | 2018-01-16 | 2019-07-23 | 华为技术有限公司 | 一种车辆定位的方法以及车辆定位装置 |
CN110888125A (zh) * | 2019-12-05 | 2020-03-17 | 奥特酷智能科技(南京)有限公司 | 一种基于毫米波雷达的自动驾驶车辆定位方法 |
CN111324686A (zh) * | 2020-02-28 | 2020-06-23 | 浙江大华技术股份有限公司 | 目标测量轨迹的获取方法及装置、存储介质、电子装置 |
CN111382768A (zh) * | 2018-12-29 | 2020-07-07 | 华为技术有限公司 | 多传感器数据融合方法和装置 |
WO2020198847A1 (en) * | 2019-03-29 | 2020-10-08 | Avigilon Corporation | Human profile and anomaly detection |
-
2021
- 2021-02-07 CN CN202110166370.2A patent/CN112505671B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110044371A (zh) * | 2018-01-16 | 2019-07-23 | 华为技术有限公司 | 一种车辆定位的方法以及车辆定位装置 |
CN108596980A (zh) * | 2018-03-29 | 2018-09-28 | 中国人民解放军63920部队 | 圆形目标视觉定位精度评估方法、装置、存储介质和处理设备 |
CN111382768A (zh) * | 2018-12-29 | 2020-07-07 | 华为技术有限公司 | 多传感器数据融合方法和装置 |
WO2020198847A1 (en) * | 2019-03-29 | 2020-10-08 | Avigilon Corporation | Human profile and anomaly detection |
CN110888125A (zh) * | 2019-12-05 | 2020-03-17 | 奥特酷智能科技(南京)有限公司 | 一种基于毫米波雷达的自动驾驶车辆定位方法 |
CN111324686A (zh) * | 2020-02-28 | 2020-06-23 | 浙江大华技术股份有限公司 | 目标测量轨迹的获取方法及装置、存储介质、电子装置 |
Also Published As
Publication number | Publication date |
---|---|
CN112505671A (zh) | 2021-03-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112505671B (zh) | Gnss信号缺失环境下毫米波雷达目标定位方法及装置 | |
US11086016B2 (en) | Method and apparatus for tracking obstacle | |
CN108319655B (zh) | 用于生成栅格地图的方法和装置 | |
CN110178048B (zh) | 交通工具环境地图生成和更新的方法和系统 | |
CN110889808B (zh) | 一种定位的方法、装置、设备及存储介质 | |
CN108280866B (zh) | 道路点云数据处理方法及系统 | |
JP2020508506A (ja) | 3d点データにおける垂直構造を取り込む2dマップを使用する位置推定 | |
WO2020041668A1 (en) | Signals of opportunity aided inertial navigation | |
CN112781599B (zh) | 确定车辆的位置的方法 | |
JP5286653B2 (ja) | 静止物地図生成装置 | |
CN113822944B (zh) | 一种外参标定方法、装置、电子设备及存储介质 | |
JP2007322391A (ja) | 自車両位置推定装置 | |
CN112805766A (zh) | 用于更新详细地图的装置和方法 | |
CN115371662B (zh) | 一种基于概率栅格移除动态对象的静态地图构建方法 | |
JP2018072316A (ja) | ジオアーク(geoarc)を使用したビークルの二次元位置の特定 | |
JP2018206038A (ja) | 点群データ処理装置、移動ロボット、移動ロボットシステム、および点群データ処理方法 | |
CN112731337B (zh) | 地图构建方法、装置和设备 | |
Aggarwal | GPS-based localization of autonomous vehicles | |
CN115235482A (zh) | 地图更新方法、装置、计算机设备及介质 | |
JPWO2017199369A1 (ja) | 地物認識装置、地物認識方法およびプログラム | |
CN114384486A (zh) | 一种数据处理方法及装置 | |
CN112180396A (zh) | 一种激光雷达定位及地图创建方法 | |
CN116704024A (zh) | 一种联合多类约束的车载激光点云位姿图优化方法及系统 | |
US11834065B2 (en) | System, method, and computer program product for detecting road marking points from LiDAR data | |
KR102308803B1 (ko) | 이미지 기반의 무선 측위 방법 및 장치 |
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 |