欢迎您访问程序员文章站本站旨在为大家提供分享程序员计算机编程知识!
您现在的位置是: 首页  >  IT编程

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

程序员文章站 2022-03-26 08:36:13
本文实例分析了c#计算汽车行驶方向的方法。分享给大家供大家参考,具体如下: 1.  场景:已知汽车行驶过程中的2个gps坐标点a(n1,e1),b(e),计算它...

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

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

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

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#相关内容感兴趣的读者可查看本站专题:《c#字符串操作技巧总结》、《c#数组操作技巧总结》、《c#中xml文件操作技巧汇总》、《c#常见控件用法教程》、《c#程序设计之线程使用技巧总结》、《c#操作excel技巧总结》、《winform控件用法总结》、《c#数据结构与算法教程》及《c#面向对象程序设计入门教程

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