资源简介
常增益α-β滤波是卡尔曼滤波的简化,在信号处理及自动控制领域广泛应用。本程序仿真了常速度运动过程中对位置的α-β滤波估计。
代码片段和文件信息
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% 给定α、β系数条件下,验证常增益α-β滤波(此系数与观测信号噪声有关,具体参考文献)
% 输入:真实数据(位置+速度)realval
% 观测数据(位置)obseval 加观测噪声
% 输出:估计数据(位置+速度)estimval
% 校正输出值(位置+速度)reviseval
% 参考文献:蔡庆宇、张伯彦,曲洪泉.相控阵雷达数据处理教程.北京:电子工业出版社.pp.60-66
% 樊文贵/电子信息工程学院/北京航空航天大学
% 5/8/2014
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
clc;
close all;
clear all;
alpha=0.27;
beta=0.04229;
T=0.1; %采样间隔/s
phi=[1T;01]; %转移矩阵
K=[alpha;beta/T]; %常数增益矩阵
H=[10]; %测量矩阵
%% 轨道生成(输入观测值obseval)
t=0:T:100; %仿真时间/s
LEN=length(t); %仿真数据长度
xi=0; %位置观测噪声均值
zeta=40e3; %位置观测噪声方差
realval=zeros(2LEN);
realval(1:)=0.3e3*t+100e3; %位置真实值/m
realval(2:)=0.3e3*zeros(1LEN); %速度真实值/m/s
origsite=100e3; %初始位置/m
origvelo=0.3e3; %初始速度/m/s
obseval=H*realval+(sqrt(zeta)*randn(1LEN)+xi*ones(1LEN)); %位置观测值 +方差为zeta均值为0的高斯噪声
fi
评论
共有 条评论