α-β滤波算法

%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%  给定α、β系数条件下，验证常增益α-β滤波（此系数与观测信号噪声有关，具体参考文献）
%  输入：真实数据（位置+速度）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）;                                 

realv