Polybot / m3piBluetooth

m3pi publish

Fork of m3pi by Chris Styles

Diff: m3pi.cpp

Revision:
9:b2df3579590b
Parent:
7:9b128cebb3c2
--- a/m3pi.cpp	Thu May 12 13:26:37 2011 +0000
+++ b/m3pi.cpp	Thu May 03 12:57:40 2018 +0000
@@ -112,6 +112,16 @@
     return(fpos);
 }
 
+
+void m3pi::calibrated_sensors(unsigned short ltab[5]) {
+    unsigned i;
+    _ser.putc(SEND_CALIB_SENSOR_VALUES);
+    for(i=0;i<5;i++){
+        ltab[i] = (unsigned short) _ser.getc();
+        ltab[i] += _ser.getc() << 8;
+    }
+}
+
 char m3pi::sensor_auto_calibrate() {
     _ser.putc(AUTO_CALIBRATE);
     return(_ser.getc());