sae ichinose
/
GPSXbee-completed
GPSとXbeeの統合
gps.cpp
- Committer:
- KINU
- Date:
- 2019-10-30
- Revision:
- 1:c142b1682312
- Child:
- 2:639bfe0721a7
File content as of revision 1:c142b1682312:
#include "mbed.h" #include "getGPS.h" #include "math.h" Serial pc(USBTX,USBRX); GPS gps (p27,p28); int main() { double a; double b; double c; double d; double distance; pc.printf("GPS Start\n"); while(1) { if(gps.getgps()) { a = gps.latitude; b = gps.longitude; pc.printf("(%lf,%lf)\n\r",gps.latitude,gps.longitude);//緯度と経度を表示 break; } else { pc.printf("NO DATA\r\n");//データ取得失敗 wait(1); } } while(1) { if(gps.getgps()) { c = gps.latitude; d = gps.longitude; pc.printf("(%lf,%lf)\n\r",gps.latitude,gps.longitude);//緯度と経度を表示 distance =6370*cos(sin(a)*sin(c)+cos(a)*cos(c)*cos(b-d)); if (distance<5) { }else { pc.printf("5m clear!"); break; } }else{ pc.printf("NO DATA\r\n");//データ取得失敗 wait(1); } } return 0; }