HG_REPOSITORIES/LPP/INSTRUMENTATION/USERS/JEANDET/LFR_FSW Commit - r385:bd1252670981

Removed all remaining unused macros and fixed bug...

jeandet -

parent child

Context file:

r385:bd1252670981

.hgsubstate +1 -1

@@ -1,2 +1,2
1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters	1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters
2	0adeb6c86feb96a126ce48641604949b87c70481 header/lfr_common_headers	2	042275d1388a0f360073a0d85bf50d128f4b8cfc header/lfr_common_headers

src/CMakeLists.txt +4 -1

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

src/fsw_globals.c +3 -3

             /** Global variables of the LFR flight software.
              *
              * @file
              * @author P. LEROY
              *
              * Among global variables, there are:
              * - RTEMS names and id.
              * - APB configuration registers.
              * - waveforms global buffers, used by the waveform picker hardware module to store data.
              * - spectral  matrices buffesr, used by the hardware module to store data.
              * - variable related to LFR modes parameters.
              * - the global HK packet buffer.
              * - the global dump parameter buffer.
              *
              */
             #include <rtems.h>
             #include <grspw.h>
             #include "ccsds_types.h"
             #include "grlib_regs.h"
             #include "fsw_params.h"
             #include "fsw_params_wf_handler.h"
-            #define NB_OF_TASKS 20
             #define NB_OF_MISC_NAMES 5
             // RTEMS GLOBAL VARIABLES
             rtems_name  misc_name[NB_OF_MISC_NAMES] = {0};
-            rtems_name  Task_name[NB_OF_TASKS]      = {0};     /* array of task names */
+            rtems_name  Task_name[CONFIGURE_MAXIMUM_TASKS-1]      = {0};     /* array of task names */
-            rtems_id    Task_id[NB_OF_TASKS]        = {0};         /* array of task ids */
+            rtems_id    Task_id[CONFIGURE_MAXIMUM_TASKS-1]        = {0};         /* array of task ids */
             rtems_name timecode_timer_name          = 0;
             rtems_id timecode_timer_id              = RTEMS_ID_NONE;
             rtems_name name_hk_rate_monotonic       = 0;            // name of the HK rate monotonic
             rtems_id HK_id                          = RTEMS_ID_NONE;// id of the HK rate monotonic period
             rtems_name name_avgv_rate_monotonic     = 0;            // name of the AVGV rate monotonic
             rtems_id AVGV_id                        = RTEMS_ID_NONE;// id of the AVGV rate monotonic period
             int fdSPW = 0;
             int fdUART = 0;
             unsigned char lfrCurrentMode = 0;
             unsigned char pa_bia_status_info = 0;
             unsigned char thisIsAnASMRestart = 0;
             unsigned char oneTcLfrUpdateTimeReceived = 0;
             // WAVEFORMS GLOBAL VARIABLES   // 2048 * 3 * 4 + 2 * 4 = 24576 + 8 bytes = 24584
                                             //  97 * 256 = 24832 => delta = 248 bytes = 62 words
             // WAVEFORMS GLOBAL VARIABLES   // 2688 * 3 * 4 + 2 * 4 = 32256 + 8 bytes = 32264
                                             // 127 * 256 = 32512 => delta = 248 bytes = 62 words
             // F0 F1 F2 F3
             volatile int wf_buffer_f0[ NB_RING_NODES_F0 * WFRM_BUFFER ] __attribute__((aligned(0x100))) = {0};
             volatile int wf_buffer_f1[ NB_RING_NODES_F1 * WFRM_BUFFER ] __attribute__((aligned(0x100))) = {0};
             volatile int wf_buffer_f2[ NB_RING_NODES_F2 * WFRM_BUFFER ] __attribute__((aligned(0x100))) = {0};
             volatile int wf_buffer_f3[ NB_RING_NODES_F3 * WFRM_BUFFER ] __attribute__((aligned(0x100))) = {0};
             //***********************************
             // SPECTRAL MATRICES GLOBAL VARIABLES
             // alignment constraints for the spectral matrices buffers => the first data after the time (8 bytes) shall be aligned on 0x00
             volatile int sm_f0[ NB_RING_NODES_SM_F0 * TOTAL_SIZE_SM ] __attribute__((aligned(0x100))) = {0};
             volatile int sm_f1[ NB_RING_NODES_SM_F1 * TOTAL_SIZE_SM ] __attribute__((aligned(0x100))) = {0};
             volatile int sm_f2[ NB_RING_NODES_SM_F2 * TOTAL_SIZE_SM ] __attribute__((aligned(0x100))) = {0};
             // APB CONFIGURATION REGISTERS
             time_management_regs_t          *time_management_regs   = (time_management_regs_t*)         REGS_ADDR_TIME_MANAGEMENT;
             gptimer_regs_t                  *gptimer_regs           = (gptimer_regs_t *)                REGS_ADDR_GPTIMER;
             waveform_picker_regs_0_1_18_t   *waveform_picker_regs   = (waveform_picker_regs_0_1_18_t*)  REGS_ADDR_WAVEFORM_PICKER;
             spectral_matrix_regs_t          *spectral_matrix_regs   = (spectral_matrix_regs_t*)         REGS_ADDR_SPECTRAL_MATRIX;
             // MODE PARAMETERS
             Packet_TM_LFR_PARAMETER_DUMP_t parameter_dump_packet    = {0};
             struct param_local_str param_local                      = {0};
             unsigned int lastValidEnterModeTime                     = {0};
             // HK PACKETS
             Packet_TM_LFR_HK_t housekeeping_packet                  = {0};
             // message queues occupancy
             unsigned char hk_lfr_q_sd_fifo_size_max = 0;
             unsigned char hk_lfr_q_rv_fifo_size_max = 0;
             unsigned char hk_lfr_q_p0_fifo_size_max = 0;
             unsigned char hk_lfr_q_p1_fifo_size_max = 0;
             unsigned char hk_lfr_q_p2_fifo_size_max = 0;
             // sequence counters are incremented by APID (PID + CAT) and destination ID
             unsigned short sequenceCounters_SCIENCE_NORMAL_BURST        __attribute__((aligned(0x4))) = 0;
             unsigned short sequenceCounters_SCIENCE_SBM1_SBM2           __attribute__((aligned(0x4))) = 0;
             unsigned short sequenceCounters_TC_EXE[SEQ_CNT_NB_DEST_ID]  __attribute__((aligned(0x4))) = {0};
             unsigned short sequenceCounters_TM_DUMP[SEQ_CNT_NB_DEST_ID] __attribute__((aligned(0x4))) = {0};
             unsigned short sequenceCounterHK                            __attribute__((aligned(0x4))) = {0};
             spw_stats grspw_stats                                       __attribute__((aligned(0x4))) = {0};
             // TC_LFR_UPDATE_INFO
             rw_f_t rw_f;
             // TC_LFR_LOAD_FILTER_PAR
             filterPar_t filterPar = {0};
             fbins_masks_t fbins_masks = {0};

src/fsw_init.c +32 -30

             /** 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
+            #include <fsw_params.h>
-            #define CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
-            #define CONFIGURE_MAXIMUM_TASKS 23 // 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
+                #ifdef LEON3
-            /* Add Timer and UART Driver */
+                /* Add Timer and UART Driver */
-            #ifdef CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
+                    #ifdef CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
-            #define CONFIGURE_DRIVER_AMBAPP_GAISLER_GPTIMER
+                        #define CONFIGURE_DRIVER_AMBAPP_GAISLER_GPTIMER
-            #endif
+                    #endif
-            #ifdef CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
+                    #ifdef CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
-            #define CONFIGURE_DRIVER_AMBAPP_GAISLER_APBUART
+                        #define CONFIGURE_DRIVER_AMBAPP_GAISLER_APBUART
-            #endif
+                    #endif
-            #endif
+                #endif
-            #define CONFIGURE_DRIVER_AMBAPP_GAISLER_GRSPW   /* GRSPW Driver */
+                #define CONFIGURE_DRIVER_AMBAPP_GAISLER_GRSPW   /* GRSPW Driver */
+                #include <drvmgr/drvmgr_confdefs.h>
-            #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_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_shift           = DEFAULT_SY_LFR_PAS_FILTER_SHIFT;
                 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' );
                 Task_name[TASKID_SCRB] = rtems_build_name( 'S', 'C', 'R', 'B' );
                 Task_name[TASKID_CALI] = rtems_build_name( 'C', 'A', 'L', 'I' );
                 // 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) // SCRUBBING TASK
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_SCRB], TASK_PRIORITY_SCRB, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_SCRB]
                     );
                 }
                 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]
                                 );
                 }
                 if (status == RTEMS_SUCCESSFUL) // CALI
                 {
                     status = rtems_task_create(
                                 Task_name[TASKID_CALI], TASK_PRIORITY_CALI, RTEMS_MINIMUM_STACK_SIZE,
                                 RTEMS_DEFAULT_MODES,
                                 RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_CALI]
                                 );
                 }
                 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)     // SCRUBBING
                 {
                     status = rtems_task_start( Task_id[TASKID_SCRB], scrubbing_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")
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)     // CALI
                 {
                     status = rtems_task_start( Task_id[TASKID_CALI], calibration_sweep_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 create_message_queues( void ) // create the five 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;
             }
+            /**
+             * @brief update_queue_max_count returns max(fifo_size_max, pending_messages + 1)
+             * @param queue_id
+             * @param fifo_size_max
+             */
             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;
                     }
                 }
             }
+            /**
+             * @brief init_ring initializes given ring buffer
+             * @param ring array of nodes to initialize
+             * @param nbNodes number of node in the ring buffer
+             * @param buffer memory space given to the ring buffer
+             * @param bufferSize size of the whole ring buffer memory space
+             *
+             * @details This function creates a circular buffer from a given number of nodes and a given memory space. It first sets all nodes attributes to thier defaults values
+             * and associates a portion of the given memory space with each node. Then it connects each nodes to build a circular buffer.
+             *
+             * Each node capacity will be bufferSize/nbNodes.
+             *
+             * https://en.wikipedia.org/wiki/Circular_buffer
+             */
             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/fsw_spacewire.c +12 -37

             /** Functions related to the SpaceWire interface.
              *
              * @file
              * @author P. LEROY
              *
              * A group of functions to handle SpaceWire transmissions:
              * - configuration of the SpaceWire link
              * - SpaceWire related interruption requests processing
              * - transmission of TeleMetry packets by a dedicated RTEMS task
              * - reception of TeleCommands by a dedicated RTEMS task
              *
              */
             #include "fsw_spacewire.h"
             rtems_name semq_name    = 0;
             rtems_id semq_id        = RTEMS_ID_NONE;
             //*****************
             // waveform headers
             Header_TM_LFR_SCIENCE_CWF_t headerCWF = {0};
             Header_TM_LFR_SCIENCE_SWF_t headerSWF = {0};
             Header_TM_LFR_SCIENCE_ASM_t headerASM = {0};
             unsigned char previousTimecodeCtr = 0;
             unsigned int *grspwPtr = (unsigned int *) (REGS_ADDR_GRSPW + APB_OFFSET_GRSPW_TIME_REGISTER);
             //***********
             // RTEMS TASK
             rtems_task spiq_task(rtems_task_argument unused)
             {
                 /** This RTEMS task is awaken by an rtems_event sent by the interruption subroutine of the SpaceWire driver.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  */
                 rtems_event_set event_out;
                 rtems_status_code status;
                 int linkStatus;
                 event_out = EVENT_SETS_NONE_PENDING;
                 linkStatus = 0;
                 BOOT_PRINTF("in SPIQ *** \n")
                 while(true){
                     rtems_event_receive(SPW_LINKERR_EVENT, RTEMS_WAIT, RTEMS_NO_TIMEOUT, &event_out); // wait for an SPW_LINKERR_EVENT
                     PRINTF("in SPIQ *** got SPW_LINKERR_EVENT\n")
                     // [0] SUSPEND RECV AND SEND TASKS
                     status = rtems_task_suspend( Task_id[ TASKID_RECV ] );
                     if ( status != RTEMS_SUCCESSFUL ) {
                         PRINTF("in SPIQ *** ERR suspending RECV Task\n")
                     }
                     status = rtems_task_suspend( Task_id[ TASKID_SEND ] );
                     if ( status != RTEMS_SUCCESSFUL ) {
                         PRINTF("in SPIQ *** ERR suspending SEND Task\n")
                     }
                     // [1] CHECK THE LINK
                     status = ioctl(fdSPW, SPACEWIRE_IOCTRL_GET_LINK_STATUS, &linkStatus);   // get the link status (1)
                     if ( linkStatus != SPW_LINK_OK) {
                         PRINTF1("in SPIQ *** linkStatus %d, wait...\n", linkStatus)
                         status = rtems_task_wake_after( SY_LFR_DPU_CONNECT_TIMEOUT );        // wait SY_LFR_DPU_CONNECT_TIMEOUT 1000 ms
                     }
                     // [2] RECHECK THE LINK AFTER SY_LFR_DPU_CONNECT_TIMEOUT
                     status = ioctl(fdSPW, SPACEWIRE_IOCTRL_GET_LINK_STATUS, &linkStatus);   // get the link status (2)
                     if ( linkStatus != SPW_LINK_OK )  // [2.a] not in run state, reset the link
                     {
                         spacewire_read_statistics();
                         status = spacewire_several_connect_attemps( );
                     }
                     else                    // [2.b] in run state, start the link
                     {
                         status = spacewire_stop_and_start_link( fdSPW ); // start the link
                         if ( status != RTEMS_SUCCESSFUL)
                         {
                             PRINTF1("in SPIQ *** ERR spacewire_stop_and_start_link %d\n", status)
                         }
                     }
                     // [3] COMPLETE RECOVERY ACTION AFTER SY_LFR_DPU_CONNECT_ATTEMPTS
                     if ( status == RTEMS_SUCCESSFUL )   // [3.a] the link is in run state and has been started successfully
                     {
                         status = rtems_task_restart( Task_id[ TASKID_SEND ], 1 );
                         if ( status != RTEMS_SUCCESSFUL ) {
                             PRINTF("in SPIQ *** ERR resuming SEND Task\n")
                         }
                         status = rtems_task_restart( Task_id[ TASKID_RECV ], 1 );
                         if ( status != RTEMS_SUCCESSFUL ) {
                             PRINTF("in SPIQ *** ERR resuming RECV Task\n")
                         }
                     }
                     else                                // [3.b] the link is not in run state, go in STANDBY mode
                     {
                         status = enter_mode_standby();
                         if ( status != RTEMS_SUCCESSFUL )
                         {
                             PRINTF1("in SPIQ *** ERR enter_standby_mode *** code %d\n", status)
                         }
                         {
                             updateLFRCurrentMode( LFR_MODE_STANDBY );
                         }
                         // wake the LINK task up to wait for the link recovery
                         status =  rtems_event_send ( Task_id[TASKID_LINK], RTEMS_EVENT_0 );
                         status = rtems_task_suspend( RTEMS_SELF );
                     }
                 }
             }
             rtems_task recv_task( rtems_task_argument unused )
             {
                 /** This RTEMS task is dedicated to the reception of incoming TeleCommands.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The RECV task blocks on a call to the read system call, waiting for incoming SpaceWire data. When unblocked:
                  * 1. It reads the incoming data.
                  * 2. Launches the acceptance procedure.
                  * 3. If the Telecommand is valid, sends it to a dedicated RTEMS message queue.
                  *
                  */
                 int len;
                 ccsdsTelecommandPacket_t __attribute__((aligned(4))) currentTC;
                 unsigned char computed_CRC[ BYTES_PER_CRC ];
                 unsigned char currentTC_LEN_RCV[ BYTES_PER_PKT_LEN ];
                 unsigned char destinationID;
                 unsigned int estimatedPacketLength;
                 unsigned int parserCode;
                 rtems_status_code status;
                 rtems_id queue_recv_id;
                 rtems_id queue_send_id;
                 memset( &currentTC, 0, sizeof(ccsdsTelecommandPacket_t) );
                 destinationID = 0;
                 queue_recv_id = RTEMS_ID_NONE;
                 queue_send_id = RTEMS_ID_NONE;
                 initLookUpTableForCRC(); // the table is used to compute Cyclic Redundancy Codes
                 status =  get_message_queue_id_recv( &queue_recv_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in RECV *** ERR get_message_queue_id_recv %d\n", status)
                 }
                 status =  get_message_queue_id_send( &queue_send_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in RECV *** ERR get_message_queue_id_send %d\n", status)
                 }
                 BOOT_PRINTF("in RECV *** \n")
                 while(1)
                 {
                     len = read( fdSPW, (char*) &currentTC, CCSDS_TC_PKT_MAX_SIZE ); // the call to read is blocking
                     if (len == -1){ // error during the read call
                         PRINTF1("in RECV *** last read call returned -1, ERRNO %d\n", errno)
                     }
                     else {
                         if ( (len+1) < CCSDS_TC_PKT_MIN_SIZE ) {
                             PRINTF("in RECV *** packet lenght too short\n")
                         }
                         else {
                             estimatedPacketLength = (unsigned int) (len - CCSDS_TC_TM_PACKET_OFFSET - PROTID_RES_APP); // => -3 is for Prot ID, Reserved and User App bytes
                             PRINTF1("incoming TC with Length (byte): %d\n", len - 3);
                             currentTC_LEN_RCV[ 0 ] = (unsigned char) (estimatedPacketLength >> SHIFT_1_BYTE);
                             currentTC_LEN_RCV[ 1 ] = (unsigned char) (estimatedPacketLength     );
                             // CHECK THE TC
                             parserCode = tc_parser( &currentTC, estimatedPacketLength, computed_CRC ) ;
                             if ( (parserCode == ILLEGAL_APID)       || (parserCode == WRONG_LEN_PKT)
                                  || (parserCode == INCOR_CHECKSUM)  || (parserCode == ILL_TYPE)
                                  || (parserCode == ILL_SUBTYPE)     || (parserCode == WRONG_APP_DATA)
                                  || (parserCode == WRONG_SRC_ID) )
                             { // send TM_LFR_TC_EXE_CORRUPTED
                                 PRINTF1("TC corrupted received, with code: %d\n", parserCode);
                                 if ( !( (currentTC.serviceType==TC_TYPE_TIME) && (currentTC.serviceSubType==TC_SUBTYPE_UPDT_TIME) )
                                      &&
                                      !( (currentTC.serviceType==TC_TYPE_GEN) && (currentTC.serviceSubType==TC_SUBTYPE_UPDT_INFO))
                                      )
                                 {
                                     if ( parserCode == WRONG_SRC_ID )
                                     {
                                         destinationID = SID_TC_GROUND;
                                     }
                                     else
                                     {
                                         destinationID = currentTC.sourceID;
                                     }
                                     send_tm_lfr_tc_exe_corrupted( &currentTC, queue_send_id,
                                                                   computed_CRC, currentTC_LEN_RCV,
                                                                   destinationID );
                                 }
                             }
                             else
                             { // send valid TC to the action launcher
                                 status =  rtems_message_queue_send( queue_recv_id, &currentTC,
                                                                     estimatedPacketLength + CCSDS_TC_TM_PACKET_OFFSET + PROTID_RES_APP);
                             }
                         }
                     }
                     update_queue_max_count( queue_recv_id, &hk_lfr_q_rv_fifo_size_max );
                 }
             }
             rtems_task send_task( rtems_task_argument argument)
             {
                 /** This RTEMS task is dedicated to the transmission of TeleMetry packets.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The SEND task waits for a message to become available in the dedicated RTEMS queue. When a message arrives:
                  * - if the first byte is equal to CCSDS_DESTINATION_ID, the message is sent as is using the write system call.
                  * - if the first byte is not equal to CCSDS_DESTINATION_ID, the message is handled as a spw_ioctl_pkt_send. After
                  * analyzis, the packet is sent either using the write system call or using the ioctl call SPACEWIRE_IOCTRL_SEND, depending on the
                  * data it contains.
                  *
                  */
                 rtems_status_code status;                // RTEMS status code
                 char incomingData[MSG_QUEUE_SIZE_SEND];  // incoming data buffer
                 ring_node *incomingRingNodePtr;
                 int ring_node_address;
                 char *charPtr;
                 spw_ioctl_pkt_send *spw_ioctl_send;
                 size_t size;                            // size of the incoming TC packet
                 rtems_id queue_send_id;
                 unsigned int sid;
                 unsigned char sidAsUnsignedChar;
                 unsigned char type;
                 incomingRingNodePtr = NULL;
                 ring_node_address = 0;
                 charPtr = (char *) &ring_node_address;
                 size = 0;
                 queue_send_id = RTEMS_ID_NONE;
                 sid = 0;
                 sidAsUnsignedChar = 0;
                 init_header_cwf( &headerCWF );
                 init_header_swf( &headerSWF );
                 init_header_asm( &headerASM );
                 status =  get_message_queue_id_send( &queue_send_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in HOUS *** ERR get_message_queue_id_send %d\n", status)
                 }
                 BOOT_PRINTF("in SEND *** \n")
                 while(1)
                 {
                     status = rtems_message_queue_receive( queue_send_id, incomingData, &size,
                                                          RTEMS_WAIT, RTEMS_NO_TIMEOUT );
                     if (status!=RTEMS_SUCCESSFUL)
                     {
                         PRINTF1("in SEND *** (1) ERR = %d\n", status)
                     }
                     else
                     {
                         if ( size == sizeof(ring_node*) )
                         {
                             charPtr[0] = incomingData[0];
                             charPtr[1] = incomingData[1];
                             charPtr[BYTE_2] = incomingData[BYTE_2];
                             charPtr[BYTE_3] = incomingData[BYTE_3];
                             incomingRingNodePtr = (ring_node*) ring_node_address;
                             sid = incomingRingNodePtr->sid;
                             if ( (sid==SID_NORM_CWF_LONG_F3)
                                  || (sid==SID_BURST_CWF_F2 )
                                  || (sid==SID_SBM1_CWF_F1  )
                                  || (sid==SID_SBM2_CWF_F2  ))
                             {
                                 spw_send_waveform_CWF( incomingRingNodePtr, &headerCWF );
                             }
-                            else if ( (sid==SID_NORM_SWF_F0) || (sid== SID_NORM_SWF_F1) || (sid==SID_NORM_SWF_F2) )
+                            else if ( (sid==SID_NORM_SWF_F0) || (sid==SID_NORM_SWF_F1) || (sid==SID_NORM_SWF_F2) )
                             {
                                 spw_send_waveform_SWF( incomingRingNodePtr, &headerSWF );
                             }
-                            else if ( (sid==SID_NORM_CWF_F3) )
+                            else if (sid==SID_NORM_CWF_F3)
                             {
                                 spw_send_waveform_CWF3_light( incomingRingNodePtr, &headerCWF );
                             }
                             else if (sid==SID_NORM_ASM_F0)
                             {
                                 spw_send_asm_f0( incomingRingNodePtr, &headerASM );
                             }
                             else if (sid==SID_NORM_ASM_F1)
                             {
                                 spw_send_asm_f1( incomingRingNodePtr, &headerASM );
                             }
                             else if (sid==SID_NORM_ASM_F2)
                             {
                                 spw_send_asm_f2( incomingRingNodePtr, &headerASM );
                             }
-                            else if ( sid==TM_CODE_K_DUMP )
+                            else if (sid==TM_CODE_K_DUMP)
                             {
                                 spw_send_k_dump( incomingRingNodePtr );
                             }
                             else
                             {
                                 PRINTF1("unexpected sid = %d\n", sid);
                             }
                         }
                         else if ( incomingData[0] == CCSDS_DESTINATION_ID ) // the incoming message is a ccsds packet
                         {
                             sidAsUnsignedChar = (unsigned char) incomingData[ PACKET_POS_PA_LFR_SID_PKT ];
                             sid = sidAsUnsignedChar;
                             type = (unsigned char) incomingData[ PACKET_POS_SERVICE_TYPE ];
                             if (type == TM_TYPE_LFR_SCIENCE)    // this is a BP packet, all other types are handled differently
                             // SET THE SEQUENCE_CNT PARAMETER IN CASE OF BP0 OR BP1 PACKETS
                             {
                                 increment_seq_counter_source_id( (unsigned char*) &incomingData[ PACKET_POS_SEQUENCE_CNT ], sid );
                             }
                             status = write( fdSPW, incomingData, size );
                             if (status == -1){
                                 PRINTF2("in SEND *** (2.a) ERRNO = %d, size = %d\n", errno, size)
                             }
                         }
                         else // the incoming message is a spw_ioctl_pkt_send structure
                         {
                             spw_ioctl_send = (spw_ioctl_pkt_send*) incomingData;
                             status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, spw_ioctl_send );
                             if (status == -1){
                                 PRINTF2("in SEND *** (2.b) ERRNO = %d, RTEMS = %d\n", errno, status)
                             }
                         }
                     }
                     update_queue_max_count( queue_send_id, &hk_lfr_q_sd_fifo_size_max );
                 }
             }
             rtems_task link_task( rtems_task_argument argument )
             {
                 rtems_event_set event_out;
                 rtems_status_code status;
                 int linkStatus;
                 event_out = EVENT_SETS_NONE_PENDING;
                 linkStatus = 0;
                 BOOT_PRINTF("in LINK ***\n")
                 while(1)
                 {
                     // wait for an RTEMS_EVENT
                     rtems_event_receive( RTEMS_EVENT_0,
                                         RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);
                     PRINTF("in LINK *** wait for the link\n")
                     status = ioctl(fdSPW, SPACEWIRE_IOCTRL_GET_LINK_STATUS, &linkStatus);       // get the link status
                     while( linkStatus != SPW_LINK_OK)                                           // wait for the link
                     {
                         status = rtems_task_wake_after( SPW_LINK_WAIT );                        // monitor the link each 100ms
                         status = ioctl(fdSPW, SPACEWIRE_IOCTRL_GET_LINK_STATUS, &linkStatus);   // get the link status
                         watchdog_reload();
                     }
                     spacewire_read_statistics();
                     status = spacewire_stop_and_start_link( fdSPW );
                     if (status != RTEMS_SUCCESSFUL)
                     {
                         PRINTF1("in LINK *** ERR link not started %d\n", status)
                     }
                     else
                     {
                         PRINTF("in LINK *** OK  link started\n")
                     }
                     // restart the SPIQ task
                     status = rtems_task_restart( Task_id[TASKID_SPIQ], 1 );
                     if ( status != RTEMS_SUCCESSFUL ) {
                         PRINTF("in SPIQ *** ERR restarting SPIQ Task\n")
                     }
                     // restart RECV and SEND
                     status = rtems_task_restart( Task_id[ TASKID_SEND ], 1 );
                     if ( status != RTEMS_SUCCESSFUL ) {
                         PRINTF("in SPIQ *** ERR restarting SEND Task\n")
                     }
                     status = rtems_task_restart( Task_id[ TASKID_RECV ], 1 );
                     if ( status != RTEMS_SUCCESSFUL ) {
                         PRINTF("in SPIQ *** ERR restarting RECV Task\n")
                     }
                 }
             }
             //****************
             // OTHER FUNCTIONS
             int spacewire_open_link( void )  // by default, the driver resets the core: [SPW_CTRL_WRITE(pDev, SPW_CTRL_RESET);]
             {
                 /** This function opens the SpaceWire link.
                  *
                  * @return a valid file descriptor in case of success, -1 in case of a failure
                  *
                  */
                 rtems_status_code status;
                 status = RTEMS_SUCCESSFUL;
                 fdSPW = open(GRSPW_DEVICE_NAME, O_RDWR); // open the device. the open call resets the hardware
                 if ( fdSPW < 0 ) {
                     PRINTF1("ERR *** in configure_spw_link *** error opening "GRSPW_DEVICE_NAME" with ERR %d\n", errno)
                 }
                 else
                 {
                     status = RTEMS_SUCCESSFUL;
                 }
                 return status;
             }
             int spacewire_start_link( int fd )
             {
                 rtems_status_code status;
                 status = ioctl( fd, SPACEWIRE_IOCTRL_START, -1); // returns successfuly if the link is started
                                                                     // -1 default hardcoded driver timeout
                 return status;
             }
             int spacewire_stop_and_start_link( int fd )
             {
                 rtems_status_code status;
                 status = ioctl( fd, SPACEWIRE_IOCTRL_STOP);      // start fails if link pDev->running != 0
                 status = ioctl( fd, SPACEWIRE_IOCTRL_START, -1); // returns successfuly if the link is started
                                                                     // -1 default hardcoded driver timeout
                 return status;
             }
             int spacewire_configure_link( int fd )
             {
                 /** This function configures the SpaceWire link.
                  *
                  * @return GR-RTEMS-DRIVER directive status codes:
                  * - 22  EINVAL - Null pointer or an out of range value was given as the argument.
                  * - 16  EBUSY - Only used for SEND. Returned when no descriptors are avialble in non-blocking mode.
                  * - 88  ENOSYS - Returned for SET_DESTKEY if RMAP command handler is not available or if a non-implemented call is used.
                  * - 116 ETIMEDOUT - REturned for SET_PACKET_SIZE and START if the link could not be brought up.
                  * - 12  ENOMEM - Returned for SET_PACKETSIZE if it was unable to allocate the new buffers.
                  * - 5   EIO - Error when writing to grswp hardware registers.
                  * - 2   ENOENT - No such file or directory
                  */
                 rtems_status_code status;
                 spacewire_set_NP(1, REGS_ADDR_GRSPW); // [N]o [P]ort force
                 spacewire_set_RE(1, REGS_ADDR_GRSPW); // [R]MAP [E]nable, the dedicated call seems to  break the no port force configuration
                 spw_ioctl_packetsize packetsize;
                 packetsize.rxsize   = SPW_RXSIZE;
                 packetsize.txdsize  = SPW_TXDSIZE;
                 packetsize.txhsize  = SPW_TXHSIZE;
                 status = ioctl(fd, SPACEWIRE_IOCTRL_SET_RXBLOCK, 1);              // sets the blocking mode for reception
                 if (status!=RTEMS_SUCCESSFUL) {
                     PRINTF("in SPIQ *** Error SPACEWIRE_IOCTRL_SET_RXBLOCK\n")
                 }
                 //
                 status = ioctl(fd, SPACEWIRE_IOCTRL_SET_EVENT_ID, Task_id[TASKID_SPIQ]); // sets the task ID to which an event is sent when a
                 if (status!=RTEMS_SUCCESSFUL) {
                     PRINTF("in SPIQ *** Error SPACEWIRE_IOCTRL_SET_EVENT_ID\n")          // link-error interrupt occurs
                 }
                 //
                 status = ioctl(fd, SPACEWIRE_IOCTRL_SET_DISABLE_ERR, 0);          // automatic link-disabling due to link-error interrupts
                 if (status!=RTEMS_SUCCESSFUL) {
                     PRINTF("in SPIQ *** Error SPACEWIRE_IOCTRL_SET_DISABLE_ERR\n")
                 }
                 //
                 status = ioctl(fd, SPACEWIRE_IOCTRL_SET_LINK_ERR_IRQ, 1);         // sets the link-error interrupt bit
                 if (status!=RTEMS_SUCCESSFUL) {
                     PRINTF("in SPIQ *** Error SPACEWIRE_IOCTRL_SET_LINK_ERR_IRQ\n")
                 }
                 //
                 status = ioctl(fd, SPACEWIRE_IOCTRL_SET_TXBLOCK, 1);              // transmission blocks
                 if (status!=RTEMS_SUCCESSFUL) {
                     PRINTF("in SPIQ *** Error SPACEWIRE_IOCTRL_SET_TXBLOCK\n")
                 }
                 //
                 status = ioctl(fd, SPACEWIRE_IOCTRL_SET_TXBLOCK_ON_FULL, 1);      // transmission blocks when no transmission descriptor is available
                 if (status!=RTEMS_SUCCESSFUL) {
                     PRINTF("in SPIQ *** Error SPACEWIRE_IOCTRL_SET_TXBLOCK_ON_FULL\n")
                 }
                 //
                 status = ioctl(fd, SPACEWIRE_IOCTRL_SET_TCODE_CTRL, CONF_TCODE_CTRL); // [Time Rx : Time Tx : Link error : Tick-out IRQ]
                 if (status!=RTEMS_SUCCESSFUL) {
                     PRINTF("in SPIQ *** Error SPACEWIRE_IOCTRL_SET_TCODE_CTRL,\n")
                 }
                 //
                 status = ioctl(fd, SPACEWIRE_IOCTRL_SET_PACKETSIZE, packetsize); // set rxsize, txdsize and txhsize
                 if (status!=RTEMS_SUCCESSFUL) {
                     PRINTF("in SPIQ *** Error SPACEWIRE_IOCTRL_SET_PACKETSIZE,\n")
                 }
                 return status;
             }
             int spacewire_several_connect_attemps( void )
             {
                 /** This function is executed by the SPIQ rtems_task wehn it has been awaken by an interruption raised by the SpaceWire driver.
                  *
                  * @return RTEMS directive status code:
                  * - RTEMS_UNSATISFIED is returned is the link is not in the running state after 10 s.
                  * - RTEMS_SUCCESSFUL is returned if the link is up before the timeout.
                  *
                  */
                 rtems_status_code status_spw;
                 rtems_status_code status;
                 int i;
                 status_spw = RTEMS_SUCCESSFUL;
                 i = 0;
                 while (i < SY_LFR_DPU_CONNECT_ATTEMPT)
                 {
                     PRINTF1("in spacewire_reset_link *** link recovery, try %d\n", i);
                     // CLOSING THE DRIVER AT THIS POINT WILL MAKE THE SEND TASK BLOCK THE SYSTEM
                     status = rtems_task_wake_after( SY_LFR_DPU_CONNECT_TIMEOUT );        // wait SY_LFR_DPU_CONNECT_TIMEOUT 1000 ms
                     status_spw = spacewire_stop_and_start_link( fdSPW );
                     if (  status_spw != RTEMS_SUCCESSFUL )
                     {
                         i = i + 1;
                         PRINTF1("in spacewire_reset_link *** ERR spacewire_start_link code %d\n",  status_spw);
                     }
                     else
                     {
                         i = SY_LFR_DPU_CONNECT_ATTEMPT;
                     }
                 }
                 return status_spw;
             }
             void spacewire_set_NP( unsigned char val, unsigned int regAddr ) // [N]o [P]ort force
             {
                 /** This function sets the [N]o [P]ort force bit of the GRSPW control register.
                  *
                  * @param val is the value, 0 or 1, used to set the value of the NP bit.
                  * @param regAddr is the address of the GRSPW control register.
                  *
                  * NP is the bit 20 of the GRSPW control register.
                  *
                  */
                 unsigned int *spwptr = (unsigned int*) regAddr;
                 if (val == 1) {
                     *spwptr = *spwptr | SPW_BIT_NP; // [NP] set the No port force bit
                 }
                 if (val== 0) {
                     *spwptr = *spwptr & SPW_BIT_NP_MASK;
                 }
             }
             void spacewire_set_RE( unsigned char val, unsigned int regAddr ) // [R]MAP [E]nable
             {
                 /** This function sets the [R]MAP [E]nable bit of the GRSPW control register.
                  *
                  * @param val is the value, 0 or 1, used to set the value of the RE bit.
                  * @param regAddr is the address of the GRSPW control register.
                  *
                  * RE is the bit 16 of the GRSPW control register.
                  *
                  */
                 unsigned int *spwptr = (unsigned int*) regAddr;
                 if (val == 1)
                 {
                     *spwptr = *spwptr | SPW_BIT_RE; // [RE] set the RMAP Enable bit
                 }
                 if (val== 0)
                 {
                     *spwptr = *spwptr & SPW_BIT_RE_MASK;
                 }
             }
             void spacewire_read_statistics( void )
             {
                 /** This function reads the SpaceWire statistics from the grspw RTEMS driver.
                  *
                  * @param void
                  *
                  * @return void
                  *
                  * Once they are read, the counters are stored in a global variable used during the building of the
                  * HK packets.
                  *
                  */
                 rtems_status_code status;
                 spw_stats current;
                 memset(&current, 0, sizeof(spw_stats));
                 spacewire_get_last_error();
                 // read the current statistics
                 status = ioctl( fdSPW, SPACEWIRE_IOCTRL_GET_STATISTICS, &current );
                 // clear the counters
                 status = ioctl( fdSPW, SPACEWIRE_IOCTRL_CLR_STATISTICS );
-            //    typedef struct {
-            //        unsigned int tx_link_err;             // NOT IN HK
-            //        unsigned int rx_rmap_header_crc_err;  // NOT IN HK
-            //        unsigned int rx_rmap_data_crc_err;    // NOT IN HK
-            //        unsigned int rx_eep_err;
-            //        unsigned int rx_truncated;
-            //        unsigned int parity_err;
-            //        unsigned int escape_err;
-            //        unsigned int credit_err;
-            //        unsigned int write_sync_err;
-            //        unsigned int disconnect_err;
-            //        unsigned int early_ep;
-            //        unsigned int invalid_address;
-            //        unsigned int packets_sent;
-            //        unsigned int packets_received;
-            //    } spw_stats;
                 // rx_eep_err
                 grspw_stats.rx_eep_err      = grspw_stats.rx_eep_err        + current.rx_eep_err;
                 // rx_truncated
                 grspw_stats.rx_truncated    = grspw_stats.rx_truncated      + current.rx_truncated;
                 // parity_err
                 grspw_stats.parity_err      = grspw_stats.parity_err        + current.parity_err;
                 // escape_err
                 grspw_stats.escape_err      = grspw_stats.escape_err        + current.escape_err;
                 // credit_err
                 grspw_stats.credit_err      = grspw_stats.credit_err        + current.credit_err;
                 // write_sync_err
                 grspw_stats.write_sync_err  = grspw_stats.write_sync_err    + current.write_sync_err;
                 // disconnect_err
                 grspw_stats.disconnect_err  = grspw_stats.disconnect_err    + current.disconnect_err;
                 // early_ep
                 grspw_stats.early_ep        = grspw_stats.early_ep          + current.early_ep;
                 // invalid_address
                 grspw_stats.invalid_address = grspw_stats.invalid_address   + current.invalid_address;
                 // packets_sent
                 grspw_stats.packets_sent    = grspw_stats.packets_sent      + current.packets_sent;
                 // packets_received
                 grspw_stats.packets_received= grspw_stats.packets_received  + current.packets_received;
             }
             void spacewire_get_last_error( void )
             {
                 static spw_stats previous = {0};
                 spw_stats current;
                 rtems_status_code status;
                 unsigned int  hk_lfr_last_er_rid;
                 unsigned char hk_lfr_last_er_code;
                 int coarseTime;
                 int fineTime;
                 unsigned char update_hk_lfr_last_er;
                 memset(&current, 0, sizeof(spw_stats));
                 hk_lfr_last_er_rid  = INIT_CHAR;
                 hk_lfr_last_er_code = INIT_CHAR;
                 update_hk_lfr_last_er = INIT_CHAR;
                 status = ioctl( fdSPW, SPACEWIRE_IOCTRL_GET_STATISTICS, &current );
                 // get current time
                 coarseTime = time_management_regs->coarse_time;
                 fineTime   = time_management_regs->fine_time;
-                //    typedef struct {
-                //        unsigned int tx_link_err;             // NOT IN HK
-                //        unsigned int rx_rmap_header_crc_err;  // NOT IN HK
-                //        unsigned int rx_rmap_data_crc_err;    // NOT IN HK
-                //        unsigned int rx_eep_err;
-                //        unsigned int rx_truncated;
-                //        unsigned int parity_err;
-                //        unsigned int escape_err;
-                //        unsigned int credit_err;
-                //        unsigned int write_sync_err;
-                //        unsigned int disconnect_err;
-                //        unsigned int early_ep;
-                //        unsigned int invalid_address;
-                //        unsigned int packets_sent;
-                //        unsigned int packets_received;
-                //    } spw_stats;
                 // tx_link_err *** no code associated to this field
                 // rx_rmap_header_crc_err ***  LE *** in HK
                 if (previous.rx_rmap_header_crc_err != current.rx_rmap_header_crc_err)
                 {
                     hk_lfr_last_er_rid  = RID_LE_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_HEADER_CRC;
                     update_hk_lfr_last_er = 1;
                 }
                 // rx_rmap_data_crc_err ***  LE *** NOT IN HK
                 if (previous.rx_rmap_data_crc_err != current.rx_rmap_data_crc_err)
                 {
                     hk_lfr_last_er_rid  = RID_LE_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_DATA_CRC;
                     update_hk_lfr_last_er = 1;
                 }
                 // rx_eep_err
                 if (previous.rx_eep_err != current.rx_eep_err)
                 {
                     hk_lfr_last_er_rid  = RID_ME_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_EEP;
                     update_hk_lfr_last_er = 1;
                 }
                 // rx_truncated
                 if (previous.rx_truncated != current.rx_truncated)
                 {
                     hk_lfr_last_er_rid  = RID_ME_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_RX_TOO_BIG;
                     update_hk_lfr_last_er = 1;
                 }
                 // parity_err
                 if (previous.parity_err != current.parity_err)
                 {
                     hk_lfr_last_er_rid  = RID_LE_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_PARITY;
                     update_hk_lfr_last_er = 1;
                 }
                 // escape_err
                 if (previous.parity_err != current.parity_err)
                 {
                     hk_lfr_last_er_rid  = RID_LE_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_ESCAPE;
                     update_hk_lfr_last_er = 1;
                 }
                 // credit_err
                 if (previous.credit_err != current.credit_err)
                 {
                     hk_lfr_last_er_rid  = RID_LE_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_CREDIT;
                     update_hk_lfr_last_er = 1;
                 }
                 // write_sync_err
                 if (previous.write_sync_err != current.write_sync_err)
                 {
                     hk_lfr_last_er_rid  = RID_LE_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_WRITE_SYNC;
                     update_hk_lfr_last_er = 1;
                 }
                 // disconnect_err
                 if (previous.disconnect_err != current.disconnect_err)
                 {
                     hk_lfr_last_er_rid  = RID_LE_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_DISCONNECT;
                     update_hk_lfr_last_er = 1;
                 }
                 // early_ep
                 if (previous.early_ep != current.early_ep)
                 {
                     hk_lfr_last_er_rid  = RID_ME_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_EARLY_EOP_EEP;
                     update_hk_lfr_last_er = 1;
                 }
                 // invalid_address
                 if (previous.invalid_address != current.invalid_address)
                 {
                     hk_lfr_last_er_rid = RID_ME_LFR_DPU_SPW;
                     hk_lfr_last_er_code = CODE_INVALID_ADDRESS;
                     update_hk_lfr_last_er = 1;
                 }
                 // if a field has changed, update the hk_last_er fields
                 if (update_hk_lfr_last_er == 1)
                 {
                     update_hk_lfr_last_er_fields( hk_lfr_last_er_rid, hk_lfr_last_er_code );
                 }
                 previous = current;
             }
             void update_hk_lfr_last_er_fields(unsigned int rid, unsigned char code)
             {
                 unsigned char *coarseTimePtr;
                 unsigned char *fineTimePtr;
                 coarseTimePtr = (unsigned char*) &time_management_regs->coarse_time;
                 fineTimePtr = (unsigned char*) &time_management_regs->fine_time;
                 housekeeping_packet.hk_lfr_last_er_rid[0]   = (unsigned char) ((rid & BYTE0_MASK) >> SHIFT_1_BYTE );
                 housekeeping_packet.hk_lfr_last_er_rid[1]   = (unsigned char)  (rid & BYTE1_MASK);
                 housekeeping_packet.hk_lfr_last_er_code     = code;
                 housekeeping_packet.hk_lfr_last_er_time[0]  = coarseTimePtr[0];
                 housekeeping_packet.hk_lfr_last_er_time[1]  = coarseTimePtr[1];
                 housekeeping_packet.hk_lfr_last_er_time[BYTE_2]  = coarseTimePtr[BYTE_2];
                 housekeeping_packet.hk_lfr_last_er_time[BYTE_3]  = coarseTimePtr[BYTE_3];
                 housekeeping_packet.hk_lfr_last_er_time[BYTE_4]  = fineTimePtr[BYTE_2];
                 housekeeping_packet.hk_lfr_last_er_time[BYTE_5]  = fineTimePtr[BYTE_3];
             }
             void update_hk_with_grspw_stats( void )
             {
                 //****************************
                 // DPU_SPACEWIRE_IF_STATISTICS
                 housekeeping_packet.hk_lfr_dpu_spw_pkt_rcv_cnt[0]   = (unsigned char) (grspw_stats.packets_received >> SHIFT_1_BYTE);
                 housekeeping_packet.hk_lfr_dpu_spw_pkt_rcv_cnt[1]   = (unsigned char) (grspw_stats.packets_received);
                 housekeeping_packet.hk_lfr_dpu_spw_pkt_sent_cnt[0]  = (unsigned char) (grspw_stats.packets_sent >> SHIFT_1_BYTE);
                 housekeeping_packet.hk_lfr_dpu_spw_pkt_sent_cnt[1]  = (unsigned char) (grspw_stats.packets_sent);
                 //******************************************
                 // ERROR COUNTERS / SPACEWIRE / LOW SEVERITY
                 housekeeping_packet.hk_lfr_dpu_spw_parity       = (unsigned char) grspw_stats.parity_err;
                 housekeeping_packet.hk_lfr_dpu_spw_disconnect   = (unsigned char) grspw_stats.disconnect_err;
                 housekeeping_packet.hk_lfr_dpu_spw_escape       = (unsigned char) grspw_stats.escape_err;
                 housekeeping_packet.hk_lfr_dpu_spw_credit       = (unsigned char) grspw_stats.credit_err;
                 housekeeping_packet.hk_lfr_dpu_spw_write_sync   = (unsigned char) grspw_stats.write_sync_err;
                 //*********************************************
                 // ERROR COUNTERS / SPACEWIRE / MEDIUM SEVERITY
                 housekeeping_packet.hk_lfr_dpu_spw_early_eop    = (unsigned char) grspw_stats.early_ep;
                 housekeeping_packet.hk_lfr_dpu_spw_invalid_addr = (unsigned char) grspw_stats.invalid_address;
                 housekeeping_packet.hk_lfr_dpu_spw_eep          = (unsigned char) grspw_stats.rx_eep_err;
                 housekeeping_packet.hk_lfr_dpu_spw_rx_too_big   = (unsigned char) grspw_stats.rx_truncated;
             }
             void spacewire_update_hk_lfr_link_state( unsigned char *hk_lfr_status_word_0 )
             {
                 unsigned int *statusRegisterPtr;
                 unsigned char linkState;
                 statusRegisterPtr = (unsigned int *) (REGS_ADDR_GRSPW + APB_OFFSET_GRSPW_STATUS_REGISTER);
                 linkState =
                         (unsigned char) ( ( (*statusRegisterPtr) >>  SPW_LINK_STAT_POS) & STATUS_WORD_LINK_STATE_BITS);   // [0000 0111]
                 *hk_lfr_status_word_0 = *hk_lfr_status_word_0 & STATUS_WORD_LINK_STATE_MASK;       // [1111 1000] set link state to 0
                 *hk_lfr_status_word_0 = *hk_lfr_status_word_0 | linkState;  // update hk_lfr_dpu_spw_link_state
             }
             void increase_unsigned_char_counter( unsigned char *counter )
             {
                 // update the number of valid timecodes that have been received
                 if (*counter == UINT8_MAX)
                 {
                     *counter = 0;
                 }
                 else
                 {
                     *counter = *counter + 1;
                 }
             }
             unsigned int check_timecode_and_previous_timecode_coherency(unsigned char currentTimecodeCtr)
             {
                 /** This function checks the coherency between the incoming timecode and the last valid timecode.
                  *
                  * @param currentTimecodeCtr is the incoming timecode
                  *
                  * @return returned codes::
                  * - LFR_DEFAULT
                  * - LFR_SUCCESSFUL
                  *
                  */
                 static unsigned char firstTickout = 1;
                 unsigned char ret;
                 ret = LFR_DEFAULT;
                 if (firstTickout == 0)
                 {
                     if (currentTimecodeCtr == 0)
                     {
                         if (previousTimecodeCtr == SPW_TIMECODE_MAX)
                         {
                             ret = LFR_SUCCESSFUL;
                         }
                         else
                         {
                             ret = LFR_DEFAULT;
                         }
                     }
                     else
                     {
                         if (currentTimecodeCtr == (previousTimecodeCtr +1))
                         {
                             ret = LFR_SUCCESSFUL;
                         }
                         else
                         {
                             ret = LFR_DEFAULT;
                         }
                     }
                 }
                 else
                 {
                     firstTickout = 0;
                     ret = LFR_SUCCESSFUL;
                 }
                 return ret;
             }
             unsigned int check_timecode_and_internal_time_coherency(unsigned char timecode, unsigned char internalTime)
             {
                 unsigned int ret;
                 ret = LFR_DEFAULT;
                 if (timecode == internalTime)
                 {
                     ret = LFR_SUCCESSFUL;
                 }
                 else
                 {
                     ret = LFR_DEFAULT;
                 }
                 return ret;
             }
             void timecode_irq_handler( void *pDev, void *regs, int minor, unsigned int tc )
             {
                 // a tickout has been emitted, perform actions on the incoming timecode
                 unsigned char incomingTimecode;
                 unsigned char updateTime;
                 unsigned char internalTime;
                 rtems_status_code status;
                 incomingTimecode =        (unsigned char) (grspwPtr[0] & TIMECODE_MASK);
                 updateTime    = time_management_regs->coarse_time_load & TIMECODE_MASK;
                 internalTime  = time_management_regs->coarse_time      & TIMECODE_MASK;
                 housekeeping_packet.hk_lfr_dpu_spw_last_timc = incomingTimecode;
                 // update the number of tickout that have been generated
                 increase_unsigned_char_counter( &housekeeping_packet.hk_lfr_dpu_spw_tick_out_cnt );
                 //**************************
                 // HK_LFR_TIMECODE_ERRONEOUS
                 // MISSING and INVALID are handled by the timecode_timer_routine service routine
                 if (check_timecode_and_previous_timecode_coherency( incomingTimecode ) == LFR_DEFAULT)
                 {
                     // this is unexpected but a tickout could have been raised despite of the timecode being erroneous
                     increase_unsigned_char_counter( &housekeeping_packet.hk_lfr_timecode_erroneous );
                     update_hk_lfr_last_er_fields( RID_LE_LFR_TIMEC, CODE_ERRONEOUS );
                 }
                 //************************
                 // HK_LFR_TIME_TIMECODE_IT
                 // check the coherency between the SpaceWire timecode and the Internal Time
                 if (check_timecode_and_internal_time_coherency( incomingTimecode, internalTime ) == LFR_DEFAULT)
                 {
                     increase_unsigned_char_counter( &housekeeping_packet.hk_lfr_time_timecode_it );
                     update_hk_lfr_last_er_fields( RID_LE_LFR_TIME, CODE_TIMECODE_IT );
                 }
                 //********************
                 // HK_LFR_TIMECODE_CTR
                 // check the value of the timecode with respect to the last TC_LFR_UPDATE_TIME => SSS-CP-FS-370
                 if (oneTcLfrUpdateTimeReceived == 1)
                 {
                     if ( incomingTimecode != updateTime )
                     {
                         increase_unsigned_char_counter( &housekeeping_packet.hk_lfr_time_timecode_ctr );
                         update_hk_lfr_last_er_fields( RID_LE_LFR_TIME, CODE_TIMECODE_CTR );
                     }
                 }
                 // launch the timecode timer to detect missing or invalid timecodes
                 previousTimecodeCtr = incomingTimecode;  // update the previousTimecodeCtr value
                 status = rtems_timer_fire_after( timecode_timer_id, TIMECODE_TIMER_TIMEOUT, timecode_timer_routine, NULL );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_14 );
                 }
             }
             rtems_timer_service_routine timecode_timer_routine( rtems_id timer_id, void *user_data )
             {
                 static unsigned char initStep = 1;
                 unsigned char currentTimecodeCtr;
                 currentTimecodeCtr = (unsigned char) (grspwPtr[0] & TIMECODE_MASK);
                 if (initStep == 1)
                 {
                     if (currentTimecodeCtr == previousTimecodeCtr)
                     {
                         //************************
                         // HK_LFR_TIMECODE_MISSING
                         // the timecode value has not changed, no valid timecode has been received, the timecode is MISSING
                         increase_unsigned_char_counter( &housekeeping_packet.hk_lfr_timecode_missing );
                         update_hk_lfr_last_er_fields( RID_LE_LFR_TIMEC, CODE_MISSING );
                     }
                     else if (currentTimecodeCtr == (previousTimecodeCtr+1))
                     {
                         // the timecode value has changed and the value is valid, this is unexpected because
                         // the timer should not have fired, the timecode_irq_handler should have been raised
                     }
                     else
                     {
                         //************************
                         // HK_LFR_TIMECODE_INVALID
                         // the timecode value has changed and the value is not valid, no tickout has been generated
                         // this is why the timer has fired
                         increase_unsigned_char_counter( &housekeeping_packet.hk_lfr_timecode_invalid );
                         update_hk_lfr_last_er_fields( RID_LE_LFR_TIMEC, CODE_INVALID );
                     }
                 }
                 else
                 {
                     initStep = 1;
                     //************************
                     // HK_LFR_TIMECODE_MISSING
                     increase_unsigned_char_counter( &housekeeping_packet.hk_lfr_timecode_missing );
                     update_hk_lfr_last_er_fields( RID_LE_LFR_TIMEC, CODE_MISSING );
                 }
                 rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_13 );
             }
             void init_header_cwf( Header_TM_LFR_SCIENCE_CWF_t *header )
             {
                 header->targetLogicalAddress    = CCSDS_DESTINATION_ID;
                 header->protocolIdentifier      = CCSDS_PROTOCOLE_ID;
                 header->reserved                = DEFAULT_RESERVED;
                 header->userApplication         = CCSDS_USER_APP;
                 header->packetSequenceControl[0]= TM_PACKET_SEQ_CTRL_STANDALONE;
                 header->packetSequenceControl[1]= TM_PACKET_SEQ_CNT_DEFAULT;
                 header->packetLength[0] = INIT_CHAR;
                 header->packetLength[1] = INIT_CHAR;
                 // DATA FIELD HEADER
                 header->spare1_pusVersion_spare2    = DEFAULT_SPARE1_PUSVERSION_SPARE2;
                 header->serviceType     = TM_TYPE_LFR_SCIENCE; // service type
                 header->serviceSubType  = TM_SUBTYPE_LFR_SCIENCE_6; // service subtype
                 header->destinationID   = TM_DESTINATION_ID_GROUND;
                 header->time[BYTE_0] = INIT_CHAR;
                 header->time[BYTE_1] = INIT_CHAR;
                 header->time[BYTE_2] = INIT_CHAR;
                 header->time[BYTE_3] = INIT_CHAR;
                 header->time[BYTE_4] = INIT_CHAR;
                 header->time[BYTE_5] = INIT_CHAR;
                 // AUXILIARY DATA HEADER
                 header->sid = INIT_CHAR;
                 header->pa_bia_status_info = DEFAULT_HKBIA;
                 header->blkNr[0] = INIT_CHAR;
                 header->blkNr[1] = INIT_CHAR;
             }
             void init_header_swf( Header_TM_LFR_SCIENCE_SWF_t *header )
             {
                 header->targetLogicalAddress        = CCSDS_DESTINATION_ID;
                 header->protocolIdentifier          = CCSDS_PROTOCOLE_ID;
                 header->reserved        = DEFAULT_RESERVED;
                 header->userApplication = CCSDS_USER_APP;
                 header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> SHIFT_1_BYTE);
                 header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                 header->packetSequenceControl[0]    = TM_PACKET_SEQ_CTRL_STANDALONE;
                 header->packetSequenceControl[1]    = TM_PACKET_SEQ_CNT_DEFAULT;
                 header->packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_336 >> SHIFT_1_BYTE);
                 header->packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_336     );
                 // DATA FIELD HEADER
                 header->spare1_pusVersion_spare2    = DEFAULT_SPARE1_PUSVERSION_SPARE2;
                 header->serviceType     = TM_TYPE_LFR_SCIENCE; // service type
                 header->serviceSubType  = TM_SUBTYPE_LFR_SCIENCE_6; // service subtype
                 header->destinationID   = TM_DESTINATION_ID_GROUND;
                 header->time[BYTE_0] = INIT_CHAR;
                 header->time[BYTE_1] = INIT_CHAR;
                 header->time[BYTE_2] = INIT_CHAR;
                 header->time[BYTE_3] = INIT_CHAR;
                 header->time[BYTE_4] = INIT_CHAR;
                 header->time[BYTE_5] = INIT_CHAR;
                 // AUXILIARY DATA HEADER
                 header->sid     = INIT_CHAR;
                 header->pa_bia_status_info   = DEFAULT_HKBIA;
                 header->pktCnt  = PKTCNT_SWF;  // PKT_CNT
                 header->pktNr   = INIT_CHAR;
                 header->blkNr[0]        = (unsigned char) (BLK_NR_CWF >> SHIFT_1_BYTE);
                 header->blkNr[1]        = (unsigned char) (BLK_NR_CWF     );
             }
             void init_header_asm( Header_TM_LFR_SCIENCE_ASM_t *header )
             {
                 header->targetLogicalAddress        = CCSDS_DESTINATION_ID;
                 header->protocolIdentifier          = CCSDS_PROTOCOLE_ID;
                 header->reserved        = DEFAULT_RESERVED;
                 header->userApplication = CCSDS_USER_APP;
                 header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> SHIFT_1_BYTE);
                 header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                 header->packetSequenceControl[0]    = TM_PACKET_SEQ_CTRL_STANDALONE;
                 header->packetSequenceControl[1]    = TM_PACKET_SEQ_CNT_DEFAULT;
                 header->packetLength[0] = INIT_CHAR;
                 header->packetLength[1] = INIT_CHAR;
                 // DATA FIELD HEADER
                 header->spare1_pusVersion_spare2    = DEFAULT_SPARE1_PUSVERSION_SPARE2;
                 header->serviceType     = TM_TYPE_LFR_SCIENCE; // service type
                 header->serviceSubType  = TM_SUBTYPE_LFR_SCIENCE_3; // service subtype
                 header->destinationID   = TM_DESTINATION_ID_GROUND;
                 header->time[BYTE_0] = INIT_CHAR;
                 header->time[BYTE_1] = INIT_CHAR;
                 header->time[BYTE_2] = INIT_CHAR;
                 header->time[BYTE_3] = INIT_CHAR;
                 header->time[BYTE_4] = INIT_CHAR;
                 header->time[BYTE_5] = INIT_CHAR;
                 // AUXILIARY DATA HEADER
                 header->sid     = INIT_CHAR;
                 header->pa_bia_status_info = INIT_CHAR;
                 header->pa_lfr_pkt_cnt_asm = INIT_CHAR;
                 header->pa_lfr_pkt_nr_asm = INIT_CHAR;
                 header->pa_lfr_asm_blk_nr[0] = INIT_CHAR;
                 header->pa_lfr_asm_blk_nr[1] = INIT_CHAR;
             }
             int spw_send_waveform_CWF( ring_node *ring_node_to_send,
                                   Header_TM_LFR_SCIENCE_CWF_t *header )
             {
                 /** This function sends CWF CCSDS packets (F2, F1 or F0).
                  *
                  * @param waveform points to the buffer containing the data that will be send.
                  * @param sid is the source identifier of the data that will be sent.
                  * @param headerCWF points to a table of headers that have been prepared for the data transmission.
                  * @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures
                  * contain information to setup the transmission of the data packets.
                  *
                  * One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.
                  *
                  */
                 unsigned int i;
                 int ret;
                 unsigned int coarseTime;
                 unsigned int fineTime;
                 rtems_status_code status;
                 spw_ioctl_pkt_send spw_ioctl_send_CWF;
                 int *dataPtr;
                 unsigned char sid;
                 spw_ioctl_send_CWF.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_CWF;
                 spw_ioctl_send_CWF.options = 0;
                 ret = LFR_DEFAULT;
                 sid = (unsigned char) ring_node_to_send->sid;
                 coarseTime  = ring_node_to_send->coarseTime;
                 fineTime    = ring_node_to_send->fineTime;
                 dataPtr     = (int*) ring_node_to_send->buffer_address;
                 header->packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_336 >> SHIFT_1_BYTE);
                 header->packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_336     );
                 header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 header->blkNr[0] = (unsigned char) (BLK_NR_CWF >> SHIFT_1_BYTE);
                 header->blkNr[1] = (unsigned char) (BLK_NR_CWF     );
                 for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF; i++) // send waveform
                 {
                     spw_ioctl_send_CWF.data = (char*) &dataPtr[ (i * BLK_NR_CWF * NB_WORDS_SWF_BLK) ];
                     spw_ioctl_send_CWF.hdr  = (char*) header;
                     // BUILD THE DATA
                     spw_ioctl_send_CWF.dlen = BLK_NR_CWF * NB_BYTES_SWF_BLK;
                     // SET PACKET SEQUENCE CONTROL
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     // SET SID
                     header->sid = sid;
                     // SET PACKET TIME
                     compute_acquisition_time( coarseTime, fineTime, sid, i, header->acquisitionTime);
                     //
                     header->time[0] = header->acquisitionTime[0];
                     header->time[1] = header->acquisitionTime[1];
                     header->time[BYTE_2] = header->acquisitionTime[BYTE_2];
                     header->time[BYTE_3] = header->acquisitionTime[BYTE_3];
                     header->time[BYTE_4] = header->acquisitionTime[BYTE_4];
                     header->time[BYTE_5] = header->acquisitionTime[BYTE_5];
                     // SET PACKET ID
                     if ( (sid == SID_SBM1_CWF_F1) || (sid == SID_SBM2_CWF_F2) )
                     {
                         header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2 >> SHIFT_1_BYTE);
                         header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2);
                     }
                     else
                     {
                         header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> SHIFT_1_BYTE);
                         header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                     }
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_CWF );
                     if (status != RTEMS_SUCCESSFUL) {
                         ret = LFR_DEFAULT;
                     }
                 }
                 return ret;
             }
             int spw_send_waveform_SWF( ring_node *ring_node_to_send,
                                    Header_TM_LFR_SCIENCE_SWF_t *header )
             {
                 /** This function sends SWF CCSDS packets (F2, F1 or F0).
                  *
                  * @param waveform points to the buffer containing the data that will be send.
                  * @param sid is the source identifier of the data that will be sent.
                  * @param headerSWF points to a table of headers that have been prepared for the data transmission.
                  * @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures
                  * contain information to setup the transmission of the data packets.
                  *
                  * One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.
                  *
                  */
                 unsigned int i;
                 int ret;
                 unsigned int coarseTime;
                 unsigned int fineTime;
                 rtems_status_code status;
                 spw_ioctl_pkt_send spw_ioctl_send_SWF;
                 int *dataPtr;
                 unsigned char sid;
                 spw_ioctl_send_SWF.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_SWF;
                 spw_ioctl_send_SWF.options = 0;
                 ret = LFR_DEFAULT;
                 coarseTime  = ring_node_to_send->coarseTime;
                 fineTime    = ring_node_to_send->fineTime;
                 dataPtr     = (int*) ring_node_to_send->buffer_address;
                 sid = ring_node_to_send->sid;
                 header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<PKTCNT_SWF; i++) // send waveform
                 {
                     spw_ioctl_send_SWF.data = (char*) &dataPtr[ (i * BLK_NR_304 * NB_WORDS_SWF_BLK) ];
                     spw_ioctl_send_SWF.hdr = (char*) header;
                     // SET PACKET SEQUENCE CONTROL
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     // SET PACKET LENGTH AND BLKNR
                     if (i == (PKTCNT_SWF-1))
                     {
                         spw_ioctl_send_SWF.dlen = BLK_NR_224 * NB_BYTES_SWF_BLK;
                         header->packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_224 >> SHIFT_1_BYTE);
                         header->packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_224     );
                         header->blkNr[0] = (unsigned char) (BLK_NR_224 >> SHIFT_1_BYTE);
                         header->blkNr[1] = (unsigned char) (BLK_NR_224     );
                     }
                     else
                     {
                         spw_ioctl_send_SWF.dlen = BLK_NR_304 * NB_BYTES_SWF_BLK;
                         header->packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_304 >> SHIFT_1_BYTE);
                         header->packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_304     );
                         header->blkNr[0] = (unsigned char) (BLK_NR_304 >> SHIFT_1_BYTE);
                         header->blkNr[1] = (unsigned char) (BLK_NR_304     );
                     }
                     // SET PACKET TIME
                     compute_acquisition_time( coarseTime, fineTime, sid, i, header->acquisitionTime );
                     //
                     header->time[BYTE_0] = header->acquisitionTime[BYTE_0];
                     header->time[BYTE_1] = header->acquisitionTime[BYTE_1];
                     header->time[BYTE_2] = header->acquisitionTime[BYTE_2];
                     header->time[BYTE_3] = header->acquisitionTime[BYTE_3];
                     header->time[BYTE_4] = header->acquisitionTime[BYTE_4];
                     header->time[BYTE_5] = header->acquisitionTime[BYTE_5];
                     // SET SID
                     header->sid = sid;
                     // SET PKTNR
                     header->pktNr = i+1;    // PKT_NR
                     // SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_SWF );
                     if (status != RTEMS_SUCCESSFUL) {
                         ret = LFR_DEFAULT;
                     }
                 }
                 return ret;
             }
             int spw_send_waveform_CWF3_light( ring_node *ring_node_to_send,
                                               Header_TM_LFR_SCIENCE_CWF_t *header )
             {
                 /** This function sends CWF_F3 CCSDS packets without the b1, b2 and b3 data.
                  *
                  * @param waveform points to the buffer containing the data that will be send.
                  * @param headerCWF points to a table of headers that have been prepared for the data transmission.
                  * @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures
                  * contain information to setup the transmission of the data packets.
                  *
                  * By default, CWF_F3 packet are send without the b1, b2 and b3 data. This function rebuilds a data buffer
                  * from the incoming data and sends it in 7 packets, 6 containing 340 blocks and 1 one containing 8 blocks.
                  *
                  */
                 unsigned int i;
                 int ret;
                 unsigned int coarseTime;
                 unsigned int fineTime;
                 rtems_status_code status;
                 spw_ioctl_pkt_send spw_ioctl_send_CWF;
                 char *dataPtr;
                 unsigned char sid;
                 spw_ioctl_send_CWF.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_CWF;
                 spw_ioctl_send_CWF.options = 0;
                 ret = LFR_DEFAULT;
                 sid = ring_node_to_send->sid;
                 coarseTime  = ring_node_to_send->coarseTime;
                 fineTime    = ring_node_to_send->fineTime;
                 dataPtr     = (char*) ring_node_to_send->buffer_address;
                 header->packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_672 >> SHIFT_1_BYTE);
                 header->packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_672     );
                 header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 header->blkNr[0] = (unsigned char) (BLK_NR_CWF_SHORT_F3 >> SHIFT_1_BYTE);
                 header->blkNr[1] = (unsigned char) (BLK_NR_CWF_SHORT_F3     );
                 //*********************
                 // SEND CWF3_light DATA
                 for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF_LIGHT; i++) // send waveform
                 {
                     spw_ioctl_send_CWF.data = (char*) &dataPtr[ (i * BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK) ];
                     spw_ioctl_send_CWF.hdr = (char*) header;
                     // BUILD THE DATA
                     spw_ioctl_send_CWF.dlen = BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK;
                     // SET PACKET SEQUENCE COUNTER
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     // SET SID
                     header->sid = sid;
                     // SET PACKET TIME
                     compute_acquisition_time( coarseTime, fineTime, SID_NORM_CWF_F3, i, header->acquisitionTime );
                     //
                     header->time[BYTE_0] = header->acquisitionTime[BYTE_0];
                     header->time[BYTE_1] = header->acquisitionTime[BYTE_1];
                     header->time[BYTE_2] = header->acquisitionTime[BYTE_2];
                     header->time[BYTE_3] = header->acquisitionTime[BYTE_3];
                     header->time[BYTE_4] = header->acquisitionTime[BYTE_4];
                     header->time[BYTE_5] = header->acquisitionTime[BYTE_5];
                     // SET PACKET ID
                     header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> SHIFT_1_BYTE);
                     header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                     // SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_CWF );
                     if (status != RTEMS_SUCCESSFUL) {
                         ret = LFR_DEFAULT;
                     }
                 }
                 return ret;
             }
             void spw_send_asm_f0( ring_node *ring_node_to_send,
                                Header_TM_LFR_SCIENCE_ASM_t *header )
             {
                 unsigned int i;
                 unsigned int length = 0;
                 rtems_status_code status;
                 unsigned int sid;
                 float *spectral_matrix;
                 int coarseTime;
                 int fineTime;
                 spw_ioctl_pkt_send spw_ioctl_send_ASM;
                 sid = ring_node_to_send->sid;
                 spectral_matrix = (float*) ring_node_to_send->buffer_address;
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
                 header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<PKTCNT_ASM; i++)
                 {
                     if ((i==0) || (i==1))
                     {
                         spw_ioctl_send_ASM.dlen = DLEN_ASM_F0_PKT_1;
                         spw_ioctl_send_ASM.data = (char *) &spectral_matrix[
                                 ( (ASM_F0_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F0_1) ) * NB_VALUES_PER_SM )
                                 ];
                         length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F0_1;
                         header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
                         header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F0_1) >> SHIFT_1_BYTE ); // BLK_NR MSB
                         header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F0_1);        // BLK_NR LSB
                     }
                     else
                     {
                         spw_ioctl_send_ASM.dlen = DLEN_ASM_F0_PKT_2;
                         spw_ioctl_send_ASM.data = (char*) &spectral_matrix[
                                 ( (ASM_F0_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F0_1) ) * NB_VALUES_PER_SM )
                                 ];
                         length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F0_2;
                         header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
                         header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F0_2) >> SHIFT_1_BYTE ); // BLK_NR MSB
                         header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F0_2);        // BLK_NR LSB
                     }
                     spw_ioctl_send_ASM.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_ASM;
                     spw_ioctl_send_ASM.hdr = (char *) header;
                     spw_ioctl_send_ASM.options = 0;
                     // (2) BUILD THE HEADER
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     header->packetLength[0] = (unsigned char) (length >> SHIFT_1_BYTE);
                     header->packetLength[1] = (unsigned char) (length);
                     header->sid = (unsigned char) sid;   // SID
                     header->pa_lfr_pkt_cnt_asm = PKTCNT_ASM;
                     header->pa_lfr_pkt_nr_asm = (unsigned char) (i+1);
                     // (3) SET PACKET TIME
                     header->time[BYTE_0] = (unsigned char) (coarseTime >> SHIFT_3_BYTES);
                     header->time[BYTE_1] = (unsigned char) (coarseTime >> SHIFT_2_BYTES);
                     header->time[BYTE_2] = (unsigned char) (coarseTime >> SHIFT_1_BYTE);
                     header->time[BYTE_3] = (unsigned char) (coarseTime);
                     header->time[BYTE_4] = (unsigned char) (fineTime >> SHIFT_1_BYTE);
                     header->time[BYTE_5] = (unsigned char) (fineTime);
                     //
                     header->acquisitionTime[BYTE_0] = header->time[BYTE_0];
                     header->acquisitionTime[BYTE_1] = header->time[BYTE_1];
                     header->acquisitionTime[BYTE_2] = header->time[BYTE_2];
                     header->acquisitionTime[BYTE_3] = header->time[BYTE_3];
                     header->acquisitionTime[BYTE_4] = header->time[BYTE_4];
                     header->acquisitionTime[BYTE_5] = header->time[BYTE_5];
                     // (4) SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_ASM );
                     if (status != RTEMS_SUCCESSFUL) {
                         PRINTF1("in ASM_send *** ERR %d\n", (int) status)
                     }
                 }
             }
             void spw_send_asm_f1( ring_node *ring_node_to_send,
                                Header_TM_LFR_SCIENCE_ASM_t *header )
             {
                 unsigned int i;
                 unsigned int length = 0;
                 rtems_status_code status;
                 unsigned int sid;
                 float *spectral_matrix;
                 int coarseTime;
                 int fineTime;
                 spw_ioctl_pkt_send spw_ioctl_send_ASM;
                 sid = ring_node_to_send->sid;
                 spectral_matrix = (float*) ring_node_to_send->buffer_address;
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
                 header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<PKTCNT_ASM; i++)
                 {
                     if ((i==0) || (i==1))
                     {
                         spw_ioctl_send_ASM.dlen = DLEN_ASM_F1_PKT_1;
                         spw_ioctl_send_ASM.data = (char *) &spectral_matrix[
                                 ( (ASM_F1_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F1_1) ) * NB_VALUES_PER_SM )
                                 ];
                         length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F1_1;
                         header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
                         header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F1_1) >> SHIFT_1_BYTE ); // BLK_NR MSB
                         header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F1_1);        // BLK_NR LSB
                     }
                     else
                     {
                         spw_ioctl_send_ASM.dlen = DLEN_ASM_F1_PKT_2;
                         spw_ioctl_send_ASM.data = (char*) &spectral_matrix[
                                 ( (ASM_F1_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F1_1) ) * NB_VALUES_PER_SM )
                                 ];
                         length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F1_2;
                         header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
                         header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F1_2) >> SHIFT_1_BYTE ); // BLK_NR MSB
                         header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F1_2);        // BLK_NR LSB
                     }
                     spw_ioctl_send_ASM.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_ASM;
                     spw_ioctl_send_ASM.hdr = (char *) header;
                     spw_ioctl_send_ASM.options = 0;
                     // (2) BUILD THE HEADER
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     header->packetLength[0] = (unsigned char) (length >> SHIFT_1_BYTE);
                     header->packetLength[1] = (unsigned char) (length);
                     header->sid = (unsigned char) sid;   // SID
                     header->pa_lfr_pkt_cnt_asm = PKTCNT_ASM;
                     header->pa_lfr_pkt_nr_asm = (unsigned char) (i+1);
                     // (3) SET PACKET TIME
                     header->time[BYTE_0] = (unsigned char) (coarseTime >> SHIFT_3_BYTES);
                     header->time[BYTE_1] = (unsigned char) (coarseTime >> SHIFT_2_BYTES);
                     header->time[BYTE_2] = (unsigned char) (coarseTime >> SHIFT_1_BYTE);
                     header->time[BYTE_3] = (unsigned char) (coarseTime);
                     header->time[BYTE_4] = (unsigned char) (fineTime >> SHIFT_1_BYTE);
                     header->time[BYTE_5] = (unsigned char) (fineTime);
                     //
                     header->acquisitionTime[BYTE_0] = header->time[BYTE_0];
                     header->acquisitionTime[BYTE_1] = header->time[BYTE_1];
                     header->acquisitionTime[BYTE_2] = header->time[BYTE_2];
                     header->acquisitionTime[BYTE_3] = header->time[BYTE_3];
                     header->acquisitionTime[BYTE_4] = header->time[BYTE_4];
                     header->acquisitionTime[BYTE_5] = header->time[BYTE_5];
                     // (4) SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_ASM );
                     if (status != RTEMS_SUCCESSFUL) {
                         PRINTF1("in ASM_send *** ERR %d\n", (int) status)
                     }
                 }
             }
+            /**
+             * @brief spw_send_asm_f2 Sends an ASM packet at F2 over spacewire
+             * @param ring_node_to_send node pointing to the actual buffer to send
+             * @param header
+             */
             void spw_send_asm_f2( ring_node *ring_node_to_send,
                                Header_TM_LFR_SCIENCE_ASM_t *header )
             {
                 unsigned int i;
                 unsigned int length = 0;
                 rtems_status_code status;
                 unsigned int sid;
                 float *spectral_matrix;
                 int coarseTime;
                 int fineTime;
                 spw_ioctl_pkt_send spw_ioctl_send_ASM;
                 sid = ring_node_to_send->sid;
                 spectral_matrix = (float*) ring_node_to_send->buffer_address;
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
                 header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<PKTCNT_ASM; i++)
                 {
                     spw_ioctl_send_ASM.dlen = DLEN_ASM_F2_PKT;
                     spw_ioctl_send_ASM.data = (char *) &spectral_matrix[
                             ( (ASM_F2_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F2) ) * NB_VALUES_PER_SM )
                             ];
                     length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F2;
                     header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_3;
                     header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F2) >> SHIFT_1_BYTE ); // BLK_NR MSB
                     header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F2);        // BLK_NR LSB
                     spw_ioctl_send_ASM.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_ASM;
                     spw_ioctl_send_ASM.hdr = (char *) header;
                     spw_ioctl_send_ASM.options = 0;
                     // (2) BUILD THE HEADER
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     header->packetLength[0] = (unsigned char) (length >> SHIFT_1_BYTE);
                     header->packetLength[1] = (unsigned char) (length);
                     header->sid = (unsigned char) sid;   // SID
                     header->pa_lfr_pkt_cnt_asm = PKTCNT_ASM;
                     header->pa_lfr_pkt_nr_asm = (unsigned char) (i+1);
                     // (3) SET PACKET TIME
                     header->time[BYTE_0] = (unsigned char) (coarseTime >> SHIFT_3_BYTES);
                     header->time[BYTE_1] = (unsigned char) (coarseTime >> SHIFT_2_BYTES);
                     header->time[BYTE_2] = (unsigned char) (coarseTime >> SHIFT_1_BYTE);
                     header->time[BYTE_3] = (unsigned char) (coarseTime);
                     header->time[BYTE_4] = (unsigned char) (fineTime >> SHIFT_1_BYTE);
                     header->time[BYTE_5] = (unsigned char) (fineTime);
                     //
                     header->acquisitionTime[BYTE_0] = header->time[BYTE_0];
                     header->acquisitionTime[BYTE_1] = header->time[BYTE_1];
                     header->acquisitionTime[BYTE_2] = header->time[BYTE_2];
                     header->acquisitionTime[BYTE_3] = header->time[BYTE_3];
                     header->acquisitionTime[BYTE_4] = header->time[BYTE_4];
                     header->acquisitionTime[BYTE_5] = header->time[BYTE_5];
                     // (4) SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_ASM );
                     if (status != RTEMS_SUCCESSFUL) {
                         PRINTF1("in ASM_send *** ERR %d\n", (int) status)
                     }
                 }
             }
+            /**
+             * @brief spw_send_k_dump Sends k coefficients dump packet over spacewire
+             * @param ring_node_to_send node pointing to the actual buffer to send
+             */
             void spw_send_k_dump( ring_node *ring_node_to_send )
             {
                 rtems_status_code status;
                 Packet_TM_LFR_KCOEFFICIENTS_DUMP_t *kcoefficients_dump;
                 unsigned int packetLength;
                 unsigned int size;
                 PRINTF("spw_send_k_dump\n")
                 kcoefficients_dump = (Packet_TM_LFR_KCOEFFICIENTS_DUMP_t *) ring_node_to_send->buffer_address;
                 packetLength = (kcoefficients_dump->packetLength[0] * CONST_256) + kcoefficients_dump->packetLength[1];
                 size = packetLength + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES;
                 PRINTF2("packetLength %d, size %d\n", packetLength, size )
                 status = write( fdSPW, (char *) ring_node_to_send->buffer_address, size );
                 if (status == -1){
                     PRINTF2("in SEND *** (2.a) ERRNO = %d, size = %d\n", errno, size)
                 }
                 ring_node_to_send->status = INIT_CHAR;
             }

src/tc_load_dump_parameters.c 0 -4

             /** 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.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.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_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_sc_rw_delta_f;
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
                         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,
                                                               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