本文实例分析了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#实现代码。
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
|
/// <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#程序设计有所帮助。