bio robot
Dependencies: MPU6050-DMP QEI_hw mbed-rpc mbed
Fork of MPU6050_Example by
main.cpp@2:17b18ea93551, 2015-12-03 (annotated)
- Committer:
- amandaghassaei
- Date:
- Thu Dec 03 02:23:34 2015 +0000
- Revision:
- 2:17b18ea93551
- Parent:
- 1:ec0a08108442
- Child:
- 3:be5cf450436d
delegate stuff working;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
syundo0730 | 0:8d2c753a96e7 | 1 | |
amandaghassaei | 2:17b18ea93551 | 2 | #include "MyMPU6050.h" |
amandaghassaei | 2:17b18ea93551 | 3 | #include "Gains.h" |
amandaghassaei | 2:17b18ea93551 | 4 | #include "Target.h" |
syundo0730 | 0:8d2c753a96e7 | 5 | |
amandaghassaei | 2:17b18ea93551 | 6 | #include "Comm.h" |
amandaghassaei | 2:17b18ea93551 | 7 | #include "SerialRPCInterface.h" |
syundo0730 | 0:8d2c753a96e7 | 8 | |
syundo0730 | 0:8d2c753a96e7 | 9 | |
amandaghassaei | 2:17b18ea93551 | 10 | Gains gains; |
amandaghassaei | 2:17b18ea93551 | 11 | Target target; |
syundo0730 | 0:8d2c753a96e7 | 12 | |
amandaghassaei | 2:17b18ea93551 | 13 | MyMPU6050 myMPU6050_1(p9, p10);//I2C_SDA, I2C_SCL |
syundo0730 | 0:8d2c753a96e7 | 14 | |
amandaghassaei | 2:17b18ea93551 | 15 | SerialRPCInterface RPC(USBTX, USBRX); |
syundo0730 | 0:8d2c753a96e7 | 16 | |
amandaghassaei | 2:17b18ea93551 | 17 | DigitalOut myled(LED1); |
amandaghassaei | 2:17b18ea93551 | 18 | DigitalOut myled2(LED2); |
syundo0730 | 0:8d2c753a96e7 | 19 | |
amandaghassaei | 2:17b18ea93551 | 20 | volatile bool ledstate = 1; |
amandaghassaei | 2:17b18ea93551 | 21 | void ReadRange(char * input, char * output); |
amandaghassaei | 2:17b18ea93551 | 22 | void ReadRange(char * input, char * output){ |
amandaghassaei | 2:17b18ea93551 | 23 | //Format the output of the srf08 into the output string |
amandaghassaei | 2:17b18ea93551 | 24 | ledstate = 0; |
amandaghassaei | 2:17b18ea93551 | 25 | myled = 0; |
amandaghassaei | 2:17b18ea93551 | 26 | // comm.printTarget(); |
amandaghassaei | 2:17b18ea93551 | 27 | // output = "amanda"; |
amandaghassaei | 2:17b18ea93551 | 28 | } |
amandaghassaei | 2:17b18ea93551 | 29 | RPCFunction RangeFinder2(&ReadRange, "RangeFinder"); |
syundo0730 | 0:8d2c753a96e7 | 30 | |
amandaghassaei | 2:17b18ea93551 | 31 | Comm comm(&gains, &target, &myMPU6050_1); |
syundo0730 | 0:8d2c753a96e7 | 32 | |
syundo0730 | 0:8d2c753a96e7 | 33 | int main() { |
amandaghassaei | 2:17b18ea93551 | 34 | myled = 1; |
syundo0730 | 0:8d2c753a96e7 | 35 | while(1) { |
amandaghassaei | 2:17b18ea93551 | 36 | myMPU6050_1.loop(); |
amandaghassaei | 2:17b18ea93551 | 37 | myled2 = ledstate; |
amandaghassaei | 2:17b18ea93551 | 38 | // comm.printTarget(); |
syundo0730 | 0:8d2c753a96e7 | 39 | } |
syundo0730 | 0:8d2c753a96e7 | 40 | } |
syundo0730 | 0:8d2c753a96e7 | 41 | |
syundo0730 | 0:8d2c753a96e7 | 42 | |
syundo0730 | 0:8d2c753a96e7 | 43 |