GPSとXbeeの統合

Dependencies:   mbed

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;
     }