C#计算汽车行驶方向 C#计算汽车行驶方向的方法分析

时间:2021-03-22 ztp800201 人气:0

想了解C#计算汽车行驶方向的方法分析的相关内容吗，ztp800201在本文为您仔细讲解C#计算汽车行驶方向的相关知识和一些Code实例，欢迎阅读和指正，我们先划重点：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;
}

希望本文所述对大家C#程序设计有所帮助。

加载全部内容