lineardist.m

来自「线性M3网络及其示意图」· M 代码 · 共 9 行

function d=linearDist(p,L)
% calculate distance from point p  to line L




d=(L(1)-L(3))*p(1)+(L(2)-L(4))*p(2)+0.5*(L(3)^2+L(4)^2-L(1)^2-L(2)^2);
d=d/sqrt((L(1)-L(3))^2+(L(2)-L(4))^2);