Diff: Compression.h

Revision:

207:28a07943dded

Parent:

206:fba4aeebf004

--- a/Compression.h	Thu Jun 30 14:00:33 2016 +0000
+++ b/Compression.h	Sat Jul 02 10:48:30 2016 +0000
@@ -1,19 +1,20 @@
-unsigned int read_2byte(unsigned char* ptr){
-    unsigned int output = (unsigned int) *(ptr+1);
-    output += ( (unsigned int)(*ptr) ) << 8;
+uint8_t read_2byte(uint8_t* ptr){
+    uint8_t output = (uint8_t ) *(ptr+1);
+    output += ( (uint8_t )(*ptr) ) << 8;
     return output;
 }
     
-unsigned int read_4byte(unsigned char* ptr){
-    unsigned int output = (unsigned int) *(ptr+3);
-    output += (unsigned int)*(ptr+2)<<8;
-    output += (unsigned int)*(ptr+1)<<16;
-    output += (unsigned int)*(ptr)<<24;
+uint8_t read_4byte(uint8_t* ptr){
+    uint8_t output = (uint8_t ) *(ptr+3);
+    output += (uint8_t )*(ptr+2)<<8;
+    output += (uint8_t )*(ptr+1)<<16;
+    output += (uint8_t )*(ptr)<<24;
     return output;
 }
 
-int adjust(int size, unsigned int data, unsigned char* ptr , int space){
+int adjust(int size, uint8_t data, uint8_t* ptr , int space){
     space = space&0x0f;
+    if(space == 8)  *ptr = 0;
     data = data&((1<<size)-1);
     if(space >= size){
         *ptr += data<<(space-size);
@@ -42,32 +43,45 @@
     }
 }
 
+//--------------------------------------------------------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.
+uint8_t 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};
+const 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};
 unsigned int scp_threshold_m0_1[9]={114688,245760,245760,245760,245760,114688,114688,65472,65472} ; //for mode 0..ie callibrated mode
-const unsigned int sfp_threshold_m1[2] ={252,8128},scp_threshold_m1[2]={7680,245760};
-unsigned char frames[3][134] = {0};
-unsigned char position_tm_frame[3] = {8,11,5} , position_tm_starting[3] = {8,11,5}; //{sc,sf-bt,sf-at}
-unsigned char id;   //sf = 0,sc-at = 1,sc-bt = 2;
-unsigned char TM_interleave_data[512] , TM_convoluted_data[270] = {0};
+const int sfp_threshold_m1[2] ={252,8128},scp_threshold_m1[2]={7680,245760};
+uint8_t frames[3][134] = {0};
+uint8_t position_tm_frame[3] = {8,11,5} , position_tm_starting[3] = {8,11,5}; //{sc,sf-bt,sf-at}
+uint8_t id;   //sf = 0,sc-at = 1,sc-bt = 2;
+uint8_t TM_interleave_data[512] , TM_convoluted_data[270] = {0};
 int proton_scp_sum,electron_scp_sum,length, temp_crc,attitude = 0,FSC_science = 1,debug_cntr = 0, size,space;   
-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
+uint8_t *ptr ,* pointer;
+uint64_t 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){
+    void convolution (uint8_t * ptr){
         ConvObj.convolutionEncode(ptr, TM_convoluted_data);
         ConvObj.convolutionEncode(ptr + 67, TM_convoluted_data + 135);
     }
 
 //give the pointer of 6 second data to this function
-void srp(unsigned char * head){
+void srp(uint8_t * head){
     //sci_time = FCTN_CDMS_RD_RTC();
     sci_time = 0;
     gPC.puts("enter srp");
@@ -79,6 +93,9 @@
     srp_mode = head[2]&0x1;
     at = 0;     //above threshold is false
     for(int counter = 0 ; counter < 60 ; counter++){
+        //gPC.puts("Y");
+//        gPC.printf("counter = %d\n",counter);
+//        cout<<"counter = "<<counter<<endl;
         pzf = 1;    ezf = 1;
         if(srp_mode == 0){      //calibrated mode
             for(int i=0; i<48 ; i++){
@@ -295,9 +312,10 @@
                 }else if(id == 2){
                     space = adjust(1,0,pointer,8);
                     space = adjust(4,2,pointer,space);
-//                    FSC_science = FCTN_SD_MNGR(2);
+                    FCTN_SD_MNGR();
+                    FSC_science = FSC_CURRENT[2];
                     
-                    //gPC.printf("SID = 2, FSC = %02X\r\n", FSC_science);
+ //                   gPC.printf("SID = 2, FSC = %02X\r\n", FSC_science);
                     frames[id][1] = (FSC_science>>16)&0xff;
                     frames[id][2] = (FSC_science>>8)&0xff;
                     frames[id][3] = FSC_science&0xff;
@@ -305,24 +323,30 @@
                 temp_crc = crc16_gen(frames[id],132);
                 frames[id][132] = temp_crc>>8;
                 frames[id][133] = temp_crc & 0xff;
-                if(test_cntr++ == 0){
-                    gPC.puts("frame start\r\n");
-                    for(int i = 0; i<134; i++){
-                        gPC.printf("%02X",frames[id][i]);
-                    }    
-                    gPC.puts("frame ends\r\n");
-                }
+              //  if(test_cntr++ == 0){
+                    //gPC.puts("frame start\r\n");
+//                    for(int i = 0; i<134; i++){
+//                        gPC.printf("%02X",frames[id][i]);
+//                    }    
+                   // gPC.puts("frame ends\r\n");
+//                }
+                   
+                
                 exor(frames[id]);
                 convolution(frames[id]);
                 interleave(TM_convoluted_data,TM_interleave_data);
                 interleave(TM_convoluted_data+ 135,TM_interleave_data + 144);
-                if(id == 1)
+                
+                if(id == 1){
                     SD_WRITE(TM_interleave_data,FSC_science,3);
-                else if (id == 2)
+                   }
+                else if (id == 2){
                     SD_WRITE(TM_interleave_data,FSC_science,2);
+                  }
                 FSC_science++;      //remove this after testing
                 position_tm_frame[id] = position_tm_starting[id];
                 frames[id][6-id] = (length-1) - j;      // first head pointer.
+                
             }
         }
         
@@ -331,7 +355,7 @@
     //---------------below is scp --------------**************************************************************************************************
     at = 0;     pzf = 1;    ezf = 1;
     srp_mode = head[2]&0x1;
-    unsigned char compression_option = (head[2]>>1)&0x3;    //--------------------------------------------------------------------------------------
+    uint8_t compression_option = (head[2]>>1)&0x3;    //--------------------------------------------------------------------------------------
     if(srp_mode ==0){
         if(compression_option == 0){
             for(int i=0; i<52 ;i++){
@@ -340,6 +364,27 @@
                     break;
                 }
             }
+            
+            //---------------------------------------------***********************************************************----------------------------beacon
+            beacon_at = 0;
+            if(scp_bin[44]>beacon_threshold[0])     beacon_at = 1;
+            if(scp_bin[48]>beacon_threshold[1])     beacon_at = 1;
+            if(scp_bin[49]>beacon_threshold[2])     beacon_at = 1;
+            if(scp_bin[50]>beacon_threshold[3])     beacon_at = 1;
+            if(scp_bin[51]>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;
@@ -386,10 +431,80 @@
             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[48],4,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(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[48],9,3)>>8,pointer,space);      pointer += space>>4;    debug_cntr += space>>4;             space = adjust(8, compress(sfp_bin[48],9,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),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(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){
+//        cout<<"i deleted it"<<endl;
+        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;
-    unsigned char packet_pp = 1;    //where to get this packet present bit----------------------------------------------------------------------------------
+    uint8_t packet_pp = 1;    //where to get this packet present bit----------------------------------------------------------------------------------
     int sfp_at_counter; //----------------------------------------------------------------------------------------------------------------------------------
     space = adjust(1, packet_pp,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;
@@ -545,7 +660,6 @@
             if(ezf == 0)
                 length += 40;
         }
-            
     }else if(srp_mode == 0 && compression_option == 1){     //data conservation mode
         if(at == 0){
             length = 94;