distance_pointtopoint.m

基于声纳信息的粒子滤波算法

function Distance=Distance_piontTopoint(x1,y1,x2,y2)
%%get the distance between two point this is ok
%2007.09.29
     Distance=sqrt((x1-x2).^2+(y1-y2).^2);