ts_induce.asv

来自「针对卡尔曼滤波的原创改进算法」· ASV 代码 · 共 64 行

function r=ts_induce(fielda,fieldb,N,vx)
gl=grade(fielda,fieldb,N,vx);
r=[0,0];
if gl(1,2)>gl(2,2)
    r(2)=gl(1,2);
    r(1)=gl(1,1);
else
    r(1)=gl(2,1);
    r(2)=gl(2,2);
end


function gl_out=grade(fielda,fieldb,N,vx)
%gl_out  2*2
%[-x,x]形式
% fielda 论域始点
% filedb 论域终点
% N 划分级别参数 总共有2*N+1级
% 输入真实值
% 输出二维数组 级别+隶属度
gl_out=zeros(2,2);
d=(fieldb-fielda)/(2*N);

%向0取整
jb=fix(vx/d);
% eps 整数最小步进距离 
if jb<=-N 
    gl_out(1,1)=-N;
    gl_out(1,2)=1;
    gl_out(2,1)=0;
    gl_out(2,2)=0;
elseif jb<eps
    gl_out(1,1)=jb;
    gl_out(1,2)=li((jb-1)*d,(jb+1)*d,vx);
    gl_out(2,1)=jb-1;
    gl_out(2,2)=li((jb-2)*d,jb*d,vx);

elseif jb<N
    gl_out(1,1)=jb;
    gl_out(1,2)=li((jb-1)*d,(jb+1)*d,vx);
    gl_out(2,1)=jb+1;
    gl_out(2,2)=li((jb)*d,(jb+2)*d,vx); 

else 
    gl_out(1,1)=N;
    gl_out(1,2)=1;
    gl_out(2,1)=0;
    gl_out(2,2)=0;
end   

%等腰三角形隶属单元函数
function ms=li(a,b,x)
% a 起点
% b 终点
% x 输入
if x<=a 
    ms=0;
elseif x<(a+b)/2
    ms=2*(x-a)/(b-a);
elseif x<b
    ms=2*(x-b)/(a-b)
else;
    ms=0;
end