计算汽车行驶的方向
2013-07-16 22:05
134 查看
1. 场景:已知汽车行驶过程中的2个GPS坐标点A(n1,e1),B(e),计算它行驶的方向。
2、分析:如上图所示,知道了两个点A、B点,让三个点构成一个直角三角形。现在可以知道,A,C坐标就很容易求出三个角的对边长度a,b,c(参考计算两个GPS坐标的距离)根据余弦定下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;
}
2、分析:如上图所示,知道了两个点A、B点,让三个点构成一个直角三角形。现在可以知道,A,C坐标就很容易求出三个角的对边长度a,b,c(参考计算两个GPS坐标的距离)根据余弦定下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#计算汽车行驶方向的方法分析
- 计算汽车行驶的方向
- 已知两点坐标,计算汽车行驶的方向【转】
- 算法:汽车在有里程标志的公路上行驶,从键盘输入开始和结束的里程及时间(以时、分、秒输入),计算并输出其平均速度(千米/小时)
- 自动驾驶汽车尚未成功:它还不能在雨中行驶 | 分析
- 【百度地图API】如何利用地图API制作汽车沿道路行驶的动画
- 2012年国家自然科学基金中标项目:云计算相关方向
- 发展方向 企业计算与嵌入式
- 用HTML和javascript(JS)计算触屏手机手指滑动方向的演示
- Unity3D研究院之主角面朝方向一定区域内对象角度计算
- 汽车加油行驶问题
- [CODEVS1912] 汽车加油行驶问题(分层图最短路)
- [创业中, 寻求合作] 业务方向:车联网智能终端;APP蓝牙控制汽车;APP网络远程控制汽车 (联系电话:18503086002)
- Matlab 沿三维任意方向切割CT图的仿真计算
- 方便的弹出视图,可随意定义箭头方向,自动计算位置
- 汽车加油行驶问题
- Unity3D研究院之主角面朝方向一定区域内对象角度计算
- 计算两点连线与X轴正方向的夹角
- 计算方框图像在0°到45°方向上的radon变换.m