资源简介
常增益α-β滤波是卡尔曼滤波的简化，在信号处理及自动控制领域广泛应用。本程序仿真了常速度运动过程中对位置的α-β滤波估计。
代码片段和文件信息
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% 给定α、β系数条件下，验证常增益α-β滤波（此系数与观测信号噪声有关，具体参考文献）
% 输入：真实数据（位置+速度）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
评论
共有 条评论