Mouse code for the MacroRat
irled.cpp@4:b5b7836ca2b0, 2017-04-28 (annotated)
- Committer:
- kyleliangus
- Date:
- Fri Apr 28 02:13:24 2017 +0000
- Revision:
- 4:b5b7836ca2b0
- Child:
- 5:7e1e4cc19044
Added Modularity, Motors
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
kyleliangus | 4:b5b7836ca2b0 | 1 | #include "irled.h" |
kyleliangus | 4:b5b7836ca2b0 | 2 | #include "mbed.h" |
kyleliangus | 4:b5b7836ca2b0 | 3 | |
kyleliangus | 4:b5b7836ca2b0 | 4 | void IrLed::calibrateSensor() { |
kyleliangus | 4:b5b7836ca2b0 | 5 | |
kyleliangus | 4:b5b7836ca2b0 | 6 | for (int i = 0; i < samplesToTake; ++i) |
kyleliangus | 4:b5b7836ca2b0 | 7 | sensorAvg += ir.read(); |
kyleliangus | 4:b5b7836ca2b0 | 8 | |
kyleliangus | 4:b5b7836ca2b0 | 9 | sensorAvg /= samplesToTake; |
kyleliangus | 4:b5b7836ca2b0 | 10 | } |
kyleliangus | 4:b5b7836ca2b0 | 11 | |
kyleliangus | 4:b5b7836ca2b0 | 12 | float IrLed::getSamples( int samples ) |
kyleliangus | 4:b5b7836ca2b0 | 13 | { |
kyleliangus | 4:b5b7836ca2b0 | 14 | float z = 0; |
kyleliangus | 4:b5b7836ca2b0 | 15 | for( int i = 0; i < samples; ++i ) |
kyleliangus | 4:b5b7836ca2b0 | 16 | z += ir.read(); |
kyleliangus | 4:b5b7836ca2b0 | 17 | return z / samples; |
kyleliangus | 4:b5b7836ca2b0 | 18 | } |
kyleliangus | 4:b5b7836ca2b0 | 19 | |
kyleliangus | 4:b5b7836ca2b0 | 20 | float IrLed::blinkLED( int i ) |
kyleliangus | 4:b5b7836ca2b0 | 21 | { |
kyleliangus | 4:b5b7836ca2b0 | 22 | return 0.0; |
kyleliangus | 4:b5b7836ca2b0 | 23 | } |
kyleliangus | 4:b5b7836ca2b0 | 24 | |
kyleliangus | 4:b5b7836ca2b0 | 25 | /* |
kyleliangus | 4:b5b7836ca2b0 | 26 | inline float IrLED::blinkLED( int i, int samples ) |
kyleliangus | 4:b5b7836ca2b0 | 27 | { |
kyleliangus | 4:b5b7836ca2b0 | 28 | float z = 0; |
kyleliangus | 4:b5b7836ca2b0 | 29 | if( i == 1 ) |
kyleliangus | 4:b5b7836ca2b0 | 30 | { |
kyleliangus | 4:b5b7836ca2b0 | 31 | IR_LED1.write(1); |
kyleliangus | 4:b5b7836ca2b0 | 32 | for( int j = 0; j < samples; j++ ) |
kyleliangus | 4:b5b7836ca2b0 | 33 | z += IR_Sensor1.read(); |
kyleliangus | 4:b5b7836ca2b0 | 34 | IR_LED1.write(0); |
kyleliangus | 4:b5b7836ca2b0 | 35 | } |
kyleliangus | 4:b5b7836ca2b0 | 36 | if( i == 2 ) |
kyleliangus | 4:b5b7836ca2b0 | 37 | { |
kyleliangus | 4:b5b7836ca2b0 | 38 | IR_LED2.write(1); |
kyleliangus | 4:b5b7836ca2b0 | 39 | for( int j = 0; j < samples; j++ ) |
kyleliangus | 4:b5b7836ca2b0 | 40 | z += IR_Sensor2.read(); |
kyleliangus | 4:b5b7836ca2b0 | 41 | IR_LED2.write(0); |
kyleliangus | 4:b5b7836ca2b0 | 42 | } |
kyleliangus | 4:b5b7836ca2b0 | 43 | if( i == 3 ) |
kyleliangus | 4:b5b7836ca2b0 | 44 | { |
kyleliangus | 4:b5b7836ca2b0 | 45 | IR_LED3.write(1); |
kyleliangus | 4:b5b7836ca2b0 | 46 | for( int j = 0; j < samples; j++ ) |
kyleliangus | 4:b5b7836ca2b0 | 47 | z += IR_Sensor3.read(); |
kyleliangus | 4:b5b7836ca2b0 | 48 | IR_LED4.write(0); |
kyleliangus | 4:b5b7836ca2b0 | 49 | } |
kyleliangus | 4:b5b7836ca2b0 | 50 | if( i == 4 ) |
kyleliangus | 4:b5b7836ca2b0 | 51 | { |
kyleliangus | 4:b5b7836ca2b0 | 52 | IR_LED4.write(1); |
kyleliangus | 4:b5b7836ca2b0 | 53 | for( int j = 0; j < samples; j++ ) |
kyleliangus | 4:b5b7836ca2b0 | 54 | z += IR_Sensor4.read(); |
kyleliangus | 4:b5b7836ca2b0 | 55 | IR_LED4.write(0); |
kyleliangus | 4:b5b7836ca2b0 | 56 | } |
kyleliangus | 4:b5b7836ca2b0 | 57 | if( DEBUGGING ) |
kyleliangus | 4:b5b7836ca2b0 | 58 | serial.println( "Sample by IR %d: %f\n", i, z ); |
kyleliangus | 4:b5b7836ca2b0 | 59 | return z / samples; |
kyleliangus | 4:b5b7836ca2b0 | 60 | }*/ |