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)
Diff: to_gcs.h
- Revision:
- 0:7ccd56e1c3b1
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/to_gcs.h Wed Aug 11 01:23:42 2010 +0000 @@ -0,0 +1,16 @@ +#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); + +} \ No newline at end of file