【C#】求点到线段的垂线距离

—花泥—

于 2017-09-29 13:40:19 发布

阅读量4.4k

点赞数

分类专栏：【C#】算法文章标签： c# 算法

本文链接：https://blog.youkuaiyun.com/qq_16716745/article/details/78133020

版权

【C#】算法专栏收录该内容

2 篇文章

订阅专栏

 public float DistanceForPointToABLine(float x, float y, float x1, float y1, float x2, float y2)//所在点到AB线段的垂线长度
    {
        float reVal = 0f;
        bool retData = false;

        float cross = (x2 - x1) * (x - x1) + (y2 - y1) * (y - y1);
        if (cross <= 0)
        {
            reVal = (float)Math.Sqrt((x - x1) * (x - x1) + (y - y1) * (y - y1));
            retData = true;
        }

        float d2 = (x2 - x1) * (x2 - x1) + (y2 - y1) * (y2 - y1);
        if (cross >= d2)
        {
            reVal = (float)Math.Sqrt((x - x2) * (x - x2) + (y - y2) * (y - y2));
            retData = true;
        }

        if (!retData)
        {
            float r = cross / d2;
            float px = x1 + (x2 - x1) * r;
            float py = y1 + (y2 - y1) * r;
            reVal = (float)Math.Sqrt((x - px) * (x - px) + (py - y) * (py - y));
        }

        return reVal;

    }