add GPS functions

TinyGsmClientSIM808.h

@@ -722,10 +722,131 @@ public:
     
     
 /*
- * Starting GPS functions
+ * GPS location functions
  */
     
     
+    // enable GPS
+    boolean enableGPS() {
+        uint16_t state;
+        
+        sendAT(GF("+CGNSPWR=1"));
+        if (waitResponse() != 1) {
+            return false;
+        }
+        
+        return true;
+    }
+    
+    boolean disableGPS() {
+        uint16_t state;
+        
+        sendAT(GF("+CGNSPWR=0"));
+        if (waitResponse() != 1) {
+            return false;
+        }
+        
+        return true;
+    }
+    
+    // get the RAW GPS output
+    // works only with ans SIM808 V2
+    String getGPSraw() {
+        sendAT(GF("+CGNSINF"));
+        if (waitResponse(GF(GSM_NL "+CGNSINF:")) != 1) {
+            return "";
+        }
+        String res = stream.readStringUntil('\n');
+        waitResponse();
+        res.trim();
+        return res;
+    }
+    
+    // get GPS informations
+    // works only with ans SIM808 V2
+    boolean getGPS(float *lat, float *lon, float *speed=0, int *alt=0, int *vsat=0, int *usat=0) {
+        //String buffer = "";
+        char chr_buffer[12];
+        boolean fix = false;
+        
+        sendAT(GF("+CGNSINF"));
+        if (waitResponse(GF(GSM_NL "+CGNSINF:")) != 1) {
+            return false;
+        }
+        
+        stream.readStringUntil(','); // mode
+        if ( stream.readStringUntil(',').toInt() == 1 ) fix = true;
+        stream.readStringUntil(','); //utctime
+        *lat =  stream.readStringUntil(',').toFloat(); //lat
+        *lon =  stream.readStringUntil(',').toFloat(); //lon
+        if (alt != NULL) *alt =  stream.readStringUntil(',').toFloat(); //lon
+        if (speed != NULL) *speed = stream.readStringUntil(',').toFloat(); //speed
+        stream.readStringUntil(',');
+        stream.readStringUntil(',');
+        stream.readStringUntil(',');
+        stream.readStringUntil(',');
+        stream.readStringUntil(',');
+        stream.readStringUntil(',');
+        stream.readStringUntil(',');
+        if (vsat != NULL) *vsat = stream.readStringUntil(',').toInt(); //viewed satelites
+        if (usat != NULL) *usat = stream.readStringUntil(',').toInt(); //used satelites
+        stream.readStringUntil('\n');
+        
+        
+        waitResponse();
+        
+        return fix;
+    }
+    
+    // get GPS time
+    // works only with SIM808 V2
+    boolean getGPSTime(int *year, int *month, int *day, int *hour, int *minute, int *second) {
+        boolean fix = false;
+        char chr_buffer[12];
+        sendAT(GF("+CGNSINF"));
+        if (waitResponse(GF(GSM_NL "+CGNSINF:")) != 1) {
+            return false;
+        }
+        
+        
+        for (int i = 0; i < 3; i++) {
+            String buffer = stream.readStringUntil(',');
+            buffer.toCharArray(chr_buffer, sizeof(chr_buffer));
+            switch (i) {
+                case 0:
+                    //mode
+                    break;
+                case 1:
+                    //fixstatus
+                    if ( buffer.toInt() == 1 ) {
+                        fix = buffer.toInt();
+                    }
+                    break;
+                case 2:
+                    *year = buffer.substring(0,4).toInt();
+                    *month = buffer.substring(4,6).toInt();
+                    *day = buffer.substring(6,8).toInt();
+                    *hour = buffer.substring(8,10).toInt();
+                    *minute = buffer.substring(10,12).toInt();
+                    *second = buffer.substring(12,14).toInt();
+                    break;
+                    
+                default:
+                    // if nothing else matches, do the default
+                    // default is optional
+                    break;
+            }
+        }
+        String res = stream.readStringUntil('\n');
+        waitResponse();
+        
+        if (fix) {
+            return true;
+        } else {
+            return false;
+        }
+    }
+
 
 private: