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

转载于 2013-04-09 18:11:54 发布 · 1.2k 阅读

c++ 专栏收录该内容

33 篇文章

订阅专栏

本文介绍了一种计算点到线段最短距离的算法。该算法首先找到线段上距离给定点最近的点，然后计算这两点之间的距离。适用于计算用户位置到公路等线段的距离。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

源码地址：http://download.youkuaiyun.com/detail/mnorst/5238806

原文地址：http://www.cocoachina.com/newbie/tutorial/2011/0223/2669.html

下面这个计算点到线段最短距离算法是先计算线段上距离点最近的点，然后求出 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);