计算点到线段最短距离的代码

下面这个计算点到线段最短距离算法是先计算线段上距离点最近的点，然后求出 2 点距离。在计算用户到当前位置到某条公路的最短距离等实际情况中，可以先用这个算法，然后根据结果坐标使用 CLLocation 类的函数计算实际距离。

代码

double x1, y1, x2, y2, x3, 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);