Diff: main.cpp

Revision:

15:9c52d5529b9d

Parent:

14:a1fa75a002f6

Child:

16:3d2684da4695

diff -r a1fa75a002f6 -r 9c52d5529b9d main.cpp
--- a/main.cpp	Wed Sep 06 02:59:57 2017 +0000
+++ b/main.cpp	Fri Sep 08 22:46:48 2017 +0000
@@ -1,25 +1,42 @@
 #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);
+
 
 int main()
 {
-    myled = 1;
-    wait(0.5);
-    myled = 0;
-    wait(0.5);
+    int i = 0,rcmd=0,cmdflag=0;
+    
+    xbee.printf("Count Up!\r\n");
+    while(1) {
+        xbee.printf("num = %d\r\n",i);
+        i++;
+        wait(1.0);
+        xbee.xbee_recieve(&rcmd,&cmdflag);
+        pc.printf("rcmd=%d, cmdflag=%d\r\n",rcmd, cmdflag);
+        if (cmdflag == 1) {
+            if (rcmd == 'a') {
+                pc.printf("Command Get %d\r\n",rcmd);
+                xbee.printf("HEPTA Uplink OK\r\n");
+                pc.printf("===================\r\n");
+                pc.printf("Accel sensing Mode\r\n");
+                pc.printf("===================\r\n");
+                for(int ii = 0; ii < 10; ii++) {
+                    n_axis.sen_acc(&ax,&ay,&az);
+                    battery.vol(&bt);
+                    
+                    
+                    
+                    
+                    wait(0.5);
+                }
+            }
+            xbee.initialize();
+        }
+    }
 }
\ No newline at end of file