Read IMU data at Serial port (p28, p27), data rate <100Hz @115200bps Read 5 channels PPM signal at p11 using InterruptIn Send data via RF Modem at serial port (p13, p14) in 36Hz @115200 Drive i2C motor speed controller at I2C port (p9, p10) in every 10mS (control loop delay time)

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers to_gcs.h Source File

to_gcs.h

00001 #define FCC_DATA_SIZE 52  //39 Direct from IMU
00002 
00003 void toGCS(){
00004     
00005     fcc.US++;// = 11;
00006     if(fcc.US>1000) fcc.US = 0;
00007 
00008     char *FtoG = (char *)&fcc, i;   //&IMU
00009 
00010      
00011     radio.putc(0xFF);
00012     radio.putc(0xFF);
00013     for (i=0;i<FCC_DATA_SIZE;i++)  radio.putc(*FtoG++);
00014     radio.putc(0x0D);
00015 
00016 }