C++：点到线段的平面距离。点与点的平面距离。

最新推荐文章于 2023-05-24 12:36:27 发布

累了就要打游戏

最新推荐文章于 2023-05-24 12:36:27 发布

阅读量2.4k

点赞数

CC 4.0 BY-SA版权

分类专栏： # C++ 文章标签：点线距离

本文链接：https://blog.youkuaiyun.com/xinjiang666/article/details/83996798

C++ 专栏收录该内容

25 篇文章

订阅专栏

本文分享了一种计算平面上点到线段距离的算法实现，通过海伦公式求三角形面积并转换为点到线段的距离，适用于地面过滤等场景。

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

分享给有需要的人，代码质量勿喷。

/// <summary>
/// 点（p0）  到线段（p1，p2）的距离
/// </summary>
/// <param name="p0"></param>
/// <param name="p1"></param>
/// <param name="p2"></param>
/// <returns></returns>
double GroundFilter::xj2DistancePointAndLine(LPoint p0, LPoint p1, LPoint p2)
{
    double dis12 = xj2DistancePointAndPoint(p1, p2);//线段长度
    double dis01 = xj2DistancePointAndPoint(p0, p1);//p1与p0的距离
    double dis02 = xj2DistancePointAndPoint(p0, p2);//p2与p0的距离
    double HalfC = (dis12 + dis01 + dis02) / 2;// 半周长
    double s = sqrt(HalfC * (HalfC - dis12) * (HalfC - dis01) * (HalfC - dis02));//海伦公式求面积
    double xj2DisPL = 2 * s / dis12;// 返回点到线的距离（利用三角形面积公式求高）

    return xj2DisPL;
}

/// <summary>
/// 点与点的平面距离
/// </summary>
/// <param name="p1"></param>
/// <param name="p2"></param>
/// <returns></returns>
double GroundFilter::xj2DistancePointAndPoint(LPoint p1, LPoint p2)
{
    double x1 = p1.x, y1 = p1.y;
    double x2 = p2.x, y2 = p2.y;

    double dis = sqrt((x1 - x2) * (x1 - x2) + (y1 - y2) * (y1 - y2));

    return dis;
}