HG_REPOSITORIES/LPP/INSTRUMENTATION/SOLO_LFR/DEV_PLE Commit - r313:972ae9f0eb8f

setFBinMask corrected...

paul -

r313:972ae9f0eb8f R3_plus

parent child

Context file:

r313:972ae9f0eb8f

Collapse all files

.hgsubstate +1 -1

@@ -1,2 +1,2
1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters	1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters
2	94f0f2fccbcb8030d9437ffbb69ee0eefaaea188 header/lfr_common_headers	2	57edc38eadba4601cf0b1e2fa1eeab85082e9f41 header/lfr_common_headers

src/CMakeLists.txt +2 0

             cmake_minimum_required (VERSION 2.6)
             project (fsw)
             include(sparc-rtems)
             include(cppcheck)
             include_directories("../header"
             	 "../header/lfr_common_headers"
             	 "../header/processing"
                      "../LFR_basic-parameters"
                      "../src")
             set(SOURCES    wf_handler.c
                  tc_handler.c
                  fsw_misc.c
                  fsw_init.c
                  fsw_globals.c
                  fsw_spacewire.c
                  tc_load_dump_parameters.c
                  tm_lfr_tc_exe.c
                  tc_acceptance.c
                  processing/fsw_processing.c
                  processing/avf0_prc0.c
                  processing/avf1_prc1.c
                  processing/avf2_prc2.c
                  lfr_cpu_usage_report.c
                  ${LFR_BP_SRC}
                  ../header/wf_handler.h
                  ../header/tc_handler.h
                  ../header/grlib_regs.h
                  ../header/fsw_misc.h
                  ../header/fsw_init.h
                  ../header/fsw_spacewire.h
                  ../header/tc_load_dump_parameters.h
                  ../header/tm_lfr_tc_exe.h
                  ../header/tc_acceptance.h
                  ../header/processing/fsw_processing.h
                  ../header/processing/avf0_prc0.h
                  ../header/processing/avf1_prc1.h
                  ../header/processing/avf2_prc2.h
                  ../header/fsw_params_wf_handler.h
                  ../header/lfr_cpu_usage_report.h
                  ../header/lfr_common_headers/ccsds_types.h
                  ../header/lfr_common_headers/fsw_params.h
                  ../header/lfr_common_headers/fsw_params_nb_bytes.h
                  ../header/lfr_common_headers/fsw_params_processing.h
                  ../header/lfr_common_headers/tm_byte_positions.h
                  ../LFR_basic-parameters/basic_parameters.h
                  ../LFR_basic-parameters/basic_parameters_params.h
                  ../header/GscMemoryLPP.hpp
             )
             option(FSW_verbose "Enable verbose LFR" ON)
             option(FSW_boot_messages "Enable LFR boot messages" ON)
             option(FSW_debug_messages "Enable LFR debug messages" ON)
             option(FSW_cpu_usage_report "Enable LFR cpu usage report" OFF)
             option(FSW_stack_report "Enable LFR stack report" OFF)
             option(FSW_vhdl_dev "?" OFF)
             option(FSW_lpp_dpu_destid "Set to debug at LPP" ON)
             option(FSW_debug_watchdog "Enable debug watchdog" OFF)
             option(FSW_debug_tch "?" OFF)
             set(SW_VERSION_N1 "3" CACHE STRING  "Choose N1 FSW Version." FORCE)
             set(SW_VERSION_N2 "1" CACHE STRING  "Choose N2 FSW Version." FORCE)
             set(SW_VERSION_N3 "0" CACHE STRING  "Choose N3 FSW Version." FORCE)
             set(SW_VERSION_N4 "4" CACHE STRING  "Choose N4 FSW Version." FORCE)
             if(FSW_verbose)
             	add_definitions(-DPRINT_MESSAGES_ON_CONSOLE)
             endif()
             if(FSW_boot_messages)
             	add_definitions(-DBOOT_MESSAGES)
             endif()
             if(FSW_debug_messages)
             	add_definitions(-DDEBUG_MESSAGES)
             endif()
             if(FSW_cpu_usage_report)
             	add_definitions(-DPRINT_TASK_STATISTICS)
             endif()
             if(FSW_stack_report)
             	add_definitions(-DPRINT_STACK_REPORT)
             endif()
             if(FSW_vhdl_dev)
             	add_definitions(-DVHDL_DEV)
             endif()
             if(FSW_lpp_dpu_destid)
             	add_definitions(-DLPP_DPU_DESTID)
             endif()
             if(FSW_debug_watchdog)
             	add_definitions(-DDEBUG_WATCHDOG)
             endif()
             if(FSW_debug_tch)
             	add_definitions(-DDEBUG_TCH)
             endif()
             add_definitions(-DMSB_FIRST_TCH)
             add_definitions(-DSWVERSION=-1-0)
             add_definitions(-DSW_VERSION_N1=${SW_VERSION_N1})
             add_definitions(-DSW_VERSION_N2=${SW_VERSION_N2})
             add_definitions(-DSW_VERSION_N3=${SW_VERSION_N3})
             add_definitions(-DSW_VERSION_N4=${SW_VERSION_N4})
             add_executable(FSW ${SOURCES})
+            add_test_cppcheck(FSW STYLE UNUSED_FUNCTIONS POSSIBLE_ERROR MISSING_INCLUDE)

src/processing/fsw_processing.c +1 -1

             /** Functions related to data processing.
              *
              * @file
              * @author P. LEROY
              *
              * These function are related to data processing, i.e. spectral matrices averaging and basic parameters computation.
              *
              */
             #include "fsw_processing.h"
             #include "fsw_processing_globals.c"
             #include "fsw_init.h"
             unsigned int nb_sm_f0;
             unsigned int nb_sm_f0_aux_f1;
             unsigned int nb_sm_f1;
             unsigned int nb_sm_f0_aux_f2;
             typedef enum restartState_t
             {
                 WAIT_FOR_F2,
                 WAIT_FOR_F1,
                 WAIT_FOR_F0
             } restartState;
             //************************
             // spectral matrices rings
             ring_node sm_ring_f0[ NB_RING_NODES_SM_F0 ];
             ring_node sm_ring_f1[ NB_RING_NODES_SM_F1 ];
             ring_node sm_ring_f2[ NB_RING_NODES_SM_F2 ];
             ring_node *current_ring_node_sm_f0;
             ring_node *current_ring_node_sm_f1;
             ring_node *current_ring_node_sm_f2;
             ring_node *ring_node_for_averaging_sm_f0;
             ring_node *ring_node_for_averaging_sm_f1;
             ring_node *ring_node_for_averaging_sm_f2;
             //
             ring_node * getRingNodeForAveraging( unsigned char frequencyChannel)
             {
                 ring_node *node;
                 node = NULL;
                 switch ( frequencyChannel ) {
                 case 0:
                     node = ring_node_for_averaging_sm_f0;
                     break;
                 case 1:
                     node = ring_node_for_averaging_sm_f1;
                     break;
                 case 2:
                     node = ring_node_for_averaging_sm_f2;
                     break;
                 default:
                     break;
                 }
                 return node;
             }
             //***********************************************************
             // Interrupt Service Routine for spectral matrices processing
             void spectral_matrices_isr_f0( int statusReg )
             {
                 unsigned char status;
                 rtems_status_code status_code;
                 ring_node *full_ring_node;
                 status = (unsigned char) (statusReg & 0x03);   // [0011] get the status_ready_matrix_f0_x bits
                 switch(status)
                 {
                 case 0:
                     break;
                 case 3:
                     // UNEXPECTED VALUE
                     spectral_matrix_regs->status = 0x03;   // [0011]
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_11 );
                     break;
                 case 1:
                     full_ring_node = current_ring_node_sm_f0->previous;
                     full_ring_node->coarseTime = spectral_matrix_regs->f0_0_coarse_time;
                     full_ring_node->fineTime = spectral_matrix_regs->f0_0_fine_time;
                     current_ring_node_sm_f0 = current_ring_node_sm_f0->next;
                     spectral_matrix_regs->f0_0_address = current_ring_node_sm_f0->buffer_address;
                     // if there are enough ring nodes ready, wake up an AVFx task
                     nb_sm_f0 = nb_sm_f0 + 1;
                     if (nb_sm_f0 == NB_SM_BEFORE_AVF0)
                     {
                         ring_node_for_averaging_sm_f0 = full_ring_node;
                         if (rtems_event_send( Task_id[TASKID_AVF0], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                         {
                             status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                         }
                         nb_sm_f0 = 0;
                     }
                     spectral_matrix_regs->status = 0x01;   // [0000 0001]
                     break;
                 case 2:
                     full_ring_node = current_ring_node_sm_f0->previous;
                     full_ring_node->coarseTime = spectral_matrix_regs->f0_1_coarse_time;
                     full_ring_node->fineTime = spectral_matrix_regs->f0_1_fine_time;
                     current_ring_node_sm_f0 = current_ring_node_sm_f0->next;
                     spectral_matrix_regs->f0_1_address = current_ring_node_sm_f0->buffer_address;
                     // if there are enough ring nodes ready, wake up an AVFx task
                     nb_sm_f0 = nb_sm_f0 + 1;
                     if (nb_sm_f0 == NB_SM_BEFORE_AVF0)
                     {
                         ring_node_for_averaging_sm_f0 = full_ring_node;
                         if (rtems_event_send( Task_id[TASKID_AVF0], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                         {
                             status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                         }
                         nb_sm_f0 = 0;
                     }
                     spectral_matrix_regs->status = 0x02;   // [0000 0010]
                     break;
                 }
             }
             void spectral_matrices_isr_f1( int statusReg )
             {
                 rtems_status_code status_code;
                 unsigned char status;
                 ring_node *full_ring_node;
                 status = (unsigned char) ((statusReg & 0x0c) >> 2);   // [1100] get the status_ready_matrix_f1_x bits
                 switch(status)
                 {
                 case 0:
                     break;
                 case 3:
                     // UNEXPECTED VALUE
                     spectral_matrix_regs->status = 0xc0;   // [1100]
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_11 );
                     break;
                 case 1:
                     full_ring_node = current_ring_node_sm_f1->previous;
                     full_ring_node->coarseTime = spectral_matrix_regs->f1_0_coarse_time;
                     full_ring_node->fineTime = spectral_matrix_regs->f1_0_fine_time;
                     current_ring_node_sm_f1 = current_ring_node_sm_f1->next;
                     spectral_matrix_regs->f1_0_address = current_ring_node_sm_f1->buffer_address;
                     // if there are enough ring nodes ready, wake up an AVFx task
                     nb_sm_f1 = nb_sm_f1 + 1;
                     if (nb_sm_f1 == NB_SM_BEFORE_AVF1)
                     {
                         ring_node_for_averaging_sm_f1 = full_ring_node;
                         if (rtems_event_send( Task_id[TASKID_AVF1], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                         {
                             status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                         }
                         nb_sm_f1 = 0;
                     }
                     spectral_matrix_regs->status = 0x04;   // [0000 0100]
                     break;
                 case 2:
                     full_ring_node = current_ring_node_sm_f1->previous;
                     full_ring_node->coarseTime = spectral_matrix_regs->f1_1_coarse_time;
                     full_ring_node->fineTime = spectral_matrix_regs->f1_1_fine_time;
                     current_ring_node_sm_f1 = current_ring_node_sm_f1->next;
                     spectral_matrix_regs->f1_1_address = current_ring_node_sm_f1->buffer_address;
                     // if there are enough ring nodes ready, wake up an AVFx task
                     nb_sm_f1 = nb_sm_f1 + 1;
                     if (nb_sm_f1 == NB_SM_BEFORE_AVF1)
                     {
                         ring_node_for_averaging_sm_f1 = full_ring_node;
                         if (rtems_event_send( Task_id[TASKID_AVF1], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                         {
                             status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                         }
                         nb_sm_f1 = 0;
                     }
                     spectral_matrix_regs->status = 0x08;   // [1000 0000]
                     break;
                 }
             }
             void spectral_matrices_isr_f2( int statusReg )
             {
                 unsigned char status;
                 rtems_status_code status_code;
                 status = (unsigned char) ((statusReg & 0x30) >> 4);   // [0011 0000] get the status_ready_matrix_f2_x bits
                 switch(status)
                 {
                 case 0:
                     break;
                 case 3:
                     // UNEXPECTED VALUE
                     spectral_matrix_regs->status = 0x30;   // [0011 0000]
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_11 );
                     break;
                 case 1:
                     ring_node_for_averaging_sm_f2 = current_ring_node_sm_f2->previous;
                     current_ring_node_sm_f2 = current_ring_node_sm_f2->next;
                     ring_node_for_averaging_sm_f2->coarseTime = spectral_matrix_regs->f2_0_coarse_time;
                     ring_node_for_averaging_sm_f2->fineTime = spectral_matrix_regs->f2_0_fine_time;
                     spectral_matrix_regs->f2_0_address = current_ring_node_sm_f2->buffer_address;
                     spectral_matrix_regs->status = 0x10;   // [0001 0000]
                     if (rtems_event_send( Task_id[TASKID_AVF2], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                     {
                         status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                     }
                     break;
                 case 2:
                     ring_node_for_averaging_sm_f2 = current_ring_node_sm_f2->previous;
                     current_ring_node_sm_f2 = current_ring_node_sm_f2->next;
                     ring_node_for_averaging_sm_f2->coarseTime = spectral_matrix_regs->f2_1_coarse_time;
                     ring_node_for_averaging_sm_f2->fineTime = spectral_matrix_regs->f2_1_fine_time;
                     spectral_matrix_regs->f2_1_address = current_ring_node_sm_f2->buffer_address;
                     spectral_matrix_regs->status = 0x20;   // [0010 0000]
                     if (rtems_event_send( Task_id[TASKID_AVF2], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                     {
                         status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                     }
                     break;
                 }
             }
             void spectral_matrix_isr_error_handler( int statusReg )
             {
                 // STATUS REGISTER
                 // input_fifo_write(2) *** input_fifo_write(1) *** input_fifo_write(0)
                 //           10                    9                       8
                 // buffer_full ** [bad_component_err] ** f2_1 ** f2_0 ** f1_1 ** f1_0 ** f0_1 ** f0_0
                 //      7                  6             5       4       3       2       1       0
                 // [bad_component_err] not defined in the last version of the VHDL code
                 rtems_status_code status_code;
                 //***************************************************
                 // the ASM status register is copied in the HK packet
                 housekeeping_packet.hk_lfr_vhdl_aa_sm = (unsigned char) (statusReg & 0x780 >> 7);    // [0111 1000 0000]
                 if (statusReg & 0x7c0)    // [0111 1100 0000]
                 {
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_8 );
                 }
                 spectral_matrix_regs->status = spectral_matrix_regs->status & 0x7c0;
             }
             rtems_isr spectral_matrices_isr( rtems_vector_number vector )
             {
                 // STATUS REGISTER
                 // input_fifo_write(2) *** input_fifo_write(1) *** input_fifo_write(0)
                 //           10                    9                       8
                 // buffer_full ** bad_component_err ** f2_1 ** f2_0 ** f1_1 ** f1_0 ** f0_1 ** f0_0
                 //      7                  6             5       4       3       2       1       0
                 int statusReg;
                 static restartState state = WAIT_FOR_F2;
                 statusReg = spectral_matrix_regs->status;
                 if (thisIsAnASMRestart == 0)
                 {   // this is not a restart sequence, process incoming matrices normally
                     spectral_matrices_isr_f0( statusReg );
                     spectral_matrices_isr_f1( statusReg );
                     spectral_matrices_isr_f2( statusReg );
                 }
                 else
                 {   // a restart sequence has to be launched
                     switch (state) {
                     case WAIT_FOR_F2:
                         if ((statusReg & 0x30) != 0x00)   // [0011 0000] check the status_ready_matrix_f2_x bits
                         {
                             state = WAIT_FOR_F1;
                         }
                         break;
                     case WAIT_FOR_F1:
                         if ((statusReg & 0x0c) != 0x00)   // [0000 1100] check the status_ready_matrix_f1_x bits
                         {
                             state = WAIT_FOR_F0;
                         }
                         break;
                     case WAIT_FOR_F0:
                         if ((statusReg & 0x03) != 0x00)   // [0000 0011] check the status_ready_matrix_f0_x bits
                         {
                             state = WAIT_FOR_F2;
                             thisIsAnASMRestart = 0;
                         }
                         break;
                     default:
                         break;
                     }
                     reset_sm_status();
                 }
                 spectral_matrix_isr_error_handler( statusReg );
             }
             //******************
             // Spectral Matrices
             void reset_nb_sm( void )
             {
                 nb_sm_f0 = 0;
                 nb_sm_f0_aux_f1 = 0;
                 nb_sm_f0_aux_f2 = 0;
                 nb_sm_f1 = 0;
             }
             void SM_init_rings( void )
             {
                 init_ring( sm_ring_f0, NB_RING_NODES_SM_F0, sm_f0, TOTAL_SIZE_SM );
                 init_ring( sm_ring_f1, NB_RING_NODES_SM_F1, sm_f1, TOTAL_SIZE_SM );
                 init_ring( sm_ring_f2, NB_RING_NODES_SM_F2, sm_f2, TOTAL_SIZE_SM );
                 DEBUG_PRINTF1("sm_ring_f0 @%x\n", (unsigned int) sm_ring_f0)
                 DEBUG_PRINTF1("sm_ring_f1 @%x\n", (unsigned int) sm_ring_f1)
                 DEBUG_PRINTF1("sm_ring_f2 @%x\n", (unsigned int) sm_ring_f2)
                 DEBUG_PRINTF1("sm_f0 @%x\n", (unsigned int) sm_f0)
                 DEBUG_PRINTF1("sm_f1 @%x\n", (unsigned int) sm_f1)
                 DEBUG_PRINTF1("sm_f2 @%x\n", (unsigned int) sm_f2)
             }
             void ASM_generic_init_ring( ring_node_asm *ring, unsigned char nbNodes )
             {
                 unsigned char i;
                 ring[ nbNodes - 1 ].next
                         = (ring_node_asm*) &ring[ 0 ];
                 for(i=0; i<nbNodes-1; i++)
                 {
                     ring[ i ].next            = (ring_node_asm*) &ring[ i + 1 ];
                 }
             }
             void SM_reset_current_ring_nodes( void )
             {
                 current_ring_node_sm_f0 = sm_ring_f0[0].next;
                 current_ring_node_sm_f1 = sm_ring_f1[0].next;
                 current_ring_node_sm_f2 = sm_ring_f2[0].next;
                 ring_node_for_averaging_sm_f0 = NULL;
                 ring_node_for_averaging_sm_f1 = NULL;
                 ring_node_for_averaging_sm_f2 = NULL;
             }
             //*****************
             // Basic Parameters
             void BP_init_header( bp_packet *packet,
                                  unsigned int apid, unsigned char sid,
                                  unsigned int packetLength, unsigned char blkNr )
             {
                 packet->targetLogicalAddress = CCSDS_DESTINATION_ID;
                 packet->protocolIdentifier = CCSDS_PROTOCOLE_ID;
                 packet->reserved = 0x00;
                 packet->userApplication = CCSDS_USER_APP;
                 packet->packetID[0] = (unsigned char) (apid >> 8);
                 packet->packetID[1] = (unsigned char) (apid);
                 packet->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 packet->packetSequenceControl[1] = 0x00;
                 packet->packetLength[0] = (unsigned char) (packetLength >> 8);
                 packet->packetLength[1] = (unsigned char) (packetLength);
                 // DATA FIELD HEADER
                 packet->spare1_pusVersion_spare2 = 0x10;
                 packet->serviceType = TM_TYPE_LFR_SCIENCE; // service type
                 packet->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_3; // service subtype
                 packet->destinationID = TM_DESTINATION_ID_GROUND;
                 packet->time[0] = 0x00;
                 packet->time[1] = 0x00;
                 packet->time[2] = 0x00;
                 packet->time[3] = 0x00;
                 packet->time[4] = 0x00;
                 packet->time[5] = 0x00;
                 // AUXILIARY DATA HEADER
                 packet->sid = sid;
                 packet->pa_bia_status_info = 0x00;
                 packet->sy_lfr_common_parameters_spare = 0x00;
                 packet->sy_lfr_common_parameters = 0x00;
                 packet->acquisitionTime[0] = 0x00;
                 packet->acquisitionTime[1] = 0x00;
                 packet->acquisitionTime[2] = 0x00;
                 packet->acquisitionTime[3] = 0x00;
                 packet->acquisitionTime[4] = 0x00;
                 packet->acquisitionTime[5] = 0x00;
                 packet->pa_lfr_bp_blk_nr[0] = 0x00;  // BLK_NR MSB
                 packet->pa_lfr_bp_blk_nr[1] = blkNr;  // BLK_NR LSB
             }
             void BP_init_header_with_spare( bp_packet_with_spare *packet,
                                             unsigned int apid, unsigned char sid,
                                             unsigned int packetLength , unsigned char blkNr)
             {
                 packet->targetLogicalAddress = CCSDS_DESTINATION_ID;
                 packet->protocolIdentifier = CCSDS_PROTOCOLE_ID;
                 packet->reserved = 0x00;
                 packet->userApplication = CCSDS_USER_APP;
                 packet->packetID[0] = (unsigned char) (apid >> 8);
                 packet->packetID[1] = (unsigned char) (apid);
                 packet->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 packet->packetSequenceControl[1] = 0x00;
                 packet->packetLength[0] = (unsigned char) (packetLength >> 8);
                 packet->packetLength[1] = (unsigned char) (packetLength);
                 // DATA FIELD HEADER
                 packet->spare1_pusVersion_spare2 = 0x10;
                 packet->serviceType = TM_TYPE_LFR_SCIENCE; // service type
                 packet->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_3; // service subtype
                 packet->destinationID = TM_DESTINATION_ID_GROUND;
                 // AUXILIARY DATA HEADER
                 packet->sid = sid;
                 packet->pa_bia_status_info = 0x00;
                 packet->sy_lfr_common_parameters_spare = 0x00;
                 packet->sy_lfr_common_parameters = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->source_data_spare = 0x00;
                 packet->pa_lfr_bp_blk_nr[0] = 0x00;  // BLK_NR MSB
                 packet->pa_lfr_bp_blk_nr[1] = blkNr;  // BLK_NR LSB
             }
             void BP_send(char *data, rtems_id queue_id, unsigned int nbBytesToSend, unsigned int sid )
             {
                 rtems_status_code status;
                 // SEND PACKET
                 status =  rtems_message_queue_send( queue_id, data, nbBytesToSend);
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in BP_send *** ERR %d\n", (int) status)
                 }
             }
             void BP_send_s1_s2(char *data, rtems_id queue_id, unsigned int nbBytesToSend, unsigned int sid )
             {
                 /** This function is used to send the BP paquets when needed.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return void
                  *
                  * SBM1 and SBM2 paquets are sent depending on the type of the LFR mode transition.
                  * BURST paquets are sent everytime.
                  *
                  */
                 rtems_status_code status;
                 // SEND PACKET
                 // before lastValidTransitionDate, the data are drops even if they are ready
                 // this guarantees that no SBM packets will be received before the requested enter mode time
                 if ( time_management_regs->coarse_time >= lastValidEnterModeTime)
                 {
                     status =  rtems_message_queue_send( queue_id, data, nbBytesToSend);
                     if (status != RTEMS_SUCCESSFUL)
                     {
                         PRINTF1("ERR *** in BP_send *** ERR %d\n", (int) status)
                     }
                 }
             }
             //******************
             // general functions
             void reset_sm_status( void )
             {
                 // error
                 // 10 --------------- 9 ---------------- 8 ---------------- 7 ---------
                 // input_fif0_write_2 input_fifo_write_1 input_fifo_write_0 buffer_full
                 // ---------- 5 -- 4 -- 3 -- 2 -- 1 -- 0 --
                 // ready bits f2_1 f2_0 f1_1 f1_1 f0_1 f0_0
                 spectral_matrix_regs->status = 0x7ff;   // [0111 1111 1111]
             }
             void reset_spectral_matrix_regs( void )
             {
                 /** This function resets the spectral matrices module registers.
                  *
                  * The registers affected by this function are located at the following offset addresses:
                  *
                  * - 0x00 config
                  * - 0x04 status
                  * - 0x08 matrixF0_Address0
                  * - 0x10 matrixFO_Address1
                  * - 0x14 matrixF1_Address
                  * - 0x18 matrixF2_Address
                  *
                  */
                 set_sm_irq_onError( 0 );
                 set_sm_irq_onNewMatrix( 0 );
                 reset_sm_status();
                 // F1
                 spectral_matrix_regs->f0_0_address = current_ring_node_sm_f0->previous->buffer_address;
                 spectral_matrix_regs->f0_1_address = current_ring_node_sm_f0->buffer_address;
                 // F2
                 spectral_matrix_regs->f1_0_address = current_ring_node_sm_f1->previous->buffer_address;
                 spectral_matrix_regs->f1_1_address = current_ring_node_sm_f1->buffer_address;
                 // F3
                 spectral_matrix_regs->f2_0_address = current_ring_node_sm_f2->previous->buffer_address;
                 spectral_matrix_regs->f2_1_address = current_ring_node_sm_f2->buffer_address;
                 spectral_matrix_regs->matrix_length = 0xc8; // 25 * 128 / 16 = 200 = 0xc8
             }
             void set_time( unsigned char *time, unsigned char * timeInBuffer )
             {
                 time[0] = timeInBuffer[0];
                 time[1] = timeInBuffer[1];
                 time[2] = timeInBuffer[2];
                 time[3] = timeInBuffer[3];
                 time[4] = timeInBuffer[6];
                 time[5] = timeInBuffer[7];
             }
             unsigned long long int get_acquisition_time( unsigned char *timePtr )
             {
                 unsigned long long int acquisitionTimeAslong;
                 acquisitionTimeAslong = 0x00;
                 acquisitionTimeAslong = ( (unsigned long long int) (timePtr[0] & 0x7f) << 40 ) // [0111 1111] mask the synchronization bit
                         + ( (unsigned long long int) timePtr[1] << 32 )
                         + ( (unsigned long long int) timePtr[2] << 24 )
                         + ( (unsigned long long int) timePtr[3] << 16 )
                         + ( (unsigned long long int) timePtr[6] << 8  )
                         + ( (unsigned long long int) timePtr[7]       );
                 return acquisitionTimeAslong;
             }
             unsigned char getSID( rtems_event_set event )
             {
                 unsigned char sid;
                 rtems_event_set eventSetBURST;
                 rtems_event_set eventSetSBM;
                 //******
                 // BURST
                 eventSetBURST = RTEMS_EVENT_BURST_BP1_F0
                         | RTEMS_EVENT_BURST_BP1_F1
                         | RTEMS_EVENT_BURST_BP2_F0
                         | RTEMS_EVENT_BURST_BP2_F1;
                 //****
                 // SBM
                 eventSetSBM = RTEMS_EVENT_SBM_BP1_F0
                         | RTEMS_EVENT_SBM_BP1_F1
                         | RTEMS_EVENT_SBM_BP2_F0
                         | RTEMS_EVENT_SBM_BP2_F1;
                 if (event & eventSetBURST)
                 {
                     sid = SID_BURST_BP1_F0;
                 }
                 else if (event & eventSetSBM)
                 {
                     sid = SID_SBM1_BP1_F0;
                 }
                 else
                 {
                     sid = 0;
                 }
                 return sid;
             }
             void extractReImVectors( float *inputASM, float *outputASM, unsigned int asmComponent )
             {
                 unsigned int i;
                 float re;
                 float im;
                 for (i=0; i<NB_BINS_PER_SM; i++){
                     re = inputASM[ (asmComponent*NB_BINS_PER_SM) + i * 2    ];
                     im = inputASM[ (asmComponent*NB_BINS_PER_SM) + i * 2 + 1];
                     outputASM[ (asmComponent   *NB_BINS_PER_SM)  +  i] = re;
                     outputASM[ (asmComponent+1)*NB_BINS_PER_SM   +  i] = im;
                 }
             }
             void copyReVectors( float *inputASM, float *outputASM, unsigned int asmComponent )
             {
                 unsigned int i;
                 float re;
                 for (i=0; i<NB_BINS_PER_SM; i++){
                     re = inputASM[ (asmComponent*NB_BINS_PER_SM) + i];
                     outputASM[ (asmComponent*NB_BINS_PER_SM)  +  i] = re;
                 }
             }
             void ASM_patch( float *inputASM, float *outputASM )
             {
                 extractReImVectors( inputASM, outputASM, 1);    // b1b2
                 extractReImVectors( inputASM, outputASM, 3 );   // b1b3
                 extractReImVectors( inputASM, outputASM, 5 );   // b1e1
                 extractReImVectors( inputASM, outputASM, 7 );   // b1e2
                 extractReImVectors( inputASM, outputASM, 10 );  // b2b3
                 extractReImVectors( inputASM, outputASM, 12 );  // b2e1
                 extractReImVectors( inputASM, outputASM, 14 );  // b2e2
                 extractReImVectors( inputASM, outputASM, 17 );  // b3e1
                 extractReImVectors( inputASM, outputASM, 19 );  // b3e2
                 extractReImVectors( inputASM, outputASM, 22 );  // e1e2
                 copyReVectors(inputASM, outputASM, 0 );    // b1b1
                 copyReVectors(inputASM, outputASM, 9 );    // b2b2
                 copyReVectors(inputASM, outputASM, 16);    // b3b3
                 copyReVectors(inputASM, outputASM, 21);    // e1e1
                 copyReVectors(inputASM, outputASM, 24);    // e2e2
             }
             void ASM_compress_reorganize_and_divide_mask(float *averaged_spec_mat, float *compressed_spec_mat , float divider,
                                                          unsigned char nbBinsCompressedMatrix, unsigned char nbBinsToAverage,
                                                          unsigned char ASMIndexStart,
                                                          unsigned char channel )
             {
                 //*************
                 // input format
                 // component0[0 .. 127] component1[0 .. 127] .. component24[0 .. 127]
                 //**************
                 // output format
                 // matr0[0 .. 24]      matr1[0 .. 24]       .. matr127[0 .. 24]
                 //************
                 // compression
                 // matr0[0 .. 24]      matr1[0 .. 24]       .. matr11[0 .. 24] => f0 NORM
                 // matr0[0 .. 24]      matr1[0 .. 24]       .. matr22[0 .. 24] => f0 BURST, SBM
                 int frequencyBin;
                 int asmComponent;
                 int offsetASM;
                 int offsetCompressed;
                 int offsetFBin;
                 int fBinMask;
                 int k;
                 // BUILD DATA
                 for (asmComponent = 0; asmComponent < NB_VALUES_PER_SM; asmComponent++)
                 {
                     for( frequencyBin = 0; frequencyBin < nbBinsCompressedMatrix; frequencyBin++ )
                     {
                         offsetCompressed =  // NO TIME OFFSET
                                 frequencyBin * NB_VALUES_PER_SM
                                 + asmComponent;
                         offsetASM =         // NO TIME OFFSET
                                 asmComponent * NB_BINS_PER_SM
                                 + ASMIndexStart
                                 + frequencyBin * nbBinsToAverage;
                         offsetFBin = ASMIndexStart
                                 + frequencyBin * nbBinsToAverage;
                         compressed_spec_mat[ offsetCompressed ] = 0;
                         for ( k = 0; k < nbBinsToAverage; k++ )
                         {
                             fBinMask = getFBinMask( offsetFBin + k, channel );
                             compressed_spec_mat[offsetCompressed ] =
                                     ( compressed_spec_mat[ offsetCompressed ]
                                     + averaged_spec_mat[ offsetASM + k ] * fBinMask );
                         }
                         compressed_spec_mat[ offsetCompressed ] =
                                 (divider != 0.) ? compressed_spec_mat[ offsetCompressed ] / (divider * nbBinsToAverage) : 0.0;
                     }
                 }
             }
             int getFBinMask( int index, unsigned char channel )
             {
                 unsigned int indexInChar;
                 unsigned int indexInTheChar;
                 int fbin;
                 unsigned char *sy_lfr_fbins_fx_word1;
-                sy_lfr_fbins_fx_word1 = parameter_dump_packet.sy_lfr_fbins_f0_word1;
+                sy_lfr_fbins_fx_word1 = parameter_dump_packet.sy_lfr_fbins.fx.f0_word1;
                 switch(channel)
                 {
                 case 0:
                     sy_lfr_fbins_fx_word1 = fbins_masks.merged_fbins_mask_f0;
                     break;
                 case 1:
                     sy_lfr_fbins_fx_word1 = fbins_masks.merged_fbins_mask_f1;
                     break;
                 case 2:
                     sy_lfr_fbins_fx_word1 = fbins_masks.merged_fbins_mask_f2;
                     break;
                 default:
                     PRINTF("ERR *** in getFBinMask, wrong frequency channel")
                 }
                 indexInChar = index >> 3;
                 indexInTheChar = index - indexInChar * 8;
                 fbin = (int) ((sy_lfr_fbins_fx_word1[ NB_BYTES_PER_FREQ_MASK - 1 - indexInChar] >> indexInTheChar) & 0x1);
                 return fbin;
             }
             unsigned char acquisitionTimeIsValid( unsigned int coarseTime, unsigned int fineTime, unsigned char channel)
             {
                 u_int64_t acquisitionTime;
                 u_int64_t timecodeReference;
                 u_int64_t offsetInFineTime;
                 u_int64_t shiftInFineTime;
                 u_int64_t tBadInFineTime;
                 u_int64_t acquisitionTimeRangeMin;
                 u_int64_t acquisitionTimeRangeMax;
                 unsigned char pasFilteringIsEnabled;
                 unsigned char ret;
                 pasFilteringIsEnabled = (filterPar.spare_sy_lfr_pas_filter_enabled & 0x01); // [0000 0001]
                 ret = 1;
                 // compute acquisition time from caoarseTime and fineTime
                 acquisitionTime = ( ((u_int64_t)coarseTime) <<  16 )
                         + (u_int64_t) fineTime;
                 // compute the timecode reference
                 timecodeReference = (u_int64_t) (floor( ((double) coarseTime) / ((double) filterPar.sy_lfr_pas_filter_modulus) )
                         * ((double) filterPar.sy_lfr_pas_filter_modulus)) * 65536;
                 // compute the acquitionTime range
                 offsetInFineTime    = ((double) filterPar.sy_lfr_pas_filter_offset)   * 65536;
                 shiftInFineTime     = ((double) filterPar.sy_lfr_pas_filter_shift)    * 65536;
                 tBadInFineTime      = ((double) filterPar.sy_lfr_pas_filter_tbad)     * 65536;
                 acquisitionTimeRangeMin =
                         timecodeReference
                         + offsetInFineTime
                         + shiftInFineTime
                         - acquisitionDurations[channel];
                 acquisitionTimeRangeMax =
                         timecodeReference
                         + offsetInFineTime
                         + shiftInFineTime
                         + tBadInFineTime;
                 if ( (acquisitionTime >= acquisitionTimeRangeMin)
                      && (acquisitionTime <= acquisitionTimeRangeMax)
                      && (pasFilteringIsEnabled == 1) )
                 {
                     ret = 0;    // the acquisition time is INSIDE the range, the matrix shall be ignored
                 }
                 else
                 {
                     ret = 1;    // the acquisition time is OUTSIDE the range, the matrix can be used for the averaging
                 }
             //    printf("coarseTime = %x, fineTime = %x\n",
             //           coarseTime,
             //           fineTime);
             //    printf("[ret = %d] *** acquisitionTime = %f, Reference = %f",
             //           ret,
             //           acquisitionTime / 65536.,
             //           timecodeReference / 65536.);
             //    printf(", Min = %f, Max = %f\n",
             //           acquisitionTimeRangeMin / 65536.,
             //           acquisitionTimeRangeMax / 65536.);
                 return ret;
             }
             void init_kcoeff_sbm_from_kcoeff_norm(float *input_kcoeff, float *output_kcoeff, unsigned char nb_bins_norm)
             {
                 unsigned char bin;
                 unsigned char kcoeff;
                 for (bin=0; bin<nb_bins_norm; bin++)
                 {
                     for (kcoeff=0; kcoeff<NB_K_COEFF_PER_BIN; kcoeff++)
                     {
                         output_kcoeff[ (bin*NB_K_COEFF_PER_BIN + kcoeff)*2     ] = input_kcoeff[ bin*NB_K_COEFF_PER_BIN + kcoeff ];
                         output_kcoeff[ (bin*NB_K_COEFF_PER_BIN + kcoeff)*2 + 1 ] = input_kcoeff[ bin*NB_K_COEFF_PER_BIN + kcoeff ];
                     }
                 }
             }

src/tc_load_dump_parameters.c +24 -33

             /** 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"
             Packet_TM_LFR_KCOEFFICIENTS_DUMP_t kcoefficients_dump_1;
             Packet_TM_LFR_KCOEFFICIENTS_DUMP_t kcoefficients_dump_2;
             ring_node kcoefficient_node_1;
             ring_node kcoefficient_node_2;
             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
                  *
                  *
                  */
                 parameter_dump_packet.sy_lfr_common_parameters_spare    = TC->dataAndCRC[0];
                 parameter_dump_packet.sy_lfr_common_parameters          = TC->dataAndCRC[1];
                 set_wfp_data_shaping( );
                 return LFR_SUCCESSFUL;
             }
             int action_load_normal_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** 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
                  *
                  */
                 int result;
                 int flag;
                 rtems_status_code status;
                 flag = LFR_SUCCESSFUL;
                 if ( (lfrCurrentMode == LFR_MODE_NORMAL) ||
                      (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) ) {
                     status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     flag = LFR_DEFAULT;
                 }
                 // CHECK THE PARAMETERS SET CONSISTENCY
                 if (flag == LFR_SUCCESSFUL)
                 {
                     flag = check_normal_par_consistency( TC, queue_id );
                 }
                 // SET THE PARAMETERS IF THEY ARE CONSISTENT
                 if (flag == LFR_SUCCESSFUL)
                 {
                     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 );
                 }
                 return flag;
             }
             int action_load_burst_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** 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
                  *
                  */
                 int flag;
                 rtems_status_code status;
                 unsigned char sy_lfr_b_bp_p0;
                 unsigned char sy_lfr_b_bp_p1;
                 float aux;
                 flag = LFR_SUCCESSFUL;
                 if ( lfrCurrentMode == LFR_MODE_BURST ) {
                     status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     flag = LFR_DEFAULT;
                 }
                 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 ];
                 // sy_lfr_b_bp_p0 shall not be lower than its default value
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_b_bp_p0 < DEFAULT_SY_LFR_B_BP_P0 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_B_BP_P0+10, sy_lfr_b_bp_p0 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 // sy_lfr_b_bp_p1 shall not be lower than its default value
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_b_bp_p1 < DEFAULT_SY_LFR_B_BP_P1 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_B_BP_P1+10, sy_lfr_b_bp_p1 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //****************************************************************
                 // 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);
                     if (aux > FLOAT_EQUAL_ZERO)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_B_BP_P0+10, sy_lfr_b_bp_p0 );
                         flag = LFR_DEFAULT;
                     }
                 }
                 // SET THE PARAMETERS
                 if (flag == LFR_SUCCESSFUL)
                 {
                     flag = set_sy_lfr_b_bp_p0( TC );
                     flag = set_sy_lfr_b_bp_p1( TC );
                 }
                 return flag;
             }
             int action_load_sbm1_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** 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
                  *
                  */
                 int flag;
                 rtems_status_code status;
                 unsigned char sy_lfr_s1_bp_p0;
                 unsigned char sy_lfr_s1_bp_p1;
                 float aux;
                 flag = LFR_SUCCESSFUL;
                 if ( lfrCurrentMode == LFR_MODE_SBM1 ) {
                     status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     flag = LFR_DEFAULT;
                 }
                 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 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P0+10, sy_lfr_s1_bp_p0 );
                         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 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P1+10, sy_lfr_s1_bp_p1 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //******************************************************************
                 // check the consistency between sy_lfr_s1_bp_p0 and sy_lfr_s1_bp_p1
                 if (flag == LFR_SUCCESSFUL)
                 {
                     aux = ( (float ) sy_lfr_s1_bp_p1 / (sy_lfr_s1_bp_p0*0.25) ) - floor(sy_lfr_s1_bp_p1 / (sy_lfr_s1_bp_p0*0.25));
                     if (aux > FLOAT_EQUAL_ZERO)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P0+10, sy_lfr_s1_bp_p0 );
                         flag = LFR_DEFAULT;
                     }
                 }
                 // SET THE PARAMETERS
                 if (flag == LFR_SUCCESSFUL)
                 {
                     flag = set_sy_lfr_s1_bp_p0( TC );
                     flag = set_sy_lfr_s1_bp_p1( TC );
                 }
                 return flag;
             }
             int action_load_sbm2_par(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;
                 rtems_status_code status;
                 unsigned char sy_lfr_s2_bp_p0;
                 unsigned char sy_lfr_s2_bp_p1;
                 float aux;
                 flag = LFR_SUCCESSFUL;
                 if ( lfrCurrentMode == LFR_MODE_SBM2 ) {
                     status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     flag = LFR_DEFAULT;
                 }
                 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 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S2_BP_P0+10, sy_lfr_s2_bp_p0 );
                         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 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S2_BP_P1+10, sy_lfr_s2_bp_p1 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //******************************************************************
                 // 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);
                     if (aux > FLOAT_EQUAL_ZERO)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S2_BP_P0+10, sy_lfr_s2_bp_p0 );
                         flag = LFR_DEFAULT;
                     }
                 }
                 // SET THE PARAMETERS
                 if (flag == LFR_SUCCESSFUL)
                 {
                     flag = set_sy_lfr_s2_bp_p0( TC );
                     flag = set_sy_lfr_s2_bp_p1( TC );
                 }
                 return flag;
             }
             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;
                 flag = set_sy_lfr_kcoeff( TC, queue_id );
                 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;
                 flag = set_sy_lfr_fbins( TC );
                 return flag;
             }
             int action_load_filter_par(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;
                 flag = check_sy_lfr_filter_parameters( TC, queue_id );
                 if (flag  == LFR_SUCCESSFUL)
                 {
                     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 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[0]         = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + 0 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[1]         = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + 1 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[2]         = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + 2 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[3]         = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + 3 ];
                     parameter_dump_packet.sy_lfr_pas_filter_offset          = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[0]        = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + 0 ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[1]        = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + 1 ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[2]        = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + 2 ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[3]        = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + 3 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[0]           = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + 0 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[1]           = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + 1 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[2]           = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + 2 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[3]           = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + 3 ];
                     //****************************
                     // 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;
                     set_sy_lfr_pas_filter_enabled( parameter_dump_packet.spare_sy_lfr_pas_filter_enabled & 0x01 );
                     // 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 );
                     //****************************************************
                     // store the parameter sy_lfr_sc_rw_delta_f as a float
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_sc_rw_delta_f,
                                      parameter_dump_packet.sy_lfr_sc_rw_delta_f );
                 }
                 return flag;
             }
             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
                  *
                  */
                 unsigned int address;
                 rtems_status_code status;
                 unsigned int freq;
                 unsigned int bin;
                 unsigned int coeff;
                 unsigned char *kCoeffPtr;
                 unsigned char *kCoeffDumpPtr;
                 // 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)
                 //*********
                 // PACKET 1
                 // 11 F0 bins, 13 F1 bins and 6 F2 bins
                 kcoefficients_dump_1.destinationID = TC->sourceID;
                 increment_seq_counter_destination_id_dump( kcoefficients_dump_1.packetSequenceControl, TC->sourceID );
                 for( freq=0;
                      freq<NB_BINS_COMPRESSED_SM_F0;
                      freq++ )
                 {
                     kcoefficients_dump_1.kcoeff_blks[ freq*KCOEFF_BLK_SIZE + 1] = freq;
                     bin = freq;
             //        printKCoefficients( freq, bin, k_coeff_intercalib_f0_norm);
                     for ( coeff=0; coeff<NB_K_COEFF_PER_BIN; coeff++ )
                     {
                         kCoeffDumpPtr = (unsigned char*) &kcoefficients_dump_1.kcoeff_blks[ freq*KCOEFF_BLK_SIZE + coeff*NB_BYTES_PER_FLOAT + 2 ]; // 2 for the kcoeff_frequency
                         kCoeffPtr     = (unsigned char*) &k_coeff_intercalib_f0_norm[ (bin*NB_K_COEFF_PER_BIN) + coeff ];
                         copyFloatByChar( kCoeffDumpPtr, kCoeffPtr );
                     }
                 }
                 for( freq=NB_BINS_COMPRESSED_SM_F0;
                      freq<(NB_BINS_COMPRESSED_SM_F0+NB_BINS_COMPRESSED_SM_F1);
                      freq++ )
                 {
                     kcoefficients_dump_1.kcoeff_blks[ freq*KCOEFF_BLK_SIZE + 1 ] = freq;
                     bin = freq - NB_BINS_COMPRESSED_SM_F0;
             //        printKCoefficients( freq, bin, k_coeff_intercalib_f1_norm);
                     for ( coeff=0; coeff<NB_K_COEFF_PER_BIN; coeff++ )
                     {
                         kCoeffDumpPtr = (unsigned char*) &kcoefficients_dump_1.kcoeff_blks[ freq*KCOEFF_BLK_SIZE + coeff*NB_BYTES_PER_FLOAT + 2 ]; // 2 for the kcoeff_frequency
                         kCoeffPtr     = (unsigned char*) &k_coeff_intercalib_f1_norm[ (bin*NB_K_COEFF_PER_BIN) + coeff ];
                         copyFloatByChar( kCoeffDumpPtr, kCoeffPtr );
                     }
                 }
                 for( freq=(NB_BINS_COMPRESSED_SM_F0+NB_BINS_COMPRESSED_SM_F1);
                      freq<(NB_BINS_COMPRESSED_SM_F0+NB_BINS_COMPRESSED_SM_F1+6);
                      freq++ )
                 {
                     kcoefficients_dump_1.kcoeff_blks[ freq*KCOEFF_BLK_SIZE + 1 ] = freq;
                     bin = freq - (NB_BINS_COMPRESSED_SM_F0+NB_BINS_COMPRESSED_SM_F1);
             //        printKCoefficients( freq, bin, k_coeff_intercalib_f2);
                     for ( coeff=0; coeff<NB_K_COEFF_PER_BIN; coeff++ )
                     {
                         kCoeffDumpPtr = (unsigned char*) &kcoefficients_dump_1.kcoeff_blks[ freq*KCOEFF_BLK_SIZE + coeff*NB_BYTES_PER_FLOAT + 2 ]; // 2 for the kcoeff_frequency
                         kCoeffPtr     = (unsigned char*) &k_coeff_intercalib_f2[ (bin*NB_K_COEFF_PER_BIN) + coeff ];
                         copyFloatByChar( kCoeffDumpPtr, kCoeffPtr );
                     }
                 }
                 kcoefficients_dump_1.time[0] = (unsigned char) (time_management_regs->coarse_time>>24);
                 kcoefficients_dump_1.time[1] = (unsigned char) (time_management_regs->coarse_time>>16);
                 kcoefficients_dump_1.time[2] = (unsigned char) (time_management_regs->coarse_time>>8);
                 kcoefficients_dump_1.time[3] = (unsigned char) (time_management_regs->coarse_time);
                 kcoefficients_dump_1.time[4] = (unsigned char) (time_management_regs->fine_time>>8);
                 kcoefficients_dump_1.time[5] = (unsigned char) (time_management_regs->fine_time);
                 // 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)
                 }
                  //********
                 // PACKET 2
                 // 6 F2 bins
                 kcoefficients_dump_2.destinationID = TC->sourceID;
                 increment_seq_counter_destination_id_dump( kcoefficients_dump_2.packetSequenceControl, TC->sourceID );
                 for( freq=0; freq<6; freq++ )
                 {
                     kcoefficients_dump_2.kcoeff_blks[ freq*KCOEFF_BLK_SIZE + 1 ] = NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1 + 6 + freq;
                     bin = freq + 6;
             //        printKCoefficients( freq, bin, k_coeff_intercalib_f2);
                     for ( coeff=0; coeff<NB_K_COEFF_PER_BIN; coeff++ )
                     {
                         kCoeffDumpPtr = (unsigned char*) &kcoefficients_dump_2.kcoeff_blks[ freq*KCOEFF_BLK_SIZE + coeff*NB_BYTES_PER_FLOAT + 2 ]; // 2 for the kcoeff_frequency
                         kCoeffPtr     = (unsigned char*) &k_coeff_intercalib_f2[ (bin*NB_K_COEFF_PER_BIN) + coeff ];
                         copyFloatByChar( kCoeffDumpPtr, kCoeffPtr );
                     }
                 }
                 kcoefficients_dump_2.time[0] = (unsigned char) (time_management_regs->coarse_time>>24);
                 kcoefficients_dump_2.time[1] = (unsigned char) (time_management_regs->coarse_time>>16);
                 kcoefficients_dump_2.time[2] = (unsigned char) (time_management_regs->coarse_time>>8);
                 kcoefficients_dump_2.time[3] = (unsigned char) (time_management_regs->coarse_time);
                 kcoefficients_dump_2.time[4] = (unsigned char) (time_management_regs->fine_time>>8);
                 kcoefficients_dump_2.time[5] = (unsigned char) (time_management_regs->fine_time);
                 // 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;
             }
             int action_dump_par( ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
             {
                 /** 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;
                 increment_seq_counter_destination_id_dump( parameter_dump_packet.packetSequenceControl, TC->sourceID );
                 parameter_dump_packet.destinationID = TC->sourceID;
                 // UPDATE TIME
                 parameter_dump_packet.time[0] = (unsigned char) (time_management_regs->coarse_time>>24);
                 parameter_dump_packet.time[1] = (unsigned char) (time_management_regs->coarse_time>>16);
                 parameter_dump_packet.time[2] = (unsigned char) (time_management_regs->coarse_time>>8);
                 parameter_dump_packet.time[3] = (unsigned char) (time_management_regs->coarse_time);
                 parameter_dump_packet.time[4] = (unsigned char) (time_management_regs->fine_time>>8);
                 parameter_dump_packet.time[5] = (unsigned char) (time_management_regs->fine_time);
                 // 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
             int check_normal_par_consistency( ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
             {
                 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 ];
                 sy_lfr_n_swf_l = msb * 256 + lsb;
                 msb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_P ];
                 lsb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_SWF_P+1 ];
                 sy_lfr_n_swf_p = msb * 256  + lsb;
                 msb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_ASM_P ];
                 lsb = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_ASM_P+1 ];
                 sy_lfr_n_asm_p = msb * 256  + lsb;
                 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
                 if (sy_lfr_n_swf_l != 2048)
                 {
                     status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_SWF_L+10, sy_lfr_n_swf_l );
                     flag = WRONG_APP_DATA;
                 }
                 // sy_lfr_n_swf_p
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( sy_lfr_n_swf_p < 22 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_SWF_P+10, sy_lfr_n_swf_p );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 // sy_lfr_n_bp_p0
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_n_bp_p0 < DFLT_SY_LFR_N_BP_P0)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_BP_P0+10, sy_lfr_n_bp_p0 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 // sy_lfr_n_asm_p
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_n_asm_p == 0)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_ASM_P+10, sy_lfr_n_asm_p );
                         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);
                     if (aux > FLOAT_EQUAL_ZERO)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_ASM_P+10, sy_lfr_n_asm_p );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 // sy_lfr_n_bp_p1
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_n_bp_p1 < DFLT_SY_LFR_N_BP_P1)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_BP_P1+10, sy_lfr_n_bp_p1 );
                         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);
                     if (aux > FLOAT_EQUAL_ZERO)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_BP_P1+10, sy_lfr_n_bp_p1 );
                         flag = LFR_DEFAULT;
                     }
                 }
                 // sy_lfr_n_cwf_long_f3
                 return flag;
             }
             int set_sy_lfr_n_swf_l( ccsdsTelecommandPacket_t *TC )
             {
                 /** 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;
                 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 ];
                 return result;
             }
             int set_sy_lfr_n_swf_p(ccsdsTelecommandPacket_t *TC )
             {
                 /** 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;
                 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 ];
                 return result;
             }
             int set_sy_lfr_n_asm_p( ccsdsTelecommandPacket_t *TC )
             {
                 /** This function sets the time between two full spectral matrices transmission, in s (SY_LFR_N_ASM_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;
                 result = LFR_SUCCESSFUL;
                 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 ];
                 return result;
             }
             int set_sy_lfr_n_bp_p0( ccsdsTelecommandPacket_t *TC )
             {
                 /** This function sets the time between two basic parameter sets, in s (DFLT_SY_LFR_N_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;
                 parameter_dump_packet.sy_lfr_n_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_BP_P0 ];
                 return status;
             }
             int set_sy_lfr_n_bp_p1(ccsdsTelecommandPacket_t *TC )
             {
                 /** 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;
                 parameter_dump_packet.sy_lfr_n_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_BP_P1 ];
                 return status;
             }
             int set_sy_lfr_n_cwf_long_f3(ccsdsTelecommandPacket_t *TC )
             {
                 /** 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;
                 parameter_dump_packet.sy_lfr_n_cwf_long_f3 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_N_CWF_LONG_F3 ];
                 return status;
             }
             //**********************
             // BURST MODE PARAMETERS
             int set_sy_lfr_b_bp_p0(ccsdsTelecommandPacket_t *TC)
             {
                 /** 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;
                 parameter_dump_packet.sy_lfr_b_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P0 ];
                 return status;
             }
             int set_sy_lfr_b_bp_p1( ccsdsTelecommandPacket_t *TC )
             {
                 /** 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;
                 parameter_dump_packet.sy_lfr_b_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P1 ];
                 return status;
             }
             //*********************
             // SBM1 MODE PARAMETERS
             int set_sy_lfr_s1_bp_p0( ccsdsTelecommandPacket_t *TC )
             {
                 /** 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;
                 parameter_dump_packet.sy_lfr_s1_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S1_BP_P0 ];
                 return status;
             }
             int set_sy_lfr_s1_bp_p1( ccsdsTelecommandPacket_t *TC )
             {
                 /** 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;
                 parameter_dump_packet.sy_lfr_s1_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S1_BP_P1 ];
                 return status;
             }
             //*********************
             // SBM2 MODE PARAMETERS
             int set_sy_lfr_s2_bp_p0( ccsdsTelecommandPacket_t *TC )
             {
                 /** 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;
                 parameter_dump_packet.sy_lfr_s2_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P0 ];
                 return status;
             }
             int set_sy_lfr_s2_bp_p1( ccsdsTelecommandPacket_t *TC )
             {
                 /** 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;
                 parameter_dump_packet.sy_lfr_s2_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P1 ];
                 return status;
             }
             //*******************
             // TC_LFR_UPDATE_INFO
             unsigned int check_update_info_hk_lfr_mode( unsigned char mode )
             {
                 unsigned int status;
                 if ( (mode == LFR_MODE_STANDBY) || (mode == LFR_MODE_NORMAL)
                      || (mode == LFR_MODE_BURST)
                      || (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;
                 if ( (mode == TDS_MODE_STANDBY) || (mode == TDS_MODE_NORMAL)
                      || (mode == TDS_MODE_BURST)
                      || (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;
                 if ( (mode == THR_MODE_STANDBY) || (mode == THR_MODE_NORMAL)
                      || (mode == THR_MODE_BURST))
                 {
                     status = LFR_SUCCESSFUL;
                 }
                 else
                 {
                     status = LFR_DEFAULT;
                 }
                 return status;
             }
             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;
                 // cp_rpw_sc_rw1_f1
                 copyFloatByChar( (unsigned char*) &cp_rpw_sc_rw1_f1,
                                  (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F1 ] );
                 // cp_rpw_sc_rw1_f2
                 copyFloatByChar( (unsigned char*) &cp_rpw_sc_rw1_f2,
                                  (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F2 ] );
                 // cp_rpw_sc_rw2_f1
                 copyFloatByChar( (unsigned char*) &cp_rpw_sc_rw2_f1,
                                  (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F1 ] );
                 // cp_rpw_sc_rw2_f2
                 copyFloatByChar( (unsigned char*) &cp_rpw_sc_rw2_f2,
                                  (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F2 ] );
                 // cp_rpw_sc_rw3_f1
                 copyFloatByChar( (unsigned char*) &cp_rpw_sc_rw3_f1,
                                  (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F1 ] );
                 // cp_rpw_sc_rw3_f2
                 copyFloatByChar( (unsigned char*) &cp_rpw_sc_rw3_f2,
                                  (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F2 ] );
                 // cp_rpw_sc_rw4_f1
                 copyFloatByChar( (unsigned char*) &cp_rpw_sc_rw4_f1,
                                  (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F1 ] );
                 // cp_rpw_sc_rw4_f2
                 copyFloatByChar( (unsigned char*) &cp_rpw_sc_rw4_f2,
                                  (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F2 ] );
             }
             void setFBinMask( unsigned char *fbins_mask, float rw_f, unsigned char deltaFreq, unsigned char flag )
             {
                 /** This function executes specific actions when a TC_LFR_UPDATE_INFO TeleCommand has been received.
                  *
                  * @param fbins_mask
                  * @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
                  * @param flag [true] filtering enabled [false] filtering disabled
                  *
                  * @return void
                  *
                  */
                 float f_RW_min;
                 float f_RW_MAX;
                 float fi_min;
                 float fi_MAX;
                 float fi;
                 float deltaBelow;
                 float deltaAbove;
                 int binBelow;
                 int binAbove;
                 int closestBin;
                 unsigned int whichByte;
                 int selectedByte;
                 int bin;
                 int binToRemove[3];
                 int k;
                 whichByte = 0;
                 bin = 0;
                 binToRemove[0] = -1;
                 binToRemove[1] = -1;
                 binToRemove[2] = -1;
                 // compute the frequency range to filter [ rw_f - delta_f/2; rw_f + delta_f/2 ]
                 f_RW_min = rw_f - filterPar.sy_lfr_sc_rw_delta_f / 2.;
                 f_RW_MAX = rw_f + filterPar.sy_lfr_sc_rw_delta_f / 2.;
                 // compute the index of the frequency bin immediately below rw_f
                 binBelow = (int) ( floor( ((double) rw_f) / ((double) deltaFreq)) );
                 deltaBelow = rw_f - binBelow * deltaFreq;
                 // compute the index of the frequency bin immediately above rw_f
                 binAbove = (int) ( ceil(  ((double) rw_f) / ((double) deltaFreq)) );
                 deltaAbove = binAbove * deltaFreq - rw_f;
                 // search the closest bin
                 if (deltaAbove > deltaBelow)
                 {
                     closestBin = binBelow;
                 }
                 else
                 {
                     closestBin = binAbove;
                 }
-                // compute the fi interval [fi - Delta_f * 0.285, fi + Delta_f * 0.285]
+                // compute the fi interval [fi - deltaFreq * 0.285, fi + deltaFreq * 0.285]
                 fi = closestBin * deltaFreq;
                 fi_min = fi - (deltaFreq * 0.285);
-                if ( fi_min < 0 )
+                fi_MAX = fi + (deltaFreq * 0.285);
-                    fi_min = 0;
-                else if ( fi_min > (deltaFreq * 127) )
-                    fi_min = -1;
-                fi_MAX = fi + (deltaFreq * 0.285);
+                //**************************************************************************************
-                if ( fi_MAX > (deltaFreq*127) )
+                // 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
-                    fi_MAX = -1;
+                //**************************************************************************************
                 // 1. IF [ f_RW_min, f_RW_MAX] is included in [ fi_min; fi_MAX ]
                 // => remove f_(i), f_(i-1) and f_(i+1)
                 if ( ( f_RW_min > fi_min ) && ( f_RW_MAX < fi_MAX ) )
                 {
-                    binToRemove[0] = closestBin - 1;
+                    binToRemove[0] = (closestBin - 1) - 1;
-                    binToRemove[1] = closestBin;
+                    binToRemove[1] = (closestBin)     - 1;
-                    binToRemove[2] = closestBin + 1;
+                    binToRemove[2] = (closestBin + 1) - 1;
                 }
                 // 2. ELSE
                 // => remove the two f_(i) which are around f_RW
                 else
                 {
-                    binToRemove[0] = binBelow;
+                    binToRemove[0] = (binBelow) - 1;
-                    binToRemove[1] = binAbove;
+                    binToRemove[1] = (binAbove) - 1;
-                    binToRemove[2] = -1;
+                    binToRemove[2] = (-1);
                 }
                 for (k = 0; k < 3; k++)
                 {
                     bin = binToRemove[k];
                     if ( (bin >= 0) && (bin <= 127) )
                     {
                         if (flag == 1)
                         {
                             whichByte = (bin >> 3);    // division by 8
                             selectedByte = ( 1 << (bin - (whichByte * 8)) );
                             fbins_mask[15 - whichByte] = fbins_mask[15 - whichByte] & ((unsigned char) (~selectedByte)); // bytes are ordered MSB first in the packets
                         }
                     }
                 }
             }
             void build_sy_lfr_rw_mask( unsigned int channel )
             {
                 unsigned char local_rw_fbins_mask[16];
                 unsigned char *maskPtr;
                 double deltaF;
                 unsigned k;
                 k = 0;
                 maskPtr = NULL;
                 deltaF = 1.;
                 switch (channel)
                 {
                 case 0:
-                    maskPtr = parameter_dump_packet.sy_lfr_rw_mask_f0_word1;
+                    maskPtr = parameter_dump_packet.sy_lfr_rw_mask.fx.f0_word1;
                     deltaF = 96.;
                     break;
                 case 1:
-                    maskPtr = parameter_dump_packet.sy_lfr_rw_mask_f1_word1;
+                    maskPtr = parameter_dump_packet.sy_lfr_rw_mask.fx.f1_word1;
                     deltaF = 16.;
                     break;
                 case 2:
-                    maskPtr = parameter_dump_packet.sy_lfr_rw_mask_f2_word1;
+                    maskPtr = parameter_dump_packet.sy_lfr_rw_mask.fx.f2_word1;
                     deltaF = 1.;
                     break;
                 default:
                     break;
                 }
                 for (k = 0; k < 16; k++)
                 {
                     local_rw_fbins_mask[k] = 0xff;
                 }
                 // RW1 F1
                 setFBinMask( local_rw_fbins_mask, cp_rpw_sc_rw1_f1, deltaF, (cp_rpw_sc_rw_f_flags & 0x80) >> 7 );   // [1000 0000]
                 // RW1 F2
                 setFBinMask( local_rw_fbins_mask, cp_rpw_sc_rw1_f2, deltaF, (cp_rpw_sc_rw_f_flags & 0x40) >> 6 );   // [0100 0000]
                 // RW2 F1
                 setFBinMask( local_rw_fbins_mask, cp_rpw_sc_rw2_f1, deltaF, (cp_rpw_sc_rw_f_flags & 0x20) >> 5 );   // [0010 0000]
                 // RW2 F2
                 setFBinMask( local_rw_fbins_mask, cp_rpw_sc_rw2_f2, deltaF, (cp_rpw_sc_rw_f_flags & 0x10) >> 4 );   // [0001 0000]
                 // RW3 F1
                 setFBinMask( local_rw_fbins_mask, cp_rpw_sc_rw3_f1, deltaF, (cp_rpw_sc_rw_f_flags & 0x08) >> 3 );   // [0000 1000]
                 // RW3 F2
                 setFBinMask( local_rw_fbins_mask, cp_rpw_sc_rw3_f2, deltaF, (cp_rpw_sc_rw_f_flags & 0x04) >> 2 );   // [0000 0100]
                 // RW4 F1
                 setFBinMask( local_rw_fbins_mask, cp_rpw_sc_rw4_f1, deltaF, (cp_rpw_sc_rw_f_flags & 0x02) >> 1 );   // [0000 0010]
                 // RW4 F2
                 setFBinMask( local_rw_fbins_mask, cp_rpw_sc_rw4_f2, deltaF, (cp_rpw_sc_rw_f_flags & 0x01)       );  // [0000 0001]
                 // update the value of the fbins related to reaction wheels frequency filtering
                 if (maskPtr != NULL)
                 {
                     for (k = 0; k < 16; k++)
                     {
                         maskPtr[k] = local_rw_fbins_mask[k];
                     }
                 }
             }
             void build_sy_lfr_rw_masks( void )
             {
                 build_sy_lfr_rw_mask( 0 );
                 build_sy_lfr_rw_mask( 1 );
                 build_sy_lfr_rw_mask( 2 );
                 merge_fbins_masks();
             }
             void merge_fbins_masks( void )
             {
                 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;
-                fbins_f0 = parameter_dump_packet.sy_lfr_fbins_f0_word1;
+                fbins_f0 = parameter_dump_packet.sy_lfr_fbins.fx.f0_word1;
-                fbins_f1 = parameter_dump_packet.sy_lfr_fbins_f1_word1;
+                fbins_f1 = parameter_dump_packet.sy_lfr_fbins.fx.f1_word1;
-                fbins_f2 = parameter_dump_packet.sy_lfr_fbins_f2_word1;
+                fbins_f2 = parameter_dump_packet.sy_lfr_fbins.fx.f2_word1;
-                rw_mask_f0 = parameter_dump_packet.sy_lfr_rw_mask_f0_word1;
+                rw_mask_f0 = parameter_dump_packet.sy_lfr_rw_mask.fx.f0_word1;
-                rw_mask_f1 = parameter_dump_packet.sy_lfr_rw_mask_f1_word1;
+                rw_mask_f1 = parameter_dump_packet.sy_lfr_rw_mask.fx.f1_word1;
-                rw_mask_f2 = parameter_dump_packet.sy_lfr_rw_mask_f2_word1;
+                rw_mask_f2 = parameter_dump_packet.sy_lfr_rw_mask.fx.f2_word1;
                 for( k=0; k < 16; k++ )
                 {
                     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];
                 }
             }
             //***********
             // 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;
-                fbins_mask_dump = parameter_dump_packet.sy_lfr_fbins_f0_word1;
+                fbins_mask_dump = parameter_dump_packet.sy_lfr_fbins.raw;
                 fbins_mask_TC = TC->dataAndCRC;
                 for (k=0; k < NB_FBINS_MASKS * NB_BYTES_PER_FBINS_MASK; k++)
                 {
                     fbins_mask_dump[k] = fbins_mask_TC[k];
                 }
                 return status;
             }
             //***************************
             // TC_LFR_LOAD_PAS_FILTER_PAR
             int check_sy_lfr_filter_parameters( ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
             {
                 int flag;
                 rtems_status_code status;
                 unsigned char sy_lfr_pas_filter_enabled;
                 unsigned char sy_lfr_pas_filter_modulus;
                 float sy_lfr_pas_filter_tbad;
                 unsigned char sy_lfr_pas_filter_offset;
                 float sy_lfr_pas_filter_shift;
                 float sy_lfr_sc_rw_delta_f;
                 char *parPtr;
                 flag = LFR_SUCCESSFUL;
                 sy_lfr_pas_filter_tbad  = 0.0;
                 sy_lfr_pas_filter_shift = 0.0;
                 sy_lfr_sc_rw_delta_f    = 0.0;
                 parPtr = NULL;
                 //***************
                 // get parameters
                 sy_lfr_pas_filter_enabled   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_ENABLED ] & 0x01;   // [0000 0001]
                 sy_lfr_pas_filter_modulus   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS ];
                 copyFloatByChar(
                             (unsigned char*) &sy_lfr_pas_filter_tbad,
                             (unsigned char*) &TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD ]
                             );
                 sy_lfr_pas_filter_offset    = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET ];
                 copyFloatByChar(
                             (unsigned char*) &sy_lfr_pas_filter_shift,
                             (unsigned char*) &TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT ]
                             );
                 copyFloatByChar(
                             (unsigned char*) &sy_lfr_sc_rw_delta_f,
                             (unsigned char*) &TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F ]
                             );
                 //******************
                 // CHECK CONSISTENCY
                 //**************************
                 // sy_lfr_pas_filter_enabled
                 // nothing to check, value is 0 or 1
                 //**************************
                 // sy_lfr_pas_filter_modulus
                 if ( (sy_lfr_pas_filter_modulus < 4) || (sy_lfr_pas_filter_modulus > 8) )
                 {
                     status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS+10, sy_lfr_pas_filter_modulus );
                     flag = WRONG_APP_DATA;
                 }
                 //***********************
                 // sy_lfr_pas_filter_tbad
                 if ( (sy_lfr_pas_filter_tbad < 0.0) || (sy_lfr_pas_filter_tbad > 4.0) )
                 {
                     parPtr = (char*) &sy_lfr_pas_filter_tbad;
                     status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD+10, parPtr[3] );
                     flag = WRONG_APP_DATA;
                 }
                 //*************************
                 // sy_lfr_pas_filter_offset
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( (sy_lfr_pas_filter_offset < 0) || (sy_lfr_pas_filter_offset > 7) )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET+10, sy_lfr_pas_filter_offset );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //************************
                 // sy_lfr_pas_filter_shift
                 if ( (sy_lfr_pas_filter_shift < 0.0) || (sy_lfr_pas_filter_shift > 1.0) )
                 {
                     parPtr = (char*) &sy_lfr_pas_filter_shift;
                     status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT+10, parPtr[3] );
                     flag = WRONG_APP_DATA;
                 }
                 //*********************
                 // sy_lfr_sc_rw_delta_f
                 // nothing to check, no default value in the ICD
                 return flag;
             }
             //**************
             // KCOEFFICIENTS
             int set_sy_lfr_kcoeff( ccsdsTelecommandPacket_t *TC,rtems_id queue_id )
             {
                 unsigned int kcoeff;
                 unsigned short sy_lfr_kcoeff_frequency;
                 unsigned short bin;
                 unsigned short *freqPtr;
                 float *kcoeffPtr_norm;
                 float *kcoeffPtr_sbm;
                 int status;
                 unsigned char *kcoeffLoadPtr;
                 unsigned char *kcoeffNormPtr;
                 unsigned char *kcoeffSbmPtr_a;
                 unsigned char *kcoeffSbmPtr_b;
                 status = LFR_SUCCESSFUL;
                 kcoeffPtr_norm = NULL;
                 kcoeffPtr_sbm  = NULL;
                 bin = 0;
                 freqPtr = (unsigned short *) &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY];
                 sy_lfr_kcoeff_frequency = *freqPtr;
                 if ( sy_lfr_kcoeff_frequency >= NB_BINS_COMPRESSED_SM )
                 {
                     PRINTF1("ERR *** in set_sy_lfr_kcoeff_frequency *** sy_lfr_kcoeff_frequency = %d\n", sy_lfr_kcoeff_frequency)
                     status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY + 10 + 1,
                                                               TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY + 1]  ); // +1 to get the LSB instead of the MSB
                     status = LFR_DEFAULT;
                 }
                 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);
                     }
                 }
                 if (kcoeffPtr_norm != NULL )    // update K coefficient for NORMAL data products
                 {
                     for (kcoeff=0; kcoeff<NB_K_COEFF_PER_BIN; kcoeff++)
                     {
                         // destination
                         kcoeffNormPtr = (unsigned char*) &kcoeffPtr_norm[ (bin * NB_K_COEFF_PER_BIN) + kcoeff ];
                         // source
                         kcoeffLoadPtr = (unsigned char*) &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_1 + NB_BYTES_PER_FLOAT * kcoeff];
                         // copy source to destination
                         copyFloatByChar( kcoeffNormPtr,  kcoeffLoadPtr );
                     }
                 }
                 if (kcoeffPtr_sbm != NULL )     // update K coefficient for SBM data products
                 {
                     for (kcoeff=0; kcoeff<NB_K_COEFF_PER_BIN; kcoeff++)
                     {
                         // destination
                         kcoeffSbmPtr_a= (unsigned char*) &kcoeffPtr_sbm[ ( (bin * NB_K_COEFF_PER_BIN) + kcoeff) * 2     ];
                         kcoeffSbmPtr_b= (unsigned char*) &kcoeffPtr_sbm[ ( (bin * NB_K_COEFF_PER_BIN) + kcoeff) * 2 + 1 ];
                         // source
                         kcoeffLoadPtr = (unsigned char*) &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_1 + NB_BYTES_PER_FLOAT * kcoeff];
                         // copy source to destination
                         copyFloatByChar( kcoeffSbmPtr_a, kcoeffLoadPtr );
                         copyFloatByChar( kcoeffSbmPtr_b, kcoeffLoadPtr );
                     }
                 }
             //    print_k_coeff();
                 return status;
             }
             void copyFloatByChar( unsigned char *destination, unsigned char *source )
             {
                 destination[0] = source[0];
                 destination[1] = source[1];
                 destination[2] = source[2];
                 destination[3] = source[3];
             }
             void floatToChar( float value, unsigned char* ptr)
             {
                 unsigned char* valuePtr;
                 valuePtr = (unsigned char*) &value;
                 ptr[0] = valuePtr[0];
                 ptr[1] = valuePtr[1];
                 ptr[2] = valuePtr[2];
                 ptr[3] = valuePtr[3];
             }
             //**********
             // init dump
             void init_parameter_dump( void )
             {
                 /** This function initialize the parameter_dump_packet global variable with default values.
                  *
                  */
                 unsigned int k;
                 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;
                 parameter_dump_packet.packetID[0] = (unsigned char) (APID_TM_PARAMETER_DUMP >> 8);
                 parameter_dump_packet.packetID[1] = (unsigned char) APID_TM_PARAMETER_DUMP;
                 parameter_dump_packet.packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 parameter_dump_packet.packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
                 parameter_dump_packet.packetLength[0] = (unsigned char) (PACKET_LENGTH_PARAMETER_DUMP >> 8);
                 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;
                 parameter_dump_packet.time[0] = (unsigned char) (time_management_regs->coarse_time>>24);
                 parameter_dump_packet.time[1] = (unsigned char) (time_management_regs->coarse_time>>16);
                 parameter_dump_packet.time[2] = (unsigned char) (time_management_regs->coarse_time>>8);
                 parameter_dump_packet.time[3] = (unsigned char) (time_management_regs->coarse_time);
                 parameter_dump_packet.time[4] = (unsigned char) (time_management_regs->fine_time>>8);
                 parameter_dump_packet.time[5] = (unsigned char) (time_management_regs->fine_time);
                 parameter_dump_packet.sid = SID_PARAMETER_DUMP;
                 //******************
                 // COMMON PARAMETERS
                 parameter_dump_packet.sy_lfr_common_parameters_spare    = DEFAULT_SY_LFR_COMMON0;
                 parameter_dump_packet.sy_lfr_common_parameters          = DEFAULT_SY_LFR_COMMON1;
                 //******************
                 // NORMAL PARAMETERS
                 parameter_dump_packet.sy_lfr_n_swf_l[0] = (unsigned char) (DFLT_SY_LFR_N_SWF_L >> 8);
                 parameter_dump_packet.sy_lfr_n_swf_l[1] = (unsigned char) (DFLT_SY_LFR_N_SWF_L     );
                 parameter_dump_packet.sy_lfr_n_swf_p[0] = (unsigned char) (DFLT_SY_LFR_N_SWF_P >> 8);
                 parameter_dump_packet.sy_lfr_n_swf_p[1] = (unsigned char) (DFLT_SY_LFR_N_SWF_P     );
                 parameter_dump_packet.sy_lfr_n_asm_p[0] = (unsigned char) (DFLT_SY_LFR_N_ASM_P >> 8);
                 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;
                 //*****************
                 // 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;
                 //************
                 // FBINS MASKS
                 for (k=0; k < NB_FBINS_MASKS * NB_BYTES_PER_FBINS_MASK; k++)
                 {
-                    parameter_dump_packet.sy_lfr_fbins_f0_word1[k] = 0xff;
+                    parameter_dump_packet.sy_lfr_fbins.raw[k] = 0xff;
                 }
                 // PAS FILTER PARAMETERS
                 parameter_dump_packet.pa_rpw_spare8_2                   = 0x00;
                 parameter_dump_packet.spare_sy_lfr_pas_filter_enabled   = 0x00;
                 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 );
                 // LFR_RW_MASK
                 for (k=0; k < NB_FBINS_MASKS * NB_BYTES_PER_FBINS_MASK; k++)
                 {
-                    parameter_dump_packet.sy_lfr_rw_mask_f0_word1[k] = 0xff;
+                    parameter_dump_packet.sy_lfr_rw_mask.raw[k] = 0xff;
                 }
             }
             void init_kcoefficients_dump( void )
             {
                 init_kcoefficients_dump_packet( &kcoefficients_dump_1, 1, 30 );
                 init_kcoefficients_dump_packet( &kcoefficients_dump_2, 2, 6  );
                 kcoefficient_node_1.previous = NULL;
                 kcoefficient_node_1.next = NULL;
                 kcoefficient_node_1.sid = TM_CODE_K_DUMP;
                 kcoefficient_node_1.coarseTime = 0x00;
                 kcoefficient_node_1.fineTime = 0x00;
                 kcoefficient_node_1.buffer_address = (int) &kcoefficients_dump_1;
                 kcoefficient_node_1.status = 0x00;
                 kcoefficient_node_2.previous = NULL;
                 kcoefficient_node_2.next = NULL;
                 kcoefficient_node_2.sid = TM_CODE_K_DUMP;
                 kcoefficient_node_2.coarseTime = 0x00;
                 kcoefficient_node_2.fineTime = 0x00;
                 kcoefficient_node_2.buffer_address = (int) &kcoefficients_dump_2;
                 kcoefficient_node_2.status = 0x00;
             }
             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;
                 packetLength = blk_nr * 130 + 20 - CCSDS_TC_TM_PACKET_OFFSET; // 4 bytes for the CCSDS header
                 kcoefficients_dump->targetLogicalAddress = CCSDS_DESTINATION_ID;
                 kcoefficients_dump->protocolIdentifier = CCSDS_PROTOCOLE_ID;
                 kcoefficients_dump->reserved = CCSDS_RESERVED;
                 kcoefficients_dump->userApplication = CCSDS_USER_APP;
                 kcoefficients_dump->packetID[0] = (unsigned char) (APID_TM_PARAMETER_DUMP >> 8);;
                 kcoefficients_dump->packetID[1] = (unsigned char) APID_TM_PARAMETER_DUMP;;
                 kcoefficients_dump->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 kcoefficients_dump->packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
                 kcoefficients_dump->packetLength[0] = (unsigned char) (packetLength >> 8);
                 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;
                 kcoefficients_dump->time[0] = 0x00;
                 kcoefficients_dump->time[1] = 0x00;
                 kcoefficients_dump->time[2] = 0x00;
                 kcoefficients_dump->time[3] = 0x00;
                 kcoefficients_dump->time[4] = 0x00;
                 kcoefficients_dump->time[5] = 0x00;
                 kcoefficients_dump->sid = SID_K_DUMP;
                 kcoefficients_dump->pkt_cnt = 2;
                 kcoefficients_dump->pkt_nr = pkt_nr;
                 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)
                 for (k=0; k<3900; k++)
                 {
                     kcoefficients_dump->kcoeff_blks[k] = 0x00;
                 }
             }
             void increment_seq_counter_destination_id_dump( unsigned char *packet_sequence_control, unsigned char destination_id )
             {
                 /** 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.
                  *
                  */
                 unsigned short sequence_cnt;
                 unsigned short segmentation_grouping_flag;
                 unsigned short new_packet_sequence_control;
                 unsigned char i;
                 switch (destination_id)
                 {
                 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;
                 }
                 segmentation_grouping_flag  = TM_PACKET_SEQ_CTRL_STANDALONE << 8;
                 sequence_cnt                = sequenceCounters_TM_DUMP[ i ] & 0x3fff;
                 new_packet_sequence_control = segmentation_grouping_flag | sequence_cnt ;
                 packet_sequence_control[0] = (unsigned char) (new_packet_sequence_control >> 8);
                 packet_sequence_control[1] = (unsigned char) (new_packet_sequence_control     );
                 // increment the sequence counter
                 if ( sequenceCounters_TM_DUMP[ i ] < SEQ_CNT_MAX )
                 {
                     sequenceCounters_TM_DUMP[ i ] = sequenceCounters_TM_DUMP[ i ] + 1;
                 }
                 else
                 {
                     sequenceCounters_TM_DUMP[ i ] = 0;
                 }
             }

General Comments 0

Write
Preview

You need to be logged in to leave comments. Login now

No TODOs yet

	Site-wide shortcuts
/	Use quick search box
g h	Goto home page
g g	Goto my private gists page
g G	Goto my public gists page
g 0-9	Goto bookmarked items from 0-9
n r	New repository page
n g	New gist page

	Repositories
g s	Goto summary page
g c	Goto changelog page
g f	Goto files page
g F	Goto files page with file search activated
g p	Goto pull requests page
g o	Goto repository settings
g O	Goto repository access permissions settings
t s	Toggle sidebar on some pages