scan-context/src/fast_evaluator/src/dist_btn_pose.m

4 lines
121 B
Matlab

function dist = dist_btn_pose(pose1, pose2)
dist = sqrt( (pose1(1) - pose2(1))^2 + (pose1(2) - pose2(2))^2);
end