CN114578341A - 雷达追踪方法、噪声消除方法、装置和设备 - Google Patents
雷达追踪方法、噪声消除方法、装置和设备 Download PDFInfo
- Publication number
- CN114578341A CN114578341A CN202011379867.4A CN202011379867A CN114578341A CN 114578341 A CN114578341 A CN 114578341A CN 202011379867 A CN202011379867 A CN 202011379867A CN 114578341 A CN114578341 A CN 114578341A
- Authority
- CN
- China
- Prior art keywords
- point cloud
- doppler
- cloud cluster
- distance
- noise
- 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.)
- Pending
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/66—Radar-tracking systems; Analogous systems
- G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
- G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
-
- 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/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/28—Details of pulse systems
- G01S7/285—Receivers
- G01S7/292—Extracting wanted echo-signals
- G01S7/2923—Extracting wanted echo-signals based on data belonging to a number of consecutive radar periods
-
- 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/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/35—Details of non-pulse systems
- G01S7/352—Receivers
- G01S7/354—Extracting wanted echo-signals
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F18/00—Pattern recognition
- G06F18/20—Analysing
- G06F18/23—Clustering techniques
- G06F18/232—Non-hierarchical techniques
- G06F18/2321—Non-hierarchical techniques using statistics or function optimisation, e.g. modelling of probability density functions
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Evolutionary Biology (AREA)
- Evolutionary Computation (AREA)
- General Engineering & Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Bioinformatics & Computational Biology (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Artificial Intelligence (AREA)
- Probability & Statistics with Applications (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本申请实施例提供了一种雷达追踪方法、噪声消除方法、装置和设备,该雷达追踪方法包括:在距离‑多普勒平面对通过雷达感知获得的点云进行聚类,得到距离‑多普勒点云簇;在空间维或者角度维对所述距离‑多普勒点云簇进行二次聚类,得到二次聚类点云簇;根据所述距离‑多普勒点云簇及其对应的所述二次聚类点云簇确定追踪目标。该雷达追踪方法利用两次聚类的策略提高追踪精度,扩展追踪的有效范围,以解决在距离较远处,雷达的空间测量精度变差,点云容易分散无法进行聚类的问题。
Description
技术领域
本申请涉及信息技术领域,尤其涉及一种雷达追踪方法、噪声消除方法、装置和设备。
背景技术
雷达通过无线信号感知运动物体的距离、速度和方位角等信息并形成点云。常规的雷达追踪算法通过点云的空间信息进行聚类和滤波等操作实现对目标的追踪。但是在距离较远处,雷达的空间测量精度变差,点云容易分散无法进行聚类。
应该注意,上面对技术背景的介绍只是为了方便对本申请的技术方案进行清楚、完整的说明,并方便本领域技术人员的理解而阐述的。不能仅仅因为这些方案在本申请的背景技术部分进行了阐述而认为上述技术方案为本领域技术人员所公知。
发明内容
为了解决在距离较远处,雷达的空间测量精度变差,点云容易分散无法进行聚类的问题,本申请实施例提供了一种雷达追踪方法、噪声消除方法、装置和设备。
根据本申请实施例的第一方面,提供一种雷达追踪方法,所述方法包括:
在距离-多普勒平面对通过雷达感知获得的点云进行聚类,得到距离-多普勒点云簇;
在空间维或者角度维对所述距离-多普勒点云簇进行二次聚类,得到二次聚类点云簇;
根据所述距离-多普勒点云簇及其对应的所述二次聚类点云簇确定追踪目标。
根据本申请实施例的第二方面,提供一种噪声消除方法,所述方法包括:
统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数nn和距离-多普勒平面上每个位置出现噪声点的次数nr,v;
根据所述点云噪声信息对所述距离-多普勒平面上的点云簇进行分析,判断所述点云簇是否是由噪声引起的点云簇;
如果所述点云簇是由噪声引起的点云簇,则消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
根据本申请实施例的第三方面,提供一种雷达追踪装置,所述装置包括:
第一聚类单元,其在距离-多普勒平面对通过雷达感知获得的点云进行聚类,得到距离-多普勒点云簇;
第二聚类单元,其在空间维或者角度维对所述距离-多普勒点云簇进行二次聚类,得到二次聚类点云簇;
确定单元,其根据所述距离-多普勒点云簇及其对应的所述二次聚类点云簇确定追踪目标。
根据本申请实施例的第四方面,提供一种噪声消除装置,所述装置包括:
统计单元,其统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数nn和距离-多普勒平面上每个位置出现噪声点的次数nr,v;
分析单元,其根据所述点云噪声信息对所述距离-多普勒平面上的点云簇进行分析,判断所述点云簇是否是由噪声引起的点云簇;
处理单元,其在所述点云簇是由噪声引起的点云簇时,消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
根据本申请实施例的又一方面,提供一种计算机设备,其中,所述计算机设备包括处理器和存储器,所述存储器存储计算机程序,所述处理器被配置为执行所述计算机程序而实现前述第一方面或第二方面所述的方法。
本申请实施例的有益效果之一在于:根据本申请实施例,一方面,利用两次聚类的策略提高追踪精度,扩展追踪的有效范围,解决了在距离较远处,雷达的空间测量精度变差,点云容易分散无法进行聚类的问题;另一方面,通过消除距离-多普勒平面上的由噪声引起的点云簇,进一步提高了空间测量精度。
参照后文的说明和附图,详细公开了本申请的特定实施方式,指明了本申请的原理可以被采用的方式。应该理解,本申请的实施方式在范围上并不因而受到限制。在所附权利要求的精神和条款的范围内,本申请的实施方式包括许多改变、修改和等同。
针对一种实施方式描述和/或示出的特征可以以相同或类似的方式在一个或更多个其它实施方式中使用,与其它实施方式中的特征相组合,或替代其它实施方式中的特征。
应该强调,术语“包括/包含”在本文使用时指特征、整件、步骤或组件的存在,但并不排除一个或更多个其它特征、整件、步骤或组件的存在或附加。
附图说明
在本申请实施例的一个附图或一种实施方式中描述的元素和特征可以与一个或更多个其它附图或实施方式中示出的元素和特征相结合。此外,在附图中,类似的标号表示几个附图中对应的部件,并可用于指示多于一种实施方式中使用的对应部件。
所包括的附图用来提供对本申请实施例的进一步的理解,其构成了说明书的一部分,用于例示本申请的实施方式,并与文字描述一起来阐释本申请的原理。显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。在附图中:
图1是本申请实施例的雷达追踪方法的一个示例的示意图;
图2是距离-多普勒平面的一个示意图;
图3是消除距离-多普勒平面上的噪声点云簇的一个示例的示意图;
图4是更新距离-多普勒平面上的点云噪声信息的一个示例的示意图;
图5是雷达点云在X-Y平面的一个示意图;
图6是雷达点云在距离-多普勒平面的一个示意图;
图7是在空间维对所述距离-多普勒点云簇进行二次聚类的一个示例的示意图;
图8是空间位置校正的一个示例的示意图;
图9是在角度维对所述距离-多普勒点云簇进行二次聚类的一个示例的示意图;
图10是确定追踪目标的一个示例的示意图;
图11是本申请实施例的噪声消除方法的一个示例的示意图;
图12是本申请实施例的雷达追踪装置的一个示例的示意图;
图13是本申请实施例的噪声消除装置的一个示例的示意图;
图14是本申请实施例的计算机设备的一个示意图。
具体实施方式
参照附图,通过下面的说明书,本申请的前述以及其它特征将变得明显。在说明书和附图中,具体公开了本申请的特定实施方式,其表明了其中可以采用本申请的原则的部分实施方式,应了解的是,本申请不限于所描述的实施方式,相反,本申请包括落入所附权利要求的范围内的全部修改、变型以及等同物。
在本申请实施例中,术语“第一”、“第二”等用于对不同元素从称谓上进行区分,但并不表示这些元素的空间排列或时间顺序等,这些元素不应被这些术语所限制。术语“和/或”包括相关联列出的术语的一种或多个中的任何一个和所有组合。术语“包含”、“包括”、“具有”等是指所陈述的特征、元素、元件或组件的存在,但并不排除存在或添加一个或多个其他特征、元素、元件或组件。
在本申请实施例中,单数形式“一”、“该”等包括复数形式,应广义地理解为“一种”或“一类”而并不是限定为“一个”的含义;此外术语“所述”应理解为既包括单数形式也包括复数形式,除非上下文另外明确指出。此外术语“根据”应理解为“至少部分根据......”,术语“基于”应理解为“至少部分基于......”,除非上下文另外明确指出。
下面结合附图对本申请实施例的各种实施方式进行说明。这些实施方式只是示例性的,不是对本申请实施例的限制。
第一方面的实施例
本申请实施例提供一种雷达追踪方法。图1是本申请实施例的雷达追踪方法的一个示例的示意图,请参照图1,该方法包括:
101:在距离-多普勒平面对通过雷达感知获得的点云进行聚类,得到距离-多普勒点云簇;
102:在空间维或者角度维对所述距离-多普勒点云簇进行二次聚类,得到二次聚类点云簇;
103:根据所述距离-多普勒点云簇及其对应的所述二次聚类点云簇确定追踪目标。
根据本申请实施例的方法,利用两次聚类的策略提高追踪精度,扩展追踪的有效范围,解决了在距离较远处,雷达的空间测量精度变差,点云容易分散无法进行聚类的问题。
在本申请实施例中,雷达周期性地向空间发送无线信号,并接收经空间中的物体反射的信号(称为反射信号);通过对反射信号进行分析,雷达输出点云,点云包含了雷达覆盖范围内物体的空间位置和速度信息。雷达输出的点云(称为雷达点云)用{oi,1≤i≤no}表示,其中oi是第i个点,no为点云中点的个数。
其中,雷达点云中的点oi可以用oi=(ri,vi,xi,yi,zi,αi,βi)表示,ri是点oi的距离频点,vi是点oi的多普勒速度频点,(xi,yi,zi)为点oi的空间坐标,αi和βi分别为点oi的水平和垂直角度频点。其中,距离频点ri可用于计算点oi到雷达的距离,当雷达的距离分辨率为Δr时,点oi到雷达的距离表示为riΔr。其中,多普勒速度频点vi用于计算点oi相对雷达的速度,当雷达的速度分辨率为Δv时,点oi相对雷达的多普勒速度为viΔv。雷达的最大距离频点数和最大多普勒速度频点数分别用nr和nv表示。其中,水平角度频点αi可用于计算点oi相对雷达的水平角度A=waαi/na,其中,na为水平角度FFT的总频点数,wa是与雷达多天线配置相关的参数。此外,与水平角度频点αi类似,通过垂直角度频点βi可以计算点oi相对雷达的垂直角度。
在本申请实施例中,在101的一些实施例中,在距离-多普勒平面对点云进行聚类,包括:将上述点云映射到距离-多普勒平面;根据该点云在该距离-多普勒平面上的距离,将上述点云划分为多个点云簇(称为距离-多普勒点云簇)以及未成簇点云(无法形成点云簇的点称为未成簇点云),每个点云簇中的点的数量大于第一阈值Tn1,并且,每个点云簇中的每个点到该点云簇的距离小于第二阈值Td1。
在上述实施例中,距离-多普勒平面是一个二维平面,其横轴为距离频点,纵轴为多普勒速度频点,根据雷达点云中各个点的距离频点和多普勒速度频点,雷达点云可以映射到该距离-多普勒平面上。
图2是映射到距离-多普勒平面的雷达点云的一个示例的示意图,其中,区域A的点云中点的数量大且分布集中,其可能是由移动目标引起的;区域B的点云中点的数量少且分布分散,其可能是由噪声引起的。
在上述实施例中,聚类的操作在距离-多普勒平面上执行,根据点云在该距离-多普勒平面上的距离,将该点云划分成若干簇,称为距离-多普勒点云簇。在执行完距离-多普勒聚类后,点云中的所有点被划分到若干个距离-多普勒点云簇或未成簇点云。其中,未成簇点云中的点可能是由噪声引起的。
在上述实施例中,一个距离-多普勒点云簇由多个在距离-多普勒平面上距离相近的点组成,其中,点的数量大于阈值Tn1(称为第一阈值),并且每个点到点云簇的距离小于阈值Td1(称为第二阈值)。
例如,用C={ok,1≤k≤nc}表示距离-多普勒点云簇,其中,nc为该点云簇中的点的个数,ok是属于该点云簇的第k个点,则nc>Tn1,点ok到点云簇C的距离d(ok,C)小于阈值于d1,即d(ok,C)<Td1。
在一些实施例中,每个点云簇中的每个点到该点云簇的距离,是指:该点到该点云簇中所有其他点的距离的最小值。
在一些实施例中,点云簇中的两个点之间的距离为该两个点的距离频点的差的绝对值和该两个点的多普勒速度频点的差的绝对值的加权和。
例如,点云簇C中点oj和ok之间在距离-多普勒平面上的距离d(oj,ok)为点oj和ok的距离频点差的绝对值和多普勒速度频点差的绝对值的加权和,即:
d(oj,ok)=a|rj-rk|+(1-a)|vj-vk| (1)
其中,rj和rk分别为点云oj和ok的距离频点,vj和vk分别为点云oj和ok的多普勒速度频点,a为预设的范围在0~1之间的加权值。
以上用于计算点云簇中点与点之间的距离的公式(1)只是举例说明,本申请不限于此,点云簇中点与点之间的距离也可以通过其他常规距离计算方法计算获得,例如欧氏距离算法等。
在本申请实施例中,对在距离-多普勒平面进行聚类的具体算法不做限制,例如可以采用DBSCAN(Density-Based Spatial Clustering ofApplications with Noise,基于密度的噪声应用空间聚类)或OPTICS(Ordering Points To Identify the ClusteringStructure,通过点排序识别聚类结构)等常用的聚类方法。
在一些实施例中,如图1所示,该方法还包括:
104:消除所述距离-多普勒点云簇中由噪声引起的点云簇。
在一些实施例中,如图1所示,104在101之后执行,也即,在通过101得到距离-多普勒点云簇之后,可以消除该距离-多普勒点云簇中由噪声引起的点云簇。通过消除由噪声引起的点云簇,可以进一步提高雷达追踪的空间测量精度。
在一些实施例中,在102之后,也可以增加消除二次聚类点云簇中由噪声引起的点云簇的操作,其具体的操作流程与104类似,下面仅以104为例对消除点云簇中由噪声引起的点云簇的方法进行说明。
图3是消除距离-多普勒点云簇中由噪声引起的点云簇的一个示例的示意图,如图3所示,该方法包括:
301:统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数nn和距离-多普勒平面上每个位置出现噪声点的次数nr,v;
302:根据所述点云噪声信息对所述距离-多普勒点云簇进行分析,判断所述点云簇是否是由噪声引起的点云簇;
303:如果所述点云簇是由噪声引起的点云簇,则消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
在本申请实施例中,距离-多普勒平面上点云噪声信息包括噪声统计总次数和该平面上每个位置出现噪声点的次数。在302中,在一些实施例中,判断距离-多普勒点云簇(例如点云簇C)是否为由噪声引起的点云簇(称为噪声点云簇),可以根据上述点云噪声信息计算该点云簇C为噪声的概率(表示为P(C));如果该点云簇C为噪声的概率P(C)大于阈值Tn(称为第三阈值),则判定为该点云簇C是噪声点云簇;否则判定为该点云簇C为活动目标。
在一些实施例中,距离-多普勒点云簇为噪声点云簇的概率是所有属于该点云簇的各点为噪声的概率的均值。仍以点云簇C为例,则点云簇C为噪声的概率P(C)是该点云簇C中各个点为噪声的概率的均值,表示如下:
其中,C是一个距离-多普勒点云簇,ok是点云簇C中的点,nC是点云簇C中点的个数;P(C)是距离-多普勒点云簇C为噪声点云簇的概率;P(ok)是点ok为噪声的概率。
在一些实施例中,点云簇C中各个点为噪声的概率是距离-多普勒平面上每个位置出现噪声点的次数与噪声统计总次数的比值。
例如,噪声统计总次数用nn表示。距离-多普勒平面上,每个位置(距离频点r和多普勒频点v的位置)出现噪声点的次数用nr,v表示,该位置出现噪声概率用P(r,v)表示,则:
在公式(2)中,P(ok)=P(rk,vk),其中rk和vk分别为点ok的距离频点和多普勒速度频点。
在本申请实施例中,在一些实施例中,如图3所示,该方法还包括:
304:更新距离-多普勒平面上的点云噪声信息,包括:将所述噪声统计总次数加1;将所有属于距离-多普勒噪声点云簇中的点和未成簇点云中的点对应的距离-多普勒平面位置处的出现噪声次数加1。
图4是更新距离-多普勒平面上点云噪声信息的一个示例的示意图。如图4所示,该方法包括:
401:更新噪声统计总次数,噪声统计总次数加1;
402~405:更新距离-多普勒平面上各位置的点出现噪声的次数。
在图4的示例中,用(r,v)表示距离-多普勒平面上的一个位置的点,其中r为距离频点,v为多普勒速度频点。在403中,确定距离-多普勒噪声点云簇或未成簇点云中是否存在距离频点为r,多普勒频速度点为v的点;如果存在,则执行404的操作,否则不做处理。在404中,更新(r,v)位置出现噪声的次数,该位置的噪声出现次数加1。
值得注意的是,以上仅以消除通过101得到的距离-多普勒点云簇中由噪声引起的点云簇为例进行了说明,同样的方法也适用于消除通过102得到的二次聚类点云簇中由噪声引起的点云簇,此处省略说明。
此外,进一步值得注意的是,以上仅给出了一种消除由噪声引起的点云簇的方法,本申请不限于此,在本申请实施例中,也可以采用其他可实施的方法来消除由噪声引起的点云簇。此处省略说明。
在本申请实施例中,在102中,可以在空间维对上述距离-多普勒点云簇进行二次聚类,也可以在角度维对上述距离-多普勒点云簇进行二次聚类,得到二次聚类点云簇。
在本申请实施例中,如果两个运动目标到雷达的距离和速度相同,它们的点云映射到距离-多普勒平面后,距离-多普勒聚类操作无法区分出这两个物体。如图5所示,雷达捕捉到两个运动目标的点云,运动目标A和B到雷达的距离相同,且相对雷达的速度也相同。如图6所示,映射到距离-多普勒平面后,雷达点云混杂在一起,只有一个距离-多普勒点云簇,无法区分出目标A和B。本申请实施例通过上述102对判定为运动目标的距离-多普勒点云簇进行二次聚类,可以利用空间位置信息(空间维)或角度信息(角度维)切分距离-多普勒点云簇中属于不同运动目标的点云。
图7是在空间维对所述距离-多普勒点云簇进行二次聚类(简称为空间位置聚类)的一个示例的示意图,如图7所示,该方法包括:
701:对每个距离-多普勒点云簇中距离频点大于第四阈值Tr的所有点,进行空间位置校正;
702:根据校正后的空间位置,对每个距离-多普勒点云簇中的所有点进行空间位置聚类,得到对应每个距离-多普勒点云簇的作为所述二次聚类点云簇的空间点云簇和/或未聚类点云。
在本申请实施例中,根据点的空间距离,空间位置聚类能够将属于同一个距离-多普勒点云簇的点划分为若干个子点云簇和1个未成簇点云。在本申请实施例中,将通过空间位置聚类得到的子点云簇称为空间点云簇。
在本申请实施例中,空间位置聚类分为两个步骤:首先对需要进行空间位置校正的点的空间位置(即X,Y,Z)进行校正(701),由此可以解决雷达在远处测量不准的问题;然后利用校正的点的空间位置执行聚类操作。本申请对聚类的方法不做限制,可采用DBSCAN或OPTICS等常用的聚类方法。
图8是空间位置校正的一个示例的示意图。如图8所示,该方法包括:
801:输入点oi=(ri,vi,xi,yi,zi,αi,βi),其中,ri是点oi的距离频点,vi是点oi的多普勒速度频点,(xi,yi,zi)是点oi的空间坐标,αi和βi分别为点oi的水平和垂直角度频点;
802:判断该点oi的距离频点ri是否大于阈值Tr;如果是,则进行后续操作,反之不进行空间位置校正;
803:对需要进行空间位置校正的点进行空间位置校正;
804:点的空间位置无需校正;
805:(x′,y′,z′)为校正后的点的空间坐标。
在本申请实施例中,如图8的803所示,给出了两种空间位置校正方法。
例如,对距离频点大于第四阈值Tr的每个点,使其空间坐标中的x的值保持不变,将其空间坐标中的z的值设为预定值,重新计算其空间坐标中的y的值,表示为:
其中,(xi,yi,zi)为所述点的原来的空间坐标,(xi′,yi′,zi′)为所述点的更新后的空间坐标,zp为所述预设值,其为运动目标相对雷达的平均高度。
再例如,对距离频点大于第四阈值Tr的每个点,将其空间坐标中的y的值和z的值分别设为预定值,重新计算其空间坐标中的x的值,表示为:
其中,(xi,yi,zi)为所述点的原来的空间坐标,(xi′,yi′,zi′)为所述点的更新后的空间坐标,yp和zp为预设值,yp为监控场景中中心线相对雷达的Y轴的平均值,zp为运动目标相对雷达的平均高度。
以上两种空间位置校正方法只是举例说明,本申请不限于此。
在公式(4)和(5)中,空间坐标的Z值置为预设值zp,该预设值为运动目标相对雷达的平均高度。在公式(4)中,空间坐标的X值保持不变,然后重新计算Y值。在公式(5)中,空间坐标的Y值被置为预设值yp,然后重新计算X值,这种校正方式适用于狭窄的目标跟踪场景(比如走廊),Y轴指向狭窄场景的细长方向,预设值yp可以设为监控场景中心线相对雷达的Y轴平均值,预设值zp为运动目标相对雷达的平均高度。
在本申请实施例中,距离-多普勒点云簇中的点进行空间位置校正后,根据校正后的点的空间距离进行聚类,获得多个空间点云簇和未聚类点云。一个空间点云簇由多个在空间中距离相近的点组成,其中,点的数量大于阈值Tn2(称为第五阈值),每个点到点云簇的距离小于阈值Td2(称为第六阈值)。
在一些实施例中,每个空间点云簇中的每个点到该空间点云簇的距离,为所述点到所述空间点云簇中所有其他点的距离的最小值。
例如,用D={ol,1≤l≤nD}表示空间点云簇,其中,nD为该空间点云簇中点的数量,nD>Tn2;ol是属于该空间点云簇的第l个点,它到该空间点云簇的距离是该点ol与该空间点云簇中其他点的距离的最小值,表示为:其中,d(oj,ol)是点oj和ol之间在空间上的距离。如上所述,点到空间点云簇的距离小于阈值Td2,即d(ol,C)<Td2。
在一些实施例中,空间点云簇中的两个点之间的距离为该两个点的空间坐标的欧氏距离。
例如,点oj和ol之间的距离为这两个点的空间坐标的欧式距离,即:
其中,(x′j,y′j,z′j)和(x′l,y′l,z′l)分别为点oj和ol校正后的空间坐标。
以上计算空间点云簇中的两个点之间的距离的方法只是举例说明,本申请不限于此,还可以采用其他可实施的方法计算空间点云簇中的两个点之间的距离。
图9是在角度维对所述距离-多普勒点云簇进行二次聚类(简称为方位角聚类)的一个示例的示意图,如图9所示,该方法包括:
901:对每个距离-多普勒点云簇中的所有点,根据所述所有点的方位角信息进行方位角聚类,得到对应每个距离-多普勒点云簇的作为所述二次聚类点云簇的方位点云簇和/或未聚类点云。
在本申请实施例中,根据点的角度频点的距离,方位角聚类能够将属于同一个距离-多普勒点云簇的点划分为若干个子点云簇和1个未成簇点云。在本申请实施例中,将方位角聚类得到的子点云簇称为方位点云簇。
在本申请实施例中,一个方位点云簇由多个角度频点的距离相近的点组成,其中,点的数量大于阈值Tn3(称为第七阈值),每个点到方位点云簇的距离小于阈值Td3(第八阈值)。
在一些实施例中,每个方位点云簇中的每个点到该方位点云簇的距离,为该点到该方位点云簇中所有其他点的距离的最小值。
例如,用E={om,1≤m≤nE}表示方位点云簇,其中,nE为该方位点云簇的点的数量,nE<Tn3;om是属于该方位点云簇的第m个点,它到该方位点云簇的距离是该点om与方位点云簇中其他点的距离的最小值,表示为:其中,d(oj,om)点oj和om之间在角度频点的距离。如上所述,点到方位点云簇的距离小于阈值Td3,即d(om,E)<Td3。
在一些实施例中,方位点云簇中的两个点之间的距离为这两个点的水平角度频点的差的绝对值和这两个点的垂直角度频点的差的绝对值的加权和。
例如,点oj和om的角度频点距离是这两个点的水平角度频点差的绝对值和垂直角度频点差的绝对值的加权和,即:
d(oj,om)=b|αj-αm|+(1-b)|βj-βm| (7)
其中,αj和βj是点oj的水平角度频点和垂直角度频点,αm和βm是点om的水平角度频点和垂直角度频点,b为预设的0~1之间的加权值。
值得注意的是,本申请对在角度维对距离-多普勒点云簇进行聚类的方法不做限制,可采用DBSCAN或OPTICS等常用的聚类方法。
在本申请实施例中,在103中,可以根据两次聚类结果(对雷达点云进行距离-多普勒聚类处理得到的距离-多普勒点云簇,以及对每个距离-多普勒点云簇进行二次聚类得到的二次聚类点云簇)确定追踪目标。其中,根据二次聚类方式不同,二次聚类点云簇可以是空间点云簇或方位点云簇。
在一些实施例中,如果所述距离-多普勒点云簇对应的二次聚类点云簇的个数大于1,则将所述二次聚类点云簇作为追踪目标;如果所述距离-多普勒点云簇对应的二次聚类点云簇的个数不大于1,则将所述距离-多普勒点云簇作为追踪目标。
图10是确定追踪目标的一个示例的示意图,如图10所示,该方法包括:
1001:输入距离-多普勒点云簇及其对应的二次聚类点云簇;这里,用C表示一个距离-多普勒点云簇,其对应的二次聚类点云簇用{Si,0≤i≤ns}表示;
1002:判断二次聚类点云簇的个数ns是否大于1;如果是,则执行1004,否则执行1003;
1003:确定距离-多普勒点云簇C为追踪目标;
1004:确定二次聚类点云簇为追踪目标。
值得注意的是,以上仅对与本申请相关的各操作或过程进行了说明,但本申请不限于此。该方法还可以包括其他操作或者过程,关于这些操作或者过程的具体内容,可以参考相关技术。
根据本申请实施例的方法,利用两次聚类的策略提高追踪精度,扩展追踪的有效范围,解决了在距离较远处,雷达的空间测量精度变差,点云容易分散无法进行聚类的问题。
第二方面的实施例
本申请实施例提供一种噪声消除方法。该方法与第一方面的实施例的图3的噪声消除方法类似,内容相同之处不再重复说明。
图11是本申请实施例的噪声消除方法的一个示例的示意图,如图11所示,该方法包括:
1101:统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数nn和距离-多普勒平面上每个位置出现噪声点的次数nr,v;
1102:根据所述点云噪声信息对所述距离-多普勒平面上的点云簇进行分析,判断所述点云簇是否是由噪声引起的点云簇;
1103:如果所述点云簇是由噪声引起的点云簇,则消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
在1102中,在一些实施例中,根据所述点云噪声信息得到每个距离-多普勒点云簇C为噪声的概率P(C);如果所述点云簇C为噪声的概率P(C)大于第三阈值Tn,则认为所述点云簇C是由噪声引起的点云簇。
在上述实施例中,每个所述点云簇C为噪声的概率P(C)是所述点云簇C中各个点为噪声的概率的均值;所述点云簇C中各个点为噪声的概率是距离-多普勒平面上每个位置出现噪声点的次数nr,v与噪声统计总次数nn的比值。
在本申请实施例中,如图11所示,该方法还包括:
1104:更新所述距离-多普勒平面上的点云噪声信息,包括:将所述噪声统计总次数加1;将所有属于距离-多普勒噪声点云簇中的点和未成簇点云中的点对应的距离-多普勒平面位置处的出现噪声次数加1。
具体的更新方法可以参考第一方面的实施例的图4的说明。
值得注意的是,以上仅对与本申请相关的各操作或过程进行了说明,但本申请不限于此。该方法还可以包括其他操作或者过程,关于这些操作或者过程的具体内容,可以参考相关技术。
根据本申请实施例的方法,根据距离-多普勒平面上的点云噪声信息确定距离-多普勒平面上的点云簇是否是由噪声引起的点云簇,进而通过消除由噪声引起的点云簇,能够进一步提高追踪精度。
第三方面的实施例
本申请实施例提供一种雷达追踪装置,该雷达追踪装置对应实施例的第一方面的雷达追踪方法,相同的内容不再重复说明。
图12是本申请实施例的雷达追踪装置的一个示例的示意图。如图12所示,本申请实施例的雷达追踪装置1200包括:
第一聚类单元1201,其在距离-多普勒平面对通过雷达感知获得的点云进行聚类,得到距离-多普勒点云簇;
第二聚类单元1202,其在空间维或者角度维对所述距离-多普勒点云簇进行二次聚类,得到二次聚类点云簇;
确定单元1203,其根据所述距离-多普勒点云簇及其对应的所述二次聚类点云簇确定追踪目标。
在一些实施例中,第一聚类单元1201将所述点云映射到距离-多普勒平面;根据所述点云在所述距离-多普勒平面上的距离,将所述点云划分为多个点云簇以及未成簇点云,每个点云簇中的点的数量大于第一阈值Tn1,并且,每个点云簇中的每个点到该点云簇的距离小于第二阈值Td1。具体的聚类方法包括但不限于DBSCAN或OPTICS等。
在上述实施例中,每个点云簇中的每个点到该点云簇的距离,为所述点到所述点云簇中所有其他点的距离的最小值。
在上述实施例中,点云簇中的两个点之间的距离为所述两个点的距离频点的差的绝对值和所述两个点的多普勒速度频点的差的绝对值的加权和。
例如,点云簇中的点和点之间的距离通过以下公式计算获得:
d(oj,ok)=a|rj-rk|+(1-a)|vj-vk|
其中,rj和rk分别为点云簇C中的点oj和点ok的距离频点,vj和vk分别为点云簇C中点oj和点ok的多普勒速度频点,a为预设的范围在0~1之间的加权值。
在本申请实施例中,可选的,如图12所示,该装置1200还包括:
噪声消除单元1204,其消除所述距离-多普勒点云簇中由噪声引起的点云簇。
在一些实施例中,噪声消除单元1204统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数nn和距离-多普勒平面上每个位置出现噪声点的次数nr,v;根据所述点云噪声信息对所述距离-多普勒点云簇进行分析,判断所述距离-多普勒点云簇是否是由噪声引起的点云簇;如果所述距离-多普勒点云簇是由噪声引起的点云簇,则消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
在一些实施例中,噪声消除单元1204根据所述点云噪声信息得到每个距离-多普勒点云簇C为噪声的概率P(C);如果所述距离-多普勒点云簇C为噪声的概率P(C)大于第三阈值Tn,则认为所述距离-多普勒点云簇C是由噪声引起的点云簇。
在一些实施例中,每个所述距离-多普勒点云簇C为噪声的概率P(C)是所述距离-多普勒点云簇C中各个点为噪声的概率的均值;所述距离-多普勒点云簇C中各个点为噪声的概率是距离-多普勒平面上每个位置出现噪声点的次数nr,v与噪声统计总次数nn的比值。
在一些实施例中,噪声消除单元1204还可以更新距离-多普勒平面上的点云噪声信息,包括:将所述噪声统计总次数加1;将所有属于距离-多普勒噪声点云簇中的点和未成簇点云中的点对应的距离-多普勒平面位置处的出现噪声次数加1。
在一些实施例中,第二聚类单元1202在空间维对所述距离-多普勒点云簇进行二次聚类包括:对每个距离-多普勒点云簇中距离频点大于第四阈值Tr的所有点,进行空间位置校正;根据校正后的空间位置,对每个距离-多普勒点云簇中的所有点进行空间位置聚类,得到对应每个距离-多普勒点云簇的作为所述二次聚类点云簇的空间点云簇和/或未聚类点云。具体的聚类方法包括但不限于DBSCAN或OPTICS等。
在上述实施例中,空间位置校正可以是:对距离频点大于第四阈值Tr的每个点,使其空间坐标中的x的值保持不变,将其空间坐标中的z的值设为预定值,重新计算其空间坐标中的y的值,表示为:
其中,(xi,yi,zi)为所述点的原来的空间坐标,(xi′,yi′,zi′)为所述点的更新后的空间坐标,zp为所述预设值,其为运动目标相对雷达的平均高度。
在一些实施例中,空间位置校正可以是:对距离频点大于第四阈值Tr的每个点,将其空间坐标中的y的值和z的值分别设为预定值,重新计算其空间坐标中的x的值,表示为:
其中,(xi,yi,zi)为所述点的原来的空间坐标,(xi′,yi′,zi′)为所述点的更新后的空间坐标,yp和zp为预设值,yp为监控场景中中心线相对雷达的Y轴的平均值,zp为运动目标相对雷达的平均高度。
在一些实施例中,每个空间点云簇中点的数量大于第五阈值Tn2,每个空间点云簇中的每个点到该空间点云簇的距离小于第六阈值Td2。
在一些实施例中,每个空间点云簇中的每个点到该空间点云簇的距离,为所述点到所述空间点云簇中所有其他点的距离的最小值。
在上述实施例中,空间点云簇中的两个点之间的距离为所述两个点的空间坐标的欧氏距离。
在一些实施例中,第二聚类单元1202在角度维对所述距离-多普勒点云簇进行二次聚类包括:对每个距离-多普勒点云簇中的所有点,根据所述所有点的方位角信息进行方位角聚类,得到对应每个距离-多普勒点云簇的作为所述二次聚类点云簇的方位点云簇和/或未聚类点云。具体的聚类方法包括但不限于DBSCAN或OPTICS等。
在一些实施例中,每个方位点云簇中的点的数量大于第七阈值Tn3,并且,每个方位点云簇中的每个点到该方位点云簇的距离小于第八阈值Td3。
在一些实施例中,每个方位点云簇中的每个点到该点云簇的距离,为所述点到所述方位点云簇中所有其他点的距离的最小值。
在上述实施例中,方位点云簇中的两个点之间的距离为所述两个点的水平角度频点的差的绝对值和所述两个点的垂直角度频点的差的绝对值的加权和。
例如,方位点云簇中的点和点之间的距离通过以下公式计算获得:
d(oj,om)=b|αj-αm|+(1-b)|βj-βm|
其中,αj和βj是方位点云簇中的点oj的水平角度频点和垂直角度频点,αm和βm是方位点云簇中的点om的水平角度频点和垂直角度频点,b为预设的范围在0~1之间的加权值。
在一些实施例中,如果所述距离-多普勒点云簇对应的二次聚类点云簇的个数大于1,则确定单元1203将所述二次聚类点云簇作为追踪目标;如果所述距离-多普勒点云簇对应的二次聚类点云簇的个数不大于1,则确定单元1203将所述距离-多普勒点云簇作为追踪目标。
值得注意的是,以上仅对与本申请相关的各部件或模块进行了说明,但本申请不限于此。雷达追踪装置1200还可以包括其他部件或者模块,关于这些部件或者模块的具体内容,可以参考相关技术。
根据本申请实施例,利用两次聚类的策略提高追踪精度,扩展追踪的有效范围,解决了在距离较远处,雷达的空间测量精度变差,点云容易分散无法进行聚类的问题。
第四方面的实施例
本申请实施例提供一种噪声消除装置,该噪声消除装置对应实施例的第二方面的噪声消除方法,相同的内容不再重复说明。
图13是本申请实施例的噪声消除装置的一个示例的示意图。如图13所示,本申请实施例的噪声消除装置1300包括:
统计单元1301,其统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数nn和距离-多普勒平面上每个位置出现噪声点的次数nr,v;
分析单元1302,其根据所述点云噪声信息对所述距离-多普勒平面上的点云簇进行分析,判断所述距离-多普勒点云簇是否是由噪声引起的点云簇;
处理单元1303,如果所述距离-多普勒点云簇是由噪声引起的点云簇,则处理单元1303消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
在一些实施例中,分析单元1302根据所述点云噪声信息得到每个距离-多普勒点云簇C为噪声的概率P(C);如果所述距离-多普勒点云簇C为噪声的概率P(C)大于第三阈值Tn,则认为所述距离-多普勒点云簇C是由噪声引起的点云簇。
在一些实施例中,每个所述距离-多普勒点云簇C为噪声的概率P(C)是所述距离-多普勒点云簇C中各个点为噪声的概率的均值;所述距离-多普勒点云簇C中各个点为噪声的概率是距离-多普勒平面上每个位置出现噪声点的次数nr,v与噪声统计总次数nn的比值。
在一些实施例中,如图13所示,所述装置1300还包括:
更新单元1304,其更新所述距离-多普勒平面上的点云噪声信息,包括:将所述噪声统计总次数加1;将所有属于距离-多普勒噪声点云簇中的点和未成簇点云中的点对应的距离-多普勒平面位置处的出现噪声次数加1。
值得注意的是,以上仅对与本申请相关的各部件或模块进行了说明,但本申请不限于此。噪声消除装置1300还可以包括其他部件或者模块,关于这些部件或者模块的具体内容,可以参考相关技术。
根据本申请实施例,根据距离-多普勒平面上的点云噪声信息确定距离-多普勒平面上的点云簇是否是由噪声引起的点云簇,进而通过消除由噪声引起的点云簇,能够进一步提高追踪精度。
第五方面的实施例
本申请实施例提供一种计算机设备,该计算机设备例如可以是计算机、服务器、工作站、膝上型计算机、智能手机,等等;但本申请实施例不限于此。
图14是本申请实施例的计算机设备的一个示意图,如图14所示,计算机设备1400可以包括:至少一个接口(图中未示出),处理器(例如,中央处理器(CPU))1401,存储器1402;存储器1402耦合到处理器1401。其中存储器1402可存储各种数据;此外还存储程序1403,并且在处理器1401的控制下执行该程序1403,并存储各种数据,例如预设的各种阈值和预定的条件等。
在一些实施例中,第三方面的实施例所述的雷达追踪装置1200的功能可以被集成到处理器1401中,实现第一方面的实施例所述的雷达追踪方法。例如,该处理器1401可以被配置为执行以下处理:
在距离-多普勒平面对通过雷达感知获得的点云进行聚类,得到距离-多普勒点云簇;
在空间维或者角度维对所述距离-多普勒点云簇进行二次聚类,得到二次聚类点云簇;
根据所述距离-多普勒点云簇及其对应的所述二次聚类点云簇确定追踪目标。
在一些实施例中,第四方面的实施例的噪声消除装置1300的功能可以被集成到处理器1401中,实现第二方面的实施例所述的噪声消除方法。例如,该处理器1401可以被配置为执行以下处理:
统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数nn和距离-多普勒平面上每个位置出现噪声点的次数nr,v;
根据所述点云噪声信息对所述距离-多普勒平面上的点云簇进行分析,判断所述距离-多普勒点云簇是否是由噪声引起的点云簇;
如果所述距离-多普勒点云簇是由噪声引起的点云簇,则消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
在一些实施例中,第三方面的实施例所述的雷达追踪装置1200或第四方面的实施例所述的噪声消除装置1300可以与处理器1401分开配置,例如可以将该雷达追踪装置1200或噪声消除装置1300配置为与处理器1401连接的芯片,通过处理器1401的控制来实现雷达追踪装置1200或噪声消除装置1300的功能。
值得注意的是,计算机设备1400还可以包括显示器1405以及I/O设备1404,或者也并不是必须要包括图14中所示的所有部件,例如还可以包括摄像头和/或雷达(未图示),用于获取图像或雷达点云;此外,该计算机设备1400还可以包括图14中没有示出的部件,可以参考现有技术。
在本申请实施例中,处理器1401有时也称为控制器或操作控件,可以包括微处理器或其他处理器装置和/或逻辑装置,该处理器1401接收输入并控制计算机设备1400的各个部件的操作。
在本申请实施例中,存储器1402例如可以是缓存器、闪存、硬驱、可移动介质、易失性存储器、非易失性存储器或其它合适装置中的一种或更多种。可储存各种信息,此外还可存储执行有关信息的程序。并且处理器1401可执行该存储器1402存储的该程序,以实现信息存储或处理等。其他部件的功能与现有类似,此处不再赘述。计算机设备1400的各部件可以通过专用硬件、固件、软件或其结合来实现,而不偏离本申请的范围。
本申请实施例还提供一种计算机可读程序,其中当在计算机设备中执行所述程序时,所述程序使得所述计算机设备执行实施例的第一方面或第二方面所述的方法。
本申请实施例还提供一种存储有计算机可读程序的存储介质,其中所述计算机可读程序使得计算机设备中执行实施例的第一方面或第二方面所述的方法。
本申请以上的装置和方法可以由硬件实现,也可以由硬件结合软件实现。本申请涉及这样的计算机可读程序,当该程序被逻辑部件所执行时,能够使该逻辑部件实现上文所述的装置或构成部件,或使该逻辑部件实现上文所述的各种方法或步骤。本申请还涉及用于存储以上程序的存储介质,如硬盘、磁盘、光盘、DVD、flash存储器等。
结合本申请实施例描述的方法/装置可直接体现为硬件、由处理器执行的软件模块或二者组合。图中所示的功能框图中的一个或多个和/或功能框图的一个或多个组合,既可以对应于计算机程序流程的各个软件模块,亦可以对应于各个硬件模块。这些软件模块,可以分别对应于图中所示的各个步骤。这些硬件模块例如可利用现场可编程门阵列(FPGA)将这些软件模块固化而实现。
软件模块可以位于RAM存储器、闪存、ROM存储器、EPROM存储器、EEPROM存储器、寄存器、硬盘、移动磁盘、CD-ROM或者本领域已知的任何其它形式的存储介质。可以将一种存储介质耦接至处理器,从而使处理器能够从该存储介质读取信息,且可向该存储介质写入信息;或者该存储介质可以是处理器的组成部分。处理器和存储介质可以位于ASIC中。该软件模块可以存储在移动终端的存储器中,也可以存储在可插入移动终端的存储卡中。例如,若设备(如移动终端)采用的是较大容量的MEGA-SIM卡或者大容量的闪存装置,则该软件模块可存储在该MEGA-SIM卡或者大容量的闪存装置中。
针对附图中描述的功能方框中的一个或多个和/或功能方框的一个或多个组合,可以实现为用于执行本申请所描述功能的通用处理器、数字信号处理器(DSP)、专用集成电路(ASIC)、现场可编程门阵列(FPGA)或者其它可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件或者其任意适当组合。针对附图描述的功能方框中的一个或多个和/或功能方框的一个或多个组合,还可以实现为计算设备的组合,例如,DSP和微处理器的组合、多个微处理器、与DSP通信结合的一个或多个微处理器或者任何其它这种配置。
以上结合具体的实施方式对本申请进行了描述,但本领域技术人员应该清楚,这些描述都是示例性的,并不是对本申请保护范围的限制。本领域技术人员可以根据本申请的精神和原理对本申请做出各种变型和修改,这些变型和修改也在本申请的范围内。
关于本申请实施例公开的上述实施方式,还公开了如下的附记:
1、一种雷达追踪方法,包括:
S1:在距离-多普勒平面对通过雷达感知获得的点云进行聚类,得到距离-多普勒点云簇;
S3:在空间维或者角度维对所述距离-多普勒点云簇进行二次聚类,得到二次聚类点云簇;
S4:根据所述距离-多普勒点云簇及其对应的所述二次聚类点云簇确定追踪目标。
2、根据附记1所述的方法,其中,S1包括:
S11:将所述点云映射到距离-多普勒平面;
S12:根据所述点云在所述距离-多普勒平面上的距离,将所述点云划分为多个点云簇以及未成簇点云,每个点云簇中的点的数量大于第一阈值Tn1,并且,每个点云簇中的每个点到该点云簇的距离小于第二阈值Td1。
3、根据附记2所述的方法,其中,每个点云簇中的每个点到该点云簇的距离,为所述点到所述点云簇中所有其他点的距离的最小值。
4、根据附记3所述的方法,其中,点云簇中的两个点之间的距离为所述两个点的距离频点的差的绝对值和所述两个点的多普勒速度频点的差的绝对值的加权和。
5、根据附记4所述的方法,其中,点云簇中的点和点之间的距离通过以下公式计算获得:
d(oj,ok)=a|rj-rk|+(1-a)|vj-vk|
其中,rj和rk分别为点云簇C中的点oj和点ok的距离频点,vj和vk分别为点云簇C中点oj和点ok的多普勒速度频点,a为预设的范围在0~1之间的加权值。
6、根据附记1所述的方法,其中,S1之后,该方法还包括:
S2:消除所述距离-多普勒点云簇中由噪声引起的点云簇。
7、根据附记6所述的方法,其中,S2包括:
S21:统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数nn和距离-多普勒平面上每个位置出现噪声点的次数nr,v;
S22:根据所述点云噪声信息对所述距离-多普勒点云簇进行分析,判断所述距离-多普勒点云簇是否是由噪声引起的点云簇;
S23:如果所述距离-多普勒点云簇是由噪声引起的点云簇,则消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
8、根据附记7所述的方法,其中,在S22中,
根据所述点云噪声信息得到每个距离-多普勒点云簇C为噪声的概率P(C);
如果所述距离-多普勒点云簇C为噪声的概率P(C)大于第三阈值Tn,则认为所述距离-多普勒点云簇C是由噪声引起的点云簇。
9、根据附记8所述的方法,其中,
每个所述距离-多普勒点云簇C为噪声的概率P(C)是所述距离-多普勒点云簇C中各个点为噪声的概率的均值;
所述距离-多普勒点云簇C中各个点为噪声的概率是距离-多普勒平面上每个位置出现噪声点的次数nr,v与噪声统计总次数nn的比值。
10、根据附记7所述的方法,其中,S2还包括:
S24:更新距离-多普勒平面上的点云噪声信息,包括:
将所述噪声统计总次数加1;
将所有属于距离-多普勒噪声点云簇中的点和未成簇点云中的点对应的距离-多普勒平面位置处的出现噪声次数加1。
11、根据附记1所述的方法,其中,S3中,在空间维对所述距离-多普勒点云簇进行二次聚类包括:
S31:对每个距离-多普勒点云簇中距离频点大于第四阈值Tr的所有点,进行空间位置校正;
S32:根据校正后的空间位置,对每个距离-多普勒点云簇中的所有点进行空间位置聚类,得到对应每个距离-多普勒点云簇的作为所述二次聚类点云簇的空间点云簇和/或未聚类点云。
12、根据附记11所述的方法,其中,S31中,对距离频点大于第四阈值Tr的每个点,使其空间坐标中的x的值保持不变,将其空间坐标中的z的值设为预定值,重新计算其空间坐标中的y的值,表示为:
其中,(xi,yi,zi)为所述点的原来的空间坐标,(xi′,yi′,zi′)为所述点的更新后的空间坐标,zp为所述预设值,其为运动目标相对雷达的平均高度。
13、根据附记11所述的方法,其中,S31中,对距离频点大于第四阈值Tr的每个点,将其空间坐标中的y的值和z的值分别设为预定值,重新计算其空间坐标中的x的值,表示为:
其中,(xi,yi,zi)为所述点的原来的空间坐标,(xi′,yi′,zi′)为所述点的更新后的空间坐标,yp和zp为预设值,yp为监控场景中中心线相对雷达的Y轴的平均值,zp为运动目标相对雷达的平均高度。
14、根据附记11所述的方法,其中,S32中,每个空间点云簇中点的数量大于第五阈值Tn2,每个空间点云簇中的每个点到该空间点云簇的距离小于第六阈值Td2。
15、根据附记14所述的方法,其中,每个空间点云簇中的每个点到该空间点云簇的距离,为所述点到所述空间点云簇中所有其他点的距离的最小值。
16、根据附记15所述的方法,其中,空间点云簇中的两个点之间的距离为所述两个点的空间坐标的欧氏距离。
17、根据附记1所述的方法,其中,S3中,在角度维对所述距离-多普勒点云簇进行二次聚类包括:
S31’:对每个距离-多普勒点云簇中的所有点,根据所述所有点的方位角信息进行方位角聚类,得到对应每个距离-多普勒点云簇的作为所述二次聚类点云簇的方位点云簇和/或未聚类点云。
18、根据附记17所述的方法,其中,每个方位点云簇中的点的数量大于第七阈值Tn3,并且,每个方位点云簇中的每个点到该方位点云簇的距离小于第八阈值Td3。
19、根据附记18所述的方法,其中,每个方位点云簇中的每个点到该点云簇的距离,为所述点到所述方位点云簇中所有其他点的距离的最小值。
20、根据附记19所述的方法,其中,方位点云簇中的两个点之间的距离为所述两个点的水平角度频点的差的绝对值和所述两个点的垂直角度频点的差的绝对值的加权和。
21、根据附记20所述的方法,其中,方位点云簇中的点和点之间的距离通过以下公式计算获得:
d(oj,om)=b|αj-αm|+(1-b)|βj-βm|
其中,αj和βj是方位点云簇中的点oj的水平角度频点和垂直角度频点,αm和βm是方位点云簇中的点om的水平角度频点和垂直角度频点,b为预设的范围在0~1之间的加权值。
22、根据附记1所述的方法,S4包括:
如果所述距离-多普勒点云簇对应的二次聚类点云簇的个数大于1,则将所述二次聚类点云簇作为追踪目标;
如果所述距离-多普勒点云簇对应的二次聚类点云簇的个数不大于1,则将所述距离-多普勒点云簇作为追踪目标。
23、一种噪声消除方法,其中,所述方法包括:
S21:统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数nn和距离-多普勒平面上每个位置出现噪声点的次数nr,v;
S22:根据所述点云噪声信息对所述距离-多普勒平面上的点云簇进行分析,判断所述距离-多普勒点云簇是否是由噪声引起的点云簇;
S23:如果所述距离-多普勒点云簇是由噪声引起的点云簇,则消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
24、根据附记23所述的方法,其中,在S22中,
根据所述点云噪声信息得到每个距离-多普勒点云簇C为噪声的概率P(C);
如果所述距离-多普勒点云簇C为噪声的概率P(C)大于第三阈值Tn,则认为所述距离-多普勒点云簇C是由噪声引起的点云簇。
25、根据附记24所述的方法,其中,
每个所述距离-多普勒点云簇C为噪声的概率P(C)是所述距离-多普勒点云簇C中各个点为噪声的概率的均值;
所述距离-多普勒点云簇C中各个点为噪声的概率是距离-多普勒平面上每个位置出现噪声点的次数nr,v与噪声统计总次数nn的比值。
26、根据附记23所述的方法,其中,所述方法还包括:
S24:更新所述距离-多普勒平面上的点云噪声信息,包括:
将所述噪声统计总次数加1;
将所有属于距离-多普勒噪声点云簇中的点和未成簇点云中的点对应的距离-多普勒平面位置处的出现噪声次数加1。
27、一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其中,所述处理器被配置为执行所述计算机程序而实现如附记1至26任一项所述的方法。
28、一种存储有计算机可读程序的存储介质,其中所述计算机可读程序使得计算机在计算机设备中执行附记1至26任一项所述的方法。
Claims (10)
1.一种雷达追踪装置,其特征在于,所述装置包括:
第一聚类单元,其在距离-多普勒平面对通过雷达感知获得的点云进行聚类,得到距离-多普勒点云簇;
第二聚类单元,其在空间维或者角度维对所述距离-多普勒点云簇进行二次聚类,得到二次聚类点云簇;
确定单元,其根据所述距离-多普勒点云簇及其对应的所述二次聚类点云簇确定追踪目标。
2.根据权利要求1所述的装置,其中,所述第一聚类单元将所述点云映射到距离-多普勒平面;根据所述点云在所述距离-多普勒平面上的距离,将所述点云划分为多个点云簇以及未成簇点云,每个点云簇中的点的数量大于第一阈值,并且,每个点云簇中的每个点到该点云簇的距离小于第二阈值。
3.根据权利要求1所述的装置,其中,所述装置还包括:
噪声消除单元,其消除所述距离-多普勒点云簇中由噪声引起的点云簇。
4.根据权利要求1所述的装置,其中,所述第二聚类单元在空间维对所述距离-多普勒点云簇进行二次聚类包括:
对每个距离-多普勒点云簇中距离频点大于第四阈值的所有点,进行空间位置校正;
根据校正后的空间位置,对每个距离-多普勒点云簇中的所有点进行空间位置聚类,得到对应每个距离-多普勒点云簇的作为所述二次聚类点云簇的空间点云簇和/或未聚类点云。
5.根据权利要求1所述的装置,其中,所述第二聚类单元在角度维对所述距离-多普勒点云簇进行二次聚类包括:
对每个距离-多普勒点云簇中的所有点,根据所述所有点的方位角信息进行方位角聚类,得到对应每个距离-多普勒点云簇的作为所述二次聚类点云簇的方位点云簇和/或未聚类点云。
6.根据权利要求1所述的装置,其中,如果所述距离-多普勒点云簇对应的二次聚类点云簇的个数大于1,则所述确定单元将所述二次聚类点云簇作为追踪目标;如果所述距离-多普勒点云簇对应的二次聚类点云簇的个数不大于1,则所述确定单元将所述距离-多普勒点云簇作为追踪目标。
7.一种噪声消除装置,其特征在于,所述装置包括:
统计单元,其统计距离-多普勒平面上的点云噪声信息,所述点云噪声信息包括:噪声统计总次数和距离-多普勒平面上每个位置出现噪声点的次数;
分析单元,其根据所述点云噪声信息对所述距离-多普勒平面上的点云簇进行分析,判断所述距离-多普勒点云簇是否是由噪声引起的点云簇;
处理单元,如果所述距离-多普勒点云簇是由噪声引起的点云簇,则所述处理单元消除所述距离-多普勒平面上的所述由噪声引起的点云簇。
8.根据权利要求7所述的装置,其中,所述分析单元根据所述点云噪声信息得到每个距离-多普勒点云簇为噪声的概率;如果所述距离-多普勒点云簇为噪声的概率大于第三阈值,则认为所述距离-多普勒点云簇是由噪声引起的点云簇。
9.根据权利要求7所述的装置,其中,所述装置还包括:
更新单元,其更新所述距离-多普勒平面上的点云噪声信息,包括:将所述噪声统计总次数加1;将所有属于距离-多普勒噪声点云簇中的点和未成簇点云中的点对应的距离-多普勒平面位置处的出现噪声次数加1。
10.一种存储有计算机可读程序的存储介质,其中所述计算机可读程序使得计算机在计算机设备中执行以下方法:
在距离-多普勒平面对通过雷达感知获得的点云进行聚类,得到距离-多普勒点云簇;
在空间维或者角度维对所述距离-多普勒点云簇进行二次聚类,得到二次聚类点云簇;
根据所述距离-多普勒点云簇及其对应的所述二次聚类点云簇确定追踪目标。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011379867.4A CN114578341A (zh) | 2020-12-01 | 2020-12-01 | 雷达追踪方法、噪声消除方法、装置和设备 |
JP2021189746A JP2022087822A (ja) | 2020-12-01 | 2021-11-22 | レーダー追跡方法、ノイズ除去方法、装置及び機器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011379867.4A CN114578341A (zh) | 2020-12-01 | 2020-12-01 | 雷达追踪方法、噪声消除方法、装置和设备 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114578341A true CN114578341A (zh) | 2022-06-03 |
Family
ID=81767493
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011379867.4A Pending CN114578341A (zh) | 2020-12-01 | 2020-12-01 | 雷达追踪方法、噪声消除方法、装置和设备 |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP2022087822A (zh) |
CN (1) | CN114578341A (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116736233B (zh) * | 2023-08-14 | 2023-10-13 | 陕西欧卡电子智能科技有限公司 | 毫米波雷达多径杂波滤除方法 |
CN117289255A (zh) * | 2023-10-19 | 2023-12-26 | 广州行深智能科技有限公司 | 目标检测方法、装置、终端设备及存储介质 |
-
2020
- 2020-12-01 CN CN202011379867.4A patent/CN114578341A/zh active Pending
-
2021
- 2021-11-22 JP JP2021189746A patent/JP2022087822A/ja active Pending
Also Published As
Publication number | Publication date |
---|---|
JP2022087822A (ja) | 2022-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107016705B (zh) | 计算机视觉系统中的地平面估计 | |
CN111612841B (zh) | 目标定位方法及装置、移动机器人及可读存储介质 | |
CN110599489A (zh) | 一种目标空间定位方法 | |
CN114578341A (zh) | 雷达追踪方法、噪声消除方法、装置和设备 | |
CN110645980B (zh) | 一种室内外一体化定位导航方法及其系统 | |
CN107132504B (zh) | 基于粒子滤波的定位追踪装置、方法及电子设备 | |
US11061102B2 (en) | Position estimating apparatus, position estimating method, and terminal apparatus | |
CN109828250B (zh) | 一种雷达标定方法、标定装置及终端设备 | |
CN112394334A (zh) | 雷达反射点的聚类装置、方法以及电子设备 | |
US11953602B2 (en) | Detecting three-dimensional structure models at runtime in vehicles | |
CN111915657A (zh) | 一种点云配准方法、装置、电子设备及存储介质 | |
CN111179184A (zh) | 基于随机抽样一致性的鱼眼图像有效区域提取方法 | |
US20210048511A1 (en) | Radar-based posture recognition apparatus and method and electronic device | |
CN109541541B (zh) | 一种室内三角定位精度修正方法及装置 | |
CN111765883A (zh) | 机器人蒙特卡罗定位方法、设备及存储介质 | |
CN116977671A (zh) | 基于图像空间定位的目标跟踪方法、装置、设备及存储介质 | |
CN113466851A (zh) | 人体姿态检测方法、装置和数据处理设备 | |
CN115239821B (zh) | 参数信息确定方法、装置、车辆、电子设备及存储介质 | |
CN116819561A (zh) | 一种点云数据匹配方法、系统、电子设备及存储介质 | |
CN112774181A (zh) | 雷达数据的处理方法、处理系统以及计算机存储介质 | |
CN110728285B (zh) | 一种基于动态变频的快速角点检测方法 | |
CN115222771B (zh) | 一种目标跟踪方法及装置 | |
CN116128804B (zh) | 多尺度多方向的无人机图像角点检测方法、系统及终端 | |
US11635507B2 (en) | Systems for estimating three-dimensional trajectories of physical objects | |
CN110097114B (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 |