Diff: main.cpp

Revision:

14:5e01368bf0fb

Parent:

13:a1fa75a002f6

Child:

16:beb20346067a

--- a/main.cpp	Wed Sep 06 02:59:57 2017 +0000
+++ b/main.cpp	Thu Sep 07 13:59:49 2017 +0000
@@ -1,25 +1,22 @@
 #include "mbed.h"
 #include "SDFileSystem.h"
-#include "HeptaXbee.h"
 #include "HeptaCamera_GPS.h"
-#include "Hepta9axis.h"
-#include "HeptaTemp.h"
-#include "HeptaBattery.h"
 
 Serial pc(USBTX,USBRX);
 SDFileSystem sd(p5, p6, p7, p8, "sd");
-HeptaXbee xbee(p9,p10);
-HeptaCamera_GPS cam_gps(p13, p14,p25,p24);
-Hepta9axis n_axis(p28,p27,0xD0,0x18);
-HeptaTemp temp(p17);
-HeptaBattery battery(p16,p26);
-
-DigitalOut myled(LED1);
+HeptaCamera_GPS cam_gps(p13, p14,p25,p24);//(tx,rx,camera switch,gps switch)
 
 int main()
 {
-    myled = 1;
-    wait(0.5);
-    myled = 0;
-    wait(0.5);
+    pc.baud(9600);
+    cam_gps.gps_setting();
+    int quality=0,stnum=0,gps_check=0;
+    char ns='A',ew='B',aunit='m';
+    float time=0.0,latitude=0.0,longitude=0.0,hacu=0.0,altitude=0.0;
+    for(int i=1; i<10; i++) {
+        cam_gps.gga_sensing(&time, &latitude, &ns, &longitude, &ew, &quality, &stnum, &hacu, &altitude, &aunit, &gps_check);
+        if((gps_check==0)|(gps_check==1)) {
+            pc.printf("GPGGA,%f,%f,%c,%f,%c,%d,%d,%f,%f,%c\r\n",time,latitude,ns,longitude,ew,quality,stnum,hacu,altitude,aunit);
+        }
+    }
 }
\ No newline at end of file