Diff: main.cpp

Revision:

10:cb7a807b5225

Parent:

7:cabeef41022a

Child:

12:2109a8bc8848

--- a/main.cpp	Thu Jun 20 15:39:46 2019 +0000
+++ b/main.cpp	Sat Jun 22 12:01:28 2019 -0300
@@ -2,41 +2,40 @@
 #include "mbed.h"
 
 #include "sgam_mdw.h"
+
+#define LOG(args...)   printf(args)  
+
 #include "ControlImpl.h"
 #include "Gyroscope.h"
 
 ControlImpl ctrl;
 
 int main() {
-    printf("=============== INICIO ===============\r\n");
+    LOG("=============== INICIO ===============\r\n");
 
     Control* control = ctrl.getControler();
 
     control->initialize();
-    
-    // Sensor<float>* temp = (Sensor<float>*) control->getSensor((char*)"Temperature");
+    int count = 0;
+
+    Sensor<float>* temp = (Sensor<float>*) control->getSensor("Temperature");
+    Sensor<GyroscopeData>* gyro = (Sensor<GyroscopeData>*) control->getSensor("Gyroscope");
     
-    // int count = 0;
-    // while( count++ < 10) {
-    //     float* f = temp->getValue();
-    //     printf("Temperatura => %f \r\n", *f);
-    //     wait(1);
-    // }
+    while( count++ < 10) {
+        float* f = temp->getValue();
+        LOG("Temperatura => %f \r\n", *f);
 
-    Sensor<GyroscopeData>* gyro = (Sensor<GyroscopeData>*) control->getSensor((char*)"Gyroscope");
-    
-    int count = 0;
-    while( count++ < 10) {
         GyroscopeData* data = gyro->getValue();
         
-        printf("Gyro (X) => %d \r\n", data->gx);
-        printf("Gyro (Y) => %d \r\n", data->gy);
-        printf("Gyro (Z) => %d \r\n", data->gz);
-        printf("***********************************\r\n");
+        LOG("Gyro (X) => %d \r\n", data->gx);
+        LOG("Gyro (Y) => %d \r\n", data->gy);
+        LOG("Gyro (Z) => %d \r\n", data->gz);
+        LOG("***********************************\r\n");
 
         wait(1);
     }
 
-    printf("=============== FINAL ===============\r\n");
+    control->finalize();
+    LOG("=============== FINAL ===============\r\n");
     return 1;
 }