点から線分までの距離
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); //
}