bio robot

Dependencies:   MPU6050-DMP QEI_hw mbed-rpc mbed

Fork of MPU6050_Example by Shundo Kishi

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?

UserRevisionLine numberNew 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