Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

irpair.cpp

Committer:
kyleliangus
Date:
2017-05-06
Revision:
9:1d8e4da058cd
Parent:
6:3d68fedd6fd9
Child:
15:b80555a4a8b9

File content as of revision 9:1d8e4da058cd:

#include "irpair.h"
#include "mbed.h"

void IRPair::calibrateSensor() {

    ir.write( 1 );

    for (int i = 0; i < samplesToTake; ++i) 
        sensorAvg += recv.read();
        
    ir.write( 0 );
    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;
}*/