CN112505671A - Gnss信号缺失环境下毫米波雷达目标定位方法及装置 - Google Patents

Gnss信号缺失环境下毫米波雷达目标定位方法及装置 Download PDF

Info

Publication number
CN112505671A
CN112505671A CN202110166370.2A CN202110166370A CN112505671A CN 112505671 A CN112505671 A CN 112505671A CN 202110166370 A CN202110166370 A CN 202110166370A CN 112505671 A CN112505671 A CN 112505671A
Authority
CN
China
Prior art keywords
millimeter wave
wave radar
data
rasterization
lookup table
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110166370.2A
Other languages
English (en)
Other versions
CN112505671B (zh
Inventor
王彦平
刘宇通
李洋
林赟
申文杰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
North China University of Technology
Original Assignee
North China University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by North China University of Technology filed Critical North China University of Technology
Priority to CN202110166370.2A priority Critical patent/CN112505671B/zh
Publication of CN112505671A publication Critical patent/CN112505671A/zh
Application granted granted Critical
Publication of CN112505671B publication Critical patent/CN112505671B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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

Abstract

本发明公开了一种GNSS信号缺失环境下毫米波雷达目标定位方法及装置，方法包括：获得当前帧毫米波雷达采集数据，历史帧毫米波雷达采集数据和历史帧位姿数据；根据所述历史帧毫米波雷达采集数据和历史帧位姿数据，建立RCS占据栅格地图；根据预先设置的边界阈值，确定所述RCS占据栅格地图的局部子图；根据所述RCS占据栅格地图的局部子图，建立椭圆栅格化查找表；将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配，得到当前帧位姿数据；根据所述当前帧位姿数据，进行GNSS信号缺失环境下毫米波雷达目标定位。本发明可以在GNSS信号缺失环境下进行毫米波雷达目标定位，提高目标定位的准确性。

Description

GNSS信号缺失环境下毫米波雷达目标定位方法及装置
技术领域
本发明涉及毫米波雷达点云处理技术领域，尤其涉及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 包含的三维特征为：
Figure 53066DEST_PATH_IMAGE001
其中，
Figure 439048DEST_PATH_IMAGE002
和
Figure 671315DEST_PATH_IMAGE002
是目标相对于雷达在笛卡尔坐标系中的坐标，rcs m 表示目标的雷达散射横截面积数据（RCS）。RCS表征了目标在雷达波照射下所产生回波强度的一种物理量，RCS低的目标是弱反射体，RCS高的目标为强反射体。反射体的RCS越低，它产生的回波强度也会越小，从而它被雷达检测到的概率也就越小。每一帧数据构成一个
Figure 535366DEST_PATH_IMAGE003
的矩阵。
实施例中，根据所述历史帧毫米波雷达采集数据和历史帧位姿数据，建立RCS占据栅格地图。根据预先设置的边界阈值，确定所述RCS占据栅格地图的局部子图。根据所述RCS占据栅格地图的局部子图，建立椭圆栅格化查找表。将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配，得到当前帧位姿数据。
本实施例中，根据所述历史帧毫米波雷达采集数据和历史帧位姿数据，建立RCS占据栅格地图，包括：根据所述历史帧毫米波雷达采集数据和历史帧位姿数据，分别建立高分辨率的第一RCS占据栅格地图和低分辨率的第二RCS占据栅格地图；根据预先设置的边界阈值，确定所述RCS占据栅格地图的局部子图，包括：根据预先设置的边界阈值，确定高分辨率的第一RCS占据栅格地图的第一局部子图和低分辨率的第二RCS占据栅格地图的第二局部子图；根据所述RCS占据栅格地图的局部子图，建立椭圆栅格化查找表，包括：根据第一局部子图，建立第一椭圆栅格化查找表，根据第二局部子图，建立第二椭圆栅格化查找表；将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配，得到当前帧位姿数据，包括：将所述当前帧毫米波雷达采集数据与第一椭圆栅格化查找表和第二椭圆栅格化查找表进行匹配，得到当前帧位姿数据。
本实施例中，根据第一局部子图，建立第一椭圆栅格化查找表，根据第二局部子图，建立第二椭圆栅格化查找表，包括：利用二维高斯分布对第一局部子图和第二局部子图进行模糊拓展；根据第一局部子图模糊拓展后的结果，建立第一椭圆栅格化查找表，根据第二局部子图模糊拓展后的结果，建立第二椭圆栅格化查找表。
本实施例中，将所述当前帧毫米波雷达采集数据与第一椭圆栅格化查找表和第二椭圆栅格化查找表进行匹配，得到当前帧位姿数据，包括：将所述当前帧毫米波雷达采集数据投影到第二椭圆栅格化查找表中；建立三维搜索窗口，将投影后的当前帧毫米波雷达采集数据进行平移处理和旋转处理；在第二椭圆栅格化查找表中遍历查找当前帧毫米波雷达采集数据击中栅格的总分的第一最大值；将所述当前帧毫米波雷达采集数据投影到第一椭圆栅格化查找表中；建立三维搜索窗口，将投影后的当前帧毫米波雷达采集数据进行平移处理和旋转处理；在第一椭圆栅格化查找表中遍历查找当前帧毫米波雷达采集数据击中栅格的总分的第二最大值；根据所述第一最大值和第二最大值，得到当前帧位姿数据。
具体实施时，首先构造两个RCS占据栅格地图，即高分辨率的第一RCS占据栅格地图和低分辨率的第二RCS占据栅格地图，构造的步骤相同，区别在于分辨率大小不同。首先RCS占据栅格地图可以表示为M：
Figure 818580DEST_PATH_IMAGE004
将地图M划分为
Figure 109884DEST_PATH_IMAGE005
个栅格，每个栅格相互独立。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用如下公式表示：
Figure 593562DEST_PATH_IMAGE006
为了避免概率接近0或1时引起的截断问题，使用概率比值的对数形式表示每个栅格被占用的概率，表示为：
Figure 261303DEST_PATH_IMAGE007
通过公式变换，把栅格状态的更新变成了简单的加法，利于二元贝叶斯滤波的迭代更新，如下公式：
Figure 399024DEST_PATH_IMAGE008
使用该公式来实时更新每个栅格的状态，进而可以得到全局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个目标
Figure 126808DEST_PATH_IMAGE009
进行平移和旋转，得到目标的绝对坐标，并分别确定x,y坐标的最小值和最大值，
Figure 599247DEST_PATH_IMAGE010
和
Figure 805100DEST_PATH_IMAGE011
。通过设置边界阈值B，最终得到全局地图的局部子图。
Figure 797327DEST_PATH_IMAGE012
接下来建立栅格化查找表。雷达对目标的检测实质上是测量目标相对雷达的角度
Figure 696013DEST_PATH_IMAGE013
与径向距离
Figure 672059DEST_PATH_IMAGE014
。使用二维高斯分布对局部子图中的所有目标进行
Figure 166757DEST_PATH_IMAGE013
与
Figure 544648DEST_PATH_IMAGE014
维度的模糊拓展。如下公式：
Figure 348656DEST_PATH_IMAGE015
其中，
Figure 546419DEST_PATH_IMAGE016
表示目标点在地图中的附近栅格的极坐标，
Figure 359655DEST_PATH_IMAGE017
表示
Figure 396313DEST_PATH_IMAGE016
的期望，
Figure 89332DEST_PATH_IMAGE018
表示
Figure 243232DEST_PATH_IMAGE016
的方差。最终形成的栅格化查找表呈现椭圆形，称为椭圆栅格化查找表。
接下来估计雷达的位姿，雷达位姿x t 是对应于时间t的三维未知参数：
Figure 329000DEST_PATH_IMAGE019
Figure 901058DEST_PATH_IMAGE020
。先将当前帧的雷达扫描数据，利用x t-1投影到低分辨率地图的椭圆栅格化查找表中。建立三维搜索窗口S l ，将当前帧数据进行平移和旋转，在椭圆栅格化查找表中遍历查找当前帧数据击中栅格的总分的最大值。假设最大值出现在栅格i处，则位姿为
Figure 312448DEST_PATH_IMAGE021
，将最大值表示为L i 。
再将当前帧的雷达扫描数据，利用位姿
Figure 219224DEST_PATH_IMAGE021
投影到高分辨率地图的椭圆栅格化查找表中。根据i建立三维搜索窗口S h ，再次将当前帧数据进行平移和旋转，遍历查找当前帧数据击中栅格的总分的最大值。假设最大值为
Figure 374262DEST_PATH_IMAGE022
，出现最大值的位姿为
Figure 564940DEST_PATH_IMAGE023
。
对于在低分辨率椭圆栅格化查找表中得到的总分高于H i 的位姿，再次使用高分辨率椭圆栅格化查找表重新遍历查找该栅格。如果找到大于H i 的总分，则更新H i 与
Figure 412811DEST_PATH_IMAGE023
。最大的H i 对应的雷达三维位姿
Figure 806883DEST_PATH_IMAGE024
，即为雷达的最佳估计位姿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信号缺失环境下毫米波雷达目标定位方法，其特征在于，包括：
获得当前帧毫米波雷达采集数据，历史帧毫米波雷达采集数据和历史帧位姿数据；
根据所述历史帧毫米波雷达采集数据和历史帧位姿数据，建立RCS占据栅格地图；
根据预先设置的边界阈值，确定所述RCS占据栅格地图的局部子图；
根据所述RCS占据栅格地图的局部子图，建立椭圆栅格化查找表；
将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配，得到当前帧位姿数据；
根据所述当前帧位姿数据，进行GNSS信号缺失环境下毫米波雷达目标定位。
2.如权利要求1所述的GNSS信号缺失环境下毫米波雷达目标定位方法，其特征在于，所述当前帧毫米波雷达采集数据包括：目标相对于雷达在笛卡尔坐标系中的当前横坐标和当前纵坐标，以及目标的当前雷达散射横截面积数据；
所述历史帧毫米波雷达采集数据包括：目标相对于雷达在笛卡尔坐标系中的历史横坐标和历史纵坐标，以及目标的历史雷达散射横截面积数据。
3.如权利要求1所述的GNSS信号缺失环境下毫米波雷达目标定位方法，其特征在于，根据所述历史帧毫米波雷达采集数据和历史帧位姿数据，建立RCS占据栅格地图，包括：
根据所述历史帧毫米波雷达采集数据和历史帧位姿数据，分别建立高分辨率的第一RCS占据栅格地图和低分辨率的第二RCS占据栅格地图；
根据预先设置的边界阈值，确定所述RCS占据栅格地图的局部子图，包括：根据预先设置的边界阈值，确定高分辨率的第一RCS占据栅格地图的第一局部子图和低分辨率的第二RCS占据栅格地图的第二局部子图；
根据所述RCS占据栅格地图的局部子图，建立椭圆栅格化查找表，包括：根据第一局部子图，建立第一椭圆栅格化查找表，根据第二局部子图，建立第二椭圆栅格化查找表；
将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配，得到当前帧位姿数据，包括：将所述当前帧毫米波雷达采集数据与第一椭圆栅格化查找表和第二椭圆栅格化查找表进行匹配，得到当前帧位姿数据。
4.如权利要求3所述的GNSS信号缺失环境下毫米波雷达目标定位方法，其特征在于，根据第一局部子图，建立第一椭圆栅格化查找表，根据第二局部子图，建立第二椭圆栅格化查找表，包括：
利用二维高斯分布对第一局部子图和第二局部子图进行模糊拓展；
根据第一局部子图模糊拓展后的结果，建立第一椭圆栅格化查找表，根据第二局部子图模糊拓展后的结果，建立第二椭圆栅格化查找表。
5.如权利要求3所述的GNSS信号缺失环境下毫米波雷达目标定位方法，其特征在于，将所述当前帧毫米波雷达采集数据与第一椭圆栅格化查找表和第二椭圆栅格化查找表进行匹配，得到当前帧位姿数据，包括：
将所述当前帧毫米波雷达采集数据投影到第二椭圆栅格化查找表中；
建立三维搜索窗口，将投影后的当前帧毫米波雷达采集数据进行平移处理和旋转处理；
在第二椭圆栅格化查找表中遍历查找当前帧毫米波雷达采集数据击中栅格的总分的第一最大值；
将所述当前帧毫米波雷达采集数据投影到第一椭圆栅格化查找表中；
建立三维搜索窗口，将投影后的当前帧毫米波雷达采集数据进行平移处理和旋转处理；
在第一椭圆栅格化查找表中遍历查找当前帧毫米波雷达采集数据击中栅格的总分的第二最大值；
根据所述第一最大值和第二最大值，得到当前帧位姿数据。
6.一种GNSS信号缺失环境下毫米波雷达目标定位装置，其特征在于，包括：
数据获得模块，用于获得当前帧毫米波雷达采集数据，历史帧毫米波雷达采集数据和历史帧位姿数据；
地图建立模块，用于根据所述历史帧毫米波雷达采集数据和历史帧位姿数据，建立RCS占据栅格地图；
子图确定模块，用于根据预先设置的边界阈值，确定所述RCS占据栅格地图的局部子图；
查找表建立模块，用于根据所述RCS占据栅格地图的局部子图，建立椭圆栅格化查找表；
匹配模块，用于将所述当前帧毫米波雷达采集数据与椭圆栅格化查找表进行匹配，得到当前帧位姿数据；
目标定位模块，用于根据所述当前帧位姿数据，进行GNSS信号缺失环境下毫米波雷达目标定位。
7.如权利要求6所述的GNSS信号缺失环境下毫米波雷达目标定位装置，其特征在于，所述地图建立模块进一步用于：
根据所述历史帧毫米波雷达采集数据和历史帧位姿数据，分别建立高分辨率的第一RCS占据栅格地图和低分辨率的第二RCS占据栅格地图；
所述子图确定模块进一步用于：根据预先设置的边界阈值，确定高分辨率的第一RCS占据栅格地图的第一局部子图和低分辨率的第二RCS占据栅格地图的第二局部子图；
所述查找表建立模块进一步用于：根据第一局部子图，建立第一椭圆栅格化查找表，根据第二局部子图，建立第二椭圆栅格化查找表；
所述匹配模块进一步用于：将所述当前帧毫米波雷达采集数据与第一椭圆栅格化查找表和第二椭圆栅格化查找表进行匹配，得到当前帧位姿数据。
8.如权利要求7所述的GNSS信号缺失环境下毫米波雷达目标定位装置，其特征在于，所述查找表建立模块进一步用于：
利用二维高斯分布对第一局部子图和第二局部子图进行模糊拓展；
根据第一局部子图模糊拓展后的结果，建立第一椭圆栅格化查找表，根据第二局部子图模糊拓展后的结果，建立第二椭圆栅格化查找表。
9.一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行所述计算机程序时实现权利要求1至5任一所述方法。
10.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质存储有执行权利要求1至5任一所述方法的计算机程序。
CN202110166370.2A 2021-02-07 2021-02-07 Gnss信号缺失环境下毫米波雷达目标定位方法及装置 Active CN112505671B (zh)

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 true CN112505671A (zh) 2021-03-16
CN112505671B 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)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113865580A (zh) * 2021-09-15 2021-12-31 北京易航远智科技有限公司 构建地图的方法、装置、电子设备及计算机可读存储介质
CN115421505A (zh) * 2022-11-04 2022-12-02 北京卓翼智能科技有限公司 一种无人机集群系统及无人机

Citations (6)

* Cited by examiner, † Cited by third party
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

Patent Citations (6)

* Cited by examiner, † Cited by third party
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 浙江大华技术股份有限公司 目标测量轨迹的获取方法及装置、存储介质、电子装置

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113865580A (zh) * 2021-09-15 2021-12-31 北京易航远智科技有限公司 构建地图的方法、装置、电子设备及计算机可读存储介质
CN113865580B (zh) * 2021-09-15 2024-03-22 北京易航远智科技有限公司 构建地图的方法、装置、电子设备及计算机可读存储介质
CN115421505A (zh) * 2022-11-04 2022-12-02 北京卓翼智能科技有限公司 一种无人机集群系统及无人机

Also Published As

Publication number Publication date
CN112505671B (zh) 2021-05-25

Similar Documents

Publication Publication Date Title
CN108319655B (zh) 用于生成栅格地图的方法和装置
CN110178048B (zh) 交通工具环境地图生成和更新的方法和系统
CN108921947B (zh) 生成电子地图的方法、装置、设备、存储介质以及采集实体
CN110889808B (zh) 一种定位的方法、装置、设备及存储介质
RU2720140C1 (ru) Способ оценки собственной позиции и устройство оценки собственной позиции
CN108280866B (zh) 道路点云数据处理方法及系统
CN111563450B (zh) 数据处理方法、装置、设备及存储介质
CN112505671B (zh) Gnss信号缺失环境下毫米波雷达目标定位方法及装置
JP5286653B2 (ja) 静止物地図生成装置
JP7033859B2 (ja) ジオアーク（ｇｅｏａｒｃ）を使用したビークルの二次元位置の特定
WO2020041668A1 (en) Signals of opportunity aided inertial navigation
CN112805766B (zh) 用于更新详细地图的装置和方法
WO2024012211A1 (zh) 自动驾驶环境感知方法、介质及车辆
CN113822944B (zh) 一种外参标定方法、装置、电子设备及存储介质
CN114820749A (zh) 无人车井下定位方法、系统、设备及介质
JP2018206038A (ja) 点群データ処理装置、移動ロボット、移動ロボットシステム、および点群データ処理方法
WO2017199369A1 (ja) 地物認識装置、地物認識方法およびプログラム
CN110927765B (zh) 激光雷达与卫星导航融合的目标在线定位方法
WO2022083529A1 (zh) 一种数据处理方法及装置
KR102308803B1 (ko) 이미지 기반의 무선 측위 방법 및 장치
US20220194413A1 (en) System, Method, and Computer Program Product for Detecting Road Marking Points from LiDAR Data
CN114509774A (zh) 定位方法、定位系统、车辆以及计算机可读存储介质
Iannucci et al. Cross-Modal Localization: Using automotive radar for absolute geolocation within a map produced with visible-light imagery
CN113421306A (zh) 定位初始化方法、系统及移动工具
CN116939815B (zh) 一种基于激光点云地图的uwb定位基站选择方法

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