Diff: main.cpp

Revision:

1:8faddee0e52f

Parent:

0:38b6065539a0

Child:

2:e9d928fd327a

--- a/main.cpp	Sat Sep 28 16:27:37 2019 +0000
+++ b/main.cpp	Sat Sep 28 22:29:57 2019 +0000
@@ -1,33 +1,19 @@
-/* mbed Microcontroller Library
- * Copyright (c) 2018 ARM Limited
- * SPDX-License-Identifier: Apache-2.0
- */
+#include "sm_esc.h"
 
-#include "mbed.h"
-#include "ThisThread.h"
-#include "stats_report.h"
-
-DigitalOut led1(LED1);
-
-#define SLEEP_TIME                  500 // (msec)
-#define PRINT_AFTER_N_LOOPS         20
+int main() {
 
-// main() runs in its own thread in the OS
-int main()
-{
-    SystemReport sys_state( SLEEP_TIME * PRINT_AFTER_N_LOOPS /* Loop delay time in ms */);
+    initGPIOs();
+    init_interruptions();
+    
+    //init state machines
+    pc.printf("init state machines");
+    
+    init_sm_esc();
+    
+    while(1) {
 
-    int count = 0;
-    while (true) {
-        // Blink LED and wait 0.5 seconds
-        led1 = !led1;
-        ThisThread::sleep_for(SLEEP_TIME);
-
-        if ((0 == count) || (PRINT_AFTER_N_LOOPS == count)) {
-            // Following the main thread wait, report on the current system status
-            sys_state.report_state();
-            count = 0;
-        }
-        ++count;
+        update_sm_esc();
+        
+        output_sm_esc();
     }
 }