Mouse code for the MacroRat
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?
User | Revision | Line number | New 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 | } |