Raharja Agie
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)
2gcs.h@0:bd282c11d296, 2010-08-12 (annotated)
- Committer:
- agiembed
- Date:
- Thu Aug 12 01:08:40 2010 +0000
- Revision:
- 0:bd282c11d296
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| agiembed | 0:bd282c11d296 | 1 | #define FCC_DATA_SIZE 52 //39 Direct from IMU |
| agiembed | 0:bd282c11d296 | 2 | |
| agiembed | 0:bd282c11d296 | 3 | void toGCS(){ |
| agiembed | 0:bd282c11d296 | 4 | |
| agiembed | 0:bd282c11d296 | 5 | |
| agiembed | 0:bd282c11d296 | 6 | fcc.US++;// = 11; |
| agiembed | 0:bd282c11d296 | 7 | if(fcc.US>1000) fcc.US = 0; |
| agiembed | 0:bd282c11d296 | 8 | |
| agiembed | 0:bd282c11d296 | 9 | char *FtoG = (char *)&fcc, i; //&IMU |
| agiembed | 0:bd282c11d296 | 10 | |
| agiembed | 0:bd282c11d296 | 11 | |
| agiembed | 0:bd282c11d296 | 12 | radio.putc(0xFF); |
| agiembed | 0:bd282c11d296 | 13 | radio.putc(0xFF); |
| agiembed | 0:bd282c11d296 | 14 | for (i=0;i<FCC_DATA_SIZE;i++) radio.putc(*FtoG++); |
| agiembed | 0:bd282c11d296 | 15 | radio.putc(0x0D); |
| agiembed | 0:bd282c11d296 | 16 | |
| agiembed | 0:bd282c11d296 | 17 | myled = !myled; |
| agiembed | 0:bd282c11d296 | 18 | } |