predict_area.m

来自「目标跟踪的扩展卡尔曼滤波算法主函数的文件是：kal_demo.m 近似网格」· M 代码 · 共 39 行

function [ Ppre ] = predict_area(loc1, loc2)

Ppre = ones(1,25);

if loc2(1,1) - loc1(1,1) >= 0
    up = 1;
else
    up = -1;
end

if loc2(2,1) - loc1(2,1) >= 0
    right = 1;
else
    right = -1;
end



switch up
    case 1
        Ppre(11:25) = Ppre(11:25) + 0;
    case -1
        Ppre(1:15) = Ppre(1:15) + 0;
    otherwise   
        Ppre = ones(1,25);
end

switch right
    case 1
        for i = 1:5
           Ppre(5*(i-1)+3:5*(i-1)+5) = Ppre(5*(i-1)+3:5*(i-1)+5) + 0; 
        end
    case -1
        for i = 1:5
            Ppre(5*(i-1)+1:5*(i-1)+3) = Ppre(5*(i-1)+1:5*(i-1)+3) + 0;
        end
    otherwise
        Ppre = ones(1,25);
end