Latest FM Code with EEPROM
Dependencies: FreescaleIAP SimpleDMA eeprom mbed-rtos mbed
Fork of CDMS_QM_03MAR2017_Flash_with_obsrs by
Diff: COM_SND_TM.h
- Revision:
- 9:e9eaada136c6
- Parent:
- 2:2caf2a9a13aa
- Child:
- 11:83acbe8e0ad1
--- a/COM_SND_TM.h Thu Dec 31 10:06:45 2015 +0000 +++ b/COM_SND_TM.h Thu Dec 31 10:19:12 2015 +0000 @@ -1,21 +1,21 @@ void adf_not_SDcard(); #define S_FRAME_SIZE 48 -#define ISR 30 +#define ISR 40 #define TM_FRAME_SIZE 134 //in bytes #define T_FRAME_SIZE 159 #define EOS_SIZE 120 -#define MAX_ADF_LEN 65535 - +#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; - + + 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 @@ -30,15 +30,17 @@ bool SCH40_f; bool FCCH80_f; bool data_f; + bool repeat_data_f; bool transmit_data_f; bool eos_f; bool junk_f; - - + bool segment_r; //flag checking if more sessions are required + + // 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++){ @@ -48,18 +50,20 @@ diff_prev = int(s & 0x01); ptr[i] = t; } - } - + } + int type0_no; //number of type zero frames - int type1_no; + int type1_no; int total_frames; //number of type one packe (TMP) int SEGMENT_NO; //number of type one packe (TMP) + int TOTAL_SEGMENT_NO; + int LAST_SEGMENT_SIZE; void inline data_number(){ int type1_frame_no; Base_tm*head = head_ptr; type0_no = 0; type1_no = 0; - while(head != NULL){ + while(head->next_TM != NULL){ switch( GETshort_or_long_tm(head->fields) ){ case 0: type0_no++; @@ -68,13 +72,23 @@ 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 + 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 + SEGMENT_NO = TOTAL_SEGMENT_NO; + if(SEGMENT_NO > MAX_SEGMENT) + { + SEGMENT_NO = MAX_SEGMENT; + segment_r = 1; + } + else segment_r = 0; + TOTAL_SEGMENT_NO -= SEGMENT_NO; + LAST_SEGMENT_SIZE = total_frames*2%ISR; } - + #define next_type_structure(ptr){\ unsigned char temp = GETshort_or_long_tm(ptr->fields);\ if((temp == 0) && (ptr->next_TM != NULL) ){\ @@ -85,7 +99,6 @@ while(temp == 1 && ptr->next_TM != NULL);\ if(temp == 1){\ ptr = NULL;\ - break;\ }\ }\ else if((temp == 1) && (ptr->next_TM != NULL)){\ @@ -95,19 +108,18 @@ }\ while(temp == 0 && ptr->next_TM != NULL);\ if(temp == 0){\ - ptr NULL;\ - break;\ + ptr = NULL;\ }\ }\ else{\ - ptr NULL;\ + 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 + return: pointer of the first node having same type */ // Base_tm* first_type_structure(int type){ // Base_tm* temp_ptr = head_ptr; @@ -116,21 +128,21 @@ // 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 NULL; +// } +// } +// } // return temp_ptr; // } - - + + #define first_type_structure( type,return_ptr) {\ Base_tm* temp_ptr = head_ptr;\ if(type == 0){\ @@ -151,14 +163,14 @@ }\ 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){\ @@ -180,9 +192,10 @@ TMframe_type1[i] = TMframe_type1[i-13];\ }\ }\ + ptr=TMframe_type1;\ } - - + + // unsigned char * type1_frame(){ // int i=4; // if(type1_frame_flag){ @@ -204,15 +217,15 @@ // //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]; +// 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);\ @@ -223,28 +236,28 @@ }\ ptr = T0F_pointer->TM_string;\ } - - + + // unsigned char* type0_frame(){ // if(type0_frame_flag){ -// T0F_pointer = first_type_structure(0); +// 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]; + + 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 interleave_data[2][144]; unsigned char DS_index; bool DS_state; int DS_counter; @@ -278,17 +291,49 @@ // }\ // DS_index = (DS_state==true)?1:0;\ // } - + +#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) + MAX_SEGMENTMAX_SEGMENT = (MAX_ADF_LEN-EOS_SIZE)/( S_FRAME_SIZE + ISR*T_FRAME_SIZE); + //MAX_SEGMENT = 1; + //(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; @@ -297,11 +342,11 @@ transmit_data_f = true; diff_prev = 0; data_number(); -// make_DataStream; - gPC.putc('z'); + // make_DataStream; +// gPC.putc('z'); } - - + + void inline transmit_data(unsigned char * transmit , bool * last_buffer){ if(transmit_data_f){ RB_c = 0; @@ -312,7 +357,7 @@ EOS_c = 0; segment_c = 0; data_c = 0; - + Sframe = true; SCH40_f = false; data_f = false; @@ -321,13 +366,14 @@ reset_adf = false; *last_buffer = false; } - + for(RB_c = 0 ; RB_c<112 ; RB_c++){ - - if(junk_f){ - transmit[RB_c] = 0xaa; + + if(junk_f || *last_buffer){ + transmit[RB_c] = 0x00; + continue; } - + if(Sframe){ transmit[RB_c] = S_frame[Sframe_c++]; if(Sframe_c == 48){ @@ -338,22 +384,32 @@ } continue; } -// +// if(SCH40_f){ - transmit[RB_c] = SCH40[SCH40_c++]; + transmit[RB_c] = SCH40[SCH40_c++]; if(SCH40_c == 5 ){ SCH40_c = 0; - SCH40_f = false; - data_f = true; + SCH40_f = false; + + + if(Tframe_c >= LAST_SEGMENT_SIZE && segment_r == 0) + { + repeat_data_f = true; + DS_index = !DS_index; + } + else + { + data_f = true; + make_DataStream; + } // 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; @@ -361,7 +417,17 @@ } continue; } - + if(repeat_data_f){ + transmit[RB_c] = interleave_data[DS_index][data_c++]; + if(data_c == 144){ + data_c = 0; + FCCH80_f = true; + repeat_data_f = false; +// printf("exit Data\n"); + } + continue; + } + if(FCCH80_f){ transmit[RB_c] = FCCH80[FCCH80_c++]; if(FCCH80_c == 10){ @@ -369,11 +435,11 @@ FCCH80_f = false; // printf("exit FCCH80\n"); if(++Tframe_c != ISR) - SCH40_f = true; + SCH40_f = true; else{ Tframe_c = 0; segment_c++; - if(segment_c == SEGMENT_NO||segment_c == MAX_SEGMENT) + if(segment_c == SEGMENT_NO) {eos_f = true;} else{ Sframe = true; @@ -381,35 +447,50 @@ } } continue; - } - - if(eos_f){ + } + + 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; - } +// if(segment_c == MAX_SEGMENT){ +// segment_c = 0; +// SEGMENT_NO = SEGMENT_NO - MAX_SEGMENT; +// reset_adf = true;//what does this do?? +// Sframe = true; +// }else{ +// *last_buffer = true; +// } + if(segment_c == SEGMENT_NO && segment_r == 0){ + *last_buffer = true; + } + else if(segment_c == SEGMENT_NO && segment_r != 0){ + segment_c = 0; + SEGMENT_NO = TOTAL_SEGMENT_NO; + if(SEGMENT_NO > MAX_SEGMENT) + { + SEGMENT_NO = MAX_SEGMENT; + segment_r = 1; + } + else segment_r = 0; + TOTAL_SEGMENT_NO -= SEGMENT_NO; + reset_adf = true;//what does this do?? + Sframe = 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