fun_dis_two_point.m

used to 计算p0点到直线p1p2的距离

function F_dis =liwm_fun_dis_two_point(p2,p1,p0)
if 1 % 计算p0点到直线p1p2的距离
       x1=p1(1);
       y1=p1(2);
       x2=p2(1);
       y2=p2(2);
       x0=p0(1);
       y0=p0(2);
       
       
        %         P(x0,y0)点到直线Ax+By+C=0的距离公式为：
        %         d=[Ax0+By0+C的绝对值]/[(A^2+B^2)的算术平方根]。
        %         如求点P（-1，2）到直线2X+Y-10=0的距离：
        %         X0=-1，Y0=2，A=2，B=1，C=-10代入公式，
        %         d=[2*(-1)+1*2-10的绝对值]/根号[2*2+1*1]=10/根号5

        fa=(y2-y1)/(x2-x1);
        fb=-1;
        fc=y1-x1*fa;
        d=abs(fa*x0+fb*y0+fc)/sqrt(fa^2+fb^2);
        F_dis=d;
        
       
        
        
    end