乐码库:一个极速、放心、纯净的下载站! 更新: 资源发布
  • 您的位置:首页 > 技术文档 > C# > C#计算汽车行驶方向的方法分析
  • 收藏本页
      C#计算汽车行驶方向的方法分析
      发布时间:2016-12-21 08:03:28 关键词: C#,计算,汽车行驶方向
      内容简介:这篇文章主要介绍了C#计算汽车行驶方向的方法,结合实例形式分析了C#数值计算的原理与相关技巧,需要的朋友可以参考下

    本文实例分析了C#计算汽车行驶方向的方法。分享给大家供大家参考,具体如下:

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

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

    3.C#实现代码。

    /// <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;
    }
    
    
      最新更新
      热门排行榜