sensory_array / Mbed 2 deprecated ymbed_haptic_belt_slave_onethread

Dependencies:   USBDevice mbed mbed-rtos

Revision:
4:91d5db5e8c9f
Parent:
3:6a249e8de7d8
Child:
5:301515ccaddc
--- a/main.cpp	Fri Mar 27 03:22:12 2015 +0000
+++ b/main.cpp	Fri Mar 27 14:36:29 2015 +0000
@@ -131,12 +131,12 @@
             //console1.printf(bluetoothData);
             //console1.printf("\n");
             processData(bluetoothData);
-            if(counter_ms % 3 == 0){
-                int num = bluetoothData[0] - '0';
-                console1.printf("Motor#: %d | ", num);
-                console1.printf("Intensity : %f | ", lraIntensity[num]);
-                console1.printf("lraOn : %d | ",lraOn_ms[num]);
-                console1.printf("lraPeriod : %d \n", lraPeriod_ms[num]);
+            int num = bluetoothData[0] - '0';
+            if(num == 1){
+                //console1.printf("Motor#: %d | ", num);
+                //console1.printf("Intensity : %f | ", lraIntensity[num]);
+                //console1.printf("lraOn : %d | ",lraOn_ms[num]);
+                //console1.printf("lraPeriod : %d \n", lraPeriod_ms[num]);
             }
         }
         for(int n=0;n<NUM_LRAS;n++){
@@ -157,12 +157,12 @@
                     lra_en[n] = 0; // no braking happening
                 }
             }
-            else {    
-                //if(n == 1){
-                //    leftToWait_ms[n] = lraPeriod_ms[n] - elapsed_ms[n];
-                //    console1.printf("leftToWait_ms[n] = %d\n",leftToWait_ms[n]);
-                //    console1.printf("elapsed_ms[n] = %d\n",elapsed_ms[n]);
-                //   }
+            else {
+                leftToWait_ms[n] = lraPeriod_ms[n] - elapsed_ms[n];    
+                if(n == 1){
+                    console1.printf("leftToWait_ms[n] = %d\n",leftToWait_ms[n]);
+                    console1.printf("elapsed_ms[n] = %d\n",elapsed_ms[n]);
+                   }
                 if(leftToWait_ms[n] < 0) {
                     console1.printf("Turning motor on\n");
                     isOn[n] = true;