shubham c / Mbed 2 deprecated COM_MNG_TMTC_SIMPLE_pl123

I2C code testing

Dependencies:   FreescaleIAP SimpleDMA mbed-rtos mbed

Fork of COM_MNG_TMTC_SIMPLE_pl123 by Siva ram

COM_SND_TM.h@52:0bd68655c651, 2016-01-14 (annotated)

Committer:
aniruddhv
Date:
Thu Jan 14 06:16:42 2016 +0000
Revision:
52:0bd68655c651
Parent:
11:83acbe8e0ad1
Child:
53:18db568f1098
Merged with Shubham's code

Who changed what in which revision?

UserRevisionLine numberNew contents of line
aniruddhv 52:0bd68655c651 1 //void adf_not_SDcard();
shreeshas95 1:a0055b3280c8 2
shreeshas95 1:a0055b3280c8 3 #define S_FRAME_SIZE 48
ee12b079 9:e9eaada136c6 4 #define ISR 40
shreeshas95 1:a0055b3280c8 5 #define TM_FRAME_SIZE 134 //in bytes
shreeshas95 1:a0055b3280c8 6 #define T_FRAME_SIZE 159
shreeshas95 1:a0055b3280c8 7 #define EOS_SIZE 120
ee12b079 9:e9eaada136c6 8 #define MAX_ADF_LEN 65535
ee12b079 9:e9eaada136c6 9
shreeshas95 1:a0055b3280c8 10 const unsigned char S_frame[] = {0x46,0x9D,0xFB,0xF0,0xD2,0xBA,0x89,0xE4,0x46,0x9D,0xFB,0xF0,0xD2,0xBA,0x89,0xE4,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
shreeshas95 1:a0055b3280c8 11 const unsigned char EoS[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x1A,0x77,0xEF,0xC3,0x4A,0xEA,0x27,0x91,0x1A,0x77,0xEF,0xC3,0x4A,0xEA,0x27,0x90,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x1A,0x77,0xEF,0xC3,0x4A,0xEA,0x27,0x91,0x1A,0x77,0xEF,0xC3,0x4A,0xEA,0x27,0x90,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
shreeshas95 1:a0055b3280c8 12 const unsigned char FCCH80[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
shreeshas95 1:a0055b3280c8 13 const unsigned char SCH40[] = {0x0a,0x3f,0x46,0xb4,0x00};
aniruddhv 52:0bd68655c651 14 const unsigned char EXOR_SEQ[] = {0x55,0xF1,0x51,0x3D,0xA7,0x42,0xAE,0x2E,0x2E,0x28,0x76,0x80,0x62,0x41,0xC4,0x75,0x4D,0x87,0xDB,0xE1,0x02,0x61,0x60,0x96,0x9C,0xCB,0x8A,0xBD,0x37,0xE4,0x72,0x5D,0xF2,0x19,0x62,0x06,0x9A,0xF9,0x38,0xB0,0x49,0x75,0xD0,0x17,0x1B,0xCC,0x0B,0xEB,0x1B,0x50,0xA2,0x2A,0x8E,0xFA,0x4D,0x6F,0x1B,0xF8,0x0F,0x97,0x39,0x25,0x60,0x55,0x9A,0xDF,0x1D,0x10,0x7F,0xBD,0x3E,0xBF,0xE5,0x68,0x02,0xD1,0x99,0x0D,0xDF,0x84,0x2E,0x15,0xE3,0x08,0xD7,0x44,0x10,0x41,0xCE,0x93,0xF6,0x59,0x71,0xD2,0xF7,0x1C,0x4A,0x44,0x2D,0xA9,0x44,0x98,0x3A,0x00,0x71,0xCC,0x2A,0x35,0xC1,0x81,0xCF,0x44,0xF7,0x6A,0x0E,0xE4,0xF2,0xFC,0xD6,0x0B,0xA8,0x95,0x7B,0x86,0xB5,0xF8,0x33,0xE9,0xBF,0x6A,0x0E,0xE6,0x53,0x82};
ee12b079 9:e9eaada136c6 15
shreeshas95 1:a0055b3280c8 16 class SND_TM{
ee12b079 9:e9eaada136c6 17
ee12b079 9:e9eaada136c6 18 Base_tm * head_ptr;
ee12b079 9:e9eaada136c6 19
shreeshas95 1:a0055b3280c8 20 // transmit data variables
shreeshas95 1:a0055b3280c8 21 unsigned char Tframe_c; //_c represents counter, counts Tframe written in a segment
shreeshas95 1:a0055b3280c8 22 unsigned char EOS_c; //count no of bytes of eos have been weitten in the rolling buffer
shreeshas95 1:a0055b3280c8 23 unsigned char Sframe_c; //count no of bytes of Sframe have been weitten in the rolling buffer
shreeshas95 1:a0055b3280c8 24 unsigned char SCH40_c; //count no of bytes of SCH40 have been weitten in the rolling buffer
shreeshas95 1:a0055b3280c8 25 unsigned char data_c;
shreeshas95 1:a0055b3280c8 26 unsigned char FCCH80_c;
shreeshas95 1:a0055b3280c8 27 unsigned char RB_c; //rolling buffer counter
shreeshas95 1:a0055b3280c8 28 unsigned char segment_c; //counts the numver of segments sent
shreeshas95 1:a0055b3280c8 29 unsigned char MAX_SEGMENT;
shreeshas95 1:a0055b3280c8 30 bool Sframe; //Sframe = 1bit of CF1
shreeshas95 1:a0055b3280c8 31 bool SCH40_f;
shreeshas95 1:a0055b3280c8 32 bool FCCH80_f;
shreeshas95 1:a0055b3280c8 33 bool data_f;
ee12b079 9:e9eaada136c6 34 bool repeat_data_f;
shreeshas95 1:a0055b3280c8 35 bool transmit_data_f;
shreeshas95 1:a0055b3280c8 36 bool eos_f;
shreeshas95 1:a0055b3280c8 37 bool junk_f;
ee12b079 9:e9eaada136c6 38 bool segment_r; //flag checking if more sessions are required
ee12b079 9:e9eaada136c6 39
ee12b079 9:e9eaada136c6 40
shreeshas95 1:a0055b3280c8 41 // type 1 frame
ee12b079 9:e9eaada136c6 42
shreeshas95 1:a0055b3280c8 43 Base_tm *T0F_pointer ;
ee12b079 9:e9eaada136c6 44
shreeshas95 1:a0055b3280c8 45 int diff_prev;
shreeshas95 1:a0055b3280c8 46 void differential_encode(unsigned char* ptr, int length){
shreeshas95 1:a0055b3280c8 47 for(int i=0; i<length;i++){
shreeshas95 1:a0055b3280c8 48 unsigned char s = ptr[i] , t;
shreeshas95 1:a0055b3280c8 49 t = s ^ (s >> 1);
shreeshas95 1:a0055b3280c8 50 (diff_prev == 0) ? t=t^0x00 : t=t^0x80 ;
shreeshas95 1:a0055b3280c8 51 diff_prev = int(s & 0x01);
shreeshas95 1:a0055b3280c8 52 ptr[i] = t;
shreeshas95 1:a0055b3280c8 53 }
ee12b079 9:e9eaada136c6 54 }
ee12b079 9:e9eaada136c6 55
shreeshas95 1:a0055b3280c8 56 int type0_no; //number of type zero frames
ee12b079 9:e9eaada136c6 57 int type1_no;
shreeshas95 1:a0055b3280c8 58 int total_frames; //number of type one packe (TMP)
shreeshas95 1:a0055b3280c8 59 int SEGMENT_NO; //number of type one packe (TMP)
ee12b079 9:e9eaada136c6 60 int TOTAL_SEGMENT_NO;
ee12b079 9:e9eaada136c6 61 int LAST_SEGMENT_SIZE;
shreeshas95 1:a0055b3280c8 62 void inline data_number(){
shreeshas95 1:a0055b3280c8 63 int type1_frame_no;
shreeshas95 1:a0055b3280c8 64 Base_tm*head = head_ptr;
shreeshas95 1:a0055b3280c8 65 type0_no = 0;
shreeshas95 1:a0055b3280c8 66 type1_no = 0;
aniruddhv 52:0bd68655c651 67 while(head != NULL){
shreeshas95 1:a0055b3280c8 68 switch( GETshort_or_long_tm(head->fields) ){
shreeshas95 1:a0055b3280c8 69 case 0:
shreeshas95 1:a0055b3280c8 70 type0_no++;
shreeshas95 1:a0055b3280c8 71 break;
shreeshas95 1:a0055b3280c8 72 case 1:
shreeshas95 1:a0055b3280c8 73 type1_no++;
shreeshas95 1:a0055b3280c8 74 break;
shreeshas95 1:a0055b3280c8 75 }
ee12b079 9:e9eaada136c6 76
shreeshas95 1:a0055b3280c8 77 head=head->next_TM;
shreeshas95 1:a0055b3280c8 78 }
shreeshas95 1:a0055b3280c8 79 type1_frame_no = ( type1_no % 10 == 0 )? (type1_no / 10) : ( (type1_no / 10) + 1);
shreeshas95 1:a0055b3280c8 80 total_frames = type0_no + type1_frame_no ;
ee12b079 9:e9eaada136c6 81 TOTAL_SEGMENT_NO = (total_frames*2 % (ISR) == 0) ? ( total_frames*2/(ISR) ) : (total_frames*2/(ISR) + 1); //subtracting 1 since the last SCH40_f is not detected
ee12b079 9:e9eaada136c6 82 SEGMENT_NO = TOTAL_SEGMENT_NO;
ee12b079 9:e9eaada136c6 83 if(SEGMENT_NO > MAX_SEGMENT)
ee12b079 9:e9eaada136c6 84 {
ee12b079 9:e9eaada136c6 85 SEGMENT_NO = MAX_SEGMENT;
ee12b079 9:e9eaada136c6 86 }
aniruddhv 52:0bd68655c651 87 if(SEGMENT_NO == 1) segment_r = 0; else segment_r = 1;
ee12b079 9:e9eaada136c6 88 TOTAL_SEGMENT_NO -= SEGMENT_NO;
aniruddhv 52:0bd68655c651 89 LAST_SEGMENT_SIZE = total_frames*2%ISR?total_frames*2%ISR:ISR;
shreeshas95 1:a0055b3280c8 90 }
ee12b079 9:e9eaada136c6 91
shreeshas95 1:a0055b3280c8 92 #define next_type_structure(ptr){\
shreeshas95 1:a0055b3280c8 93 unsigned char temp = GETshort_or_long_tm(ptr->fields);\
shreeshas95 1:a0055b3280c8 94 if((temp == 0) && (ptr->next_TM != NULL) ){\
shreeshas95 1:a0055b3280c8 95 do{\
shreeshas95 1:a0055b3280c8 96 ptr = ptr->next_TM;\
shreeshas95 1:a0055b3280c8 97 temp = GETshort_or_long_tm(ptr->fields);\
shreeshas95 1:a0055b3280c8 98 }\
shreeshas95 1:a0055b3280c8 99 while(temp == 1 && ptr->next_TM != NULL);\
shreeshas95 1:a0055b3280c8 100 if(temp == 1){\
shreeshas95 1:a0055b3280c8 101 ptr = NULL;\
shreeshas95 1:a0055b3280c8 102 }\
shreeshas95 1:a0055b3280c8 103 }\
shreeshas95 1:a0055b3280c8 104 else if((temp == 1) && (ptr->next_TM != NULL)){\
shreeshas95 1:a0055b3280c8 105 do{\
shreeshas95 1:a0055b3280c8 106 ptr = ptr->next_TM;\
shreeshas95 1:a0055b3280c8 107 temp = GETshort_or_long_tm(ptr->fields);\
shreeshas95 1:a0055b3280c8 108 }\
shreeshas95 1:a0055b3280c8 109 while(temp == 0 && ptr->next_TM != NULL);\
shreeshas95 1:a0055b3280c8 110 if(temp == 0){\
ee12b079 9:e9eaada136c6 111 ptr = NULL;\
shreeshas95 1:a0055b3280c8 112 }\
shreeshas95 1:a0055b3280c8 113 }\
shreeshas95 1:a0055b3280c8 114 else{\
ee12b079 9:e9eaada136c6 115 ptr = NULL;\
shreeshas95 1:a0055b3280c8 116 }\
shreeshas95 1:a0055b3280c8 117 }
ee12b079 9:e9eaada136c6 118
shreeshas95 1:a0055b3280c8 119 /*
shreeshas95 1:a0055b3280c8 120 brief: take input type 0 or 1 and return the address of the first node in the list that have that type
shreeshas95 1:a0055b3280c8 121 parameter: type 0 or 1
ee12b079 9:e9eaada136c6 122 return: pointer of the first node having same type
shreeshas95 1:a0055b3280c8 123 */
shreeshas95 1:a0055b3280c8 124 // Base_tm* first_type_structure(int type){
shreeshas95 1:a0055b3280c8 125 // Base_tm* temp_ptr = head_ptr;
shreeshas95 1:a0055b3280c8 126 // if(type == 0){
shreeshas95 1:a0055b3280c8 127 // while(GETshort_or_long_tm(temp_ptr->fields) == 1){
shreeshas95 1:a0055b3280c8 128 // temp_ptr = temp_ptr->next_TM;
shreeshas95 1:a0055b3280c8 129 // if(temp_ptr == NULL){
shreeshas95 1:a0055b3280c8 130 // return NULL ;
ee12b079 9:e9eaada136c6 131 // }
ee12b079 9:e9eaada136c6 132 // }
shreeshas95 1:a0055b3280c8 133 // }
shreeshas95 1:a0055b3280c8 134 // else if(type == 1){
shreeshas95 1:a0055b3280c8 135 // while(GETshort_or_long_tm(temp_ptr->fields) == 0){
shreeshas95 1:a0055b3280c8 136 // temp_ptr = temp_ptr->next_TM;
shreeshas95 1:a0055b3280c8 137 // if(temp_ptr == NULL){
ee12b079 9:e9eaada136c6 138 // return NULL;
ee12b079 9:e9eaada136c6 139 // }
ee12b079 9:e9eaada136c6 140 // }
ee12b079 9:e9eaada136c6 141 // }
shreeshas95 1:a0055b3280c8 142 // return temp_ptr;
shreeshas95 1:a0055b3280c8 143 // }
aniruddhv 52:0bd68655c651 144 #define exor(ptr) { for(int i=0 ; i<134; i++ ) ptr[i]=ptr[i]^EXOR_SEQ[i];}
ee12b079 9:e9eaada136c6 145
ee12b079 9:e9eaada136c6 146
shreeshas95 1:a0055b3280c8 147 #define first_type_structure( type,return_ptr) {\
shreeshas95 1:a0055b3280c8 148 Base_tm* temp_ptr = head_ptr;\
shreeshas95 1:a0055b3280c8 149 if(type == 0){\
shreeshas95 1:a0055b3280c8 150 while(GETshort_or_long_tm(temp_ptr->fields) == 1){\
shreeshas95 1:a0055b3280c8 151 temp_ptr = temp_ptr->next_TM;\
shreeshas95 1:a0055b3280c8 152 if(temp_ptr == NULL){\
shreeshas95 1:a0055b3280c8 153 return_ptr = NULL ;\
shreeshas95 1:a0055b3280c8 154 }\
shreeshas95 1:a0055b3280c8 155 }\
shreeshas95 1:a0055b3280c8 156 }\
shreeshas95 1:a0055b3280c8 157 else if(type == 1){\
shreeshas95 1:a0055b3280c8 158 while(GETshort_or_long_tm(temp_ptr->fields) == 0){\
shreeshas95 1:a0055b3280c8 159 temp_ptr = temp_ptr->next_TM;\
shreeshas95 1:a0055b3280c8 160 if(temp_ptr == NULL){\
shreeshas95 1:a0055b3280c8 161 return_ptr = NULL;\
shreeshas95 1:a0055b3280c8 162 }\
shreeshas95 1:a0055b3280c8 163 }\
shreeshas95 1:a0055b3280c8 164 }\
shreeshas95 1:a0055b3280c8 165 return_ptr = temp_ptr;\
shreeshas95 1:a0055b3280c8 166 }
ee12b079 9:e9eaada136c6 167
ee12b079 9:e9eaada136c6 168
ee12b079 9:e9eaada136c6 169
shreeshas95 1:a0055b3280c8 170 Base_tm *T1F_pointer ;
shreeshas95 1:a0055b3280c8 171 int T1F_counter;
shreeshas95 1:a0055b3280c8 172 unsigned char TMframe_type1[TM_FRAME_SIZE];
shreeshas95 1:a0055b3280c8 173 bool type1_frame_flag; //should be true for every new list
ee12b079 9:e9eaada136c6 174
shreeshas95 1:a0055b3280c8 175 #define type1_frame(ptr){\
shreeshas95 1:a0055b3280c8 176 int i=4;\
shreeshas95 1:a0055b3280c8 177 if(type1_frame_flag){\
shreeshas95 1:a0055b3280c8 178 first_type_structure(1,T1F_pointer);\
shreeshas95 1:a0055b3280c8 179 T1F_counter = 0;\
shreeshas95 1:a0055b3280c8 180 type1_frame_flag = false;\
shreeshas95 1:a0055b3280c8 181 }\
shreeshas95 1:a0055b3280c8 182 for(i = 4 ; (i < 134) && (T1F_pointer != NULL) ; i++){\
shreeshas95 1:a0055b3280c8 183 TMframe_type1[i] = T1F_pointer->TM_string[T1F_counter];\
shreeshas95 1:a0055b3280c8 184 if(T1F_counter++ == 12){\
shreeshas95 1:a0055b3280c8 185 T1F_counter = 0;\
shreeshas95 1:a0055b3280c8 186 next_type_structure(T1F_pointer);\
shreeshas95 1:a0055b3280c8 187 }\
shreeshas95 1:a0055b3280c8 188 }\
aniruddhv 52:0bd68655c651 189 TMframe_type1[0] = (1<<7) + (( (i-4)/13 )<<3);\
shreeshas95 1:a0055b3280c8 190 TMframe_type1[3] = crc16_gen(TMframe_type1,3);\
shreeshas95 1:a0055b3280c8 191 if(T1F_pointer == NULL && i>12){\
shreeshas95 1:a0055b3280c8 192 for( ; i < 134 ; i++){\
shreeshas95 1:a0055b3280c8 193 TMframe_type1[i] = TMframe_type1[i-13];\
shreeshas95 1:a0055b3280c8 194 }\
shreeshas95 1:a0055b3280c8 195 }\
ee12b079 9:e9eaada136c6 196 ptr=TMframe_type1;\
shreeshas95 1:a0055b3280c8 197 }
ee12b079 9:e9eaada136c6 198
ee12b079 9:e9eaada136c6 199
shreeshas95 1:a0055b3280c8 200 // unsigned char * type1_frame(){
shreeshas95 1:a0055b3280c8 201 // int i=4;
shreeshas95 1:a0055b3280c8 202 // if(type1_frame_flag){
shreeshas95 1:a0055b3280c8 203 // T1F_pointer = first_type_structure(1);
shreeshas95 1:a0055b3280c8 204 // T1F_counter = 0;
shreeshas95 1:a0055b3280c8 205 // type1_frame_flag = false;
shreeshas95 1:a0055b3280c8 206 // }
shreeshas95 1:a0055b3280c8 207 // for(i = 4 ; (i < 134) && (T1F_pointer != NULL) ; i++){
shreeshas95 1:a0055b3280c8 208 // TMframe_type1[i] = T1F_pointer->TM_string[T1F_counter];
shreeshas95 1:a0055b3280c8 209 // if(T1F_counter++ == 12){
shreeshas95 1:a0055b3280c8 210 // T1F_counter = 0;
shreeshas95 1:a0055b3280c8 211 // T1F_pointer = next_type_structure(T1F_pointer);
shreeshas95 1:a0055b3280c8 212 // }
shreeshas95 1:a0055b3280c8 213 // }
shreeshas95 1:a0055b3280c8 214 // // header
shreeshas95 1:a0055b3280c8 215 // TMframe_type1[0] = 1<<7 + ( (i-4)/10 )<<3; //( (i-4)/10 ) gives number of packets in the frame
shreeshas95 1:a0055b3280c8 216 // //insert time ;
shreeshas95 1:a0055b3280c8 217 // TMframe_type1[3] = CRC::crc16_gen(TMframe_type1,3);
shreeshas95 1:a0055b3280c8 218 // //end header
shreeshas95 1:a0055b3280c8 219 // if(T1F_pointer == NULL && i>12){
shreeshas95 1:a0055b3280c8 220 // for( ; i < 134 ; i++){ //repeating ;ast packet to fill up the extra space
ee12b079 9:e9eaada136c6 221 // TMframe_type1[i] = TMframe_type1[i-13];
shreeshas95 1:a0055b3280c8 222 // }
shreeshas95 1:a0055b3280c8 223 // }
shreeshas95 1:a0055b3280c8 224 // return TMframe_type1;
shreeshas95 1:a0055b3280c8 225 // }
ee12b079 9:e9eaada136c6 226
shreeshas95 1:a0055b3280c8 227 bool type0_frame_flag;
ee12b079 9:e9eaada136c6 228
ee12b079 9:e9eaada136c6 229
shreeshas95 1:a0055b3280c8 230 #define type0_frame(ptr){\
shreeshas95 1:a0055b3280c8 231 if(type0_frame_flag){\
shreeshas95 1:a0055b3280c8 232 first_type_structure(0,T0F_pointer);\
shreeshas95 1:a0055b3280c8 233 type0_frame_flag = false;\
shreeshas95 1:a0055b3280c8 234 }\
shreeshas95 1:a0055b3280c8 235 else {\
shreeshas95 1:a0055b3280c8 236 next_type_structure(T0F_pointer);\
shreeshas95 1:a0055b3280c8 237 }\
shreeshas95 1:a0055b3280c8 238 ptr = T0F_pointer->TM_string;\
shreeshas95 1:a0055b3280c8 239 }
ee12b079 9:e9eaada136c6 240
ee12b079 9:e9eaada136c6 241
shreeshas95 1:a0055b3280c8 242 // unsigned char* type0_frame(){
shreeshas95 1:a0055b3280c8 243 // if(type0_frame_flag){
ee12b079 9:e9eaada136c6 244 // T0F_pointer = first_type_structure(0);
shreeshas95 1:a0055b3280c8 245 // type0_frame_flag = false;
ee12b079 9:e9eaada136c6 246 // }
shreeshas95 1:a0055b3280c8 247 // else {
shreeshas95 1:a0055b3280c8 248 // T0F_pointer = next_type_structure(T0F_pointer);
shreeshas95 1:a0055b3280c8 249 // }
shreeshas95 1:a0055b3280c8 250 // return T0F_pointer->TM_string;
shreeshas95 1:a0055b3280c8 251 // }
ee12b079 9:e9eaada136c6 252
ee12b079 9:e9eaada136c6 253 unsigned char convoluted_frame[270];
shreeshas95 1:a0055b3280c8 254 Convolution ConvObj2;
shreeshas95 1:a0055b3280c8 255 void convolution (unsigned char * ptr){
shreeshas95 1:a0055b3280c8 256 ConvObj2.convolutionEncode(ptr, convoluted_frame);
shreeshas95 1:a0055b3280c8 257 ConvObj2.convolutionEncode(ptr + 67, convoluted_frame + 135);
shreeshas95 1:a0055b3280c8 258 }
ee12b079 9:e9eaada136c6 259
ee12b079 9:e9eaada136c6 260
ee12b079 9:e9eaada136c6 261 unsigned char interleave_data[2][144];
shreeshas95 1:a0055b3280c8 262 unsigned char DS_index;
shreeshas95 1:a0055b3280c8 263 bool DS_state;
shreeshas95 1:a0055b3280c8 264 int DS_counter;
shreeshas95 1:a0055b3280c8 265 bool DS_f;
shreeshas95 1:a0055b3280c8 266 bool make_DataStream_f;
shreeshas95 1:a0055b3280c8 267 // #define make_DataStream {\
shreeshas95 1:a0055b3280c8 268 // unsigned char* ptr;\
shreeshas95 1:a0055b3280c8 269 // if(make_DataStream_f == true){\
shreeshas95 1:a0055b3280c8 270 // DS_state = true;\
shreeshas95 1:a0055b3280c8 271 // DS_counter = 0;\
shreeshas95 1:a0055b3280c8 272 // DS_f = false;\
shreeshas95 1:a0055b3280c8 273 // make_DataStream_f = false;\
shreeshas95 1:a0055b3280c8 274 // }\
shreeshas95 1:a0055b3280c8 275 // if(DS_state){\
shreeshas95 1:a0055b3280c8 276 // if(DS_counter < total_frames-type0_no){\
shreeshas95 1:a0055b3280c8 277 // type1_frame(ptr); \
shreeshas95 1:a0055b3280c8 278 // DS_f = true;\
shreeshas95 1:a0055b3280c8 279 // }\
shreeshas95 1:a0055b3280c8 280 // else if(DS_counter < total_frames ){\
shreeshas95 1:a0055b3280c8 281 // type0_frame(ptr);\
shreeshas95 1:a0055b3280c8 282 // DS_f = true;\
shreeshas95 1:a0055b3280c8 283 // }\
shreeshas95 1:a0055b3280c8 284 // DS_counter++;\
shreeshas95 1:a0055b3280c8 285 // }\
shreeshas95 1:a0055b3280c8 286 // DS_state = !DS_state;\
shreeshas95 1:a0055b3280c8 287 // if (DS_f){\
shreeshas95 1:a0055b3280c8 288 // DS_f = false;\
shreeshas95 1:a0055b3280c8 289 // convolution(ptr);\
shreeshas95 1:a0055b3280c8 290 // interleave(convoluted_frame,interleave_data[0]);\
shreeshas95 1:a0055b3280c8 291 // interleave(convoluted_frame+ 135,interleave_data[1]);\
shreeshas95 1:a0055b3280c8 292 // }\
shreeshas95 1:a0055b3280c8 293 // DS_index = (DS_state==true)?1:0;\
shreeshas95 1:a0055b3280c8 294 // }
ee12b079 9:e9eaada136c6 295
ee12b079 9:e9eaada136c6 296 #define make_DataStream {\
ee12b079 9:e9eaada136c6 297 unsigned char* ptr;\
ee12b079 9:e9eaada136c6 298 if(make_DataStream_f == true){\
ee12b079 9:e9eaada136c6 299 DS_state = true;\
ee12b079 9:e9eaada136c6 300 DS_counter = 0;\
ee12b079 9:e9eaada136c6 301 DS_f = false;\
ee12b079 9:e9eaada136c6 302 make_DataStream_f = false;\
ee12b079 9:e9eaada136c6 303 }\
ee12b079 9:e9eaada136c6 304 if(DS_state){\
ee12b079 9:e9eaada136c6 305 if(DS_counter < total_frames-type0_no){\
ee12b079 9:e9eaada136c6 306 type1_frame(ptr); \
ee12b079 9:e9eaada136c6 307 DS_f = true;\
ee12b079 9:e9eaada136c6 308 }\
ee12b079 9:e9eaada136c6 309 else if(DS_counter < total_frames ){\
ee12b079 9:e9eaada136c6 310 type0_frame(ptr);\
ee12b079 9:e9eaada136c6 311 DS_f = true;\
ee12b079 9:e9eaada136c6 312 }\
ee12b079 9:e9eaada136c6 313 DS_counter++;\
ee12b079 9:e9eaada136c6 314 }\
ee12b079 9:e9eaada136c6 315 DS_state = !DS_state;\
ee12b079 9:e9eaada136c6 316 if (DS_f){\
ee12b079 9:e9eaada136c6 317 DS_f = false;\
aniruddhv 52:0bd68655c651 318 exor(ptr);\
ee12b079 9:e9eaada136c6 319 convolution(ptr);\
ee12b079 9:e9eaada136c6 320 interleave(convoluted_frame,interleave_data[0]);\
ee12b079 9:e9eaada136c6 321 interleave(convoluted_frame+ 135,interleave_data[1]);}\
ee12b079 9:e9eaada136c6 322 DS_index = (DS_state==true)?1:0;\
ee12b079 9:e9eaada136c6 323 }
ee12b079 9:e9eaada136c6 324
ee12b079 9:e9eaada136c6 325
ee12b079 9:e9eaada136c6 326 //
shreeshas95 1:a0055b3280c8 327 public:
ee12b079 9:e9eaada136c6 328
shreeshas95 1:a0055b3280c8 329 bool reset_adf;
shreeshas95 1:a0055b3280c8 330 SND_TM(){
rohit3342 11:83acbe8e0ad1 331 MAX_SEGMENT = (MAX_ADF_LEN-EOS_SIZE)/( S_FRAME_SIZE + ISR*T_FRAME_SIZE);
ee12b079 9:e9eaada136c6 332 //MAX_SEGMENT = 1;
ee12b079 9:e9eaada136c6 333 //(max length - eos size)/(sframe length + tFrameLength*ISR)
shreeshas95 1:a0055b3280c8 334 // cout<<int(MAX_SEGMENT)<<endl;
shreeshas95 1:a0055b3280c8 335 }
ee12b079 9:e9eaada136c6 336
shreeshas95 1:a0055b3280c8 337
ee12b079 9:e9eaada136c6 338
shreeshas95 1:a0055b3280c8 339 void head_pointer(Base_tm* ptr){
shreeshas95 1:a0055b3280c8 340 head_ptr = ptr ;
shreeshas95 1:a0055b3280c8 341 type1_frame_flag = true;
shreeshas95 1:a0055b3280c8 342 type0_frame_flag = true;
shreeshas95 1:a0055b3280c8 343 make_DataStream_f = true;
shreeshas95 1:a0055b3280c8 344 transmit_data_f = true;
shreeshas95 1:a0055b3280c8 345 diff_prev = 0;
shreeshas95 1:a0055b3280c8 346 data_number();
ee12b079 9:e9eaada136c6 347 // make_DataStream;
ee12b079 9:e9eaada136c6 348 // gPC.putc('z');
shreeshas95 1:a0055b3280c8 349 }
ee12b079 9:e9eaada136c6 350
ee12b079 9:e9eaada136c6 351
shreeshas95 1:a0055b3280c8 352 void inline transmit_data(unsigned char * transmit , bool * last_buffer){
shreeshas95 1:a0055b3280c8 353 if(transmit_data_f){
shreeshas95 1:a0055b3280c8 354 RB_c = 0;
shreeshas95 1:a0055b3280c8 355 Sframe_c = 0;
shreeshas95 1:a0055b3280c8 356 SCH40_c = 0;
shreeshas95 1:a0055b3280c8 357 FCCH80_c = 0;
shreeshas95 1:a0055b3280c8 358 Tframe_c = 0;
shreeshas95 1:a0055b3280c8 359 EOS_c = 0;
shreeshas95 1:a0055b3280c8 360 segment_c = 0;
shreeshas95 1:a0055b3280c8 361 data_c = 0;
ee12b079 9:e9eaada136c6 362
shreeshas95 1:a0055b3280c8 363 Sframe = true;
shreeshas95 1:a0055b3280c8 364 SCH40_f = false;
shreeshas95 1:a0055b3280c8 365 data_f = false;
shreeshas95 1:a0055b3280c8 366 FCCH80_f = false;
shreeshas95 1:a0055b3280c8 367 transmit_data_f = false;
shreeshas95 1:a0055b3280c8 368 reset_adf = false;
shreeshas95 1:a0055b3280c8 369 *last_buffer = false;
shreeshas95 1:a0055b3280c8 370 }
ee12b079 9:e9eaada136c6 371
shreeshas95 1:a0055b3280c8 372 for(RB_c = 0 ; RB_c<112 ; RB_c++){
ee12b079 9:e9eaada136c6 373
ee12b079 9:e9eaada136c6 374 if(junk_f || *last_buffer){
ee12b079 9:e9eaada136c6 375 transmit[RB_c] = 0x00;
ee12b079 9:e9eaada136c6 376 continue;
shreeshas95 1:a0055b3280c8 377 }
ee12b079 9:e9eaada136c6 378
shreeshas95 1:a0055b3280c8 379 if(Sframe){
shreeshas95 1:a0055b3280c8 380 transmit[RB_c] = S_frame[Sframe_c++];
shreeshas95 1:a0055b3280c8 381 if(Sframe_c == 48){
shreeshas95 1:a0055b3280c8 382 // printf("exit s frame\n");
shreeshas95 1:a0055b3280c8 383 Sframe_c = 0;
shreeshas95 1:a0055b3280c8 384 Sframe = false;
shreeshas95 1:a0055b3280c8 385 SCH40_f =true;
shreeshas95 1:a0055b3280c8 386 }
shreeshas95 1:a0055b3280c8 387 continue;
shreeshas95 1:a0055b3280c8 388 }
ee12b079 9:e9eaada136c6 389 //
shreeshas95 1:a0055b3280c8 390 if(SCH40_f){
ee12b079 9:e9eaada136c6 391 transmit[RB_c] = SCH40[SCH40_c++];
shreeshas95 1:a0055b3280c8 392 if(SCH40_c == 5 ){
shreeshas95 1:a0055b3280c8 393 SCH40_c = 0;
ee12b079 9:e9eaada136c6 394 SCH40_f = false;
ee12b079 9:e9eaada136c6 395
ee12b079 9:e9eaada136c6 396
ee12b079 9:e9eaada136c6 397 if(Tframe_c >= LAST_SEGMENT_SIZE && segment_r == 0)
ee12b079 9:e9eaada136c6 398 {
ee12b079 9:e9eaada136c6 399 repeat_data_f = true;
ee12b079 9:e9eaada136c6 400 DS_index = !DS_index;
ee12b079 9:e9eaada136c6 401 }
ee12b079 9:e9eaada136c6 402 else
ee12b079 9:e9eaada136c6 403 {
ee12b079 9:e9eaada136c6 404 data_f = true;
ee12b079 9:e9eaada136c6 405 make_DataStream;
ee12b079 9:e9eaada136c6 406 }
shreeshas95 1:a0055b3280c8 407 // printf("exit SCH40 frame\n");
shreeshas95 1:a0055b3280c8 408 }
shreeshas95 1:a0055b3280c8 409 continue;
shreeshas95 1:a0055b3280c8 410 }
ee12b079 9:e9eaada136c6 411 //
shreeshas95 1:a0055b3280c8 412 if(data_f){
shreeshas95 1:a0055b3280c8 413 transmit[RB_c] = interleave_data[DS_index][data_c++];
shreeshas95 1:a0055b3280c8 414 if(data_c == 144){
shreeshas95 1:a0055b3280c8 415 data_c = 0;
shreeshas95 1:a0055b3280c8 416 FCCH80_f = true;
shreeshas95 1:a0055b3280c8 417 data_f = false;
shreeshas95 1:a0055b3280c8 418 // printf("exit Data\n");
shreeshas95 1:a0055b3280c8 419 }
shreeshas95 1:a0055b3280c8 420 continue;
shreeshas95 1:a0055b3280c8 421 }
ee12b079 9:e9eaada136c6 422 if(repeat_data_f){
ee12b079 9:e9eaada136c6 423 transmit[RB_c] = interleave_data[DS_index][data_c++];
ee12b079 9:e9eaada136c6 424 if(data_c == 144){
ee12b079 9:e9eaada136c6 425 data_c = 0;
ee12b079 9:e9eaada136c6 426 FCCH80_f = true;
ee12b079 9:e9eaada136c6 427 repeat_data_f = false;
ee12b079 9:e9eaada136c6 428 // printf("exit Data\n");
ee12b079 9:e9eaada136c6 429 }
ee12b079 9:e9eaada136c6 430 continue;
ee12b079 9:e9eaada136c6 431 }
ee12b079 9:e9eaada136c6 432
shreeshas95 1:a0055b3280c8 433 if(FCCH80_f){
shreeshas95 1:a0055b3280c8 434 transmit[RB_c] = FCCH80[FCCH80_c++];
shreeshas95 1:a0055b3280c8 435 if(FCCH80_c == 10){
shreeshas95 1:a0055b3280c8 436 FCCH80_c = 0;
shreeshas95 1:a0055b3280c8 437 FCCH80_f = false;
shreeshas95 1:a0055b3280c8 438 // printf("exit FCCH80\n");
shreeshas95 1:a0055b3280c8 439 if(++Tframe_c != ISR)
ee12b079 9:e9eaada136c6 440 SCH40_f = true;
shreeshas95 1:a0055b3280c8 441 else{
shreeshas95 1:a0055b3280c8 442 Tframe_c = 0;
shreeshas95 1:a0055b3280c8 443 segment_c++;
aniruddhv 52:0bd68655c651 444 if(segment_c >= SEGMENT_NO - 1 && TOTAL_SEGMENT_NO == 0) segment_r = 0; else segment_r = 1;
ee12b079 9:e9eaada136c6 445 if(segment_c == SEGMENT_NO)
shreeshas95 1:a0055b3280c8 446 {eos_f = true;}
shreeshas95 1:a0055b3280c8 447 else{
shreeshas95 1:a0055b3280c8 448 Sframe = true;
shreeshas95 1:a0055b3280c8 449 }
shreeshas95 1:a0055b3280c8 450 }
shreeshas95 1:a0055b3280c8 451 }
shreeshas95 1:a0055b3280c8 452 continue;
ee12b079 9:e9eaada136c6 453 }
ee12b079 9:e9eaada136c6 454
ee12b079 9:e9eaada136c6 455 if(eos_f){
shreeshas95 1:a0055b3280c8 456 transmit[RB_c] = EoS[EOS_c++];
shreeshas95 1:a0055b3280c8 457 if(EOS_c == EOS_SIZE){
shreeshas95 1:a0055b3280c8 458 EOS_c = 0;
shreeshas95 1:a0055b3280c8 459 eos_f = false;
shreeshas95 1:a0055b3280c8 460 // printf("exit EOS\n");
ee12b079 9:e9eaada136c6 461 // if(segment_c == MAX_SEGMENT){
ee12b079 9:e9eaada136c6 462 // segment_c = 0;
ee12b079 9:e9eaada136c6 463 // SEGMENT_NO = SEGMENT_NO - MAX_SEGMENT;
ee12b079 9:e9eaada136c6 464 // reset_adf = true;//what does this do??
ee12b079 9:e9eaada136c6 465 // Sframe = true;
ee12b079 9:e9eaada136c6 466 // }else{
ee12b079 9:e9eaada136c6 467 // *last_buffer = true;
ee12b079 9:e9eaada136c6 468 // }
ee12b079 9:e9eaada136c6 469 if(segment_c == SEGMENT_NO && segment_r == 0){
ee12b079 9:e9eaada136c6 470 *last_buffer = true;
ee12b079 9:e9eaada136c6 471 }
ee12b079 9:e9eaada136c6 472 else if(segment_c == SEGMENT_NO && segment_r != 0){
ee12b079 9:e9eaada136c6 473 segment_c = 0;
ee12b079 9:e9eaada136c6 474 SEGMENT_NO = TOTAL_SEGMENT_NO;
ee12b079 9:e9eaada136c6 475 if(SEGMENT_NO > MAX_SEGMENT)
ee12b079 9:e9eaada136c6 476 {
ee12b079 9:e9eaada136c6 477 SEGMENT_NO = MAX_SEGMENT;
ee12b079 9:e9eaada136c6 478 }
aniruddhv 52:0bd68655c651 479 if(SEGMENT_NO == 1) segment_r = 0; else segment_r = 1;
ee12b079 9:e9eaada136c6 480 TOTAL_SEGMENT_NO -= SEGMENT_NO;
ee12b079 9:e9eaada136c6 481 reset_adf = true;//what does this do??
ee12b079 9:e9eaada136c6 482 Sframe = true;
ee12b079 9:e9eaada136c6 483 }
shreeshas95 1:a0055b3280c8 484 junk_f = true;
shreeshas95 1:a0055b3280c8 485 }
shreeshas95 1:a0055b3280c8 486 continue;
ee12b079 9:e9eaada136c6 487 }
shreeshas95 1:a0055b3280c8 488 }
shreeshas95 1:a0055b3280c8 489 differential_encode(transmit,112);
shreeshas95 1:a0055b3280c8 490 if(reset_adf == true){
shreeshas95 1:a0055b3280c8 491 diff_prev = 0;
shreeshas95 1:a0055b3280c8 492 junk_f = false;
shreeshas95 1:a0055b3280c8 493 }
ee12b079 9:e9eaada136c6 494
shreeshas95 1:a0055b3280c8 495 }
ee12b079 9:e9eaada136c6 496
shreeshas95 1:a0055b3280c8 497 };
shreeshas95 1:a0055b3280c8 498 SND_TM snd_tm;