bio robot

Dependencies:   MPU6050-DMP QEI_hw mbed-rpc mbed

Fork of MPU6050_Example by Shundo Kishi

main.cpp

Committer:
amandaghassaei
Date:
2015-12-03
Revision:
4:ebb882658c50
Parent:
3:be5cf450436d
Child:
5:c3d671959ef3

File content as of revision 4:ebb882658c50:

#include "mbed.h"
#include "mbed_rpc.h"

#include "MyMPU6050.h"    
#include "Gains.h"
#include "Target.h"

#include "Comm.h"

void ReadRange(Arguments* input, Reply* output);
RPCFunction RangeFinder(&ReadRange, "RangeFinder");

Gains gains;
Target target;

MyMPU6050 myMPU6050_1(p9, p10);//I2C_SDA, I2C_SCL

Comm comm(&gains, &target, &myMPU6050_1);

int main() {
    
    while(1) {
        myMPU6050_1.loop();
//        comm.printTarget();
        comm.check();
    }
}

void ReadRange(Arguments* input, Reply* output){
    for (int i=0; i < input->argc; i++){
        comm._pc.printf("argv[%1d] = %s \n",i,input->argv[i]);
    }
    
    comm._pc.printf("serialdjfjsldkj");
    //Format the output of the srf08 into the output string
//    sprintf(output, "%f", srf08.read());
}