24 lines
449 B
Matlab
24 lines
449 B
Matlab
function [ revisitness ] = is_revisit(query_idx, query_pose, radar_poses, revisit_criteria, num_node_enough_apart)
|
|
|
|
num_db = size(radar_poses, 1);
|
|
|
|
revisitness = 0;
|
|
for ii = 1:num_db
|
|
|
|
if( abs(query_idx - ii) < num_node_enough_apart)
|
|
continue;
|
|
end
|
|
|
|
pose = radar_poses(ii, :);
|
|
|
|
dist = dist_btn_pose(query_pose, pose);
|
|
|
|
if(dist < revisit_criteria)
|
|
revisitness = 1;
|
|
break;
|
|
end
|
|
end
|
|
|
|
end
|
|
|