zoukankan      html  css  js  c++  java
  • 计算汽车行驶的方向

    1.  场景:已知汽车行驶过程中的2GPS坐标点An1,e1),B(e),计算它行驶的方向。

    2. 分析:如上图所示,知道了两个点A、B,可以假设一个C点,让三个点构成一个直角三角形。现在可以知道,A,B,C三点的GPS坐标就很容易求出三个角的对边长度a,b,c(参考计算两个GPS坐标的距离)。根据余弦定下CosB=(a2+c2-b2)/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;
    
            }
  • 相关阅读:
    What version of .NET Framework is integrated into what version of OS?
    《千字文》古今第一文,1000字无重复,囊括各个方面的知识!
    这些习惯正在阻碍你的成长(你正在做。。。)
    百家讲坛另附笔记
    百家讲坛之曾国藩笔记
    《挪威的森林》经典语录
    《悲伤逆流成河》台词摘抄
    2018年11月29日,晴
    关于描述的一些感悟
    2018年11月27日, 晴
  • 原文地址:https://www.cnblogs.com/wt88/p/12090881.html
Copyright © 2011-2022 走看看