shubham c
CDMS code for testing sbc
Dependencies: FreescaleIAP SimpleDMA mbed-rtos mbed
Fork of
CDMS_CODE
by 
shubham c
Compression.h
- Committer:
- prasanthbj05
- Date:
- 2016-07-15
- Revision:
- 266:ae588e75cfa4
- Parent:
- 261:1e54415b34d3
- Child:
- 267:783c248a6207
File content as of revision 266:ae588e75cfa4:
/*-----------------------------------------to_do_compression.h--------------------------------------------------
-> SD_Write error to be checked
-> fsc_counter is 32 bit but in the code 24 bit. Talk to chaitu
---------------------------------------------------------------------------------------------------------------*/
//updated compression algorithm
/*#include <iostream>
#include "stdio.h"
#include "crc.h"
#include "interleave.h"
#include "Convolution.h"
#include "bitset"*/
//using namespace std;
//reading functions 2byte, 4byte
uint16_t read_2byte(uint8_t* ptr)
{
uint16_t output = (uint8_t ) *(ptr+1);
output += ( (uint8_t )(*ptr) ) << 8;
return output;
}
uint32_t read_4byte(uint8_t* ptr)
{
uint32_t output = (uint32_t) (*(ptr+3));
output += (uint32_t)(*(ptr+2)<<8);
output += (uint32_t)(*(ptr+1)<<16);
output += (uint32_t)(*(ptr)<<24);
return output;
}
uint8_t adjust(uint8_t size, uint8_t data, uint8_t* ptr , uint8_t space)
{
space = space&0x0f;
if(space == 8) *ptr = 0;
data = data&((1<<size)-1);
if(space >= size){
*ptr += data<<(space-size);
if(space - size == 0){
return 0x18;
}else{
return space-size;
}
}else{
ptr[0] += data>>(size-space);
ptr[1] = (data<<(8-(size-space)))&0xff ;
return 0x10 + 8-(size - space);
}
}
int compress (int data, int x, int y) //to be compressed with scheme (msb x)*4^y ;
{
for(int i = 0 ; i < (1<<y) ; i++)
{
if(data <= ( (1<<x)-1) * (1<<(2*i)) )
{
return ( ((data>>i*2)<<y) + i);
}
}
if ( data > (( (1<<x)-1) * (1<<(2*((1<<y)-1)))) )
{
//cout <<"compression exception"<<endl;
return (((1<<x)-1) * (1<<(2*((1<<y)-1))));
}
}
//--------------------------------------------------------beacon
uint8_t beacon_array[134];
uint8_t beacon_cntr = 1;
uint8_t *beacon_ptr;
//--------------------------------------------------------beacon
//variable declarations
uint8_t srp_mode , at , pzf , ezf ,sfp[71] ,scp[56],beacon_at; //tells which mode is calibrated or plot 0 for calibrated and 1 for scatterered, below threshold , proton zero flux, electron zero flux.
uint32_t sfp_bin[52] , scp_bin[52]; //storing the bin values.
uint32_t sfp_threshold_m0[52] = {124,124,60,60,60,60,60,60,60,60,60,60,60,60,60,60,60,4032,252,252,252,252,252,4032,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};
uint32_t scp_threshold_m0[52] = {4032,4032,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,114688,8128,4032,4032,4032,4032,114688,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};
uint32_t scp_threshold_m0_1[9] = {114688,245760,245760,245760,245760,114688,114688,65472,65472} ; //for callibrated mode with data conservation
uint32_t scp_sfp_threshold_m0_2[3] = {245760,65472,65472};
uint32_t sfp_threshold_m1[52] = {1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,1984,8128,8128,8128,8128};
uint32_t scp_threshold_m1[52] = {114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,114688,245760,245760,245760,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};
uint64_t proton_scp_sum,electron_scp_sum,FSC_science;
uint16_t temp_crc;
uint32_t debug_cntr, size,space,length;
uint8_t *ptr ,* pointer;
uint64_t sci_time = 0, time_prev_scp = 0;
uint32_t attitude = 0;
uint32_t beacon_threshold[9] = {114688,245760,245760,245760,245760,114688,114688,65472,65472};
Convolution ConvObj;
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(uint8_t * head)
{
gPC.printf("\n\rEntered srp");
debug_cntr = 0;
sci_time = FCTN_CDMS_RD_RTC();
if(time_prev_scp==0){
time_prev_scp = sci_time;
}
FCTN_SD_MNGR(); ///changed recently
for (int i = 0; i < 56 ; i++)
{
scp_bin[i] = 0;
}
ptr = head + 3; //ptr points to proton energy bin of srp
srp_mode = head[2]&0x1;
for(uint8_t counter = 0 ; counter < 60 ; counter++)
{
/*-------------------- ------------populating sfp_bin and scp_bin[] starts here(also tag AT or BT)-----------------------*/
at = 0; pzf = 1; ezf = 1;
if(srp_mode == 0) //calibrated mode
{
for(int i=0; i<48 ; i++) //first 48 bins or SRP are of 16 bits size
{
sfp_bin[i] = read_2byte(ptr + i*2);
scp_bin[i] += sfp_bin[i];
if(sfp_bin[i]>sfp_threshold_m0[i])
{
at = 1;
}
if(i<17)
{
if(sfp_bin[i] > 0)
pzf = 0;
}
else if (i>17 && i < 23)
{
if(sfp_bin[i]>0)
ezf = 0;
}
}
for(int i=0; i<4; i++) //last 4 bins(excluding the spare bin) are 32 bit each
{
sfp_bin[i+48] = read_4byte( (ptr+96) + 4*i );
scp_bin[i+48] += sfp_bin[i+48];
if(sfp_bin[i+48]>sfp_threshold_m0[i+48])
at = 1;
}
}
else if(srp_mode == 1) //scattered mode
{
for(int i = 0; i <48; i++) //first 48 bins of SRP are of 16 bit size
{
sfp_bin[i] = read_2byte(ptr+2*i);
scp_bin[i] += sfp_bin[i];
if(sfp_bin[i] > sfp_threshold_m1[i])
at = 1;
}
for(int i = 0; i < 4 ; i++) //next 4 bins are of 32 bit size
{
///sfp_bin[i+48] = read_4byte( (ptr+64) + 4*i );
sfp_bin[i+48] = read_4byte( (ptr+96) + 4*i );
scp_bin[i+48] += sfp_bin[i+48];
if(sfp_bin[i+48] > sfp_threshold_m1[i+48])
at = 1;
}
}
/*---------------------------populating sfp_bin[] and scp_bin[] from srp ends here(also tagging AT or BT)------------------*/
ptr = ptr + 112; //moving the pointer to next srp packet in the DMA buffer
/*------------------------------------------forming a science fine packet starts here----------------------------------------
First we fill packet header, then fill packet data and finally assign its length
----------------------------------------------------------------------------------------------------------------------------*/
for(int i = 0; i<71; i++)
sfp[i] = 0;
if(srp_mode == 0) //calibrated mode
{
if(at == 0)
{
pointer = sfp; debug_cntr = 0;
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;
space = adjust(1, pzf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1, ezf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
for(uint8_t i = 0 ; i < 8 ; i++){
space = adjust(1, ((compress(sfp_bin[24+i],7,2))&0x100)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, ((compress(sfp_bin[24+i],7,2))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(uint8_t i = 0 ; i <12 ; i++){
space = adjust(6, (compress(sfp_bin[32+i],4,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(uint8_t i = 0; i < 4; i++){
space = adjust(8, (compress(sfp_bin[44+i],6,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(uint8_t i = 0 ; i < 4 ; i++){
space = adjust(1, (compress(sfp_bin[48+i],7,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[48+i],7,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
space = adjust(8, ((compress(sfp_bin[17],6,2))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, ((compress(sfp_bin[23],6,2))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(pzf == 0){
for(uint8_t i = 0; i<2 ; i++){
space = adjust(6, ((compress(sfp_bin[i],5,1))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(uint8_t i = 0; i<15 ; i++){
space = adjust(5, ((compress(sfp_bin[i+2],4,1))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
if(ezf == 0){
for(uint8_t i = 0; i <5 ;i++){
space = adjust(7, ((compress(sfp_bin[18+i],6,1))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
} //below thershold ends here.
if(at == 1){
pointer = sfp + 6; debug_cntr = 6;space = 8;
sfp[0] = (sci_time>>27)&0xff; sfp[1] = (sci_time>>19)&0xff; sfp[2] = (sci_time>>11)&0xff; sfp[3] = (sci_time>>3)&0xff;
sfp[4] = ((sci_time&0x07)<<5) + ((attitude&0x0f)<<1) + (counter>>5);
sfp[5] = ((counter&0x1f)<<3) + (srp_mode<<2);
sfp[5] += (pzf<<1) + ezf ;
for(uint8_t i = 0 ; i < 8 ; i++){
space = adjust(1, (compress(sfp_bin[24+i],7,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, ((compress(sfp_bin[24+i],7,2))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(uint8_t i = 0 ; i <12 ; i++){
space = adjust(6, ((compress(sfp_bin[32+i],3,3))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(uint8_t i = 0 ; i < 4 ; i++){
space = adjust(2, (compress(sfp_bin[44+i],8,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[44+i],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(uint8_t i = 0 ; i < 4 ; i++){
space = adjust(1, (compress(sfp_bin[48+i],6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[48+i],6,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
space = adjust(2, (compress(sfp_bin[17],8,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[17],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(2, (compress(sfp_bin[23],8,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[23],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(pzf == 0){
//cout<<"proton bins ";
for(uint8_t i = 0; i<17 ; i++){
space = adjust(2, ((compress(sfp_bin[i],8,2))>>8) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[i],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
//printf("%02X ",compress(sfp_bin[i],8,2));
}
}
if(ezf == 0){
//cout<<"electron bins ";
for(int i = 0; i<5 ; i++){
space = adjust(2,((compress(sfp_bin[18+i],8,2))>>8),pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[18+i],8,2),pointer,space); pointer += space>>4; debug_cntr += space>>4;
//printf("%02X ",compress(sfp_bin[i],8,2));
}
}
} //above threshold ends here.
if(at == 0)
{
id = 1; length = 241+5; //5 spare bits
if(pzf == 0)
length += 87;
if(ezf == 0)
length += 35;
}
else
{
id = 2; length = 288; //0 spare bits
if(pzf == 0)
length += 170;
if(ezf == 0)
length += 50;
}
}
else if(srp_mode == 1) //scattered mode
{
if(at == 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;
for(uint8_t i=0; i<48; i++)
{
space = adjust(7, compress(sfp_bin[i],5,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(uint8_t i = 0 ; i < 4 ; i++)
{
space = adjust(1, (compress(sfp_bin[48+i],7,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[48+i],7,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
if(at == 1)
{
pointer = sfp; debug_cntr = 0; space = 8;
space = adjust(3, sci_time>>32 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, sci_time>>24 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, sci_time>>16 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, sci_time>>8 ,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,pointer,space); 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;
for(uint8_t i=0; i<48; i++)
{
space = adjust(2, (compress(sfp_bin[i],8,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[i],8,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(uint8_t i = 0 ; i < 4 ; i++)
{
space = adjust(1, (compress(sfp_bin[48+i],6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(sfp_bin[48+i],6,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
if(at == 0)
{
id = 1; length = 384; //0 spare bits
}
else
{
id = 2; length = 568; //0 spare bits
}
}
length = (length%8==0)?(length/8):(length/8)+1; //converting length to mulitple of 8
/*----------------------------------------forming a science packet ends here-----------------------------------------------*/
/*-----------------------------Inserting the above packet(sfp) into the TM frame(s) starts here----------------------------*/
if(id==1){
if(position_tm_frame[id]>130){
while(position_tm_frame[id]<132){
frames[id][position_tm_frame[id]] = 0;
position_tm_frame[id]++;
}
}
}
else if(id==2){
if(position_tm_frame[id]>126){
while(position_tm_frame[id]<132){
frames[id][position_tm_frame[id]] = 0;
position_tm_frame[id]++;
}
}
}
if(position_tm_frame[id]==position_tm_starting[id]){
frames[id][6-id] = position_tm_starting[id];
}
for(uint16_t j=0 ; j<length ;)
{
if(position_tm_frame[id]==frames[id][6-id]){
if(id==1){
frames[id][6] = (uint8_t)((sci_time>>32)&0x07);
frames[id][7] = (uint8_t)((sci_time>>24)&0xff);
frames[id][8] = (uint8_t)((sci_time>>16)&0xff);
frames[id][9] = (uint8_t)((sci_time>>8)&0xff);
frames[id][10] = (uint8_t)((sci_time)&0xff);
}
}
if(position_tm_frame[id]<132){
frames[id][position_tm_frame[id]] = sfp[j];
j++;
position_tm_frame[id]++; //incrementing position of write pointer in TM frame
}
if(position_tm_frame[id] == 132)
{
/*-----------the current frame is completely filled and we fill frame header to write into SD card---------*/
pointer = frames[id];
if(id == 1){ //below threshold
space = adjust(1,0,pointer,8);
space = adjust(4,3,pointer,space);
FSC_science = FSC_CURRENT[3]; ///to be used as this, but FSC_CURRENT[] is 32 bit
frames[id][1] = (FSC_science>>24)&0xff;
frames[id][2] = (FSC_science>>16)&0xff;
frames[id][3] = (FSC_science>>8)&0xff;
frames[id][4] = FSC_science&0xff;
}
else if(id == 2) //above threshold
{
space = adjust(1,0,pointer,8);
space = adjust(4,2,pointer,space);
FSC_science = FSC_CURRENT[2]; ///to be used as this
frames[id][1] = (FSC_science>>16)&0xff;
frames[id][2] = (FSC_science>>8)&0xff;
frames[id][3] = FSC_science&0xff;
}
temp_crc = crc16_gen(frames[id],132);
frames[id][132] = temp_crc>>8;
frames[id][133] = temp_crc & 0xff;
/*------------------current TM frame completely filled-----------------------*/
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)
{
SD_WRITE(TM_interleave_data,FSC_science+1,3); //sd_write will return ack later, for now not included
}
else if (id == 2)
{
SD_WRITE(TM_interleave_data,FSC_science+1,2); //sd_write will return ack later, for now not included
}
position_tm_frame[id] = position_tm_starting[id];
frames[id][6-id] = ((length-1) - j)+position_tm_starting[id];
}
}
/*------------------------------finished inserting the sfp packet into the TM frame(s)-------------------------------------*/
} // for loop bracket which runs 60 times
at = 0; pzf = 1; ezf = 1;
srp_mode = head[2]&0x1;
uint8_t compression_option = (head[2]>>1)&0x3;
/*-------------------------------Tagging the scp packet formed from these 60 sfp's as AT or BT starts here-------------------------
------------------(in case compression option = 0 , then tagging beacon packet(not yet formed) as AT or BT is also done)----------*/
if(srp_mode ==0)
{
if(compression_option == 0)
{
for(int i=0; i<52 ;i++)
{
if(scp_bin[i] > scp_threshold_m0[i])
{
at = 1;
break;
}
}
}
else if(compression_option == 1)
{
if(scp_bin[44] > scp_threshold_m0_1[0]) at=1;
for(int i=0; i<4 ;i++)
{
if(scp_bin[48+i] > scp_threshold_m0_1[i+1])
{
at = 1;
break;
}
}
if(scp_bin[17] > scp_threshold_m0_1[5]) at=1;
if(scp_bin[23] > scp_threshold_m0_1[6]) 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 > scp_threshold_m0_1[7]) at=1;
if(electron_scp_sum > scp_threshold_m0_1[8]) at=1;
}
else if(compression_option == 2)
{
if(scp_bin[50] > scp_sfp_threshold_m0_2[0]) 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 > scp_sfp_threshold_m0_2[1]) at=1;
if(electron_scp_sum > scp_sfp_threshold_m0_2[2]) at=1;
}
}
else if(srp_mode ==1)
{
if(compression_option==0){
for(int i=0; i<48; i++)
{
if(scp_bin[i] > scp_threshold_m1[i]){
at = 1;
break;
}
}
for(int i=48; i<52; i++)
{
if(scp_bin[i] > scp_threshold_m1[i]){
at = 1;
break;
}
}
}
else if(compression_option==2){
if(scp_bin[50]>scp_sfp_threshold_m0_2[0]) at=1;
}
}
/*----------------------------Tagging the scp packet formed from these 60 sfp's as AT or BT ends here--------------------------*/
if(srp_mode == 0)
{
//determining if non zero values of proton and electron bins exist for calibrated mode (srp)
for(int i=0; i<17 ;i++)
{
if(scp_bin[i]>0)
pzf = 0;
}
for(int i=18; i<23 ;i++)
{
if(scp_bin[i]>0)
ezf = 0;
}
}
/*-----------------------------------------Tagging beacon packet as AT or BT starts here-------------------------------------*/
beacon_at = 0;
if(srp_mode==0) //those bins which can be meaningfully compared only in srp_mode==0
{
if(scp_bin[44]>beacon_threshold[0]) 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;
}
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;
/*----------------------------------------Tagging beacon packet as AT or BT ends here------------------------------------------*/
/*-----------------------------------------------Forming the beacon packet starts here-----------------------------------------*/
//Last 512 bits of beacon_array excluding CRC bits is used for storing the 5 most recent beacon packets
if(beacon_cntr == 1)
{
beacon_ptr = &(beacon_array[62]); // starting block address, stores the oldest(among the 5 most recent) beacon packet
}
else if(beacon_cntr>1 && beacon_cntr<6)
{
beacon_ptr +=14; // increase the block number(totally 5 blocks for 5 beacon packets)
}
else if(beacon_cntr == 6)
{
for(uint16_t i=0;i<14;i++) // when all 5 blocks have been used shift the last 4 blocks up along the array and
{ // overwrite the new beacon packet in the 5th block
beacon_array[62+i] = beacon_array[76+i];
beacon_array[76+i] = beacon_array[90+i];
beacon_array[90+i] = beacon_array[104+i];
beacon_array[104+i] = beacon_array[118+i];
}
beacon_ptr = &(beacon_array[118]); //address of the 5th block
beacon_cntr = 5;
}
pointer = beacon_ptr; debug_cntr = 0; space = 8;
space = adjust(1, 1,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(srp_mode==0){
if(beacon_at == 0){
space = adjust(1, 0,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(6, compress(scp_bin[44],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(7, compress(scp_bin[48],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(7, compress(scp_bin[49],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(7, compress(scp_bin[50],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(7, compress(scp_bin[51],4,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(6, compress(scp_bin[17],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(6, compress(scp_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;
pointer = pointer + 1;
for(int temp_i = 12; temp_i<14; temp_i++)
{
*pointer = 0;
pointer = pointer + 1;
}
}
else if(beacon_at==1){
space = adjust(1, 1,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;
}
}else if(srp_mode==1){
if(beacon_at==0){
space = adjust(1, 0,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(6, compress(0,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;
pointer = pointer + 1;
for(uint8_t temp_i = 7; temp_i<14; temp_i++)
{
*pointer = 0;
pointer = pointer + 1;
}
}
else if(beacon_at==1){
space = adjust(1, 1,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1, compress(0,6,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, compress(0,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;
pointer = pointer + 1;
for(uint8_t temp_i = 10; temp_i<14; temp_i++)
{
*pointer = 0;
pointer = pointer + 1;
}
}
}
beacon_cntr++;
/*--------------------------------------------------beacon packet ends here--------------------------------------------------------*/
gPC.printf("scp\r\n");
uint8_t packet_pp,time_diff;
/*------------------------------------------Forming a science packet(scp) starts here----------------------------------------------*/
pointer = scp; debug_cntr = 0; space = 8;
time_diff = 0;
packet_pp = 1;
if((((uint8_t)(sci_time>>7))&0x3f)<(((uint8_t)(time_prev_scp>>7))&0x3f))
{
time_diff = time_diff+60;
}
time_diff += (((uint8_t)(sci_time>>7))&0x3f);
time_diff -= (((uint8_t)(time_prev_scp>>7))&0x3f);
if(time_diff>10){
packet_pp = 0;
}
time_prev_scp = sci_time;
uint32_t sfp_at_counter;
sfp_at_counter = FSC_CURRENT[2];
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;
space = adjust(8, (sci_time)&0xff,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(4, (attitude)&0xf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(2, compression_option,pointer,space); pointer += space>>4; debug_cntr += space>>4; //first two bits of compression option
space = adjust(1, at,pointer,space); pointer += space>>4; debug_cntr += space>>4; //last bit of compression option
space = adjust(1, srp_mode,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(!(srp_mode==0 && compression_option==2))
{
space = adjust(8, sfp_at_counter>>16,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, sfp_at_counter>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, sfp_at_counter,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
if(srp_mode == 0 && compression_option == 0){ //normal callibrated mode
space = adjust(1, pzf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1, ezf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(at == 0 ){
for(int i = 0; i<8 ;i++){
space = adjust(7,compress(scp_bin[24+i],4,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(int i = 0; i<12 ;i++){
space = adjust(5,compress(scp_bin[32+i],2,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(int i = 0; i<4 ;i++){
space = adjust(6,compress(scp_bin[44+i],3,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(int i = 0; i<4 ;i++){
space = adjust(7,compress(scp_bin[48+i],4,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
space = adjust(6,compress(scp_bin[17],3,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(6,compress(scp_bin[23],3,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(pzf == 0){
for(int i = 0; i<2 ;i++){
space = adjust(8,compress(scp_bin[i],6,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(int i = 0; i<15 ;i++){
space = adjust(7,compress(scp_bin[i+2],5,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
if(ezf == 0){
space = adjust(1,compress(scp_bin[18],7,2)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8,compress(scp_bin[18],7,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
for(int i=0; i<4; i++){
space = adjust(8,compress(scp_bin[19+i],6,2) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
}// below threshold ends here
if(at == 1){
for(int i = 0; i<8 ;i++){
space = adjust(7,compress(scp_bin[24+i],4,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(int i = 0; i<12 ;i++){
space = adjust(5,compress(scp_bin[32+i],2,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(int i = 0; i<4 ;i++){
space = adjust(1,compress(scp_bin[44+i],6,3)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8,compress(scp_bin[44+i],6,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(int i=0; i<4 ;i++){
space = adjust(4,compress(scp_bin[48+i],9,3)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8,compress(scp_bin[48+i],9,3) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
space = adjust(1,compress(scp_bin[17],6,3)>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8,compress(scp_bin[17],6,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1,compress(scp_bin[23],6,3)>>8,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8,compress(scp_bin[23],6,3),pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(pzf == 0){
for(int i = 0; i<17 ; i++){
space = adjust(8, (compress(scp_bin[i],5,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
if(ezf == 0){
for(int i = 0; i<5 ; i++){
space = adjust(8, (compress(scp_bin[18+i],5,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
} //above thresholds ends
} //srp_mode == 0 ends
if(srp_mode == 1){
if(at == 0){
for(int i=0; i<48; i++){
space = adjust(6, ((compress(scp_bin[i],3,3))&0xff) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(int i = 0 ; i < 4 ; i++){
space = adjust(7, (compress(scp_bin[48+i],4,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
if(at == 1){
for(int i=0; i<48; i++){
space = adjust(7, (compress((scp_bin[i]/2),4,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
for(int i = 0 ; i < 4 ; i++){
space = adjust(4, (compress(scp_bin[48+i],9,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(scp_bin[48+i],9,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
}// scp mode 1 end
if( srp_mode == 0 && compression_option == 1 ){ //scp data conservation mode
space = adjust(1, pzf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1, ezf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(at == 0){
space = adjust(6, (compress(scp_bin[44],3,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
for(int i=0; i<4; i++){
space = adjust(7, (compress(scp_bin[48+i],4,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
space = adjust(6, (compress(scp_bin[17],3,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(6, (compress(scp_bin[23],3,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(pzf==0){
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;
}
if(ezf==0){
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;
}
}else if(at == 1){
space = adjust(1, (compress(scp_bin[44],6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(scp_bin[44],6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
for(int i=0; i<4; i++){
space = adjust(4, (compress(scp_bin[48+i],9,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(scp_bin[48+i],9,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
space = adjust(1, (compress(scp_bin[17],6,3)>>8) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(scp_bin[17],6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1, (compress(scp_bin[23],6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(scp_bin[23],6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(pzf==0){
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;
}
if(ezf==0){
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;
}
}
}
if(compression_option == 2 ) //scp extreme data conservation mode
{
if(srp_mode==0)
{
space = adjust(1, pzf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1, ezf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(at==0){
space = adjust(7, (compress(scp_bin[50],4,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(pzf==0){
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;
}
if(ezf==0){
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;
}
}else if(at==1){
space = adjust(4, (compress(scp_bin[50],9,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(scp_bin[50],9,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(pzf==0){
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;
}
if(ezf==0){
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;
}
}
}
else if(srp_mode==1)
{
pzf = 0; ezf = 0; //because proton energy bins are not available in scatter plot mode and hence in the packet we send dummy data(which is nothng but the maximum value which fits into that particular compression scheme)
space = adjust(1, pzf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1, ezf,pointer,space); pointer += space>>4; debug_cntr += space>>4;
if(at==0){
space = adjust(7, (compress(scp_bin[50],4,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
// below 4 lines - filling the proton ane electron energy bins with zeros(junk value) since they're not available in srp
space = adjust(4, (compress(0,10,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(0,10,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(4, (compress(0,10,2))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(0,10,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
else if(at==1){
space = adjust(4, (compress(scp_bin[50],9,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(scp_bin[50],9,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1, (compress(0,6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(0,6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(1, (compress(0,6,3))>>8 ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
space = adjust(8, (compress(0,6,3)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}
}
/*---------------------------------------------forming a science packet ends here----------------------------------------------*/
id = 0;
if(srp_mode == 0 && compression_option == 0){
if(at == 0){
length = 228+2; //2 spare bits
if(pzf == 0)
length += 121;
if(ezf == 0)
length +=41;
}else if(at == 1){
length = 266+6; //6 spare bits
if(pzf == 0)
length += 136;
if(ezf == 0)
length += 40;
}
}else if(srp_mode == 0 && compression_option == 1){ //data conservation mode
if(at == 0){
length = 94+2; //2 spare bits
if(pzf == 0)
length += 12;
if(ezf == 0)
length += 12;
}else if(at == 1){
length = 123+3; //3 spare bits
if(pzf == 0)
length += 9;
if(ezf == 0)
length += 9;
}
}
else if( srp_mode == 1){
if(at == 0)
length = 368;
else if(at == 1)
length = 432;
}
else if(compression_option == 2) //in extreme data conservation mode, length is same for both srp_modes
{
if(at == 0){
length = 31+1; //1 spare bits
if(pzf == 0)
length += 12;
if(ezf == 0)
length += 12;
}else if(at == 1){
length = 36+2; //2 spare bits
if(pzf == 0)
length += 9;
if(ezf == 0)
length += 9;
}
}
length = (length%8==0)?(length/8):(length/8)+1;
if(position_tm_frame[id]>129){
while(position_tm_frame[id]<132){
frames[id][position_tm_frame[id]] = 0;
position_tm_frame[id]++;
}
}
if(position_tm_frame[id]==position_tm_starting[id]){
frames[id][4] = position_tm_starting[id];
}
for(int j= 0; j < length ;)
{
if(position_tm_frame[id]==frames[id][4]){
frames[id][5] = (uint8_t)((sci_time>>29)&0x3f);
frames[id][6] = (uint8_t)((sci_time>>21)&0xff);
frames[id][7] = (uint8_t)((sci_time>>13)&0x3f);
}
if(position_tm_frame[id]<132){
frames[id][position_tm_frame[id]] = scp[j];
j++;
position_tm_frame[id]++;
}
if(position_tm_frame[id] == 132) //space full in the frame bro
{
pointer = frames[id];
space = adjust(1,0,pointer,8);
space = adjust(4,1,pointer,space);
FSC_science = FSC_CURRENT[1];
frames[id][1] = (FSC_science>>16)&0xff;
frames[id][2] = (FSC_science>>8)&0xff;
frames[id][3] = (FSC_science)&0xff;
temp_crc = crc16_gen(frames[id],132);
frames[id][132] = temp_crc>>8;
frames[id][133] = temp_crc & 0xff;
exor(frames[id]);
convolution(frames[id]);
interleave(TM_convoluted_data,TM_interleave_data);
interleave(TM_convoluted_data+ 135,TM_interleave_data + 144);
SD_WRITE(TM_interleave_data,FSC_science+1,1); //sd_write returns ack, for now not included
position_tm_frame[id] = position_tm_starting[id];
frames[id][4] = ((length-1) - j)+position_tm_starting[id];
}
}
}