MacroRat / MouseCode

Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

main.cpp@3:880f15be8c72, 2017-04-28 (annotated)

Committer:
christine222
Date:
Fri Apr 28 01:08:29 2017 +0000
Revision:
3:880f15be8c72
Parent:
2:771db996cee0
Child:
4:b5b7836ca2b0
added some gyro stuff

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sahilmgandhi 0:a03c771ab78e 1 #include "mbed.h"
sahilmgandhi 0:a03c771ab78e 2 #include <stdlib.h>
sahilmgandhi 1:8a4b2f573923 3 #include "ITG3200.h"
sahilmgandhi 0:a03c771ab78e 4
christine222 3:880f15be8c72 5
sahilmgandhi 0:a03c771ab78e 6 DigitalOut redLed(PC_0);
sahilmgandhi 0:a03c771ab78e 7 DigitalOut blueLed(PC_1);
sahilmgandhi 0:a03c771ab78e 8 DigitalOut greenLed(PC_2);
sahilmgandhi 0:a03c771ab78e 9
christine222 3:880f15be8c72 10 DigitalOut IR_1(PB_1);
christine222 3:880f15be8c72 11 DigitalOut IR_2(PB_13);
sahilmgandhi 1:8a4b2f573923 12 DigitalOut IR_3(PB_0);
sahilmgandhi 0:a03c771ab78e 13 DigitalOut IR_4(PB_14);
sahilmgandhi 0:a03c771ab78e 14
sahilmgandhi 1:8a4b2f573923 15 AnalogIn Rec_1(PC_5);
sahilmgandhi 1:8a4b2f573923 16 AnalogIn Rec_2(PC_4);
sahilmgandhi 1:8a4b2f573923 17 AnalogIn Rec_3(PA_6);
sahilmgandhi 1:8a4b2f573923 18 AnalogIn Rec_4(PA_7);
sahilmgandhi 1:8a4b2f573923 19
sahilmgandhi 1:8a4b2f573923 20 Serial serial(PC_6, PC_7);
sahilmgandhi 1:8a4b2f573923 21
sahilmgandhi 1:8a4b2f573923 22 ITG3200 gyro(PC_9, PA_8);
sahilmgandhi 0:a03c771ab78e 23
christine222 3:880f15be8c72 24
christine222 3:880f15be8c72 25 volatile double reading = 0;
christine222 3:880f15be8c72 26
christine222 3:880f15be8c72 27 int gyroX = 0;
christine222 3:880f15be8c72 28 int gyroY = 0;
christine222 3:880f15be8c72 29 int gyroZ = 0;
christine222 3:880f15be8c72 30
sahilmgandhi 0:a03c771ab78e 31 int main()
sahilmgandhi 0:a03c771ab78e 32 {
christine222 3:880f15be8c72 33 //Set highest bandwidth.
sahilmgandhi 1:8a4b2f573923 34 gyro.setLpBandwidth(LPFBW_42HZ);
christine222 3:880f15be8c72 35 serial.baud(9600);
christine222 3:880f15be8c72 36
sahilmgandhi 1:8a4b2f573923 37 wait (0.1);
christine222 3:880f15be8c72 38
christine222 3:880f15be8c72 39 // IR_1.write(1);
sahilmgandhi 2:771db996cee0 40 // IR_2.write(1);
sahilmgandhi 2:771db996cee0 41 // IR_3.write(1);
sahilmgandhi 2:771db996cee0 42 // IR_4.write(1);
christine222 3:880f15be8c72 43
sahilmgandhi 2:771db996cee0 44 redLed.write(1);
sahilmgandhi 2:771db996cee0 45 greenLed.write(0);
sahilmgandhi 2:771db996cee0 46 blueLed.write(1);
sahilmgandhi 1:8a4b2f573923 47
christine222 3:880f15be8c72 48 while (1) {
christine222 3:880f15be8c72 49
christine222 3:880f15be8c72 50 wait(0.1);
christine222 3:880f15be8c72 51 serial.printf("%i, %i, %i\n", gyro.getGyroX(), gyro.getGyroY(), gyro.getGyroZ());
christine222 3:880f15be8c72 52
christine222 3:880f15be8c72 53 //reading = Rec_4.read();
christine222 3:880f15be8c72 54 // serial.printf("reading: %f\n", reading);
sahilmgandhi 1:8a4b2f573923 55 // redLed.write(0);
sahilmgandhi 1:8a4b2f573923 56 // wait_ms(1000);
sahilmgandhi 1:8a4b2f573923 57 // redLed.write(1);
sahilmgandhi 1:8a4b2f573923 58 // greenLed.write(0);
sahilmgandhi 1:8a4b2f573923 59 // wait_ms(1000);
sahilmgandhi 1:8a4b2f573923 60 // greenLed.write(1);
sahilmgandhi 1:8a4b2f573923 61 // blueLed.write(0);
sahilmgandhi 1:8a4b2f573923 62 // wait_ms(1000);
sahilmgandhi 1:8a4b2f573923 63 // blueLed.write(1);
christine222 3:880f15be8c72 64 }
sahilmgandhi 0:a03c771ab78e 65 }