Polybot / m3piBluetooth

m3pi publish

Fork of m3pi by Chris Styles

Files at this revision

API Documentation at this revision

Revision 9:b2df3579590b, committed 2018-05-03

Comitter:
Maximousse
Date:
Thu May 03 12:57:40 2018 +0000
Parent:
8:4b7d6ea9b35b
Commit message:
commit m3pi;

Changed in this revision

m3pi.cpp Show annotated file Show diff for this revision Revisions of this file
m3pi.h Show annotated file Show diff for this revision Revisions of this file 
diff -r 4b7d6ea9b35b -r b2df3579590b m3pi.cpp
--- 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());

diff -r 4b7d6ea9b35b -r b2df3579590b m3pi.h
--- a/m3pi.h	Thu May 12 13:26:37 2011 +0000
+++ b/m3pi.h	Thu May 03 12:57:40 2018 +0000
@@ -30,6 +30,7 @@
 #include "rpc.h"
 #endif
 
+#define SEND_CALIB_SENSOR_VALUES 0x87
 #define SEND_SIGNATURE 0x81
 #define SEND_RAW_SENSOR_VALUES 0x86
 #define SEND_TRIMPOT 0xB0
@@ -169,7 +170,7 @@
      *
      */
     char sensor_auto_calibrate (void);
-
+    void m3pi::calibrated_sensors(unsigned short ltab[5]);
     /** Set calibration manually to the current settings.
      *
      */