GPS 测速器

切风40.83 · 发表于 2011-7-8 11:42

最近有点无聊，飞直升机航线飞得甚爽，估计我那只450速度被我弄到极限了，但是不知道到底有多快。先写下这个程序，放车上用接上电脑和车载GPS 比较下速度是否精确。两秒钟出一次数据。上网查了下，一度的距离是110公里。听说地球是椭圆的，如果要出精确的速度太复杂。明天看看效果再说。

void loop(){
  getGPS();
  lat = lat1;
  lon = lon1;
  getGPS();
  lat = lat2;
  lon = lon2;
dis = (110/3600) * sqrt((lat2-lat1)*(lat2-lat1) + (lon2 - lon1)*(lon2 - lon1));  // 速度计算
  Serial.print("speed");
  Serial.print(dis);
  Serial.println("km/h"); // 单位为KM/H

}