Mouse code for the MacroRat
Diff: irpair.cpp
- 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