点到线段的距离

// 设线段两段点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); //两点间距离公式
}

 

你可能感兴趣的:(数论题)