Diff: m3pi.cpp

Revision:

5:847e6cbd458b

Parent:

4:0abe81f5d9fd

Child:

6:39daa09102a0

--- a/m3pi.cpp	Mon Jun 26 11:09:40 2017 +0000
+++ b/m3pi.cpp	Thu Jun 29 09:25:07 2017 +0000
@@ -61,17 +61,30 @@
 {
     char vals[10];                      // array to receive 10 byte return message
     _serial->putc(0x87);                // send command
-
-    int n=0;
-    while ( _serial->readable() ) {     // keep looping while data on rx line
-        vals[n] = _serial->getc();      // read into array
-        n++;                            // increment index
+    
+    while (_serial->readable() == 0) {
+        
     }
-
+    
+    for (int i=0; i < 10; i++) {
+        vals[i] =  _serial->getc();   
+    }
+    
     for(int i=0; i<5; i++) {            // construct the 2-byte values
         values[i] = (vals[2*i+1] << 8) | vals[2*i];
     }
 
+    //int n=0;
+    //while ( _serial->readable() ) {     // keep looping while data on rx line
+    //    vals[n] = _serial->getc();      // read into array
+    //    n++;                            // increment index
+    //}
+
+    //for(int i=0; i<5; i++) {            // construct the 2-byte values
+    //    values[i] = (vals[2*i+1] << 8) | vals[2*i];
+    //}
+    
+    //wait_ms(1);
 }
 
 float m3pi::get_trimpot_value()