Committer:
agiembed
Date:
Tue Aug 16 05:32:33 2011 +0000
Revision:
0:d463d5c04541

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
agiembed 0:d463d5c04541 1 #define Roll_INDEX 0x01
agiembed 0:d463d5c04541 2 #define Pitch_INDEX 0x02
agiembed 0:d463d5c04541 3 #define Yaw_INDEX 0x03
agiembed 0:d463d5c04541 4 #define Dis_INDEX 0x05
agiembed 0:d463d5c04541 5 #define Alt_INDEX 0x04
agiembed 0:d463d5c04541 6 #define TEMP_INDEX 0x06
agiembed 0:d463d5c04541 7
agiembed 0:d463d5c04541 8 #define Gain_Start_bit1 0xFE //Gain stick
agiembed 0:d463d5c04541 9 #define Gain_Start_bit2 0xFE
agiembed 0:d463d5c04541 10 #define Gain_End_bit 0x0D
agiembed 0:d463d5c04541 11
agiembed 0:d463d5c04541 12 #define Flight_Start_bit1 0xFF //Flight Mode Data
agiembed 0:d463d5c04541 13 #define Flight_Start_bit2 0xFE
agiembed 0:d463d5c04541 14 #define Flight_End_bit 0x0D
agiembed 0:d463d5c04541 15
agiembed 0:d463d5c04541 16 #define Gain_num 20 //
agiembed 0:d463d5c04541 17 #define GPS_num 12
agiembed 0:d463d5c04541 18 #define Mode_num 3 //14
agiembed 0:d463d5c04541 19
agiembed 0:d463d5c04541 20 #define head1 0xFF
agiembed 0:d463d5c04541 21 #define head2 0xFF
agiembed 0:d463d5c04541 22 #define End_bit 0x0D
agiembed 0:d463d5c04541 23
agiembed 0:d463d5c04541 24
agiembed 0:d463d5c04541 25 char data_cnt = 0;
agiembed 0:d463d5c04541 26 char Gain[Gain_num];
agiembed 0:d463d5c04541 27 char GPS[GPS_num];
agiembed 0:d463d5c04541 28 char Mode[Mode_num];
agiembed 0:d463d5c04541 29
agiembed 0:d463d5c04541 30 typedef enum
agiembed 0:d463d5c04541 31 {
agiembed 0:d463d5c04541 32 start, check1, check2, check3, check4, check5, check6, check7, check8
agiembed 0:d463d5c04541 33 } Check;
agiembed 0:d463d5c04541 34
agiembed 0:d463d5c04541 35 float latt, lont; //Target point
agiembed 0:d463d5c04541 36 float latp, lonp; //Current point
agiembed 0:d463d5c04541 37 float d_lat, d_lon;
agiembed 0:d463d5c04541 38 float a, b, c, d, ld;
agiembed 0:d463d5c04541 39 float lats, lons;
agiembed 0:d463d5c04541 40 float dlat, dlon;