CN110794396A - 基于激光雷达和导航雷达的多目标识别方法及系统 - Google Patents

基于激光雷达和导航雷达的多目标识别方法及系统 Download PDF

Info

Publication number
CN110794396A
CN110794396A CN201910715439.5A CN201910715439A CN110794396A CN 110794396 A CN110794396 A CN 110794396A CN 201910715439 A CN201910715439 A CN 201910715439A CN 110794396 A CN110794396 A CN 110794396A
Authority
CN
China
Prior art keywords
target
radar
laser
navigation
navigation radar
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
CN201910715439.5A
Other languages
English (en)
Other versions
CN110794396B (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.)
SHANGHAI AIWEI AEROSPACE ELECTRONIC CO Ltd
Original Assignee
SHANGHAI AIWEI AEROSPACE ELECTRONIC CO Ltd
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 SHANGHAI AIWEI AEROSPACE ELECTRONIC CO Ltd filed Critical SHANGHAI AIWEI AEROSPACE ELECTRONIC CO Ltd
Priority to CN201910715439.5A priority Critical patent/CN110794396B/zh
Publication of CN110794396A publication Critical patent/CN110794396A/zh
Application granted granted Critical
Publication of CN110794396B publication Critical patent/CN110794396B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems 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/86Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
    • G01S13/865Combination of radar systems with lidar systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems 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/66Radar-tracking systems; Analogous systems
    • G01S13/72Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • G01S13/723Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
    • G01S13/726Multiple target tracking
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/66Tracking systems using electromagnetic waves other than radio waves
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/41Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
    • G01S7/415Identification of targets based on measurements of movement associated with the target
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/4802Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

本发明公开了一种基于激光雷达和导航雷达的多目标识别方法及系统,建立激光雷达坐标系,将极坐标下的角度和距离转化为笛卡尔坐标下的下x、y和z;建立导航雷达坐标系,以所述导航雷达为坐标原点建立二维平面坐标系x、y;使用导航雷达采集多目标数据;使用激光雷达传感器采集多目标数据;使用所述激光雷达传感器采集的所述多目标数据对所述使用导航雷达采集的多目标数据进行辅助,将所述导航雷达采集的所述多目标数据中的错误数据筛除。本发明提供的基于激光雷达和导航雷达的多目标识别方法及系统,无人水面艇上在自主航行中不受天气因素的影响,从而提高多目标的检测与跟踪能力。

Description

基于激光雷达和导航雷达的多目标识别方法及系统
技术领域
本发明涉及一种多目标识别方法及系统,尤其涉及一种基于激光雷达和导航雷达的多目标识别方法及系统。
背景技术
无人水面艇(Unmanned Surface Vehicle,USV)是一种智能化的小型水面平台,可以代替有人水面艇在特定水域完成一些繁琐的、复杂的甚至危险的任务。如果要在多变的、复杂的海况下安全自主地完成各项任务,则无人水面艇必须具备良好的环境感知能力,其中准确稳定的障碍物检测能力是无人水面艇实现自主导航避障的前提和关键技术。
无人水面艇目标检测分为被动检测法和主动检测法两种。被动检测法,被动检测法主要采用单目视觉或立体视觉传感器进行环境信息的感知,由于传感器的特点使得通过该方法可以获得平台周围环境中丰富的颜色特征,对环境信息的处理方式一般利用边缘检测算法进行数据处理,提取出海天、陆天交界线,借以区分地面目标与悬空目标,然后根据需求的不同,可在交界线上方或下方根据目标模型搜寻目标。但是这两种被动检测方法均存在着一定的缺陷,如单目视觉法除理想状态外往往难以精确的获得图像深度信息,无法在环境中定位目标深度,且受光照干扰极大,同环境下随着光照量的变化最终得出的结果有很大差异;而立体视觉检测法的数据量与计算量十分庞大,难以保障算法的实时性与快速性,无法满足实时处理环境信息的需求。
主动检测法则是利用导航雷达、激光雷达等主动传感器来检测无人水面艇周围目标。在无人水面艇上的雷达一般为导航雷达。导航雷达采用缝隙阵列天线,工作在厘米波段,作用距离较近,盲区小,距离和方位的精度和分辨力较高,抑制海面和雨雪等杂波的能力较强,由于其波长相对较长,探测距离较远,并且技术成熟,目前主要用于中远距离的水面目标检测与跟踪,但是由于探测精度限制,导航雷达通常只能为本船提供目标的位置信息、速度信息,无法识别目标的形状特征,并且导航雷达在本船船体附近的近距离范围内存在盲区,在大型船只上可以通过人工瞭望等方式对近距离目标观测进行弥补,但是对于无人水面艇需要无人作业的前提下,导航雷达无法为无人水面艇的安全航行提供保障。激光雷达根据其垂面激光束的数量多少可划分为二维激光雷达和三维激光雷达,二者均可达到良好的目标检测效果。激光雷达使用激光作为主动探测源,激光的波长非常短,使得激光雷达具备了很高的测量精度以及很强的抗干扰能力等非常优秀的特点,这让激光雷达具有非常适用于无人水面艇近距离目标检测的能力。但是激光雷达对工作环境的要求较高,对天气变化比较敏感,在雨雪天、风沙天等恶劣天气探测效果不理想,探测范围有限,跟踪目标较少。
因此有必要开发一种系统,可以提高无人水面艇在水域环境下检测障碍物的能力。
发明内容
本发明所要解决的技术问题是提供一种基于激光雷达和导航雷达的多目标识别方法及系统,无人水面艇上在自主航行中不受天气因素的影响,从而提高多目标的检测与跟踪能力。
本发明为解决上述技术问题而采用的技术方案是提供一种基于激光雷达和导航雷达的多目标识别方法,包括以下步骤:
建立激光雷达坐标系,将极坐标下的角度和距离转化为笛卡尔坐标下的下x、y和z;
建立导航雷达坐标系,以所述导航雷达为坐标原点建立二维平面坐标系x、y;
使用所述导航雷达采集多目标数据;
使用激光雷达传感器采集多目标数据;
使用所述激光雷达传感器采集的所述多目标数据对所述使用导航雷达采集的多目标数据进行辅助,将所述导航雷达采集的所述多目标数据中的错误数据筛除。
优选地,用以下公式将极坐标下的角度和距离转化为笛卡尔坐标下的下x、y、z以建立激光雷达坐标系:
其中,r为实测距离,ω为激光的垂直角度,α为激光的水平旋转角度,x、y和z为极坐标投影到X、Y、Z轴上的坐标。
优选地,以导航雷达为坐标原点建立导航雷达坐标系,转换关系如下:
xl=xm
yl=ym
zl=zm+0.2
其中,以所述激光雷达为坐标原点的三维坐标系中有一点坐标l(xl,yl,zl),对应在以所述导航雷达为坐标原点的三维坐标系中的一点坐标m(xm,ym,zm)。
优选地,所述使用所述激光雷达传感器采集的所述多目标数据对所述使用导航雷达采集的多目标数据进行辅助,包括使用以下基于有理数倍采样的异步融合算法:
步骤1,将来自各传感器的测量值在融合中心的坐标系中和时钟下进行映射统一;
步骤2,基于下一时刻目标状态的预测值与当前时刻目标状态的估计值之差,建立描述该融合周期内各个观测点处的目标状态向量之间的动态模型;
步骤3,依据当前时刻目标状态基于全局信息的估计值,结合所述动态模型和传统的滤波器,利用本周期内按序到达的所述各传感器测量值,依次对各观测点处的目标状态进行估计;
步骤4,获得下一时刻目标状态基于全局信息的估计值。
优选地,使用所述导航雷达的距离和角度确定一目标之后,使用所述激光雷达确定该目标周围返回的目标数量,根据以下最近邻聚类法判断该目标是否采用:
步骤1:任取样本Xi作为第一个聚类中心的初始值,令Z1=X1;
步骤2:计算样本X2到Z1的欧式距离D21=||X2-Z1||,若D21>T,定义一新的聚类中心Z2=X2,否则X2∈以Z1为中心的聚类;
步骤3:假设已有聚类中心Z1,Z2,计算D31=||X3-Z1||和D32=||X3-Z2||,若D31>T且D32>T,则建立第三个聚类中心Z3=X3,否则X3∈离Z1和Z2中最近邻的聚类中心;
步骤4:以此类推,直到将所有的N个样本都进行分类;
待分类的模式{X1,X2,…,Xn},按T分类到以Z1,Z2,…为聚类中心的模式类中,
其中,Z1是起始值,T是预设的距离阈值。
优选地,还包括以下步骤:
使用激光导航的距离参数确定一目标之后,设置一阈值,若所述导航雷达的距离超过该阈值,判断该目标出错,不予采用。
优选地,无人艇前方目标速度以导航雷达的速度为准。
优选地,所述多目标数据使用最近邻算法,依据最近邻的至少一个目标轨迹点的运动目标来确定待分目标轨迹点所属的运动目标,从而构成了多目标的航迹。
假设第j帧第m个运动目标的返回角度、距离、速度参数为(θjm,djm,vjm),其在以激光雷达传感器为坐标原点的世界坐标系中坐标为(xj,m,yj,m),其中xj,m=djm·sinθjm,yj,m=djm·cosθjm,所述第j帧第m个运动目标与下一帧第j+1帧第k个运动目标的距离dk(k=1,2,···nj+1)由两点间的距离公式表示为:
Figure BDA0002155242040000041
优选地,所述多目标数据使用联合概率数据关联。
优选地,所述联合概率数据关联包括第j帧nj个目标与第j+1帧nj+1个目标进行关联,产生多个目标关联排列组合,将所有的相邻两帧配对目标的关联概率相乘,取最大概率值为对应的关联排列。
本发明为解决上述技术问题而采用的另一技术方案是提供一种基于激光雷达和导航雷达的多目标识别方法的系统,包括使用基于激光雷达和导航雷达的多目标识别方法的方法,还包括:
无人艇控制器和数据处理器,所述数据处理器包括激光检测处理模块、激光扫描控制模块、厘米波雷达基带处理模块和波形产生模块;
激光雷达传感器,所述激光传感器包括激光发射器和激光接收器,所述激光发射器和所述激光检测处理模块连接,所述激光接收器和所述激光扫描控制模块连接;
导航雷达传感器,所述导航雷达传感器包括射频电路,所述射频电路发送基带信号到所述厘米波雷达基带处理模块,所述射频电路接收所述波形产生模块发送的调制信号;
所述无人艇控制器和电源电路、接口芯片以及时钟电路电性连接。
本发明对比现有技术有如下的有益效果:本发明提供的基于激光雷达和导航雷达的多目标识别方法及系统,通过利用激光雷达的数据有效地滤去了导航雷达探测到的大量无效目标,只对较少目标进行跟踪,极大地减少了激光雷达和导航雷达多目标数据关联的概率,有效地提高了无人艇决策的可靠性。无人水面艇上在自主航行中不受天气因素的影响,从而提高多目标的检测与跟踪能力。
附图说明
图1为本发明实施例中基于激光雷达和导航雷达的多目标识别系统的结构示意图;
图2为本发明实施例中激光雷达极坐标和XYZ坐标映射图;
图3为本发明实施例中激光雷达极坐标和XYZ坐标映射图的俯视图;
图4为本发明实施例中导航雷达坐标转换示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的描述。
在以下描述中,为了提供本发明的透彻理解,阐述了很多具体的细节。然而,本发明可以在没有这些具体的细节的情况下实践,这对本领域普通该技术人员来说将是显而易见的。因此,具体的细节阐述仅仅是示例性的,具体的细节可以由奔放的精神和范围而变化并且仍被认为是在本发明的精神和范围内。
本实施例提供的一种基于激光雷达和导航雷达的多目标识别方法及系统,无人水面艇上在自主航行中不受天气因素的影响,从而提高多目标的检测与跟踪能力。
本实施例公开了一种基于激光雷达和导航雷达的多目标识别方法,包括以下步骤:
建立激光雷达坐标系,将极坐标下的角度和距离转化为笛卡尔坐标下的下x、y和z;
建立导航雷达坐标系,以所述导航雷达为坐标原点建立二维平面坐标系x、y;
使用导航雷达采集多目标数据;
使用激光雷达传感器采集多目标数据;
使用激光雷达传感器采集的所述多目标数据对所述使用导航雷达采集的多目标数据进行辅助,将导航雷达采集的所述多目标数据中的错误数据筛除。由于激光雷达的测量精度要比导航雷达高,一旦多目标进入到激光雷达范围内后采集的数据会更为精确。
优选地,用以下公式将极坐标下的角度和距离转化为笛卡尔坐标下的下x、y、z以建立激光雷达坐标系:
Figure BDA0002155242040000051
其中,r为实测距离,ω为激光的垂直角度,α为激光的水平旋转角度,x、y和z为极坐标投影到X、Y、Z轴上的坐标。
请参考图4,通过对导航雷达所应用的技术的分析研究,创新性采用直角坐标系下加权的方式改进其捕获、录取、跟踪的算法,经国际标准要求的五种场景验证,以及结合实际应用验证,实验数据与理论数据的对比表明算法可以高速高精度实现机动状态下的避碰:
x=x0+ρcosθ
y=y0+ρsinθ
表示扫描中心点的坐标。如果直接用上式的数学关系进行坐标转换,必然导致极坐标和直角坐标之间不能一一对应,甚至出现死点和显示盲点的问题。在扫描变换中,添加视频采样保持可有效消除“盲点”问题。通过改变角度量化数可以有效解决死点问题。
在具体实施中,以导航雷达为坐标原点建立导航雷达坐标系。
为了实现激光雷达和导航雷达坐标间的转换,对激光雷达相对于导航雷达的相对空间位置作了测量。导航雷达距离地面高度160cm,激光雷达距离地面180cm。在朝无人艇航行的方向上也即轴的正方向上两种传感器没有相对位移,在无人艇的左右也即水平方向上两种传感器没有相对位移,转换关系如下:
x1=xm
y1=ym
z1=zm+0.2
其中,设在以激光雷达为坐标原点的三维坐标系中有一点坐标l(x1,y1,z1),单位为米。则对应在以导航雷达为坐标原点的三维坐标系中的一点坐标m(xm,ym,zm),单位为米。
在具体实施中,所述使用所述激光雷达传感器采集的所述多目标数据对所述使用导航雷达采集的多目标数据进行辅助,包括使用基于有理数倍采样的异步融合算法。步骤1,将来自各传感器的测量值在融合中心的坐标系中和时钟下进行映射统一;步骤2,基于下一时刻目标状态的预测值与当前时刻目标状态的估计值之差,建立描述该融合周期内各个观测点处的目标状态向量之间的动态模型;步骤3,依据当前时刻目标状态基于全局信息的估计值,结合所述动态模型和传统的滤波器,利用本周期内按序到达的所述各传感器测量值,依次对各观测点处的目标状态进行估计;步骤4,获得下一时刻目标状态基于全局信息的估计值。
多传感器融合系统一般可以分为两类即同步和异步融合。传统的多传感器融合算法大部分是基于各传感器测量数据同时测量比并且同时到达的情况下进行的。实际使用中,由于所用传感器种类或任务的不同,各个传感器有不同的采样速率和传输延迟,在这种情况下,测量的同步很难做到。而本发明采用的基于有理数倍采样的异步融合算法,在实际仿真中效果较好,同时在状态估计精度方面有一定的优势,并在异步融合中需要解决多种误差问题。
使用导航雷达的距离和角度确定一目标之后,使用激光雷达确定该目标周围返回的目标数量,根据以下最近邻聚类法判断出该目标是否采用,步骤1:任取样本Xi作为第一个聚类中心的初始值,令Z1=X1;步骤2:计算样本X2到Z1的欧式距离D21=||X2-Z1||,若D21>T,定义一新的聚类中心Z2=X2,否则X2∈以Z1为中心的聚类;步骤3:假设已有聚类中心Z1,Z2,计算D31=||X3-Z1||和D32=||X3-Z2||,若D31>T且D32>T,则建立第三个聚类中心Z3=X3,否则X3∈离Z1和Z2中最近邻的聚类中心;步骤4:以此类推,直到将所有的N个样本都进行分类;待分类的模式{X1,X2,…,Xn},按T分类到以Z1,Z2,…为聚类中心的模式类中,其中,Z1是起始值,T是预设的距离阈值。这是因为,在目标角度参数的选择上,导航雷达无疑具有精度上的优势。
使用激光导航的距离参数确定一目标之后,设置一阈值,若所述导航雷达的距离超过该阈值,判断该目标出错,不予采用。激光雷达和导航雷达距离数据的异步融合不仅提高了数据精度,而且可以滤掉异常数据,提高多传感器系统的稳定性和可靠性,这也是多传感器系统相对于单个传感器的优势。
在具体实施中,无人艇前方目标速度以导航雷达的速度为准。两种传感器异步融合后的无人艇前方目标速度主要取决于导航雷达的速度。而导航雷达在中距离和远距离测速的精确度都为0.12m/s,这也是多传感器系统的测速精度。
在具体实施中,所述多目标数据使用最近邻算法,依据最近邻的至少一个目标轨迹点的运动目标来确定待分目标轨迹点所属的运动目标,从而构成了多目标的航迹。
假设第j帧第m个运动目标的返回角度、距离、速度参数为(θjm,djm,vjm),其在以激光雷达传感器为坐标原点的世界坐标系中坐标为(xj,m,yj,m),其中xj,m=djm·sinθjm,yj,m=djm·cosθjm,所述第j帧第m个运动目标与下一帧第j+1帧第k个运动目标的距离dk(k=1,2,···nj+1)由两点间的距离公式表示为:
当依赖单个导航雷达传感器报告一系列目标的方位,距离,速度信息时,为了推算目标的航迹,必须按照时间的先后顺序将这些目标位置连接起来,如果是单目标,实现起来就相对来说比较简单。但在实际情况下,一直出现单目标的概率是非常小的,当出现多目标时,即使已经画出每个目标的航迹,一个采样周期之后,又有若干个新的目标数据报告,但这些目标数据具体与已有的哪条目标航迹关联,有很多种可能,当然也有可能与所有己存在航迹都不相关联,而是在这一时刻出现的新的目标。面对这种情况,人们研究了很多跟踪算法,这些算法在一定程度上解决了部分问题,但由于计算量过大,实时性不好,在实际应用中并没有得到大规模的推广。因此,本发明技术方案借助激光雷达传感器自身的特点,辅助导航雷达对多目标的航迹维持,明显减少了错误关联的航迹,取得了不错的效果。
最近邻算法(kNN,k-NearestNeighbor)的核心思想是如果一个样本在特征空间中的k个最相邻的样本中的大多数数以一个类型别,则该样本也属于这个类别,并具有该类别上样本的特征。该方法在确定分类决策上,只依据最近邻的一个或者几个样本的类别来决定待分样本所属的类别。
kNN算法的一般流程如下:
步骤1:初始化距离为最大值;
步骤2:计算未知样本和每个训练样本的距离dist;
步骤3:得到目前K个最邻近样本中的最大距离maxdist;
步骤4:如果dist小于maxdist,则将训练样本作为K-最近邻样本;
步骤5:重复步骤2,3,4,直到未知样本和所有训练样本的距离都算完;
步骤6:统计K-最近邻样本中每个类标号出现的次数;
步骤7:出现频率最大的类标号最为未知样本的类标号。
在具体实施中,所述联合概率数据关联包括第j帧nj个目标与第j+1帧nj+1个目标进行关联,产生多个目标关联排列组合,将所有的相邻两帧配对目标的关联概率相乘,取最大概率值为对应的关联排列。
本实施例还公开了一种基于激光雷达和导航雷达的多目标识别系统,包括使用基于激光雷达和导航雷达的多目标识别方法的方法,还包括:
无人艇控制器和数据处理器,所述数据处理器包括激光检测处理模块、激光扫描控制模块、厘米波雷达基带处理模块和波形产生模块;
激光雷达传感器,所述激光传感器包括激光发射器和激光接收器,所述激光发射器和所述激光检测处理模块连接,所述激光接收器和所述激光扫描控制模块连接;
导航雷达传感器,所述导航雷达传感器包括射频电路,所述射频电路发送基带信号到所述厘米波雷达基带处理模块,所述射频电路接收所述波形产生模块发送的调制信号;
所述无人艇控制器和电源电路、接口芯片以及时钟电路电性连接。
综上,本实施例提供的基于激光雷达和导航雷达的多目标识别方法及系统,通过利用激光雷达的数据有效地滤去了导航雷达探测到的大量无效目标,只对较少目标进行跟踪,极大地减少了激光雷达和导航雷达多目标数据关联的概率,有效地提高了无人艇决策的可靠性。无人水面艇上在自主航行中不受天气因素的影响,从而提高多目标的检测与跟踪能力。
虽然本发明已以较佳实施例揭示如上,然其并非用以限定本发明,任何本领域技术人员,在不脱离本发明的精神和范围内,当可作些许的修改和完善,因此本发明的保护范围当以权利要求书所界定的为准。

Claims (11)

1.一种基于激光雷达和导航雷达的多目标识别方法,其特征在于,包括以下步骤:
建立激光雷达坐标系,将极坐标下的角度和距离转化为笛卡尔坐标下的下x、y和z;
建立导航雷达坐标系,以所述导航雷达为坐标原点建立二维平面坐标系x、y;
使用所述导航雷达采集多目标数据;
使用激光雷达传感器采集多目标数据;
使用所述激光雷达传感器采集的所述多目标数据对所述使用导航雷达采集的多目标数据进行辅助,将所述导航雷达采集的所述多目标数据中的错误数据筛除。
2.如权利要求1所述的基于激光雷达和导航雷达的多目标识别方法,其特征在于,用以下公式将极坐标下的角度和距离转化为笛卡尔坐标下的下x、y、z以建立激光雷达坐标系:
Figure FDA0002155242030000011
其中,r为实测距离,ω为激光的垂直角度,α为激光的水平旋转角度,x、y和z为极坐标投影到X、Y、Z轴上的坐标。
3.如权利要求1所述的基于激光雷达和导航雷达的多目标识别方法,其特征在于,以导航雷达为坐标原点建立导航雷达坐标系,转换关系如下:
xl=xm
yl=ym
zl=zm+0.2
其中,以所述激光雷达为坐标原点的三维坐标系中有一点坐标l(xl,yl,zl),对应在以所述导航雷达为坐标原点的三维坐标系中的一点坐标m(xm,ym,zm)。
4.如权利要求1所述的基于激光雷达和导航雷达的多目标识别方法,其特征在于,所述使用所述激光雷达传感器采集的所述多目标数据对所述使用导航雷达采集的多目标数据进行辅助,包括使用以下基于有理数倍采样的异步融合算法:
步骤1,将来自各传感器的测量值在融合中心的坐标系中和时钟下进行映射统一;
步骤2,基于下一时刻目标状态的预测值与当前时刻目标状态的估计值之差,建立描述该融合周期内各个观测点处的目标状态向量之间的动态模型;
步骤3,依据当前时刻目标状态基于全局信息的估计值,结合所述动态模型和传统的滤波器,利用本周期内按序到达的所述各传感器测量值,依次对各观测点处的目标状态进行估计;
步骤4,获得下一时刻目标状态基于全局信息的估计值。
5.如权利要求1所述的基于激光雷达和导航雷达的多目标识别方法,其特征在于,使用所述导航雷达的距离和角度确定一目标之后,使用所述激光雷达确定该目标周围返回的目标数量,根据以下最近邻聚类法判断该目标是否采用:
步骤1:任取样本Xi作为第一个聚类中心的初始值,令Z1=X1;
步骤2:计算样本X2到Z1的欧式距离D21=||X2-Z1||,若D21>T,定义一新的聚类中心Z2=X2,否则X2∈以Z1为中心的聚类;
步骤3:假设已有聚类中心Z1,Z2,计算D31=||X3-Z1||和D32=||X3-Z2||,若D31>T且D32>T,则建立第三个聚类中心Z3=X3,否则X3∈离Z1和Z2中最近邻的聚类中心;
步骤4:以此类推,直到将所有的N个样本都进行分类;
待分类的模式{X1,X2,…,Xn},按T分类到以Z1,Z2,…为聚类中心的模式类中,
其中,Z1是起始值,T是预设的距离阈值。
6.如权利要求1所述的基于激光雷达和导航雷达的多目标识别方法,其特征在于,还包括以下步骤:
使用激光导航的距离参数确定一目标之后,设置一阈值,若所述导航雷达的距离超过该阈值,判断该目标出错,不予采用。
7.如权利要求1所述的基于激光雷达和导航雷达的多目标识别方法,其特征在于,无人艇前方目标速度以导航雷达的速度为准。
8.如权利要求1所述的基于激光雷达和导航雷达的多目标识别方法,其特征在于,所述多目标数据使用最近邻算法,依据最近邻的至少一个目标轨迹点的运动目标来确定待分目标轨迹点所属的运动目标,从而构成了多目标的航迹。
假设第j帧第m个运动目标的返回角度、距离、速度参数为(θjm,djm,vjm),其在以激光雷达传感器为坐标原点的世界坐标系中坐标为(xj,m,yj,m),其中xj,m=djm·sinθjm,yj,m=djm·cosθjm,所述第j帧第m个运动目标与下一帧第j+1帧第k个运动目标的距离dk(k=1,2,···nj+1)由两点间的距离公式表示为:
Figure FDA0002155242030000031
9.如权利要求1所述的基于激光雷达和导航雷达的多目标识别方法,其特征在于,所述多目标数据使用联合概率数据关联。
10.如权利要求9所述的基于激光雷达和导航雷达的多目标识别方法,其特征在于,所述联合概率数据关联包括第j帧nj个目标与第j+1帧nj+1个目标进行关联,产生多个目标关联排列组合,将所有的相邻两帧配对目标的关联概率相乘,取最大概率值为对应的关联排列。
11.一种使用如权利要求1至10任一项所述的基于激光雷达和导航雷达的多目标识别方法的系统,其特征在于,包括:
无人艇控制器和数据处理器,所述数据处理器包括激光检测处理模块、激光扫描控制模块、厘米波雷达基带处理模块和波形产生模块;
激光雷达传感器,所述激光传感器包括激光发射器和激光接收器,所述激光发射器和所述激光检测处理模块连接,所述激光接收器和所述激光扫描控制模块连接;
导航雷达传感器,所述导航雷达传感器包括射频电路,所述射频电路发送基带信号到所述厘米波雷达基带处理模块,所述射频电路接收所述波形产生模块发送的调制信号;
所述无人艇控制器和电源电路、接口芯片以及时钟电路电性连接。
CN201910715439.5A 2019-08-05 2019-08-05 基于激光雷达和导航雷达的多目标识别方法及系统 Active CN110794396B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910715439.5A CN110794396B (zh) 2019-08-05 2019-08-05 基于激光雷达和导航雷达的多目标识别方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910715439.5A CN110794396B (zh) 2019-08-05 2019-08-05 基于激光雷达和导航雷达的多目标识别方法及系统

Publications (2)

Publication Number Publication Date
CN110794396A true CN110794396A (zh) 2020-02-14
CN110794396B CN110794396B (zh) 2021-08-17

Family

ID=69426996

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910715439.5A Active CN110794396B (zh) 2019-08-05 2019-08-05 基于激光雷达和导航雷达的多目标识别方法及系统

Country Status (1)

Country Link
CN (1) CN110794396B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111721167A (zh) * 2020-05-19 2020-09-29 李超 一种航空计算机雷达制导系统
CN111830502A (zh) * 2020-06-30 2020-10-27 广州小鹏车联网科技有限公司 数据集的建立方法、车辆和存储介质
CN111986232A (zh) * 2020-08-13 2020-11-24 上海高仙自动化科技发展有限公司 目标物体的检测方法、装置、机器人及存储介质
CN112986980A (zh) * 2021-02-09 2021-06-18 北京理工大学 一种目标态势特征的监测系统
CN113204015A (zh) * 2021-03-31 2021-08-03 扬州瑞亿达电子科技有限公司 用于分布式雷达目标模拟的多无人机航迹规划方法及系统
CN117036342A (zh) * 2023-10-07 2023-11-10 深圳模微半导体有限公司 一种芯片缺陷识别方法及系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN203310993U (zh) * 2013-07-08 2013-11-27 北京顶亮科技有限公司 雷达和光电一体化综合探测识别装置
KR101734867B1 (ko) * 2016-11-29 2017-05-15 렉스젠(주) 객체 검출 장치
CN108573280A (zh) * 2018-04-08 2018-09-25 四方继保(武汉)软件有限公司 一种无人船自主通过桥梁的方法
CN109212530A (zh) * 2017-07-04 2019-01-15 百度在线网络技术(北京)有限公司 用于确定障碍物速度的方法和装置
CN109282813A (zh) * 2018-11-26 2019-01-29 深圳市海斯比船艇科技股份有限公司 一种无人艇全局障碍物识别的方法
CN109835441A (zh) * 2019-02-25 2019-06-04 浙江科技学院 水质监测智能小船的自动驾驶方法及其系统

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN203310993U (zh) * 2013-07-08 2013-11-27 北京顶亮科技有限公司 雷达和光电一体化综合探测识别装置
KR101734867B1 (ko) * 2016-11-29 2017-05-15 렉스젠(주) 객체 검출 장치
CN109212530A (zh) * 2017-07-04 2019-01-15 百度在线网络技术(北京)有限公司 用于确定障碍物速度的方法和装置
CN108573280A (zh) * 2018-04-08 2018-09-25 四方继保(武汉)软件有限公司 一种无人船自主通过桥梁的方法
CN109282813A (zh) * 2018-11-26 2019-01-29 深圳市海斯比船艇科技股份有限公司 一种无人艇全局障碍物识别的方法
CN109835441A (zh) * 2019-02-25 2019-06-04 浙江科技学院 水质监测智能小船的自动驾驶方法及其系统

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111721167A (zh) * 2020-05-19 2020-09-29 李超 一种航空计算机雷达制导系统
CN111830502A (zh) * 2020-06-30 2020-10-27 广州小鹏车联网科技有限公司 数据集的建立方法、车辆和存储介质
CN111830502B (zh) * 2020-06-30 2021-10-12 广州小鹏自动驾驶科技有限公司 数据集的建立方法、车辆和存储介质
CN111986232A (zh) * 2020-08-13 2020-11-24 上海高仙自动化科技发展有限公司 目标物体的检测方法、装置、机器人及存储介质
CN111986232B (zh) * 2020-08-13 2021-09-14 上海高仙自动化科技发展有限公司 目标物体的检测方法、装置、机器人及存储介质
CN112986980A (zh) * 2021-02-09 2021-06-18 北京理工大学 一种目标态势特征的监测系统
CN113204015A (zh) * 2021-03-31 2021-08-03 扬州瑞亿达电子科技有限公司 用于分布式雷达目标模拟的多无人机航迹规划方法及系统
CN117036342A (zh) * 2023-10-07 2023-11-10 深圳模微半导体有限公司 一种芯片缺陷识别方法及系统
CN117036342B (zh) * 2023-10-07 2024-02-06 深圳模微半导体有限公司 一种芯片缺陷识别方法及系统

Also Published As

Publication number Publication date
CN110794396B (zh) 2021-08-17

Similar Documents

Publication Publication Date Title
CN110794396B (zh) 基于激光雷达和导航雷达的多目标识别方法及系统
CN109444911B (zh) 一种单目相机和激光雷达信息融合的无人艇水面目标检测识别与定位方法
CN110850403B (zh) 一种多传感器决策级融合的智能船水面目标感知识别方法
CN110275153B (zh) 一种基于激光雷达的水面目标检测与跟踪方法
CN105701479B (zh) 基于目标特征的智能车辆多激光雷达融合识别方法
CN113985419A (zh) 水面机器人协同障碍物检测及避障方法及系统
Wang et al. Bionic vision inspired on-road obstacle detection and tracking using radar and visual information
CN110580044A (zh) 基于智能感知的无人船全自动航行异构系统
CN110568433A (zh) 基于毫米波雷达的高空抛物检测方法
CN111781608A (zh) 一种基于fmcw激光雷达的运动目标检测方法及系统
CN109282808A (zh) 用于桥梁三维巡航检测的无人机与多传感器融合定位方法
Cui et al. 3D detection and tracking for on-road vehicles with a monovision camera and dual low-cost 4D mmWave radars
CN113721253B (zh) 基于fmcw激光雷达的运动物体速度检测方法
CN111123212A (zh) 一种基于复杂杂波背景下的场面监视雷达的信号处理方法
Schouten et al. RadarSLAM: Biomimetic SLAM using ultra-wideband pulse-echo radar
CN115761286A (zh) 复杂海况下基于激光雷达的水面无人艇航行障碍物检测方法
CN115031718A (zh) 一种多传感器融合的无人船同步定位与建图方法(slam)及系统
Li et al. Pedestrian liveness detection based on mmwave radar and camera fusion
CN116699602A (zh) 一种基于毫米波雷达和相机融合的目标检测系统及方法
CN117606497A (zh) 一种实时地图构建方法、系统及导盲眼镜
CN116508071A (zh) 用于注释汽车雷达数据的系统和方法
CN113790718A (zh) 一种基于无人船的信息共享系统
CN113091733A (zh) 一种基于毫米波雷达与imu融合的实时定位装置及方法
TW202019742A (zh) 近距離障礙物之光達偵測裝置及其方法
Lim et al. A fusion method of data association and virtual detection for minimizing track loss and false track

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