一种基于多源数据融合的水面动态障碍物轨迹预测方法与流程

摘要: 本发明涉及基于无线波的水面目标感知与运动预测,具体为一种基于多源数据融合的水面动态障碍物轨迹预测方法。背景技术:1、水面动态障碍物对水面机器人航行、航道通航安全...
一种基于多源数据融合的水面动态障碍物轨迹预测方法与流程

本发明涉及基于无线波的水面目标感知与运动预测,具体为一种基于多源数据融合的水面动态障碍物轨迹预测方法。

背景技术:

1、水面动态障碍物对水面机器人航行、航道通航安全与水环境清理作业构成直接威胁。本发明所指的水面动态障碍物具体为流动水面漂浮物,即随水流与风漂移的漂浮物体。

2、现有的水面漂浮物运动分析方案主要依赖单目相机对水面图像序列进行处理:检测水面波纹纹理的变化特征,将波纹特征与预设的经验运动状态表执行查表匹配,输出漂浮物当前的运动方向与快慢等级。

3、上述方案存在以下局限:第一,查表匹配仅输出当前时刻的定性运动状态,无法给出未来时段的位置预测,下游避障与打捞任务只能依据当前状态做被动响应;第二,水面波纹特征仅反映局部水面形态,未与表层流、风场数据执行融合,在低光照、大浪、雨雾条件下波纹特征退化,输出结果随之失真;第三,一旦漂浮物脱离相机视野或被浪花、杂物遮挡,方案即丢失目标,无法继续给出目标位置;第四,输出结果不附带不确定性度量,下游任务无法评估结果的可靠程度。

技术实现思路

1、针对现有技术的不足,本发明提供了一种基于多源数据融合的水面动态障碍物轨迹预测方法,解决了背景技术中轨迹预测不够全面问题。

2、为实现以上目的,本发明通过以下技术方案予以实现:一种基于多源数据融合的水面动态障碍物轨迹预测方法,所述方法包括:

3、s1:先通过雷达观测采集单元向监控水域连续发射无线波并接收水域内目标反射的回波信号,对回波信号执行障碍物检测与目标关联得到障碍物位置观测数据,再通过环境场采集单元获取表层流数据与风场数据;

4、s2:先通过时空对齐单元将障碍物位置观测数据、表层流数据与风场数据统一到同一采样时刻得到同步观测数据,再通过空间配准单元将同步观测数据中的障碍物位置由雷达距离方位坐标转换至地理坐标并剔除无效观测,最后通过观测置信度评估单元根据信号质量指标计算雷达观测置信度;

5、s3:通过漂移动力学建模单元构建漂浮物漂移动力学模型,再通过滤波状态估计单元得到障碍物运动状态估计值与滤波残差序列,最后通过风曳系数自适应估计单元利用滤波残差序列与回波强度指标对风曳漂移系数执行在线估计与修正得到风曳漂移系数估计值;

6、s4:通过状态特征量构建单元对障碍物运动状态估计值与滤波残差序列执行滑动窗口统计,再通过状态逻辑判别单元按照先突变判别、再静止判别、后位置验证的递进顺序对三个特征量执行逻辑判别,输出自由漂移状态、搁浅静止状态或碰撞扰动突变状态之一的运动状态标签,最后通过预测模型切换单元根据运动状态标签切换预测模型;

7、s5:通过丢失判定单元对每个已登记障碍物的连续未观测计数执行累计与阈值比较,判定已登记障碍物是否进入观测丢失状态,在判定进入观测丢失状态时通过动力学推演单元执行动力学推演得到推演位置序列,在重新检测到该已登记障碍物时通过再观测校正单元以新的障碍物位置观测数据对推演位置序列执行校正;

8、s6:通过环境预报驱动预测单元以预测模型对未来时段内的表层流预报数据与风场预报数据逐步推演得到预测轨迹点序列,再通过不确定性量化单元对预测轨迹点序列执行多次参数扰动推演,统计各预测轨迹点的位置分布,生成各预测轨迹点的置信区间;

9、s7:通过漂移归宿分析单元将预测轨迹点序列与置信区间和岸线数据、航道范围数据、保护区范围数据、水深地形数据执行空间相交判别,输出漂移归宿标记,再通过风险等级生成单元根据漂移归宿标记、进入时间与置信区间宽度综合生成风险等级,并将风险等级、漂移归宿标记、进入时间、预测轨迹点序列与置信区间封装为风险预警消息输出。

10、本发明提供了一种基于多源数据融合的水面动态障碍物轨迹预测方法。具备以下有益效果:

11、(1)本发明将雷达观测得到的障碍物位置观测数据与表层流数据、风场数据经时空对齐与空间配准统一到同一时空基准形成同步观测数据,并通过观测置信度评估量化各数据源的可靠程度,以此确定自适应卡尔曼滤波中观测噪声与过程噪声的取值,克服了现有技术仅依赖单一水面图像波纹特征、在低光照与大浪条件下特征退化即输出失真的缺陷,实现了多源异构数据在状态估计框架内的互补融合;雷达无线波观测不受光照条件限制,对夜间、雨雾、海雾等低能见度条件具有较强的适应性。

12、(2)本发明以表层流漂移项与风致漂移项构成的漂浮物漂移动力学模型为滤波状态方程,通过残差驱动辨识与回波强度指标修正对每个已登记障碍物的风曳漂移系数执行在线估计,并按照先突变判别、再静止判别、后位置验证的递进顺序识别运动状态标签并自适应切换预测模型,克服了现有查表式方案仅能输出当前时刻定性运动状态、无法预测未来位置的缺陷,实现了物理规律约束下的水面动态障碍物未来轨迹预测。

13、(3)本发明在观测丢失条件下以风曳漂移系数估计值结合表层流预报数据与风场预报数据持续推演目标位置,并在重新检测时校正推演轨迹、恢复滤波,解决了现有技术中障碍物一旦脱离视野或被遮挡即丢失目标、方案失效的鲁棒性缺陷;同时对预测轨迹点执行多次参数扰动推演生成置信区间,将预测的不确定性随风险预警消息一并输出,为下游水面机器人本地避障与岸基平台全局监控、多打捞机器人任务预分配提供了可靠程度依据。

1.一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述方法包括:

2.根据权利要求1所述的一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述s1中,障碍物位置观测数据还携带回波强度指标,所述回波强度指标为候选回波区域的雷达回波功率经归一化处理后得到的量;所述目标关联以帧间位置位移作为关联代价,在关联代价小于关联阈值时判定当前候选回波区域与已有目标为同一水面动态障碍物并分配唯一的目标编号。

3.根据权利要求1所述的一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述s2中,空间配准单元读取雷达的安装位置坐标与天线方位基准,按距离方位关系将同步观测数据中障碍物位置的距离方位坐标转换至地理坐标;对转换后落在监控水域范围外或落在陆地区域的位置观测标记为无效观测并剔除;时空对齐单元在表层流数据与风场数据的相邻两个实测样本的间隔超过预设插值窗口时,将该时刻标记为环境数据缺失,滤波状态估计单元对标记为环境数据缺失的时刻采用最近一次有效的表层流数据与风场数据执行状态预测。

4.根据权利要求2所述的一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述s3中,风曳系数自适应估计单元将滤波残差序列投影至风致漂移方向得到投影残差,以递推最小二乘法对投影残差执行回归得到系统偏差估计量,并根据系统偏差估计量更新风曳漂移系数;风曳系数自适应估计单元还读取障碍物位置观测数据携带的回波强度指标,根据回波强度指标对更新后的风曳漂移系数执行修正,并将修正结果限幅至预设系数范围,得到风曳漂移系数估计值;所述在线估计仅在雷达观测置信度高于置信度门限且运动状态标签为自由漂移状态时执行。

5.根据权利要求1所述的一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述s2中,观测置信度评估单元以信噪比指标、回波稳定度指标与干扰水平指标的加权和作为雷达观测置信度,并根据表层流数据与风场数据的来源与时效确定环境数据置信度;所述s3中,滤波状态估计单元以雷达观测置信度确定观测噪声协方差,以环境数据置信度确定过程噪声协方差,雷达观测置信度越低,观测噪声协方差越大,使自适应卡尔曼滤波在状态更新中降低雷达观测的融合权重。

6.根据权利要求1所述的一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述s4中,状态逻辑判别单元按照先突变判别、再静止判别、后位置验证的递进顺序执行判别:在突变判别中,在残差累积和特征量超过突变阈值且速度变化量超过速度变化阈值时输出碰撞扰动突变状态;在静止判别中,在速度统计特征量低于搁浅速度阈值时进入位置验证,否则输出自由漂移状态;在位置验证中,在位置-岸线距离特征量小于岸线缓冲距离且当前位置水深小于预设水深时输出搁浅静止状态,否则维持上一时刻的运动状态标签。

7.根据权利要求1所述的一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述s4中,扰动过渡预测模型的预测速度自当前滤波速度向理论漂移速度按指数衰减方式过渡,衰减因子与过渡期均预先设定,过渡期结束后自动切换至自由漂移预测模型;预测模型切换单元在切换预测模型时以当前滤波状态作为新模型的推演初值。

8.根据权利要求1所述的一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述s5中,丢失判定阈值根据雷达观测置信度自适应设置:在雷达观测置信度高于低置信度阈值时,丢失判定阈值取第一阈值;在雷达观测置信度低于低置信度阈值时,丢失判定阈值取大于第一阈值的第二阈值;在动力学推演单元的推演时长超过最大推演时长且未重新检测到已登记障碍物时,注销已登记障碍物并输出轨迹终止标记。

9.根据权利要求1所述的一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述s6中,不确定性量化单元对初始速度、风曳漂移系数估计值与环境预报流速三类参数执行扰动采样,以采样后的参数重复执行环境预报驱动预测单元的推演过程得到多条采样轨迹,对各预测轨迹点取多条采样轨迹对应位置的分位数,生成置信区间。

10.根据权利要求1所述的一种基于多源数据融合的水面动态障碍物轨迹预测方法,其特征在于,所述s7中,漂移归宿标记为搁浅上岸、进入航道、进入保护区或持续漂移之一;风险等级分为一级风险、二级风险与三级风险;在漂移归宿标记为进入航道且进入时间不超过预设进入时限时定为一级风险;在漂移归宿标记为进入航道且进入时间超过预设进入时限,或漂移归宿标记为进入保护区时定为二级风险;在漂移归宿标记为搁浅上岸或持续漂移时定为三级风险;在对应预测轨迹点的置信区间宽度超过宽度阈值时,将风险等级上调一级。