find_area.m

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

function temp_area = find_area(loc)

temp = 1;

for i=1:5
    for j=1:5
        
        switch j
            case 1
                x1 = loc(1,1) - 2;
            case 2
                x1 = loc(1,1) - 1;
            case 3
                x1 = loc(1,1);
            case 4
                x1 = loc(1,1) + 1;
            case 5
                x1 = loc(1,1) + 2;
            otherwise
                x1 = loc(1,1);
        end
        
        switch i
            case 1
                y1 = loc(2,1) - 2;
            case 2
                y1 = loc(2,1) - 1;
            case 3
                y1 = loc(2,1);
            case 4
                y1 = loc(2,1) + 1;
            case 5
                y1 = loc(2,1) + 2;
            otherwise
                y1 = loc(2,1);
        end
        
        temp_area(:,temp) = [x1,y1];
        temp = temp + 1;
    end
end