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)
to_gcs.h
- Committer:
- agiembed
- Date:
- 2010-08-11
- Revision:
- 0:7ccd56e1c3b1
File content as of revision 0:7ccd56e1c3b1:
#define FCC_DATA_SIZE 52 //39 Direct from IMU void toGCS(){ fcc.US++;// = 11; if(fcc.US>1000) fcc.US = 0; char *FtoG = (char *)&fcc, i; //&IMU radio.putc(0xFF); radio.putc(0xFF); for (i=0;i<FCC_DATA_SIZE;i++) radio.putc(*FtoG++); radio.putc(0x0D); }