Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

Revision:
6:3d68fedd6fd9
Parent:
5:7e1e4cc19044
Child:
9:1d8e4da058cd
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/irpair.cpp	Thu May 04 21:38:20 2017 +0000
@@ -0,0 +1,57 @@
+#include "irpair.h"
+#include "mbed.h"
+
+void IRPair::calibrateSensor() {
+
+    for (int i = 0; i < samplesToTake; ++i) 
+        sensorAvg += recv.read();
+        
+    sensorAvg /= samplesToTake;
+}
+
+float IRPair::getSamples( int samples )
+{
+    float z = 0;
+    ir.write( 1 );
+    for( int i = 0; i < samples; ++i )
+        z += recv.read();
+    ir.write( 0 );
+    return z / samples;
+}
+
+/*
+inline float IrLED::blinkLED( int i, int samples )
+{
+    float z = 0;
+    if( i == 1 )
+    {
+        IR_LED1.write(1);
+        for( int j = 0; j < samples; j++ )
+            z += IR_Sensor1.read();
+        IR_LED1.write(0);
+    }
+    if( i == 2 )
+    {
+        IR_LED2.write(1);
+        for( int j = 0; j < samples; j++ )
+            z += IR_Sensor2.read();
+        IR_LED2.write(0);
+    }
+    if( i == 3 )
+    {
+        IR_LED3.write(1);   
+        for( int j = 0; j < samples; j++ )
+            z += IR_Sensor3.read();
+        IR_LED4.write(0);
+    }
+    if( i == 4 )
+    {
+        IR_LED4.write(1);
+        for( int j = 0; j < samples; j++ )
+            z += IR_Sensor4.read();
+        IR_LED4.write(0);
+    }
+    if( DEBUGGING )
+        serial.println( "Sample by IR %d: %f\n", i, z );
+    return z / samples;
+}*/
\ No newline at end of file