Shreesha S / Mbed 2 deprecated COM_MNG_TMTC_SIMPLE

Simple version of COM_MNG_TMTC_CODE for IITMSAT.

Dependencies:   mbed-rtos mbed FreescaleIAP SimpleDMA

Compression.h@163:e4ff6c00faa2, 2016-04-14 (annotated)

Committer:
ee12b079
Date:
Thu Apr 14 11:29:07 2016 +0000
Revision:
163:e4ff6c00faa2
Parent:
114:9fb55057b13f 
Compression changed;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ee12b079 93:4d76de54a699 1 unsigned int read_2byte(unsigned char* ptr){
ee12b079 93:4d76de54a699 2 unsigned int output = (unsigned int) *(ptr+1);
ee12b079 93:4d76de54a699 3 output += ( (unsigned int)(*ptr) ) << 8;
ee12b079 93:4d76de54a699 4 return output;
ee12b079 93:4d76de54a699 5 }
shreeshas95 1:a0055b3280c8 6
ee12b079 93:4d76de54a699 7 unsigned int read_4byte(unsigned char* ptr){
ee12b079 93:4d76de54a699 8 unsigned int output = (unsigned int) *(ptr+3);
ee12b079 93:4d76de54a699 9 output += (unsigned int)*(ptr+2)<<8;
ee12b079 93:4d76de54a699 10 output += (unsigned int)*(ptr+1)<<16;
ee12b079 93:4d76de54a699 11 output += (unsigned int)*(ptr)<<24;
ee12b079 93:4d76de54a699 12 return output;
ee12b079 93:4d76de54a699 13 }
ee12b079 93:4d76de54a699 14
ee12b079 93:4d76de54a699 15 int adjust(int size, unsigned int data, unsigned char* ptr , int space){
ee12b079 93:4d76de54a699 16 space = space&0x0f;
ee12b079 163:e4ff6c00faa2 17 if(space == 8){
ee12b079 163:e4ff6c00faa2 18 *ptr = 0;
ee12b079 163:e4ff6c00faa2 19 }
ee12b079 93:4d76de54a699 20 data = data&((1<<size)-1);
ee12b079 93:4d76de54a699 21 if(space >= size){
ee12b079 93:4d76de54a699 22 *ptr += data<<(space-size);
ee12b079 93:4d76de54a699 23 if(space - size == 0){
ee12b079 93:4d76de54a699 24 return 0x18;
ee12b079 93:4d76de54a699 25 }else{
ee12b079 93:4d76de54a699 26 return space-size;
shreeshas95 1:a0055b3280c8 27 }
ee12b079 93:4d76de54a699 28 }else{
ee12b079 93:4d76de54a699 29 ptr[0] += data>>(size-space);
ee12b079 93:4d76de54a699 30 ptr[1] = (data<<(8-(size-space)))&0xff ;
ee12b079 93:4d76de54a699 31 return 0x10 + 8-(size - space);
ee12b079 93:4d76de54a699 32 }
ee12b079 93:4d76de54a699 33 }
ee12b079 93:4d76de54a699 34
ee12b079 93:4d76de54a699 35
ee12b079 93:4d76de54a699 36 int compress (int data, int x, int y){ //to be compressed with scheme (msb x)*4^y ;
ee12b079 93:4d76de54a699 37 for(int i = 0 ; i < 1<<y ; i++){
ee12b079 93:4d76de54a699 38 if(data <= ( (1<<x)-1) * (1<<(2*i)) ){
ee12b079 93:4d76de54a699 39 return ( ((data>>i*2)<<y) + i);
shreeshas95 1:a0055b3280c8 40 }
ee12b079 93:4d76de54a699 41 }
ee12b079 93:4d76de54a699 42 if ( data > ( (1<<x)-1) * (1<<(2*((1<<y)-1))) ){
ee12b079 93:4d76de54a699 43 // cout <<"compression exception"<<endl;
ee12b079 93:4d76de54a699 44 return 0;
ee12b079 93:4d76de54a699 45 }
ee12b079 93:4d76de54a699 46 }
ee12b079 93:4d76de54a699 47
ee12b079 163:e4ff6c00faa2 48 //--------------------------------------------------------beacon
ee12b079 163:e4ff6c00faa2 49 struct beacon_packet{
ee12b079 163:e4ff6c00faa2 50 unsigned char data[14];
ee12b079 163:e4ff6c00faa2 51 beacon_packet *next;
ee12b079 163:e4ff6c00faa2 52 int len;
ee12b079 163:e4ff6c00faa2 53 };
ee12b079 163:e4ff6c00faa2 54
ee12b079 163:e4ff6c00faa2 55 int beacon_cntr = 0;
ee12b079 163:e4ff6c00faa2 56 bool beacon_flag = true;
ee12b079 163:e4ff6c00faa2 57 beacon_packet *head_beacon, *tail_beacon;
ee12b079 163:e4ff6c00faa2 58 //--------------------------------------------------------beacon
ee12b079 163:e4ff6c00faa2 59
ee12b079 93:4d76de54a699 60
ee12b079 93:4d76de54a699 61
ee12b079 93:4d76de54a699 62 //variable declerations
ee12b079 163:e4ff6c00faa2 63 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.
ee12b079 93:4d76de54a699 64 unsigned int sfp_bin[52] , scp_bin[52]; //storing the bin values.
ee12b079 93:4d76de54a699 65 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};
ee12b079 93:4d76de54a699 66 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};
ee12b079 93:4d76de54a699 67 unsigned int scp_threshold_m0_1[9]={114688,245760,245760,245760,245760,114688,114688,65472,65472} ; //for mode 0..ie callibrated mode
ee12b079 93:4d76de54a699 68 const unsigned int sfp_threshold_m1[2] ={252,8128},scp_threshold_m1[2]={7680,245760};
ee12b079 93:4d76de54a699 69 unsigned char frames[3][134] = {0};
ee12b079 93:4d76de54a699 70 unsigned char position_tm_frame[3] = {8,11,5} , position_tm_starting[3] = {8,11,5}; //{sc,sf-bt,sf-at}
ee12b079 93:4d76de54a699 71 unsigned char id; //sf = 0,sc-at = 1,sc-bt = 2;
ee12b079 93:4d76de54a699 72 unsigned char TM_interleave_data[512] , TM_convoluted_data[270] = {0};
ee12b079 99:efde3df6cd94 73 int proton_scp_sum,electron_scp_sum,length, temp_crc,attitude = 0,FSC_science = 1,debug_cntr = 0, size,space;
ee12b079 93:4d76de54a699 74 unsigned char *ptr ,* pointer;
ee12b079 93:4d76de54a699 75 long long int sci_time = 0x221000000; //call some function and get the time or get in the starting, what ever akshay says
ee12b079 99:efde3df6cd94 76 int test_cntr = 0;
ee12b079 163:e4ff6c00faa2 77 unsigned int beacon_threshold[9] = {114688,245760,245760,245760,245760,114688,114688,65472,65472}; //fill it bro
ee12b079 93:4d76de54a699 78
ee12b079 93:4d76de54a699 79 Convolution ConvObj;
ee12b079 93:4d76de54a699 80 void convolution (unsigned char * ptr){
ee12b079 93:4d76de54a699 81 ConvObj.convolutionEncode(ptr, TM_convoluted_data);
ee12b079 93:4d76de54a699 82 ConvObj.convolutionEncode(ptr + 67, TM_convoluted_data + 135);
ee12b079 93:4d76de54a699 83 }
ee12b079 93:4d76de54a699 84
ee12b079 93:4d76de54a699 85 //give the pointer of 6 second data to this function
ee12b079 93:4d76de54a699 86 void srp(unsigned char * head){
ee12b079 98:fd99ddc0e0a1 87 //sci_time = FCTN_CDMS_RD_RTC();
ee12b079 98:fd99ddc0e0a1 88 sci_time = 0;
ee12b079 98:fd99ddc0e0a1 89 gPC.puts("enter srp");
ee12b079 98:fd99ddc0e0a1 90
ee12b079 93:4d76de54a699 91 for (int i = 0; i < 52 ; i++){
ee12b079 93:4d76de54a699 92 scp_bin[i] = 0;
shreeshas95 1:a0055b3280c8 93 }
ee12b079 93:4d76de54a699 94 ptr = head + 3;
ee12b079 93:4d76de54a699 95 srp_mode = head[2]&0x1;
ee12b079 93:4d76de54a699 96 at = 0; //above threshold is false
ee12b079 93:4d76de54a699 97 for(int counter = 0 ; counter < 60 ; counter++){
ee12b079 93:4d76de54a699 98 pzf = 1; ezf = 1;
ee12b079 93:4d76de54a699 99 if(srp_mode == 0){ //calibrated mode
ee12b079 93:4d76de54a699 100 for(int i=0; i<48 ; i++){
ee12b079 93:4d76de54a699 101 sfp_bin[i] = read_2byte(ptr + i*2);
ee12b079 93:4d76de54a699 102 scp_bin[i] += sfp_bin[i];
ee12b079 93:4d76de54a699 103 if(sfp_bin[i]>sfp_threshold_m0[i]){
ee12b079 93:4d76de54a699 104 at = 1;
ee12b079 93:4d76de54a699 105 }
ee12b079 93:4d76de54a699 106 if(i<17){
ee12b079 93:4d76de54a699 107 if(sfp_bin[i] > 0)
ee12b079 93:4d76de54a699 108 pzf = 0;
ee12b079 93:4d76de54a699 109 }
ee12b079 93:4d76de54a699 110 else if (i>17 && i < 23){
ee12b079 93:4d76de54a699 111 if(sfp_bin[i]>0)
ee12b079 93:4d76de54a699 112 ezf = 0;
ee12b079 93:4d76de54a699 113 }
ee12b079 93:4d76de54a699 114 }
ee12b079 93:4d76de54a699 115 for(int i=0; i<4; i++){
ee12b079 93:4d76de54a699 116 sfp_bin[i+48] = read_4byte( (ptr+96) + 4*i );
ee12b079 93:4d76de54a699 117 scp_bin[i+48] += sfp_bin[i+48];
ee12b079 93:4d76de54a699 118 if(sfp_bin[i+48]>sfp_threshold_m0[i+48])
ee12b079 93:4d76de54a699 119 at = 1;
ee12b079 93:4d76de54a699 120 }
ee12b079 93:4d76de54a699 121 }
ee12b079 93:4d76de54a699 122 else if(srp_mode == 1){ //scattered mode
ee12b079 93:4d76de54a699 123 for(int i = 0; i <32; i++){
ee12b079 93:4d76de54a699 124 sfp_bin[i] = read_2byte(ptr+2*i);
ee12b079 93:4d76de54a699 125 scp_bin[i] += sfp_bin[i];
ee12b079 93:4d76de54a699 126 if(sfp_bin[i] > sfp_threshold_m1[0])
ee12b079 93:4d76de54a699 127 at = 1;
ee12b079 93:4d76de54a699 128 }
ee12b079 93:4d76de54a699 129 for(int i = 0; i < 4 ; i++){
ee12b079 93:4d76de54a699 130 sfp_bin[i+32] = read_4byte( (ptr+64) + 4*i );
ee12b079 93:4d76de54a699 131 scp_bin[i+32] += sfp_bin[i+32];
ee12b079 93:4d76de54a699 132 if(sfp_bin[i+32] > sfp_threshold_m1[1])
ee12b079 93:4d76de54a699 133 at = 1;
ee12b079 93:4d76de54a699 134 }
shreeshas95 1:a0055b3280c8 135 }
ee12b079 93:4d76de54a699 136 ptr = ptr + 112;
ee12b079 93:4d76de54a699 137 for(int i = 0; i<65; i++)
ee12b079 93:4d76de54a699 138 sfp[i] = 0;
ee12b079 93:4d76de54a699 139 if(srp_mode == 0){ //calibrated mode
ee12b079 93:4d76de54a699 140 if(at == 0){
ee12b079 163:e4ff6c00faa2 141 pointer = sfp; debug_cntr = 0; space = 8;
ee12b079 93:4d76de54a699 142 space = adjust(4, attitude,pointer,8); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 143 space = adjust(6, counter,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 144 space = adjust(1, srp_mode,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 145 space = adjust(1, pzf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 146 space = adjust(1, ezf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 147 for(int i = 0 ; i < 8 ; i++){
ee12b079 93:4d76de54a699 148 space = adjust(1, ((compress(sfp_bin[24+i],7,2))&0x100)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 149 space = adjust(8, ((compress(sfp_bin[24+i],7,2))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 150 }
ee12b079 93:4d76de54a699 151 for(int i = 0 ; i <12 ; i++){
ee12b079 93:4d76de54a699 152 space = adjust(6, (compress(sfp_bin[32+i],4,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 153 }
ee12b079 93:4d76de54a699 154 for(int i = 0; i < 4; i++){
ee12b079 93:4d76de54a699 155 space = adjust(8, (compress(sfp_bin[44+i],6,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 156 }
ee12b079 93:4d76de54a699 157 for(int i = 0 ; i < 4 ; i++){
ee12b079 93:4d76de54a699 158 space = adjust(1, (compress(sfp_bin[48+i],7,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 159 space = adjust(8, compress(sfp_bin[48+i],7,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 160 }
ee12b079 93:4d76de54a699 161 space = adjust(8, ((compress(sfp_bin[17],6,2))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 162 space = adjust(8, ((compress(sfp_bin[23],6,2))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 163 if(pzf == 0){
ee12b079 93:4d76de54a699 164 for(int i = 0; i<2 ; i++){
ee12b079 93:4d76de54a699 165 space = adjust(6, ((compress(sfp_bin[i],5,1))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 166 }
ee12b079 93:4d76de54a699 167 for(int i = 0; i<15 ; i++){
ee12b079 93:4d76de54a699 168 space = adjust(5, ((compress(sfp_bin[i+2],4,1))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 169 }
ee12b079 93:4d76de54a699 170 }
ee12b079 93:4d76de54a699 171 if(ezf == 0){
ee12b079 93:4d76de54a699 172 for(int i = 0; i <5 ;i++){
ee12b079 93:4d76de54a699 173 space = adjust(7, ((compress(sfp_bin[18+i],6,1))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 174 }
ee12b079 93:4d76de54a699 175 }
ee12b079 93:4d76de54a699 176 }//below thershold ends here.
shreeshas95 1:a0055b3280c8 177
ee12b079 98:fd99ddc0e0a1 178 //gPC.puts("below_thresh\r\n");
ee12b079 98:fd99ddc0e0a1 179
ee12b079 93:4d76de54a699 180 if(at == 1){
ee12b079 93:4d76de54a699 181 pointer = sfp + 6; debug_cntr = 6;space = 8;
ee12b079 93:4d76de54a699 182 sfp[0] = (sci_time>>27)&0xff; sfp[1] = (sci_time>>19)&0xff; sfp[2] = (sci_time>>11)&0xff; sfp[3] = (sci_time>>3)&0xff;
ee12b079 93:4d76de54a699 183 sfp[4] = ((sci_time&0x07)<<5) + ((attitude&0x0f)<<1) + (counter>>5);
ee12b079 93:4d76de54a699 184 sfp[5] = ((counter&0x0f)<<3) + (srp_mode<<2);
ee12b079 93:4d76de54a699 185 sfp[5] += (pzf<<1) + ezf ;
ee12b079 93:4d76de54a699 186 for(int i = 0 ; i < 8 ; i++){
ee12b079 93:4d76de54a699 187 space = adjust(1, (compress(sfp_bin[24+i],7,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 188 space = adjust(8, ((compress(sfp_bin[24+i],7,2))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
shreeshas95 1:a0055b3280c8 189 }
ee12b079 93:4d76de54a699 190 for(int i = 0 ; i <12 ; i++){
ee12b079 93:4d76de54a699 191 space = adjust(6, ((compress(sfp_bin[32+i],3,3))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
shreeshas95 1:a0055b3280c8 192 }
ee12b079 93:4d76de54a699 193 for(int i = 0 ; i < 4 ; i++){
ee12b079 93:4d76de54a699 194 space = adjust(2, (compress(sfp_bin[44+i],8,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 195 space = adjust(8, compress(sfp_bin[44+i],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
shreeshas95 1:a0055b3280c8 196 }
ee12b079 93:4d76de54a699 197 for(int i = 0 ; i < 4 ; i++){
ee12b079 93:4d76de54a699 198 space = adjust(1, (compress(sfp_bin[48+i],6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 199 space = adjust(8, compress(sfp_bin[48+i],6,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 200 }
ee12b079 93:4d76de54a699 201 space = adjust(2, (compress(sfp_bin[17],8,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 202 space = adjust(8, compress(sfp_bin[17],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 203 space = adjust(2, (compress(sfp_bin[23],8,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 204 space = adjust(8, compress(sfp_bin[23],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
shreeshas95 1:a0055b3280c8 205
ee12b079 93:4d76de54a699 206 if(pzf == 0){
ee12b079 93:4d76de54a699 207 // cout<<"proton bins ";
ee12b079 93:4d76de54a699 208 for(int i = 0; i<17 ; i++){
ee12b079 93:4d76de54a699 209 space = adjust(2, ((compress(sfp_bin[i],8,2))>>8) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 210 space = adjust(8, compress(sfp_bin[i],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 211 // printf("%02X ",compress(sfp_bin[i],8,2));
ee12b079 93:4d76de54a699 212 }
ee12b079 93:4d76de54a699 213 }
ee12b079 93:4d76de54a699 214 if(ezf == 0){
ee12b079 93:4d76de54a699 215 // cout<<"electron bins ";
ee12b079 93:4d76de54a699 216 for(int i = 0; i<5 ; i++){
ee12b079 93:4d76de54a699 217 space = adjust(2, ((compress(sfp_bin[18+i],8,2))>>8) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 218 space = adjust(8, compress(sfp_bin[18+i],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 219 // printf("%02X ",compress(sfp_bin[i],8,2));
ee12b079 93:4d76de54a699 220 }
ee12b079 93:4d76de54a699 221 }
ee12b079 93:4d76de54a699 222 // cout<<debug_cntr<<" "<<(space&0xf)<<endl;
ee12b079 93:4d76de54a699 223 // cout<<"packet ";
ee12b079 93:4d76de54a699 224 // for(int i = 0; i< 64; i++){
ee12b079 93:4d76de54a699 225 // cout<<bitset<8>(sfp[i]);
ee12b079 93:4d76de54a699 226 // }
ee12b079 93:4d76de54a699 227 // cout<<"ends"<<endl;
ee12b079 93:4d76de54a699 228 }//above threshold ends here.
ee12b079 93:4d76de54a699 229 }else if(srp_mode == 1){ //scattered mode
ee12b079 93:4d76de54a699 230 if(at == 0){
ee12b079 93:4d76de54a699 231 pointer = sfp; debug_cntr = 0; space = 8;
ee12b079 93:4d76de54a699 232 space = adjust(4, attitude,pointer,8); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 233 space = adjust(6, counter,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 234 space = adjust(1, srp_mode,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 235 for(int i=0; i<32; i++){
ee12b079 93:4d76de54a699 236 space = adjust(7, compress(sfp_bin[i],6,1) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 237 }
ee12b079 93:4d76de54a699 238 for(int i = 0 ; i < 4 ; i++){
ee12b079 93:4d76de54a699 239 space = adjust(1, (compress(sfp_bin[32+i],7,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 240 space = adjust(8, compress(sfp_bin[32+i],7,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 241 }
ee12b079 93:4d76de54a699 242 }
ee12b079 93:4d76de54a699 243 if(at == 1){
ee12b079 93:4d76de54a699 244 pointer = sfp; debug_cntr = 0; space = 8;
ee12b079 93:4d76de54a699 245 space = adjust(3, sci_time>>32 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 246 space = adjust(8, sci_time>>24 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 247 space = adjust(8, sci_time>>16 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 248 space = adjust(8, sci_time>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 249 space = adjust(8, sci_time ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 250 space = adjust(4, attitude,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 251 space = adjust(6, counter,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 252 space = adjust(1, srp_mode,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 253 for(int i=0; i<32; i++){
ee12b079 93:4d76de54a699 254 space = adjust(2, (compress(sfp_bin[i],8,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 255 space = adjust(8, compress(sfp_bin[i],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 256 }
ee12b079 93:4d76de54a699 257 for(int i = 0 ; i < 4 ; i++){
ee12b079 93:4d76de54a699 258 space = adjust(1, (compress(sfp_bin[32+i],6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 259 space = adjust(8, compress(sfp_bin[32+i],6,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 260 }
ee12b079 93:4d76de54a699 261 }
ee12b079 93:4d76de54a699 262 }
ee12b079 98:fd99ddc0e0a1 263
ee12b079 98:fd99ddc0e0a1 264 //gPC.puts("sci fine pack\r\n");
ee12b079 93:4d76de54a699 265 //science fine packet is complete here.
ee12b079 93:4d76de54a699 266 //lets try to make frame now******************************************************************************************************************************
ee12b079 93:4d76de54a699 267 if(srp_mode == 0){
ee12b079 93:4d76de54a699 268 if(at == 0){
ee12b079 93:4d76de54a699 269 id = 1; length = 241;
ee12b079 93:4d76de54a699 270 if(pzf == 0)
ee12b079 93:4d76de54a699 271 length += 87;
ee12b079 93:4d76de54a699 272 if(ezf == 0)
ee12b079 93:4d76de54a699 273 length += 35;
ee12b079 93:4d76de54a699 274 }else{
ee12b079 93:4d76de54a699 275 id = 2; length = 288;
ee12b079 93:4d76de54a699 276 if(pzf == 0)
ee12b079 93:4d76de54a699 277 length += 170;
ee12b079 93:4d76de54a699 278 if(ezf == 0)
ee12b079 93:4d76de54a699 279 length += 50;
ee12b079 93:4d76de54a699 280 }
shreeshas95 1:a0055b3280c8 281 }
ee12b079 93:4d76de54a699 282 else if(srp_mode == 1){
ee12b079 93:4d76de54a699 283 if(at == 0){
ee12b079 93:4d76de54a699 284 id = 1; length = 272;
ee12b079 93:4d76de54a699 285 }else{
ee12b079 93:4d76de54a699 286 id = 2; length = 408;
ee12b079 93:4d76de54a699 287 }
shreeshas95 1:a0055b3280c8 288 }
ee12b079 93:4d76de54a699 289 length = (length%8==0)?(length/8):(length/8)+1;
ee12b079 93:4d76de54a699 290 for(int j=0 ; j<length ;j++){
ee12b079 93:4d76de54a699 291 // printf("%02X",sfp[j]);
ee12b079 93:4d76de54a699 292 frames[id][position_tm_frame[id]] = sfp[j];
ee12b079 93:4d76de54a699 293 position_tm_frame[id]++;
ee12b079 93:4d76de54a699 294 if(position_tm_frame[id] == 132){ //space full in the frame bro
ee12b079 93:4d76de54a699 295 pointer = frames[id];
ee12b079 93:4d76de54a699 296 if(id == 1){ //below thereshold
ee12b079 93:4d76de54a699 297 space = adjust(1,0,pointer,8);
ee12b079 93:4d76de54a699 298 space = adjust(4,3,pointer,space);
ee12b079 99:efde3df6cd94 299 FSC_science = FCTN_SD_MNGR(3);
ee12b079 96:4ca92f9775e0 300 //gPC.printf("SID = 3, FSC = %02X\r\n", FSC_science);
ee12b079 93:4d76de54a699 301 frames[id][1] = (FSC_science>>24)&0xff;
ee12b079 93:4d76de54a699 302 frames[id][2] = (FSC_science>>16)&0xff;
ee12b079 93:4d76de54a699 303 frames[id][3] = (FSC_science>>8)&0xff;
ee12b079 93:4d76de54a699 304 frames[id][4] = FSC_science&0xff;
ee12b079 93:4d76de54a699 305 frames[id][6] = (sci_time>>32)&0xff;
ee12b079 93:4d76de54a699 306 frames[id][7] = (sci_time>>24)&0xff;
ee12b079 93:4d76de54a699 307 frames[id][8] = (sci_time>>16)&0xff;
ee12b079 93:4d76de54a699 308 frames[id][9] = (sci_time>>8)&0xff;
ee12b079 93:4d76de54a699 309 frames[id][10] = (sci_time)&0xff;
ee12b079 93:4d76de54a699 310 }else if(id == 2){
ee12b079 93:4d76de54a699 311 space = adjust(1,0,pointer,8);
ee12b079 93:4d76de54a699 312 space = adjust(4,2,pointer,space);
ee12b079 99:efde3df6cd94 313 // FSC_science = FCTN_SD_MNGR(2);
ee12b079 99:efde3df6cd94 314
ee12b079 96:4ca92f9775e0 315 //gPC.printf("SID = 2, FSC = %02X\r\n", FSC_science);
ee12b079 93:4d76de54a699 316 frames[id][1] = (FSC_science>>16)&0xff;
ee12b079 93:4d76de54a699 317 frames[id][2] = (FSC_science>>8)&0xff;
ee12b079 93:4d76de54a699 318 frames[id][3] = FSC_science&0xff;
ee12b079 93:4d76de54a699 319 }
ee12b079 93:4d76de54a699 320 temp_crc = crc16_gen(frames[id],132);
ee12b079 93:4d76de54a699 321 frames[id][132] = temp_crc>>8;
ee12b079 93:4d76de54a699 322 frames[id][133] = temp_crc & 0xff;
ee12b079 100:484a687431cc 323 if(test_cntr++ == 0){
ee12b079 99:efde3df6cd94 324 gPC.puts("frame start\r\n");
ee12b079 99:efde3df6cd94 325 for(int i = 0; i<134; i++){
ee12b079 99:efde3df6cd94 326 gPC.printf("%02X",frames[id][i]);
ee12b079 99:efde3df6cd94 327 }
ee12b079 99:efde3df6cd94 328 gPC.puts("frame ends\r\n");
ee12b079 100:484a687431cc 329 }
ee12b079 114:9fb55057b13f 330 exor(frames[id]);
ee12b079 93:4d76de54a699 331 convolution(frames[id]);
ee12b079 93:4d76de54a699 332 interleave(TM_convoluted_data,TM_interleave_data);
ee12b079 93:4d76de54a699 333 interleave(TM_convoluted_data+ 135,TM_interleave_data + 144);
ee12b079 93:4d76de54a699 334 if(id == 1)
ee12b079 99:efde3df6cd94 335 SD_WRITE(TM_interleave_data,FSC_science,3);
ee12b079 93:4d76de54a699 336 else if (id == 2)
ee12b079 99:efde3df6cd94 337 SD_WRITE(TM_interleave_data,FSC_science,2);
ee12b079 99:efde3df6cd94 338 FSC_science++; //remove this after testing
ee12b079 93:4d76de54a699 339 position_tm_frame[id] = position_tm_starting[id];
ee12b079 93:4d76de54a699 340 frames[id][6-id] = (length-1) - j; // first head pointer.
ee12b079 93:4d76de54a699 341 }
shreeshas95 1:a0055b3280c8 342 }
shreeshas95 1:a0055b3280c8 343
ee12b079 93:4d76de54a699 344 }//for loop bracket which runs 60 times
shreeshas95 1:a0055b3280c8 345
ee12b079 93:4d76de54a699 346 //---------------below is scp --------------**************************************************************************************************
ee12b079 93:4d76de54a699 347 at = 0; pzf = 1; ezf = 1;
ee12b079 93:4d76de54a699 348 srp_mode = head[2]&0x1;
ee12b079 93:4d76de54a699 349 unsigned char compression_option = (head[2]>>1)&0x3; //--------------------------------------------------------------------------------------
ee12b079 93:4d76de54a699 350 if(srp_mode ==0){
ee12b079 93:4d76de54a699 351 if(compression_option == 0){
ee12b079 93:4d76de54a699 352 for(int i=0; i<52 ;i++){
ee12b079 93:4d76de54a699 353 if(scp_bin[i] > scp_threshold_m0[i]){
ee12b079 93:4d76de54a699 354 at = 1;
shreeshas95 1:a0055b3280c8 355 break;
shreeshas95 1:a0055b3280c8 356 }
shreeshas95 1:a0055b3280c8 357 }
ee12b079 163:e4ff6c00faa2 358
ee12b079 163:e4ff6c00faa2 359 //---------------------------------------------***********************************************************----------------------------beacon
ee12b079 163:e4ff6c00faa2 360 beacon_at = 0;
ee12b079 163:e4ff6c00faa2 361 if(scp_bin[44]>beacon_threshold[0]) beacon_at = 1;
ee12b079 163:e4ff6c00faa2 362 if(scp_bin[49]>beacon_threshold[1]) beacon_at = 1;
ee12b079 163:e4ff6c00faa2 363 if(scp_bin[50]>beacon_threshold[2]) beacon_at = 1;
ee12b079 163:e4ff6c00faa2 364 if(scp_bin[51]>beacon_threshold[3]) beacon_at = 1;
ee12b079 163:e4ff6c00faa2 365 if(scp_bin[52]>beacon_threshold[4]) beacon_at = 1;
ee12b079 163:e4ff6c00faa2 366 if(scp_bin[17]>beacon_threshold[5]) beacon_at = 1;
ee12b079 163:e4ff6c00faa2 367 if(scp_bin[23]>beacon_threshold[6]) beacon_at = 1;
ee12b079 163:e4ff6c00faa2 368 proton_scp_sum = 0; electron_scp_sum = 0;
ee12b079 163:e4ff6c00faa2 369 for(int i=0;i<17;i++){
ee12b079 163:e4ff6c00faa2 370 proton_scp_sum += scp_bin[i];
ee12b079 163:e4ff6c00faa2 371 }
ee12b079 163:e4ff6c00faa2 372 for(int i=0; i<5; i++){
ee12b079 163:e4ff6c00faa2 373 electron_scp_sum += scp_bin[18+i];
ee12b079 163:e4ff6c00faa2 374 }
ee12b079 163:e4ff6c00faa2 375 if(proton_scp_sum > beacon_threshold[7]) beacon_at =1;
ee12b079 163:e4ff6c00faa2 376 if(electron_scp_sum > beacon_threshold[8]) beacon_at =1;
ee12b079 163:e4ff6c00faa2 377 //--------------------------------------------*******************************************************************----------------------beacon
ee12b079 163:e4ff6c00faa2 378
ee12b079 93:4d76de54a699 379 }
ee12b079 93:4d76de54a699 380 else if(compression_option == 1){
ee12b079 93:4d76de54a699 381 if(scp_bin[44] > scp_threshold_m0_1[0]) at=1;
ee12b079 93:4d76de54a699 382 for(int i=0; i<4 ;i++){
ee12b079 93:4d76de54a699 383 if(scp_bin[48+i] > scp_threshold_m0_1[i+1]){
ee12b079 93:4d76de54a699 384 at = 1;
ee12b079 93:4d76de54a699 385 break;
ee12b079 93:4d76de54a699 386 }
shreeshas95 1:a0055b3280c8 387 }
ee12b079 93:4d76de54a699 388 if(scp_bin[17] > scp_threshold_m0_1[5]) at=1;
ee12b079 93:4d76de54a699 389 if(scp_bin[23] > scp_threshold_m0_1[6]) at=1;
ee12b079 93:4d76de54a699 390
ee12b079 93:4d76de54a699 391 proton_scp_sum = 0; electron_scp_sum = 0;
ee12b079 93:4d76de54a699 392 for(int i=0;i<17;i++){
ee12b079 93:4d76de54a699 393 proton_scp_sum += scp_bin[i];
shreeshas95 1:a0055b3280c8 394 }
ee12b079 93:4d76de54a699 395 for(int i=0; i<5; i++){
ee12b079 93:4d76de54a699 396 electron_scp_sum += scp_bin[18+i];
ee12b079 93:4d76de54a699 397 }
ee12b079 93:4d76de54a699 398 if(proton_scp_sum > scp_threshold_m0_1[7]) at=1;
ee12b079 93:4d76de54a699 399 if(electron_scp_sum > scp_threshold_m0_1[8]) at=1;
shreeshas95 1:a0055b3280c8 400 }
ee12b079 93:4d76de54a699 401 }else if(srp_mode ==1){
ee12b079 93:4d76de54a699 402 for(int i=0; i<32; i++){
ee12b079 93:4d76de54a699 403 if(scp_bin[i] > scp_threshold_m1[0]){
ee12b079 93:4d76de54a699 404 at = 1;
ee12b079 93:4d76de54a699 405 break;
shreeshas95 1:a0055b3280c8 406 }
shreeshas95 1:a0055b3280c8 407 }
ee12b079 93:4d76de54a699 408 for(int i=32; i<36; i++){
ee12b079 93:4d76de54a699 409 if(scp_bin[i] > scp_threshold_m1[1]){
ee12b079 93:4d76de54a699 410 at = 1;
ee12b079 93:4d76de54a699 411 break;
ee12b079 93:4d76de54a699 412 }
shreeshas95 1:a0055b3280c8 413 }
shreeshas95 1:a0055b3280c8 414 }
shreeshas95 1:a0055b3280c8 415
ee12b079 93:4d76de54a699 416 for(int i=0; i<17 ;i++){
ee12b079 93:4d76de54a699 417 if(scp_bin[i]>0)
ee12b079 93:4d76de54a699 418 pzf = 0;
ee12b079 93:4d76de54a699 419 }
ee12b079 93:4d76de54a699 420 for(int i=18; i<23 ;i++){
ee12b079 93:4d76de54a699 421 if(scp_bin[i]>0)
ee12b079 93:4d76de54a699 422 ezf = 0;
ee12b079 93:4d76de54a699 423 }
ee12b079 93:4d76de54a699 424
ee12b079 163:e4ff6c00faa2 425 //------------------------------------------------------------------------beacon
ee12b079 163:e4ff6c00faa2 426 // struct beacon_packet{
ee12b079 163:e4ff6c00faa2 427 // unsigned char data[12];
ee12b079 163:e4ff6c00faa2 428 // beacon_packet *next;
ee12b079 163:e4ff6c00faa2 429 // };
ee12b079 163:e4ff6c00faa2 430 //
ee12b079 163:e4ff6c00faa2 431 // int beacon_cntr = 0;
ee12b079 163:e4ff6c00faa2 432 // bool beacon_flag = true;
ee12b079 163:e4ff6c00faa2 433 // beacon_packet *head_beacon, *tail_beacon;
ee12b079 163:e4ff6c00faa2 434
ee12b079 163:e4ff6c00faa2 435 if(beacon_cntr == 0){
ee12b079 163:e4ff6c00faa2 436 head_beacon = tail_beacon = new beacon_packet;
ee12b079 163:e4ff6c00faa2 437 tail_beacon->next == NULL;
ee12b079 163:e4ff6c00faa2 438 }
ee12b079 163:e4ff6c00faa2 439 else{
ee12b079 163:e4ff6c00faa2 440 tail_beacon->next = new beacon_packet;
ee12b079 163:e4ff6c00faa2 441 tail_beacon = tail_beacon->next;
ee12b079 163:e4ff6c00faa2 442 tail_beacon->next == NULL;
ee12b079 163:e4ff6c00faa2 443 }
ee12b079 163:e4ff6c00faa2 444 pointer = tail_beacon->data; debug_cntr = 0; space = 8;
ee12b079 163:e4ff6c00faa2 445 space = adjust(1, 0,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 446 space = adjust(5,(sci_time>>8)&0x1f,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 447 space = adjust(8, sci_time,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 448 space = adjust(4, (attitude)&0xf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 449 if(beacon_at == 0){
ee12b079 163:e4ff6c00faa2 450 tail_beacon->len = 12;
ee12b079 163:e4ff6c00faa2 451 space = adjust(1, 0,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 452 space = adjust(6, compress(sfp_bin[44],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 453 space = adjust(7, compress(sfp_bin[49],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 454 space = adjust(7, compress(sfp_bin[50],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 455 space = adjust(7, compress(sfp_bin[51],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 456 space = adjust(7, compress(sfp_bin[52],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 457 space = adjust(6, compress(sfp_bin[17],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 458 space = adjust(6, compress(sfp_bin[23],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 459 space = adjust(4, compress(proton_scp_sum ,10,2)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 460 space = adjust(8, compress(proton_scp_sum ,10,2),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 461 space = adjust(4, compress(electron_scp_sum ,10,2)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 462 space = adjust(8, compress(electron_scp_sum ,10,2),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 463 // cout<<"for beacon space = "<<(space&0x0f)<<" counter = "<<debug_cntr;
ee12b079 163:e4ff6c00faa2 464 for(int temp_i = 12; temp_i<14; temp_i++){
ee12b079 163:e4ff6c00faa2 465 *pointer = 0;
ee12b079 163:e4ff6c00faa2 466 pointer = pointer + 1;
ee12b079 163:e4ff6c00faa2 467 }
ee12b079 163:e4ff6c00faa2 468 }
ee12b079 163:e4ff6c00faa2 469 else{
ee12b079 163:e4ff6c00faa2 470 tail_beacon->len = 14;
ee12b079 163:e4ff6c00faa2 471 space = adjust(1, 0,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 163:e4ff6c00faa2 472 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;
ee12b079 163:e4ff6c00faa2 473 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;
ee12b079 163:e4ff6c00faa2 474 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;
ee12b079 163:e4ff6c00faa2 475 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;
ee12b079 163:e4ff6c00faa2 476 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;
ee12b079 163:e4ff6c00faa2 477 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;
ee12b079 163:e4ff6c00faa2 478 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;
ee12b079 163:e4ff6c00faa2 479 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;
ee12b079 163:e4ff6c00faa2 480 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;
ee12b079 163:e4ff6c00faa2 481 // cout<<"for beacon space = "<<(space&0x0f)<<" counter = "<<debug_cntr;
ee12b079 163:e4ff6c00faa2 482 }
ee12b079 163:e4ff6c00faa2 483 beacon_cntr++;
ee12b079 163:e4ff6c00faa2 484 if(beacon_cntr ==6){
ee12b079 163:e4ff6c00faa2 485 beacon_packet *temp_bec;
ee12b079 163:e4ff6c00faa2 486 temp_bec = head_beacon;
ee12b079 163:e4ff6c00faa2 487 head_beacon = head_beacon->next;
ee12b079 163:e4ff6c00faa2 488 delete(temp_bec);
ee12b079 163:e4ff6c00faa2 489 beacon_cntr--;
ee12b079 163:e4ff6c00faa2 490 }
ee12b079 163:e4ff6c00faa2 491
ee12b079 163:e4ff6c00faa2 492 //------------------------------------------------------------------------beacon
ee12b079 163:e4ff6c00faa2 493
ee12b079 98:fd99ddc0e0a1 494 gPC.puts("scp\r\n");
ee12b079 98:fd99ddc0e0a1 495
ee12b079 93:4d76de54a699 496 pointer = scp; debug_cntr = 0; space = 8;
ee12b079 93:4d76de54a699 497 unsigned char packet_pp = 1; //where to get this packet present bit----------------------------------------------------------------------------------
ee12b079 93:4d76de54a699 498 int sfp_at_counter; //----------------------------------------------------------------------------------------------------------------------------------
ee12b079 93:4d76de54a699 499 space = adjust(1, packet_pp,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 500 space = adjust(5, (sci_time>>8)&0x1f,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 501 space = adjust(8, (sci_time)&0xff,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 502 space = adjust(4, (attitude)&0xf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 503 space = adjust(2, compression_option,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 504 space = adjust(1,srp_mode,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 505 space = adjust(1,srp_mode,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 506 space = adjust(8, sfp_at_counter>>16,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 507 space = adjust(8, sfp_at_counter>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 508 space = adjust(8, sfp_at_counter,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 509 if(srp_mode == 0 && compression_option == 0){ //normal callibrated mode
ee12b079 93:4d76de54a699 510 space = adjust(1, pzf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 511 space = adjust(1, ezf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 512 if(at == 0 ){
ee12b079 93:4d76de54a699 513 for(int i = 0; i<8 ;i++){
ee12b079 93:4d76de54a699 514 space = adjust(7,compress(sfp_bin[24+i],4,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 515 }
ee12b079 93:4d76de54a699 516 for(int i = 0; i<12 ;i++){
ee12b079 93:4d76de54a699 517 space = adjust(5,compress(sfp_bin[32+i],2,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 518 }
ee12b079 93:4d76de54a699 519 for(int i = 0; i<4 ;i++){
ee12b079 93:4d76de54a699 520 space = adjust(6,compress(scp_bin[44+i],3,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 521 }
ee12b079 93:4d76de54a699 522 for(int i = 0; i<4 ;i++){
ee12b079 93:4d76de54a699 523 space = adjust(7,compress(scp_bin[48+i],4,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 524 }
ee12b079 93:4d76de54a699 525 space = adjust(6,compress(scp_bin[17],3,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 526 space = adjust(6,compress(scp_bin[23],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 527 if(pzf == 0){
ee12b079 93:4d76de54a699 528 for(int i = 0; i<2 ;i++){
ee12b079 93:4d76de54a699 529 space = adjust(8,compress(scp_bin[i],6,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 530 }
ee12b079 93:4d76de54a699 531 for(int i = 0; i<15 ;i++){
ee12b079 93:4d76de54a699 532 space = adjust(7,compress(scp_bin[i+2],5,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 533 }
ee12b079 93:4d76de54a699 534 }
ee12b079 93:4d76de54a699 535 if(ezf == 0){
ee12b079 93:4d76de54a699 536 space = adjust(1,compress(scp_bin[18],7,2)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 537 space = adjust(8,compress(scp_bin[18],7,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 538 for(int i=0; i<4; i++){
ee12b079 93:4d76de54a699 539 space = adjust(8,compress(scp_bin[19+i],6,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 540 }
ee12b079 93:4d76de54a699 541 }
ee12b079 93:4d76de54a699 542 }// below threshold ends here
ee12b079 93:4d76de54a699 543 if(at == 1){
ee12b079 93:4d76de54a699 544 for(int i = 0; i<8 ;i++){
ee12b079 93:4d76de54a699 545 space = adjust(7,compress(scp_bin[24+i],4,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 546 }
ee12b079 93:4d76de54a699 547 for(int i = 0; i<12 ;i++){
ee12b079 93:4d76de54a699 548 space = adjust(5,compress(scp_bin[32+i],2,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 549 }
ee12b079 93:4d76de54a699 550 for(int i = 0; i<4 ;i++){
ee12b079 93:4d76de54a699 551 space = adjust(1,compress(scp_bin[44+i],6,3)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 552 space = adjust(8,compress(scp_bin[44+i],6,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 553 }
ee12b079 93:4d76de54a699 554 for(int i=0; i<4 ;i++){
ee12b079 93:4d76de54a699 555 space = adjust(2,compress(scp_bin[48+i],6,4)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 556 space = adjust(8,compress(scp_bin[48+i],6,4) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 557 }
ee12b079 93:4d76de54a699 558 space = adjust(1,compress(scp_bin[17],6,3)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 559 space = adjust(8,compress(scp_bin[17],6,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 560 space = adjust(1,compress(scp_bin[23],6,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 561 space = adjust(8,compress(scp_bin[23],6,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 562 if(pzf == 0){
ee12b079 93:4d76de54a699 563 for(int i = 0; i<17 ; i++){
ee12b079 93:4d76de54a699 564 space = adjust(8, (compress(scp_bin[i],5,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 565 }
ee12b079 93:4d76de54a699 566 }
ee12b079 93:4d76de54a699 567 if(ezf == 0){
ee12b079 93:4d76de54a699 568 for(int i = 0; i<5 ; i++){
ee12b079 93:4d76de54a699 569 space = adjust(8, (compress(scp_bin[18+i],5,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 570 }
ee12b079 93:4d76de54a699 571 }
ee12b079 93:4d76de54a699 572 } //above thresholds ends
ee12b079 93:4d76de54a699 573 } //srp_mode == 0 ends
ee12b079 93:4d76de54a699 574 if(srp_mode == 1){
ee12b079 93:4d76de54a699 575 if(at == 0){
ee12b079 93:4d76de54a699 576 for(int i=0; i<32; i++){
ee12b079 93:4d76de54a699 577 space = adjust(6, ((compress(scp_bin[i],4,2))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 578 }
ee12b079 93:4d76de54a699 579 for(int i = 0 ; i < 4 ; i++){
ee12b079 93:4d76de54a699 580 space = adjust(7, (compress(scp_bin[32+i],4,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 581 }
ee12b079 93:4d76de54a699 582 }
ee12b079 93:4d76de54a699 583 if(at == 1){
ee12b079 93:4d76de54a699 584 for(int i=0; i<32; i++){
ee12b079 93:4d76de54a699 585 space = adjust(6, (compress(scp_bin[i],3,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 586 }
ee12b079 93:4d76de54a699 587 for(int i = 0 ; i < 4 ; i++){
ee12b079 93:4d76de54a699 588 space = adjust(4, (compress(scp_bin[32+i],9,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 589 space = adjust(8, (compress(scp_bin[32+i],9,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 590 }
ee12b079 93:4d76de54a699 591 }
ee12b079 93:4d76de54a699 592 }// scp mode 1 end
ee12b079 93:4d76de54a699 593 if( srp_mode == 0 && compression_option == 1 ){ //scp data conservation mode
ee12b079 93:4d76de54a699 594 space = adjust(1, pzf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 595 space = adjust(1, ezf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 596 if(at == 0){
ee12b079 93:4d76de54a699 597 if(at == 0){
ee12b079 93:4d76de54a699 598 space = adjust(6, (compress(scp_bin[44],3,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 599 for(int i=0; i<4; i++){
ee12b079 93:4d76de54a699 600 space = adjust(7, (compress(scp_bin[48+i],4,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 601 }
ee12b079 93:4d76de54a699 602 space = adjust(6, (compress(scp_bin[17],3,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 603 space = adjust(6, (compress(scp_bin[23],3,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 604 if(pzf==0){
ee12b079 93:4d76de54a699 605 space = adjust(2, (compress(proton_scp_sum,10,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 606 space = adjust(8, (compress(proton_scp_sum,10,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 607 }
ee12b079 93:4d76de54a699 608 if(ezf==0){
ee12b079 93:4d76de54a699 609 space = adjust(2, (compress(electron_scp_sum,10,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 610 space = adjust(8, (compress(electron_scp_sum,10,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 611 }
ee12b079 93:4d76de54a699 612 } // scp data conservaton mode
ee12b079 93:4d76de54a699 613 }else if(at == 1){
ee12b079 93:4d76de54a699 614 space = adjust(1, (compress(scp_bin[44],6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 615 space = adjust(8, (compress(scp_bin[44],6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 616 for(int i=0; i<4; i++){
ee12b079 93:4d76de54a699 617 space = adjust(4, (compress(scp_bin[48+i],9,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 618 space = adjust(8, (compress(scp_bin[48+i],9,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 619 }
ee12b079 93:4d76de54a699 620 space = adjust(1, (compress(scp_bin[17],6,3)>>8) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 621 space = adjust(8, (compress(scp_bin[17],6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 622 space = adjust(1, (compress(scp_bin[23],6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 623 space = adjust(8, (compress(scp_bin[23],6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 624 if(pzf==0){
ee12b079 93:4d76de54a699 625 space = adjust(1, (compress(proton_scp_sum,6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 626 space = adjust(8, (compress(proton_scp_sum,6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 627 }
ee12b079 93:4d76de54a699 628 if(ezf==0){
ee12b079 93:4d76de54a699 629 space = adjust(1, (compress(electron_scp_sum,6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 630 space = adjust(8, (compress(electron_scp_sum,6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
ee12b079 93:4d76de54a699 631 }
ee12b079 93:4d76de54a699 632 }
ee12b079 93:4d76de54a699 633 }//-----------------------------------------------------------------------------------------------------------------------------------------------------
ee12b079 98:fd99ddc0e0a1 634
ee12b079 98:fd99ddc0e0a1 635 gPC.puts("sci frame starts\r\n");
ee12b079 98:fd99ddc0e0a1 636
ee12b079 93:4d76de54a699 637 //time to make scp frame
ee12b079 93:4d76de54a699 638 id = 0;
ee12b079 93:4d76de54a699 639 if(srp_mode == 0 && compression_option == 0){
ee12b079 93:4d76de54a699 640 if(at == 0){
ee12b079 93:4d76de54a699 641 length = 228;
ee12b079 93:4d76de54a699 642 if(pzf == 0)
ee12b079 93:4d76de54a699 643 length += 121;
ee12b079 93:4d76de54a699 644 if(ezf == 0)
ee12b079 93:4d76de54a699 645 length +=41;
ee12b079 93:4d76de54a699 646 }else if(at == 1){
ee12b079 93:4d76de54a699 647 length = 266;
ee12b079 93:4d76de54a699 648 if(pzf == 0)
ee12b079 93:4d76de54a699 649 length += 136;
ee12b079 93:4d76de54a699 650 if(ezf == 0)
ee12b079 93:4d76de54a699 651 length += 40;
ee12b079 93:4d76de54a699 652 }
ee12b079 93:4d76de54a699 653
ee12b079 93:4d76de54a699 654 }else if(srp_mode == 0 && compression_option == 1){ //data conservation mode
ee12b079 93:4d76de54a699 655 if(at == 0){
ee12b079 93:4d76de54a699 656 length = 94;
ee12b079 93:4d76de54a699 657 if(pzf == 0)
ee12b079 93:4d76de54a699 658 length += 12;
ee12b079 93:4d76de54a699 659 if(ezf == 0)
ee12b079 93:4d76de54a699 660 length += 12;
ee12b079 93:4d76de54a699 661 }else if(at == 1){
ee12b079 93:4d76de54a699 662 length = 123;
ee12b079 93:4d76de54a699 663 if(pzf == 0)
ee12b079 93:4d76de54a699 664 length += 9;
ee12b079 93:4d76de54a699 665 if(ezf == 0)
ee12b079 93:4d76de54a699 666 length += 9;
ee12b079 93:4d76de54a699 667 }
ee12b079 93:4d76de54a699 668 }else if( srp_mode == 1){
ee12b079 93:4d76de54a699 669 if(at == 0)
ee12b079 93:4d76de54a699 670 length = 272;
ee12b079 93:4d76de54a699 671 else if(at == 1)
ee12b079 93:4d76de54a699 672 length = 288;
ee12b079 93:4d76de54a699 673 }
ee12b079 93:4d76de54a699 674 length = (length%8==0)?(length/8):(length/8)+1;
ee12b079 93:4d76de54a699 675 for(int j= 0; j < length ; j++){
ee12b079 93:4d76de54a699 676 frames[id][position_tm_frame[id]] = scp[j];
ee12b079 93:4d76de54a699 677 position_tm_frame[id]++;
ee12b079 93:4d76de54a699 678 if(position_tm_frame[id] == 132){ //space full in the frame bro
ee12b079 93:4d76de54a699 679 pointer = frames[id];
ee12b079 93:4d76de54a699 680 space = adjust(1,0,pointer,8);
ee12b079 93:4d76de54a699 681 space = adjust(4,1,pointer,space);
ee12b079 99:efde3df6cd94 682 FSC_science = FCTN_SD_MNGR(1);
ee12b079 96:4ca92f9775e0 683 //gPC.printf("SID = 1, FSC = %02X\r\n", FSC_science);
ee12b079 93:4d76de54a699 684 frames[id][1] = (FSC_science>>16)&0xff;
ee12b079 93:4d76de54a699 685 frames[id][2] = (FSC_science>>8)&0xff;
ee12b079 93:4d76de54a699 686 frames[id][3] = (FSC_science)&0xff;
ee12b079 93:4d76de54a699 687 frames[id][5] = (sci_time>>16)&0x3f;
ee12b079 93:4d76de54a699 688 frames[id][6] = (sci_time>>8)&0xff;
ee12b079 93:4d76de54a699 689 frames[id][7] = (sci_time)&0xff;
ee12b079 93:4d76de54a699 690 temp_crc = crc16_gen(frames[id],132);
ee12b079 93:4d76de54a699 691 frames[id][132] = temp_crc>>8;
ee12b079 93:4d76de54a699 692 frames[id][133] = temp_crc & 0xff;
ee12b079 99:efde3df6cd94 693 exor(frames[id]);
ee12b079 93:4d76de54a699 694 convolution(frames[id]);
ee12b079 93:4d76de54a699 695 interleave(TM_convoluted_data,TM_interleave_data);
ee12b079 93:4d76de54a699 696 interleave(TM_convoluted_data+ 135,TM_interleave_data + 144);
ee12b079 99:efde3df6cd94 697 SD_WRITE(TM_interleave_data,FSC_science,1);
ee12b079 93:4d76de54a699 698 position_tm_frame[id] = position_tm_starting[id];
ee12b079 93:4d76de54a699 699 frames[id][4] = (length-1) - j;
ee12b079 93:4d76de54a699 700 }
ee12b079 93:4d76de54a699 701 }
ee12b079 96:4ca92f9775e0 702 gPC.puts("end srp");
ee12b079 93:4d76de54a699 703 }//srp fucntion end bracket