21 lines
340 B
Mathematica
21 lines
340 B
Mathematica
|
function [is_revisit, min_dist] = isRevisitGlobalLoc(query_pose, db_poses, thres)
|
||
|
|
||
|
num_dbs = length(db_poses);
|
||
|
|
||
|
dists = zeros(1, num_dbs);
|
||
|
for ii=1:num_dbs
|
||
|
dist = norm(query_pose - db_poses(ii, :));
|
||
|
dists(ii) = dist;
|
||
|
end
|
||
|
|
||
|
if ( min(dists) < thres )
|
||
|
is_revisit = 1;
|
||
|
else
|
||
|
is_revisit = 0;
|
||
|
end
|
||
|
|
||
|
min_dist = min(dists);
|
||
|
|
||
|
end
|
||
|
|