2. 程式人生 > >記錄一下演算法：點到線段的距離計算。

記錄一下演算法：點到線段的距離計算。

阿新 • • 發佈：2018-12-24

C#版

 public double PointLine_Disp(double xx, double yy, double x1, double y1, double x2, double y2)
        {
            double a, b, c, ang1, ang2, ang, m;
            double result = 0;
            //分別計算三條邊的長度
            a = Math.Sqrt((x1 - xx) * (x1 - xx) + (y1 - yy) * (y1 - yy));
            if (a == 0)
                return -1;
            b = Math.Sqrt((x2 - xx) * (x2 - xx) + (y2 - yy) * (y2 - yy));
            if (b == 0)
                return -1;
            c = Math.Sqrt((x1 - x2) * (x1 - x2) + (y1 - y2) * (y1 - y2));
            //如果線段是一個點則退出函式並返回距離
            if (c == 0)
            {
                result = a;
                return result;
            }
            //如果點(xx,yy到點x1,y1)這條邊短
            if (a < b)
            {
                //如果直線段AB是水平線。得到直線段AB的弧度
                if (y1 == y2)
                {
                    if (x1 < x2)
                        ang1 = 0;
                    else
                        ang1 = Math.PI;
                }
                else
                {
                    m = (x2 - x1) / c;
                    if (m - 1 > 0.00001)
                        m = 1;
                    ang1 = Math.Acos(m);
                    if (y1 >y2)
                        ang1 = Math.PI*2  - ang1;//直線(x1,y1)-(x2,y2)與折X軸正向夾角的弧度
                }
                m = (xx - x1) / a;
                if (m - 1 > 0.00001)
                    m = 1;
                ang2 = Math.Acos(m);
                if (y1 > yy)
                    ang2 = Math.PI * 2 - ang2;//直線(x1,y1)-(xx,yy)與折X軸正向夾角的弧度
               
                ang = ang2 - ang1;
                if (ang < 0) ang = -ang;
               
                if (ang > Math.PI) ang = Math.PI * 2 - ang;
                //如果是鈍角則直接返回距離
                if (ang > Math.PI / 2)
                    return a;
                else
                    return a * Math.Sin(ang);
            }
            else//如果(xx,yy)到點(x2,y2)這條邊較短
            {
                //如果兩個點的縱座標相同，則直接得到直線斜率的弧度
                if (y1 == y2)
                    if (x1 < x2)
                        ang1 = Math.PI;
                    else
                        ang1 = 0;
                else
                {
                    m = (x1 - x2) / c;
                    if (m - 1 > 0.00001)
                        m = 1;
                    ang1 = Math.Acos(m);
                    if (y2 > y1)
                        ang1 = Math.PI * 2 - ang1;
                }
                m = (xx - x2) / b;
                if (m - 1 > 0.00001)
                    m = 1;
                ang2 = Math.Acos(m);//直線(x2-x1)-(xx,yy)斜率的弧度
                if (y2 > yy)
                    ang2 = Math.PI * 2 - ang2;
                ang = ang2 - ang1;
                if (ang < 0) ang = -ang;
                if (ang > Math.PI) ang = Math.PI * 2 - ang;//交角的大小
                //如果是對角則直接返回距離
                if (ang > Math.PI / 2)
                    return b;
                else
                    return b * Math.Sin(ang);//如果是銳角，返回計算得到的距離
            }

        }

JS版

<script type="text/javascript">
     function PointLine_Disp(xx, yy, x1, y1, x2, y2)
     {
        var a, b, c, ang1, ang2, ang, m;
            var result = 0;
            //分別計算三條邊的長度
            a = Math.sqrt((x1 - xx) * (x1 - xx) + (y1 - yy) * (y1 - yy));
            if (a == 0)
                return -1;
            b = Math.sqrt((x2 - xx) * (x2 - xx) + (y2 - yy) * (y2 - yy));
            if (b == 0)
                return -1;
            c = Math.sqrt((x1 - x2) * (x1 - x2) + (y1 - y2) * (y1 - y2));
            //如果線段是一個點則退出函式並返回距離
            if (c == 0)
            {
                result = a;
                return result;
            }
            //如果點(xx,yy到點x1,y1)這條邊短
            if (a < b)
            {
                //如果直線段AB是水平線。得到直線段AB的弧度
                if (y1 == y2)
                {
                    if (x1 < x2)
                        ang1 = 0;
                    else
                        ang1 = Math.PI;
                }
                else
                {
                    m = (x2 - x1) / c;
                    if (m - 1 > 0.00001)
                        m = 1;
                    ang1 = Math.acos(m);
                    if (y1 >y2)
                        ang1 = Math.PI*2  - ang1;//直線(x1,y1)-(x2,y2)與折X軸正向夾角的弧度
                }
                m = (xx - x1) / a;
                if (m - 1 > 0.00001)
                    m = 1;
                ang2 = Math.acos(m);
                if (y1 > yy)
                    ang2 = Math.PI * 2 - ang2;//直線(x1,y1)-(xx,yy)與折X軸正向夾角的弧度
               
                ang = ang2 - ang1;
                if (ang < 0) ang = -ang;
               
                if (ang > Math.PI) ang = Math.PI * 2 - ang;
                //如果是鈍角則直接返回距離
                if (ang > Math.PI / 2)
                    return a;
                else
                    return a * Math.sin(ang);
            }
            else//如果(xx,yy)到點(x2,y2)這條邊較短
            {
                //如果兩個點的縱座標相同，則直接得到直線斜率的弧度
                if (y1 == y2)
                    if (x1 < x2)
                        ang1 = Math.PI;
                    else
                        ang1 = 0;
                else
                {
                    m = (x1 - x2) / c;
                    if (m - 1 > 0.00001)
                        m = 1;
                    ang1 = Math.acos(m);
                    if (y2 > y1)
                        ang1 = Math.PI * 2 - ang1;
                }
                m = (xx - x2) / b;
                if (m - 1 > 0.00001)
                    m = 1;
                ang2 = Math.acos(m);//直線(x2-x1)-(xx,yy)斜率的弧度
                if (y2 > yy)
                    ang2 = Math.PI * 2 - ang2;
                ang = ang2 - ang1;
                if (ang < 0) ang = -ang;
                if (ang > Math.PI) ang = Math.PI * 2 - ang;//交角的大小
                //如果是對角則直接返回距離
                if (ang > Math.PI / 2)
                    return b;
                else
                    return b * Math.sin(ang);//如果是銳角，返回計算得到的距離
            }
     }


</script>

相關推薦

記錄一下演算法：點到線段的距離計算。

C#版 public double PointLine_Disp(double xx, double yy, double x1, double y1, double x2, double y2)        {            double a, b, c, ang

KNN演算法中常用的距離計算公式

　　KNN，英文全稱為K-nearst neighbor，中文名稱為K近鄰演算法，它是由Cover和Hart在1968年提出來的。 　　KNN演算法流程： 　　輸入：訓練資料集　　 T=(x1,y1),(x2,y2),...,(xN,yN) 　　其中，x

碰撞檢測演算法：點和矩形碰撞、矩形碰撞

以下程式碼Lua可直接除錯. 點與矩形碰撞 -- 點與矩形碰撞 function testPoint(x0,y0,w0,h0,x1,y1) return x1 >= x0 and x1 <= x0 + w0 and y1>=y0

記錄一下golang http-server的處理流程。

原始碼位於go標準庫的net/http/server.go中。 1：從入口點http.ListenAndServe跟程式碼 func (srv *Server) ListenAndServe() error { addr := srv.Addr //獲取地址

記錄一下這五天的學習mini2440。心酸呀

15年末購入了一塊ARM2440（因為聽說這塊板的資源多上手容易，確實是有問題上網一搜很容易找到相同的） 買的是FriendlyARM 一點都不友善的友善之臂  官網上的光碟資料不更新 ARM9論壇上也是沒客服沒大神幫忙解答，比較冷清。還有。。。（看下去就知道了） 放假玩

Python地理位置信息庫geopy的使用（二）：根據中心點坐標，方向，距離計算坐標

block 我們 code ram des int pri 經緯 kilo 上一篇文章我們介紹了geopy的基本使用，這一篇文章我們根據中心點坐標，方向，距中心點距離計算出對應的坐標點，這種用法官網並沒有給出詳細的文檔，我們這裏做一下說明 生成坐標點的具體方法 impor

計算幾何 平面最近點對 nlogn分治演算法 求平面中距離最近的兩點

本文全文原創 轉載請註明出處 http://blog.csdn.net/lytning/article/details/25370169 平面最近點對，即平面中距離最近的兩點 分治演算法： int SOLVE(int left,int right)//求解點集中區間[lef

Python地理位置資訊庫geopy的使用（二）：根據中心點座標，方向，距離計算座標

上一篇文章我們介紹了geopy的基本使用，這一篇文章我們根據中心點座標，方向，距中心點距離計算出對應的座標點，這種用法官網並沒有給出詳細的文件，我們這裡做一下說明 生成座標點的具體方法 import geopy.distance def get_dista

C++：點到線段的平面距離。點與點的平面距離。

LPoint是自己定義的點 //點（p0）  到線段（p1，p2）的距離 double GroundFilter::xj2DistancePointAndLine( LPoint p0, LPoint

UWP：記錄一下這幾天踩到的坑

upload bug 爆炸 文件夾 方法 空間 enable 怎麽 重裝系統 原文:UWP：記錄一下這幾天踩到的坑最近在玩微軟的Desktop Bridge項目，遇到了如下幾個坑： 1、文檔中給的是js項目魔改的方法，其實C#項目也可以魔改加入UWP部分的，區別在於：

計算幾何模板（點+線段）1.0

計算幾何 int cst opera str point col cstring 弧度 1 #include<cstdio> 2 #include<cstring> 3 #include<algorithm> 4 #in

知道兩個點的經緯度計算兩個點的距離

經緯度首先轉化為弧度 然後使用公式即可 1 private static double EARTH_RADIUS=6378.137; 2 private static double rad(double d) { 3 return d*Mat

點到平面的距離計算

點到平面的距離計算 如上圖所示，假設現在有一平面\(S\) \[ WX+b = 0 \] 其中\(W,X\)都是向量，現有平面外一點\(Q\)，求\(Q\)到平面的距離。 我們假設平面內有一點\(P\)，並且平面的法向量為\(\overrightarrow{n}=(W_1, W_2, \cdots, W

幾種排序演算法，記錄一下

個人也就會四種排序（bubble,select,insert,quick），哈哈，看官大人可能有點失望。自己也看過幾種，不過一直沒寫過其他的，就記錄下這四種吧。 程式碼均可直接通過編譯。各種版本實現都有出入，不過思想都是一樣。工作這麼久還沒有一次性完全寫正確過，功力還是差點。 #includ

HRV非線性分析PoincarePlot：SD1，SD2計算演算法

主旨 分析給出HRV非線性分析Poincare Plot中SD1和SD2的演算法 背景描述 Poincare Plot是HRV非線性分析的一種方法。對於一段連續的心跳間隔，將第i個心跳間隔作為橫座標，第(i+1)個心跳間隔作為縱座標，在二維平面可以畫出如下圖形[1]。這些點的分佈可以近似為橢圓

第11章：使用Apriori演算法進行關聯分析（計算頻繁項集）

目的：找到資料集中事務的關係，如超市中經常一起出現的物品集合，想找到支援度超過0.8的所有項集 概念： 頻繁項集：指經常出現在一起的物品集合； 關聯規則：指兩個物品之間可能存在很強的關係，如一個人買了什麼之後很大可能會買另一種東西； 支援度：資料集中包含該項集的記錄所佔的比例；保

Java架構-面試演算法：計算堆疊當前元素的最大值

有一道堆疊相關演算法題，我被面試過兩次以上，看似其在演算法面試中出現的概率很高，由此值得我們好好分析下。題目是這樣的： 對於堆疊的常用操作有, pop 彈出堆疊頂部的元素；push 向堆疊壓入一個元素；peek 獲得堆疊頂部的元素值，但不彈出堆疊。現在要去你增加一個操作max， 它的

Unity射線/右鍵點選某一點會使物體跟隨至滑鼠點選位置/計算目標物體距離滑鼠點選位置的距離

public class MyRay : MonoBehaviour { public GameObject GameObject;//要例項化的物體 粒子特效 public GameObject Player; private Animation ani;

記錄一個演算法題（java程式碼）：統計正整數n的二進位制寫法中有多少個1

package ludims.main; import java.util.Scanner; public class myMain {     public static void main(String[] args) {         System.out.pri

寫點什麽...記錄一下學習過程中的心路歷程

方法 展開 這不 這才 遊戲視頻 畫面 思維 相互 摩擦 　　講真"好腦子比不上爛筆頭"這句話讓我產生了深深的認同感... 　　Python自學已經一個多月了,天天在視頻,書本的連環轟炸下,稀裏糊塗的記住了不少的東西,擺脫了看代碼兩眼一抹黑的尷尬境遇.各種結構驚奇的代碼