working version

Dependencies:   mbed mbed-rtos SimpleDMA FreescaleIAP eeprom

Fork of CDMS_CODE_FM_28JAN2017 by samp Srinivasan

Revision:
163:e4ff6c00faa2
Parent:
114:9fb55057b13f
--- 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;