shubham c
CDMS code for testing sbc
Dependencies: FreescaleIAP SimpleDMA mbed-rtos mbed
Fork of
CDMS_CODE
by 
shubham c
Diff: Compression.h
- Revision:
- 268:ded5306a1fd1
- Parent:
- 267:783c248a6207
- Child:
- 269:72529b247333
--- a/Compression.h Sat Jul 16 16:04:14 2016 +0000
+++ b/Compression.h Wed Jul 20 09:58:59 2016 +0000
@@ -14,6 +14,10 @@
//using namespace std;
//reading functions 2byte, 4byte
+#define srpz 1
+#define scpz 1
+#define scp_last 1
+#define srp_last 1
uint16_t read_2byte(uint8_t* ptr)
{
@@ -101,14 +105,15 @@
//give the pointer of 6 second data to this function
void srp(uint8_t * head)
{
- gPC.printf("\n\rEntered srp");
+ uint8_t sd_stat = 0;
+ gPC.printf("\n\rEntered srp function");
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++)
+ for (int i = 0; i < 52 ; i++)
{
scp_bin[i] = 0;
}
@@ -116,16 +121,23 @@
srp_mode = head[2]&0x1;
for(uint8_t counter = 0 ; counter < 60 ; counter++)
{
+ #if srpz
+ //gPC.printf("\n\n\rSRP count:%d",counter+1);
+ #endif
/*-------------------- ------------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
{
+ #if srpz
+ //gPC.printf("\n\rSRP - Calibrated Mode");
+ #endif
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])
{
+ //gPC.printf("\n\rSFP above threshold index:%d",i);
at = 1;
}
if(i<17)
@@ -143,31 +155,41 @@
{
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])
+ if(sfp_bin[i+48]>sfp_threshold_m0[i+48]){
+ //gPC.printf("\n\rSP above threshold index: %d",i+48);
at = 1;
+ }
}
}
else if(srp_mode == 1) //scattered mode
{
+ #if srpz
+ //gPC.printf("\n\rSRP - Scatter Plot Mode");
+ #endif
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])
+ //gPC.printf("\n\rsfp_bin[%d]= %u\t\tscp_bin[%d]= %u",i,sfp_bin[i],i,scp_bin[i]);
+ if(sfp_bin[i] > sfp_threshold_m1[i]){
+ //gPC.printf("\n\rSP above threshold index: %d",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])
+ if(sfp_bin[i+48] > sfp_threshold_m1[i+48]){
+ //gPC.printf("\n\rSP above threshold index: %d",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
+ //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
@@ -178,6 +200,9 @@
{
if(at == 0)
{
+ #if srpz
+ //gPC.printf("\n\rSFP Below Threshold");
+ #endif
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;
@@ -215,6 +240,9 @@
}
} //below thershold ends here.
if(at == 1){
+ #if srpz
+ //gPC.printf("\n\rSFP Above Threshold");
+ #endif
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);
@@ -242,6 +270,9 @@
if(pzf == 0){
//cout<<"proton bins ";
+ #if srpz
+ //gPC.printf("\n\rProton bins present in SRP");
+ #endif
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;
@@ -250,6 +281,9 @@
}
if(ezf == 0){
//cout<<"electron bins ";
+ #if srpz
+ //gPC.printf("\n\rElectron bins present in SRP");
+ #endif
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;
@@ -278,6 +312,9 @@
{
if(at == 0)
{
+ #if srpz
+ //gPC.printf("\n\rSFP below threshold");
+ #endif
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;
@@ -294,6 +331,10 @@
}
if(at == 1)
{
+
+ #if srpz
+ //gPC.printf("\n\rSFP below threshold");
+ #endif
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;
@@ -324,11 +365,17 @@
}
}
length = (length%8==0)?(length/8):(length/8)+1; //converting length to mulitple of 8
+ #if srpz
+ //gPC.printf("\n\rLength of SFP packet in bytes = %d",length);
+ #endif
/*----------------------------------------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){
+ #if srpz
+ //gPC.printf("\n\rSkipping the current frame.Inserting sfp packet into the next frame.");
+ #endif
while(position_tm_frame[id]<132){
frames[id][position_tm_frame[id]] = 0;
position_tm_frame[id]++;
@@ -337,6 +384,9 @@
}
else if(id==2){
if(position_tm_frame[id]>126){
+ #if srpz
+ //gPC.printf("\n\rSkipping the current frame.Inserting sfp packet into the next frame.");
+ #endif
while(position_tm_frame[id]<132){
frames[id][position_tm_frame[id]] = 0;
position_tm_frame[id]++;
@@ -350,6 +400,9 @@
{
if(position_tm_frame[id]==frames[id][6-id]){
if(id==1){
+ #if srpz
+ //gPC.printf("\n\rAdding Time to TM frame");
+ #endif
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);
@@ -365,11 +418,16 @@
if(position_tm_frame[id] == 132)
{
/*-----------the current frame is completely filled and we fill frame header to write into SD card---------*/
+ #if srpz
+ //gPC.printf("\n\rSFP_TM frame full. Length of current packet = %d",j);
+ //gPC.printf("\n\rFrame Header: %d",frames[id][6-id]);
+ //gPC.printf("\n\rFirst head pointer contents: 0x%02X",frames[id][frames[id][6-id]]);
+ #endif
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
+ 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;
@@ -387,7 +445,14 @@
temp_crc = crc16_gen(frames[id],132);
frames[id][132] = temp_crc>>8;
frames[id][133] = temp_crc & 0xff;
-
+
+ #if srpz
+ gPC.printf("\n\rPrinting SFP_TM\n\r{");
+ for(uint8_t z=0;z<134;z++){
+ gPC.printf("0x%02X,",frames[id][z]);
+ }
+ gPC.printf("}\n\r");
+ #endif
/*------------------current TM frame completely filled-----------------------*/
exor(frames[id]);
@@ -396,18 +461,61 @@
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
+ sd_stat = 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
+ sd_stat = SD_WRITE(TM_interleave_data,FSC_science+1,2); //sd_write will return ack later, for now not included
}
+ if(sd_stat)
+ {
+ gPC.puts("sd write fail");
+ }
position_tm_frame[id] = position_tm_starting[id];
- frames[id][6-id] = ((length-1) - j)+position_tm_starting[id];
+ frames[id][6-id] = (length - j)+position_tm_starting[id];
}
}
/*------------------------------finished inserting the sfp packet into the TM frame(s)-------------------------------------*/
- } // for loop bracket which runs 60 times
+ } // for loop bracket which runs 60 times
+ #if srpz_last
+ //gPC.printf("\n\rPrinting the last SFP_TM frame");
+ //gPC.printf("\n\n\rPosition of tm_pointer: %d",position_tm_frame[id]);
+ while(position_tm_frame[id]<132){
+ frames[id][position_tm_frame[id]] = 0;
+ position_tm_frame[id]++;
+ }
+ if(position_tm_frame[id]==132){
+ //gPC.printf("\n\rFirst head pointer contents: 0x%02X",frames[id][frames[id][6-id]]);
+ 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;
+
+ gPC.printf("\n\rPrinting SFP_TM\n\r{");
+ for(uint8_t z=0;z<134;z++){
+ gPC.printf("0x%02X,",frames[id][z]);
+ }
+ gPC.printf("}\n\r");
+ }
+ #endif
at = 0; pzf = 1; ezf = 1;
srp_mode = head[2]&0x1;
uint8_t compression_option = (head[2]>>1)&0x3;
@@ -421,6 +529,7 @@
{
if(scp_bin[i] > scp_threshold_m0[i])
{
+ //gPC.printf("\n\rSCP above threshold index: %d",i);
at = 1;
break;
}
@@ -428,17 +537,25 @@
}
else if(compression_option == 1)
{
- if(scp_bin[44] > scp_threshold_m0_1[0]) at=1;
+ if(scp_bin[44] > scp_threshold_m0_1[0]){//gPC.printf("\n\rSCP above threshold index: 44");
+ at=1;}
for(int i=0; i<4 ;i++)
{
if(scp_bin[48+i] > scp_threshold_m0_1[i+1])
{
+ //gPC.printf("\n\rSCP above threshold index: %d",i+48);
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;
+ if(scp_bin[17] > scp_threshold_m0_1[5]){
+ //gPC.printf("\n\rSP above threshold index: 17");
+ at=1;
+ }
+ if(scp_bin[23] > scp_threshold_m0_1[6]){
+ //gPC.printf("\n\rSP above threshold index: 23");
+ at=1;
+ }
proton_scp_sum = 0; electron_scp_sum = 0;
for(int i=0;i<17;i++)
@@ -449,12 +566,15 @@
{
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;
+ if(proton_scp_sum > scp_threshold_m0_1[7]){ //gPC.printf("\n\rProton_scp_sum above threshold");
+ at=1;}
+ if(electron_scp_sum > scp_threshold_m0_1[8]){//gPC.printf("\n\rElectron_scp_sum above threshold");
+ at=1;}
}
else if(compression_option == 2)
{
- if(scp_bin[50] > scp_sfp_threshold_m0_2[0]) at=1;
+ if(scp_bin[50] > scp_sfp_threshold_m0_2[0]){//gPC.printf("\n\rSCP above threshold index:50");
+ at=1;}
proton_scp_sum = 0; electron_scp_sum = 0;
for(int i=0;i<17;i++)
{
@@ -464,16 +584,19 @@
{
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;
+ if(proton_scp_sum > scp_sfp_threshold_m0_2[1]){//gPC.printf("\n\rProton_SCP_sum above threshold");
+ at=1;}
+ if(electron_scp_sum > scp_sfp_threshold_m0_2[2]){//gPC.printf("\n\rElectron above threshold");
+ at=1;}
}
}
else if(srp_mode ==1)
{
- if(compression_option==0){
+ if(compression_option==0){
for(int i=0; i<48; i++)
{
if(scp_bin[i] > scp_threshold_m1[i]){
+ //gPC.printf("\nSCP above threshold index:%d, Value:%d",i,scp_bin[i]);
at = 1;
break;
}
@@ -481,13 +604,17 @@
for(int i=48; i<52; i++)
{
if(scp_bin[i] > scp_threshold_m1[i]){
+ //gPC.printf("\nSCP above threshold index:%d, Value:%d",i,scp_bin[i]);
at = 1;
break;
}
}
}
- else if(compression_option==2){
- if(scp_bin[50]>scp_sfp_threshold_m0_2[0]) at=1;
+ else if(compression_option==2){
+ if(scp_bin[50]>scp_sfp_threshold_m0_2[0]){
+ //gPC.printf("\nSCP above threshold index:50, Value:%",scp_bin[50]);
+ at=1;
+ }
}
}
/*----------------------------Tagging the scp packet formed from these 60 sfp's as AT or BT ends here--------------------------*/
@@ -645,7 +772,7 @@
beacon_cntr++;
/*--------------------------------------------------beacon packet ends here--------------------------------------------------------*/
- gPC.printf("scp\r\n");
+ //gPC.printf("\n\rSCP count: %d");
uint8_t packet_pp,time_diff;
/*------------------------------------------Forming a science packet(scp) starts here----------------------------------------------*/
@@ -679,9 +806,15 @@
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
+ #if scpz
+ //gPC.printf("\n\rSCP - Normal calibrated mode");
+ #endif
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 ){
+ #if scpz
+ //gPC.printf("\n\rBelow threshold");
+ #endif
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;
}
@@ -713,6 +846,9 @@
}
}// below threshold ends here
if(at == 1){
+ #if scpz
+ //gPC.printf("\n\rAbove threshold");
+ #endif
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;
}
@@ -745,7 +881,13 @@
} //above thresholds ends
} //srp_mode == 0 ends
if(srp_mode == 1){
+ #if scpz
+ //gPC.printf("\n\rSCP - Scatter plot mode");
+ #endif
if(at == 0){
+ #if scpz
+ //gPC.printf("\n\rBelow Threshold");
+ #endif
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;
}
@@ -754,6 +896,9 @@
}
}
if(at == 1){
+ #if scpz
+ //gPC.printf("\n\rAbove threshold");
+ #endif
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;
}
@@ -764,9 +909,15 @@
}
}// scp mode 1 end
if( srp_mode == 0 && compression_option == 1 ){ //scp data conservation mode
+ #if scpz
+ //gPC.printf("\n\rSCP - Calibrated data conservation mode");
+ #endif
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){
+ #if scpz
+ //gPC.printf("\n\rBelow threshold");
+ #endif
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;
@@ -782,6 +933,9 @@
space = adjust(8, (compress(electron_scp_sum,10,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}else if(at == 1){
+ #if scpz
+ //gPC.printf("\n\rAbove threshold");
+ #endif
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++){
@@ -806,9 +960,15 @@
{
if(srp_mode==0)
{
+ #if scpz
+ //gPC.printf("\n\rSCP - calibrated extreme data conservation mode");
+ #endif
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){
+ #if scpz
+ //gPC.printf("\n\rBelow threshold");
+ #endif
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;
@@ -819,6 +979,9 @@
space = adjust(8, (compress(electron_scp_sum,10,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
}else if(at==1){
+ #if scpz
+ //gPC.printf("\n\rAbove threshold");
+ #endif
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){
@@ -833,10 +996,16 @@
}
else if(srp_mode==1)
{
+ #if scpz
+ //gPC.printf("\n\rSCP - Scatter plot, extreme data conservation mode");
+ #endif
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){
+ #if scpz
+ //gPC.printf("\n\rBelow threshold");
+ #endif
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;
@@ -845,6 +1014,9 @@
space = adjust(8, (compress(0,10,2)) ,pointer,space); pointer += space>>4; debug_cntr += space>>4;
}
else if(at==1){
+ #if scpz
+ //gPC.printf("\n\rAbove threshold");
+ #endif
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;
@@ -909,7 +1081,14 @@
}
}
length = (length%8==0)?(length/8):(length/8)+1;
- if(position_tm_frame[id]>129){
+ #if scpz
+ //gPC.printf("\n\rSCP packet length = %d",length);
+ #endif
+ if(position_tm_frame[id]>129){
+ #if scpz
+ //gPC.printf("\n\rSkipping the current TM frame. Inserting SCP into the next frame");
+ //gPC.printf("\n\rposition_tm_frame = %d",position_tm_frame[id]);
+ #endif
while(position_tm_frame[id]<132){
frames[id][position_tm_frame[id]] = 0;
position_tm_frame[id]++;
@@ -921,6 +1100,9 @@
for(int j= 0; j < length ;)
{
if(position_tm_frame[id]==frames[id][4]){
+ #if scpz
+ //gPC.printf("\n\rInserting Time into SCP_TM");
+ #endif
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);
@@ -932,6 +1114,9 @@
}
if(position_tm_frame[id] == 132) //space full in the frame bro
{
+ #if scpz
+ //gPC.printf("\n\rSCP_TM frame full. Length of current SCP packet = %d",j);
+ #endif
pointer = frames[id];
space = adjust(1,0,pointer,8);
space = adjust(4,1,pointer,space);
@@ -942,15 +1127,67 @@
temp_crc = crc16_gen(frames[id],132);
frames[id][132] = temp_crc>>8;
frames[id][133] = temp_crc & 0xff;
+ #if scpz
+ //gPC.printf("\n\rFirst head pointer contents: 0x%02X",frames[id][frames[id][4]]);
+ gPC.printf("\n\rPrinting SCP_TM\n\r{");
+ for(uint8_t z=0;z<134;z++){
+ gPC.printf("0x%02X,",frames[id][z]);
+ }
+ gPC.printf("}\n\r");
+ #endif
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
-
+ sd_stat = SD_WRITE(TM_interleave_data,FSC_science+1,1); //sd_write returns ack, for now not included
+ if(sd_stat)
+ {
+ gPC.puts("sd write fail");
+ }
+
position_tm_frame[id] = position_tm_starting[id];
- frames[id][4] = ((length-1) - j)+position_tm_starting[id];
+ frames[id][4] = (length - j)+position_tm_starting[id];
}
}
+ #if scpz_last
+ //gPC.printf("\n\rPrinting the last SFP_TM frame");
+ //gPC.printf("\n\n\rPosition of tm_pointer: %d",position_tm_frame[id]);
+ while(position_tm_frame[id]<132){
+ frames[id][position_tm_frame[id]] = 0;
+ position_tm_frame[id]++;
+ }
+ if(position_tm_frame[id]==132){
+ //gPC.printf("\n\rFirst head pointer contents: 0x%02X",frames[id][frames[id][4]]);
+ pointer = frames[id];
+ if(id == 1){ //below threshold
+ space = adjust(1,0,pointer,8);
+ space = adjust(4,3,pointer,space);
+ FSC_science = FSC_CURRENT[1]; ///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;
+
+
+ gPC.printf("\n\rPrinting SCP_TM\n\r{");
+ for(uint8_t z=0;z<134;z++){
+ gPC.printf("0x%02X,",frames[id][z]);
+ }
+ gPC.printf("}\n\r");
+ }
+ #endif
}
\ No newline at end of file