计算汽车行驶的方向

2019-12-24 12:51:14 阅读：307 来源： 互联网

1．场景：已知汽车行驶过程中的2个GPS坐标点A（n1,e1），B(e)，计算它行驶的方向。

2. 分析：如上图所示，知道了两个点A、B，可以假设一个C点，让三个点构成一个直角三角形。现在可以知道，A，B，C三点的GPS坐标就很容易求出三个角的对边长度a,b,c(参考计算两个GPS坐标的距离)。根据余弦定下CosB=(a²+c²-b²)/2ac,就可以求出CosB的值。

3.C#实现代码。

计算汽车行驶的方向 

Code highlighting produced by Actipro CodeHighlighter (freeware)http://www.CodeHighlighter.com/--> /// <summary>
     ///计算两点GPS坐标的距离
     /// </summary>
     /// <param name="n1">第一点的纬度坐标</param>
     /// <param name="e1">第一点的经度坐标</param>
     /// <param name="n2">第二点的纬度坐标</param>
     /// <param name="e2">第二点的经度坐标</param>
     /// <returns></returns>
        public static double Distance(double n1, double e1, double n2, double e2)
        {
            double jl_jd = 102834.74258026089786013677476285;
            double jl_wd = 111712.69150641055729984301412873;
            double b = Math.Abs((e1 - e2) * jl_jd);
            double a = Math.Abs((n1 - n2) * jl_wd);
            return Math.Sqrt((a * a + b * b));

        }
       /// <summary>
       /// 已知汽车行驶的两个GPS点，求汽车行驶的方向
       /// </summary>
       /// <param name="n1">第一个GPS点纬度</param>
        /// <param name="e1">第一个GPS点经度</param>
        /// <param name="n2">第二个GPS点纬度</param>
        /// <param name="e2">第二个GPS点经度</param>
       /// <returns></returns>
        public static double GetBusDirection( double n1,double e1, double n2, double e2)
        {

            double e3 = 0;
            double n3 = 0;
            e3 = e1 + 0.005;
            n3 = n1;
            double a = 0;
            double b = 0;
            double c = 0;
            a = Distance(e1, n1, e3, n3);
            b = Distance(e3, n3, e2, n2);
            c = Distance(e1, n1, e2, n2);
            double cosB = 0;
            if ((a * c) != 0)
            {
                cosB = (a * a + c * c - b * b) / (2 * a * c);
            }
            double B = Math.Acos(cosB) * 180 / Math.PI;

            if(n2<n1)
            {
                B=180+(180-B);
            }

            return B;

        }

标签：double,行驶,坐标,计算,方向,n1,n2,e1,GPS
来源： https://www.cnblogs.com/wt88/p/12090881.html

本站声明： 1. iCode9 技术分享网（下文简称本站）提供的所有内容，仅供技术学习、探讨和分享；
2. 关于本站的所有留言、评论、转载及引用，纯属内容发起人的个人观点，与本站观点和立场无关；
3. 关于本站的所有言论和文字，纯属内容发起人的个人观点，与本站观点和立场无关；
4. 本站文章均是网友提供，不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属；如您发现该文章侵犯了您的权益，可联系我们第一时间进行删除；
5. 本站为非盈利性的个人网站，所有内容不会用来进行牟利，也不会利用任何形式的广告来间接获益，纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。

ICode9

计算汽车行驶的方向