各位看官请注意了,是点到线段的距离。点到线段,不是点到直线或者点到射线,如果不明白啥就点到直线的记录,请参考初中几何教材。
(x1,y1),(x2,y2)是线段的两个端点,(x3,y3)是那个点。
- (double)CalDis:(double)x1:(double)y1:(double)x2:(double)y2:(double)x3:(double)y3
{
double px = x2 - x1;
double py = y2 - y1;
double som = px * px + py * py;
double u = ((x3 - x1) * px + (y3 - y1) * py) / som;
if (u > 1) {
u = 1;
}
if (u < 0) {
u = 0;
}
//the closest point
double x = x1 + u * px;
double y = y1 + u * py;
double dx = x - x3;
double dy = y - y3; 
double dist = sqrt(dx*dx + dy*dy);
 
return dist;
}

 

arrow
arrow
    全站熱搜

    戮克 發表在 痞客邦 留言(0) 人氣()