点到直线的距离

double fun(node s,node t,node p)//点到直线的距离,点p到点s和t确定的直线的距离 
{ 
      if(fabs(s.x-t.x)<0.0000001) 
      { 
            return fabs(p.x-s.x); 
      } 
      double k=(s.y-t.y)/(s.x-t.x); 
      double b=s.y-s.x*k; 
      return fabs(k*p.x+b-p.y)/sqrt(pow(k,2)+1); 
}