Diff: main.cpp

Revision:

17:f4fd402f8e93

Parent:

13:a1fa75a002f6

Child:

19:62ab01e42129

--- a/main.cpp	Fri Nov 17 02:10:06 2017 +0000
+++ b/main.cpp	Wed Aug 08 10:41:54 2018 +0000
@@ -1,25 +1,71 @@
 #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);
+DigitalOut myleds[] = {LED1,LED2,LED3,LED4};;
+
+int rcmd = 0,cmdflag = 0;
+
+void commandget()
+{
+    rcmd=pc.getc();
+    cmdflag = 1;
+}
+void receive(int *xrcmd, int *xcmdflag)
+{
+    pc.attach(commandget,Serial::RxIrq);
+    *xrcmd = rcmd;
+    *xcmdflag = cmdflag;
+}
+
+void initialize()
+{
+    rcmd = 0;
+    cmdflag = 0;
+}
 
 int main()
 {
-    myled = 1;
-    wait(0.5);
-    myled = 0;
-    wait(0.5);
+    pc.baud(9600);
+    float bt;
+    int flag = 0;
+    char str[100];
+    while(1) {
+        battery.vol(&bt);
+        if(bt <= 3.5) {
+            battery.shut_down_regulator();
+            flag = 1;
+        } else {
+            battery.turn_on_regulator();
+            flag = 0;
+        }
+        pc.printf("Vol = %.2f [V]\r\n",bt);
+        if(flag == 1) {
+            pc.printf("Power saving mode ON\r\n");
+        }
+        wait(0.5);
+        receive(&rcmd,&cmdflag);
+        if (cmdflag == 1) {
+            pc.printf("Command Get = %d\r\n",rcmd);
+            if (rcmd == 'a') {
+                for(int i = 0; i < 10; i++) {
+                    pc.printf("Count = %d\r\n",i);
+                    wait(1.0);
+                }
+            }
+            if (rcmd == 'b') {
+                
+                
+                
+                
+                
+                
+            }
+            initialize();
+        }
+    }
 }
\ No newline at end of file