Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

main.cpp

Committer:
christine222
Date:
2017-04-28
Revision:
3:880f15be8c72
Parent:
2:771db996cee0
Child:
4:b5b7836ca2b0

File content as of revision 3:880f15be8c72:

#include "mbed.h"
#include <stdlib.h>
#include "ITG3200.h"


DigitalOut redLed(PC_0);
DigitalOut blueLed(PC_1);
DigitalOut greenLed(PC_2);

DigitalOut IR_1(PB_1);
DigitalOut IR_2(PB_13);
DigitalOut IR_3(PB_0);
DigitalOut IR_4(PB_14);

AnalogIn Rec_1(PC_5);
AnalogIn Rec_2(PC_4);
AnalogIn Rec_3(PA_6);
AnalogIn Rec_4(PA_7);

Serial serial(PC_6, PC_7);

ITG3200 gyro(PC_9, PA_8);


volatile double reading = 0;

int gyroX = 0;
int gyroY = 0;
int gyroZ = 0;

int main()
{
    //Set highest bandwidth.
    gyro.setLpBandwidth(LPFBW_42HZ);
    serial.baud(9600);
       
    wait (0.1);
    
//    IR_1.write(1);
//    IR_2.write(1);
//    IR_3.write(1);
//    IR_4.write(1);

    redLed.write(1);
    greenLed.write(0);
    blueLed.write(1);
    
    while (1) {
        
        wait(0.1);
        serial.printf("%i, %i, %i\n", gyro.getGyroX(), gyro.getGyroY(), gyro.getGyroZ());
            
        //reading = Rec_4.read();
//        serial.printf("reading: %f\n", reading);
//        redLed.write(0);
//        wait_ms(1000);
//        redLed.write(1);
//        greenLed.write(0);
//        wait_ms(1000);
//        greenLed.write(1);
//        blueLed.write(0);
//        wait_ms(1000);
//        blueLed.write(1);
    }
}