[发明专利]一种基于分数阶卡尔曼滤波的毫米波雷达单目标跟踪方法在审
申请号: | 202111235191.6 | 申请日: | 2021-10-22 |
公开(公告)号: | CN114019498A | 公开(公告)日: | 2022-02-08 |
发明(设计)人: | 王知雨 | 申请(专利权)人: | 四川启睿克科技有限公司 |
主分类号: | G01S13/72 | 分类号: | G01S13/72 |
代理公司: | 四川省成都市天策商标专利事务所(有限合伙) 51213 | 代理人: | 刘堋 |
地址: | 610000 四川省成都市中国(四川)*** | 国省代码: | 四川;51 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 分数 卡尔 滤波 毫米波 雷达 目标 跟踪 方法 | ||
1.一种基于分数阶卡尔曼滤波的毫米波雷达单目标跟踪方法,其特征在于,包括如下步骤:
从雷达端输出目标的回波点云数据;
对点云数据分堆选择;
进行分数阶卡尔曼滤波;
进行马氏距离判断;
目标位置更新。
2.根据权利要求1所述的基于分数阶卡尔曼滤波的毫米波雷达单目标跟踪方法,其特征在于,所述雷达端输出目标的回波点云数据包括点的数量信息、距离信息、多普勒信息、方位角信息、信噪比信息和当前帧编号。
3.根据权利要求1所述的基于分数阶卡尔曼滤波的毫米波雷达单目标跟踪方法,其特征在于,所述分数阶卡尔曼滤波算法包括如下步骤:
S1、初始化分数阶运动模型并预设分数阶卡尔曼滤波的相关参数;
S2、建立并完成关于跟踪目标的分数阶卡尔曼滤波状态更新方程;
S3、建立并完成关于跟踪目标的分数阶卡尔曼滤波量测更新方程;
S4、根据分数阶卡尔曼滤波结果更新运动模型的分数阶阶次。
4.根据权利要求3所述的基于分数阶卡尔曼滤波的毫米波雷达单目标跟踪方法,其特征在于,步骤S1中,分数阶运动模型为利用分数阶微积分建立关于目标在系统绝对坐标系下,时域内的连续运动模型,具体包括:
其中,为分数阶微分算子,α为分数阶阶次,F为系统矩阵,x(t)为运动目标的状态向量,具体包括:
其中,h表示系统采样周期,
给出目标在雷达相对坐标系下,时域内的量测向量:
进一步的,利用时域内系统的连续运动模型及量测向量,进行离散化得到系统在分数阶微积分下的状态空间表达式:
其中,xk,xk+1,yk分别表示k时刻目标运动状态,k+1时刻目标运动状态及k时刻雷达系统量测;ωk,υk分别表示k时刻系统噪声及量测噪声;表示k时刻系统的状态转移矩阵;为对角阵;h(·)为非线性坐标变换;
5.根据权利要求4所述的基于分数阶卡尔曼滤波的毫米波雷达单目标跟踪方法,其特征在于,步骤S1中,分数阶卡尔曼滤波的相关参数设置包括:目标初始位置x0设置,目标初始残差协方差矩阵P0设置,协方差矩阵分别为Q与R的高斯白噪声设置,初始分数阶阶数α0设置。
6.根据权利要求5所述的基于分数阶卡尔曼滤波的毫米波雷达单目标跟踪方法,其特征在于,步骤S2中,关于跟踪目标的分数阶卡尔曼滤波状态更新方程的具体步骤为:
其中,表示当前时刻先验状态估计;表示j时刻前的后验估计状态;表示当前时刻的先验残差协方差矩阵;Pk-j表示j时刻前的后验残差协方差矩阵;Q表示系统噪声协方差矩阵;表示k时刻系统的状态转移矩阵;Θj为一个对角矩阵,其表达式为:
7.根据权利要求6所述的基于分数阶卡尔曼滤波的毫米波雷达单目标跟踪方法,其特征在于,步骤S3中,关于跟踪目标的分数阶卡尔曼滤波量测更新方程的具体步骤为:
其中,表示卡尔曼增益;表示k时刻雷达系统量测,各分量含义为:距离、方位角及多普勒速度;h(·)为关于跟踪目标的非线性坐标变换,Jh为h(·)对x(t)的雅各比矩阵:
8.根据权利要求7所述的基于分数阶卡尔曼滤波的毫米波雷达单目标跟踪方法,其特征在于,步骤S4中,分数阶阶次的更新方法如下:
在完成一次分数阶卡尔曼滤波过程后,以当前雷达量测值yk及量测更新后的目标位置之间误差的最小平方和作为目标函数,采用非线性最小二乘法对分数阶阶次进行更新,具体的目标函数为:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于四川启睿克科技有限公司,未经四川启睿克科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111235191.6/1.html,转载请声明来源钻瓜专利网。