Diff: akmsensormanager.cpp

Revision:

16:d85be9bafb80

Parent:

15:1238993fd75f

Child:

17:9abb7c28709c

--- a/akmsensormanager.cpp	Fri Oct 28 21:27:33 2016 +0000
+++ b/akmsensormanager.cpp	Wed Jan 04 00:52:30 2017 +0000
@@ -158,6 +158,9 @@
     return sensor;
 }
 
+        
+void AkmSensorManager::dummyCallbackForCommandReceived(){}
+
 AkmSensorManager::Status AkmSensorManager::commandReceived(char* buf){
     // Construct message
     Status status = SUCCESS;
@@ -168,7 +171,9 @@
         eventCommandReceived = false;
     }else{       
         eventCommandReceived = true;
+//        MSG("#Parsed message. %s\r\n", buf);
     }
+    t.attach(callback(this, &AkmSensorManager::dummyCallbackForCommandReceived),0); // wake-up from ble.waitForEvent
     return status;
 }
 
@@ -366,20 +371,21 @@
 AkmSensorManager::Status AkmSensorManager::processEvent()
 {
     AkmSensorManager::Status status = AkmSensorManager::SUCCESS;
-    
+   
     // command received from the host
     if(eventCommandReceived)
     {
+//        MSG("#Command received.\r\n");
         processCommand();
         eventCommandReceived = false;
     }
     if(sensor->isEvent())  // sensor read data event
     {
+//        MSG("#Sensor event received.\r\n");
         Message msg;
         if( sensor->readSensorData(&msg) != AkmSensor::SUCCESS) status = AkmSensorManager::ERROR;
         throwMessage(&msg);            
     }
-
     if(eventConnected)     // BLE connected. Start sensor.
     {
         eventConnected = false;