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
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 }
Generated on Sun Jul 17 2022 23:18:49 by 1.7.2