点から線分までの距離

751 ワード

//       A(x1,y1)  B (x2 , y2)         C ( x , y );
double cn(double x,double y,double x1,double y1,double x2,double y2)
{
    double cross = (x2 - x1) * (x - x1) + (y2 - y1) * (y - y1); // |AB| * |AC|*cos(x)
    if (cross <= 0)  //     0,    BAC       
        return sqrt((x - x1) * (x - x1) + (y - y1) * (y - y1)+0.0);
    
    double d2 = (x2 - x1) * (x2 - x1) + (y2 - y1) * (y2 - y1); // |AB|
    if (cross >= d2)  // ABC      
        return sqrt((x - x2) * (x - x2) + (y - y2) * (y - y2)+0.0);
    
    //     
    double r = cross / d2;
    double px = x1 + (x2 - x1) * r;  // C  AB     (px,py)
    double py = y1 + (y2 - y1) * r;
    return sqrt((x - px) * (x - px) + (y - py) * (y - py)+0.0); //       
}