
Repository for CDMS code
Dependencies: SimpleDMA mbed-rtos mbed eeprom
Fork of COM_MNG_TMTC_SIMPLE by
Revision 163:e4ff6c00faa2, committed 2016-04-14
- Comitter:
- ee12b079
- Date:
- Thu Apr 14 11:29:07 2016 +0000
- Parent:
- 154:9aec89c8cdc7
- Commit message:
- Compression changed;
Changed in this revision
Compression.h | Show annotated file Show diff for this revision Revisions of this file |
--- a/Compression.h Mon Apr 11 16:04:55 2016 +0000 +++ b/Compression.h Thu Apr 14 11:29:07 2016 +0000 @@ -14,6 +14,9 @@ int adjust(int size, unsigned int data, unsigned char* ptr , int space){ space = space&0x0f; + if(space == 8){ + *ptr = 0; + } data = data&((1<<size)-1); if(space >= size){ *ptr += data<<(space-size); @@ -42,10 +45,22 @@ } } +//--------------------------------------------------------beacon +struct beacon_packet{ + unsigned char data[14]; + beacon_packet *next; + int len; +}; + +int beacon_cntr = 0; +bool beacon_flag = true; +beacon_packet *head_beacon, *tail_beacon; +//--------------------------------------------------------beacon + //variable declerations -unsigned char srp_mode , at , pzf , ezf ,sfp[65] ,scp[55];; //tells which mode is calibrated or plot 0 for calibrated and 1 for scatterered, below threshold , proton zero flux, electron zero flux. +unsigned char srp_mode , at , pzf , ezf ,sfp[65] ,scp[55],beacon_at ; //tells which mode is calibrated or plot 0 for calibrated and 1 for scatterered, below threshold , proton zero flux, electron zero flux. unsigned int sfp_bin[52] , scp_bin[52]; //storing the bin values. unsigned int sfp_threshold_m0[52] = {8128,8128,8128,8128,8128,8128,8128,8128,960,960,960,960,960,960,960,960,960,960,960,960,4032,4032,4032,4032,8128,8128,8128,8128,4032,4032,124,124,60,60,60,60,60,60,60,60,60,60,60,60,60,60,60,252,252,252,252,252}; const unsigned int scp_threshold_m0[52] = {245760,245760,245760,245760,245760,245760,245760,245760,49152,49152,49152,49152,49152,49152,49152,49152,49152,49152,49152,49152,114688,114688,114688,114688,245760,245760,245760,245760,114688,114688,4032,4032,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,8128,4032,4032,4032,4032}; @@ -59,6 +74,7 @@ unsigned char *ptr ,* pointer; long long int sci_time = 0x221000000; //call some function and get the time or get in the starting, what ever akshay says int test_cntr = 0; +unsigned int beacon_threshold[9] = {114688,245760,245760,245760,245760,114688,114688,65472,65472}; //fill it bro Convolution ConvObj; void convolution (unsigned char * ptr){ @@ -122,7 +138,7 @@ sfp[i] = 0; if(srp_mode == 0){ //calibrated mode if(at == 0){ - pointer = sfp; debug_cntr = 0; + pointer = sfp; debug_cntr = 0; space = 8; space = adjust(4, attitude,pointer,8); pointer += space>>4; debug_cntr += space>>4; space = adjust(6, counter,pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(1, srp_mode,pointer,space); pointer += space>>4; debug_cntr += space>>4; @@ -339,6 +355,27 @@ break; } } + + //---------------------------------------------***********************************************************----------------------------beacon + beacon_at = 0; + if(scp_bin[44]>beacon_threshold[0]) beacon_at = 1; + if(scp_bin[49]>beacon_threshold[1]) beacon_at = 1; + if(scp_bin[50]>beacon_threshold[2]) beacon_at = 1; + if(scp_bin[51]>beacon_threshold[3]) beacon_at = 1; + if(scp_bin[52]>beacon_threshold[4]) beacon_at = 1; + if(scp_bin[17]>beacon_threshold[5]) beacon_at = 1; + if(scp_bin[23]>beacon_threshold[6]) beacon_at = 1; + proton_scp_sum = 0; electron_scp_sum = 0; + for(int i=0;i<17;i++){ + proton_scp_sum += scp_bin[i]; + } + for(int i=0; i<5; i++){ + electron_scp_sum += scp_bin[18+i]; + } + if(proton_scp_sum > beacon_threshold[7]) beacon_at =1; + if(electron_scp_sum > beacon_threshold[8]) beacon_at =1; + //--------------------------------------------*******************************************************************----------------------beacon + } else if(compression_option == 1){ if(scp_bin[44] > scp_threshold_m0_1[0]) at=1; @@ -385,6 +422,75 @@ ezf = 0; } + //------------------------------------------------------------------------beacon +// struct beacon_packet{ +// unsigned char data[12]; +// beacon_packet *next; +// }; +// +// int beacon_cntr = 0; +// bool beacon_flag = true; +// beacon_packet *head_beacon, *tail_beacon; + + if(beacon_cntr == 0){ + head_beacon = tail_beacon = new beacon_packet; + tail_beacon->next == NULL; + } + else{ + tail_beacon->next = new beacon_packet; + tail_beacon = tail_beacon->next; + tail_beacon->next == NULL; + } + pointer = tail_beacon->data; debug_cntr = 0; space = 8; + space = adjust(1, 0,pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(5,(sci_time>>8)&0x1f,pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(8, sci_time,pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(4, (attitude)&0xf,pointer,space); pointer += space>>4; debug_cntr += space>>4; + if(beacon_at == 0){ + tail_beacon->len = 12; + space = adjust(1, 0,pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(6, compress(sfp_bin[44],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(7, compress(sfp_bin[49],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(7, compress(sfp_bin[50],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(7, compress(sfp_bin[51],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(7, compress(sfp_bin[52],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(6, compress(sfp_bin[17],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(6, compress(sfp_bin[23],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(4, compress(proton_scp_sum ,10,2)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(8, compress(proton_scp_sum ,10,2),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(4, compress(electron_scp_sum ,10,2)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(8, compress(electron_scp_sum ,10,2),pointer,space); pointer += space>>4; debug_cntr += space>>4; +// cout<<"for beacon space = "<<(space&0x0f)<<" counter = "<<debug_cntr; + for(int temp_i = 12; temp_i<14; temp_i++){ + *pointer = 0; + pointer = pointer + 1; + } + } + else{ + tail_beacon->len = 14; + space = adjust(1, 0,pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(1, compress(sfp_bin[44],6,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(8, compress(sfp_bin[44],6,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(4, compress(sfp_bin[49],9,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(8, compress(sfp_bin[49],9,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(4, compress(sfp_bin[50],9,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(8, compress(sfp_bin[50],9,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(4, compress(sfp_bin[51],9,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(8, compress(sfp_bin[51],9,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(4, compress(sfp_bin[52],9,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(8, compress(sfp_bin[52],9,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(1, compress(sfp_bin[17],6,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(8, compress(sfp_bin[17],6,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(1, compress(sfp_bin[23],6,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(8, compress(sfp_bin[23],6,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(1, compress(proton_scp_sum ,6,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(8, compress(proton_scp_sum ,6,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; + space = adjust(1, compress(electron_scp_sum ,6,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4; space = adjust(8, compress(electron_scp_sum ,6,3),pointer,space); pointer += space>>4; debug_cntr += space>>4; +// cout<<"for beacon space = "<<(space&0x0f)<<" counter = "<<debug_cntr; + } + beacon_cntr++; + if(beacon_cntr ==6){ + beacon_packet *temp_bec; + temp_bec = head_beacon; + head_beacon = head_beacon->next; + delete(temp_bec); + beacon_cntr--; + } + + //------------------------------------------------------------------------beacon + gPC.puts("scp\r\n"); pointer = scp; debug_cntr = 0; space = 8;