erase_features.m

来自「用EKF」· M 代码 · 共 25 行

function map = erase_features (map, which)
%-------------------------------------------------------
% University of Zaragoza
% Centro Politecnico Superior
% Robotics and Real Time Group
% Authors:  J. Neira, J. Tardos
% Date   :  7-2006
%-------------------------------------------------------
%-------------------------------------------------------

[ix, iy, inde] = obs_rows(which);
inde = inde + 3;
ind = ones(size(map.x));
ind(inde) = 0;
ind = find(ind);
map.x = map.x(ind);
map.P = map.P(ind, ind);

ind = ones(map.n, 1);
ind(which) = 0;
ind = find(ind);
map.ground_id = map.ground_id(ind);
map.first = map.first(ind);
map.hits = map.hits(ind);
map.n = map.n - length(which);