##// END OF EJS Templates
HG_REPOSITORIES » LPP » INSTRUMENTATION » SOLO_LFR » DEV_PLE
RSS

Clone from http://pc-instru.lpp.polytechnique.fr:5000/DEV_PLE

begin to work on:...
begin to work on: Bug 984 FFT retirée alors que en dehors du TBAD Bug 978 Mauvais nombre de FFT retiré lors du filtrage PAS commit before going back to previous state for 3.2.0.4 delivery
paul - - Load All Authors

File last commit:

r352:c07c16776bd4 R3++
r353:06a7ca24f3e7 R3++
Show More
tc_load_dump_parameters.c
2061 lines | 74.7 KiB | text/x-c | CLexer
/ src / tc_load_dump_parameters.c
History | Source | Raw |Copy content |Copy permalink
paul
Header files inclusion reworked...
 r40 /** Functions to load and dump parameters in the LFR registers.
*
* @file
* @author P. LEROY
*
* A group of functions to handle TC related to parameter loading and dumping.\n
* TC_LFR_LOAD_COMMON_PAR\n
* TC_LFR_LOAD_NORMAL_PAR\n
* TC_LFR_LOAD_BURST_PAR\n
* TC_LFR_LOAD_SBM1_PAR\n
* TC_LFR_LOAD_SBM2_PAR\n
*
*/
#include "tc_load_dump_parameters.h"
paul
Bug #796 Don_Initialisation_P1
 r321 Packet_TM_LFR_KCOEFFICIENTS_DUMP_t kcoefficients_dump_1 = {0};
Packet_TM_LFR_KCOEFFICIENTS_DUMP_t kcoefficients_dump_2 = {0};
ring_node kcoefficient_node_1 = {0};
ring_node kcoefficient_node_2 = {0};
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194
paul
Header files inclusion reworked...
 r40 int action_load_common_par(ccsdsTelecommandPacket_t *TC)
{
/** This function updates the LFR registers with the incoming common parameters.
*
* @param TC points to the TeleCommand packet that is being processed
*
*
*/
paul
Minor changes in .h inclusion
 r45
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 parameter_dump_packet.sy_lfr_common_parameters_spare = TC->dataAndCRC[0];
parameter_dump_packet.sy_lfr_common_parameters = TC->dataAndCRC[1];
paul
Sync
 r97 set_wfp_data_shaping( );
paul
Header files inclusion reworked...
 r40 return LFR_SUCCESSFUL;
}
paul
fsw-0-23...
 r75 int action_load_normal_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
paul
Header files inclusion reworked...
 r40 {
/** This function updates the LFR registers with the incoming normal parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
paul
Minor changes in .h inclusion
 r45
paul
Header files inclusion reworked...
 r40 int result;
int flag;
paul
Minor modifications to meet Logiscope requirements
 r78 rtems_status_code status;
paul
Header files inclusion reworked...
 r40
flag = LFR_SUCCESSFUL;
paul
fsw-0-20
 r58 if ( (lfrCurrentMode == LFR_MODE_NORMAL) ||
(lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) ) {
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
paul
Header files inclusion reworked...
 r40 flag = LFR_DEFAULT;
}
paul
Bug #167...
 r152 // CHECK THE PARAMETERS SET CONSISTENCY
paul
Bug #167
 r142 if (flag == LFR_SUCCESSFUL)
{
paul
3.0.0.21...
 r275 flag = check_normal_par_consistency( TC, queue_id );
paul
Bug #167
 r142 }
paul
Bug #167...
 r152 // SET THE PARAMETERS IF THEY ARE CONSISTENT
paul
There is a message queue between AVFO and MATR...
 r118 if (flag == LFR_SUCCESSFUL)
{
paul
Bug #167...
 r152 result = set_sy_lfr_n_swf_l( TC );
result = set_sy_lfr_n_swf_p( TC );
result = set_sy_lfr_n_bp_p0( TC );
result = set_sy_lfr_n_bp_p1( TC );
result = set_sy_lfr_n_asm_p( TC );
result = set_sy_lfr_n_cwf_long_f3( TC );
paul
ICD 2.0...
 r92 }
paul
fsw-0-20
 r58 return flag;
paul
Header files inclusion reworked...
 r40 }
paul
fsw-0-23...
 r75 int action_load_burst_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
paul
Header files inclusion reworked...
 r40 {
/** This function updates the LFR registers with the incoming burst parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
paul
Minor changes in .h inclusion
 r45
paul
Sync...
 r117 int flag;
paul
Minor modifications to meet Logiscope requirements
 r78 rtems_status_code status;
paul
Sync...
 r117 unsigned char sy_lfr_b_bp_p0;
unsigned char sy_lfr_b_bp_p1;
float aux;
paul
Header files inclusion reworked...
 r40
paul
Sync...
 r117 flag = LFR_SUCCESSFUL;
paul
Header files inclusion reworked...
 r40
paul
Sync...
 r117 if ( lfrCurrentMode == LFR_MODE_BURST ) {
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
paul
Bug #176
 r159 flag = LFR_DEFAULT;
paul
Header files inclusion reworked...
 r40 }
paul
Bug #167...
 r152 sy_lfr_b_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P0 ];
sy_lfr_b_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P1 ];
paul
correction de bug #485
 r223 // sy_lfr_b_bp_p0 shall not be lower than its default value
paul
Bug #167...
 r152 if (flag == LFR_SUCCESSFUL)
{
if (sy_lfr_b_bp_p0 < DEFAULT_SY_LFR_B_BP_P0 )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_B_BP_P0 + DATAFIELD_OFFSET, sy_lfr_b_bp_p0 );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
paul
correction de bug #485
 r223 // sy_lfr_b_bp_p1 shall not be lower than its default value
paul
Bug #167...
 r152 if (flag == LFR_SUCCESSFUL)
{
if (sy_lfr_b_bp_p1 < DEFAULT_SY_LFR_B_BP_P1 )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_B_BP_P1 + DATAFIELD_OFFSET, sy_lfr_b_bp_p1 );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
paul
Sync...
 r117 //****************************************************************
// check the consistency between sy_lfr_b_bp_p0 and sy_lfr_b_bp_p1
if (flag == LFR_SUCCESSFUL)
{
sy_lfr_b_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P0 ];
sy_lfr_b_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P1 ];
aux = ( (float ) sy_lfr_b_bp_p1 / sy_lfr_b_bp_p0 ) - floor(sy_lfr_b_bp_p1 / sy_lfr_b_bp_p0);
paul
Many corrections done after Logiscope analysis
 r166 if (aux > FLOAT_EQUAL_ZERO)
paul
Sync...
 r117 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_B_BP_P0 + DATAFIELD_OFFSET, sy_lfr_b_bp_p0 );
paul
Sync...
 r117 flag = LFR_DEFAULT;
}
paul
Header files inclusion reworked...
 r40 }
paul
correction de bug #485
 r223 // SET THE PARAMETERS
paul
Sync...
 r117 if (flag == LFR_SUCCESSFUL)
{
paul
Bug #176
 r159 flag = set_sy_lfr_b_bp_p0( TC );
flag = set_sy_lfr_b_bp_p1( TC );
paul
Sync...
 r117 }
return flag;
paul
Header files inclusion reworked...
 r40 }
paul
fsw-0-23...
 r75 int action_load_sbm1_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
paul
Header files inclusion reworked...
 r40 {
/** This function updates the LFR registers with the incoming sbm1 parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
paul
Sync...
 r117 int flag;
rtems_status_code status;
unsigned char sy_lfr_s1_bp_p0;
unsigned char sy_lfr_s1_bp_p1;
float aux;
paul
Header files inclusion reworked...
 r40
paul
Sync...
 r117 flag = LFR_SUCCESSFUL;
if ( lfrCurrentMode == LFR_MODE_SBM1 ) {
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
paul
Bug #176
 r159 flag = LFR_DEFAULT;
paul
Header files inclusion reworked...
 r40 }
paul
Bug #167...
 r152 sy_lfr_s1_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S1_BP_P0 ];
sy_lfr_s1_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S1_BP_P1 ];
// sy_lfr_s1_bp_p0
if (flag == LFR_SUCCESSFUL)
{
if (sy_lfr_s1_bp_p0 < DEFAULT_SY_LFR_S1_BP_P0 )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P0 + DATAFIELD_OFFSET, sy_lfr_s1_bp_p0 );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
// sy_lfr_s1_bp_p1
if (flag == LFR_SUCCESSFUL)
{
if (sy_lfr_s1_bp_p1 < DEFAULT_SY_LFR_S1_BP_P1 )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P1 + DATAFIELD_OFFSET, sy_lfr_s1_bp_p1 );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
paul
Sync...
 r117 //******************************************************************
// check the consistency between sy_lfr_s1_bp_p0 and sy_lfr_s1_bp_p1
if (flag == LFR_SUCCESSFUL)
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 aux = ( (float ) sy_lfr_s1_bp_p1 / (sy_lfr_s1_bp_p0 * S1_BP_P0_SCALE) )
- floor(sy_lfr_s1_bp_p1 / (sy_lfr_s1_bp_p0 * S1_BP_P0_SCALE));
paul
Many corrections done after Logiscope analysis
 r166 if (aux > FLOAT_EQUAL_ZERO)
paul
Sync...
 r117 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P0 + DATAFIELD_OFFSET, sy_lfr_s1_bp_p0 );
paul
Sync...
 r117 flag = LFR_DEFAULT;
}
paul
Header files inclusion reworked...
 r40 }
paul
Bug #167...
 r152 // SET THE PARAMETERS
paul
Sync...
 r117 if (flag == LFR_SUCCESSFUL)
{
paul
Bug #176
 r159 flag = set_sy_lfr_s1_bp_p0( TC );
flag = set_sy_lfr_s1_bp_p1( TC );
paul
Sync...
 r117 }
return flag;
paul
Header files inclusion reworked...
 r40 }
paul
fsw-0-23...
 r75 int action_load_sbm2_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
paul
Header files inclusion reworked...
 r40 {
/** This function updates the LFR registers with the incoming sbm2 parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
paul
Sync...
 r117 int flag;
paul
Minor modifications to meet Logiscope requirements
 r78 rtems_status_code status;
paul
Sync...
 r117 unsigned char sy_lfr_s2_bp_p0;
unsigned char sy_lfr_s2_bp_p1;
float aux;
paul
Header files inclusion reworked...
 r40
paul
Sync...
 r117 flag = LFR_SUCCESSFUL;
paul
Header files inclusion reworked...
 r40
paul
Sync...
 r117 if ( lfrCurrentMode == LFR_MODE_SBM2 ) {
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
paul
Bug #176
 r159 flag = LFR_DEFAULT;
paul
Header files inclusion reworked...
 r40 }
paul
Bug #167...
 r152 sy_lfr_s2_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P0 ];
sy_lfr_s2_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P1 ];
// sy_lfr_s2_bp_p0
if (flag == LFR_SUCCESSFUL)
{
if (sy_lfr_s2_bp_p0 < DEFAULT_SY_LFR_S2_BP_P0 )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S2_BP_P0 + DATAFIELD_OFFSET, sy_lfr_s2_bp_p0 );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
// sy_lfr_s2_bp_p1
if (flag == LFR_SUCCESSFUL)
{
if (sy_lfr_s2_bp_p1 < DEFAULT_SY_LFR_S2_BP_P1 )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S2_BP_P1 + DATAFIELD_OFFSET, sy_lfr_s2_bp_p1 );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
paul
Sync...
 r117 //******************************************************************
// check the consistency between sy_lfr_s2_bp_p0 and sy_lfr_s2_bp_p1
if (flag == LFR_SUCCESSFUL)
{
sy_lfr_s2_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P0 ];
sy_lfr_s2_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P1 ];
aux = ( (float ) sy_lfr_s2_bp_p1 / sy_lfr_s2_bp_p0 ) - floor(sy_lfr_s2_bp_p1 / sy_lfr_s2_bp_p0);
paul
Many corrections done after Logiscope analysis
 r166 if (aux > FLOAT_EQUAL_ZERO)
paul
Sync...
 r117 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S2_BP_P0 + DATAFIELD_OFFSET, sy_lfr_s2_bp_p0 );
paul
Sync...
 r117 flag = LFR_DEFAULT;
}
paul
Header files inclusion reworked...
 r40 }
paul
Bug #167...
 r152 // SET THE PARAMETERS
paul
Sync...
 r117 if (flag == LFR_SUCCESSFUL)
{
paul
Bug #176
 r159 flag = set_sy_lfr_s2_bp_p0( TC );
flag = set_sy_lfr_s2_bp_p1( TC );
paul
Sync...
 r117 }
return flag;
paul
Header files inclusion reworked...
 r40 }
paul
R3 updates. TC handlers added for the new telecommands:...
 r192 int action_load_kcoefficients(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
{
/** This function updates the LFR registers with the incoming sbm2 parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int flag;
flag = LFR_DEFAULT;
paul
#426 corrected, sy_lfr_kcoeff_frequency >= 36 triggers the transmission of...
 r211 flag = set_sy_lfr_kcoeff( TC, queue_id );
paul
R3 updates. TC handlers added for the new telecommands:...
 r192
return flag;
}
int action_load_fbins_mask(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
{
/** This function updates the LFR registers with the incoming sbm2 parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int flag;
flag = LFR_DEFAULT;
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 flag = set_sy_lfr_fbins( TC );
paul
R3 updates. TC handlers added for the new telecommands:...
 r192
paul
Bug #649 corrected, TC with Length > 228 are dropped by the driver, not parsed
 r316 // once the fbins masks have been stored, they have to be merged with the masks which handle the reaction wheels frequencies filtering
merge_fbins_masks();
paul
R3 updates. TC handlers added for the new telecommands:...
 r192 return flag;
}
paul
ICD 4.1 taken into account
 r283 int action_load_filter_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 {
/** This function updates the LFR registers with the incoming sbm2 parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int flag;
paul
compliance with ICD 4.3...
 r328 unsigned char k;
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282
flag = LFR_DEFAULT;
paul
compliance with ICD 4.3...
 r328 k = INIT_CHAR;
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282
paul
minor updates
 r285 flag = check_sy_lfr_filter_parameters( TC, queue_id );
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282
if (flag == LFR_SUCCESSFUL)
{
paul
ICD 4.1 taken into account
 r283 parameter_dump_packet.spare_sy_lfr_pas_filter_enabled = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_ENABLED ];
parameter_dump_packet.sy_lfr_pas_filter_modulus = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS ];
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_0] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_0 ];
parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_1] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_1 ];
parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_2] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_2 ];
parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_3] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_3 ];
paul
ICD 4.1 taken into account
 r283 parameter_dump_packet.sy_lfr_pas_filter_offset = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET ];
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_0] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_0 ];
parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_1] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_1 ];
parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_2] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_2 ];
parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_3] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_3 ];
parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_0] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_0 ];
parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_1] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_1 ];
parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_2] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_2 ];
parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_3] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_3 ];
paul
reaction wheels filtering implemented
 r286
paul
3.1.0.2...
 r293 //****************************
// store PAS filter parameters
// sy_lfr_pas_filter_enabled
filterPar.spare_sy_lfr_pas_filter_enabled = parameter_dump_packet.spare_sy_lfr_pas_filter_enabled;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 set_sy_lfr_pas_filter_enabled( parameter_dump_packet.spare_sy_lfr_pas_filter_enabled & BIT_PAS_FILTER_ENABLED );
paul
3.1.0.2...
 r293 // sy_lfr_pas_filter_modulus
filterPar.sy_lfr_pas_filter_modulus = parameter_dump_packet.sy_lfr_pas_filter_modulus;
// sy_lfr_pas_filter_tbad
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_pas_filter_tbad,
parameter_dump_packet.sy_lfr_pas_filter_tbad );
// sy_lfr_pas_filter_offset
filterPar.sy_lfr_pas_filter_offset = parameter_dump_packet.sy_lfr_pas_filter_offset;
// sy_lfr_pas_filter_shift
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_pas_filter_shift,
parameter_dump_packet.sy_lfr_pas_filter_shift );
//****************************************************
paul
reaction wheels filtering implemented
 r286 // store the parameter sy_lfr_sc_rw_delta_f as a float
paul
3.1.0.2...
 r293 copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_sc_rw_delta_f,
parameter_dump_packet.sy_lfr_sc_rw_delta_f );
paul
compliance with ICD 4.3...
 r328
// copy rw.._k.. from the incoming TC to the local parameter_dump_packet
for (k = 0; k < NB_RW_K_COEFFS * NB_BYTES_PER_RW_K_COEFF; k++)
{
parameter_dump_packet.sy_lfr_rw1_k1[k] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_RW1_K1 + k ];
}
//***********************************************
// store the parameter sy_lfr_rw.._k.. as a float
// rw1_k
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw1_k1, parameter_dump_packet.sy_lfr_rw1_k1 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw1_k2, parameter_dump_packet.sy_lfr_rw1_k2 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw1_k3, parameter_dump_packet.sy_lfr_rw1_k3 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw1_k4, parameter_dump_packet.sy_lfr_rw1_k4 );
// rw2_k
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw2_k1, parameter_dump_packet.sy_lfr_rw2_k1 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw2_k2, parameter_dump_packet.sy_lfr_rw2_k2 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw2_k3, parameter_dump_packet.sy_lfr_rw2_k3 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw2_k4, parameter_dump_packet.sy_lfr_rw2_k4 );
// rw3_k
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw3_k1, parameter_dump_packet.sy_lfr_rw3_k1 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw3_k2, parameter_dump_packet.sy_lfr_rw3_k2 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw3_k3, parameter_dump_packet.sy_lfr_rw3_k3 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw3_k4, parameter_dump_packet.sy_lfr_rw3_k4 );
// rw4_k
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw4_k1, parameter_dump_packet.sy_lfr_rw4_k1 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw4_k2, parameter_dump_packet.sy_lfr_rw4_k2 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw4_k3, parameter_dump_packet.sy_lfr_rw4_k3 );
copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw4_k4, parameter_dump_packet.sy_lfr_rw4_k4 );
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 }
return flag;
}
paul
R3 updates. TC handlers added for the new telecommands:...
 r192 int action_dump_kcoefficients(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
{
/** This function updates the LFR registers with the incoming sbm2 parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 unsigned int address;
rtems_status_code status;
unsigned int freq;
unsigned int bin;
unsigned int coeff;
unsigned char *kCoeffPtr;
unsigned char *kCoeffDumpPtr;
paul
R3 updates. TC handlers added for the new telecommands:...
 r192
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 // for each sy_lfr_kcoeff_frequency there is 32 kcoeff
// F0 => 11 bins
// F1 => 13 bins
// F2 => 12 bins
// 36 bins to dump in two packets (30 bins max per packet)
paul
R3 updates. TC handlers added for the new telecommands:...
 r192
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 //*********
// PACKET 1
// 11 F0 bins, 13 F1 bins and 6 F2 bins
paul
bug #508 corrected (destination_id of TM_LFR_KCOEFFICIENTS_DUMP)
 r221 kcoefficients_dump_1.destinationID = TC->sourceID;
paul
printf removed or replaced by PRINTF macros...
 r227 increment_seq_counter_destination_id_dump( kcoefficients_dump_1.packetSequenceControl, TC->sourceID );
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for( freq = 0;
freq < NB_BINS_COMPRESSED_SM_F0;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 freq++ )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump_1.kcoeff_blks[ (freq*KCOEFF_BLK_SIZE) + 1] = freq;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 bin = freq;
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 // printKCoefficients( freq, bin, k_coeff_intercalib_f0_norm);
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 for ( coeff=0; coeff<NB_K_COEFF_PER_BIN; coeff++ )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kCoeffDumpPtr = (unsigned char*) &kcoefficients_dump_1.kcoeff_blks[
(freq*KCOEFF_BLK_SIZE) + (coeff*NB_BYTES_PER_FLOAT) + KCOEFF_FREQ
]; // 2 for the kcoeff_frequency
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kCoeffPtr = (unsigned char*) &k_coeff_intercalib_f0_norm[ (bin*NB_K_COEFF_PER_BIN) + coeff ];
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 copyFloatByChar( kCoeffDumpPtr, kCoeffPtr );
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 }
}
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for( freq = NB_BINS_COMPRESSED_SM_F0;
freq < ( NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1 );
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 freq++ )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump_1.kcoeff_blks[ (freq*KCOEFF_BLK_SIZE) + 1 ] = freq;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 bin = freq - NB_BINS_COMPRESSED_SM_F0;
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 // printKCoefficients( freq, bin, k_coeff_intercalib_f1_norm);
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 for ( coeff=0; coeff<NB_K_COEFF_PER_BIN; coeff++ )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kCoeffDumpPtr = (unsigned char*) &kcoefficients_dump_1.kcoeff_blks[
(freq*KCOEFF_BLK_SIZE) + (coeff*NB_BYTES_PER_FLOAT) + KCOEFF_FREQ
]; // 2 for the kcoeff_frequency
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kCoeffPtr = (unsigned char*) &k_coeff_intercalib_f1_norm[ (bin*NB_K_COEFF_PER_BIN) + coeff ];
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 copyFloatByChar( kCoeffDumpPtr, kCoeffPtr );
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 }
}
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for( freq = ( NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1 );
freq < KCOEFF_BLK_NR_PKT1 ;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 freq++ )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump_1.kcoeff_blks[ (freq * KCOEFF_BLK_SIZE) + 1 ] = freq;
bin = freq - (NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1);
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 // printKCoefficients( freq, bin, k_coeff_intercalib_f2);
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for ( coeff = 0; coeff <NB_K_COEFF_PER_BIN; coeff++ )
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kCoeffDumpPtr = (unsigned char*) &kcoefficients_dump_1.kcoeff_blks[
(freq * KCOEFF_BLK_SIZE) + (coeff * NB_BYTES_PER_FLOAT) + KCOEFF_FREQ
]; // 2 for the kcoeff_frequency
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kCoeffPtr = (unsigned char*) &k_coeff_intercalib_f2[ (bin*NB_K_COEFF_PER_BIN) + coeff ];
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 copyFloatByChar( kCoeffDumpPtr, kCoeffPtr );
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 }
}
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump_1.time[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
kcoefficients_dump_1.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
kcoefficients_dump_1.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
kcoefficients_dump_1.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
kcoefficients_dump_1.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
kcoefficients_dump_1.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 // SEND DATA
kcoefficient_node_1.status = 1;
address = (unsigned int) &kcoefficient_node_1;
status = rtems_message_queue_send( queue_id, &address, sizeof( ring_node* ) );
if (status != RTEMS_SUCCESSFUL) {
PRINTF1("in action_dump_kcoefficients *** ERR sending packet 1 , code %d", status)
}
paul
R3 updates. TC handlers added for the new telecommands:...
 r192
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 //********
// PACKET 2
// 6 F2 bins
paul
bug #508 corrected (destination_id of TM_LFR_KCOEFFICIENTS_DUMP)
 r221 kcoefficients_dump_2.destinationID = TC->sourceID;
paul
printf removed or replaced by PRINTF macros...
 r227 increment_seq_counter_destination_id_dump( kcoefficients_dump_2.packetSequenceControl, TC->sourceID );
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for( freq = 0;
freq < KCOEFF_BLK_NR_PKT2;
freq++ )
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump_2.kcoeff_blks[ (freq*KCOEFF_BLK_SIZE) + 1 ] = KCOEFF_BLK_NR_PKT1 + freq;
bin = freq + KCOEFF_BLK_NR_PKT2;
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 // printKCoefficients( freq, bin, k_coeff_intercalib_f2);
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 for ( coeff=0; coeff<NB_K_COEFF_PER_BIN; coeff++ )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kCoeffDumpPtr = (unsigned char*) &kcoefficients_dump_2.kcoeff_blks[
(freq*KCOEFF_BLK_SIZE) + (coeff*NB_BYTES_PER_FLOAT) + KCOEFF_FREQ ]; // 2 for the kcoeff_frequency
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kCoeffPtr = (unsigned char*) &k_coeff_intercalib_f2[ (bin*NB_K_COEFF_PER_BIN) + coeff ];
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 copyFloatByChar( kCoeffDumpPtr, kCoeffPtr );
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 }
}
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump_2.time[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
kcoefficients_dump_2.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
kcoefficients_dump_2.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
kcoefficients_dump_2.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
kcoefficients_dump_2.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
kcoefficients_dump_2.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 // SEND DATA
kcoefficient_node_2.status = 1;
address = (unsigned int) &kcoefficient_node_2;
status = rtems_message_queue_send( queue_id, &address, sizeof( ring_node* ) );
if (status != RTEMS_SUCCESSFUL) {
PRINTF1("in action_dump_kcoefficients *** ERR sending packet 2, code %d", status)
}
return status;
paul
R3 updates. TC handlers added for the new telecommands:...
 r192 }
paul
bug #507 corrected (destination_id of TM_LFR_PARAMETER_DUMP)
 r222 int action_dump_par( ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
paul
Header files inclusion reworked...
 r40 {
/** This function dumps the LFR parameters by sending the appropriate TM packet to the dedicated RTEMS message queue.
*
* @param queue_id is the id of the queue which handles TM related to this execution step.
*
* @return RTEMS directive status codes:
* - RTEMS_SUCCESSFUL - message sent successfully
* - RTEMS_INVALID_ID - invalid queue id
* - RTEMS_INVALID_SIZE - invalid message size
* - RTEMS_INVALID_ADDRESS - buffer is NULL
* - RTEMS_UNSATISFIED - out of message buffers
* - RTEMS_TOO_MANY - queue s limit has been reached
*
*/
int status;
paul
printf removed or replaced by PRINTF macros...
 r227 increment_seq_counter_destination_id_dump( parameter_dump_packet.packetSequenceControl, TC->sourceID );
paul
bug #507 corrected (destination_id of TM_LFR_PARAMETER_DUMP)
 r222 parameter_dump_packet.destinationID = TC->sourceID;
paul
Bug #117
 r149
paul
printf removed or replaced by PRINTF macros...
 r227 // UPDATE TIME
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.time[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
parameter_dump_packet.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
parameter_dump_packet.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
parameter_dump_packet.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
parameter_dump_packet.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
parameter_dump_packet.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
paul
Header files inclusion reworked...
 r40 // SEND DATA
status = rtems_message_queue_send( queue_id, &parameter_dump_packet,
PACKET_LENGTH_PARAMETER_DUMP + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES);
if (status != RTEMS_SUCCESSFUL) {
PRINTF1("in action_dump *** ERR sending packet, code %d", status)
}
return status;
}
//***********************
// NORMAL MODE PARAMETERS
paul
3.0.0.21...
 r275 int check_normal_par_consistency( ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
paul
Bug #167...
 r152 {
unsigned char msb;
unsigned char lsb;
int flag;
float aux;
rtems_status_code status;
unsigned int sy_lfr_n_swf_l;
unsigned int sy_lfr_n_swf_p;
unsigned int sy_lfr_n_asm_p;
unsigned char sy_lfr_n_bp_p0;
unsigned char sy_lfr_n_bp_p1;
unsigned char sy_lfr_n_cwf_long_f3;
flag = LFR_SUCCESSFUL;
//***************
// get parameters
msb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_L ];
lsb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_L+1 ];
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 sy_lfr_n_swf_l = (msb * CONST_256) + lsb;
paul
Bug #167...
 r152
msb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_P ];
lsb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_P+1 ];
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 sy_lfr_n_swf_p = (msb * CONST_256) + lsb;
paul
Bug #167...
 r152
msb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_ASM_P ];
lsb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_ASM_P+1 ];
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 sy_lfr_n_asm_p = (msb * CONST_256) + lsb;
paul
Bug #167...
 r152
sy_lfr_n_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_BP_P0 ];
sy_lfr_n_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_BP_P1 ];
sy_lfr_n_cwf_long_f3 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_CWF_LONG_F3 ];
//******************
// check consistency
// sy_lfr_n_swf_l
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 if (sy_lfr_n_swf_l != DFLT_SY_LFR_N_SWF_L)
paul
Bug #167...
 r152 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_SWF_L + DATAFIELD_OFFSET, sy_lfr_n_swf_l );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
// sy_lfr_n_swf_p
if (flag == LFR_SUCCESSFUL)
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 if ( sy_lfr_n_swf_p < MIN_SY_LFR_N_SWF_P )
paul
Bug #167...
 r152 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_SWF_P + DATAFIELD_OFFSET, sy_lfr_n_swf_p );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
// sy_lfr_n_bp_p0
if (flag == LFR_SUCCESSFUL)
{
paul
Many corrections done after Logiscope analysis
 r166 if (sy_lfr_n_bp_p0 < DFLT_SY_LFR_N_BP_P0)
paul
Bug #167...
 r152 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_BP_P0 + DATAFIELD_OFFSET, sy_lfr_n_bp_p0 );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
// sy_lfr_n_asm_p
if (flag == LFR_SUCCESSFUL)
{
if (sy_lfr_n_asm_p == 0)
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_ASM_P + DATAFIELD_OFFSET, sy_lfr_n_asm_p );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
// sy_lfr_n_asm_p shall be a whole multiple of sy_lfr_n_bp_p0
if (flag == LFR_SUCCESSFUL)
{
aux = ( (float ) sy_lfr_n_asm_p / sy_lfr_n_bp_p0 ) - floor(sy_lfr_n_asm_p / sy_lfr_n_bp_p0);
paul
Many corrections done after Logiscope analysis
 r166 if (aux > FLOAT_EQUAL_ZERO)
paul
Bug #167...
 r152 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_ASM_P + DATAFIELD_OFFSET, sy_lfr_n_asm_p );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
// sy_lfr_n_bp_p1
if (flag == LFR_SUCCESSFUL)
{
paul
Many corrections done after Logiscope analysis
 r166 if (sy_lfr_n_bp_p1 < DFLT_SY_LFR_N_BP_P1)
paul
Bug #167...
 r152 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_BP_P1 + DATAFIELD_OFFSET, sy_lfr_n_bp_p1 );
paul
Bug #167...
 r152 flag = WRONG_APP_DATA;
}
}
// sy_lfr_n_bp_p1 shall be a whole multiple of sy_lfr_n_bp_p0
if (flag == LFR_SUCCESSFUL)
{
aux = ( (float ) sy_lfr_n_bp_p1 / sy_lfr_n_bp_p0 ) - floor(sy_lfr_n_bp_p1 / sy_lfr_n_bp_p0);
paul
Many corrections done after Logiscope analysis
 r166 if (aux > FLOAT_EQUAL_ZERO)
paul
Bug #167...
 r152 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_BP_P1 + DATAFIELD_OFFSET, sy_lfr_n_bp_p1 );
paul
Bug #167...
 r152 flag = LFR_DEFAULT;
}
}
// sy_lfr_n_cwf_long_f3
return flag;
}
int set_sy_lfr_n_swf_l( ccsdsTelecommandPacket_t *TC )
paul
Header files inclusion reworked...
 r40 {
/** This function sets the number of points of a snapshot (sy_lfr_n_swf_l).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int result;
paul
Bug #167...
 r152 result = LFR_SUCCESSFUL;
parameter_dump_packet.sy_lfr_n_swf_l[0] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_L ];
parameter_dump_packet.sy_lfr_n_swf_l[1] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_L+1 ];
paul
Header files inclusion reworked...
 r40
return result;
}
paul
Bug #167...
 r152 int set_sy_lfr_n_swf_p(ccsdsTelecommandPacket_t *TC )
paul
Header files inclusion reworked...
 r40 {
/** This function sets the time between two snapshots, in s (sy_lfr_n_swf_p).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int result;
paul
Bug #167...
 r152 result = LFR_SUCCESSFUL;
parameter_dump_packet.sy_lfr_n_swf_p[0] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_P ];
parameter_dump_packet.sy_lfr_n_swf_p[1] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_P+1 ];
paul
Header files inclusion reworked...
 r40
return result;
}
paul
Bug #167...
 r152 int set_sy_lfr_n_asm_p( ccsdsTelecommandPacket_t *TC )
paul
Header files inclusion reworked...
 r40 {
paul
Ignore doc files...
 r46 /** This function sets the time between two full spectral matrices transmission, in s (SY_LFR_N_ASM_P).
paul
Header files inclusion reworked...
 r40 *
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int result;
paul
Bug #167...
 r152
result = LFR_SUCCESSFUL;
paul
Header files inclusion reworked...
 r40
paul
Bug #167...
 r152 parameter_dump_packet.sy_lfr_n_asm_p[0] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_ASM_P ];
parameter_dump_packet.sy_lfr_n_asm_p[1] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_ASM_P+1 ];
paul
Header files inclusion reworked...
 r40
return result;
}
paul
Bug #167...
 r152 int set_sy_lfr_n_bp_p0( ccsdsTelecommandPacket_t *TC )
paul
Header files inclusion reworked...
 r40 {
paul
Many corrections done after Logiscope analysis
 r166 /** This function sets the time between two basic parameter sets, in s (DFLT_SY_LFR_N_BP_P0).
paul
Header files inclusion reworked...
 r40 *
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
paul
Bug #167...
 r152 parameter_dump_packet.sy_lfr_n_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_BP_P0 ];
paul
Header files inclusion reworked...
 r40
return status;
}
paul
Bug #167...
 r152 int set_sy_lfr_n_bp_p1(ccsdsTelecommandPacket_t *TC )
paul
Header files inclusion reworked...
 r40 {
/** This function sets the time between two basic parameter sets (autocorrelation + crosscorrelation), in s (sy_lfr_n_bp_p1).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
paul
Bug #167...
 r152 parameter_dump_packet.sy_lfr_n_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_BP_P1 ];
paul
Header files inclusion reworked...
 r40
return status;
}
paul
Bug #167...
 r152 int set_sy_lfr_n_cwf_long_f3(ccsdsTelecommandPacket_t *TC )
paul
ICD 2.0...
 r92 {
/** This function allows to switch from CWF_F3 packets to CWF_LONG_F3 packets.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
paul
sync
 r113 parameter_dump_packet.sy_lfr_n_cwf_long_f3 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_CWF_LONG_F3 ];
paul
ICD 2.0...
 r92
return status;
}
paul
Header files inclusion reworked...
 r40 //**********************
// BURST MODE PARAMETERS
paul
AVGV modified...
 r352
paul
Bug #167...
 r152 int set_sy_lfr_b_bp_p0(ccsdsTelecommandPacket_t *TC)
paul
Sync...
 r117 {
/** This function sets the time between two basic parameter sets, in s (SY_LFR_B_BP_P0).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
paul
Bug #167...
 r152 parameter_dump_packet.sy_lfr_b_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P0 ];
paul
Sync...
 r117
return status;
}
paul
Bug #167...
 r152 int set_sy_lfr_b_bp_p1( ccsdsTelecommandPacket_t *TC )
paul
Sync...
 r117 {
/** This function sets the time between two basic parameter sets, in s (SY_LFR_B_BP_P1).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
paul
Bug #167...
 r152 parameter_dump_packet.sy_lfr_b_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P1 ];
paul
Sync...
 r117
return status;
}
paul
Header files inclusion reworked...
 r40
//*********************
// SBM1 MODE PARAMETERS
paul
AVGV modified...
 r352
paul
Bug #167...
 r152 int set_sy_lfr_s1_bp_p0( ccsdsTelecommandPacket_t *TC )
paul
Sync...
 r117 {
/** This function sets the time between two basic parameter sets, in s (SY_LFR_S1_BP_P0).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
paul
Bug #167...
 r152 parameter_dump_packet.sy_lfr_s1_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S1_BP_P0 ];
paul
Sync...
 r117
return status;
}
paul
Bug #167...
 r152 int set_sy_lfr_s1_bp_p1( ccsdsTelecommandPacket_t *TC )
paul
Sync...
 r117 {
/** This function sets the time between two basic parameter sets, in s (SY_LFR_S1_BP_P1).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
paul
Bug #167...
 r152 parameter_dump_packet.sy_lfr_s1_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S1_BP_P1 ];
paul
Sync...
 r117
return status;
}
paul
Header files inclusion reworked...
 r40
//*********************
// SBM2 MODE PARAMETERS
paul
AVGV modified...
 r352
paul
ICD 4.1 taken into account
 r283 int set_sy_lfr_s2_bp_p0( ccsdsTelecommandPacket_t *TC )
paul
Sync...
 r117 {
/** This function sets the time between two basic parameter sets, in s (SY_LFR_S2_BP_P0).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
paul
Bug #167...
 r152 parameter_dump_packet.sy_lfr_s2_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P0 ];
paul
Sync...
 r117
return status;
}
paul
Bug #167...
 r152 int set_sy_lfr_s2_bp_p1( ccsdsTelecommandPacket_t *TC )
paul
Sync...
 r117 {
/** This function sets the time between two basic parameter sets, in s (SY_LFR_S2_BP_P1).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
paul
Bug #167...
 r152 parameter_dump_packet.sy_lfr_s2_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P1 ];
paul
Sync...
 r117
return status;
}
paul
rev 1.0.0.2...
 r104 //*******************
// TC_LFR_UPDATE_INFO
paul
AVGV modified...
 r352
paul
rev 1.0.0.2...
 r104 unsigned int check_update_info_hk_lfr_mode( unsigned char mode )
{
unsigned int status;
paul
Bug #801 Don_Initialisation_P2
 r320 status = LFR_DEFAULT;
paul
rev 1.0.0.2...
 r104 if ( (mode == LFR_MODE_STANDBY) || (mode == LFR_MODE_NORMAL)
paul
Corrections:...
 r107 || (mode == LFR_MODE_BURST)
paul
rev 1.0.0.2...
 r104 || (mode == LFR_MODE_SBM1) || (mode == LFR_MODE_SBM2))
{
status = LFR_SUCCESSFUL;
}
else
{
status = LFR_DEFAULT;
}
return status;
}
unsigned int check_update_info_hk_tds_mode( unsigned char mode )
{
unsigned int status;
paul
Bug #801 Don_Initialisation_P2
 r320 status = LFR_DEFAULT;
paul
rev 1.0.0.2...
 r104 if ( (mode == TDS_MODE_STANDBY) || (mode == TDS_MODE_NORMAL)
paul
Corrections:...
 r107 || (mode == TDS_MODE_BURST)
paul
rev 1.0.0.2...
 r104 || (mode == TDS_MODE_SBM1) || (mode == TDS_MODE_SBM2)
|| (mode == TDS_MODE_LFM))
{
status = LFR_SUCCESSFUL;
}
else
{
status = LFR_DEFAULT;
}
return status;
}
unsigned int check_update_info_hk_thr_mode( unsigned char mode )
{
unsigned int status;
paul
Bug #801 Don_Initialisation_P2
 r320 status = LFR_DEFAULT;
paul
rev 1.0.0.2...
 r104 if ( (mode == THR_MODE_STANDBY) || (mode == THR_MODE_NORMAL)
paul
Corrections:...
 r107 || (mode == THR_MODE_BURST))
paul
rev 1.0.0.2...
 r104 {
status = LFR_SUCCESSFUL;
}
else
{
status = LFR_DEFAULT;
}
return status;
}
paul
compliance with ICD 4.3...
 r328 void set_hk_lfr_sc_rw_f_flag( unsigned char wheel, unsigned char freq, float value )
{
unsigned char flag;
unsigned char flagPosInByte;
unsigned char newFlag;
unsigned char flagMask;
// if the frequency value is not a number, the flag is set to 0 and the frequency RWx_Fy is not filtered
if (isnan(value))
{
flag = FLAG_NAN;
}
else
{
flag = FLAG_IAN;
}
switch(wheel)
{
case WHEEL_1:
flagPosInByte = FLAG_OFFSET_WHEELS_1_3 - freq;
flagMask = ~(1 << flagPosInByte);
newFlag = flag << flagPosInByte;
housekeeping_packet.hk_lfr_sc_rw1_rw2_f_flags = (housekeeping_packet.hk_lfr_sc_rw1_rw2_f_flags & flagMask) | newFlag;
break;
case WHEEL_2:
flagPosInByte = FLAG_OFFSET_WHEELS_2_4 - freq;
flagMask = ~(1 << flagPosInByte);
newFlag = flag << flagPosInByte;
housekeeping_packet.hk_lfr_sc_rw1_rw2_f_flags = (housekeeping_packet.hk_lfr_sc_rw1_rw2_f_flags & flagMask) | newFlag;
break;
case WHEEL_3:
flagPosInByte = FLAG_OFFSET_WHEELS_1_3 - freq;
flagMask = ~(1 << flagPosInByte);
newFlag = flag << flagPosInByte;
housekeeping_packet.hk_lfr_sc_rw3_rw4_f_flags = (housekeeping_packet.hk_lfr_sc_rw3_rw4_f_flags & flagMask) | newFlag;
break;
case WHEEL_4:
flagPosInByte = FLAG_OFFSET_WHEELS_2_4 - freq;
flagMask = ~(1 << flagPosInByte);
newFlag = flag << flagPosInByte;
housekeeping_packet.hk_lfr_sc_rw3_rw4_f_flags = (housekeeping_packet.hk_lfr_sc_rw3_rw4_f_flags & flagMask) | newFlag;
break;
default:
break;
}
}
void set_hk_lfr_sc_rw_f_flags( void )
{
// RW1
set_hk_lfr_sc_rw_f_flag( WHEEL_1, FREQ_1, rw_f.cp_rpw_sc_rw1_f1 );
set_hk_lfr_sc_rw_f_flag( WHEEL_1, FREQ_2, rw_f.cp_rpw_sc_rw1_f2 );
set_hk_lfr_sc_rw_f_flag( WHEEL_1, FREQ_3, rw_f.cp_rpw_sc_rw1_f3 );
set_hk_lfr_sc_rw_f_flag( WHEEL_1, FREQ_4, rw_f.cp_rpw_sc_rw1_f4 );
// RW2
set_hk_lfr_sc_rw_f_flag( WHEEL_2, FREQ_1, rw_f.cp_rpw_sc_rw2_f1 );
set_hk_lfr_sc_rw_f_flag( WHEEL_2, FREQ_2, rw_f.cp_rpw_sc_rw2_f2 );
set_hk_lfr_sc_rw_f_flag( WHEEL_2, FREQ_3, rw_f.cp_rpw_sc_rw2_f3 );
set_hk_lfr_sc_rw_f_flag( WHEEL_2, FREQ_4, rw_f.cp_rpw_sc_rw2_f4 );
// RW3
set_hk_lfr_sc_rw_f_flag( WHEEL_3, FREQ_1, rw_f.cp_rpw_sc_rw3_f1 );
set_hk_lfr_sc_rw_f_flag( WHEEL_3, FREQ_2, rw_f.cp_rpw_sc_rw3_f2 );
set_hk_lfr_sc_rw_f_flag( WHEEL_3, FREQ_3, rw_f.cp_rpw_sc_rw3_f3 );
set_hk_lfr_sc_rw_f_flag( WHEEL_3, FREQ_4, rw_f.cp_rpw_sc_rw3_f4 );
// RW4
set_hk_lfr_sc_rw_f_flag( WHEEL_4, FREQ_1, rw_f.cp_rpw_sc_rw4_f1 );
set_hk_lfr_sc_rw_f_flag( WHEEL_4, FREQ_2, rw_f.cp_rpw_sc_rw4_f2 );
set_hk_lfr_sc_rw_f_flag( WHEEL_4, FREQ_3, rw_f.cp_rpw_sc_rw4_f3 );
set_hk_lfr_sc_rw_f_flag( WHEEL_4, FREQ_4, rw_f.cp_rpw_sc_rw4_f4 );
}
paul
AVGV modified...
 r352 int check_sy_lfr_rw_f( ccsdsTelecommandPacket_t *TC, int offset, int* pos, float* value )
{
float rw_k;
int ret;
ret = LFR_SUCCESSFUL;
rw_k = INIT_FLOAT;
copyFloatByChar( (unsigned char*) &rw_k, (unsigned char*) &TC->packetID[ offset ] );
*pos = offset;
*value = rw_k;
if (rw_k < MIN_SY_LFR_RW_F)
{
ret = WRONG_APP_DATA;
}
return ret;
}
int check_all_sy_lfr_rw_f( ccsdsTelecommandPacket_t *TC, int *pos, float*value )
{
int ret;
ret = LFR_SUCCESSFUL;
//****
//****
// RW1
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F1, pos, value ); // F1
if (ret == LFR_SUCCESSFUL) // F2
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F2, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F3
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F3, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F4
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F4, pos, value );
}
//****
//****
// RW2
if (ret == LFR_SUCCESSFUL) // F1
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F1, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F2
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F2, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F3
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F3, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F4
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F4, pos, value );
}
//****
//****
// RW3
if (ret == LFR_SUCCESSFUL) // F1
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F1, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F2
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F2, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F3
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F3, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F4
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F4, pos, value );
}
//****
//****
// RW4
if (ret == LFR_SUCCESSFUL) // F1
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F1, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F2
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F2, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F3
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F3, pos, value );
}
if (ret == LFR_SUCCESSFUL) // F4
{
ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F4, pos, value );
}
return ret;
}
paul
ICD 4.1 taken into account
 r283 void getReactionWheelsFrequencies( ccsdsTelecommandPacket_t *TC )
{
/** This function get the reaction wheels frequencies in the incoming TC_LFR_UPDATE_INFO and copy the values locally.
*
* @param TC points to the TeleCommand packet that is being processed
*
*/
unsigned char * bytePosPtr; // pointer to the beginning of the incoming TC packet
bytePosPtr = (unsigned char *) &TC->packetID;
paul
compliance with ICD 4.3...
 r328 // rw1_f
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw1_f1, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F1 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw1_f2, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F2 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw1_f3, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F3 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw1_f4, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F4 ] );
paul
minor updates
 r285
paul
compliance with ICD 4.3...
 r328 // rw2_f
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw2_f1, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F1 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw2_f2, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F2 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw2_f3, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F3 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw2_f4, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F4 ] );
paul
minor updates
 r285
paul
compliance with ICD 4.3...
 r328 // rw3_f
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw3_f1, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F1 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw3_f2, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F2 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw3_f3, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F3 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw3_f4, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F4 ] );
paul
minor updates
 r285
paul
compliance with ICD 4.3...
 r328 // rw4_f
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw4_f1, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F1 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw4_f2, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F2 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw4_f3, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F3 ] );
copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw4_f4, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F4 ] );
paul
minor updates
 r285
paul
compliance with ICD 4.3...
 r328 // test each reaction wheel frequency value. NaN means that the frequency is not filtered
paul
ICD 4.1 taken into account
 r283 }
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 void setFBinMask( unsigned char *fbins_mask, float rw_f, unsigned char deltaFreq, float sy_lfr_rw_k )
paul
ICD 4.1 taken into account
 r283 {
paul
minor updates
 r285 /** This function executes specific actions when a TC_LFR_UPDATE_INFO TeleCommand has been received.
*
* @param fbins_mask
paul
reaction wheels filtering implemented
 r286 * @param rw_f is the reaction wheel frequency to filter
* @param delta_f is the frequency step between the frequency bins, it depends on the frequency channel
paul
minor updates
 r285 * @param flag [true] filtering enabled [false] filtering disabled
*
* @return void
*
*/
paul
3.1.0.3...
 r296 float f_RW_min;
float f_RW_MAX;
float fi_min;
float fi_MAX;
float fi;
float deltaBelow;
float deltaAbove;
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 float freqToFilterOut;
paul
reaction wheels filtering implemented
 r286 int binBelow;
int binAbove;
paul
3.1.0.3...
 r296 int closestBin;
paul
reaction wheels filtering implemented
 r286 unsigned int whichByte;
paul
3.1.0.3...
 r296 int selectedByte;
paul
reaction wheels filtering implemented
 r286 int bin;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 int binToRemove[NB_BINS_TO_REMOVE];
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 int k;
bool filteringSet;
paul
ICD 4.1 taken into account
 r283
paul
Bug #801 Don_Initialisation_P2
 r320 closestBin = 0;
paul
reaction wheels filtering implemented
 r286 whichByte = 0;
bin = 0;
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 filteringSet = false;
paul
reaction wheels filtering implemented
 r286
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 for (k = 0; k < NB_BINS_TO_REMOVE; k++)
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 {
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 binToRemove[k] = -1;
paul
3.1.0.3...
 r296 }
paul
partial recoding of reaction wheel filtering
 r329 if (!isnan(rw_f))
paul
ICD 4.1 taken into account
 r283 {
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 // compute the frequency range to filter [ rw_f - delta_f; rw_f + delta_f ]
f_RW_min = rw_f - ((filterPar.sy_lfr_sc_rw_delta_f) * sy_lfr_rw_k);
f_RW_MAX = rw_f + ((filterPar.sy_lfr_sc_rw_delta_f) * sy_lfr_rw_k);
paul
partial recoding of reaction wheel filtering
 r329
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 freqToFilterOut = f_RW_min;
while ( filteringSet == false )
{
// compute the index of the frequency bin immediately below rw_f
binBelow = (int) ( floor( ((double) freqToFilterOut) / ((double) deltaFreq)) );
deltaBelow = freqToFilterOut - binBelow * deltaFreq;
paul
partial recoding of reaction wheel filtering
 r329
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 // compute the index of the frequency bin immediately above rw_f
binAbove = (int) ( ceil( ((double) freqToFilterOut) / ((double) deltaFreq)) );
deltaAbove = binAbove * deltaFreq - freqToFilterOut;
paul
partial recoding of reaction wheel filtering
 r329
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 // search the closest bin
if (deltaAbove > deltaBelow)
{
closestBin = binBelow;
}
else
{
closestBin = binAbove;
}
paul
partial recoding of reaction wheel filtering
 r329
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 // compute the fi interval [fi - deltaFreq * 0.285, fi + deltaFreq * 0.285]
fi = closestBin * deltaFreq;
fi_min = fi - (deltaFreq * FI_INTERVAL_COEFF);
fi_MAX = fi + (deltaFreq * FI_INTERVAL_COEFF);
//**************************************************************************************
// be careful here, one shall take into account that the bin 0 IS DROPPED in the spectra
// thus, the index 0 in a mask corresponds to the bin 1 of the spectrum
//**************************************************************************************
paul
3.1.0.3...
 r296
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 // 1. IF freqToFilterOut is included in [ fi_min; fi_MAX ]
// => remove f_(i), f_(i-1) and f_(i+1)
if ( ( freqToFilterOut > fi_min ) && ( freqToFilterOut < fi_MAX ) )
{
binToRemove[0] = (closestBin - 1) - 1;
binToRemove[1] = (closestBin) - 1;
binToRemove[2] = (closestBin + 1) - 1;
}
// 2. ELSE
// => remove the two f_(i) which are around f_RW
else
{
binToRemove[0] = (binBelow) - 1;
binToRemove[1] = (binAbove) - 1;
binToRemove[2] = (-1);
}
paul
partial recoding of reaction wheel filtering
 r329
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 for (k = 0; k < NB_BINS_TO_REMOVE; k++)
{
bin = binToRemove[k];
if ( (bin >= BIN_MIN) && (bin <= BIN_MAX) )
{
whichByte = (bin >> SHIFT_3_BITS); // division by 8
selectedByte = ( 1 << (bin - (whichByte * BITS_PER_BYTE)) );
fbins_mask[BYTES_PER_MASK - 1 - whichByte] =
fbins_mask[BYTES_PER_MASK - 1 - whichByte] & ((unsigned char) (~selectedByte)); // bytes are ordered MSB first in the packets
}
}
paul
partial recoding of reaction wheel filtering
 r329
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 // update freqToFilterOut
if ( freqToFilterOut == f_RW_MAX )
{
filteringSet = true; // end of the loop
}
else
paul
reaction wheels filtering implemented
 r286 {
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 freqToFilterOut = freqToFilterOut + deltaFreq;
}
paul
partial recoding of reaction wheel filtering
 r329
paul
Bug #914 Masque erroné en cas de bande polluée partiellement ......
 r344 if ( freqToFilterOut > f_RW_MAX)
{
freqToFilterOut = f_RW_MAX;
paul
reaction wheels filtering implemented
 r286 }
paul
ICD 4.1 taken into account
 r283 }
}
}
paul
reaction wheels filtering implemented
 r286 void build_sy_lfr_rw_mask( unsigned int channel )
paul
ICD 4.1 taken into account
 r283 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 unsigned char local_rw_fbins_mask[BYTES_PER_MASK];
paul
ICD 4.1 taken into account
 r283 unsigned char *maskPtr;
double deltaF;
unsigned k;
paul
reaction wheels filtering implemented
 r286 maskPtr = NULL;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 deltaF = DELTAF_F2;
paul
reaction wheels filtering implemented
 r286
paul
ICD 4.1 taken into account
 r283 switch (channel)
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 case CHANNELF0:
paul
union usage removed from the sources (#897 Don_ArtVariables)...
 r324 maskPtr = parameter_dump_packet.sy_lfr_rw_mask_f0_word1;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 deltaF = DELTAF_F0;
paul
ICD 4.1 taken into account
 r283 break;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 case CHANNELF1:
paul
union usage removed from the sources (#897 Don_ArtVariables)...
 r324 maskPtr = parameter_dump_packet.sy_lfr_rw_mask_f1_word1;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 deltaF = DELTAF_F1;
paul
ICD 4.1 taken into account
 r283 break;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 case CHANNELF2:
paul
union usage removed from the sources (#897 Don_ArtVariables)...
 r324 maskPtr = parameter_dump_packet.sy_lfr_rw_mask_f2_word1;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 deltaF = DELTAF_F2;
paul
ICD 4.1 taken into account
 r283 break;
default:
break;
}
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for (k = 0; k < BYTES_PER_MASK; k++)
paul
ICD 4.1 taken into account
 r283 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 local_rw_fbins_mask[k] = INT8_ALL_F;
paul
ICD 4.1 taken into account
 r283 }
paul
compliance with ICD 4.3...
 r328 // RW1
paul
partial recoding of reaction wheel filtering
 r329 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw1_f1, deltaF, filterPar.sy_lfr_rw1_k1 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw1_f2, deltaF, filterPar.sy_lfr_rw1_k2 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw1_f3, deltaF, filterPar.sy_lfr_rw1_k3 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw1_f4, deltaF, filterPar.sy_lfr_rw1_k4 );
paul
ICD 4.1 taken into account
 r283
paul
partial recoding of reaction wheel filtering
 r329 // RW2
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw2_f1, deltaF, filterPar.sy_lfr_rw2_k1 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw2_f2, deltaF, filterPar.sy_lfr_rw2_k2 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw2_f3, deltaF, filterPar.sy_lfr_rw2_k3 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw2_f4, deltaF, filterPar.sy_lfr_rw2_k4 );
paul
ICD 4.1 taken into account
 r283
paul
partial recoding of reaction wheel filtering
 r329 // RW3
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw3_f1, deltaF, filterPar.sy_lfr_rw3_k1 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw3_f2, deltaF, filterPar.sy_lfr_rw3_k2 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw3_f3, deltaF, filterPar.sy_lfr_rw3_k3 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw3_f4, deltaF, filterPar.sy_lfr_rw3_k4 );
paul
ICD 4.1 taken into account
 r283
paul
partial recoding of reaction wheel filtering
 r329 // RW4
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw4_f1, deltaF, filterPar.sy_lfr_rw4_k1 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw4_f2, deltaF, filterPar.sy_lfr_rw4_k2 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw4_f3, deltaF, filterPar.sy_lfr_rw4_k3 );
setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw4_f4, deltaF, filterPar.sy_lfr_rw4_k4 );
paul
ICD 4.1 taken into account
 r283
// update the value of the fbins related to reaction wheels frequency filtering
paul
reaction wheels filtering implemented
 r286 if (maskPtr != NULL)
paul
ICD 4.1 taken into account
 r283 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for (k = 0; k < BYTES_PER_MASK; k++)
paul
reaction wheels filtering implemented
 r286 {
maskPtr[k] = local_rw_fbins_mask[k];
}
paul
ICD 4.1 taken into account
 r283 }
}
paul
reaction wheels filtering implemented
 r286 void build_sy_lfr_rw_masks( void )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 build_sy_lfr_rw_mask( CHANNELF0 );
build_sy_lfr_rw_mask( CHANNELF1 );
build_sy_lfr_rw_mask( CHANNELF2 );
paul
reaction wheels filtering implemented
 r286 }
void merge_fbins_masks( void )
paul
ICD 4.1 taken into account
 r283 {
paul
reaction wheels filtering implemented
 r286 unsigned char k;
unsigned char *fbins_f0;
unsigned char *fbins_f1;
unsigned char *fbins_f2;
unsigned char *rw_mask_f0;
unsigned char *rw_mask_f1;
unsigned char *rw_mask_f2;
paul
union usage removed from the sources (#897 Don_ArtVariables)...
 r324 fbins_f0 = parameter_dump_packet.sy_lfr_fbins_f0_word1;
fbins_f1 = parameter_dump_packet.sy_lfr_fbins_f1_word1;
fbins_f2 = parameter_dump_packet.sy_lfr_fbins_f2_word1;
rw_mask_f0 = parameter_dump_packet.sy_lfr_rw_mask_f0_word1;
rw_mask_f1 = parameter_dump_packet.sy_lfr_rw_mask_f1_word1;
rw_mask_f2 = parameter_dump_packet.sy_lfr_rw_mask_f2_word1;
paul
reaction wheels filtering implemented
 r286
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for( k=0; k < BYTES_PER_MASK; k++ )
paul
reaction wheels filtering implemented
 r286 {
fbins_masks.merged_fbins_mask_f0[k] = fbins_f0[k] & rw_mask_f0[k];
fbins_masks.merged_fbins_mask_f1[k] = fbins_f1[k] & rw_mask_f1[k];
fbins_masks.merged_fbins_mask_f2[k] = fbins_f2[k] & rw_mask_f2[k];
}
paul
ICD 4.1 taken into account
 r283 }
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 //***********
// FBINS MASK
int set_sy_lfr_fbins( ccsdsTelecommandPacket_t *TC )
{
int status;
unsigned int k;
unsigned char *fbins_mask_dump;
unsigned char *fbins_mask_TC;
status = LFR_SUCCESSFUL;
paul
union usage removed from the sources (#897 Don_ArtVariables)...
 r324 fbins_mask_dump = parameter_dump_packet.sy_lfr_fbins_f0_word1;
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 fbins_mask_TC = TC->dataAndCRC;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for (k=0; k < BYTES_PER_MASKS_SET; k++)
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 {
fbins_mask_dump[k] = fbins_mask_TC[k];
}
return status;
}
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 //***************************
// TC_LFR_LOAD_PAS_FILTER_PAR
paul
3.2.0.3...
 r351 int check_sy_lfr_rw_k( ccsdsTelecommandPacket_t *TC, int offset, int* pos, float* value )
{
float rw_k;
int ret;
ret = LFR_SUCCESSFUL;
rw_k = INIT_FLOAT;
copyFloatByChar( (unsigned char*) &rw_k, (unsigned char*) &TC->dataAndCRC[ offset ] );
*pos = offset;
*value = rw_k;
paul
AVGV modified...
 r352 if (rw_k < MIN_SY_LFR_RW_F)
paul
3.2.0.3...
 r351 {
ret = WRONG_APP_DATA;
}
return ret;
}
paul
AVGV modified...
 r352 int check_all_sy_lfr_rw_k( ccsdsTelecommandPacket_t *TC, int *pos, float *value )
paul
3.2.0.3...
 r351 {
int ret;
ret = LFR_SUCCESSFUL;
//****
//****
// RW1
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW1_K1, pos, value ); // K1
if (ret == LFR_SUCCESSFUL) // K2
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW1_K2, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K3
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW1_K3, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K4
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW1_K4, pos, value );
}
//****
//****
// RW2
if (ret == LFR_SUCCESSFUL) // K1
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW2_K1, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K2
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW2_K2, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K3
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW2_K3, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K4
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW2_K4, pos, value );
}
//****
//****
// RW3
if (ret == LFR_SUCCESSFUL) // K1
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW3_K1, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K2
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW3_K2, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K3
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW3_K3, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K4
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW3_K4, pos, value );
}
//****
//****
// RW4
if (ret == LFR_SUCCESSFUL) // K1
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW4_K1, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K2
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW4_K2, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K3
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW4_K3, pos, value );
}
if (ret == LFR_SUCCESSFUL) // K4
{
ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW4_K4, pos, value );
}
return ret;
}
paul
minor updates
 r285 int check_sy_lfr_filter_parameters( ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 {
int flag;
rtems_status_code status;
unsigned char sy_lfr_pas_filter_enabled;
unsigned char sy_lfr_pas_filter_modulus;
paul
ICD 4.1 taken into account
 r283 float sy_lfr_pas_filter_tbad;
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 unsigned char sy_lfr_pas_filter_offset;
paul
minor updates
 r285 float sy_lfr_pas_filter_shift;
paul
ICD 4.1 taken into account
 r283 float sy_lfr_sc_rw_delta_f;
paul
minor updates
 r285 char *parPtr;
paul
AVGV modified...
 r352 int datafield_pos;
float rw_k;
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282
flag = LFR_SUCCESSFUL;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 sy_lfr_pas_filter_tbad = INIT_FLOAT;
sy_lfr_pas_filter_shift = INIT_FLOAT;
sy_lfr_sc_rw_delta_f = INIT_FLOAT;
paul
minor updates
 r285 parPtr = NULL;
paul
AVGV modified...
 r352 datafield_pos = INIT_INT;
rw_k = INIT_FLOAT;
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282
//***************
// get parameters
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 sy_lfr_pas_filter_enabled = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_ENABLED ] & BIT_PAS_FILTER_ENABLED; // [0000 0001]
paul
minor updates
 r285 sy_lfr_pas_filter_modulus = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS ];
copyFloatByChar(
paul
reaction wheels filtering implemented
 r286 (unsigned char*) &sy_lfr_pas_filter_tbad,
(unsigned char*) &TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD ]
paul
minor updates
 r285 );
sy_lfr_pas_filter_offset = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET ];
copyFloatByChar(
paul
reaction wheels filtering implemented
 r286 (unsigned char*) &sy_lfr_pas_filter_shift,
(unsigned char*) &TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT ]
paul
minor updates
 r285 );
copyFloatByChar(
paul
reaction wheels filtering implemented
 r286 (unsigned char*) &sy_lfr_sc_rw_delta_f,
(unsigned char*) &TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F ]
paul
minor updates
 r285 );
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282
//******************
paul
minor updates
 r285 // CHECK CONSISTENCY
//**************************
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 // sy_lfr_pas_filter_enabled
paul
minor updates
 r285 // nothing to check, value is 0 or 1
//**************************
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 // sy_lfr_pas_filter_modulus
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 if ( (sy_lfr_pas_filter_modulus < MIN_PAS_FILTER_MODULUS) || (sy_lfr_pas_filter_modulus > MAX_PAS_FILTER_MODULUS) )
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS + DATAFIELD_OFFSET, sy_lfr_pas_filter_modulus );
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 flag = WRONG_APP_DATA;
}
paul
minor updates
 r285
//***********************
paul
ICD 4.1 taken into account
 r283 // sy_lfr_pas_filter_tbad
paul
AVGV modified...
 r352 if (flag == LFR_SUCCESSFUL)
paul
minor updates
 r285 {
paul
AVGV modified...
 r352 if ( (sy_lfr_pas_filter_tbad < MIN_PAS_FILTER_TBAD) || (sy_lfr_pas_filter_tbad > MAX_PAS_FILTER_TBAD) )
{
parPtr = (char*) &sy_lfr_pas_filter_tbad;
status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
flag = WRONG_APP_DATA;
}
paul
minor updates
 r285 }
//*************************
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 // sy_lfr_pas_filter_offset
if (flag == LFR_SUCCESSFUL)
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 if ( (sy_lfr_pas_filter_offset < MIN_PAS_FILTER_OFFSET) || (sy_lfr_pas_filter_offset > MAX_PAS_FILTER_OFFSET) )
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET + DATAFIELD_OFFSET, sy_lfr_pas_filter_offset );
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 flag = WRONG_APP_DATA;
}
}
paul
minor updates
 r285
//************************
// sy_lfr_pas_filter_shift
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 if (flag == LFR_SUCCESSFUL)
paul
minor updates
 r285 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 if ( (sy_lfr_pas_filter_shift < MIN_PAS_FILTER_SHIFT) || (sy_lfr_pas_filter_shift > MAX_PAS_FILTER_SHIFT) )
{
parPtr = (char*) &sy_lfr_pas_filter_shift;
status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
flag = WRONG_APP_DATA;
}
}
//*************************************
// check global coherency of the values
if (flag == LFR_SUCCESSFUL)
{
if ( (sy_lfr_pas_filter_tbad + sy_lfr_pas_filter_offset + sy_lfr_pas_filter_shift) > sy_lfr_pas_filter_modulus )
{
status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS + DATAFIELD_OFFSET, sy_lfr_pas_filter_modulus );
flag = WRONG_APP_DATA;
}
paul
minor updates
 r285 }
//*********************
paul
ICD 4.1 taken into account
 r283 // sy_lfr_sc_rw_delta_f
paul
3.2.0.3...
 r351 if (flag == LFR_SUCCESSFUL)
{
if ( sy_lfr_sc_rw_delta_f < MIN_SY_LFR_SC_RW_DELTA_F )
{
paul
AVGV modified...
 r352 parPtr = (char*) &sy_lfr_pas_filter_shift;
paul
3.2.0.3...
 r351 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + DATAFIELD_OFFSET, sy_lfr_sc_rw_delta_f );
flag = WRONG_APP_DATA;
}
}
//************
// sy_lfr_rw_k
if (flag == LFR_SUCCESSFUL)
{
paul
AVGV modified...
 r352 flag = check_all_sy_lfr_rw_k( TC, &datafield_pos, &rw_k );
paul
3.2.0.3...
 r351 if (flag != LFR_SUCCESSFUL)
{
paul
AVGV modified...
 r352 parPtr = (char*) &sy_lfr_pas_filter_shift;
status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, datafield_pos + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
paul
3.2.0.3...
 r351 }
}
paul
TC_LFR_LOAD_PAS_FILTER_PAR added to the authorized telecommands...
 r282 return flag;
}
paul
sync
 r193 //**************
// KCOEFFICIENTS
paul
#426 corrected, sy_lfr_kcoeff_frequency >= 36 triggers the transmission of...
 r211 int set_sy_lfr_kcoeff( ccsdsTelecommandPacket_t *TC,rtems_id queue_id )
paul
sync
 r193 {
paul
rev 3.0.0.6...
 r214 unsigned int kcoeff;
paul
sync
 r193 unsigned short sy_lfr_kcoeff_frequency;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 unsigned short bin;
float *kcoeffPtr_norm;
float *kcoeffPtr_sbm;
paul
sync
 r193 int status;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 unsigned char *kcoeffLoadPtr;
unsigned char *kcoeffNormPtr;
paul
Major bug corrected on the handling of TC_LFR_LOAD_COMMON_PAR
 r199 unsigned char *kcoeffSbmPtr_a;
unsigned char *kcoeffSbmPtr_b;
paul
sync
 r193
paul
Correction of a bug in set_sy_lfr_kcoeff (misalignment)
 r340 sy_lfr_kcoeff_frequency = 0;
bin = 0;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kcoeffPtr_norm = NULL;
kcoeffPtr_sbm = NULL;
paul
Correction of a bug in set_sy_lfr_kcoeff (misalignment)
 r340 status = LFR_SUCCESSFUL;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194
paul
Correction of a bug in set_sy_lfr_kcoeff (misalignment)
 r340 // copy the value of the frequency byte by byte DO NOT USE A SHORT* POINTER
copyInt16ByChar( (unsigned char*) &sy_lfr_kcoeff_frequency, &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY] );
paul
sync
 r193
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 if ( sy_lfr_kcoeff_frequency >= NB_BINS_COMPRESSED_SM )
paul
sync
 r193 {
PRINTF1("ERR *** in set_sy_lfr_kcoeff_frequency *** sy_lfr_kcoeff_frequency = %d\n", sy_lfr_kcoeff_frequency)
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY + DATAFIELD_OFFSET + 1,
paul
bug #426 corrected
 r215 TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY + 1] ); // +1 to get the LSB instead of the MSB
paul
#426 corrected, sy_lfr_kcoeff_frequency >= 36 triggers the transmission of...
 r211 status = LFR_DEFAULT;
paul
sync
 r193 }
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 else
{
if ( ( sy_lfr_kcoeff_frequency >= 0 )
&& ( sy_lfr_kcoeff_frequency < NB_BINS_COMPRESSED_SM_F0 ) )
{
kcoeffPtr_norm = k_coeff_intercalib_f0_norm;
kcoeffPtr_sbm = k_coeff_intercalib_f0_sbm;
bin = sy_lfr_kcoeff_frequency;
}
else if ( ( sy_lfr_kcoeff_frequency >= NB_BINS_COMPRESSED_SM_F0 )
&& ( sy_lfr_kcoeff_frequency < (NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1) ) )
{
kcoeffPtr_norm = k_coeff_intercalib_f1_norm;
kcoeffPtr_sbm = k_coeff_intercalib_f1_sbm;
bin = sy_lfr_kcoeff_frequency - NB_BINS_COMPRESSED_SM_F0;
}
else if ( ( sy_lfr_kcoeff_frequency >= (NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1) )
&& ( sy_lfr_kcoeff_frequency < (NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1 + NB_BINS_COMPRESSED_SM_F2) ) )
{
kcoeffPtr_norm = k_coeff_intercalib_f2;
kcoeffPtr_sbm = NULL;
bin = sy_lfr_kcoeff_frequency - (NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1);
}
}
paul
bug corrected TC_LFR_LOAD_KCOEFFICIENTS with sy_lfr_kcoeff_frequency >= 24
 r207 if (kcoeffPtr_norm != NULL ) // update K coefficient for NORMAL data products
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 {
paul
rev 3.0.0.6...
 r214 for (kcoeff=0; kcoeff<NB_K_COEFF_PER_BIN; kcoeff++)
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 {
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 // destination
paul
rev 3.0.0.6...
 r214 kcoeffNormPtr = (unsigned char*) &kcoeffPtr_norm[ (bin * NB_K_COEFF_PER_BIN) + kcoeff ];
paul
bug corrected TC_LFR_LOAD_KCOEFFICIENTS with sy_lfr_kcoeff_frequency >= 24
 r207 // source
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoeffLoadPtr = (unsigned char*) &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_1 + (NB_BYTES_PER_FLOAT * kcoeff)];
paul
bug corrected TC_LFR_LOAD_KCOEFFICIENTS with sy_lfr_kcoeff_frequency >= 24
 r207 // copy source to destination
copyFloatByChar( kcoeffNormPtr, kcoeffLoadPtr );
}
}
if (kcoeffPtr_sbm != NULL ) // update K coefficient for SBM data products
{
paul
rev 3.0.0.6...
 r214 for (kcoeff=0; kcoeff<NB_K_COEFF_PER_BIN; kcoeff++)
paul
bug corrected TC_LFR_LOAD_KCOEFFICIENTS with sy_lfr_kcoeff_frequency >= 24
 r207 {
// destination
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoeffSbmPtr_a= (unsigned char*) &kcoeffPtr_sbm[ ( (bin * NB_K_COEFF_PER_BIN) + kcoeff) * SBM_COEFF_PER_NORM_COEFF ];
kcoeffSbmPtr_b= (unsigned char*) &kcoeffPtr_sbm[ (((bin * NB_K_COEFF_PER_BIN) + kcoeff) * SBM_KCOEFF_PER_NORM_KCOEFF) + 1 ];
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 // source
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoeffLoadPtr = (unsigned char*) &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_1 + (NB_BYTES_PER_FLOAT * kcoeff)];
paul
Major bug corrected on the handling of TC_LFR_LOAD_COMMON_PAR
 r199 // copy source to destination
copyFloatByChar( kcoeffSbmPtr_a, kcoeffLoadPtr );
copyFloatByChar( kcoeffSbmPtr_b, kcoeffLoadPtr );
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 }
}
paul
sync
 r193
paul
rev 3.0.0.6...
 r214 // print_k_coeff();
paul
sync
 r193 return status;
}
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 void copyFloatByChar( unsigned char *destination, unsigned char *source )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 destination[BYTE_0] = source[BYTE_0];
destination[BYTE_1] = source[BYTE_1];
destination[BYTE_2] = source[BYTE_2];
destination[BYTE_3] = source[BYTE_3];
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 }
paul
alignment added to variables initialized by memset...
 r338 void copyInt32ByChar( unsigned char *destination, unsigned char *source )
{
destination[BYTE_0] = source[BYTE_0];
destination[BYTE_1] = source[BYTE_1];
destination[BYTE_2] = source[BYTE_2];
destination[BYTE_3] = source[BYTE_3];
}
paul
Correction of a bug in set_sy_lfr_kcoeff (misalignment)
 r340 void copyInt16ByChar( unsigned char *destination, unsigned char *source )
{
destination[BYTE_0] = source[BYTE_0];
destination[BYTE_1] = source[BYTE_1];
}
paul
initialization of parameter_dump_packet updated with filtering elements
 r294 void floatToChar( float value, unsigned char* ptr)
{
unsigned char* valuePtr;
valuePtr = (unsigned char*) &value;
paul
test floatToChar function
 r341
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 ptr[BYTE_0] = valuePtr[BYTE_0];
ptr[BYTE_1] = valuePtr[BYTE_1];
ptr[BYTE_2] = valuePtr[BYTE_2];
ptr[BYTE_3] = valuePtr[BYTE_3];
paul
initialization of parameter_dump_packet updated with filtering elements
 r294 }
paul
Ignore doc files...
 r46 //**********
// init dump
void init_parameter_dump( void )
{
/** This function initialize the parameter_dump_packet global variable with default values.
*
*/
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 unsigned int k;
paul
Ignore doc files...
 r46 parameter_dump_packet.targetLogicalAddress = CCSDS_DESTINATION_ID;
parameter_dump_packet.protocolIdentifier = CCSDS_PROTOCOLE_ID;
parameter_dump_packet.reserved = CCSDS_RESERVED;
parameter_dump_packet.userApplication = CCSDS_USER_APP;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.packetID[0] = (unsigned char) (APID_TM_PARAMETER_DUMP >> SHIFT_1_BYTE);
paul
Sync...
 r116 parameter_dump_packet.packetID[1] = (unsigned char) APID_TM_PARAMETER_DUMP;
paul
Ignore doc files...
 r46 parameter_dump_packet.packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
parameter_dump_packet.packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.packetLength[0] = (unsigned char) (PACKET_LENGTH_PARAMETER_DUMP >> SHIFT_1_BYTE);
paul
Ignore doc files...
 r46 parameter_dump_packet.packetLength[1] = (unsigned char) PACKET_LENGTH_PARAMETER_DUMP;
// DATA FIELD HEADER
parameter_dump_packet.spare1_pusVersion_spare2 = SPARE1_PUSVERSION_SPARE2;
parameter_dump_packet.serviceType = TM_TYPE_PARAMETER_DUMP;
parameter_dump_packet.serviceSubType = TM_SUBTYPE_PARAMETER_DUMP;
parameter_dump_packet.destinationID = TM_DESTINATION_ID_GROUND;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.time[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
parameter_dump_packet.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
parameter_dump_packet.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
parameter_dump_packet.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
parameter_dump_packet.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
parameter_dump_packet.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
paul
Ignore doc files...
 r46 parameter_dump_packet.sid = SID_PARAMETER_DUMP;
//******************
// COMMON PARAMETERS
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 parameter_dump_packet.sy_lfr_common_parameters_spare = DEFAULT_SY_LFR_COMMON0;
parameter_dump_packet.sy_lfr_common_parameters = DEFAULT_SY_LFR_COMMON1;
paul
Ignore doc files...
 r46
//******************
// NORMAL PARAMETERS
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.sy_lfr_n_swf_l[0] = (unsigned char) (DFLT_SY_LFR_N_SWF_L >> SHIFT_1_BYTE);
paul
Many corrections done after Logiscope analysis
 r166 parameter_dump_packet.sy_lfr_n_swf_l[1] = (unsigned char) (DFLT_SY_LFR_N_SWF_L );
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.sy_lfr_n_swf_p[0] = (unsigned char) (DFLT_SY_LFR_N_SWF_P >> SHIFT_1_BYTE);
paul
Many corrections done after Logiscope analysis
 r166 parameter_dump_packet.sy_lfr_n_swf_p[1] = (unsigned char) (DFLT_SY_LFR_N_SWF_P );
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.sy_lfr_n_asm_p[0] = (unsigned char) (DFLT_SY_LFR_N_ASM_P >> SHIFT_1_BYTE);
paul
Many corrections done after Logiscope analysis
 r166 parameter_dump_packet.sy_lfr_n_asm_p[1] = (unsigned char) (DFLT_SY_LFR_N_ASM_P );
parameter_dump_packet.sy_lfr_n_bp_p0 = (unsigned char) DFLT_SY_LFR_N_BP_P0;
parameter_dump_packet.sy_lfr_n_bp_p1 = (unsigned char) DFLT_SY_LFR_N_BP_P1;
parameter_dump_packet.sy_lfr_n_cwf_long_f3 = (unsigned char) DFLT_SY_LFR_N_CWF_LONG_F3;
paul
Ignore doc files...
 r46
//*****************
// BURST PARAMETERS
parameter_dump_packet.sy_lfr_b_bp_p0 = (unsigned char) DEFAULT_SY_LFR_B_BP_P0;
parameter_dump_packet.sy_lfr_b_bp_p1 = (unsigned char) DEFAULT_SY_LFR_B_BP_P1;
//****************
// SBM1 PARAMETERS
parameter_dump_packet.sy_lfr_s1_bp_p0 = (unsigned char) DEFAULT_SY_LFR_S1_BP_P0; // min value is 0.25 s for the period
parameter_dump_packet.sy_lfr_s1_bp_p1 = (unsigned char) DEFAULT_SY_LFR_S1_BP_P1;
//****************
// SBM2 PARAMETERS
parameter_dump_packet.sy_lfr_s2_bp_p0 = (unsigned char) DEFAULT_SY_LFR_S2_BP_P0;
parameter_dump_packet.sy_lfr_s2_bp_p1 = (unsigned char) DEFAULT_SY_LFR_S2_BP_P1;
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195
//************
// FBINS MASKS
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for (k=0; k < BYTES_PER_MASKS_SET; k++)
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 {
paul
union usage removed from the sources (#897 Don_ArtVariables)...
 r324 parameter_dump_packet.sy_lfr_fbins_f0_word1[k] = INT8_ALL_F;
paul
R2 parameter added to TC_LFR_LOAD_COMMON_PAR...
 r195 }
paul
initialization of parameter_dump_packet updated with filtering elements
 r294
// PAS FILTER PARAMETERS
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 parameter_dump_packet.pa_rpw_spare8_2 = INIT_CHAR;
parameter_dump_packet.spare_sy_lfr_pas_filter_enabled = INIT_CHAR;
paul
initialization of parameter_dump_packet updated with filtering elements
 r294 parameter_dump_packet.sy_lfr_pas_filter_modulus = DEFAULT_SY_LFR_PAS_FILTER_MODULUS;
floatToChar( DEFAULT_SY_LFR_PAS_FILTER_TBAD, parameter_dump_packet.sy_lfr_pas_filter_tbad );
parameter_dump_packet.sy_lfr_pas_filter_offset = DEFAULT_SY_LFR_PAS_FILTER_OFFSET;
floatToChar( DEFAULT_SY_LFR_PAS_FILTER_SHIFT, parameter_dump_packet.sy_lfr_pas_filter_shift );
floatToChar( DEFAULT_SY_LFR_SC_RW_DELTA_F, parameter_dump_packet.sy_lfr_sc_rw_delta_f );
paul
compliance with ICD 4.3...
 r328 // RW1_K
floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw1_k1);
floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw1_k2);
floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw1_k3);
floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw1_k4);
// RW2_K
floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw2_k1);
floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw2_k2);
floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw2_k3);
floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw2_k4);
// RW3_K
floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw3_k1);
floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw3_k2);
floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw3_k3);
floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw3_k4);
// RW4_K
floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw4_k1);
floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw4_k2);
floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw4_k3);
floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw4_k4);
paul
initialization of parameter_dump_packet updated with filtering elements
 r294 // LFR_RW_MASK
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for (k=0; k < BYTES_PER_MASKS_SET; k++)
paul
initialization of parameter_dump_packet updated with filtering elements
 r294 {
paul
union usage removed from the sources (#897 Don_ArtVariables)...
 r324 parameter_dump_packet.sy_lfr_rw_mask_f0_word1[k] = INT8_ALL_F;
paul
initialization of parameter_dump_packet updated with filtering elements
 r294 }
paul
Bug #649 corrected, TC with Length > 228 are dropped by the driver, not parsed
 r316
// once the reaction wheels masks have been initialized, they have to be merged with the fbins masks
merge_fbins_masks();
paul
Ignore doc files...
 r46 }
paul
Header files inclusion reworked...
 r40
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 void init_kcoefficients_dump( void )
{
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 init_kcoefficients_dump_packet( &kcoefficients_dump_1, PKTNR_1, KCOEFF_BLK_NR_PKT1 );
init_kcoefficients_dump_packet( &kcoefficients_dump_2, PKTNR_2, KCOEFF_BLK_NR_PKT2 );
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194
kcoefficient_node_1.previous = NULL;
kcoefficient_node_1.next = NULL;
kcoefficient_node_1.sid = TM_CODE_K_DUMP;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficient_node_1.coarseTime = INIT_CHAR;
kcoefficient_node_1.fineTime = INIT_CHAR;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kcoefficient_node_1.buffer_address = (int) &kcoefficients_dump_1;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficient_node_1.status = INIT_CHAR;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194
kcoefficient_node_2.previous = NULL;
kcoefficient_node_2.next = NULL;
kcoefficient_node_2.sid = TM_CODE_K_DUMP;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficient_node_2.coarseTime = INIT_CHAR;
kcoefficient_node_2.fineTime = INIT_CHAR;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kcoefficient_node_2.buffer_address = (int) &kcoefficients_dump_2;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficient_node_2.status = INIT_CHAR;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 }
void init_kcoefficients_dump_packet( Packet_TM_LFR_KCOEFFICIENTS_DUMP_t *kcoefficients_dump, unsigned char pkt_nr, unsigned char blk_nr )
{
unsigned int k;
unsigned int packetLength;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 packetLength =
((blk_nr * KCOEFF_BLK_SIZE) + BYTE_POS_KCOEFFICIENTS_PARAMETES) - CCSDS_TC_TM_PACKET_OFFSET; // 4 bytes for the CCSDS header
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194
kcoefficients_dump->targetLogicalAddress = CCSDS_DESTINATION_ID;
kcoefficients_dump->protocolIdentifier = CCSDS_PROTOCOLE_ID;
kcoefficients_dump->reserved = CCSDS_RESERVED;
kcoefficients_dump->userApplication = CCSDS_USER_APP;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump->packetID[0] = (unsigned char) (APID_TM_PARAMETER_DUMP >> SHIFT_1_BYTE);
kcoefficients_dump->packetID[1] = (unsigned char) APID_TM_PARAMETER_DUMP;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kcoefficients_dump->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
kcoefficients_dump->packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump->packetLength[0] = (unsigned char) (packetLength >> SHIFT_1_BYTE);
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kcoefficients_dump->packetLength[1] = (unsigned char) packetLength;
// DATA FIELD HEADER
kcoefficients_dump->spare1_pusVersion_spare2 = SPARE1_PUSVERSION_SPARE2;
kcoefficients_dump->serviceType = TM_TYPE_K_DUMP;
kcoefficients_dump->serviceSubType = TM_SUBTYPE_K_DUMP;
kcoefficients_dump->destinationID= TM_DESTINATION_ID_GROUND;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump->time[BYTE_0] = INIT_CHAR;
kcoefficients_dump->time[BYTE_1] = INIT_CHAR;
kcoefficients_dump->time[BYTE_2] = INIT_CHAR;
kcoefficients_dump->time[BYTE_3] = INIT_CHAR;
kcoefficients_dump->time[BYTE_4] = INIT_CHAR;
kcoefficients_dump->time[BYTE_5] = INIT_CHAR;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kcoefficients_dump->sid = SID_K_DUMP;
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump->pkt_cnt = KCOEFF_PKTCNT;
kcoefficients_dump->pkt_nr = PKTNR_1;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 kcoefficients_dump->blk_nr = blk_nr;
//******************
// SOURCE DATA repeated N times with N in [0 .. PA_LFR_KCOEFF_BLK_NR]
// one blk is 2 + 4 * 32 = 130 bytes, 30 blks max in one packet (30 * 130 = 3900)
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 for (k=0; k<(KCOEFF_BLK_NR_PKT1 * KCOEFF_BLK_SIZE); k++)
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 {
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 kcoefficients_dump->kcoeff_blks[k] = INIT_CHAR;
paul
TC_LFR_LOAD_KCOEFFICIENTS...
 r194 }
}
paul
Header files inclusion reworked...
 r40
paul
printf removed or replaced by PRINTF macros...
 r227 void increment_seq_counter_destination_id_dump( unsigned char *packet_sequence_control, unsigned char destination_id )
paul
rev 3.0.0.6...
 r214 {
paul
printf removed or replaced by PRINTF macros...
 r227 /** This function increment the packet sequence control parameter of a TC, depending on its destination ID.
*
* @param packet_sequence_control points to the packet sequence control which will be incremented
* @param destination_id is the destination ID of the TM, there is one counter by destination ID
*
* If the destination ID is not known, a dedicated counter is incremented.
*
*/
paul
Header files inclusion reworked...
 r40
paul
printf removed or replaced by PRINTF macros...
 r227 unsigned short sequence_cnt;
unsigned short segmentation_grouping_flag;
unsigned short new_packet_sequence_control;
unsigned char i;
switch (destination_id)
paul
rev 3.0.0.6...
 r214 {
paul
printf removed or replaced by PRINTF macros...
 r227 case SID_TC_GROUND:
i = GROUND;
break;
case SID_TC_MISSION_TIMELINE:
i = MISSION_TIMELINE;
break;
case SID_TC_TC_SEQUENCES:
i = TC_SEQUENCES;
break;
case SID_TC_RECOVERY_ACTION_CMD:
i = RECOVERY_ACTION_CMD;
break;
case SID_TC_BACKUP_MISSION_TIMELINE:
i = BACKUP_MISSION_TIMELINE;
break;
case SID_TC_DIRECT_CMD:
i = DIRECT_CMD;
break;
case SID_TC_SPARE_GRD_SRC1:
i = SPARE_GRD_SRC1;
break;
case SID_TC_SPARE_GRD_SRC2:
i = SPARE_GRD_SRC2;
break;
case SID_TC_OBCP:
i = OBCP;
break;
case SID_TC_SYSTEM_CONTROL:
i = SYSTEM_CONTROL;
break;
case SID_TC_AOCS:
i = AOCS;
break;
case SID_TC_RPW_INTERNAL:
i = RPW_INTERNAL;
break;
default:
i = GROUND;
break;
paul
rev 3.0.0.6...
 r214 }
paul
Header files inclusion reworked...
 r40
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 segmentation_grouping_flag = TM_PACKET_SEQ_CTRL_STANDALONE << SHIFT_1_BYTE;
sequence_cnt = sequenceCounters_TM_DUMP[ i ] & SEQ_CNT_MASK;
paul
printf removed or replaced by PRINTF macros...
 r227
new_packet_sequence_control = segmentation_grouping_flag | sequence_cnt ;
paul
rev 3.0.0.6...
 r214
paul
Many corrections, mainly related to #807 Don_Enumeration
 r318 packet_sequence_control[0] = (unsigned char) (new_packet_sequence_control >> SHIFT_1_BYTE);
paul
printf removed or replaced by PRINTF macros...
 r227 packet_sequence_control[1] = (unsigned char) (new_packet_sequence_control );
// increment the sequence counter
if ( sequenceCounters_TM_DUMP[ i ] < SEQ_CNT_MAX )
paul
rev 3.0.0.6...
 r214 {
paul
printf removed or replaced by PRINTF macros...
 r227 sequenceCounters_TM_DUMP[ i ] = sequenceCounters_TM_DUMP[ i ] + 1;
}
else
{
sequenceCounters_TM_DUMP[ i ] = 0;
paul
rev 3.0.0.6...
 r214 }
}