![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Repository for testing ADF code of COM_TMTC_SIMPLE
Fork of COM_MNG_TMTC_SIMPLE by
Diff: COM_SND_TM.h
- Revision:
- 1:a0055b3280c8
- Child:
- 2:2caf2a9a13aa
diff -r f016e9e8d48b -r a0055b3280c8 COM_SND_TM.h --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/COM_SND_TM.h Mon Dec 14 12:04:01 2015 +0000 @@ -0,0 +1,414 @@ +void adf_not_SDcard(); + +#define S_FRAME_SIZE 48 +#define ISR 30 +#define TM_FRAME_SIZE 134 //in bytes +#define T_FRAME_SIZE 159 +#define EOS_SIZE 120 +#define MAX_ADF_LEN 65535 + +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}; +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}; +const unsigned char FCCH80[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}; +const unsigned char SCH40[] = {0x0a,0x3f,0x46,0xb4,0x00}; + +class SND_TM{ + + Base_tm * head_ptr; + +// transmit data variables + unsigned char Tframe_c; //_c represents counter, counts Tframe written in a segment + unsigned char EOS_c; //count no of bytes of eos have been weitten in the rolling buffer + unsigned char Sframe_c; //count no of bytes of Sframe have been weitten in the rolling buffer + unsigned char SCH40_c; //count no of bytes of SCH40 have been weitten in the rolling buffer + unsigned char data_c; + unsigned char FCCH80_c; + unsigned char RB_c; //rolling buffer counter + unsigned char segment_c; //counts the numver of segments sent + unsigned char MAX_SEGMENT; + bool Sframe; //Sframe = 1bit of CF1 + bool SCH40_f; + bool FCCH80_f; + bool data_f; + bool transmit_data_f; + bool eos_f; + bool junk_f; + + +// type 1 frame + + Base_tm *T0F_pointer ; + + int diff_prev; + void differential_encode(unsigned char* ptr, int length){ + for(int i=0; i<length;i++){ + unsigned char s = ptr[i] , t; + t = s ^ (s >> 1); + (diff_prev == 0) ? t=t^0x00 : t=t^0x80 ; + diff_prev = int(s & 0x01); + ptr[i] = t; + } + } + + int type0_no; //number of type zero frames + int type1_no; + int total_frames; //number of type one packe (TMP) + int SEGMENT_NO; //number of type one packe (TMP) + void inline data_number(){ + int type1_frame_no; + Base_tm*head = head_ptr; + type0_no = 0; + type1_no = 0; + while(head != NULL){ + switch( GETshort_or_long_tm(head->fields) ){ + case 0: + type0_no++; + break; + case 1: + type1_no++; + break; + } + head=head->next_TM; + } + type1_frame_no = ( type1_no % 10 == 0 )? (type1_no / 10) : ( (type1_no / 10) + 1); + total_frames = type0_no + type1_frame_no ; + 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 + } + +#define next_type_structure(ptr){\ + unsigned char temp = GETshort_or_long_tm(ptr->fields);\ + if((temp == 0) && (ptr->next_TM != NULL) ){\ + do{\ + ptr = ptr->next_TM;\ + temp = GETshort_or_long_tm(ptr->fields);\ + }\ + while(temp == 1 && ptr->next_TM != NULL);\ + if(temp == 1){\ + ptr = NULL;\ + break;\ + }\ + }\ + else if((temp == 1) && (ptr->next_TM != NULL)){\ + do{\ + ptr = ptr->next_TM;\ + temp = GETshort_or_long_tm(ptr->fields);\ + }\ + while(temp == 0 && ptr->next_TM != NULL);\ + if(temp == 0){\ + ptr NULL;\ + break;\ + }\ + }\ + else{\ + ptr NULL;\ + }\ + } + + /* + brief: take input type 0 or 1 and return the address of the first node in the list that have that type + parameter: type 0 or 1 + return: pointer of the first node having same type + */ +// Base_tm* first_type_structure(int type){ +// Base_tm* temp_ptr = head_ptr; +// if(type == 0){ +// while(GETshort_or_long_tm(temp_ptr->fields) == 1){ +// temp_ptr = temp_ptr->next_TM; +// if(temp_ptr == NULL){ +// return NULL ; +// } +// } +// } +// else if(type == 1){ +// while(GETshort_or_long_tm(temp_ptr->fields) == 0){ +// temp_ptr = temp_ptr->next_TM; +// if(temp_ptr == NULL){ +// return NULL; +// } +// } +// } +// return temp_ptr; +// } + + + #define first_type_structure( type,return_ptr) {\ + Base_tm* temp_ptr = head_ptr;\ + if(type == 0){\ + while(GETshort_or_long_tm(temp_ptr->fields) == 1){\ + temp_ptr = temp_ptr->next_TM;\ + if(temp_ptr == NULL){\ + return_ptr = NULL ;\ + }\ + }\ + }\ + else if(type == 1){\ + while(GETshort_or_long_tm(temp_ptr->fields) == 0){\ + temp_ptr = temp_ptr->next_TM;\ + if(temp_ptr == NULL){\ + return_ptr = NULL;\ + }\ + }\ + }\ + return_ptr = temp_ptr;\ + } + + + + Base_tm *T1F_pointer ; + int T1F_counter; + unsigned char TMframe_type1[TM_FRAME_SIZE]; + bool type1_frame_flag; //should be true for every new list + + #define type1_frame(ptr){\ + int i=4;\ + if(type1_frame_flag){\ + first_type_structure(1,T1F_pointer);\ + T1F_counter = 0;\ + type1_frame_flag = false;\ + }\ + for(i = 4 ; (i < 134) && (T1F_pointer != NULL) ; i++){\ + TMframe_type1[i] = T1F_pointer->TM_string[T1F_counter];\ + if(T1F_counter++ == 12){\ + T1F_counter = 0;\ + next_type_structure(T1F_pointer);\ + }\ + }\ + TMframe_type1[0] = 1<<7 + ( (i-4)/10 )<<3;\ + TMframe_type1[3] = crc16_gen(TMframe_type1,3);\ + if(T1F_pointer == NULL && i>12){\ + for( ; i < 134 ; i++){\ + TMframe_type1[i] = TMframe_type1[i-13];\ + }\ + }\ + } + + +// unsigned char * type1_frame(){ +// int i=4; +// if(type1_frame_flag){ +// T1F_pointer = first_type_structure(1); +// T1F_counter = 0; +// type1_frame_flag = false; +// } +// for(i = 4 ; (i < 134) && (T1F_pointer != NULL) ; i++){ +// TMframe_type1[i] = T1F_pointer->TM_string[T1F_counter]; +// if(T1F_counter++ == 12){ +// T1F_counter = 0; +// T1F_pointer = next_type_structure(T1F_pointer); +// } +// } +// // header +// TMframe_type1[0] = 1<<7 + ( (i-4)/10 )<<3; //( (i-4)/10 ) gives number of packets in the frame +// //insert time ; +// TMframe_type1[3] = CRC::crc16_gen(TMframe_type1,3); +// //end header +// if(T1F_pointer == NULL && i>12){ +// for( ; i < 134 ; i++){ //repeating ;ast packet to fill up the extra space +// TMframe_type1[i] = TMframe_type1[i-13]; +// } +// } +// return TMframe_type1; +// } + + bool type0_frame_flag; + + + #define type0_frame(ptr){\ + if(type0_frame_flag){\ + first_type_structure(0,T0F_pointer);\ + type0_frame_flag = false;\ + }\ + else {\ + next_type_structure(T0F_pointer);\ + }\ + ptr = T0F_pointer->TM_string;\ + } + + +// unsigned char* type0_frame(){ +// if(type0_frame_flag){ +// T0F_pointer = first_type_structure(0); +// type0_frame_flag = false; +// } +// else { +// T0F_pointer = next_type_structure(T0F_pointer); +// } +// return T0F_pointer->TM_string; +// } + + unsigned char convoluted_frame[270]; + Convolution ConvObj2; + void convolution (unsigned char * ptr){ + ConvObj2.convolutionEncode(ptr, convoluted_frame); + ConvObj2.convolutionEncode(ptr + 67, convoluted_frame + 135); + } + + + unsigned char interleave_data[2][144]; + unsigned char DS_index; + bool DS_state; + int DS_counter; + bool DS_f; + bool make_DataStream_f; +// #define make_DataStream {\ +// unsigned char* ptr;\ +// if(make_DataStream_f == true){\ +// DS_state = true;\ +// DS_counter = 0;\ +// DS_f = false;\ +// make_DataStream_f = false;\ +// }\ +// if(DS_state){\ +// if(DS_counter < total_frames-type0_no){\ +// type1_frame(ptr); \ +// DS_f = true;\ +// }\ +// else if(DS_counter < total_frames ){\ +// type0_frame(ptr);\ +// DS_f = true;\ +// }\ +// DS_counter++;\ +// }\ +// DS_state = !DS_state;\ +// if (DS_f){\ +// DS_f = false;\ +// convolution(ptr);\ +// interleave(convoluted_frame,interleave_data[0]);\ +// interleave(convoluted_frame+ 135,interleave_data[1]);\ +// }\ +// DS_index = (DS_state==true)?1:0;\ +// } + + public: + + bool reset_adf; + SND_TM(){ + MAX_SEGMENT = (MAX_ADF_LEN-T_FRAME_SIZE)/( S_FRAME_SIZE + ISR*T_FRAME_SIZE); //(max length - eos size)/(sframe length + tFrameLength*ISR) +// cout<<int(MAX_SEGMENT)<<endl; + } + + + + void head_pointer(Base_tm* ptr){ + head_ptr = ptr ; + type1_frame_flag = true; + type0_frame_flag = true; + make_DataStream_f = true; + transmit_data_f = true; + diff_prev = 0; + data_number(); +// make_DataStream; + } + + + void inline transmit_data(unsigned char * transmit , bool * last_buffer){ + if(transmit_data_f){ + RB_c = 0; + Sframe_c = 0; + SCH40_c = 0; + FCCH80_c = 0; + Tframe_c = 0; + EOS_c = 0; + segment_c = 0; + data_c = 0; + + Sframe = true; + SCH40_f = false; + data_f = false; + FCCH80_f = false; + transmit_data_f = false; + reset_adf = false; + *last_buffer = false; + } + + for(RB_c = 0 ; RB_c<112 ; RB_c++){ + + if(junk_f){ + transmit[RB_c] = 0xaa; + } + + if(Sframe){ + transmit[RB_c] = S_frame[Sframe_c++]; + if(Sframe_c == 48){ + // printf("exit s frame\n"); + Sframe_c = 0; + Sframe = false; + SCH40_f =true; + } + continue; + } +// + if(SCH40_f){ + transmit[RB_c] = SCH40[SCH40_c++]; + if(SCH40_c == 5 ){ + SCH40_c = 0; + SCH40_f = false; + data_f = true; +// printf("exit SCH40 frame\n"); + } + continue; + } +// + if(data_f){ + transmit[RB_c] = interleave_data[DS_index][data_c++]; + if(data_c == 144){ +// make_DataStream; + data_c = 0; + FCCH80_f = true; + data_f = false; +// printf("exit Data\n"); + } + continue; + } + + if(FCCH80_f){ + transmit[RB_c] = FCCH80[FCCH80_c++]; + if(FCCH80_c == 10){ + FCCH80_c = 0; + FCCH80_f = false; +// printf("exit FCCH80\n"); + if(++Tframe_c != ISR) + SCH40_f = true; + else{ + Tframe_c = 0; + segment_c++; + if(segment_c == SEGMENT_NO||segment_c == MAX_SEGMENT) + {eos_f = true;} + else{ + Sframe = true; + } + } + } + continue; + } + + if(eos_f){ + transmit[RB_c] = EoS[EOS_c++]; + if(EOS_c == EOS_SIZE){ + EOS_c = 0; + eos_f = false; + // printf("exit EOS\n"); + if(segment_c == MAX_SEGMENT){ + segment_c = 0; + SEGMENT_NO = SEGMENT_NO - MAX_SEGMENT; + reset_adf = true; + Sframe = true; + }else{ + *last_buffer = true; + } + junk_f = true; + } + continue; + } + } + + differential_encode(transmit,112); + if(reset_adf == true){ + diff_prev = 0; + junk_f = false; + } + + } + +}; +SND_TM snd_tm; \ No newline at end of file