MacroRat / MouseCode

Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

irpair.cpp

Committer:
kyleliangus
Date:
2017-05-26
Revision:
32:69acb14778ea
Parent:
29:ec2c5a69acd6
Child:
33:68ce1f74ab5f

File content as of revision 32:69acb14778ea:

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

//Ticker toggleIr;

#define dark_samples 10
#define busy_wait 10

void IRPair::calibrateSensor() {

    ir.write( 1 );
    wait_us(55);

    for (int i = 0; i < samplesToTake; ++i) 
        sensorAvg += recv.read();
        
    ir.write( 0 );
    sensorAvg /= samplesToTake;
    wait_us(5);
}

double IRPair::getSamples( int samples )
{
    double z = 0;
    
    ir.write( 0 );
    //for( int i = 0; i < dark_samples; i++ )
    //    z1 += recv.read();
    
    ir.write( 1 );
    wait_us(55);
    
    for( int i = 0; i < samples; ++i )
        z += recv.read();
    ir.write( 0 );
    wait_us(5);
    return z / samples;
}