Ermis Gasetopulos / m3pi_TUB2

Fork of m3pi_TUB by TUB-MRT

Revision:
16:8c1f1622ce81
Parent:
12:78fd82b3fb09
--- a/m3pi_ng.cpp	Wed Jul 22 12:43:54 2015 +0000
+++ b/m3pi_ng.cpp	Sat Jan 30 22:26:00 2016 +0000
@@ -245,6 +245,22 @@
     return(_ser.getc());
 }
 
+void m3pi::readsensor (int *sensor){
+   
+   _ser.putc(SEND_CALIBRATED_SENSOR_VALUES);  
+    sensor[0] = _ser.getc();
+    sensor[0] += _ser.getc() << 8;
+    sensor[1] = _ser.getc();
+    sensor[1] += _ser.getc() << 8;
+    sensor[2] = _ser.getc();
+    sensor[2] += _ser.getc() << 8;
+    sensor[3] = _ser.getc();
+    sensor[3] += _ser.getc() << 8;
+    sensor[4] = _ser.getc();
+    sensor[4] += _ser.getc() << 8;
+  
+    return;
+}