Diff: gps.cpp

Revision:

68:fc357095c8ef

Parent:

67:17addc7bf8c2

--- a/gps.cpp	Fri Mar 12 13:33:06 2021 +0000
+++ b/gps.cpp	Fri Mar 26 13:43:43 2021 +0000
@@ -611,6 +611,15 @@
     //printf ("gps lat=%d lon=%d \n",Data.lat ,Data.lon );
     //lat=Data.lat;
     //lon=Data.lon;
+        if(Data.year !=0){
+    pc.printf("<g%d,%d>\n", (int)Data.lat, (int)Data.lon);
+    pc.printf("<t%d/%d/%d-%d:%d:%d>\n", (int)Data.year, (int)Data.month,(int)Data.day, (int)Data.hour, (int)Data.min, (int)Data.sec);
+        }
+    else{
+        pc.printf("location not found!\n");
+        }
+    
+    
 }
 
 void gps_get_lat_lon(int *latitude, int *logitude){
@@ -662,5 +671,22 @@
     }
 
 gps_navPVT get_struct(){
-    return Pac;
+    uint8_t packet_nav_pvt[] = {    0xB5,   0x62,   0x01,   0x07,   0x00,   0x00,   0x08,   0x19};
+    
+    //=============envia pacote nav pvt
+    for ( int i=0; i< sizeof(packet_nav_pvt) ; i++){
+        spi_2.write(packet_nav_pvt[i]);
+        wait_ms(20);
+    }
+    
+    gps_navPVT Data = le_nav_pvt();
+    
+    if(Data.year !=0){
+    pc.printf("<g%d,%d>\n", (int)Data.lat, (int)Data.lon);
+    pc.printf("<t%d/%d/%d-%d:%d:%d>\n", (int)Data.year, (int)Data.month,(int)Data.day, (int)Data.hour, (int)Data.min, (int)Data.sec);
+        }
+    else{
+        pc.printf("location not found!");
+        }
+    return Data;
     }
\ No newline at end of file