HG_REPOSITORIES/LPP/INSTRUMENTATION/USERS/JEANDET/LFR_FSW Commit - r355:c502a62ca98f

modulus, tbad, offset, shift are stored in finetime (uint64_t)...

paul -

r355:c502a62ca98f R3++

parent child

Context file:

r355:c502a62ca98f

Collapse all files

.hgsubstate +1 -1

@@ -1,2 +1,2
1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters	1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters
2	26659466eb11170e587645c796142ac8a7fd0add header/lfr_common_headers	2	e904b329ff977514bf36af92617afefd22fd06ab header/lfr_common_headers

src/fsw_init.c +5 -3

             /** This is the RTEMS initialization module.
              *
              * @file
              * @author P. LEROY
              *
              * This module contains two very different information:
              * - specific instructions to configure the compilation of the RTEMS executive
              * - functions related to the fligth softwre initialization, especially the INIT RTEMS task
              *
              */
             //*************************
             // GPL reminder to be added
             //*************************
             #include <rtems.h>
             /* configuration information */
             #define CONFIGURE_INIT
             #include <bsp.h> /* for device driver prototypes */
             /* configuration information */
             #define CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
             #define CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
             #define CONFIGURE_MAXIMUM_TASKS 21 // number of tasks concurrently active including INIT
             #define CONFIGURE_RTEMS_INIT_TASKS_TABLE
             #define CONFIGURE_EXTRA_TASK_STACKS (3 * RTEMS_MINIMUM_STACK_SIZE)
             #define CONFIGURE_LIBIO_MAXIMUM_FILE_DESCRIPTORS 32
             #define CONFIGURE_INIT_TASK_PRIORITY 1 // instead of 100
             #define CONFIGURE_INIT_TASK_MODE (RTEMS_DEFAULT_MODES | RTEMS_NO_PREEMPT)
             #define CONFIGURE_INIT_TASK_ATTRIBUTES (RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT)
             #define CONFIGURE_MAXIMUM_DRIVERS 16
             #define CONFIGURE_MAXIMUM_PERIODS 6 // [hous] [load] [avgv]
             #define CONFIGURE_MAXIMUM_TIMERS 6 // [spiq] [link] [spacewire_reset_link]
             #define CONFIGURE_MAXIMUM_MESSAGE_QUEUES 5
             #ifdef PRINT_STACK_REPORT
                 #define CONFIGURE_STACK_CHECKER_ENABLED
             #endif
             #include <rtems/confdefs.h>
             /* If --drvmgr was enabled during the configuration of the RTEMS kernel */
             #ifdef RTEMS_DRVMGR_STARTUP
             #ifdef LEON3
             /* Add Timer and UART Driver */
             #ifdef CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
             #define CONFIGURE_DRIVER_AMBAPP_GAISLER_GPTIMER
             #endif
             #ifdef CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
             #define CONFIGURE_DRIVER_AMBAPP_GAISLER_APBUART
             #endif
             #endif
             #define CONFIGURE_DRIVER_AMBAPP_GAISLER_GRSPW   /* GRSPW Driver */
             #include <drvmgr/drvmgr_confdefs.h>
             #endif
             #include "fsw_init.h"
             #include "fsw_config.c"
             #include "GscMemoryLPP.hpp"
             void initCache()
             {
                 // ASI 2 contains a few control registers that have not been assigned as ancillary state registers.
                 // These should only be read and written using 32-bit LDA/STA instructions.
                 // All cache registers are accessed through load/store operations to the alternate address space (LDA/STA), using ASI = 2.
                 // The table below shows the register addresses:
                 //      0x00 Cache control register
                 //      0x04 Reserved
                 //      0x08 Instruction cache configuration register
                 //      0x0C Data cache configuration register
                 // Cache Control Register Leon3 / Leon3FT
                 // 31..30  29   28  27..24  23  22  21  20..19  18  17  16
                 //         RFT  PS  TB      DS  FD  FI  FT          ST  IB
                 // 15  14  13..12  11..10  9..8  7..6  5   4   3..2  1..0
                 // IP  DP  ITE     IDE     DTE   DDE   DF  IF  DCS   ICS
                 unsigned int cacheControlRegister;
                 CCR_resetCacheControlRegister();
                 ASR16_resetRegisterProtectionControlRegister();
                 cacheControlRegister = CCR_getValue();
                 PRINTF1("(0) CCR - Cache Control Register = %x\n", cacheControlRegister);
                 PRINTF1("(0) ASR16                        = %x\n", *asr16Ptr);
                 CCR_enableInstructionCache();       // ICS bits
                 CCR_enableDataCache();              // DCS bits
                 CCR_enableInstructionBurstFetch();  // IB  bit
                 faultTolerantScheme();
                 cacheControlRegister = CCR_getValue();
                 PRINTF1("(1) CCR - Cache Control Register = %x\n", cacheControlRegister);
                 PRINTF1("(1) ASR16 Register protection control register = %x\n", *asr16Ptr);
                 PRINTF("\n");
             }
             rtems_task Init( rtems_task_argument ignored )
             {
                 /** This is the RTEMS INIT taks, it is the first task launched by the system.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The INIT task create and run all other RTEMS tasks.
                  *
                  */
                 //***********
                 // INIT CACHE
                 unsigned char *vhdlVersion;
                 reset_lfr();
                 reset_local_time();
                 rtems_cpu_usage_reset();
                 rtems_status_code status;
                 rtems_status_code status_spw;
                 rtems_isr_entry  old_isr_handler;
                 old_isr_handler = NULL;
                 // UART settings
                 enable_apbuart_transmitter();
                 set_apbuart_scaler_reload_register(REGS_ADDR_APBUART, APBUART_SCALER_RELOAD_VALUE);
                 DEBUG_PRINTF("\n\n\n\n\nIn INIT *** Now the console is on port COM1\n")
                 PRINTF("\n\n\n\n\n")
                 initCache();
                 PRINTF("*************************\n")
                 PRINTF("** LFR Flight Software **\n")
                 PRINTF1("** %d-", SW_VERSION_N1)
                 PRINTF1("%d-"   , SW_VERSION_N2)
                 PRINTF1("%d-"   , SW_VERSION_N3)
                 PRINTF1("%d             **\n", SW_VERSION_N4)
                 vhdlVersion = (unsigned char *) (REGS_ADDR_VHDL_VERSION);
                 PRINTF("** VHDL                **\n")
                 PRINTF1("** %d-", vhdlVersion[1])
                 PRINTF1("%d-"   , vhdlVersion[2])
                 PRINTF1("%d              **\n", vhdlVersion[3])
                 PRINTF("*************************\n")
                 PRINTF("\n\n")
                 init_parameter_dump();
                 init_kcoefficients_dump();
                 init_local_mode_parameters();
                 init_housekeeping_parameters();
                 init_k_coefficients_prc0();
                 init_k_coefficients_prc1();
                 init_k_coefficients_prc2();
                 pa_bia_status_info = INIT_CHAR;
                 // initialize all reaction wheels frequencies to NaN
                 rw_f.cp_rpw_sc_rw1_f1 = NAN;
                 rw_f.cp_rpw_sc_rw1_f2 = NAN;
                 rw_f.cp_rpw_sc_rw1_f3 = NAN;
                 rw_f.cp_rpw_sc_rw1_f4 = NAN;
                 rw_f.cp_rpw_sc_rw2_f1 = NAN;
                 rw_f.cp_rpw_sc_rw2_f2 = NAN;
                 rw_f.cp_rpw_sc_rw2_f3 = NAN;
                 rw_f.cp_rpw_sc_rw2_f4 = NAN;
                 rw_f.cp_rpw_sc_rw3_f1 = NAN;
                 rw_f.cp_rpw_sc_rw3_f2 = NAN;
                 rw_f.cp_rpw_sc_rw3_f3 = NAN;
                 rw_f.cp_rpw_sc_rw3_f4 = NAN;
                 rw_f.cp_rpw_sc_rw4_f1 = NAN;
                 rw_f.cp_rpw_sc_rw4_f2 = NAN;
                 rw_f.cp_rpw_sc_rw4_f3 = NAN;
                 rw_f.cp_rpw_sc_rw4_f4 = NAN;
                 // initialize filtering parameters
                 filterPar.spare_sy_lfr_pas_filter_enabled   = DEFAULT_SY_LFR_PAS_FILTER_ENABLED;
-                filterPar.sy_lfr_pas_filter_modulus         = DEFAULT_SY_LFR_PAS_FILTER_MODULUS;
+                filterPar.sy_lfr_sc_rw_delta_f              = DEFAULT_SY_LFR_SC_RW_DELTA_F;
                 filterPar.sy_lfr_pas_filter_tbad            = DEFAULT_SY_LFR_PAS_FILTER_TBAD;
-                filterPar.sy_lfr_pas_filter_offset          = DEFAULT_SY_LFR_PAS_FILTER_OFFSET;
                 filterPar.sy_lfr_pas_filter_shift           = DEFAULT_SY_LFR_PAS_FILTER_SHIFT;
-                filterPar.sy_lfr_sc_rw_delta_f              = DEFAULT_SY_LFR_SC_RW_DELTA_F;
+                filterPar.modulus_in_finetime               = DEFAULT_MODULUS;
+                filterPar.tbad_in_finetime                  = DEFAULT_TBAD;
+                filterPar.offset_in_finetime                = DEFAULT_OFFSET;
+                filterPar.shift_in_finetime                 = DEFAULT_SHIFT;
                 update_last_valid_transition_date( DEFAULT_LAST_VALID_TRANSITION_DATE  );
                 // waveform picker initialization
                 WFP_init_rings();
                 LEON_Clear_interrupt( IRQ_SPARC_GPTIMER_WATCHDOG );    // initialize the waveform rings
                 WFP_reset_current_ring_nodes();
                 reset_waveform_picker_regs();
                 // spectral matrices initialization
                 SM_init_rings();            // initialize spectral matrices rings
                 SM_reset_current_ring_nodes();
                 reset_spectral_matrix_regs();
                 // configure calibration
                 configureCalibration( false );   // true means interleaved mode, false is for normal mode
                 updateLFRCurrentMode( LFR_MODE_STANDBY );
                 BOOT_PRINTF1("in INIT *** lfrCurrentMode is %d\n", lfrCurrentMode)
                 create_names();                             // create all names
                 status = create_timecode_timer();           // create the timer used by timecode_irq_handler
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in INIT *** ERR in create_timer_timecode, code %d", status)
                 }
                 status = create_message_queues();           // create message queues
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in INIT *** ERR in create_message_queues, code %d", status)
                 }
                 status = create_all_tasks();                // create all tasks
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in INIT *** ERR in create_all_tasks, code %d\n", status)
                 }
                 // **************************
                 // <SPACEWIRE INITIALIZATION>
                 status_spw = spacewire_open_link();     // (1) open the link
                 if ( status_spw != RTEMS_SUCCESSFUL )
                 {
                     PRINTF1("in INIT *** ERR spacewire_open_link code %d\n", status_spw )
                 }
                 if ( status_spw == RTEMS_SUCCESSFUL )   // (2) configure the link
                 {
                     status_spw = spacewire_configure_link( fdSPW );
                     if ( status_spw != RTEMS_SUCCESSFUL )
                     {
                         PRINTF1("in INIT *** ERR spacewire_configure_link code %d\n", status_spw )
                     }
                 }
                 if ( status_spw == RTEMS_SUCCESSFUL)    // (3) start the link
                 {
                     status_spw = spacewire_start_link( fdSPW );
                     if (  status_spw != RTEMS_SUCCESSFUL )
                     {
                         PRINTF1("in INIT *** ERR spacewire_start_link code %d\n",  status_spw )
                     }
                 }
                 // </SPACEWIRE INITIALIZATION>
                 // ***************************
                 status = start_all_tasks();     // start all tasks
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in INIT *** ERR in start_all_tasks, code %d", status)
                 }
                 // start RECV and SEND *AFTER* SpaceWire Initialization, due to the timeout of the start call during the initialization
                 status = start_recv_send_tasks();
                 if ( status != RTEMS_SUCCESSFUL )
                 {
                     PRINTF1("in INIT *** ERR start_recv_send_tasks code %d\n",  status )
                 }
                 // suspend science tasks, they will be restarted later depending on the mode
                 status = suspend_science_tasks();   // suspend science tasks (not done in stop_current_mode if current mode = STANDBY)
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in INIT *** in suspend_science_tasks *** ERR code: %d\n", status)
                 }
                 // configure IRQ handling for the waveform picker unit
                 status = rtems_interrupt_catch( waveforms_isr,
                                                IRQ_SPARC_WAVEFORM_PICKER,
                                                &old_isr_handler) ;
                 // configure IRQ handling for the spectral matrices unit
                 status = rtems_interrupt_catch( spectral_matrices_isr,
                                                IRQ_SPARC_SPECTRAL_MATRIX,
                                                &old_isr_handler) ;
                 // if the spacewire link is not up then send an event to the SPIQ task for link recovery
                 if ( status_spw != RTEMS_SUCCESSFUL )
                 {
                     status = rtems_event_send( Task_id[TASKID_SPIQ], SPW_LINKERR_EVENT );
                     if ( status != RTEMS_SUCCESSFUL ) {
                         PRINTF1("in INIT *** ERR rtems_event_send to SPIQ code %d\n",  status )
                     }
                 }
                 BOOT_PRINTF("delete INIT\n")
                 set_hk_lfr_sc_potential_flag( true );
                 // start the timer to detect a missing spacewire timecode
                 // the timeout is larger because the spw IP needs to receive several valid timecodes before generating a tickout
                 // if a tickout is generated, the timer is restarted
                 status = rtems_timer_fire_after( timecode_timer_id, TIMECODE_TIMER_TIMEOUT_INIT, timecode_timer_routine, NULL );
                 grspw_timecode_callback = &timecode_irq_handler;
                 status = rtems_task_delete(RTEMS_SELF);
             }
             void init_local_mode_parameters( void )
             {
                 /** This function initialize the param_local global variable with default values.
                  *
                  */
                 unsigned int i;
                 // LOCAL PARAMETERS
                 BOOT_PRINTF1("local_sbm1_nb_cwf_max %d \n", param_local.local_sbm1_nb_cwf_max)
                 BOOT_PRINTF1("local_sbm2_nb_cwf_max %d \n", param_local.local_sbm2_nb_cwf_max)
                 // init sequence counters
                 for(i = 0; i<SEQ_CNT_NB_DEST_ID; i++)
                 {
                     sequenceCounters_TC_EXE[i] = INIT_CHAR;
                     sequenceCounters_TM_DUMP[i] = INIT_CHAR;
                 }
                 sequenceCounters_SCIENCE_NORMAL_BURST = INIT_CHAR;
                 sequenceCounters_SCIENCE_SBM1_SBM2 =    INIT_CHAR;
                 sequenceCounterHK =                     TM_PACKET_SEQ_CTRL_STANDALONE << TM_PACKET_SEQ_SHIFT;
             }
             void reset_local_time( void )
             {
                 time_management_regs->ctrl = time_management_regs->ctrl | VAL_SOFTWARE_RESET;  // [0010] software reset, coarse time = 0x80000000
             }
             void create_names( void ) // create all names for tasks and queues
             {
                 /** This function creates all RTEMS names used in the software for tasks and queues.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - successful completion
                  *
                  */
                 // task names
                 Task_name[TASKID_AVGV] = rtems_build_name( 'A', 'V', 'G', 'V' );
                 Task_name[TASKID_RECV] = rtems_build_name( 'R', 'E', 'C', 'V' );
                 Task_name[TASKID_ACTN] = rtems_build_name( 'A', 'C', 'T', 'N' );
                 Task_name[TASKID_SPIQ] = rtems_build_name( 'S', 'P', 'I', 'Q' );
                 Task_name[TASKID_LOAD] = rtems_build_name( 'L', 'O', 'A', 'D' );
                 Task_name[TASKID_AVF0] = rtems_build_name( 'A', 'V', 'F', '0' );
                 Task_name[TASKID_SWBD] = rtems_build_name( 'S', 'W', 'B', 'D' );
                 Task_name[TASKID_WFRM] = rtems_build_name( 'W', 'F', 'R', 'M' );
                 Task_name[TASKID_DUMB] = rtems_build_name( 'D', 'U', 'M', 'B' );
                 Task_name[TASKID_HOUS] = rtems_build_name( 'H', 'O', 'U', 'S' );
                 Task_name[TASKID_PRC0] = rtems_build_name( 'P', 'R', 'C', '0' );
                 Task_name[TASKID_CWF3] = rtems_build_name( 'C', 'W', 'F', '3' );
                 Task_name[TASKID_CWF2] = rtems_build_name( 'C', 'W', 'F', '2' );
                 Task_name[TASKID_CWF1] = rtems_build_name( 'C', 'W', 'F', '1' );
                 Task_name[TASKID_SEND] = rtems_build_name( 'S', 'E', 'N', 'D' );
                 Task_name[TASKID_LINK] = rtems_build_name( 'L', 'I', 'N', 'K' );
                 Task_name[TASKID_AVF1] = rtems_build_name( 'A', 'V', 'F', '1' );
                 Task_name[TASKID_PRC1] = rtems_build_name( 'P', 'R', 'C', '1' );
                 Task_name[TASKID_AVF2] = rtems_build_name( 'A', 'V', 'F', '2' );
                 Task_name[TASKID_PRC2] = rtems_build_name( 'P', 'R', 'C', '2' );
                 // rate monotonic period names
                 name_hk_rate_monotonic = rtems_build_name( 'H', 'O', 'U', 'S' );
                 name_avgv_rate_monotonic = rtems_build_name( 'A', 'V', 'G', 'V' );
                 misc_name[QUEUE_RECV] = rtems_build_name( 'Q', '_', 'R', 'V' );
                 misc_name[QUEUE_SEND] = rtems_build_name( 'Q', '_', 'S', 'D' );
                 misc_name[QUEUE_PRC0] = rtems_build_name( 'Q', '_', 'P', '0' );
                 misc_name[QUEUE_PRC1] = rtems_build_name( 'Q', '_', 'P', '1' );
                 misc_name[QUEUE_PRC2] = rtems_build_name( 'Q', '_', 'P', '2' );
                 timecode_timer_name = rtems_build_name( 'S', 'P', 'T', 'C' );
             }
             int create_all_tasks( void ) // create all tasks which run in the software
             {
                 /** This function creates all RTEMS tasks used in the software.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task created successfully
                  * - RTEMS_INVALID_ADDRESS - id is NULL
                  * - RTEMS_INVALID_NAME - invalid task name
                  * - RTEMS_INVALID_PRIORITY - invalid task priority
                  * - RTEMS_MP_NOT_CONFIGURED - multiprocessing not configured
                  * - RTEMS_TOO_MANY - too many tasks created
                  * - RTEMS_UNSATISFIED - not enough memory for stack/FP context
                  * - RTEMS_TOO_MANY - too many global objects
                  *
                  */
                 rtems_status_code status;
                 //**********
                 // SPACEWIRE
                 // RECV
                 status = rtems_task_create(
                     Task_name[TASKID_RECV], TASK_PRIORITY_RECV, RTEMS_MINIMUM_STACK_SIZE,
                     RTEMS_DEFAULT_MODES,
                     RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_RECV]
                 );
                 if (status == RTEMS_SUCCESSFUL) // SEND
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_SEND], TASK_PRIORITY_SEND, RTEMS_MINIMUM_STACK_SIZE * STACK_SIZE_MULT,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_SEND]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // LINK
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_LINK], TASK_PRIORITY_LINK, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_LINK]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // ACTN
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_ACTN], TASK_PRIORITY_ACTN, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES | RTEMS_NO_PREEMPT,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_ACTN]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // SPIQ
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_SPIQ], TASK_PRIORITY_SPIQ, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES | RTEMS_NO_PREEMPT,
                         RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_SPIQ]
                     );
                 }
                 //******************
                 // SPECTRAL MATRICES
                 if (status == RTEMS_SUCCESSFUL) // AVF0
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_AVF0], TASK_PRIORITY_AVF0, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_AVF0]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // PRC0
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_PRC0], TASK_PRIORITY_PRC0, RTEMS_MINIMUM_STACK_SIZE * STACK_SIZE_MULT,
                         RTEMS_DEFAULT_MODES | RTEMS_NO_PREEMPT,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_PRC0]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // AVF1
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_AVF1], TASK_PRIORITY_AVF1, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_AVF1]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // PRC1
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_PRC1], TASK_PRIORITY_PRC1, RTEMS_MINIMUM_STACK_SIZE * STACK_SIZE_MULT,
                         RTEMS_DEFAULT_MODES | RTEMS_NO_PREEMPT,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_PRC1]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // AVF2
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_AVF2], TASK_PRIORITY_AVF2, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_AVF2]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // PRC2
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_PRC2], TASK_PRIORITY_PRC2, RTEMS_MINIMUM_STACK_SIZE * STACK_SIZE_MULT,
                         RTEMS_DEFAULT_MODES | RTEMS_NO_PREEMPT,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_PRC2]
                     );
                 }
                 //****************
                 // WAVEFORM PICKER
                 if (status == RTEMS_SUCCESSFUL) // WFRM
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_WFRM], TASK_PRIORITY_WFRM, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_WFRM]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // CWF3
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_CWF3], TASK_PRIORITY_CWF3, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_CWF3]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // CWF2
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_CWF2], TASK_PRIORITY_CWF2, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_CWF2]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // CWF1
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_CWF1], TASK_PRIORITY_CWF1, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_CWF1]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // SWBD
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_SWBD], TASK_PRIORITY_SWBD, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_SWBD]
                     );
                 }
                 //*****
                 // MISC
                 if (status == RTEMS_SUCCESSFUL) // LOAD
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_LOAD], TASK_PRIORITY_LOAD, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_LOAD]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // DUMB
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_DUMB], TASK_PRIORITY_DUMB, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_DUMB]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // HOUS
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_HOUS], TASK_PRIORITY_HOUS, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_HOUS]
                     );
                 }
                 if (status == RTEMS_SUCCESSFUL) // AVGV
                 {
                     status = rtems_task_create(
                                 Task_name[TASKID_AVGV], TASK_PRIORITY_AVGV, RTEMS_MINIMUM_STACK_SIZE,
                                 RTEMS_DEFAULT_MODES,
                                 RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_AVGV]
                                 );
                 }
                 return status;
             }
             int start_recv_send_tasks( void )
             {
                 rtems_status_code status;
                 status = rtems_task_start( Task_id[TASKID_RECV], recv_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) {
                     BOOT_PRINTF("in INIT *** Error starting TASK_RECV\n")
                 }
                 if (status == RTEMS_SUCCESSFUL)     // SEND
                 {
                     status = rtems_task_start( Task_id[TASKID_SEND], send_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_SEND\n")
                     }
                 }
                 return status;
             }
             int start_all_tasks( void ) // start all tasks except SEND RECV and HOUS
             {
                 /** This function starts all RTEMS tasks used in the software.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - ask started successfully
                  * - RTEMS_INVALID_ADDRESS - invalid task entry point
                  * - RTEMS_INVALID_ID - invalid task id
                  * - RTEMS_INCORRECT_STATE - task not in the dormant state
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot start remote task
                  *
                  */
                 // starts all the tasks fot eh flight software
                 rtems_status_code status;
                 //**********
                 // SPACEWIRE
                 status = rtems_task_start( Task_id[TASKID_SPIQ], spiq_task, 1 );
                 if (status!=RTEMS_SUCCESSFUL) {
                     BOOT_PRINTF("in INIT *** Error starting TASK_SPIQ\n")
                 }
                 if (status == RTEMS_SUCCESSFUL)     // LINK
                 {
                     status = rtems_task_start( Task_id[TASKID_LINK], link_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_LINK\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // ACTN
                 {
                     status = rtems_task_start( Task_id[TASKID_ACTN], actn_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_ACTN\n")
                     }
                 }
                 //******************
                 // SPECTRAL MATRICES
                 if (status == RTEMS_SUCCESSFUL)     // AVF0
                 {
                     status = rtems_task_start( Task_id[TASKID_AVF0], avf0_task, LFR_MODE_STANDBY );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_AVF0\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // PRC0
                 {
                     status = rtems_task_start( Task_id[TASKID_PRC0], prc0_task, LFR_MODE_STANDBY );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_PRC0\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // AVF1
                 {
                     status = rtems_task_start( Task_id[TASKID_AVF1], avf1_task, LFR_MODE_STANDBY );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_AVF1\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // PRC1
                 {
                     status = rtems_task_start( Task_id[TASKID_PRC1], prc1_task, LFR_MODE_STANDBY );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_PRC1\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // AVF2
                 {
                     status = rtems_task_start( Task_id[TASKID_AVF2], avf2_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_AVF2\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // PRC2
                 {
                     status = rtems_task_start( Task_id[TASKID_PRC2], prc2_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_PRC2\n")
                     }
                 }
                 //****************
                 // WAVEFORM PICKER
                 if (status == RTEMS_SUCCESSFUL)     // WFRM
                 {
                     status = rtems_task_start( Task_id[TASKID_WFRM], wfrm_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_WFRM\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // CWF3
                 {
                     status = rtems_task_start( Task_id[TASKID_CWF3], cwf3_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_CWF3\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // CWF2
                 {
                     status = rtems_task_start( Task_id[TASKID_CWF2], cwf2_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_CWF2\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // CWF1
                 {
                     status = rtems_task_start( Task_id[TASKID_CWF1], cwf1_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_CWF1\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // SWBD
                 {
                     status = rtems_task_start( Task_id[TASKID_SWBD], swbd_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_SWBD\n")
                     }
                 }
                 //*****
                 // MISC
                 if (status == RTEMS_SUCCESSFUL)     // HOUS
                 {
                     status = rtems_task_start( Task_id[TASKID_HOUS], hous_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_HOUS\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // AVGV
                 {
                     status = rtems_task_start( Task_id[TASKID_AVGV], avgv_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_AVGV\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // DUMB
                 {
                     status = rtems_task_start( Task_id[TASKID_DUMB], dumb_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_DUMB\n")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // LOAD
                 {
                     status = rtems_task_start( Task_id[TASKID_LOAD], load_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_LOAD\n")
                     }
                 }
                 return status;
             }
             rtems_status_code create_message_queues( void ) // create the two message queues used in the software
             {
                 rtems_status_code status_recv;
                 rtems_status_code status_send;
                 rtems_status_code status_q_p0;
                 rtems_status_code status_q_p1;
                 rtems_status_code status_q_p2;
                 rtems_status_code ret;
                 rtems_id queue_id;
                 ret = RTEMS_SUCCESSFUL;
                 queue_id = RTEMS_ID_NONE;
                 //****************************************
                 // create the queue for handling valid TCs
                 status_recv = rtems_message_queue_create( misc_name[QUEUE_RECV],
                                                           MSG_QUEUE_COUNT_RECV, CCSDS_TC_PKT_MAX_SIZE,
                                                      RTEMS_FIFO | RTEMS_LOCAL, &queue_id );
                 if ( status_recv != RTEMS_SUCCESSFUL ) {
                     PRINTF1("in create_message_queues *** ERR creating QUEU queue, %d\n", status_recv)
                 }
                 //************************************************
                 // create the queue for handling TM packet sending
                 status_send = rtems_message_queue_create( misc_name[QUEUE_SEND],
                                                           MSG_QUEUE_COUNT_SEND, MSG_QUEUE_SIZE_SEND,
                                                   RTEMS_FIFO | RTEMS_LOCAL, &queue_id );
                 if ( status_send != RTEMS_SUCCESSFUL ) {
                     PRINTF1("in create_message_queues *** ERR creating PKTS queue, %d\n", status_send)
                 }
                 //*****************************************************************************
                 // create the queue for handling averaged spectral matrices for processing @ f0
                 status_q_p0 = rtems_message_queue_create( misc_name[QUEUE_PRC0],
                                                           MSG_QUEUE_COUNT_PRC0, MSG_QUEUE_SIZE_PRC0,
                                                   RTEMS_FIFO | RTEMS_LOCAL, &queue_id );
                 if ( status_q_p0 != RTEMS_SUCCESSFUL ) {
                     PRINTF1("in create_message_queues *** ERR creating Q_P0 queue, %d\n", status_q_p0)
                 }
                 //*****************************************************************************
                 // create the queue for handling averaged spectral matrices for processing @ f1
                 status_q_p1 = rtems_message_queue_create( misc_name[QUEUE_PRC1],
                                                           MSG_QUEUE_COUNT_PRC1, MSG_QUEUE_SIZE_PRC1,
                                                   RTEMS_FIFO | RTEMS_LOCAL, &queue_id );
                 if ( status_q_p1 != RTEMS_SUCCESSFUL ) {
                     PRINTF1("in create_message_queues *** ERR creating Q_P1 queue, %d\n", status_q_p1)
                 }
                 //*****************************************************************************
                 // create the queue for handling averaged spectral matrices for processing @ f2
                 status_q_p2 = rtems_message_queue_create( misc_name[QUEUE_PRC2],
                                                           MSG_QUEUE_COUNT_PRC2, MSG_QUEUE_SIZE_PRC2,
                                                   RTEMS_FIFO | RTEMS_LOCAL, &queue_id );
                 if ( status_q_p2 != RTEMS_SUCCESSFUL ) {
                     PRINTF1("in create_message_queues *** ERR creating Q_P2 queue, %d\n", status_q_p2)
                 }
                 if ( status_recv != RTEMS_SUCCESSFUL )
                 {
                     ret = status_recv;
                 }
                 else if( status_send != RTEMS_SUCCESSFUL )
                 {
                     ret = status_send;
                 }
                 else if( status_q_p0 != RTEMS_SUCCESSFUL )
                 {
                     ret = status_q_p0;
                 }
                 else if( status_q_p1 != RTEMS_SUCCESSFUL )
                 {
                     ret = status_q_p1;
                 }
                 else
                 {
                     ret = status_q_p2;
                 }
                 return ret;
             }
             rtems_status_code create_timecode_timer( void )
             {
                 rtems_status_code status;
                 status =  rtems_timer_create( timecode_timer_name, &timecode_timer_id );
                 if ( status != RTEMS_SUCCESSFUL )
                 {
                     PRINTF1("in create_timer_timecode *** ERR creating SPTC timer, %d\n", status)
                 }
                 else
                 {
                     PRINTF("in create_timer_timecode *** OK creating SPTC timer\n")
                 }
                 return status;
             }
             rtems_status_code get_message_queue_id_send( rtems_id *queue_id )
             {
                 rtems_status_code status;
                 rtems_name queue_name;
                 queue_name = rtems_build_name( 'Q', '_', 'S', 'D' );
                 status =  rtems_message_queue_ident( queue_name, 0, queue_id );
                 return status;
             }
             rtems_status_code get_message_queue_id_recv( rtems_id *queue_id )
             {
                 rtems_status_code status;
                 rtems_name queue_name;
                 queue_name = rtems_build_name( 'Q', '_', 'R', 'V' );
                 status =  rtems_message_queue_ident( queue_name, 0, queue_id );
                 return status;
             }
             rtems_status_code get_message_queue_id_prc0( rtems_id *queue_id )
             {
                 rtems_status_code status;
                 rtems_name queue_name;
                 queue_name = rtems_build_name( 'Q', '_', 'P', '0' );
                 status =  rtems_message_queue_ident( queue_name, 0, queue_id );
                 return status;
             }
             rtems_status_code get_message_queue_id_prc1( rtems_id *queue_id )
             {
                 rtems_status_code status;
                 rtems_name queue_name;
                 queue_name = rtems_build_name( 'Q', '_', 'P', '1' );
                 status =  rtems_message_queue_ident( queue_name, 0, queue_id );
                 return status;
             }
             rtems_status_code get_message_queue_id_prc2( rtems_id *queue_id )
             {
                 rtems_status_code status;
                 rtems_name queue_name;
                 queue_name = rtems_build_name( 'Q', '_', 'P', '2' );
                 status =  rtems_message_queue_ident( queue_name, 0, queue_id );
                 return status;
             }
             void update_queue_max_count( rtems_id queue_id, unsigned char*fifo_size_max )
             {
                 u_int32_t count;
                 rtems_status_code status;
                 count = 0;
                 status = rtems_message_queue_get_number_pending( queue_id, &count );
                 count = count + 1;
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in update_queue_max_count *** ERR = %d\n", status)
                 }
                 else
                 {
                     if (count > *fifo_size_max)
                     {
                         *fifo_size_max = count;
                     }
                 }
             }
             void init_ring(ring_node ring[], unsigned char nbNodes, volatile int buffer[], unsigned int bufferSize )
             {
                 unsigned char i;
                 //***************
                 // BUFFER ADDRESS
                 for(i=0; i<nbNodes; i++)
                 {
                     ring[i].coarseTime  = INT32_ALL_F;
                     ring[i].fineTime    = INT32_ALL_F;
                     ring[i].sid         = INIT_CHAR;
                     ring[i].status      = INIT_CHAR;
                     ring[i].buffer_address  = (int) &buffer[ i * bufferSize ];
                 }
                 //*****
                 // NEXT
                  ring[ nbNodes - 1 ].next  = (ring_node*) &ring[ 0 ];
                  for(i=0; i<nbNodes-1; i++)
                  {
                      ring[i].next      = (ring_node*) &ring[ i + 1 ];
                  }
                 //*********
                 // PREVIOUS
                 ring[ 0 ].previous       = (ring_node*) &ring[ nbNodes - 1 ];
                 for(i=1; i<nbNodes; i++)
                 {
                     ring[i].previous   = (ring_node*) &ring[ i - 1 ];
                 }
             }

src/processing/fsw_processing.c +42 -32

             /** 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       = 0;
             unsigned int nb_sm_f0_aux_f1= 0;
             unsigned int nb_sm_f1       = 0;
             unsigned int nb_sm_f0_aux_f2= 0;
             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 ] = {0};
             ring_node sm_ring_f1[ NB_RING_NODES_SM_F1 ] = {0};
             ring_node sm_ring_f2[ NB_RING_NODES_SM_F2 ] = {0};
             ring_node *current_ring_node_sm_f0      = NULL;
             ring_node *current_ring_node_sm_f1      = NULL;
             ring_node *current_ring_node_sm_f2      = NULL;
             ring_node *ring_node_for_averaging_sm_f0= NULL;
             ring_node *ring_node_for_averaging_sm_f1= NULL;
             ring_node *ring_node_for_averaging_sm_f2= NULL;
             //
             ring_node * getRingNodeForAveraging( unsigned char frequencyChannel)
             {
                 ring_node *node;
                 node = NULL;
                 switch ( frequencyChannel ) {
                 case CHANNELF0:
                     node = ring_node_for_averaging_sm_f0;
                     break;
                 case CHANNELF1:
                     node = ring_node_for_averaging_sm_f1;
                     break;
                 case CHANNELF2:
                     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 & BITS_STATUS_F0);   // [0011] get the status_ready_matrix_f0_x bits
                 switch(status)
                 {
                 case 0:
                     break;
                 case BIT_READY_0_1:
                     // UNEXPECTED VALUE
                     spectral_matrix_regs->status = BIT_READY_0_1;   // [0011]
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_11 );
                     break;
                 case BIT_READY_0:
                     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_F1)
                     {
                         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 = BIT_READY_0;   // [0000 0001]
                     break;
                 case BIT_READY_1:
                     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_F1)
                     {
                         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 = BIT_READY_1;   // [0000 0010]
                     break;
                 default:
                     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 & BITS_STATUS_F1) >> SHIFT_2_BITS);   // [1100] get the status_ready_matrix_f1_x bits
                 switch(status)
                 {
                 case 0:
                     break;
                 case BIT_READY_0_1:
                     // UNEXPECTED VALUE
                     spectral_matrix_regs->status = BITS_STATUS_F1;   // [1100]
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_11 );
                     break;
                 case BIT_READY_0:
                     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_AVF0_F1)
                     {
                         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 = BIT_STATUS_F1_0;   // [0000 0100]
                     break;
                 case BIT_READY_1:
                     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_AVF0_F1)
                     {
                         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 = BIT_STATUS_F1_1;   // [1000 0000]
                     break;
                 default:
                     break;
                 }
             }
             void spectral_matrices_isr_f2( int statusReg )
             {
                 unsigned char status;
                 rtems_status_code status_code;
                 status = (unsigned char) ((statusReg & BITS_STATUS_F2) >> SHIFT_4_BITS);   // [0011 0000] get the status_ready_matrix_f2_x bits
                 switch(status)
                 {
                 case 0:
                     break;
                 case BIT_READY_0_1:
                     // UNEXPECTED VALUE
                     spectral_matrix_regs->status = BITS_STATUS_F2;   // [0011 0000]
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_11 );
                     break;
                 case BIT_READY_0:
                     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 = BIT_STATUS_F2_0;   // [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 BIT_READY_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_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 = BIT_STATUS_F2_1;   // [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;
                 default:
                     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 & BITS_HK_AA_SM) >> SHIFT_7_BITS);    // [0111 1000 0000]
                 if (statusReg & BITS_SM_ERR)    // [0111 1100 0000]
                 {
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_8 );
                 }
                 spectral_matrix_regs->status = spectral_matrix_regs->status & BITS_SM_ERR;
             }
             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 & BITS_STATUS_F2) != INIT_CHAR)   // [0011 0000] check the status_ready_matrix_f2_x bits
                         {
                             state = WAIT_FOR_F1;
                         }
                         break;
                     case WAIT_FOR_F1:
                         if ((statusReg & BITS_STATUS_F1) != INIT_CHAR)   // [0000 1100] check the status_ready_matrix_f1_x bits
                         {
                             state = WAIT_FOR_F0;
                         }
                         break;
                     case WAIT_FOR_F0:
                         if ((statusReg & BITS_STATUS_F0) != INIT_CHAR)   // [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 = INIT_CHAR;
                 packet->userApplication = CCSDS_USER_APP;
                 packet->packetID[0] = (unsigned char) (apid >> SHIFT_1_BYTE);
                 packet->packetID[1] = (unsigned char) (apid);
                 packet->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 packet->packetSequenceControl[1] = INIT_CHAR;
                 packet->packetLength[0] = (unsigned char) (packetLength >> SHIFT_1_BYTE);
                 packet->packetLength[1] = (unsigned char) (packetLength);
                 // DATA FIELD HEADER
                 packet->spare1_pusVersion_spare2 = SPARE1_PUSVERSION_SPARE2;
                 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[BYTE_0] = INIT_CHAR;
                 packet->time[BYTE_1] = INIT_CHAR;
                 packet->time[BYTE_2] = INIT_CHAR;
                 packet->time[BYTE_3] = INIT_CHAR;
                 packet->time[BYTE_4] = INIT_CHAR;
                 packet->time[BYTE_5] = INIT_CHAR;
                 // AUXILIARY DATA HEADER
                 packet->sid = sid;
                 packet->pa_bia_status_info = INIT_CHAR;
                 packet->sy_lfr_common_parameters_spare = INIT_CHAR;
                 packet->sy_lfr_common_parameters = INIT_CHAR;
                 packet->acquisitionTime[BYTE_0] = INIT_CHAR;
                 packet->acquisitionTime[BYTE_1] = INIT_CHAR;
                 packet->acquisitionTime[BYTE_2] = INIT_CHAR;
                 packet->acquisitionTime[BYTE_3] = INIT_CHAR;
                 packet->acquisitionTime[BYTE_4] = INIT_CHAR;
                 packet->acquisitionTime[BYTE_5] = INIT_CHAR;
                 packet->pa_lfr_bp_blk_nr[0] = INIT_CHAR;  // 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 = INIT_CHAR;
                 packet->userApplication = CCSDS_USER_APP;
                 packet->packetID[0] = (unsigned char) (apid >> SHIFT_1_BYTE);
                 packet->packetID[1] = (unsigned char) (apid);
                 packet->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 packet->packetSequenceControl[1] = INIT_CHAR;
                 packet->packetLength[0] = (unsigned char) (packetLength >> SHIFT_1_BYTE);
                 packet->packetLength[1] = (unsigned char) (packetLength);
                 // DATA FIELD HEADER
                 packet->spare1_pusVersion_spare2 = SPARE1_PUSVERSION_SPARE2;
                 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 = INIT_CHAR;
                 packet->sy_lfr_common_parameters_spare = INIT_CHAR;
                 packet->sy_lfr_common_parameters = INIT_CHAR;
                 packet->time[BYTE_0] = INIT_CHAR;
                 packet->time[BYTE_1] = INIT_CHAR;
                 packet->time[BYTE_2] = INIT_CHAR;
                 packet->time[BYTE_3] = INIT_CHAR;
                 packet->time[BYTE_4] = INIT_CHAR;
                 packet->time[BYTE_5] = INIT_CHAR;
                 packet->source_data_spare = INIT_CHAR;
                 packet->pa_lfr_bp_blk_nr[0] = INIT_CHAR;  // 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 = BITS_STATUS_REG;   // [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 = DEFAULT_MATRIX_LENGTH; // 25 * 128 / 16 = 200 = 0xc8
             }
             void set_time( unsigned char *time, unsigned char * timeInBuffer )
             {
                 time[BYTE_0] = timeInBuffer[BYTE_0];
                 time[BYTE_1] = timeInBuffer[BYTE_1];
                 time[BYTE_2] = timeInBuffer[BYTE_2];
                 time[BYTE_3] = timeInBuffer[BYTE_3];
                 time[BYTE_4] = timeInBuffer[BYTE_6];
                 time[BYTE_5] = timeInBuffer[BYTE_7];
             }
             unsigned long long int get_acquisition_time( unsigned char *timePtr )
             {
                 unsigned long long int acquisitionTimeAslong;
                 acquisitionTimeAslong = INIT_CHAR;
                 acquisitionTimeAslong =
                         ( (unsigned long long int) (timePtr[BYTE_0] & SYNC_BIT_MASK) << SHIFT_5_BYTES ) // [0111 1111] mask the synchronization bit
                         + ( (unsigned long long int) timePtr[BYTE_1] << SHIFT_4_BYTES )
                         + ( (unsigned long long int) timePtr[BYTE_2] << SHIFT_3_BYTES )
                         + ( (unsigned long long int) timePtr[BYTE_3] << SHIFT_2_BYTES )
                         + ( (unsigned long long int) timePtr[BYTE_6] << SHIFT_1_BYTE  )
                         + ( (unsigned long long int) timePtr[BYTE_7]       );
                 return acquisitionTimeAslong;
             }
             unsigned char getSID( rtems_event_set event )
             {
                 unsigned char sid;
                 rtems_event_set eventSetBURST;
                 rtems_event_set eventSetSBM;
                 sid = 0;
                 //******
                 // 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 * SM_BYTES_PER_VAL)    ];
                     im = inputASM[ (asmComponent*NB_BINS_PER_SM) + (i * SM_BYTES_PER_VAL) + 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, ASM_COMP_B1B2);    // b1b2
                 extractReImVectors( inputASM, outputASM, ASM_COMP_B1B3 );   // b1b3
                 extractReImVectors( inputASM, outputASM, ASM_COMP_B1E1 );   // b1e1
                 extractReImVectors( inputASM, outputASM, ASM_COMP_B1E2 );   // b1e2
                 extractReImVectors( inputASM, outputASM, ASM_COMP_B2B3 );   // b2b3
                 extractReImVectors( inputASM, outputASM, ASM_COMP_B2E1 );   // b2e1
                 extractReImVectors( inputASM, outputASM, ASM_COMP_B2E2 );   // b2e2
                 extractReImVectors( inputASM, outputASM, ASM_COMP_B3E1 );   // b3e1
                 extractReImVectors( inputASM, outputASM, ASM_COMP_B3E2 );   // b3e2
                 extractReImVectors( inputASM, outputASM, ASM_COMP_E1E2 );   // e1e2
                 copyReVectors(inputASM, outputASM, ASM_COMP_B1B1 );     // b1b1
                 copyReVectors(inputASM, outputASM, ASM_COMP_B2B2 );     // b2b2
                 copyReVectors(inputASM, outputASM, ASM_COMP_B3B3);      // b3b3
                 copyReVectors(inputASM, outputASM, ASM_COMP_E1E1);      // e1e1
                 copyReVectors(inputASM, outputASM, ASM_COMP_E2E2);      // 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);
                         }
                         if (divider != 0)
                         {
                             compressed_spec_mat[ offsetCompressed ] = compressed_spec_mat[ offsetCompressed ] / (divider * nbBinsToAverage);
                         }
                         else
                         {
                             compressed_spec_mat[ offsetCompressed ] = INIT_FLOAT;
                         }
                     }
                 }
             }
             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;
                 switch(channel)
                 {
                 case CHANNELF0:
                     sy_lfr_fbins_fx_word1 = fbins_masks.merged_fbins_mask_f0;
                     break;
                 case CHANNELF1:
                     sy_lfr_fbins_fx_word1 = fbins_masks.merged_fbins_mask_f1;
                     break;
                 case CHANNELF2:
                     sy_lfr_fbins_fx_word1 = fbins_masks.merged_fbins_mask_f2;
                     break;
                 default:
                     PRINTF("ERR *** in getFBinMask, wrong frequency channel")
                 }
                 indexInChar = index >> SHIFT_3_BITS;
                 indexInTheChar = index - (indexInChar * BITS_PER_BYTE);
                 fbin = (int) ((sy_lfr_fbins_fx_word1[ BYTES_PER_MASK - 1 - indexInChar] >> indexInTheChar) & 1);
                 return fbin;
             }
             unsigned char isPolluted( u_int64_t t0, u_int64_t t1, u_int64_t tbad0, u_int64_t tbad1 )
             {
                 unsigned char polluted;
                 polluted = MATRIX_IS_NOT_POLLUTED;
                 if ( ((tbad0 < t0) && (t0 < tbad1))     // t0 is inside the polluted range
                      || ((tbad0 < t1) && (t1 < tbad1))  // t1 is inside the polluted range
                      || ((t0 < tbad0) && (tbad1 < t1))  // the polluted range is inside the signal range
                      || ((tbad0 < t0) && (t1 < tbad1))) // the signal range is inside the polluted range
                 {
                     polluted = MATRIX_IS_POLLUTED;
                 }
                 return polluted;
             }
             unsigned char acquisitionTimeIsValid( unsigned int coarseTime, unsigned int fineTime, unsigned char channel)
             {
                 u_int64_t t0;
                 u_int64_t t1;
                 u_int64_t tc;
                 u_int64_t tbad0;
                 u_int64_t tbad1;
                 u_int64_t modulusInFineTime;
                 u_int64_t offsetInFineTime;
                 u_int64_t shiftInFineTime;
                 u_int64_t tbadInFineTime;
                 u_int64_t timecodeReference;
                 unsigned char pasFilteringIsEnabled;
                 unsigned char ret;
-                pasFilteringIsEnabled = (filterPar.spare_sy_lfr_pas_filter_enabled & 1); // [0000 0001]
-                ret = MATRIX_IS_NOT_POLLUTED;
-                // compute the acquitionTime range
-                modulusInFineTime   = ((u_int64_t) filterPar.sy_lfr_pas_filter_modulus) * CONST_65536;
-                offsetInFineTime    = ((u_int64_t) filterPar.sy_lfr_pas_filter_offset)  * CONST_65536;
-                shiftInFineTime     = ((u_int64_t) filterPar.sy_lfr_pas_filter_shift)   * CONST_65536;
-                tbadInFineTime      = ((u_int64_t) filterPar.sy_lfr_pas_filter_tbad)    * CONST_65536;
                 // compute acquisition time from caoarseTime and fineTime
                 t0 = ( ((u_int64_t)coarseTime) <<  SHIFT_2_BYTES ) + (u_int64_t) fineTime;
+                t1 = t0;
+                tc = t0;
+                tbad0 = t0;
+                tbad1 = t0;
                 switch(channel)
                 {
                 case CHANNELF0:
                     t1 = t0 + ACQUISITION_DURATION_F0;
                     tc = t0 + HALF_ACQUISITION_DURATION_F0;
                     break;
                 case CHANNELF1:
                     t1 = t0 + ACQUISITION_DURATION_F1;
                     tc = t0 + HALF_ACQUISITION_DURATION_F1;
                     break;
                 case CHANNELF2:
                     t1 = t0 + ACQUISITION_DURATION_F2;
                     tc = t0 + HALF_ACQUISITION_DURATION_F2;
                     break;
+                default:
+                    break;
                 }
-                // INTERSECTION TEST #1
+                // compute the acquitionTime range
-                timecodeReference = (tc - (tc % modulusInFineTime)) - modulusInFineTime ;
+                modulusInFineTime   = filterPar.modulus_in_finetime;
-                tbad0 = timecodeReference + offsetInFineTime + shiftInFineTime;
+                offsetInFineTime    = filterPar.offset_in_finetime;
-                tbad1 = timecodeReference + offsetInFineTime + shiftInFineTime + tbadInFineTime;
+                shiftInFineTime     = filterPar.shift_in_finetime;
-                ret = isPolluted( t0, t1, tbad0, tbad1 );
+                tbadInFineTime      = filterPar.tbad_in_finetime;
+                timecodeReference   = INIT_INT;
-                // INTERSECTION TEST #2
+                pasFilteringIsEnabled = (filterPar.spare_sy_lfr_pas_filter_enabled & 1); // [0000 0001]
-                timecodeReference = (tc - (tc % modulusInFineTime)) ;
+                ret = MATRIX_IS_NOT_POLLUTED;
-                tbad0 = timecodeReference + offsetInFineTime + shiftInFineTime;
-                tbad1 = timecodeReference + offsetInFineTime + shiftInFineTime + tbadInFineTime;
-                if (ret == MATRIX_IS_NOT_POLLUTED)
-                    ret = isPolluted( t0, t1, tbad0, tbad1 );
-                // INTERSECTION TEST #3
+                if ( (tbadInFineTime == 0) || (pasFilteringIsEnabled == 0) )
-                timecodeReference = (tc - (tc % modulusInFineTime)) + modulusInFineTime ;
-                tbad0 = timecodeReference + offsetInFineTime + shiftInFineTime;
-                tbad1 = timecodeReference + offsetInFineTime + shiftInFineTime + tbadInFineTime;
-                if (ret == MATRIX_IS_NOT_POLLUTED)
-                    ret = isPolluted( t0, t1, tbad0, tbad1 );
-                if (pasFilteringIsEnabled == 0)
                 {
                     ret = MATRIX_IS_NOT_POLLUTED;
                 }
+                else
+                {
+                    // INTERSECTION TEST #1
+                    timecodeReference = (tc - (tc % modulusInFineTime)) - modulusInFineTime ;
+                    tbad0 = timecodeReference + offsetInFineTime + shiftInFineTime;
+                    tbad1 = timecodeReference + offsetInFineTime + shiftInFineTime + tbadInFineTime;
+                    ret = isPolluted( t0, t1, tbad0, tbad1 );
+                    // INTERSECTION TEST #2
+                    if (ret == MATRIX_IS_NOT_POLLUTED)
+                    {
+                        timecodeReference = (tc - (tc % modulusInFineTime)) ;
+                        tbad0 = timecodeReference + offsetInFineTime + shiftInFineTime;
+                        tbad1 = timecodeReference + offsetInFineTime + shiftInFineTime + tbadInFineTime;
+                        ret = isPolluted( t0, t1, tbad0, tbad1 );
+                    }
+                    // INTERSECTION TEST #3
+                    if (ret == MATRIX_IS_NOT_POLLUTED)
+                    {
+                        timecodeReference = (tc - (tc % modulusInFineTime)) + modulusInFineTime ;
+                        tbad0 = timecodeReference + offsetInFineTime + shiftInFineTime;
+                        tbad1 = timecodeReference + offsetInFineTime + shiftInFineTime + tbadInFineTime;
+                        ret = isPolluted( t0, t1, tbad0, tbad1 );
+                    }
+                }
                 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 ) * SBM_COEFF_PER_NORM_COEFF       ]
                                 = input_kcoeff[ (bin*NB_K_COEFF_PER_BIN) + kcoeff ];
                         output_kcoeff[ ( ( (bin * NB_K_COEFF_PER_BIN ) + kcoeff) * SBM_COEFF_PER_NORM_COEFF ) + 1 ]
                                 = input_kcoeff[ (bin*NB_K_COEFF_PER_BIN) + kcoeff ];
                     }
                 }
             }

src/tc_load_dump_parameters.c +9 -2

             /** 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 = {0};
             Packet_TM_LFR_KCOEFFICIENTS_DUMP_t kcoefficients_dump_2 = {0};
             ring_node kcoefficient_node_1 = {0};
             ring_node kcoefficient_node_2 = {0};
             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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 * S1_BP_P0_SCALE) )
                             - floor(sy_lfr_s1_bp_p1 / (sy_lfr_s1_bp_p0 * S1_BP_P0_SCALE));
                     if (aux > FLOAT_EQUAL_ZERO)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P0 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 );
                 // once the fbins masks have been stored, they have to be merged with the masks which handle the reaction wheels frequencies filtering
                 merge_fbins_masks();
                 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;
                 unsigned char k;
                 flag = LFR_DEFAULT;
                 k = INIT_CHAR;
                 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[BYTE_0]    = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_0 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_1]    = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_1 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_2]    = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_2 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_3]    = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_3 ];
                     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[BYTE_0]   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_0 ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_1]   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_1 ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_2]   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_2 ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_3]   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_3 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_0]      = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_0 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_1]      = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_1 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_2]      = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_2 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_3]      = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_3 ];
                     //****************************
                     // 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 & BIT_PAS_FILTER_ENABLED );
                     // sy_lfr_pas_filter_modulus
-                    filterPar.sy_lfr_pas_filter_modulus         = parameter_dump_packet.sy_lfr_pas_filter_modulus;
+                    filterPar.modulus_in_finetime = ((uint64_t) parameter_dump_packet.sy_lfr_pas_filter_modulus) * CONST_65536;
                     // sy_lfr_pas_filter_tbad
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_pas_filter_tbad,
                                      parameter_dump_packet.sy_lfr_pas_filter_tbad );
+                    filterPar.tbad_in_finetime = (uint64_t) (filterPar.sy_lfr_pas_filter_tbad * CONST_65536);
                     // sy_lfr_pas_filter_offset
-                    filterPar.sy_lfr_pas_filter_offset          = parameter_dump_packet.sy_lfr_pas_filter_offset;
+                    filterPar.offset_in_finetime = ((uint64_t) parameter_dump_packet.sy_lfr_pas_filter_offset) * CONST_65536;
                     // sy_lfr_pas_filter_shift
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_pas_filter_shift,
                                      parameter_dump_packet.sy_lfr_pas_filter_shift );
+                    filterPar.shift_in_finetime = (uint64_t) (filterPar.sy_lfr_pas_filter_shift * CONST_65536);
                     //****************************************************
                     // 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 );
                     // copy rw.._k.. from the incoming TC to the local parameter_dump_packet
                     for (k = 0; k < NB_RW_K_COEFFS * NB_BYTES_PER_RW_K_COEFF; k++)
                     {
                         parameter_dump_packet.sy_lfr_rw1_k1[k] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_RW1_K1 + k ];
                     }
                     //***********************************************
                     // store the parameter sy_lfr_rw.._k.. as a float
                     // rw1_k
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw1_k1, parameter_dump_packet.sy_lfr_rw1_k1 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw1_k2, parameter_dump_packet.sy_lfr_rw1_k2 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw1_k3, parameter_dump_packet.sy_lfr_rw1_k3 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw1_k4, parameter_dump_packet.sy_lfr_rw1_k4 );
                     // rw2_k
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw2_k1, parameter_dump_packet.sy_lfr_rw2_k1 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw2_k2, parameter_dump_packet.sy_lfr_rw2_k2 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw2_k3, parameter_dump_packet.sy_lfr_rw2_k3 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw2_k4, parameter_dump_packet.sy_lfr_rw2_k4 );
                     // rw3_k
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw3_k1, parameter_dump_packet.sy_lfr_rw3_k1 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw3_k2, parameter_dump_packet.sy_lfr_rw3_k2 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw3_k3, parameter_dump_packet.sy_lfr_rw3_k3 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw3_k4, parameter_dump_packet.sy_lfr_rw3_k4 );
                     // rw4_k
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw4_k1, parameter_dump_packet.sy_lfr_rw4_k1 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw4_k2, parameter_dump_packet.sy_lfr_rw4_k2 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw4_k3, parameter_dump_packet.sy_lfr_rw4_k3 );
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_rw4_k4, parameter_dump_packet.sy_lfr_rw4_k4 );
                 }
                 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) + KCOEFF_FREQ
                                 ]; // 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) + KCOEFF_FREQ
                                 ]; // 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 < KCOEFF_BLK_NR_PKT1 ;
                      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) + KCOEFF_FREQ
                                 ]; // 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[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
                 kcoefficients_dump_1.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
                 kcoefficients_dump_1.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
                 kcoefficients_dump_1.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
                 kcoefficients_dump_1.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
                 kcoefficients_dump_1.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
                 // 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 < KCOEFF_BLK_NR_PKT2;
                      freq++ )
                 {
                     kcoefficients_dump_2.kcoeff_blks[ (freq*KCOEFF_BLK_SIZE) + 1 ] = KCOEFF_BLK_NR_PKT1 + freq;
                     bin = freq + KCOEFF_BLK_NR_PKT2;
             //        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) + KCOEFF_FREQ ]; // 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[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
                 kcoefficients_dump_2.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
                 kcoefficients_dump_2.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
                 kcoefficients_dump_2.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
                 kcoefficients_dump_2.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
                 kcoefficients_dump_2.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
                 // 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[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
                 parameter_dump_packet.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
                 parameter_dump_packet.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
                 parameter_dump_packet.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
                 parameter_dump_packet.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
                 parameter_dump_packet.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
                 // 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 * CONST_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 * CONST_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 * CONST_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 != DFLT_SY_LFR_N_SWF_L)
                 {
                     status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_SWF_L + DATAFIELD_OFFSET, sy_lfr_n_swf_l );
                     flag = WRONG_APP_DATA;
                 }
                 // sy_lfr_n_swf_p
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( sy_lfr_n_swf_p < MIN_SY_LFR_N_SWF_P )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_N_SWF_P + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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 + DATAFIELD_OFFSET, 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;
                 status = LFR_DEFAULT;
                 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;
                 status = LFR_DEFAULT;
                 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;
                 status = LFR_DEFAULT;
                 if ( (mode == THR_MODE_STANDBY) || (mode == THR_MODE_NORMAL)
                      || (mode == THR_MODE_BURST))
                 {
                     status = LFR_SUCCESSFUL;
                 }
                 else
                 {
                     status = LFR_DEFAULT;
                 }
                 return status;
             }
             void set_hk_lfr_sc_rw_f_flag( unsigned char wheel, unsigned char freq, float value )
             {
                 unsigned char flag;
                 unsigned char flagPosInByte;
                 unsigned char newFlag;
                 unsigned char flagMask;
                 // if the frequency value is not a number, the flag is set to 0 and the frequency RWx_Fy is not filtered
                 if (isnan(value))
                 {
                     flag = FLAG_NAN;
                 }
                 else
                 {
                     flag = FLAG_IAN;
                 }
                 switch(wheel)
                 {
                 case WHEEL_1:
                     flagPosInByte = FLAG_OFFSET_WHEELS_1_3 - freq;
                     flagMask = ~(1 << flagPosInByte);
                     newFlag = flag << flagPosInByte;
                     housekeeping_packet.hk_lfr_sc_rw1_rw2_f_flags = (housekeeping_packet.hk_lfr_sc_rw1_rw2_f_flags & flagMask) | newFlag;
                     break;
                 case WHEEL_2:
                     flagPosInByte = FLAG_OFFSET_WHEELS_2_4 - freq;
                     flagMask = ~(1 << flagPosInByte);
                     newFlag = flag << flagPosInByte;
                     housekeeping_packet.hk_lfr_sc_rw1_rw2_f_flags = (housekeeping_packet.hk_lfr_sc_rw1_rw2_f_flags & flagMask) | newFlag;
                     break;
                 case WHEEL_3:
                     flagPosInByte = FLAG_OFFSET_WHEELS_1_3 - freq;
                     flagMask = ~(1 << flagPosInByte);
                     newFlag = flag << flagPosInByte;
                     housekeeping_packet.hk_lfr_sc_rw3_rw4_f_flags = (housekeeping_packet.hk_lfr_sc_rw3_rw4_f_flags & flagMask) | newFlag;
                     break;
                 case WHEEL_4:
                     flagPosInByte = FLAG_OFFSET_WHEELS_2_4 - freq;
                     flagMask = ~(1 << flagPosInByte);
                     newFlag = flag << flagPosInByte;
                     housekeeping_packet.hk_lfr_sc_rw3_rw4_f_flags = (housekeeping_packet.hk_lfr_sc_rw3_rw4_f_flags & flagMask) | newFlag;
                     break;
                 default:
                     break;
                 }
             }
             void set_hk_lfr_sc_rw_f_flags( void )
             {
                 // RW1
                 set_hk_lfr_sc_rw_f_flag( WHEEL_1, FREQ_1, rw_f.cp_rpw_sc_rw1_f1 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_1, FREQ_2, rw_f.cp_rpw_sc_rw1_f2 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_1, FREQ_3, rw_f.cp_rpw_sc_rw1_f3 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_1, FREQ_4, rw_f.cp_rpw_sc_rw1_f4 );
                 // RW2
                 set_hk_lfr_sc_rw_f_flag( WHEEL_2, FREQ_1, rw_f.cp_rpw_sc_rw2_f1 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_2, FREQ_2, rw_f.cp_rpw_sc_rw2_f2 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_2, FREQ_3, rw_f.cp_rpw_sc_rw2_f3 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_2, FREQ_4, rw_f.cp_rpw_sc_rw2_f4 );
                 // RW3
                 set_hk_lfr_sc_rw_f_flag( WHEEL_3, FREQ_1, rw_f.cp_rpw_sc_rw3_f1 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_3, FREQ_2, rw_f.cp_rpw_sc_rw3_f2 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_3, FREQ_3, rw_f.cp_rpw_sc_rw3_f3 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_3, FREQ_4, rw_f.cp_rpw_sc_rw3_f4 );
                 // RW4
                 set_hk_lfr_sc_rw_f_flag( WHEEL_4, FREQ_1, rw_f.cp_rpw_sc_rw4_f1 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_4, FREQ_2, rw_f.cp_rpw_sc_rw4_f2 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_4, FREQ_3, rw_f.cp_rpw_sc_rw4_f3 );
                 set_hk_lfr_sc_rw_f_flag( WHEEL_4, FREQ_4, rw_f.cp_rpw_sc_rw4_f4 );
             }
             int check_sy_lfr_rw_f( ccsdsTelecommandPacket_t *TC, int offset, int* pos, float* value )
             {
                 float rw_k;
                 int ret;
                 ret = LFR_SUCCESSFUL;
                 rw_k = INIT_FLOAT;
                 copyFloatByChar( (unsigned char*) &rw_k, (unsigned char*) &TC->packetID[ offset ] );
                 *pos = offset;
                 *value = rw_k;
                 if (rw_k < MIN_SY_LFR_RW_F)
                 {
                     ret = WRONG_APP_DATA;
                 }
                 return ret;
             }
             int check_all_sy_lfr_rw_f( ccsdsTelecommandPacket_t *TC, int *pos, float*value )
             {
                 int ret;
                 ret = LFR_SUCCESSFUL;
                 //****
                 //****
                 // RW1
                 ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F1, pos, value );  // F1
                 if (ret == LFR_SUCCESSFUL)  // F2
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F2, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F3
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F3, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F4
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F4, pos, value  );
                 }
                 //****
                 //****
                 // RW2
                 if (ret == LFR_SUCCESSFUL)  // F1
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F1, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F2
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F2, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F3
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F3, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F4
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F4, pos, value  );
                 }
                 //****
                 //****
                 // RW3
                 if (ret == LFR_SUCCESSFUL)  // F1
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F1, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F2
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F2, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F3
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F3, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F4
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F4, pos, value  );
                 }
                 //****
                 //****
                 // RW4
                 if (ret == LFR_SUCCESSFUL)  // F1
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F1, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F2
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F2, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F3
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F3, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // F4
                 {
                     ret = check_sy_lfr_rw_f( TC, BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F4, pos, value  );
                 }
                 return ret;
             }
             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;
                 // rw1_f
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw1_f1, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F1 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw1_f2, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F2 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw1_f3, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F3 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw1_f4, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F4 ] );
                 // rw2_f
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw2_f1, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F1 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw2_f2, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F2 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw2_f3, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F3 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw2_f4, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F4 ] );
                 // rw3_f
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw3_f1, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F1 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw3_f2, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F2 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw3_f3, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F3 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw3_f4, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F4 ] );
                 // rw4_f
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw4_f1, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F1 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw4_f2, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F2 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw4_f3, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F3 ] );
                 copyFloatByChar( (unsigned char*) &rw_f.cp_rpw_sc_rw4_f4, (unsigned char*) &bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F4 ] );
                 // test each reaction wheel frequency value. NaN means that the frequency is not filtered
             }
             void setFBinMask( unsigned char *fbins_mask, float rw_f, unsigned char deltaFreq, float sy_lfr_rw_k )
             {
                 /** 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;
                 float freqToFilterOut;
                 int binBelow;
                 int binAbove;
                 int closestBin;
                 unsigned int whichByte;
                 int selectedByte;
                 int bin;
                 int binToRemove[NB_BINS_TO_REMOVE];
                 int k;
                 bool filteringSet;
                 closestBin = 0;
                 whichByte = 0;
                 bin = 0;
                 filteringSet = false;
                 for (k = 0; k < NB_BINS_TO_REMOVE; k++)
                 {
                     binToRemove[k] = -1;
                 }
                 if (!isnan(rw_f))
                 {
                     // compute the frequency range to filter [ rw_f - delta_f; rw_f + delta_f ]
                     f_RW_min = rw_f - ((filterPar.sy_lfr_sc_rw_delta_f) * sy_lfr_rw_k);
                     f_RW_MAX = rw_f + ((filterPar.sy_lfr_sc_rw_delta_f) * sy_lfr_rw_k);
                     freqToFilterOut = f_RW_min;
                     while ( filteringSet == false )
                     {
                         // compute the index of the frequency bin immediately below rw_f
                         binBelow = (int) ( floor( ((double) freqToFilterOut) / ((double) deltaFreq)) );
                         deltaBelow = freqToFilterOut - binBelow * deltaFreq;
                         // compute the index of the frequency bin immediately above rw_f
                         binAbove = (int) ( ceil(  ((double) freqToFilterOut) / ((double) deltaFreq)) );
                         deltaAbove = binAbove * deltaFreq - freqToFilterOut;
                         // search the closest bin
                         if (deltaAbove > deltaBelow)
                         {
                             closestBin = binBelow;
                         }
                         else
                         {
                             closestBin = binAbove;
                         }
                         // compute the fi interval [fi - deltaFreq * 0.285, fi + deltaFreq * 0.285]
                         fi = closestBin * deltaFreq;
                         fi_min = fi - (deltaFreq * FI_INTERVAL_COEFF);
                         fi_MAX = fi + (deltaFreq * FI_INTERVAL_COEFF);
                         //**************************************************************************************
                         // be careful here, one shall take into account that the bin 0 IS DROPPED in the spectra
                         // thus, the index 0 in a mask corresponds to the bin 1 of the spectrum
                         //**************************************************************************************
                         // 1. IF freqToFilterOut is included in [ fi_min; fi_MAX ]
                         // => remove f_(i), f_(i-1) and f_(i+1)
                         if ( ( freqToFilterOut > fi_min ) && ( freqToFilterOut < fi_MAX ) )
                         {
                             binToRemove[0] = (closestBin - 1) - 1;
                             binToRemove[1] = (closestBin)     - 1;
                             binToRemove[2] = (closestBin + 1) - 1;
                         }
                         // 2. ELSE
                         // => remove the two f_(i) which are around f_RW
                         else
                         {
                             binToRemove[0] = (binBelow) - 1;
                             binToRemove[1] = (binAbove) - 1;
                             binToRemove[2] = (-1);
                         }
                         for (k = 0; k < NB_BINS_TO_REMOVE; k++)
                         {
                             bin = binToRemove[k];
                             if ( (bin >= BIN_MIN) && (bin <= BIN_MAX) )
                             {
                                 whichByte = (bin >> SHIFT_3_BITS);    // division by 8
                                 selectedByte = ( 1 << (bin - (whichByte * BITS_PER_BYTE)) );
                                 fbins_mask[BYTES_PER_MASK - 1 - whichByte] =
                                         fbins_mask[BYTES_PER_MASK - 1 - whichByte] & ((unsigned char) (~selectedByte)); // bytes are ordered MSB first in the packets
                             }
                         }
                         // update freqToFilterOut
                         if ( freqToFilterOut == f_RW_MAX )
                         {
                             filteringSet = true;    // end of the loop
                         }
                         else
                         {
                             freqToFilterOut = freqToFilterOut + deltaFreq;
                         }
                         if ( freqToFilterOut > f_RW_MAX)
                         {
                             freqToFilterOut = f_RW_MAX;
                         }
                     }
                 }
             }
             void build_sy_lfr_rw_mask( unsigned int channel )
             {
                 unsigned char local_rw_fbins_mask[BYTES_PER_MASK];
                 unsigned char *maskPtr;
                 double deltaF;
                 unsigned k;
                 maskPtr = NULL;
                 deltaF = DELTAF_F2;
                 switch (channel)
                 {
                 case CHANNELF0:
                     maskPtr = parameter_dump_packet.sy_lfr_rw_mask_f0_word1;
                     deltaF = DELTAF_F0;
                     break;
                 case CHANNELF1:
                     maskPtr = parameter_dump_packet.sy_lfr_rw_mask_f1_word1;
                     deltaF = DELTAF_F1;
                     break;
                 case CHANNELF2:
                     maskPtr = parameter_dump_packet.sy_lfr_rw_mask_f2_word1;
                     deltaF = DELTAF_F2;
                     break;
                 default:
                     break;
                 }
                 for (k = 0; k < BYTES_PER_MASK; k++)
                 {
                     local_rw_fbins_mask[k] = INT8_ALL_F;
                 }
                 // RW1
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw1_f1, deltaF, filterPar.sy_lfr_rw1_k1 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw1_f2, deltaF, filterPar.sy_lfr_rw1_k2 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw1_f3, deltaF, filterPar.sy_lfr_rw1_k3 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw1_f4, deltaF, filterPar.sy_lfr_rw1_k4 );
                 // RW2
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw2_f1, deltaF, filterPar.sy_lfr_rw2_k1 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw2_f2, deltaF, filterPar.sy_lfr_rw2_k2 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw2_f3, deltaF, filterPar.sy_lfr_rw2_k3 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw2_f4, deltaF, filterPar.sy_lfr_rw2_k4 );
                 // RW3
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw3_f1, deltaF, filterPar.sy_lfr_rw3_k1 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw3_f2, deltaF, filterPar.sy_lfr_rw3_k2 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw3_f3, deltaF, filterPar.sy_lfr_rw3_k3 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw3_f4, deltaF, filterPar.sy_lfr_rw3_k4 );
                 // RW4
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw4_f1, deltaF, filterPar.sy_lfr_rw4_k1 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw4_f2, deltaF, filterPar.sy_lfr_rw4_k2 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw4_f3, deltaF, filterPar.sy_lfr_rw4_k3 );
                 setFBinMask( local_rw_fbins_mask, rw_f.cp_rpw_sc_rw4_f4, deltaF, filterPar.sy_lfr_rw4_k4 );
                 // update the value of the fbins related to reaction wheels frequency filtering
                 if (maskPtr != NULL)
                 {
                     for (k = 0; k < BYTES_PER_MASK; k++)
                     {
                         maskPtr[k] = local_rw_fbins_mask[k];
                     }
                 }
             }
             void build_sy_lfr_rw_masks( void )
             {
                 build_sy_lfr_rw_mask( CHANNELF0 );
                 build_sy_lfr_rw_mask( CHANNELF1 );
                 build_sy_lfr_rw_mask( CHANNELF2 );
             }
             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_f1 = parameter_dump_packet.sy_lfr_fbins_f1_word1;
                 fbins_f2 = parameter_dump_packet.sy_lfr_fbins_f2_word1;
                 rw_mask_f0 = parameter_dump_packet.sy_lfr_rw_mask_f0_word1;
                 rw_mask_f1 = parameter_dump_packet.sy_lfr_rw_mask_f1_word1;
                 rw_mask_f2 = parameter_dump_packet.sy_lfr_rw_mask_f2_word1;
                 for( k=0; k < BYTES_PER_MASK; 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_TC = TC->dataAndCRC;
                 for (k=0; k < BYTES_PER_MASKS_SET; k++)
                 {
                     fbins_mask_dump[k] = fbins_mask_TC[k];
                 }
                 return status;
             }
             //***************************
             // TC_LFR_LOAD_PAS_FILTER_PAR
             int check_sy_lfr_rw_k( ccsdsTelecommandPacket_t *TC, int offset, int* pos, float* value )
             {
                 float rw_k;
                 int ret;
                 ret = LFR_SUCCESSFUL;
                 rw_k = INIT_FLOAT;
                 copyFloatByChar( (unsigned char*) &rw_k, (unsigned char*) &TC->dataAndCRC[ offset ] );
                 *pos = offset;
                 *value = rw_k;
                 if (rw_k < MIN_SY_LFR_RW_F)
                 {
                     ret = WRONG_APP_DATA;
                 }
                 return ret;
             }
             int check_all_sy_lfr_rw_k( ccsdsTelecommandPacket_t *TC, int *pos, float *value )
             {
                 int ret;
                 ret = LFR_SUCCESSFUL;
                 //****
                 //****
                 // RW1
                 ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW1_K1, pos, value );  // K1
                 if (ret == LFR_SUCCESSFUL)  // K2
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW1_K2, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K3
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW1_K3, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K4
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW1_K4, pos, value  );
                 }
                 //****
                 //****
                 // RW2
                 if (ret == LFR_SUCCESSFUL)  // K1
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW2_K1, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K2
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW2_K2, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K3
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW2_K3, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K4
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW2_K4, pos, value  );
                 }
                 //****
                 //****
                 // RW3
                 if (ret == LFR_SUCCESSFUL)  // K1
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW3_K1, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K2
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW3_K2, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K3
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW3_K3, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K4
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW3_K4, pos, value  );
                 }
                 //****
                 //****
                 // RW4
                 if (ret == LFR_SUCCESSFUL)  // K1
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW4_K1, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K2
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW4_K2, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K3
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW4_K3, pos, value  );
                 }
                 if (ret == LFR_SUCCESSFUL)  // K4
                 {
                     ret = check_sy_lfr_rw_k( TC, DATAFIELD_POS_SY_LFR_RW4_K4, pos, value  );
                 }
                 return ret;
             }
             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;
                 int datafield_pos;
                 float rw_k;
                 flag = LFR_SUCCESSFUL;
                 sy_lfr_pas_filter_tbad  = INIT_FLOAT;
                 sy_lfr_pas_filter_shift = INIT_FLOAT;
                 sy_lfr_sc_rw_delta_f    = INIT_FLOAT;
                 parPtr = NULL;
                 datafield_pos = INIT_INT;
                 rw_k = INIT_FLOAT;
                 //***************
                 // get parameters
                 sy_lfr_pas_filter_enabled   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_ENABLED ] & BIT_PAS_FILTER_ENABLED;   // [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 < MIN_PAS_FILTER_MODULUS) || (sy_lfr_pas_filter_modulus > MAX_PAS_FILTER_MODULUS) )
                 {
                     status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS + DATAFIELD_OFFSET, sy_lfr_pas_filter_modulus );
                     flag = WRONG_APP_DATA;
                 }
                 //***********************
                 // sy_lfr_pas_filter_tbad
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( (sy_lfr_pas_filter_tbad < MIN_PAS_FILTER_TBAD) || (sy_lfr_pas_filter_tbad > MAX_PAS_FILTER_TBAD) )
                     {
                         parPtr = (char*) &sy_lfr_pas_filter_tbad;
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //*************************
                 // sy_lfr_pas_filter_offset
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( (sy_lfr_pas_filter_offset < MIN_PAS_FILTER_OFFSET) || (sy_lfr_pas_filter_offset > MAX_PAS_FILTER_OFFSET) )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET + DATAFIELD_OFFSET, sy_lfr_pas_filter_offset );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //************************
                 // sy_lfr_pas_filter_shift
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( (sy_lfr_pas_filter_shift < MIN_PAS_FILTER_SHIFT) || (sy_lfr_pas_filter_shift > MAX_PAS_FILTER_SHIFT) )
                     {
                         parPtr = (char*) &sy_lfr_pas_filter_shift;
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //*************************************
                 // check global coherency of the values
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( (sy_lfr_pas_filter_tbad + sy_lfr_pas_filter_offset + sy_lfr_pas_filter_shift) > sy_lfr_pas_filter_modulus )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS + DATAFIELD_OFFSET, sy_lfr_pas_filter_modulus );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //*********************
                 // sy_lfr_sc_rw_delta_f
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( sy_lfr_sc_rw_delta_f < MIN_SY_LFR_SC_RW_DELTA_F )
                     {
                         parPtr = (char*) &sy_lfr_pas_filter_shift;
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + DATAFIELD_OFFSET, sy_lfr_sc_rw_delta_f );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //************
                 // sy_lfr_rw_k
                 if (flag == LFR_SUCCESSFUL)
                 {
                     flag = check_all_sy_lfr_rw_k( TC, &datafield_pos, &rw_k );
                     if (flag  != LFR_SUCCESSFUL)
                     {
                         parPtr = (char*) &sy_lfr_pas_filter_shift;
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, datafield_pos + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
                     }
                 }
                 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;
                 float *kcoeffPtr_norm;
                 float *kcoeffPtr_sbm;
                 int status;
                 unsigned char *kcoeffLoadPtr;
                 unsigned char *kcoeffNormPtr;
                 unsigned char *kcoeffSbmPtr_a;
                 unsigned char *kcoeffSbmPtr_b;
                 sy_lfr_kcoeff_frequency = 0;
                 bin = 0;
                 kcoeffPtr_norm = NULL;
                 kcoeffPtr_sbm  = NULL;
                 status = LFR_SUCCESSFUL;
                 // copy the value of the frequency byte by byte DO NOT USE A SHORT* POINTER
                 copyInt16ByChar( (unsigned char*) &sy_lfr_kcoeff_frequency, &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY] );
                 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 + DATAFIELD_OFFSET + 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) * SBM_COEFF_PER_NORM_COEFF        ];
                         kcoeffSbmPtr_b= (unsigned char*) &kcoeffPtr_sbm[ (((bin * NB_K_COEFF_PER_BIN) + kcoeff) * SBM_KCOEFF_PER_NORM_KCOEFF) + 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[BYTE_0] = source[BYTE_0];
                 destination[BYTE_1] = source[BYTE_1];
                 destination[BYTE_2] = source[BYTE_2];
                 destination[BYTE_3] = source[BYTE_3];
             }
             void copyInt32ByChar( unsigned char *destination, unsigned char *source )
             {
                 destination[BYTE_0] = source[BYTE_0];
                 destination[BYTE_1] = source[BYTE_1];
                 destination[BYTE_2] = source[BYTE_2];
                 destination[BYTE_3] = source[BYTE_3];
             }
             void copyInt16ByChar( unsigned char *destination, unsigned char *source )
             {
                 destination[BYTE_0] = source[BYTE_0];
                 destination[BYTE_1] = source[BYTE_1];
             }
             void floatToChar( float value, unsigned char* ptr)
             {
                 unsigned char* valuePtr;
                 valuePtr = (unsigned char*) &value;
                 ptr[BYTE_0] = valuePtr[BYTE_0];
                 ptr[BYTE_1] = valuePtr[BYTE_1];
                 ptr[BYTE_2] = valuePtr[BYTE_2];
                 ptr[BYTE_3] = valuePtr[BYTE_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 >> SHIFT_1_BYTE);
                 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 >> SHIFT_1_BYTE);
                 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[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
                 parameter_dump_packet.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
                 parameter_dump_packet.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
                 parameter_dump_packet.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
                 parameter_dump_packet.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
                 parameter_dump_packet.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
                 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 >> SHIFT_1_BYTE);
                 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 >> SHIFT_1_BYTE);
                 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 >> SHIFT_1_BYTE);
                 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 < BYTES_PER_MASKS_SET; k++)
                 {
                     parameter_dump_packet.sy_lfr_fbins_f0_word1[k] = INT8_ALL_F;
                 }
                 // PAS FILTER PARAMETERS
                 parameter_dump_packet.pa_rpw_spare8_2                   = INIT_CHAR;
                 parameter_dump_packet.spare_sy_lfr_pas_filter_enabled   = INIT_CHAR;
                 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 );
                 // RW1_K
                 floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw1_k1);
                 floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw1_k2);
                 floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw1_k3);
                 floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw1_k4);
                 // RW2_K
                 floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw2_k1);
                 floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw2_k2);
                 floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw2_k3);
                 floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw2_k4);
                 // RW3_K
                 floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw3_k1);
                 floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw3_k2);
                 floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw3_k3);
                 floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw3_k4);
                 // RW4_K
                 floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw4_k1);
                 floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw4_k2);
                 floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw4_k3);
                 floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw4_k4);
                 // LFR_RW_MASK
                 for (k=0; k < BYTES_PER_MASKS_SET; k++)
                 {
                     parameter_dump_packet.sy_lfr_rw_mask_f0_word1[k] = INT8_ALL_F;
                 }
                 // once the reaction wheels masks have been initialized, they have to be merged with the fbins masks
                 merge_fbins_masks();
             }
             void init_kcoefficients_dump( void )
             {
                 init_kcoefficients_dump_packet( &kcoefficients_dump_1, PKTNR_1, KCOEFF_BLK_NR_PKT1 );
                 init_kcoefficients_dump_packet( &kcoefficients_dump_2, PKTNR_2, KCOEFF_BLK_NR_PKT2  );
                 kcoefficient_node_1.previous = NULL;
                 kcoefficient_node_1.next = NULL;
                 kcoefficient_node_1.sid = TM_CODE_K_DUMP;
                 kcoefficient_node_1.coarseTime = INIT_CHAR;
                 kcoefficient_node_1.fineTime = INIT_CHAR;
                 kcoefficient_node_1.buffer_address = (int) &kcoefficients_dump_1;
                 kcoefficient_node_1.status = INIT_CHAR;
                 kcoefficient_node_2.previous = NULL;
                 kcoefficient_node_2.next = NULL;
                 kcoefficient_node_2.sid = TM_CODE_K_DUMP;
                 kcoefficient_node_2.coarseTime = INIT_CHAR;
                 kcoefficient_node_2.fineTime = INIT_CHAR;
                 kcoefficient_node_2.buffer_address = (int) &kcoefficients_dump_2;
                 kcoefficient_node_2.status = INIT_CHAR;
             }
             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 * KCOEFF_BLK_SIZE) + BYTE_POS_KCOEFFICIENTS_PARAMETES) - 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 >> SHIFT_1_BYTE);
                 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 >> SHIFT_1_BYTE);
                 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[BYTE_0] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_1] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_2] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_3] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_4] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_5] = INIT_CHAR;
                 kcoefficients_dump->sid = SID_K_DUMP;
                 kcoefficients_dump->pkt_cnt = KCOEFF_PKTCNT;
                 kcoefficients_dump->pkt_nr = PKTNR_1;
                 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<(KCOEFF_BLK_NR_PKT1 * KCOEFF_BLK_SIZE); k++)
                 {
                     kcoefficients_dump->kcoeff_blks[k] = INIT_CHAR;
                 }
             }
             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 << SHIFT_1_BYTE;
                 sequence_cnt                = sequenceCounters_TM_DUMP[ i ] & SEQ_CNT_MASK;
                 new_packet_sequence_control = segmentation_grouping_flag | sequence_cnt ;
                 packet_sequence_control[0] = (unsigned char) (new_packet_sequence_control >> SHIFT_1_BYTE);
                 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