HG_REPOSITORIES/LPP/INSTRUMENTATION/USERS/JEANDET/LFR_FSW Commit - r352:c07c16776bd4

AVGV modified...

paul -

r352:c07c16776bd4 R3++

parent child

Context file:

r352:c07c16776bd4

Collapse all files

.hgsubstate +1 -1

@@ -1,2 +1,2
1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters	1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters
2	~~e01ac8bd125a79a7af38b0e3ba0330f5be1a3c92~~ header/lfr_common_headers	2	7ee7da2ed42fbc9cd673ae7f3a865345cea0f83f header/lfr_common_headers

header/grlib_regs.h +3 -6

             #ifndef GRLIB_REGS_H_INCLUDED
             #define GRLIB_REGS_H_INCLUDED
             #define NB_GPTIMER 3
             #include <stdint.h>
             struct apbuart_regs_str{
                 volatile unsigned int data;
                 volatile unsigned int status;
                 volatile unsigned int ctrl;
                 volatile unsigned int scaler;
                 volatile unsigned int fifoDebug;
             };
             struct grgpio_regs_str{
                 volatile int io_port_data_register;
                 int io_port_output_register;
                 int io_port_direction_register;
                 int interrupt_mak_register;
                 int interrupt_polarity_register;
                 int interrupt_edge_register;
                 int bypass_register;
                 int reserved;
                 // 0x20-0x3c interrupt map register(s)
             };
             typedef struct {
                 volatile unsigned int counter;
                 volatile unsigned int reload;
                 volatile unsigned int ctrl;
                 volatile unsigned int unused;
             } timer_regs_t;
             //*************
             //*************
             // GPTIMER_REGS
             #define GPTIMER_CLEAR_IRQ   0x00000010  // clear pending IRQ if any
             #define GPTIMER_LD          0x00000004  // LD load value from the reload register
             #define GPTIMER_EN          0x00000001  // EN enable the timer
             #define GPTIMER_EN_MASK     0xfffffffe  // EN enable the timer
             #define GPTIMER_RS          0x00000002  // RS restart
             #define GPTIMER_IE          0x00000008  // IE interrupt enable
             #define GPTIMER_IE_MASK     0xffffffef  // IE interrupt enable
             typedef struct {
                 volatile unsigned int scaler_value;
                 volatile unsigned int scaler_reload;
                 volatile unsigned int conf;
                 volatile unsigned int unused0;
                 timer_regs_t timer[NB_GPTIMER];
             } gptimer_regs_t;
             //*********************
             //*********************
             // TIME_MANAGEMENT_REGS
             #define VAL_SOFTWARE_RESET      0x02  // [0010] software reset
             #define VAL_LFR_SYNCHRONIZED    0x80000000
             #define BIT_SYNCHRONIZATION     31
             #define COARSE_TIME_MASK        0x7fffffff
             #define SYNC_BIT_MASK           0x7f
             #define SYNC_BIT                0x80
             #define BIT_CAL_RELOAD          0x00000010
             #define MASK_CAL_RELOAD         0xffffffef  // [1110 1111]
             #define BIT_CAL_ENABLE          0x00000040
             #define MASK_CAL_ENABLE         0xffffffbf  // [1011 1111]
             #define BIT_SET_INTERLEAVED     0x00000020  // [0010 0000]
             #define MASK_SET_INTERLEAVED    0xffffffdf  // [1101 1111]
             #define BIT_SOFT_RESET          0x00000004  // [0100]
             #define MASK_SOFT_RESET         0xfffffffb  // [1011]
             typedef struct {
                 volatile int ctrl;  // bit 0 forces the load of the coarse_time_load value and resets the fine_time
                                     // bit 1 is the soft reset for the time management module
                                     // bit 2 is the soft reset for the waveform picker and the spectral matrix modules, set to 1 after HW reset
                 volatile int coarse_time_load;
                 volatile int coarse_time;
                 volatile int fine_time;
                 // TEMPERATURES
                 volatile int temp_pcb;  // SEL1 = 0 SEL0 = 0
                 volatile int temp_fpga; // SEL1 = 0 SEL0 = 1
                 volatile int temp_scm;  // SEL1 = 1 SEL0 = 0
                 // CALIBRATION
                 volatile unsigned int calDACCtrl;
                 volatile unsigned int calPrescaler;
                 volatile unsigned int calDivisor;
                 volatile unsigned int calDataPtr;
                 volatile unsigned int calData;
             } time_management_regs_t;
             //*********************
             //*********************
             // WAVEFORM_PICKER_REGS
             #define BITS_WFP_STATUS_F3  0xc0        // [1100 0000] check the f3 full bits
             #define BIT_WFP_BUF_F3_0    0x40        // [0100 0000] f3 buffer 0 is full
             #define BIT_WFP_BUF_F3_1    0x80        // [1000 0000] f3 buffer 1 is full
             #define RST_WFP_F3_0        0x00008840  // [1000 1000 0100 0000]
             #define RST_WFP_F3_1        0x00008880  // [1000 1000 1000 0000]
             #define BITS_WFP_STATUS_F2  0x30        // [0011 0000] get the status bits for f2
             #define SHIFT_WFP_STATUS_F2 4
             #define BIT_WFP_BUF_F2_0    0x10        // [0001 0000] f2 buffer 0 is full
             #define BIT_WFP_BUF_F2_1    0x20        // [0010 0000] f2 buffer 1 is full
             #define RST_WFP_F2_0        0x00004410  // [0100 0100 0001 0000]
             #define RST_WFP_F2_1        0x00004420  // [0100 0100 0010 0000]
             #define BITS_WFP_STATUS_F1  0x0c        // [0000 1100] check the f1 full bits
             #define BIT_WFP_BUF_F1_0    0x04        // [0000 0100] f1 buffer 0 is full
             #define BIT_WFP_BUF_F1_1    0x08        // [0000 1000] f1 buffer 1 is full
             #define RST_WFP_F1_0        0x00002204  // [0010 0010 0000 0100] f1 bits = 0
             #define RST_WFP_F1_1        0x00002208  // [0010 0010 0000 1000] f1 bits = 0
             #define BITS_WFP_STATUS_F0  0x03        // [0000 0011] check the f0 full bits
             #define RST_WFP_F0_0        0x00001101  // [0001 0001 0000 0001]
             #define RST_WFP_F0_1        0x00001102  // [0001 0001 0000 0010]
             #define BIT_WFP_BUFFER_0    0x01
             #define BIT_WFP_BUFFER_1    0x02
             #define RST_BITS_RUN_BURST_EN   0x80    // [1000 0000] burst f2, f1, f0     enable f3, f2, f1, f0
             #define BITS_WFP_ENABLE_ALL     0x0f    // [0000 1111] enable f3, f2, f1, f0
             #define BITS_WFP_ENABLE_BURST   0x0c    // [0000 1100] enable f3, f2
             #define RUN_BURST_ENABLE_SBM2   0x60    // [0110 0000] enable f2 and f1 burst
             #define RUN_BURST_ENABLE_BURST  0x40    // [0100 0000] f2 burst enabled
             #define DFLT_WFP_NB_DATA_BY_BUFFER  0xa7f   // 0x30 *** 2688 - 1 => nb samples -1
             #define DFLT_WFP_SNAPSHOT_PARAM     0xa80   // 0x34 *** 2688 => nb samples
             #define DFLT_WFP_BUFFER_LENGTH      0x1f8   // buffer length in burst = 3 * 2688 / 16 = 504 = 0x1f8
             #define DFLT_WFP_DELTA_F0_2         0x30    // 48 = 11 0000, max 7 bits
             // PDB >= 0.1.28, 0x80000f54
             typedef struct{
                 int data_shaping;       // 0x00 00 *** R2 R1 R0 SP1 SP0 BW
                 int run_burst_enable;   // 0x04 01 *** [run *** burst f2, f1, f0 *** enable f3, f2, f1, f0 ]
                 int addr_data_f0_0;     // 0x08
                 int addr_data_f0_1;     // 0x0c
                 int addr_data_f1_0;     // 0x10
                 int addr_data_f1_1;     // 0x14
                 int addr_data_f2_0;     // 0x18
                 int addr_data_f2_1;     // 0x1c
                 int addr_data_f3_0;     // 0x20
                 int addr_data_f3_1;     // 0x24
                 volatile int status;    // 0x28
                 volatile int delta_snapshot;     // 0x2c
                 int delta_f0;           // 0x30
                 int delta_f0_2;         // 0x34
                 int delta_f1;           // 0x38
                 int delta_f2;           // 0x3c
                 int nb_data_by_buffer;  // 0x40 number of samples in a buffer = 2688
                 int snapshot_param;     // 0x44
                 int start_date;         // 0x48
                 //
                 volatile unsigned int f0_0_coarse_time; // 0x4c
                 volatile unsigned int f0_0_fine_time;   // 0x50
                 volatile unsigned int f0_1_coarse_time; // 0x54
                 volatile unsigned int f0_1_fine_time;   // 0x58
                 //
                 volatile unsigned int f1_0_coarse_time; // 0x5c
                 volatile unsigned int f1_0_fine_time;   // 0x60
                 volatile unsigned int f1_1_coarse_time; // 0x64
                 volatile unsigned int f1_1_fine_time;   // 0x68
                 //
                 volatile unsigned int f2_0_coarse_time; // 0x6c
                 volatile unsigned int f2_0_fine_time;   // 0x70
                 volatile unsigned int f2_1_coarse_time; // 0x74
                 volatile unsigned int f2_1_fine_time;   // 0x78
                 //
                 volatile unsigned int f3_0_coarse_time; // 0x7c => 0x7c + 0xf54 = 0xd0
                 volatile unsigned int f3_0_fine_time;   // 0x80
                 volatile unsigned int f3_1_coarse_time; // 0x84
                 volatile unsigned int f3_1_fine_time;   // 0x88
                 //
                 unsigned int buffer_length;             // 0x8c = buffer length in burst 2688 / 16 = 168
                 //
-                volatile int16_t v_dummy;          // 0x90
+                volatile int v;     // 0x90
-                volatile int16_t v;                // 0x90
+                volatile int e1;    // 0x94
-                volatile int16_t e1_dummy;         // 0x94
+                volatile int e2;    // 0x98
-                volatile int16_t e1;               // 0x94
-                volatile int16_t e2_dummy;         // 0x98
-                volatile int16_t e2;               // 0x98
             } waveform_picker_regs_0_1_18_t;
             //*********************
             //*********************
             // SPECTRAL_MATRIX_REGS
             #define BITS_STATUS_F0  0x03    // [0011]
             #define BITS_STATUS_F1  0x0c    // [1100]
             #define BITS_STATUS_F2  0x30    // [0011 0000]
             #define BITS_HK_AA_SM   0x780   // [0111 1000 0000]
             #define BITS_SM_ERR     0x7c0   // [0111 1100 0000]
             #define BITS_STATUS_REG 0x7ff   // [0111 1111 1111]
             #define BIT_READY_0   0x1       // [01]
             #define BIT_READY_1   0x2       // [10]
             #define BIT_READY_0_1 0x3       // [11]
             #define BIT_STATUS_F1_0 0x04    // [0100]
             #define BIT_STATUS_F1_1 0x08    // [1000]
             #define BIT_STATUS_F2_0 0x10    // [0001 0000]
             #define BIT_STATUS_F2_1 0x20    // [0010 0000]
             #define DEFAULT_MATRIX_LENGTH   0xc8    // 25 * 128 / 16 = 200 = 0xc8
             #define BIT_IRQ_ON_NEW_MATRIX   0x01
             #define MASK_IRQ_ON_NEW_MATRIX  0xfffffffe
             #define BIT_IRQ_ON_ERROR        0x02
             #define MASK_IRQ_ON_ERROR       0xfffffffd
             typedef struct {
                 volatile int config;            // 0x00
                 volatile int status;            // 0x04
                 volatile int f0_0_address;      // 0x08
                 volatile int f0_1_address;      // 0x0C
                 //
                 volatile int f1_0_address;      // 0x10
                 volatile int f1_1_address;      // 0x14
                 volatile int f2_0_address;      // 0x18
                 volatile int f2_1_address;      // 0x1C
                 //
                 volatile unsigned int f0_0_coarse_time; // 0x20
                 volatile unsigned int f0_0_fine_time;   // 0x24
                 volatile unsigned int f0_1_coarse_time; // 0x28
                 volatile unsigned int f0_1_fine_time;   // 0x2C
                 //
                 volatile unsigned int f1_0_coarse_time; // 0x30
                 volatile unsigned int f1_0_fine_time;   // 0x34
                 volatile unsigned int f1_1_coarse_time; // 0x38
                 volatile unsigned int f1_1_fine_time;   // 0x3C
                 //
                 volatile unsigned int f2_0_coarse_time; // 0x40
                 volatile unsigned int f2_0_fine_time;   // 0x44
                 volatile unsigned int f2_1_coarse_time; // 0x48
                 volatile unsigned int f2_1_fine_time;   // 0x4C
                 //
                 unsigned int matrix_length;             // 0x50, length of a spectral matrix in burst 3200 / 16 = 200 = 0xc8
             } spectral_matrix_regs_t;
             #endif // GRLIB_REGS_H_INCLUDED

header/tc_load_dump_parameters.h +2 0

             #ifndef TC_LOAD_DUMP_PARAMETERS_H
             #define TC_LOAD_DUMP_PARAMETERS_H
             #include <rtems.h>
             #include <stdio.h>
             #include "fsw_params.h"
             #include "wf_handler.h"
             #include "tm_lfr_tc_exe.h"
             #include "fsw_misc.h"
             #include "basic_parameters_params.h"
             #include "avf0_prc0.h"
             #define FLOAT_EQUAL_ZERO    0.001
             #define NB_BINS_TO_REMOVE   3
             #define FI_INTERVAL_COEFF   0.285
             #define BIN_MIN             0
             #define BIN_MAX             127
             #define DELTAF_F0           96.
             #define DELTAF_F1           16.
             #define DELTAF_F2           1.
             #define DELTAF_DIV          2.
             #define BIT_RW1_F1  0x80
             #define BIT_RW1_F2  0x40
             #define BIT_RW2_F1  0x20
             #define BIT_RW2_F2  0x10
             #define BIT_RW3_F1  0x08
             #define BIT_RW3_F2  0x04
             #define BIT_RW4_F1  0x02
             #define BIT_RW4_F2  0x01
             #define WHEEL_1 1
             #define WHEEL_2 2
             #define WHEEL_3 3
             #define WHEEL_4 4
             #define FREQ_1 1
             #define FREQ_2 2
             #define FREQ_3 3
             #define FREQ_4 4
             #define FLAG_OFFSET_WHEELS_1_3 8
             #define FLAG_OFFSET_WHEELS_2_4 4
             #define FLAG_NAN    0   // Not A NUMBER
             #define FLAG_IAN    1   // Is A Number
             #define SBM_KCOEFF_PER_NORM_KCOEFF  2
             extern unsigned short sequenceCounterParameterDump;
             extern unsigned short sequenceCounters_TM_DUMP[];
             extern float k_coeff_intercalib_f0_norm[ ];
             extern float k_coeff_intercalib_f0_sbm[ ];
             extern float k_coeff_intercalib_f1_norm[ ];
             extern float k_coeff_intercalib_f1_sbm[ ];
             extern float k_coeff_intercalib_f2[ ];
             extern fbins_masks_t fbins_masks;
             int action_load_common_par( ccsdsTelecommandPacket_t *TC );
             int action_load_normal_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id , unsigned char *time);
             int action_load_burst_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id , unsigned char *time);
             int action_load_sbm1_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id , unsigned char *time);
             int action_load_sbm2_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id , unsigned char *time);
             int action_load_kcoefficients(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time);
             int action_load_fbins_mask(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time);
             int action_load_filter_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time);
             int action_dump_kcoefficients(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time);
             int action_dump_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id );
             // NORMAL
             int check_normal_par_consistency( ccsdsTelecommandPacket_t *TC, rtems_id queue_id );
             int set_sy_lfr_n_swf_l( ccsdsTelecommandPacket_t *TC );
             int set_sy_lfr_n_swf_p( ccsdsTelecommandPacket_t *TC );
             int set_sy_lfr_n_asm_p( ccsdsTelecommandPacket_t *TC );
             int set_sy_lfr_n_bp_p0( ccsdsTelecommandPacket_t *TC );
             int set_sy_lfr_n_bp_p1( ccsdsTelecommandPacket_t *TC );
             int set_sy_lfr_n_cwf_long_f3( ccsdsTelecommandPacket_t *TC );
             // BURST
             int set_sy_lfr_b_bp_p0( ccsdsTelecommandPacket_t *TC );
             int set_sy_lfr_b_bp_p1( ccsdsTelecommandPacket_t *TC );
             // SBM1
             int set_sy_lfr_s1_bp_p0( ccsdsTelecommandPacket_t *TC );
             int set_sy_lfr_s1_bp_p1( ccsdsTelecommandPacket_t *TC );
             // SBM2
             int set_sy_lfr_s2_bp_p0( ccsdsTelecommandPacket_t *TC );
             int set_sy_lfr_s2_bp_p1( ccsdsTelecommandPacket_t *TC );
             // TC_LFR_UPDATE_INFO
             unsigned int check_update_info_hk_lfr_mode( unsigned char mode );
             unsigned int check_update_info_hk_tds_mode( unsigned char mode );
             unsigned int check_update_info_hk_thr_mode( unsigned char mode );
             void set_hk_lfr_sc_rw_f_flag( unsigned char wheel, unsigned char freq, float value );
             void set_hk_lfr_sc_rw_f_flags( void );
+            int check_sy_lfr_rw_f( ccsdsTelecommandPacket_t *TC, int offset, int* pos, float* value );
+            int check_all_sy_lfr_rw_f( ccsdsTelecommandPacket_t *TC, int *pos, float*value );
             void getReactionWheelsFrequencies( ccsdsTelecommandPacket_t *TC );
             void setFBinMask(unsigned char *fbins_mask, float rw_f, unsigned char deltaFreq, float sy_lfr_rw_k );
             void build_sy_lfr_rw_mask( unsigned int channel );
             void build_sy_lfr_rw_masks();
             void merge_fbins_masks( void );
             // FBINS_MASK
             int set_sy_lfr_fbins( ccsdsTelecommandPacket_t *TC );
             // TC_LFR_LOAD_PARS_FILTER_PAR
             int check_sy_lfr_rw_k( ccsdsTelecommandPacket_t *TC, int offset, int* pos, float* value );
             int check_all_sy_lfr_rw_k( ccsdsTelecommandPacket_t *TC, int *pos, float*value );
             int check_sy_lfr_filter_parameters( ccsdsTelecommandPacket_t *TC, rtems_id queue_id );
             // KCOEFFICIENTS
             int set_sy_lfr_kcoeff(ccsdsTelecommandPacket_t *TC , rtems_id queue_id);
             void copyFloatByChar( unsigned char *destination, unsigned char *source );
             void copyInt32ByChar( unsigned char *destination, unsigned char *source );
             void copyInt16ByChar( unsigned char *destination, unsigned char *source );
             void floatToChar( float value, unsigned char* ptr);
             void init_parameter_dump( void );
             void init_kcoefficients_dump( void );
             void init_kcoefficients_dump_packet( Packet_TM_LFR_KCOEFFICIENTS_DUMP_t *kcoefficients_dump, unsigned char pkt_nr, unsigned char blk_nr );
             void increment_seq_counter_destination_id_dump( unsigned char *packet_sequence_control, unsigned char destination_id );
             #endif // TC_LOAD_DUMP_PARAMETERS_H

src/fsw_globals.c +6 -6

             /** 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_id    Task_id[NB_OF_TASKS]        = {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        = 0;
+            unsigned short sequenceCounters_SCIENCE_NORMAL_BURST        __attribute__((aligned(0x4))) = 0;
-            unsigned short sequenceCounters_SCIENCE_SBM1_SBM2           = 0;
+            unsigned short sequenceCounters_SCIENCE_SBM1_SBM2           __attribute__((aligned(0x4))) = 0;
-            unsigned short sequenceCounters_TC_EXE[SEQ_CNT_NB_DEST_ID]  = {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] = {0};
+            unsigned short sequenceCounters_TM_DUMP[SEQ_CNT_NB_DEST_ID] __attribute__((aligned(0x4))) = {0};
-            unsigned short sequenceCounterHK                            = {0};
+            unsigned short sequenceCounterHK                            __attribute__((aligned(0x4))) = {0};
-            spw_stats grspw_stats                                       = {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};
             unsigned int acquisitionDurations[NB_ACQUISITION_DURATION]
             = {ACQUISITION_DURATION_F0, ACQUISITION_DURATION_F1, ACQUISITION_DURATION_F2};

src/fsw_init.c +2 -2

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

src/fsw_misc.c +21 -3

             /** General usage functions and RTEMS tasks.
              *
              * @file
              * @author P. LEROY
              *
              */
             #include "fsw_misc.h"
             int16_t hk_lfr_sc_v_f3_as_int16 = 0;
             int16_t hk_lfr_sc_e1_f3_as_int16 = 0;
             int16_t hk_lfr_sc_e2_f3_as_int16 = 0;
             void timer_configure(unsigned char timer, unsigned int clock_divider,
                                 unsigned char interrupt_level, rtems_isr (*timer_isr)() )
             {
                 /** This function configures a GPTIMER timer instantiated in the VHDL design.
                  *
                  * @param gptimer_regs points to the APB registers of the GPTIMER IP core.
                  * @param timer is the number of the timer in the IP core (several timers can be instantiated).
                  * @param clock_divider is the divider of the 1 MHz clock that will be configured.
                  * @param interrupt_level is the interrupt level that the timer drives.
                  * @param timer_isr is the interrupt subroutine that will be attached to the IRQ driven by the timer.
                  *
                  * Interrupt levels are described in the SPARC documentation sparcv8.pdf p.76
                  *
                  */
                 rtems_status_code status;
                 rtems_isr_entry old_isr_handler;
                 old_isr_handler = NULL;
                 gptimer_regs->timer[timer].ctrl = INIT_CHAR;  // reset the control register
                 status = rtems_interrupt_catch( timer_isr, interrupt_level, &old_isr_handler) ; // see sparcv8.pdf p.76 for interrupt levels
                 if (status!=RTEMS_SUCCESSFUL)
                 {
                     PRINTF("in configure_timer *** ERR rtems_interrupt_catch\n")
                 }
                 timer_set_clock_divider( timer, clock_divider);
             }
             void timer_start(unsigned char timer)
             {
                 /** This function starts a GPTIMER timer.
                  *
                  * @param gptimer_regs points to the APB registers of the GPTIMER IP core.
                  * @param timer is the number of the timer in the IP core (several timers can be instantiated).
                  *
                  */
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | GPTIMER_CLEAR_IRQ;
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | GPTIMER_LD;
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | GPTIMER_EN;
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | GPTIMER_RS;
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | GPTIMER_IE;
             }
             void timer_stop(unsigned char timer)
             {
                 /** This function stops a GPTIMER timer.
                  *
                  * @param gptimer_regs points to the APB registers of the GPTIMER IP core.
                  * @param timer is the number of the timer in the IP core (several timers can be instantiated).
                  *
                  */
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl & GPTIMER_EN_MASK;
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl & GPTIMER_IE_MASK;
                 gptimer_regs->timer[timer].ctrl = gptimer_regs->timer[timer].ctrl | GPTIMER_CLEAR_IRQ;
             }
             void timer_set_clock_divider(unsigned char timer, unsigned int clock_divider)
             {
                 /** This function sets the clock divider of a GPTIMER timer.
                  *
                  * @param gptimer_regs points to the APB registers of the GPTIMER IP core.
                  * @param timer is the number of the timer in the IP core (several timers can be instantiated).
                  * @param clock_divider is the divider of the 1 MHz clock that will be configured.
                  *
                  */
                 gptimer_regs->timer[timer].reload = clock_divider; // base clock frequency is 1 MHz
             }
             // WATCHDOG
             rtems_isr watchdog_isr( rtems_vector_number vector )
             {
                 rtems_status_code status_code;
                 status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_12 );
                 PRINTF("watchdog_isr *** this is the end, exit(0)\n");
                 exit(0);
             }
             void watchdog_configure(void)
             {
                 /** This function configure the watchdog.
                  *
                  * @param gptimer_regs points to the APB registers of the GPTIMER IP core.
                  * @param timer is the number of the timer in the IP core (several timers can be instantiated).
                  *
                  * The watchdog is a timer provided by the GPTIMER IP core of the GRLIB.
                  *
                  */
                 LEON_Mask_interrupt( IRQ_GPTIMER_WATCHDOG );    // mask gptimer/watchdog interrupt during configuration
                 timer_configure( TIMER_WATCHDOG, CLKDIV_WATCHDOG, IRQ_SPARC_GPTIMER_WATCHDOG, watchdog_isr );
                 LEON_Clear_interrupt( IRQ_GPTIMER_WATCHDOG );   // clear gptimer/watchdog interrupt
             }
             void watchdog_stop(void)
             {
                 LEON_Mask_interrupt( IRQ_GPTIMER_WATCHDOG );                  // mask gptimer/watchdog interrupt line
                 timer_stop( TIMER_WATCHDOG );
                 LEON_Clear_interrupt( IRQ_GPTIMER_WATCHDOG );                 // clear gptimer/watchdog interrupt
             }
             void watchdog_reload(void)
             {
                 /** This function reloads the watchdog timer counter with the timer reload value.
                  *
                  * @param void
                  *
                  * @return void
                  *
                  */
                 gptimer_regs->timer[TIMER_WATCHDOG].ctrl = gptimer_regs->timer[TIMER_WATCHDOG].ctrl | GPTIMER_LD;
             }
             void watchdog_start(void)
             {
                 /** This function starts the watchdog timer.
                  *
                  * @param gptimer_regs points to the APB registers of the GPTIMER IP core.
                  * @param timer is the number of the timer in the IP core (several timers can be instantiated).
                  *
                  */
                 LEON_Clear_interrupt( IRQ_GPTIMER_WATCHDOG );
                 gptimer_regs->timer[TIMER_WATCHDOG].ctrl = gptimer_regs->timer[TIMER_WATCHDOG].ctrl | GPTIMER_CLEAR_IRQ;
                 gptimer_regs->timer[TIMER_WATCHDOG].ctrl = gptimer_regs->timer[TIMER_WATCHDOG].ctrl | GPTIMER_LD;
                 gptimer_regs->timer[TIMER_WATCHDOG].ctrl = gptimer_regs->timer[TIMER_WATCHDOG].ctrl | GPTIMER_EN;
                 gptimer_regs->timer[TIMER_WATCHDOG].ctrl = gptimer_regs->timer[TIMER_WATCHDOG].ctrl | GPTIMER_IE;
                 LEON_Unmask_interrupt( IRQ_GPTIMER_WATCHDOG );
             }
             int enable_apbuart_transmitter( void )  // set the bit 1, TE Transmitter Enable to 1 in the APBUART control register
             {
                 struct apbuart_regs_str *apbuart_regs = (struct apbuart_regs_str *) REGS_ADDR_APBUART;
                 apbuart_regs->ctrl = APBUART_CTRL_REG_MASK_TE;
                 return 0;
             }
             void set_apbuart_scaler_reload_register(unsigned int regs, unsigned int value)
             {
                 /** This function sets the scaler reload register of the apbuart module
                  *
                  * @param regs is the address of the apbuart registers in memory
                  * @param value is the value that will be stored in the scaler register
                  *
                  * The value shall be set by the software to get data on the serial interface.
                  *
                  */
                 struct apbuart_regs_str *apbuart_regs = (struct apbuart_regs_str *) regs;
                 apbuart_regs->scaler = value;
                 BOOT_PRINTF1("OK  *** apbuart port scaler reload register set to 0x%x\n", value)
             }
             //************
             // RTEMS TASKS
             rtems_task load_task(rtems_task_argument argument)
             {
                 BOOT_PRINTF("in LOAD *** \n")
                 rtems_status_code status;
                 unsigned int i;
                 unsigned int j;
                 rtems_name name_watchdog_rate_monotonic;  // name of the watchdog rate monotonic
                 rtems_id watchdog_period_id;              // id of the watchdog rate monotonic period
                 watchdog_period_id = RTEMS_ID_NONE;
                 name_watchdog_rate_monotonic = rtems_build_name( 'L', 'O', 'A', 'D' );
                 status = rtems_rate_monotonic_create( name_watchdog_rate_monotonic, &watchdog_period_id );
                 if( status != RTEMS_SUCCESSFUL ) {
                     PRINTF1( "in LOAD *** rtems_rate_monotonic_create failed with status of %d\n", status )
                 }
                 i = 0;
                 j = 0;
                 watchdog_configure();
                 watchdog_start();
                 set_sy_lfr_watchdog_enabled( true );
                 while(1){
                     status = rtems_rate_monotonic_period( watchdog_period_id, WATCHDOG_PERIOD );
                     watchdog_reload();
                     i = i + 1;
                     if ( i == WATCHDOG_LOOP_PRINTF )
                     {
                         i = 0;
                         j = j + 1;
                         PRINTF1("%d\n", j)
                     }
             #ifdef DEBUG_WATCHDOG
                     if (j == WATCHDOG_LOOP_DEBUG )
                     {
                         status = rtems_task_delete(RTEMS_SELF);
                     }
             #endif
                 }
             }
             rtems_task hous_task(rtems_task_argument argument)
             {
                 rtems_status_code status;
                 rtems_status_code spare_status;
                 rtems_id queue_id;
                 rtems_rate_monotonic_period_status period_status;
                 bool isSynchronized;
                 queue_id = RTEMS_ID_NONE;
                 memset(&period_status, 0, sizeof(rtems_rate_monotonic_period_status));
                 isSynchronized = false;
                 status =  get_message_queue_id_send( &queue_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in HOUS *** ERR get_message_queue_id_send %d\n", status)
                 }
                 BOOT_PRINTF("in HOUS ***\n");
                 if (rtems_rate_monotonic_ident( name_hk_rate_monotonic, &HK_id) != RTEMS_SUCCESSFUL) {
                     status = rtems_rate_monotonic_create( name_hk_rate_monotonic, &HK_id );
                     if( status != RTEMS_SUCCESSFUL ) {
                         PRINTF1( "rtems_rate_monotonic_create failed with status of %d\n", status );
                     }
                 }
                 status = rtems_rate_monotonic_cancel(HK_id);
                 if( status != RTEMS_SUCCESSFUL ) {
                     PRINTF1( "ERR *** in HOUS *** rtems_rate_monotonic_cancel(HK_id) ***code: %d\n", status );
                 }
                 else {
                     DEBUG_PRINTF("OK  *** in HOUS *** rtems_rate_monotonic_cancel(HK_id)\n");
                 }
                 // startup phase
                 status = rtems_rate_monotonic_period( HK_id, SY_LFR_TIME_SYN_TIMEOUT_in_ticks );
                 status = rtems_rate_monotonic_get_status( HK_id, &period_status );
                 DEBUG_PRINTF1("startup HK, HK_id status = %d\n", period_status.state)
                 while( (period_status.state != RATE_MONOTONIC_EXPIRED)
                        && (isSynchronized == false) )   // after SY_LFR_TIME_SYN_TIMEOUT ms, starts HK anyway
                 {
                     if ((time_management_regs->coarse_time & VAL_LFR_SYNCHRONIZED) == INT32_ALL_0) // check time synchronization
                     {
                         isSynchronized = true;
                     }
                     else
                     {
                         status = rtems_rate_monotonic_get_status( HK_id, &period_status );
                         status = rtems_task_wake_after( HK_SYNC_WAIT );        // wait HK_SYNCH_WAIT 100 ms = 10 * 10 ms
                     }
                 }
                 status = rtems_rate_monotonic_cancel(HK_id);
                 DEBUG_PRINTF1("startup HK, HK_id status = %d\n", period_status.state)
                 set_hk_lfr_reset_cause( POWER_ON );
                 while(1){ // launch the rate monotonic task
                     status = rtems_rate_monotonic_period( HK_id, HK_PERIOD );
                     if ( status != RTEMS_SUCCESSFUL ) {
                         PRINTF1( "in HOUS *** ERR period: %d\n", status);
                         spare_status = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_6 );
                     }
                     else {
                         housekeeping_packet.packetSequenceControl[BYTE_0] = (unsigned char) (sequenceCounterHK >> SHIFT_1_BYTE);
                         housekeeping_packet.packetSequenceControl[BYTE_1] = (unsigned char) (sequenceCounterHK     );
                         increment_seq_counter( &sequenceCounterHK );
                         housekeeping_packet.time[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
                         housekeeping_packet.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
                         housekeeping_packet.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
                         housekeeping_packet.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
                         housekeeping_packet.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
                         housekeeping_packet.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
                         spacewire_update_hk_lfr_link_state( &housekeeping_packet.lfr_status_word[0] );
                         spacewire_read_statistics();
                         update_hk_with_grspw_stats();
                         set_hk_lfr_time_not_synchro();
                         housekeeping_packet.hk_lfr_q_sd_fifo_size_max = hk_lfr_q_sd_fifo_size_max;
                         housekeeping_packet.hk_lfr_q_rv_fifo_size_max = hk_lfr_q_rv_fifo_size_max;
                         housekeeping_packet.hk_lfr_q_p0_fifo_size_max = hk_lfr_q_p0_fifo_size_max;
                         housekeeping_packet.hk_lfr_q_p1_fifo_size_max = hk_lfr_q_p1_fifo_size_max;
                         housekeeping_packet.hk_lfr_q_p2_fifo_size_max = hk_lfr_q_p2_fifo_size_max;
                         housekeeping_packet.sy_lfr_common_parameters_spare  = parameter_dump_packet.sy_lfr_common_parameters_spare;
                         housekeeping_packet.sy_lfr_common_parameters        = parameter_dump_packet.sy_lfr_common_parameters;
                         get_temperatures( housekeeping_packet.hk_lfr_temp_scm );
                         get_v_e1_e2_f3(   housekeeping_packet.hk_lfr_sc_v_f3  );
                         get_cpu_load( (unsigned char *) &housekeeping_packet.hk_lfr_cpu_load );
                         hk_lfr_le_me_he_update();
                         // SEND PACKET
                         status =  rtems_message_queue_send( queue_id, &housekeeping_packet,
                                                             PACKET_LENGTH_HK + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES);
                         if (status != RTEMS_SUCCESSFUL) {
                             PRINTF1("in HOUS *** ERR send: %d\n", status)
                         }
                     }
                 }
                 PRINTF("in HOUS *** deleting task\n")
                 status = rtems_task_delete( RTEMS_SELF ); // should not return
                 return;
             }
+            int32_t getIntFromShort( int reg )
+            {
+                int16_t ret_as_int16;
+                int32_t ret_as_int32;
+                char *regPtr;
+                char *ret_as_int16_ptr;
+                regPtr = (char*) &reg;
+                ret_as_int16_ptr = (char*) &ret_as_int16;
+                ret_as_int16_ptr[BYTE_0] = regPtr[BYTE_3];
+                ret_as_int16_ptr[BYTE_1] = regPtr[BYTE_4];
+                ret_as_int32 = (int32_t) ret_as_int16;
+                return ret_as_int32;
+            }
             rtems_task avgv_task(rtems_task_argument argument)
             {
             #define MOVING_AVERAGE 16
                 rtems_status_code status;
                 static int32_t v[MOVING_AVERAGE] = {0};
                 static int32_t e1[MOVING_AVERAGE] = {0};
                 static int32_t e2[MOVING_AVERAGE] = {0};
                 int32_t average_v;
                 int32_t average_e1;
                 int32_t average_e2;
                 int32_t newValue_v;
                 int32_t newValue_e1;
                 int32_t newValue_e2;
                 unsigned char k;
                 unsigned char indexOfOldValue;
                 BOOT_PRINTF("in AVGV ***\n");
                 if (rtems_rate_monotonic_ident( name_avgv_rate_monotonic, &AVGV_id) != RTEMS_SUCCESSFUL) {
                     status = rtems_rate_monotonic_create( name_avgv_rate_monotonic, &AVGV_id );
                     if( status != RTEMS_SUCCESSFUL ) {
                         PRINTF1( "rtems_rate_monotonic_create failed with status of %d\n", status );
                     }
                 }
                 status = rtems_rate_monotonic_cancel(AVGV_id);
                 if( status != RTEMS_SUCCESSFUL ) {
                     PRINTF1( "ERR *** in AVGV *** rtems_rate_monotonic_cancel(AVGV_id) ***code: %d\n", status );
                 }
                 else {
                     DEBUG_PRINTF("OK  *** in AVGV *** rtems_rate_monotonic_cancel(AVGV_id)\n");
                 }
                 // initialize values
                 indexOfOldValue = MOVING_AVERAGE - 1;
                 average_v   = 0;
                 average_e1  = 0;
                 average_e2  = 0;
                 newValue_v  = 0;
                 newValue_e1 = 0;
                 newValue_e2 = 0;
                 k = INIT_CHAR;
                 while(1)
                 { // launch the rate monotonic task
                     status = rtems_rate_monotonic_period( AVGV_id, AVGV_PERIOD );
                     if ( status != RTEMS_SUCCESSFUL )
                     {
                         PRINTF1( "in AVGV *** ERR period: %d\n", status);
                     }
                     else
                     {
                         // get new values
-                        newValue_v =  (int32_t) waveform_picker_regs->v;
+                        newValue_v =  getIntFromShort( waveform_picker_regs->v );
-                        newValue_e1 = (int32_t) waveform_picker_regs->e1;
+                        newValue_e1 = getIntFromShort( waveform_picker_regs->e1 );
-                        newValue_e2 = (int32_t) waveform_picker_regs->e2;
+                        newValue_e2 = getIntFromShort( waveform_picker_regs->e2 );
                         // compute the moving average
                         average_v = average_v + newValue_v - v[k];
                         average_e1 = average_e1 + newValue_e1 - e1[k];
                         average_e2 = average_e2 + newValue_e2 - e2[k];
                         // store new values in buffers
                         v[k] = newValue_v;
                         e1[k] = newValue_e1;
                         e2[k] = newValue_e2;
                     }
                     if (k == (MOVING_AVERAGE-1))
                     {
                         k = 0;
                     }
                     else
                     {
                         k++;
                     }
                     //update int16 values
                     hk_lfr_sc_v_f3_as_int16 =  (int16_t) (average_v / MOVING_AVERAGE );
                     hk_lfr_sc_e1_f3_as_int16 = (int16_t) (average_e1 / MOVING_AVERAGE );
                     hk_lfr_sc_e2_f3_as_int16 = (int16_t) (average_e2 / MOVING_AVERAGE );
                 }
                 PRINTF("in AVGV *** deleting task\n");
                 status = rtems_task_delete( RTEMS_SELF ); // should not return
                 return;
             }
             rtems_task dumb_task( rtems_task_argument unused )
             {
                 /** This RTEMS taks is used to print messages without affecting the general behaviour of the software.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The DUMB taks waits for RTEMS events and print messages depending on the incoming events.
                  *
                  */
                 unsigned int i;
                 unsigned int intEventOut;
                 unsigned int coarse_time = 0;
                 unsigned int fine_time = 0;
                 rtems_event_set event_out;
                 event_out = EVENT_SETS_NONE_PENDING;
                 BOOT_PRINTF("in DUMB *** \n")
                 while(1){
                     rtems_event_receive(RTEMS_EVENT_0 | RTEMS_EVENT_1 | RTEMS_EVENT_2 | RTEMS_EVENT_3
                                         | RTEMS_EVENT_4 | RTEMS_EVENT_5 | RTEMS_EVENT_6 | RTEMS_EVENT_7
                                         | RTEMS_EVENT_8 | RTEMS_EVENT_9 | RTEMS_EVENT_12 | RTEMS_EVENT_13
                                         | RTEMS_EVENT_14,
                                         RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out); // wait for an RTEMS_EVENT
                     intEventOut =  (unsigned int) event_out;
                     for ( i=0; i<NB_RTEMS_EVENTS; i++)
                     {
                         if ( ((intEventOut >> i) & 1) != 0)
                         {
                             coarse_time = time_management_regs->coarse_time;
                             fine_time = time_management_regs->fine_time;
                             if (i==EVENT_12)
                             {
                                 PRINTF1("%s\n", DUMB_MESSAGE_12)
                             }
                             if (i==EVENT_13)
                             {
                                 PRINTF1("%s\n", DUMB_MESSAGE_13)
                             }
                             if (i==EVENT_14)
                             {
                                 PRINTF1("%s\n", DUMB_MESSAGE_1)
                             }
                         }
                     }
                 }
             }
             //*****************************
             // init housekeeping parameters
             void init_housekeeping_parameters( void )
             {
                 /** This function initialize the housekeeping_packet global variable with default values.
                  *
                  */
                 unsigned int i = 0;
                 unsigned char *parameters;
                 unsigned char sizeOfHK;
                 sizeOfHK = sizeof( Packet_TM_LFR_HK_t );
                 parameters = (unsigned char*) &housekeeping_packet;
                 for(i = 0; i< sizeOfHK; i++)
                 {
                     parameters[i] = INIT_CHAR;
                 }
                 housekeeping_packet.targetLogicalAddress = CCSDS_DESTINATION_ID;
                 housekeeping_packet.protocolIdentifier = CCSDS_PROTOCOLE_ID;
                 housekeeping_packet.reserved = DEFAULT_RESERVED;
                 housekeeping_packet.userApplication = CCSDS_USER_APP;
                 housekeeping_packet.packetID[0] = (unsigned char) (APID_TM_HK >> SHIFT_1_BYTE);
                 housekeeping_packet.packetID[1] = (unsigned char) (APID_TM_HK);
                 housekeeping_packet.packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 housekeeping_packet.packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
                 housekeeping_packet.packetLength[0] = (unsigned char) (PACKET_LENGTH_HK >> SHIFT_1_BYTE);
                 housekeeping_packet.packetLength[1] = (unsigned char) (PACKET_LENGTH_HK     );
                 housekeeping_packet.spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;
                 housekeeping_packet.serviceType = TM_TYPE_HK;
                 housekeeping_packet.serviceSubType = TM_SUBTYPE_HK;
                 housekeeping_packet.destinationID = TM_DESTINATION_ID_GROUND;
                 housekeeping_packet.sid = SID_HK;
                 // init status word
                 housekeeping_packet.lfr_status_word[0] = DEFAULT_STATUS_WORD_BYTE0;
                 housekeeping_packet.lfr_status_word[1] = DEFAULT_STATUS_WORD_BYTE1;
                 // init software version
                 housekeeping_packet.lfr_sw_version[0] = SW_VERSION_N1;
                 housekeeping_packet.lfr_sw_version[1] = SW_VERSION_N2;
                 housekeeping_packet.lfr_sw_version[BYTE_2] = SW_VERSION_N3;
                 housekeeping_packet.lfr_sw_version[BYTE_3] = SW_VERSION_N4;
                 // init fpga version
                 parameters = (unsigned char *) (REGS_ADDR_VHDL_VERSION);
                 housekeeping_packet.lfr_fpga_version[BYTE_0] = parameters[BYTE_1]; // n1
                 housekeeping_packet.lfr_fpga_version[BYTE_1] = parameters[BYTE_2]; // n2
                 housekeeping_packet.lfr_fpga_version[BYTE_2] = parameters[BYTE_3]; // n3
                 housekeeping_packet.hk_lfr_q_sd_fifo_size = MSG_QUEUE_COUNT_SEND;
                 housekeeping_packet.hk_lfr_q_rv_fifo_size = MSG_QUEUE_COUNT_RECV;
                 housekeeping_packet.hk_lfr_q_p0_fifo_size = MSG_QUEUE_COUNT_PRC0;
                 housekeeping_packet.hk_lfr_q_p1_fifo_size = MSG_QUEUE_COUNT_PRC1;
                 housekeeping_packet.hk_lfr_q_p2_fifo_size = MSG_QUEUE_COUNT_PRC2;
             }
             void increment_seq_counter( unsigned short *packetSequenceControl )
             {
                 /** This function increment the sequence counter passes in argument.
                  *
                  * The increment does not affect the grouping flag. In case of an overflow, the counter is reset to 0.
                  *
                  */
                 unsigned short segmentation_grouping_flag;
                 unsigned short sequence_cnt;
                 segmentation_grouping_flag  = TM_PACKET_SEQ_CTRL_STANDALONE << SHIFT_1_BYTE;   // keep bits 7 downto 6
                 sequence_cnt                = (*packetSequenceControl) & SEQ_CNT_MASK;    // [0011 1111 1111 1111]
                 if ( sequence_cnt < SEQ_CNT_MAX)
                 {
                     sequence_cnt = sequence_cnt + 1;
                 }
                 else
                 {
                     sequence_cnt = 0;
                 }
                 *packetSequenceControl = segmentation_grouping_flag | sequence_cnt ;
             }
             void getTime( unsigned char *time)
             {
                 /** This function write the current local time in the time buffer passed in argument.
                  *
                  */
                 time[0] = (unsigned char) (time_management_regs->coarse_time>>SHIFT_3_BYTES);
                 time[1] = (unsigned char) (time_management_regs->coarse_time>>SHIFT_2_BYTES);
                 time[2] = (unsigned char) (time_management_regs->coarse_time>>SHIFT_1_BYTE);
                 time[3] = (unsigned char) (time_management_regs->coarse_time);
                 time[4] = (unsigned char) (time_management_regs->fine_time>>SHIFT_1_BYTE);
                 time[5] = (unsigned char) (time_management_regs->fine_time);
             }
             unsigned long long int getTimeAsUnsignedLongLongInt( )
             {
                 /** This function write the current local time in the time buffer passed in argument.
                  *
                  */
                 unsigned long long int time;
                 time = ( (unsigned long long int) (time_management_regs->coarse_time & COARSE_TIME_MASK) << SHIFT_2_BYTES )
                         + time_management_regs->fine_time;
                 return time;
             }
             void send_dumb_hk( void )
             {
                 Packet_TM_LFR_HK_t dummy_hk_packet;
                 unsigned char *parameters;
                 unsigned int i;
                 rtems_id queue_id;
                 queue_id = RTEMS_ID_NONE;
                 dummy_hk_packet.targetLogicalAddress = CCSDS_DESTINATION_ID;
                 dummy_hk_packet.protocolIdentifier = CCSDS_PROTOCOLE_ID;
                 dummy_hk_packet.reserved = DEFAULT_RESERVED;
                 dummy_hk_packet.userApplication = CCSDS_USER_APP;
                 dummy_hk_packet.packetID[0] = (unsigned char) (APID_TM_HK >> SHIFT_1_BYTE);
                 dummy_hk_packet.packetID[1] = (unsigned char) (APID_TM_HK);
                 dummy_hk_packet.packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 dummy_hk_packet.packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
                 dummy_hk_packet.packetLength[0] = (unsigned char) (PACKET_LENGTH_HK >> SHIFT_1_BYTE);
                 dummy_hk_packet.packetLength[1] = (unsigned char) (PACKET_LENGTH_HK     );
                 dummy_hk_packet.spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;
                 dummy_hk_packet.serviceType = TM_TYPE_HK;
                 dummy_hk_packet.serviceSubType = TM_SUBTYPE_HK;
                 dummy_hk_packet.destinationID = TM_DESTINATION_ID_GROUND;
                 dummy_hk_packet.time[0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
                 dummy_hk_packet.time[1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
                 dummy_hk_packet.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
                 dummy_hk_packet.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
                 dummy_hk_packet.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
                 dummy_hk_packet.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
                 dummy_hk_packet.sid = SID_HK;
                 // init status word
                 dummy_hk_packet.lfr_status_word[0] = INT8_ALL_F;
                 dummy_hk_packet.lfr_status_word[1] = INT8_ALL_F;
                 // init software version
                 dummy_hk_packet.lfr_sw_version[0] = SW_VERSION_N1;
                 dummy_hk_packet.lfr_sw_version[1] = SW_VERSION_N2;
                 dummy_hk_packet.lfr_sw_version[BYTE_2] = SW_VERSION_N3;
                 dummy_hk_packet.lfr_sw_version[BYTE_3] = SW_VERSION_N4;
                 // init fpga version
                 parameters = (unsigned char *) (REGS_ADDR_WAVEFORM_PICKER + APB_OFFSET_VHDL_REV);
                 dummy_hk_packet.lfr_fpga_version[BYTE_0] = parameters[BYTE_1]; // n1
                 dummy_hk_packet.lfr_fpga_version[BYTE_1] = parameters[BYTE_2]; // n2
                 dummy_hk_packet.lfr_fpga_version[BYTE_2] = parameters[BYTE_3]; // n3
                 parameters = (unsigned char *) &dummy_hk_packet.hk_lfr_cpu_load;
                 for (i=0; i<(BYTE_POS_HK_REACTION_WHEELS_FREQUENCY - BYTE_POS_HK_LFR_CPU_LOAD); i++)
                 {
                     parameters[i] = INT8_ALL_F;
                 }
                 get_message_queue_id_send( &queue_id );
                 rtems_message_queue_send( queue_id, &dummy_hk_packet,
                                             PACKET_LENGTH_HK + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES);
             }
             void get_temperatures( unsigned char *temperatures )
             {
                 unsigned char* temp_scm_ptr;
                 unsigned char* temp_pcb_ptr;
                 unsigned char* temp_fpga_ptr;
                 // SEL1 SEL0
                 // 0    0       => PCB
                 // 0    1       => FPGA
                 // 1    0       => SCM
                 temp_scm_ptr  = (unsigned char *) &time_management_regs->temp_scm;
                 temp_pcb_ptr =  (unsigned char *) &time_management_regs->temp_pcb;
                 temp_fpga_ptr = (unsigned char *) &time_management_regs->temp_fpga;
                 temperatures[ BYTE_0 ] = temp_scm_ptr[ BYTE_2 ];
                 temperatures[ BYTE_1 ] = temp_scm_ptr[ BYTE_3 ];
                 temperatures[ BYTE_2 ] = temp_pcb_ptr[ BYTE_2 ];
                 temperatures[ BYTE_3 ] = temp_pcb_ptr[ BYTE_3 ];
                 temperatures[ BYTE_4 ] = temp_fpga_ptr[ BYTE_2 ];
                 temperatures[ BYTE_5 ] = temp_fpga_ptr[ BYTE_3 ];
             }
             void get_v_e1_e2_f3( unsigned char *spacecraft_potential )
             {
                 unsigned char* v_ptr;
                 unsigned char* e1_ptr;
                 unsigned char* e2_ptr;
                 v_ptr  = (unsigned char *) &hk_lfr_sc_v_f3_as_int16;
                 e1_ptr = (unsigned char *) &hk_lfr_sc_e1_f3_as_int16;
                 e2_ptr = (unsigned char *) &hk_lfr_sc_e2_f3_as_int16;
                 spacecraft_potential[BYTE_0] = v_ptr[0];
                 spacecraft_potential[BYTE_1] = v_ptr[1];
                 spacecraft_potential[BYTE_2] = e1_ptr[0];
                 spacecraft_potential[BYTE_3] = e1_ptr[1];
                 spacecraft_potential[BYTE_4] = e2_ptr[0];
                 spacecraft_potential[BYTE_5] = e2_ptr[1];
             }
             void get_cpu_load( unsigned char *resource_statistics )
             {
                 unsigned char cpu_load;
                 cpu_load = lfr_rtems_cpu_usage_report();
                 // HK_LFR_CPU_LOAD
                 resource_statistics[0] = cpu_load;
                 // HK_LFR_CPU_LOAD_MAX
                 if (cpu_load > resource_statistics[1])
                 {
                      resource_statistics[1] = cpu_load;
                 }
                 // CPU_LOAD_AVE
                 resource_statistics[BYTE_2] = 0;
             #ifndef PRINT_TASK_STATISTICS
                     rtems_cpu_usage_reset();
             #endif
             }
             void set_hk_lfr_sc_potential_flag( bool state )
             {
                 if (state == true)
                 {
                     housekeeping_packet.lfr_status_word[1] =
                             housekeeping_packet.lfr_status_word[1] | STATUS_WORD_SC_POTENTIAL_FLAG_BIT;   // [0100 0000]
                 }
                 else
                 {
                     housekeeping_packet.lfr_status_word[1] =
                             housekeeping_packet.lfr_status_word[1] & STATUS_WORD_SC_POTENTIAL_FLAG_MASK;   // [1011 1111]
                 }
             }
             void set_sy_lfr_pas_filter_enabled( bool state )
             {
                 if (state == true)
                 {
                     housekeeping_packet.lfr_status_word[1] =
                             housekeeping_packet.lfr_status_word[1] | STATUS_WORD_PAS_FILTER_ENABLED_BIT;   // [0010 0000]
                 }
                 else
                 {
                     housekeeping_packet.lfr_status_word[1] =
                             housekeeping_packet.lfr_status_word[1] & STATUS_WORD_PAS_FILTER_ENABLED_MASK;   // [1101 1111]
                 }
             }
             void set_sy_lfr_watchdog_enabled( bool state )
             {
                 if (state == true)
                 {
                     housekeeping_packet.lfr_status_word[1] =
                             housekeeping_packet.lfr_status_word[1] | STATUS_WORD_WATCHDOG_BIT;   // [0001 0000]
                 }
                 else
                 {
                     housekeeping_packet.lfr_status_word[1] =
                             housekeeping_packet.lfr_status_word[1] & STATUS_WORD_WATCHDOG_MASK;   // [1110 1111]
                 }
             }
             void set_hk_lfr_calib_enable( bool state )
             {
                 if (state == true)
                 {
                     housekeeping_packet.lfr_status_word[1] =
                             housekeeping_packet.lfr_status_word[1] | STATUS_WORD_CALIB_BIT;   // [0000 1000]
                 }
                 else
                 {
                     housekeeping_packet.lfr_status_word[1] =
                             housekeeping_packet.lfr_status_word[1] & STATUS_WORD_CALIB_MASK;   // [1111 0111]
                 }
             }
             void set_hk_lfr_reset_cause( enum lfr_reset_cause_t lfr_reset_cause )
             {
                 housekeeping_packet.lfr_status_word[1] =
                         housekeeping_packet.lfr_status_word[1] & STATUS_WORD_RESET_CAUSE_MASK; // [1111 1000]
                 housekeeping_packet.lfr_status_word[1] = housekeeping_packet.lfr_status_word[1]
                         | (lfr_reset_cause & STATUS_WORD_RESET_CAUSE_BITS );   // [0000 0111]
             }
             void increment_hk_counter( unsigned char newValue, unsigned char oldValue, unsigned int *counter )
             {
                 int delta;
                 delta = 0;
                 if (newValue >= oldValue)
                 {
                     delta = newValue - oldValue;
                 }
                 else
                 {
                     delta = (CONST_256 - oldValue) + newValue;
                 }
                 *counter = *counter + delta;
             }
             void hk_lfr_le_update( void )
             {
                 static hk_lfr_le_t old_hk_lfr_le = {0};
                 hk_lfr_le_t new_hk_lfr_le;
                 unsigned int counter;
                 counter = (((unsigned int) housekeeping_packet.hk_lfr_le_cnt[0]) * CONST_256) + housekeeping_packet.hk_lfr_le_cnt[1];
                 // DPU
                 new_hk_lfr_le.dpu_spw_parity    = housekeeping_packet.hk_lfr_dpu_spw_parity;
                 new_hk_lfr_le.dpu_spw_disconnect= housekeeping_packet.hk_lfr_dpu_spw_disconnect;
                 new_hk_lfr_le.dpu_spw_escape    = housekeeping_packet.hk_lfr_dpu_spw_escape;
                 new_hk_lfr_le.dpu_spw_credit    = housekeeping_packet.hk_lfr_dpu_spw_credit;
                 new_hk_lfr_le.dpu_spw_write_sync= housekeeping_packet.hk_lfr_dpu_spw_write_sync;
                 // TIMECODE
                 new_hk_lfr_le.timecode_erroneous= housekeeping_packet.hk_lfr_timecode_erroneous;
                 new_hk_lfr_le.timecode_missing  = housekeeping_packet.hk_lfr_timecode_missing;
                 new_hk_lfr_le.timecode_invalid  = housekeeping_packet.hk_lfr_timecode_invalid;
                 // TIME
                 new_hk_lfr_le.time_timecode_it  = housekeeping_packet.hk_lfr_time_timecode_it;
                 new_hk_lfr_le.time_not_synchro  = housekeeping_packet.hk_lfr_time_not_synchro;
                 new_hk_lfr_le.time_timecode_ctr = housekeeping_packet.hk_lfr_time_timecode_ctr;
                 //AHB
                 new_hk_lfr_le.ahb_correctable   = housekeeping_packet.hk_lfr_ahb_correctable;
                 // housekeeping_packet.hk_lfr_dpu_spw_rx_ahb => not handled by the grspw driver
                 // housekeeping_packet.hk_lfr_dpu_spw_tx_ahb => not handled by the grspw driver
                 // update the le counter
                 // DPU
                 increment_hk_counter( new_hk_lfr_le.dpu_spw_parity,    old_hk_lfr_le.dpu_spw_parity,       &counter );
                 increment_hk_counter( new_hk_lfr_le.dpu_spw_disconnect,old_hk_lfr_le.dpu_spw_disconnect,   &counter );
                 increment_hk_counter( new_hk_lfr_le.dpu_spw_escape,    old_hk_lfr_le.dpu_spw_escape,       &counter );
                 increment_hk_counter( new_hk_lfr_le.dpu_spw_credit,    old_hk_lfr_le.dpu_spw_credit,       &counter );
                 increment_hk_counter( new_hk_lfr_le.dpu_spw_write_sync,old_hk_lfr_le.dpu_spw_write_sync,   &counter );
                 // TIMECODE
                 increment_hk_counter( new_hk_lfr_le.timecode_erroneous,old_hk_lfr_le.timecode_erroneous,   &counter );
                 increment_hk_counter( new_hk_lfr_le.timecode_missing,  old_hk_lfr_le.timecode_missing,     &counter );
                 increment_hk_counter( new_hk_lfr_le.timecode_invalid,  old_hk_lfr_le.timecode_invalid,     &counter );
                 // TIME
                 increment_hk_counter( new_hk_lfr_le.time_timecode_it,  old_hk_lfr_le.time_timecode_it,     &counter );
                 increment_hk_counter( new_hk_lfr_le.time_not_synchro,  old_hk_lfr_le.time_not_synchro,     &counter );
                 increment_hk_counter( new_hk_lfr_le.time_timecode_ctr, old_hk_lfr_le.time_timecode_ctr,    &counter );
                 // AHB
                 increment_hk_counter( new_hk_lfr_le.ahb_correctable,   old_hk_lfr_le.ahb_correctable,      &counter );
                 // DPU
                 old_hk_lfr_le.dpu_spw_parity    = new_hk_lfr_le.dpu_spw_parity;
                 old_hk_lfr_le.dpu_spw_disconnect= new_hk_lfr_le.dpu_spw_disconnect;
                 old_hk_lfr_le.dpu_spw_escape    = new_hk_lfr_le.dpu_spw_escape;
                 old_hk_lfr_le.dpu_spw_credit    = new_hk_lfr_le.dpu_spw_credit;
                 old_hk_lfr_le.dpu_spw_write_sync= new_hk_lfr_le.dpu_spw_write_sync;
                 // TIMECODE
                 old_hk_lfr_le.timecode_erroneous= new_hk_lfr_le.timecode_erroneous;
                 old_hk_lfr_le.timecode_missing  = new_hk_lfr_le.timecode_missing;
                 old_hk_lfr_le.timecode_invalid  = new_hk_lfr_le.timecode_invalid;
                 // TIME
                 old_hk_lfr_le.time_timecode_it  = new_hk_lfr_le.time_timecode_it;
                 old_hk_lfr_le.time_not_synchro  = new_hk_lfr_le.time_not_synchro;
                 old_hk_lfr_le.time_timecode_ctr = new_hk_lfr_le.time_timecode_ctr;
                 //AHB
                 old_hk_lfr_le.ahb_correctable   = new_hk_lfr_le.ahb_correctable;
                 // housekeeping_packet.hk_lfr_dpu_spw_rx_ahb => not handled by the grspw driver
                 // housekeeping_packet.hk_lfr_dpu_spw_tx_ahb => not handled by the grspw driver
                 // update housekeeping packet counters, convert unsigned int numbers in 2 bytes numbers
                 // LE
                 housekeeping_packet.hk_lfr_le_cnt[0] = (unsigned char) ((counter & BYTE0_MASK) >> SHIFT_1_BYTE);
                 housekeeping_packet.hk_lfr_le_cnt[1] = (unsigned char)  (counter & BYTE1_MASK);
             }
             void hk_lfr_me_update( void )
             {
                 static hk_lfr_me_t old_hk_lfr_me = {0};
                 hk_lfr_me_t new_hk_lfr_me;
                 unsigned int counter;
                 counter = (((unsigned int) housekeeping_packet.hk_lfr_me_cnt[0]) * CONST_256) + housekeeping_packet.hk_lfr_me_cnt[1];
                 // get the current values
                 new_hk_lfr_me.dpu_spw_early_eop     = housekeeping_packet.hk_lfr_dpu_spw_early_eop;
                 new_hk_lfr_me.dpu_spw_invalid_addr  = housekeeping_packet.hk_lfr_dpu_spw_invalid_addr;
                 new_hk_lfr_me.dpu_spw_eep           = housekeeping_packet.hk_lfr_dpu_spw_eep;
                 new_hk_lfr_me.dpu_spw_rx_too_big    = housekeeping_packet.hk_lfr_dpu_spw_rx_too_big;
                 // update the me counter
                 increment_hk_counter( new_hk_lfr_me.dpu_spw_early_eop,      old_hk_lfr_me.dpu_spw_early_eop,    &counter );
                 increment_hk_counter( new_hk_lfr_me.dpu_spw_invalid_addr,   old_hk_lfr_me.dpu_spw_invalid_addr, &counter );
                 increment_hk_counter( new_hk_lfr_me.dpu_spw_eep,            old_hk_lfr_me.dpu_spw_eep,          &counter );
                 increment_hk_counter( new_hk_lfr_me.dpu_spw_rx_too_big,     old_hk_lfr_me.dpu_spw_rx_too_big,   &counter );
                 // store the counters for the next time
                 old_hk_lfr_me.dpu_spw_early_eop     = new_hk_lfr_me.dpu_spw_early_eop;
                 old_hk_lfr_me.dpu_spw_invalid_addr  = new_hk_lfr_me.dpu_spw_invalid_addr;
                 old_hk_lfr_me.dpu_spw_eep           = new_hk_lfr_me.dpu_spw_eep;
                 old_hk_lfr_me.dpu_spw_rx_too_big    = new_hk_lfr_me.dpu_spw_rx_too_big;
                 // update housekeeping packet counters, convert unsigned int numbers in 2 bytes numbers
                 // ME
                 housekeeping_packet.hk_lfr_me_cnt[0] = (unsigned char) ((counter & BYTE0_MASK) >> SHIFT_1_BYTE);
                 housekeeping_packet.hk_lfr_me_cnt[1] = (unsigned char)  (counter & BYTE1_MASK);
             }
             void hk_lfr_le_me_he_update()
             {
                 unsigned int hk_lfr_he_cnt;
                 hk_lfr_he_cnt = (((unsigned int) housekeeping_packet.hk_lfr_he_cnt[0]) * 256) + housekeeping_packet.hk_lfr_he_cnt[1];
                 //update the low severity error counter
                 hk_lfr_le_update( );
                 //update the medium severity error counter
                 hk_lfr_me_update();
                 //update the high severity error counter
                 hk_lfr_he_cnt = 0;
                 // update housekeeping packet counters, convert unsigned int numbers in 2 bytes numbers
                 // HE
                 housekeeping_packet.hk_lfr_he_cnt[0] = (unsigned char) ((hk_lfr_he_cnt & BYTE0_MASK) >> SHIFT_1_BYTE);
                 housekeeping_packet.hk_lfr_he_cnt[1] = (unsigned char)  (hk_lfr_he_cnt & BYTE1_MASK);
             }
             void set_hk_lfr_time_not_synchro()
             {
                 static unsigned char synchroLost = 1;
                 int synchronizationBit;
                 // get the synchronization bit
                 synchronizationBit =
                         (time_management_regs->coarse_time & VAL_LFR_SYNCHRONIZED) >> BIT_SYNCHRONIZATION;    // 1000 0000 0000 0000
                 switch (synchronizationBit)
                 {
                 case 0:
                     if (synchroLost == 1)
                     {
                         synchroLost = 0;
                     }
                     break;
                 case 1:
                     if (synchroLost == 0 )
                     {
                         synchroLost = 1;
                         increase_unsigned_char_counter(&housekeeping_packet.hk_lfr_time_not_synchro);
                         update_hk_lfr_last_er_fields( RID_LE_LFR_TIME, CODE_NOT_SYNCHRO );
                     }
                     break;
                 default:
                     PRINTF1("in hk_lfr_time_not_synchro *** unexpected value for synchronizationBit = %d\n", synchronizationBit);
                     break;
                 }
             }
             void set_hk_lfr_ahb_correctable()   // CRITICITY L
             {
                 /** This function builds the error counter hk_lfr_ahb_correctable using the statistics provided
                  * by the Cache Control Register (ASI 2, offset 0) and in the Register Protection Control Register (ASR16) on the
                  * detected errors in the cache, in the integer unit and in the floating point unit.
                  *
                  * @param void
                  *
                  * @return void
                  *
                  * All errors are summed to set the value of the hk_lfr_ahb_correctable counter.
                  *
                 */
                 unsigned int ahb_correctable;
                 unsigned int instructionErrorCounter;
                 unsigned int dataErrorCounter;
                 unsigned int fprfErrorCounter;
                 unsigned int iurfErrorCounter;
                 instructionErrorCounter = 0;
                 dataErrorCounter = 0;
                 fprfErrorCounter = 0;
                 iurfErrorCounter = 0;
                 CCR_getInstructionAndDataErrorCounters( &instructionErrorCounter, &dataErrorCounter);
                 ASR16_get_FPRF_IURF_ErrorCounters( &fprfErrorCounter, &iurfErrorCounter);
                 ahb_correctable = instructionErrorCounter
                         + dataErrorCounter
                         + fprfErrorCounter
                         + iurfErrorCounter
                         + housekeeping_packet.hk_lfr_ahb_correctable;
                 housekeeping_packet.hk_lfr_ahb_correctable = (unsigned char) (ahb_correctable & INT8_ALL_F);  // [1111 1111]
             }

src/processing/fsw_processing.c +1 0

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

src/tc_handler.c +40 -26

             /** Functions and tasks related to TeleCommand handling.
              *
              * @file
              * @author P. LEROY
              *
              * A group of functions to handle TeleCommands:\n
              * action launching\n
              * TC parsing\n
              * ...
              *
              */
             #include "tc_handler.h"
             #include "math.h"
             //***********
             // RTEMS TASK
             rtems_task actn_task( rtems_task_argument unused )
             {
                 /** This RTEMS task is responsible for launching actions upton the reception of valid TeleCommands.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The ACTN task waits for data coming from an RTEMS msesage queue. When data arrives, it launches specific actions depending
                  * on the incoming TeleCommand.
                  *
                  */
                 int result;
                 rtems_status_code status;       // RTEMS status code
                 ccsdsTelecommandPacket_t __attribute__((aligned(4))) TC;    // TC sent to the ACTN task
                 size_t size;                    // size of the incoming TC packet
                 unsigned char subtype;          // subtype of the current TC packet
                 unsigned char time[BYTES_PER_TIME];
                 rtems_id queue_rcv_id;
                 rtems_id queue_snd_id;
                 memset(&TC, 0, sizeof(ccsdsTelecommandPacket_t));
                 size = 0;
                 queue_rcv_id = RTEMS_ID_NONE;
                 queue_snd_id = RTEMS_ID_NONE;
                 status =  get_message_queue_id_recv( &queue_rcv_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in ACTN *** ERR get_message_queue_id_recv %d\n", status)
                 }
                 status =  get_message_queue_id_send( &queue_snd_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in ACTN *** ERR get_message_queue_id_send %d\n", status)
                 }
                 result = LFR_SUCCESSFUL;
                 subtype = 0;          // subtype of the current TC packet
                 BOOT_PRINTF("in ACTN *** \n");
                 while(1)
                 {
                     status = rtems_message_queue_receive( queue_rcv_id, (char*) &TC, &size,
                                                           RTEMS_WAIT, RTEMS_NO_TIMEOUT);
                     getTime( time );    // set time to the current time
                     if (status!=RTEMS_SUCCESSFUL)
                     {
                         PRINTF1("ERR *** in task ACTN *** error receiving a message, code %d \n", status)
                     }
                     else
                     {
                         subtype = TC.serviceSubType;
                         switch(subtype)
                         {
                         case TC_SUBTYPE_RESET:
                             result = action_reset( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_COMM:
                             result = action_load_common_par( &TC );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_NORM:
                             result = action_load_normal_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_BURST:
                             result = action_load_burst_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_SBM1:
                             result = action_load_sbm1_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_SBM2:
                             result = action_load_sbm2_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_DUMP:
                             result = action_dump_par( &TC,  queue_snd_id );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_ENTER:
                             result = action_enter_mode( &TC, queue_snd_id );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_UPDT_INFO:
                             result = action_update_info( &TC, queue_snd_id );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_EN_CAL:
                             result = action_enable_calibration( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_DIS_CAL:
                             result = action_disable_calibration( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_K:
                             result = action_load_kcoefficients( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_DUMP_K:
                             result = action_dump_kcoefficients( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_FBINS:
                             result = action_load_fbins_mask( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_FILTER_PAR:
                             result = action_load_filter_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_UPDT_TIME:
                             result = action_update_time( &TC );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         default:
                             break;
                         }
                     }
                 }
             }
             //***********
             // TC ACTIONS
             int action_reset(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function executes specific actions when a TC_LFR_RESET TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  */
                 PRINTF("this is the end!!!\n");
                 exit(0);
                 send_tm_lfr_tc_exe_not_implemented( TC, queue_id, time );
                 return LFR_DEFAULT;
             }
             int action_enter_mode(ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
             {
                 /** This function executes specific actions when a TC_LFR_ENTER_MODE TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  */
                 rtems_status_code status;
                 unsigned char requestedMode;
                 unsigned int transitionCoarseTime;
                 unsigned char * bytePosPtr;
                 bytePosPtr = (unsigned char *) &TC->packetID;
                 requestedMode = bytePosPtr[ BYTE_POS_CP_MODE_LFR_SET ];
                 copyInt32ByChar( (char*) &transitionCoarseTime, &bytePosPtr[ BYTE_POS_CP_LFR_ENTER_MODE_TIME ] );
                 transitionCoarseTime = transitionCoarseTime & COARSE_TIME_MASK;
                 status = check_mode_value( requestedMode );
                 if ( status != LFR_SUCCESSFUL )     // the mode value is inconsistent
                 {
                     send_tm_lfr_tc_exe_inconsistent( TC, queue_id, BYTE_POS_CP_MODE_LFR_SET, requestedMode );
                 }
                 else                                // the mode value is valid, check the transition
                 {
                     status = check_mode_transition(requestedMode);
                     if (status != LFR_SUCCESSFUL)
                     {
                         PRINTF("ERR *** in action_enter_mode *** check_mode_transition\n")
                                 send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     }
                 }
                 if ( status == LFR_SUCCESSFUL )     // the transition is valid, check the date
                 {
                     status = check_transition_date( transitionCoarseTime );
                     if (status != LFR_SUCCESSFUL)
                     {
                         PRINTF("ERR *** in action_enter_mode *** check_transition_date\n");
                         send_tm_lfr_tc_exe_not_executable(TC, queue_id );
                     }
                 }
                 if ( status == LFR_SUCCESSFUL )     // the date is valid, enter the mode
                 {
                     PRINTF1("OK  *** in action_enter_mode *** enter mode %d\n", requestedMode);
                     switch(requestedMode)
                     {
                     case LFR_MODE_STANDBY:
                         status = enter_mode_standby();
                         break;
                     case LFR_MODE_NORMAL:
                         status = enter_mode_normal( transitionCoarseTime );
                         break;
                     case LFR_MODE_BURST:
                         status = enter_mode_burst( transitionCoarseTime );
                         break;
                     case LFR_MODE_SBM1:
                         status = enter_mode_sbm1( transitionCoarseTime );
                         break;
                     case LFR_MODE_SBM2:
                         status = enter_mode_sbm2( transitionCoarseTime );
                         break;
                     default:
                         break;
                     }
                     if (status != RTEMS_SUCCESSFUL)
                     {
                         status = LFR_EXE_ERROR;
                     }
                 }
                 return status;
             }
             int action_update_info(ccsdsTelecommandPacket_t *TC, rtems_id queue_id)
             {
                 /** This function executes specific actions when a TC_LFR_UPDATE_INFO TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  * @return LFR directive status code:
                  * - LFR_DEFAULT
                  * - LFR_SUCCESSFUL
                  *
                  */
                 unsigned int val;
-                int result;
                 unsigned int status;
                 unsigned char mode;
                 unsigned char * bytePosPtr;
+                int pos;
+                float value;
+                pos = INIT_CHAR;
+                value = INIT_FLOAT;
+                status = LFR_DEFAULT;
                 bytePosPtr = (unsigned char *) &TC->packetID;
                 // check LFR mode
                 mode = (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET5 ] & BITS_LFR_MODE) >> SHIFT_LFR_MODE;
                 status = check_update_info_hk_lfr_mode( mode );
                 if (status == LFR_SUCCESSFUL)  // check TDS mode
                 {
                     mode = (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET6 ] & BITS_TDS_MODE) >> SHIFT_TDS_MODE;
                     status = check_update_info_hk_tds_mode( mode );
                 }
                 if (status == LFR_SUCCESSFUL)  // check THR mode
                 {
                     mode = (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET6 ] & BITS_THR_MODE);
                     status = check_update_info_hk_thr_mode( mode );
                 }
-                if (status == LFR_SUCCESSFUL)  // if the parameter check is successful
+                if (status == LFR_SUCCESSFUL) // check reaction wheels frequencies
                 {
-                    val = (housekeeping_packet.hk_lfr_update_info_tc_cnt[0] * CONST_256)
+                    status = check_all_sy_lfr_rw_f(TC, &pos, &value);
-                            + housekeeping_packet.hk_lfr_update_info_tc_cnt[1];
-                    val++;
-                    housekeeping_packet.hk_lfr_update_info_tc_cnt[0] = (unsigned char) (val >> SHIFT_1_BYTE);
-                    housekeeping_packet.hk_lfr_update_info_tc_cnt[1] = (unsigned char) (val);
                 }
-                // pa_bia_status_info
+                // if the parameters checking succeeds, udpate all parameters
-                // => pa_bia_mode_mux_set       3 bits
+                if (status == LFR_SUCCESSFUL)
-                // => pa_bia_mode_hv_enabled    1 bit
-                // => pa_bia_mode_bias1_enabled 1 bit
+                    // pa_bia_status_info
-                // => pa_bia_mode_bias2_enabled 1 bit
+                    // => pa_bia_mode_mux_set       3 bits
-                // => pa_bia_mode_bias3_enabled 1 bit
+                    // => pa_bia_mode_hv_enabled    1 bit
-                // => pa_bia_on_off (cp_dpu_bias_on_off)
+                    // => pa_bia_mode_bias1_enabled 1 bit
-                pa_bia_status_info = bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET2 ] & BITS_BIA; // [1111 1110]
+                    // => pa_bia_mode_bias2_enabled 1 bit
-                pa_bia_status_info = pa_bia_status_info
+                    // => pa_bia_mode_bias3_enabled 1 bit
-                        | (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET1 ] & 1);
+                    // => pa_bia_on_off (cp_dpu_bias_on_off)
+                    pa_bia_status_info = bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET2 ] & BITS_BIA; // [1111 1110]
+                    pa_bia_status_info = pa_bia_status_info
+                            | (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET1 ] & 1);
-                // REACTION_WHEELS_FREQUENCY, copy the incoming parameters in the local variable (to be copied in HK packets)
+                    // REACTION_WHEELS_FREQUENCY, copy the incoming parameters in the local variable (to be copied in HK packets)
-                getReactionWheelsFrequencies( TC );
+                    getReactionWheelsFrequencies( TC );
-                set_hk_lfr_sc_rw_f_flags();
+                    set_hk_lfr_sc_rw_f_flags();
-                build_sy_lfr_rw_masks();
+                    build_sy_lfr_rw_masks();
+                    // once the masks are built, they have to be merged with the fbins_mask
+                    merge_fbins_masks();
-                // once the masks are built, they have to be merged with the fbins_mask
+                    // increase the TC_LFR_UPDATE_INFO counter
-                merge_fbins_masks();
+                    if (status == LFR_SUCCESSFUL)  // if the parameter check is successful
+                    {
+                        val = (housekeeping_packet.hk_lfr_update_info_tc_cnt[0] * CONST_256)
+                                + housekeeping_packet.hk_lfr_update_info_tc_cnt[1];
+                        val++;
+                        housekeeping_packet.hk_lfr_update_info_tc_cnt[0] = (unsigned char) (val >> SHIFT_1_BYTE);
+                        housekeeping_packet.hk_lfr_update_info_tc_cnt[1] = (unsigned char) (val);
+                    }
+                }
-                result = status;
+                return status;
-                return result;
             }
             int action_enable_calibration(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function executes specific actions when a TC_LFR_ENABLE_CALIBRATION TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  */
                 int result;
                 result = LFR_DEFAULT;
                 setCalibration( true );
                 result = LFR_SUCCESSFUL;
                 return result;
             }
             int action_disable_calibration(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function executes specific actions when a TC_LFR_DISABLE_CALIBRATION TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  */
                 int result;
                 result = LFR_DEFAULT;
                 setCalibration( false );
                 result = LFR_SUCCESSFUL;
                 return result;
             }
             int action_update_time(ccsdsTelecommandPacket_t *TC)
             {
                 /** This function executes specific actions when a TC_LFR_UPDATE_TIME TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  * @return LFR_SUCCESSFUL
                  *
                  */
                 unsigned int val;
                 time_management_regs->coarse_time_load = (TC->dataAndCRC[BYTE_0] << SHIFT_3_BYTES)
                         + (TC->dataAndCRC[BYTE_1] << SHIFT_2_BYTES)
                         + (TC->dataAndCRC[BYTE_2] << SHIFT_1_BYTE)
                         + TC->dataAndCRC[BYTE_3];
                 val = (housekeeping_packet.hk_lfr_update_time_tc_cnt[0] * CONST_256)
                         + housekeeping_packet.hk_lfr_update_time_tc_cnt[1];
                 val++;
                 housekeeping_packet.hk_lfr_update_time_tc_cnt[0] = (unsigned char) (val >> SHIFT_1_BYTE);
                 housekeeping_packet.hk_lfr_update_time_tc_cnt[1] = (unsigned char) (val);
                 oneTcLfrUpdateTimeReceived = 1;
                 return LFR_SUCCESSFUL;
             }
             //*******************
             // ENTERING THE MODES
             int check_mode_value( unsigned char requestedMode )
             {
                 int status;
                 status = LFR_DEFAULT;
                 if ( (requestedMode != LFR_MODE_STANDBY)
                      && (requestedMode != LFR_MODE_NORMAL) && (requestedMode != LFR_MODE_BURST)
                      && (requestedMode != LFR_MODE_SBM1) && (requestedMode != LFR_MODE_SBM2) )
                 {
                     status = LFR_DEFAULT;
                 }
                 else
                 {
                     status = LFR_SUCCESSFUL;
                 }
                 return status;
             }
             int check_mode_transition( unsigned char requestedMode )
             {
                 /** This function checks the validity of the transition requested by the TC_LFR_ENTER_MODE.
                  *
                  * @param requestedMode is the mode requested by the TC_LFR_ENTER_MODE
                  *
                  * @return LFR directive status codes:
                  * - LFR_SUCCESSFUL - the transition is authorized
                  * - LFR_DEFAULT - the transition is not authorized
                  *
                  */
                 int status;
                 switch (requestedMode)
                 {
                 case LFR_MODE_STANDBY:
                     if ( lfrCurrentMode == LFR_MODE_STANDBY ) {
                         status = LFR_DEFAULT;
                     }
                     else
                     {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 case LFR_MODE_NORMAL:
                     if ( lfrCurrentMode == LFR_MODE_NORMAL ) {
                         status = LFR_DEFAULT;
                     }
                     else {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 case LFR_MODE_BURST:
                     if ( lfrCurrentMode == LFR_MODE_BURST ) {
                         status = LFR_DEFAULT;
                     }
                     else {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 case LFR_MODE_SBM1:
                     if ( lfrCurrentMode == LFR_MODE_SBM1 ) {
                         status = LFR_DEFAULT;
                     }
                     else {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 case LFR_MODE_SBM2:
                     if ( lfrCurrentMode == LFR_MODE_SBM2 ) {
                         status = LFR_DEFAULT;
                     }
                     else {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 default:
                     status = LFR_DEFAULT;
                     break;
                 }
                 return status;
             }
             void update_last_valid_transition_date( unsigned int transitionCoarseTime )
             {
                 if (transitionCoarseTime == 0)
                 {
                     lastValidEnterModeTime = time_management_regs->coarse_time + 1;
                     PRINTF1("lastValidEnterModeTime = 0x%x (transitionCoarseTime = 0 => coarse_time+1)\n", lastValidEnterModeTime);
                 }
                 else
                 {
                     lastValidEnterModeTime = transitionCoarseTime;
                     PRINTF1("lastValidEnterModeTime = 0x%x\n", transitionCoarseTime);
                 }
             }
             int check_transition_date( unsigned int transitionCoarseTime )
             {
                 int status;
                 unsigned int localCoarseTime;
                 unsigned int deltaCoarseTime;
                 status = LFR_SUCCESSFUL;
                 if (transitionCoarseTime == 0)  // transition time = 0 means an instant transition
                 {
                     status = LFR_SUCCESSFUL;
                 }
                 else
                 {
                     localCoarseTime = time_management_regs->coarse_time & COARSE_TIME_MASK;
                     PRINTF2("localTime = %x, transitionTime = %x\n", localCoarseTime, transitionCoarseTime);
                     if ( transitionCoarseTime <= localCoarseTime )   // SSS-CP-EQS-322
                     {
                         status = LFR_DEFAULT;
                         PRINTF("ERR *** in check_transition_date *** transitionCoarseTime <= localCoarseTime\n");
                     }
                     if (status == LFR_SUCCESSFUL)
                     {
                         deltaCoarseTime = transitionCoarseTime - localCoarseTime;
                         if ( deltaCoarseTime > MAX_DELTA_COARSE_TIME )  // SSS-CP-EQS-323
                         {
                             status = LFR_DEFAULT;
                             PRINTF1("ERR *** in check_transition_date *** deltaCoarseTime = %x\n", deltaCoarseTime)
                         }
                     }
                 }
                 return status;
             }
             int restart_asm_activities( unsigned char lfrRequestedMode )
             {
                 rtems_status_code status;
                 status = stop_spectral_matrices();
                 thisIsAnASMRestart = 1;
                 status = restart_asm_tasks( lfrRequestedMode );
                 launch_spectral_matrix();
                 return status;
             }
             int stop_spectral_matrices( void )
             {
                 /** This function stops and restarts the current mode average spectral matrices activities.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_ALREADY_SUSPENDED - task already suspended
                  *
                  */
                 rtems_status_code status;
                 status = RTEMS_SUCCESSFUL;
                 // (1) mask interruptions
                 LEON_Mask_interrupt( IRQ_SPECTRAL_MATRIX );     // mask spectral matrix interrupt
                 // (2) reset spectral matrices registers
                 set_sm_irq_onNewMatrix( 0 );                    // stop the spectral matrices
                 reset_sm_status();
                 // (3) clear interruptions
                 LEON_Clear_interrupt( IRQ_SPECTRAL_MATRIX );    // clear spectral matrix interrupt
                 // suspend several tasks
                 if (lfrCurrentMode != LFR_MODE_STANDBY) {
                     status = suspend_asm_tasks();
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in stop_current_mode *** in suspend_science_tasks *** ERR code: %d\n", status)
                 }
                 return status;
             }
             int stop_current_mode( void )
             {
                 /** This function stops the current mode by masking interrupt lines and suspending science tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_ALREADY_SUSPENDED - task already suspended
                  *
                  */
                 rtems_status_code status;
                 status = RTEMS_SUCCESSFUL;
                 // (1) mask interruptions
                 LEON_Mask_interrupt( IRQ_WAVEFORM_PICKER );     // mask waveform picker interrupt
                 LEON_Mask_interrupt( IRQ_SPECTRAL_MATRIX );     // clear spectral matrix interrupt
                 // (2) reset waveform picker registers
                 reset_wfp_burst_enable();                       // reset burst and enable bits
                 reset_wfp_status();                             // reset all the status bits
                 // (3) reset spectral matrices registers
                 set_sm_irq_onNewMatrix( 0 );                    // stop the spectral matrices
                 reset_sm_status();
                 // reset lfr VHDL module
                 reset_lfr();
                 reset_extractSWF();                             // reset the extractSWF flag to false
                 // (4) clear interruptions
                 LEON_Clear_interrupt( IRQ_WAVEFORM_PICKER );    // clear waveform picker interrupt
                 LEON_Clear_interrupt( IRQ_SPECTRAL_MATRIX );    // clear spectral matrix interrupt
                 // suspend several tasks
                 if (lfrCurrentMode != LFR_MODE_STANDBY) {
                     status = suspend_science_tasks();
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in stop_current_mode *** in suspend_science_tasks *** ERR code: %d\n", status)
                 }
                 return status;
             }
             int enter_mode_standby( void )
             {
                 /** This function is used to put LFR in the STANDBY mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The STANDBY mode does not depends on a specific transition date, the effect of the TC_LFR_ENTER_MODE
                  * is immediate.
                  *
                  */
                 int status;
                 status = stop_current_mode();       // STOP THE CURRENT MODE
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_report();
             #endif
             #ifdef PRINT_STACK_REPORT
                 PRINTF("stack report selected\n")
                 rtems_stack_checker_report_usage();
             #endif
                 return status;
             }
             int enter_mode_normal( unsigned int transitionCoarseTime )
             {
                 /** This function is used to start the NORMAL mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The way the NORMAL mode is started depends on the LFR current mode. If LFR is in SBM1 or SBM2,
                  * the snapshots are not restarted, only ASM, BP and CWF data generation are affected.
                  *
                  */
                 int status;
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_reset();
             #endif
                 status = RTEMS_UNSATISFIED;
                 switch( lfrCurrentMode )
                 {
                 case LFR_MODE_STANDBY:
                     status = restart_science_tasks( LFR_MODE_NORMAL ); // restart science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_NORMAL, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_BURST:
                     status = stop_current_mode();           // stop the current mode
                     status = restart_science_tasks( LFR_MODE_NORMAL ); // restart the science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_NORMAL, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_SBM1:
                     status = restart_asm_activities( LFR_MODE_NORMAL ); // this is necessary to restart ASM tasks to update the parameters
                     status = LFR_SUCCESSFUL;                   // lfrCurrentMode will be updated after the execution of close_action
                     update_last_valid_transition_date( transitionCoarseTime );
                     break;
                 case LFR_MODE_SBM2:
                     status = restart_asm_activities( LFR_MODE_NORMAL ); // this is necessary to restart ASM tasks to update the parameters
                     status = LFR_SUCCESSFUL;                   // lfrCurrentMode will be updated after the execution of close_action
                     update_last_valid_transition_date( transitionCoarseTime );
                     break;
                 default:
                     break;
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in enter_mode_normal *** status = %d\n", status)
                             status = RTEMS_UNSATISFIED;
                 }
                 return status;
             }
             int enter_mode_burst( unsigned int transitionCoarseTime )
             {
                 /** This function is used to start the BURST mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The way the BURST mode is started does not depend on the LFR current mode.
                  *
                  */
                 int status;
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_reset();
             #endif
                 status = stop_current_mode();           // stop the current mode
                 status = restart_science_tasks( LFR_MODE_BURST ); // restart the science tasks
                 if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                 {
                     launch_spectral_matrix( );
                     launch_waveform_picker( LFR_MODE_BURST, transitionCoarseTime );
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in enter_mode_burst *** status = %d\n", status)
                             status = RTEMS_UNSATISFIED;
                 }
                 return status;
             }
             int enter_mode_sbm1( unsigned int transitionCoarseTime )
             {
                 /** This function is used to start the SBM1 mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The way the SBM1 mode is started depends on the LFR current mode. If LFR is in NORMAL or SBM2,
                  * the snapshots are not restarted, only ASM, BP and CWF data generation are affected. In other
                  * cases, the acquisition is completely restarted.
                  *
                  */
                 int status;
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_reset();
             #endif
                 status = RTEMS_UNSATISFIED;
                 switch( lfrCurrentMode )
                 {
                 case LFR_MODE_STANDBY:
                     status = restart_science_tasks( LFR_MODE_SBM1 ); // restart science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_SBM1, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_NORMAL:                       // lfrCurrentMode will be updated after the execution of close_action
                     status = restart_asm_activities( LFR_MODE_SBM1 );
                     status = LFR_SUCCESSFUL;
                     update_last_valid_transition_date( transitionCoarseTime );
                     break;
                 case LFR_MODE_BURST:
                     status = stop_current_mode();           // stop the current mode
                     status = restart_science_tasks( LFR_MODE_SBM1 ); // restart the science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_SBM1, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_SBM2:
                     status = restart_asm_activities( LFR_MODE_SBM1 );
                     status = LFR_SUCCESSFUL;                // lfrCurrentMode will be updated after the execution of close_action
                     update_last_valid_transition_date( transitionCoarseTime );
                     break;
                 default:
                     break;
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in enter_mode_sbm1 *** status = %d\n", status);
                     status = RTEMS_UNSATISFIED;
                 }
                 return status;
             }
             int enter_mode_sbm2( unsigned int transitionCoarseTime )
             {
                 /** This function is used to start the SBM2 mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The way the SBM2 mode is started depends on the LFR current mode. If LFR is in NORMAL or SBM1,
                  * the snapshots are not restarted, only ASM, BP and CWF data generation are affected. In other
                  * cases, the acquisition is completely restarted.
                  *
                  */
                 int status;
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_reset();
             #endif
                 status = RTEMS_UNSATISFIED;
                 switch( lfrCurrentMode )
                 {
                 case LFR_MODE_STANDBY:
                     status = restart_science_tasks( LFR_MODE_SBM2 ); // restart science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_SBM2, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_NORMAL:
                     status = restart_asm_activities( LFR_MODE_SBM2 );
                     status = LFR_SUCCESSFUL;                // lfrCurrentMode will be updated after the execution of close_action
                     update_last_valid_transition_date( transitionCoarseTime );
                     break;
                 case LFR_MODE_BURST:
                     status = stop_current_mode();           // stop the current mode
                     status = restart_science_tasks( LFR_MODE_SBM2 ); // restart the science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_SBM2, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_SBM1:
                     status = restart_asm_activities( LFR_MODE_SBM2 );
                     status = LFR_SUCCESSFUL;                // lfrCurrentMode will be updated after the execution of close_action
                     update_last_valid_transition_date( transitionCoarseTime );
                     break;
                 default:
                     break;
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in enter_mode_sbm2 *** status = %d\n", status)
                             status = RTEMS_UNSATISFIED;
                 }
                 return status;
             }
             int restart_science_tasks( unsigned char lfrRequestedMode )
             {
                 /** This function is used to restart all science tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * Science tasks are AVF0, PRC0, WFRM, CWF3, CW2, CWF1
                  *
                  */
                 rtems_status_code status[NB_SCIENCE_TASKS];
                 rtems_status_code ret;
                 ret = RTEMS_SUCCESSFUL;
                 status[STATUS_0] = rtems_task_restart( Task_id[TASKID_AVF0], lfrRequestedMode );
                 if (status[STATUS_0] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF0 ERR %d\n", status[STATUS_0])
                 }
                 status[STATUS_1] = rtems_task_restart( Task_id[TASKID_PRC0], lfrRequestedMode );
                 if (status[STATUS_1] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC0 ERR %d\n", status[STATUS_1])
                 }
                 status[STATUS_2] = rtems_task_restart( Task_id[TASKID_WFRM],1 );
                 if (status[STATUS_2] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** WFRM ERR %d\n", status[STATUS_2])
                 }
                 status[STATUS_3] = rtems_task_restart( Task_id[TASKID_CWF3],1 );
                 if (status[STATUS_3] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** CWF3 ERR %d\n", status[STATUS_3])
                 }
                 status[STATUS_4] = rtems_task_restart( Task_id[TASKID_CWF2],1 );
                 if (status[STATUS_4] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** CWF2 ERR %d\n", status[STATUS_4])
                 }
                 status[STATUS_5] = rtems_task_restart( Task_id[TASKID_CWF1],1 );
                 if (status[STATUS_5] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** CWF1 ERR %d\n", status[STATUS_5])
                 }
                 status[STATUS_6] = rtems_task_restart( Task_id[TASKID_AVF1], lfrRequestedMode );
                 if (status[STATUS_6] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF1 ERR %d\n", status[STATUS_6])
                 }
                 status[STATUS_7] = rtems_task_restart( Task_id[TASKID_PRC1],lfrRequestedMode );
                 if (status[STATUS_7] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC1 ERR %d\n", status[STATUS_7])
                 }
                 status[STATUS_8] = rtems_task_restart( Task_id[TASKID_AVF2], 1 );
                 if (status[STATUS_8] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF2 ERR %d\n", status[STATUS_8])
                 }
                 status[STATUS_9] = rtems_task_restart( Task_id[TASKID_PRC2], 1 );
                 if (status[STATUS_9] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC2 ERR %d\n", status[STATUS_9])
                 }
                 if ( (status[STATUS_0] != RTEMS_SUCCESSFUL) || (status[STATUS_1] != RTEMS_SUCCESSFUL) ||
                      (status[STATUS_2] != RTEMS_SUCCESSFUL) || (status[STATUS_3] != RTEMS_SUCCESSFUL) ||
                      (status[STATUS_4] != RTEMS_SUCCESSFUL) || (status[STATUS_5] != RTEMS_SUCCESSFUL) ||
                      (status[STATUS_6] != RTEMS_SUCCESSFUL) || (status[STATUS_7] != RTEMS_SUCCESSFUL) ||
                      (status[STATUS_8] != RTEMS_SUCCESSFUL) || (status[STATUS_9] != RTEMS_SUCCESSFUL) )
                 {
                     ret = RTEMS_UNSATISFIED;
                 }
                 return ret;
             }
             int restart_asm_tasks( unsigned char lfrRequestedMode )
             {
                 /** This function is used to restart average spectral matrices tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * ASM tasks are AVF0, PRC0, AVF1, PRC1, AVF2 and PRC2
                  *
                  */
                 rtems_status_code status[NB_ASM_TASKS];
                 rtems_status_code ret;
                 ret = RTEMS_SUCCESSFUL;
                 status[STATUS_0] = rtems_task_restart( Task_id[TASKID_AVF0], lfrRequestedMode );
                 if (status[STATUS_0] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF0 ERR %d\n", status[STATUS_0])
                 }
                 status[STATUS_1] = rtems_task_restart( Task_id[TASKID_PRC0], lfrRequestedMode );
                 if (status[STATUS_1] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC0 ERR %d\n", status[STATUS_1])
                 }
                 status[STATUS_2] = rtems_task_restart( Task_id[TASKID_AVF1], lfrRequestedMode );
                 if (status[STATUS_2] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF1 ERR %d\n", status[STATUS_2])
                 }
                 status[STATUS_3] = rtems_task_restart( Task_id[TASKID_PRC1],lfrRequestedMode );
                 if (status[STATUS_3] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC1 ERR %d\n", status[STATUS_3])
                 }
                 status[STATUS_4] = rtems_task_restart( Task_id[TASKID_AVF2], 1 );
                 if (status[STATUS_4] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF2 ERR %d\n", status[STATUS_4])
                 }
                 status[STATUS_5] = rtems_task_restart( Task_id[TASKID_PRC2], 1 );
                 if (status[STATUS_5] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC2 ERR %d\n", status[STATUS_5])
                 }
                 if ( (status[STATUS_0] != RTEMS_SUCCESSFUL) || (status[STATUS_1] != RTEMS_SUCCESSFUL) ||
                      (status[STATUS_2] != RTEMS_SUCCESSFUL) || (status[STATUS_3] != RTEMS_SUCCESSFUL) ||
                      (status[STATUS_4] != RTEMS_SUCCESSFUL) || (status[STATUS_5] != RTEMS_SUCCESSFUL) )
                 {
                     ret = RTEMS_UNSATISFIED;
                 }
                 return ret;
             }
             int suspend_science_tasks( void )
             {
                 /** This function suspends the science tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_ALREADY_SUSPENDED - task already suspended
                  *
                  */
                 rtems_status_code status;
                 PRINTF("in suspend_science_tasks\n")
                         status = rtems_task_suspend( Task_id[TASKID_AVF0] );    // suspend AVF0
                 if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                 {
                     PRINTF1("in suspend_science_task *** AVF0 ERR %d\n", status)
                 }
                 else
                 {
                     status = RTEMS_SUCCESSFUL;
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC0
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC0] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC0 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend AVF1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_AVF1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** AVF1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend AVF2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_AVF2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** AVF2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend WFRM
                 {
                     status = rtems_task_suspend( Task_id[TASKID_WFRM] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** WFRM ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend CWF3
                 {
                     status = rtems_task_suspend( Task_id[TASKID_CWF3] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** CWF3 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend CWF2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_CWF2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** CWF2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend CWF1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_CWF1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** CWF1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 return status;
             }
             int suspend_asm_tasks( void )
             {
                 /** This function suspends the science tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_ALREADY_SUSPENDED - task already suspended
                  *
                  */
                 rtems_status_code status;
                 PRINTF("in suspend_science_tasks\n")
                         status = rtems_task_suspend( Task_id[TASKID_AVF0] );    // suspend AVF0
                 if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                 {
                     PRINTF1("in suspend_science_task *** AVF0 ERR %d\n", status)
                 }
                 else
                 {
                     status = RTEMS_SUCCESSFUL;
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC0
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC0] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC0 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend AVF1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_AVF1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** AVF1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend AVF2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_AVF2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** AVF2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 return status;
             }
             void launch_waveform_picker( unsigned char mode, unsigned int transitionCoarseTime )
             {
                 WFP_reset_current_ring_nodes();
                 reset_waveform_picker_regs();
                 set_wfp_burst_enable_register( mode );
                 LEON_Clear_interrupt( IRQ_WAVEFORM_PICKER );
                 LEON_Unmask_interrupt( IRQ_WAVEFORM_PICKER );
                 if (transitionCoarseTime == 0)
                 {
                     // instant transition means transition on the next valid date
                     // this is mandatory to have a good snapshot period and a good correction of the snapshot period
                     waveform_picker_regs->start_date = time_management_regs->coarse_time + 1;
                 }
                 else
                 {
                     waveform_picker_regs->start_date = transitionCoarseTime;
                 }
                 update_last_valid_transition_date(waveform_picker_regs->start_date);
             }
             void launch_spectral_matrix( void )
             {
                 SM_reset_current_ring_nodes();
                 reset_spectral_matrix_regs();
                 reset_nb_sm();
                 set_sm_irq_onNewMatrix( 1 );
                 LEON_Clear_interrupt( IRQ_SPECTRAL_MATRIX );
                 LEON_Unmask_interrupt( IRQ_SPECTRAL_MATRIX );
             }
             void set_sm_irq_onNewMatrix( unsigned char value )
             {
                 if (value == 1)
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config | BIT_IRQ_ON_NEW_MATRIX;
                 }
                 else
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config & MASK_IRQ_ON_NEW_MATRIX;   // 1110
                 }
             }
             void set_sm_irq_onError( unsigned char value )
             {
                 if (value == 1)
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config | BIT_IRQ_ON_ERROR;
                 }
                 else
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config & MASK_IRQ_ON_ERROR;   // 1101
                 }
             }
             //*****************************
             // CONFIGURE CALIBRATION SIGNAL
             void setCalibrationPrescaler( unsigned int prescaler )
             {
                 // prescaling of the master clock (25 MHz)
                 // master clock is divided by 2^prescaler
                 time_management_regs->calPrescaler = prescaler;
             }
             void setCalibrationDivisor( unsigned int divisionFactor )
             {
                 // division of the prescaled clock by the division factor
                 time_management_regs->calDivisor = divisionFactor;
             }
             void setCalibrationData( void )
             {
                 /** This function is used to store the values used to drive the DAC in order to generate the SCM calibration signal
                  *
                  * @param void
                  *
                  * @return void
                  *
                  */
                 unsigned int k;
                 unsigned short data;
                 float val;
                 float Ts;
                 time_management_regs->calDataPtr = INIT_CHAR;
                 Ts = 1 / CAL_FS;
                 // build the signal for the SCM calibration
                 for (k = 0; k < CAL_NB_PTS; k++)
                 {
                     val = CAL_A0 *  sin( CAL_W0 * k * Ts )
                                     + CAL_A1 * sin(  CAL_W1 * k * Ts );
                     data = (unsigned short) ((val * CAL_SCALE_FACTOR) + CONST_2048);
                     time_management_regs->calData = data & CAL_DATA_MASK;
                 }
             }
             void setCalibrationDataInterleaved( void )
             {
                 /** This function is used to store the values used to drive the DAC in order to generate the SCM calibration signal
                  *
                  * @param void
                  *
                  * @return void
                  *
                  * In interleaved mode, one can store more values than in normal mode.
                  * The data are stored in bunch of 18 bits, 12 bits from one sample and 6 bits from another sample.
                  * T store 3 values, one need two write operations.
                  * s1 [ b11 b10 b9 b8 b7 b6 ] s0 [ b11 b10 b9 b8 b7 b6 b5 b3 b2 b1 b0 ]
                  * s1 [ b5  b4  b3 b2 b1 b0 ] s2 [ b11 b10 b9 b8 b7 b6 b5 b3 b2 b1 b0 ]
                  *
                  */
                 unsigned int k;
                 float val;
                 float Ts;
                 unsigned short data[CAL_NB_PTS_INTER];
                 unsigned char *dataPtr;
                 Ts = 1 / CAL_FS_INTER;
                 time_management_regs->calDataPtr = INIT_CHAR;
                 // build the signal for the SCM calibration
                 for (k=0; k<CAL_NB_PTS_INTER; k++)
                 {
                     val = sin( 2 * pi * CAL_F0 * k * Ts )
                             + sin(  2 * pi * CAL_F1 * k * Ts );
                     data[k] = (unsigned short) ((val * CONST_512) + CONST_2048);
                 }
                 // write the signal in interleaved mode
                 for (k=0; k < STEPS_FOR_STORAGE_INTER; k++)
                 {
                     dataPtr = (unsigned char*) &data[ (k * BYTES_FOR_2_SAMPLES) + 2 ];
                     time_management_regs->calData = ( data[ k * BYTES_FOR_2_SAMPLES ]     & CAL_DATA_MASK )
                             + ( (dataPtr[0] & CAL_DATA_MASK_INTER) << CAL_DATA_SHIFT_INTER);
                     time_management_regs->calData = ( data[(k * BYTES_FOR_2_SAMPLES) + 1] & CAL_DATA_MASK )
                             + ( (dataPtr[1] & CAL_DATA_MASK_INTER) << CAL_DATA_SHIFT_INTER);
                 }
             }
             void setCalibrationReload( bool state)
             {
                 if (state == true)
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl | BIT_CAL_RELOAD;   // [0001 0000]
                 }
                 else
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl & MASK_CAL_RELOAD;   // [1110 1111]
                 }
             }
             void setCalibrationEnable( bool state )
             {
                 // this bit drives the multiplexer
                 if (state == true)
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl | BIT_CAL_ENABLE;   // [0100 0000]
                 }
                 else
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl & MASK_CAL_ENABLE; // [1011 1111]
                 }
             }
             void setCalibrationInterleaved( bool state )
             {
                 // this bit drives the multiplexer
                 if (state == true)
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl | BIT_SET_INTERLEAVED;   // [0010 0000]
                 }
                 else
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl & MASK_SET_INTERLEAVED; // [1101 1111]
                 }
             }
             void setCalibration( bool state )
             {
                 if (state == true)
                 {
                     setCalibrationEnable( true );
                     setCalibrationReload( false );
                     set_hk_lfr_calib_enable( true );
                 }
                 else
                 {
                     setCalibrationEnable( false );
                     setCalibrationReload( true );
                     set_hk_lfr_calib_enable( false );
                 }
             }
             void configureCalibration( bool interleaved )
             {
                 setCalibration( false );
                 if ( interleaved == true )
                 {
                     setCalibrationInterleaved( true );
                     setCalibrationPrescaler( 0 );                   // 25 MHz   => 25 000 000
                     setCalibrationDivisor( CAL_F_DIVISOR_INTER );   //          => 240 384
                     setCalibrationDataInterleaved();
                 }
                 else
                 {
                     setCalibrationPrescaler( 0 );           // 25 MHz   => 25 000 000
                     setCalibrationDivisor( CAL_F_DIVISOR ); //          => 160 256 (39 - 1)
                     setCalibrationData();
                 }
             }
             //****************
             // CLOSING ACTIONS
             void update_last_TC_exe( ccsdsTelecommandPacket_t *TC, unsigned char * time )
             {
                 /** This function is used to update the HK packets statistics after a successful TC execution.
                  *
                  * @param TC points to the TC being processed
                  * @param time is the time used to date the TC execution
                  *
                  */
                 unsigned int val;
                 housekeeping_packet.hk_lfr_last_exe_tc_id[0] = TC->packetID[0];
                 housekeeping_packet.hk_lfr_last_exe_tc_id[1] = TC->packetID[1];
                 housekeeping_packet.hk_lfr_last_exe_tc_type[0] = INIT_CHAR;
                 housekeeping_packet.hk_lfr_last_exe_tc_type[1] = TC->serviceType;
                 housekeeping_packet.hk_lfr_last_exe_tc_subtype[0] = INIT_CHAR;
                 housekeeping_packet.hk_lfr_last_exe_tc_subtype[1] = TC->serviceSubType;
                 housekeeping_packet.hk_lfr_last_exe_tc_time[BYTE_0] = time[BYTE_0];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[BYTE_1] = time[BYTE_1];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[BYTE_2] = time[BYTE_2];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[BYTE_3] = time[BYTE_3];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[BYTE_4] = time[BYTE_4];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[BYTE_5] = time[BYTE_5];
                 val = (housekeeping_packet.hk_lfr_exe_tc_cnt[0] * CONST_256) + housekeeping_packet.hk_lfr_exe_tc_cnt[1];
                 val++;
                 housekeeping_packet.hk_lfr_exe_tc_cnt[0] = (unsigned char) (val >> SHIFT_1_BYTE);
                 housekeeping_packet.hk_lfr_exe_tc_cnt[1] = (unsigned char) (val);
             }
             void update_last_TC_rej(ccsdsTelecommandPacket_t *TC, unsigned char * time )
             {
                 /** This function is used to update the HK packets statistics after a TC rejection.
                  *
                  * @param TC points to the TC being processed
                  * @param time is the time used to date the TC rejection
                  *
                  */
                 unsigned int val;
                 housekeeping_packet.hk_lfr_last_rej_tc_id[0] = TC->packetID[0];
                 housekeeping_packet.hk_lfr_last_rej_tc_id[1] = TC->packetID[1];
                 housekeeping_packet.hk_lfr_last_rej_tc_type[0] = INIT_CHAR;
                 housekeeping_packet.hk_lfr_last_rej_tc_type[1] = TC->serviceType;
                 housekeeping_packet.hk_lfr_last_rej_tc_subtype[0] = INIT_CHAR;
                 housekeeping_packet.hk_lfr_last_rej_tc_subtype[1] = TC->serviceSubType;
                 housekeeping_packet.hk_lfr_last_rej_tc_time[BYTE_0] = time[BYTE_0];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[BYTE_1] = time[BYTE_1];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[BYTE_2] = time[BYTE_2];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[BYTE_3] = time[BYTE_3];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[BYTE_4] = time[BYTE_4];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[BYTE_5] = time[BYTE_5];
                 val = (housekeeping_packet.hk_lfr_rej_tc_cnt[0] * CONST_256) + housekeeping_packet.hk_lfr_rej_tc_cnt[1];
                 val++;
                 housekeeping_packet.hk_lfr_rej_tc_cnt[0] = (unsigned char) (val >> SHIFT_1_BYTE);
                 housekeeping_packet.hk_lfr_rej_tc_cnt[1] = (unsigned char) (val);
             }
             void close_action(ccsdsTelecommandPacket_t *TC, int result, rtems_id queue_id )
             {
                 /** This function is the last step of the TC execution workflow.
                  *
                  * @param TC points to the TC being processed
                  * @param result is the result of the TC execution (LFR_SUCCESSFUL / LFR_DEFAULT)
                  * @param queue_id is the id of the RTEMS message queue used to send TM packets
                  * @param time is the time used to date the TC execution
                  *
                  */
                 unsigned char requestedMode;
                 if (result == LFR_SUCCESSFUL)
                 {
                     if ( !( (TC->serviceType==TC_TYPE_TIME) & (TC->serviceSubType==TC_SUBTYPE_UPDT_TIME) )
                          &
                          !( (TC->serviceType==TC_TYPE_GEN) & (TC->serviceSubType==TC_SUBTYPE_UPDT_INFO))
                          )
                     {
                         send_tm_lfr_tc_exe_success( TC, queue_id );
                     }
                     if ( (TC->serviceType == TC_TYPE_GEN) & (TC->serviceSubType == TC_SUBTYPE_ENTER) )
                     {
                         //**********************************
                         // UPDATE THE LFRMODE LOCAL VARIABLE
                         requestedMode = TC->dataAndCRC[1];
                         updateLFRCurrentMode( requestedMode );
                     }
                 }
                 else if (result == LFR_EXE_ERROR)
                 {
                     send_tm_lfr_tc_exe_error( TC, queue_id );
                 }
             }
             //***************************
             // Interrupt Service Routines
             rtems_isr commutation_isr1( rtems_vector_number vector )
             {
                 if (rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL) {
                     PRINTF("In commutation_isr1 *** Error sending event to DUMB\n")
                 }
             }
             rtems_isr commutation_isr2( rtems_vector_number vector )
             {
                 if (rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL) {
                     PRINTF("In commutation_isr2 *** Error sending event to DUMB\n")
                 }
             }
             //****************
             // OTHER FUNCTIONS
             void updateLFRCurrentMode( unsigned char requestedMode )
             {
                 /** This function updates the value of the global variable lfrCurrentMode.
                  *
                  * lfrCurrentMode is a parameter used by several functions to know in which mode LFR is running.
                  *
                  */
                 // update the local value of lfrCurrentMode with the value contained in the housekeeping_packet structure
                 housekeeping_packet.lfr_status_word[0] = (housekeeping_packet.lfr_status_word[0] & STATUS_WORD_LFR_MODE_MASK)
                         + (unsigned char) ( requestedMode << STATUS_WORD_LFR_MODE_SHIFT );
                 lfrCurrentMode = requestedMode;
             }
             void set_lfr_soft_reset( unsigned char value )
             {
                 if (value == 1)
                 {
                     time_management_regs->ctrl = time_management_regs->ctrl | BIT_SOFT_RESET; // [0100]
                 }
                 else
                 {
                     time_management_regs->ctrl = time_management_regs->ctrl & MASK_SOFT_RESET; // [1011]
                 }
             }
             void reset_lfr( void )
             {
                 set_lfr_soft_reset( 1 );
                 set_lfr_soft_reset( 0 );
                 set_hk_lfr_sc_potential_flag( true );
             }

src/tc_load_dump_parameters.c +128 -18

             /** Functions to load and dump parameters in the LFR registers.
              *
              * @file
              * @author P. LEROY
              *
              * A group of functions to handle TC related to parameter loading and dumping.\n
              * TC_LFR_LOAD_COMMON_PAR\n
              * TC_LFR_LOAD_NORMAL_PAR\n
              * TC_LFR_LOAD_BURST_PAR\n
              * TC_LFR_LOAD_SBM1_PAR\n
              * TC_LFR_LOAD_SBM2_PAR\n
              *
              */
             #include "tc_load_dump_parameters.h"
             Packet_TM_LFR_KCOEFFICIENTS_DUMP_t kcoefficients_dump_1 = {0};
             Packet_TM_LFR_KCOEFFICIENTS_DUMP_t kcoefficients_dump_2 = {0};
             ring_node kcoefficient_node_1 = {0};
             ring_node kcoefficient_node_2 = {0};
             int action_load_common_par(ccsdsTelecommandPacket_t *TC)
             {
                 /** This function updates the LFR registers with the incoming common parameters.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  *
                  *
                  */
                 parameter_dump_packet.sy_lfr_common_parameters_spare    = TC->dataAndCRC[0];
                 parameter_dump_packet.sy_lfr_common_parameters          = TC->dataAndCRC[1];
                 set_wfp_data_shaping( );
                 return LFR_SUCCESSFUL;
             }
             int action_load_normal_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function updates the LFR registers with the incoming normal parameters.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM related to this execution step
                  *
                  */
                 int result;
                 int flag;
                 rtems_status_code status;
                 flag = LFR_SUCCESSFUL;
                 if ( (lfrCurrentMode == LFR_MODE_NORMAL) ||
                      (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) ) {
                     status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     flag = LFR_DEFAULT;
                 }
                 // CHECK THE PARAMETERS SET CONSISTENCY
                 if (flag == LFR_SUCCESSFUL)
                 {
                     flag = check_normal_par_consistency( TC, queue_id );
                 }
                 // SET THE PARAMETERS IF THEY ARE CONSISTENT
                 if (flag == LFR_SUCCESSFUL)
                 {
                     result = set_sy_lfr_n_swf_l( TC );
                     result = set_sy_lfr_n_swf_p( TC );
                     result = set_sy_lfr_n_bp_p0( TC );
                     result = set_sy_lfr_n_bp_p1( TC );
                     result = set_sy_lfr_n_asm_p( TC );
                     result = set_sy_lfr_n_cwf_long_f3( TC );
                 }
                 return flag;
             }
             int action_load_burst_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function updates the LFR registers with the incoming burst parameters.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM related to this execution step
                  *
                  */
                 int flag;
                 rtems_status_code status;
                 unsigned char sy_lfr_b_bp_p0;
                 unsigned char sy_lfr_b_bp_p1;
                 float aux;
                 flag = LFR_SUCCESSFUL;
                 if ( lfrCurrentMode == LFR_MODE_BURST ) {
                     status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     flag = LFR_DEFAULT;
                 }
                 sy_lfr_b_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P0 ];
                 sy_lfr_b_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P1 ];
                 // sy_lfr_b_bp_p0 shall not be lower than its default value
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_b_bp_p0 < DEFAULT_SY_LFR_B_BP_P0 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_B_BP_P0 + DATAFIELD_OFFSET, sy_lfr_b_bp_p0 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 // sy_lfr_b_bp_p1 shall not be lower than its default value
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_b_bp_p1 < DEFAULT_SY_LFR_B_BP_P1 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_B_BP_P1 + DATAFIELD_OFFSET, sy_lfr_b_bp_p1 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //****************************************************************
                 // check the consistency between sy_lfr_b_bp_p0 and sy_lfr_b_bp_p1
                 if (flag == LFR_SUCCESSFUL)
                 {
                     sy_lfr_b_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P0 ];
                     sy_lfr_b_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_B_BP_P1 ];
                     aux = ( (float ) sy_lfr_b_bp_p1 / sy_lfr_b_bp_p0 ) - floor(sy_lfr_b_bp_p1 / sy_lfr_b_bp_p0);
                     if (aux > FLOAT_EQUAL_ZERO)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_B_BP_P0 + DATAFIELD_OFFSET, sy_lfr_b_bp_p0 );
                         flag = LFR_DEFAULT;
                     }
                 }
                 // SET THE PARAMETERS
                 if (flag == LFR_SUCCESSFUL)
                 {
                     flag = set_sy_lfr_b_bp_p0( TC );
                     flag = set_sy_lfr_b_bp_p1( TC );
                 }
                 return flag;
             }
             int action_load_sbm1_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function updates the LFR registers with the incoming sbm1 parameters.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM related to this execution step
                  *
                  */
                 int flag;
                 rtems_status_code status;
                 unsigned char sy_lfr_s1_bp_p0;
                 unsigned char sy_lfr_s1_bp_p1;
                 float aux;
                 flag = LFR_SUCCESSFUL;
                 if ( lfrCurrentMode == LFR_MODE_SBM1 ) {
                     status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     flag = LFR_DEFAULT;
                 }
                 sy_lfr_s1_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S1_BP_P0 ];
                 sy_lfr_s1_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S1_BP_P1 ];
                 // sy_lfr_s1_bp_p0
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_s1_bp_p0 < DEFAULT_SY_LFR_S1_BP_P0 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P0 + DATAFIELD_OFFSET, sy_lfr_s1_bp_p0 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 // sy_lfr_s1_bp_p1
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_s1_bp_p1 < DEFAULT_SY_LFR_S1_BP_P1 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P1 + DATAFIELD_OFFSET, sy_lfr_s1_bp_p1 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //******************************************************************
                 // check the consistency between sy_lfr_s1_bp_p0 and sy_lfr_s1_bp_p1
                 if (flag == LFR_SUCCESSFUL)
                 {
                     aux = ( (float ) sy_lfr_s1_bp_p1 / (sy_lfr_s1_bp_p0 * S1_BP_P0_SCALE) )
                             - floor(sy_lfr_s1_bp_p1 / (sy_lfr_s1_bp_p0 * S1_BP_P0_SCALE));
                     if (aux > FLOAT_EQUAL_ZERO)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S1_BP_P0 + DATAFIELD_OFFSET, sy_lfr_s1_bp_p0 );
                         flag = LFR_DEFAULT;
                     }
                 }
                 // SET THE PARAMETERS
                 if (flag == LFR_SUCCESSFUL)
                 {
                     flag = set_sy_lfr_s1_bp_p0( TC );
                     flag = set_sy_lfr_s1_bp_p1( TC );
                 }
                 return flag;
             }
             int action_load_sbm2_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function updates the LFR registers with the incoming sbm2 parameters.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM related to this execution step
                  *
                  */
                 int flag;
                 rtems_status_code status;
                 unsigned char sy_lfr_s2_bp_p0;
                 unsigned char sy_lfr_s2_bp_p1;
                 float aux;
                 flag = LFR_SUCCESSFUL;
                 if ( lfrCurrentMode == LFR_MODE_SBM2 ) {
                     status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     flag = LFR_DEFAULT;
                 }
                 sy_lfr_s2_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P0 ];
                 sy_lfr_s2_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P1 ];
                 // sy_lfr_s2_bp_p0
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_s2_bp_p0 < DEFAULT_SY_LFR_S2_BP_P0 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S2_BP_P0 + DATAFIELD_OFFSET, sy_lfr_s2_bp_p0 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 // sy_lfr_s2_bp_p1
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if (sy_lfr_s2_bp_p1 < DEFAULT_SY_LFR_S2_BP_P1 )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S2_BP_P1 + DATAFIELD_OFFSET, sy_lfr_s2_bp_p1 );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //******************************************************************
                 // check the consistency between sy_lfr_s2_bp_p0 and sy_lfr_s2_bp_p1
                 if (flag == LFR_SUCCESSFUL)
                 {
                     sy_lfr_s2_bp_p0 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P0 ];
                     sy_lfr_s2_bp_p1 = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_S2_BP_P1 ];
                     aux = ( (float ) sy_lfr_s2_bp_p1 / sy_lfr_s2_bp_p0 ) - floor(sy_lfr_s2_bp_p1 / sy_lfr_s2_bp_p0);
                     if (aux > FLOAT_EQUAL_ZERO)
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_S2_BP_P0 + DATAFIELD_OFFSET, sy_lfr_s2_bp_p0 );
                         flag = LFR_DEFAULT;
                     }
                 }
                 // SET THE PARAMETERS
                 if (flag == LFR_SUCCESSFUL)
                 {
                     flag = set_sy_lfr_s2_bp_p0( TC );
                     flag = set_sy_lfr_s2_bp_p1( TC );
                 }
                 return flag;
             }
             int action_load_kcoefficients(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function updates the LFR registers with the incoming sbm2 parameters.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM related to this execution step
                  *
                  */
                 int flag;
                 flag = LFR_DEFAULT;
                 flag = set_sy_lfr_kcoeff( TC, queue_id );
                 return flag;
             }
             int action_load_fbins_mask(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function updates the LFR registers with the incoming sbm2 parameters.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM related to this execution step
                  *
                  */
                 int flag;
                 flag = LFR_DEFAULT;
                 flag = set_sy_lfr_fbins( TC );
                 // once the fbins masks have been stored, they have to be merged with the masks which handle the reaction wheels frequencies filtering
                 merge_fbins_masks();
                 return flag;
             }
             int action_load_filter_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function updates the LFR registers with the incoming sbm2 parameters.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM related to this execution step
                  *
                  */
                 int flag;
                 unsigned char k;
                 flag = LFR_DEFAULT;
                 k = INIT_CHAR;
                 flag = check_sy_lfr_filter_parameters( TC, queue_id );
                 if (flag  == LFR_SUCCESSFUL)
                 {
                     parameter_dump_packet.spare_sy_lfr_pas_filter_enabled   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_ENABLED ];
                     parameter_dump_packet.sy_lfr_pas_filter_modulus         = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_0]    = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_0 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_1]    = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_1 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_2]    = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_2 ];
                     parameter_dump_packet.sy_lfr_pas_filter_tbad[BYTE_3]    = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + BYTE_3 ];
                     parameter_dump_packet.sy_lfr_pas_filter_offset          = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_0]   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_0 ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_1]   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_1 ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_2]   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_2 ];
                     parameter_dump_packet.sy_lfr_pas_filter_shift[BYTE_3]   = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + BYTE_3 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_0]      = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_0 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_1]      = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_1 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_2]      = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_2 ];
                     parameter_dump_packet.sy_lfr_sc_rw_delta_f[BYTE_3]      = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + BYTE_3 ];
                     //****************************
                     // store PAS filter parameters
                     // sy_lfr_pas_filter_enabled
                     filterPar.spare_sy_lfr_pas_filter_enabled   = parameter_dump_packet.spare_sy_lfr_pas_filter_enabled;
                     set_sy_lfr_pas_filter_enabled( parameter_dump_packet.spare_sy_lfr_pas_filter_enabled & BIT_PAS_FILTER_ENABLED );
                     // sy_lfr_pas_filter_modulus
                     filterPar.sy_lfr_pas_filter_modulus         = parameter_dump_packet.sy_lfr_pas_filter_modulus;
                     // sy_lfr_pas_filter_tbad
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_pas_filter_tbad,
                                      parameter_dump_packet.sy_lfr_pas_filter_tbad );
                     // sy_lfr_pas_filter_offset
                     filterPar.sy_lfr_pas_filter_offset          = parameter_dump_packet.sy_lfr_pas_filter_offset;
                     // sy_lfr_pas_filter_shift
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_pas_filter_shift,
                                      parameter_dump_packet.sy_lfr_pas_filter_shift );
                     //****************************************************
                     // store the parameter sy_lfr_sc_rw_delta_f as a float
                     copyFloatByChar( (unsigned char*) &filterPar.sy_lfr_sc_rw_delta_f,
                                      parameter_dump_packet.sy_lfr_sc_rw_delta_f );
                     // 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_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 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;
+                int datafield_pos;
-                float *rw_k;
+                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 = NULL;
+                datafield_pos = INIT_INT;
-                rw_k = NULL;
+                rw_k = INIT_FLOAT;
-                *datafield_pos = LFR_DEFAULT_ALT;
-                *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 ( (sy_lfr_pas_filter_tbad < MIN_PAS_FILTER_TBAD) || (sy_lfr_pas_filter_tbad > MAX_PAS_FILTER_TBAD) )
+                if (flag == LFR_SUCCESSFUL)
                 {
-                    parPtr = (char*) &sy_lfr_pas_filter_tbad;
+                    if ( (sy_lfr_pas_filter_tbad < MIN_PAS_FILTER_TBAD) || (sy_lfr_pas_filter_tbad > MAX_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;
+                        parPtr = (char*) &sy_lfr_pas_filter_tbad;
+                        status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
+                        flag = WRONG_APP_DATA;
+                    }
                 }
                 //*************************
                 // sy_lfr_pas_filter_offset
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( (sy_lfr_pas_filter_offset < MIN_PAS_FILTER_OFFSET) || (sy_lfr_pas_filter_offset > MAX_PAS_FILTER_OFFSET) )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET + DATAFIELD_OFFSET, sy_lfr_pas_filter_offset );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //************************
                 // sy_lfr_pas_filter_shift
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( (sy_lfr_pas_filter_shift < MIN_PAS_FILTER_SHIFT) || (sy_lfr_pas_filter_shift > MAX_PAS_FILTER_SHIFT) )
                     {
                         parPtr = (char*) &sy_lfr_pas_filter_shift;
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //*************************************
                 // check global coherency of the values
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( (sy_lfr_pas_filter_tbad + sy_lfr_pas_filter_offset + sy_lfr_pas_filter_shift) > sy_lfr_pas_filter_modulus )
                     {
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS + DATAFIELD_OFFSET, sy_lfr_pas_filter_modulus );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //*********************
                 // sy_lfr_sc_rw_delta_f
                 if (flag == LFR_SUCCESSFUL)
                 {
                     if ( sy_lfr_sc_rw_delta_f < MIN_SY_LFR_SC_RW_DELTA_F )
                     {
+                        parPtr = (char*) &sy_lfr_pas_filter_shift;
                         status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + DATAFIELD_OFFSET, sy_lfr_sc_rw_delta_f );
                         flag = WRONG_APP_DATA;
                     }
                 }
                 //************
                 // sy_lfr_rw_k
                 if (flag == LFR_SUCCESSFUL)
                 {
-                    flag = check_all_sy_lfr_rw_k( TC, datafield_pos, rw_k );
+                    flag = check_all_sy_lfr_rw_k( TC, &datafield_pos, &rw_k );
                     if (flag  != LFR_SUCCESSFUL)
                     {
-                        status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, *datafield_pos + DATAFIELD_OFFSET, *rw_k );
+                        parPtr = (char*) &sy_lfr_pas_filter_shift;
+                        status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, datafield_pos + DATAFIELD_OFFSET, parPtr[FLOAT_LSBYTE] );
                     }
                 }
                 return flag;
             }
             //**************
             // KCOEFFICIENTS
             int set_sy_lfr_kcoeff( ccsdsTelecommandPacket_t *TC,rtems_id queue_id )
             {
                 unsigned int kcoeff;
                 unsigned short sy_lfr_kcoeff_frequency;
                 unsigned short bin;
                 float *kcoeffPtr_norm;
                 float *kcoeffPtr_sbm;
                 int status;
                 unsigned char *kcoeffLoadPtr;
                 unsigned char *kcoeffNormPtr;
                 unsigned char *kcoeffSbmPtr_a;
                 unsigned char *kcoeffSbmPtr_b;
                 sy_lfr_kcoeff_frequency = 0;
                 bin = 0;
                 kcoeffPtr_norm = NULL;
                 kcoeffPtr_sbm  = NULL;
                 status = LFR_SUCCESSFUL;
                 // copy the value of the frequency byte by byte DO NOT USE A SHORT* POINTER
                 copyInt16ByChar( (unsigned char*) &sy_lfr_kcoeff_frequency, &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY] );
                 if ( sy_lfr_kcoeff_frequency >= NB_BINS_COMPRESSED_SM )
                 {
                     PRINTF1("ERR *** in set_sy_lfr_kcoeff_frequency *** sy_lfr_kcoeff_frequency = %d\n", sy_lfr_kcoeff_frequency)
                     status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY + DATAFIELD_OFFSET + 1,
                                                               TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_FREQUENCY + 1]  ); // +1 to get the LSB instead of the MSB
                     status = LFR_DEFAULT;
                 }
                 else
                 {
                     if       ( ( sy_lfr_kcoeff_frequency >= 0 )
                             && ( sy_lfr_kcoeff_frequency < NB_BINS_COMPRESSED_SM_F0 ) )
                     {
                         kcoeffPtr_norm = k_coeff_intercalib_f0_norm;
                         kcoeffPtr_sbm  = k_coeff_intercalib_f0_sbm;
                         bin   = sy_lfr_kcoeff_frequency;
                     }
                     else if   ( ( sy_lfr_kcoeff_frequency >= NB_BINS_COMPRESSED_SM_F0 )
                              && ( sy_lfr_kcoeff_frequency < (NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1) ) )
                     {
                         kcoeffPtr_norm = k_coeff_intercalib_f1_norm;
                         kcoeffPtr_sbm  = k_coeff_intercalib_f1_sbm;
                         bin   = sy_lfr_kcoeff_frequency -  NB_BINS_COMPRESSED_SM_F0;
                     }
                     else if   ( ( sy_lfr_kcoeff_frequency >= (NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1) )
                              && ( sy_lfr_kcoeff_frequency <  (NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1 + NB_BINS_COMPRESSED_SM_F2) ) )
                     {
                         kcoeffPtr_norm = k_coeff_intercalib_f2;
                         kcoeffPtr_sbm  = NULL;
                         bin   = sy_lfr_kcoeff_frequency - (NB_BINS_COMPRESSED_SM_F0 + NB_BINS_COMPRESSED_SM_F1);
                     }
                 }
                 if (kcoeffPtr_norm != NULL )    // update K coefficient for NORMAL data products
                 {
                     for (kcoeff=0; kcoeff<NB_K_COEFF_PER_BIN; kcoeff++)
                     {
                         // destination
                         kcoeffNormPtr = (unsigned char*) &kcoeffPtr_norm[ (bin * NB_K_COEFF_PER_BIN) + kcoeff ];
                         // source
                         kcoeffLoadPtr = (unsigned char*) &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_1 + (NB_BYTES_PER_FLOAT * kcoeff)];
                         // copy source to destination
                         copyFloatByChar( kcoeffNormPtr,  kcoeffLoadPtr );
                     }
                 }
                 if (kcoeffPtr_sbm != NULL )     // update K coefficient for SBM data products
                 {
                     for (kcoeff=0; kcoeff<NB_K_COEFF_PER_BIN; kcoeff++)
                     {
                         // destination
                         kcoeffSbmPtr_a= (unsigned char*) &kcoeffPtr_sbm[ ( (bin * NB_K_COEFF_PER_BIN) + kcoeff) * SBM_COEFF_PER_NORM_COEFF        ];
                         kcoeffSbmPtr_b= (unsigned char*) &kcoeffPtr_sbm[ (((bin * NB_K_COEFF_PER_BIN) + kcoeff) * SBM_KCOEFF_PER_NORM_KCOEFF) + 1 ];
                         // source
                         kcoeffLoadPtr = (unsigned char*) &TC->dataAndCRC[DATAFIELD_POS_SY_LFR_KCOEFF_1 + (NB_BYTES_PER_FLOAT * kcoeff)];
                         // copy source to destination
                         copyFloatByChar( kcoeffSbmPtr_a, kcoeffLoadPtr );
                         copyFloatByChar( kcoeffSbmPtr_b, kcoeffLoadPtr );
                     }
                 }
             //    print_k_coeff();
                 return status;
             }
             void copyFloatByChar( unsigned char *destination, unsigned char *source )
             {
                 destination[BYTE_0] = source[BYTE_0];
                 destination[BYTE_1] = source[BYTE_1];
                 destination[BYTE_2] = source[BYTE_2];
                 destination[BYTE_3] = source[BYTE_3];
             }
             void copyInt32ByChar( unsigned char *destination, unsigned char *source )
             {
                 destination[BYTE_0] = source[BYTE_0];
                 destination[BYTE_1] = source[BYTE_1];
                 destination[BYTE_2] = source[BYTE_2];
                 destination[BYTE_3] = source[BYTE_3];
             }
             void copyInt16ByChar( unsigned char *destination, unsigned char *source )
             {
                 destination[BYTE_0] = source[BYTE_0];
                 destination[BYTE_1] = source[BYTE_1];
             }
             void floatToChar( float value, unsigned char* ptr)
             {
                 unsigned char* valuePtr;
                 valuePtr = (unsigned char*) &value;
                 ptr[BYTE_0] = valuePtr[BYTE_0];
                 ptr[BYTE_1] = valuePtr[BYTE_1];
                 ptr[BYTE_2] = valuePtr[BYTE_2];
                 ptr[BYTE_3] = valuePtr[BYTE_3];
             }
             //**********
             // init dump
             void init_parameter_dump( void )
             {
                 /** This function initialize the parameter_dump_packet global variable with default values.
                  *
                  */
                 unsigned int k;
                 parameter_dump_packet.targetLogicalAddress = CCSDS_DESTINATION_ID;
                 parameter_dump_packet.protocolIdentifier = CCSDS_PROTOCOLE_ID;
                 parameter_dump_packet.reserved = CCSDS_RESERVED;
                 parameter_dump_packet.userApplication = CCSDS_USER_APP;
                 parameter_dump_packet.packetID[0] = (unsigned char) (APID_TM_PARAMETER_DUMP >> SHIFT_1_BYTE);
                 parameter_dump_packet.packetID[1] = (unsigned char) APID_TM_PARAMETER_DUMP;
                 parameter_dump_packet.packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 parameter_dump_packet.packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
                 parameter_dump_packet.packetLength[0] = (unsigned char) (PACKET_LENGTH_PARAMETER_DUMP >> SHIFT_1_BYTE);
                 parameter_dump_packet.packetLength[1] = (unsigned char) PACKET_LENGTH_PARAMETER_DUMP;
                 // DATA FIELD HEADER
                 parameter_dump_packet.spare1_pusVersion_spare2 = SPARE1_PUSVERSION_SPARE2;
                 parameter_dump_packet.serviceType = TM_TYPE_PARAMETER_DUMP;
                 parameter_dump_packet.serviceSubType = TM_SUBTYPE_PARAMETER_DUMP;
                 parameter_dump_packet.destinationID = TM_DESTINATION_ID_GROUND;
                 parameter_dump_packet.time[BYTE_0] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_3_BYTES);
                 parameter_dump_packet.time[BYTE_1] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_2_BYTES);
                 parameter_dump_packet.time[BYTE_2] = (unsigned char) (time_management_regs->coarse_time >> SHIFT_1_BYTE);
                 parameter_dump_packet.time[BYTE_3] = (unsigned char) (time_management_regs->coarse_time);
                 parameter_dump_packet.time[BYTE_4] = (unsigned char) (time_management_regs->fine_time >> SHIFT_1_BYTE);
                 parameter_dump_packet.time[BYTE_5] = (unsigned char) (time_management_regs->fine_time);
                 parameter_dump_packet.sid = SID_PARAMETER_DUMP;
                 //******************
                 // COMMON PARAMETERS
                 parameter_dump_packet.sy_lfr_common_parameters_spare    = DEFAULT_SY_LFR_COMMON0;
                 parameter_dump_packet.sy_lfr_common_parameters          = DEFAULT_SY_LFR_COMMON1;
                 //******************
                 // NORMAL PARAMETERS
                 parameter_dump_packet.sy_lfr_n_swf_l[0] = (unsigned char) (DFLT_SY_LFR_N_SWF_L >> SHIFT_1_BYTE);
                 parameter_dump_packet.sy_lfr_n_swf_l[1] = (unsigned char) (DFLT_SY_LFR_N_SWF_L     );
                 parameter_dump_packet.sy_lfr_n_swf_p[0] = (unsigned char) (DFLT_SY_LFR_N_SWF_P >> SHIFT_1_BYTE);
                 parameter_dump_packet.sy_lfr_n_swf_p[1] = (unsigned char) (DFLT_SY_LFR_N_SWF_P     );
                 parameter_dump_packet.sy_lfr_n_asm_p[0] = (unsigned char) (DFLT_SY_LFR_N_ASM_P >> SHIFT_1_BYTE);
                 parameter_dump_packet.sy_lfr_n_asm_p[1] = (unsigned char) (DFLT_SY_LFR_N_ASM_P     );
                 parameter_dump_packet.sy_lfr_n_bp_p0 = (unsigned char) DFLT_SY_LFR_N_BP_P0;
                 parameter_dump_packet.sy_lfr_n_bp_p1 = (unsigned char) DFLT_SY_LFR_N_BP_P1;
                 parameter_dump_packet.sy_lfr_n_cwf_long_f3 = (unsigned char) DFLT_SY_LFR_N_CWF_LONG_F3;
                 //*****************
                 // BURST PARAMETERS
                 parameter_dump_packet.sy_lfr_b_bp_p0 = (unsigned char) DEFAULT_SY_LFR_B_BP_P0;
                 parameter_dump_packet.sy_lfr_b_bp_p1 = (unsigned char) DEFAULT_SY_LFR_B_BP_P1;
                 //****************
                 // SBM1 PARAMETERS
                 parameter_dump_packet.sy_lfr_s1_bp_p0 = (unsigned char) DEFAULT_SY_LFR_S1_BP_P0; // min value is 0.25 s for the period
                 parameter_dump_packet.sy_lfr_s1_bp_p1 = (unsigned char) DEFAULT_SY_LFR_S1_BP_P1;
                 //****************
                 // SBM2 PARAMETERS
                 parameter_dump_packet.sy_lfr_s2_bp_p0 = (unsigned char) DEFAULT_SY_LFR_S2_BP_P0;
                 parameter_dump_packet.sy_lfr_s2_bp_p1 = (unsigned char) DEFAULT_SY_LFR_S2_BP_P1;
                 //************
                 // FBINS MASKS
                 for (k=0; k < BYTES_PER_MASKS_SET; k++)
                 {
                     parameter_dump_packet.sy_lfr_fbins_f0_word1[k] = INT8_ALL_F;
                 }
                 // PAS FILTER PARAMETERS
                 parameter_dump_packet.pa_rpw_spare8_2                   = INIT_CHAR;
                 parameter_dump_packet.spare_sy_lfr_pas_filter_enabled   = INIT_CHAR;
                 parameter_dump_packet.sy_lfr_pas_filter_modulus         = DEFAULT_SY_LFR_PAS_FILTER_MODULUS;
                 floatToChar( DEFAULT_SY_LFR_PAS_FILTER_TBAD,    parameter_dump_packet.sy_lfr_pas_filter_tbad );
                 parameter_dump_packet.sy_lfr_pas_filter_offset          = DEFAULT_SY_LFR_PAS_FILTER_OFFSET;
                 floatToChar( DEFAULT_SY_LFR_PAS_FILTER_SHIFT,   parameter_dump_packet.sy_lfr_pas_filter_shift );
                 floatToChar( DEFAULT_SY_LFR_SC_RW_DELTA_F,      parameter_dump_packet.sy_lfr_sc_rw_delta_f );
                 // RW1_K
                 floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw1_k1);
                 floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw1_k2);
                 floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw1_k3);
                 floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw1_k4);
                 // RW2_K
                 floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw2_k1);
                 floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw2_k2);
                 floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw2_k3);
                 floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw2_k4);
                 // RW3_K
                 floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw3_k1);
                 floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw3_k2);
                 floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw3_k3);
                 floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw3_k4);
                 // RW4_K
                 floatToChar( DEFAULT_SY_LFR_RW_K1, parameter_dump_packet.sy_lfr_rw4_k1);
                 floatToChar( DEFAULT_SY_LFR_RW_K2, parameter_dump_packet.sy_lfr_rw4_k2);
                 floatToChar( DEFAULT_SY_LFR_RW_K3, parameter_dump_packet.sy_lfr_rw4_k3);
                 floatToChar( DEFAULT_SY_LFR_RW_K4, parameter_dump_packet.sy_lfr_rw4_k4);
                 // LFR_RW_MASK
                 for (k=0; k < BYTES_PER_MASKS_SET; k++)
                 {
                     parameter_dump_packet.sy_lfr_rw_mask_f0_word1[k] = INT8_ALL_F;
                 }
                 // once the reaction wheels masks have been initialized, they have to be merged with the fbins masks
                 merge_fbins_masks();
             }
             void init_kcoefficients_dump( void )
             {
                 init_kcoefficients_dump_packet( &kcoefficients_dump_1, PKTNR_1, KCOEFF_BLK_NR_PKT1 );
                 init_kcoefficients_dump_packet( &kcoefficients_dump_2, PKTNR_2, KCOEFF_BLK_NR_PKT2  );
                 kcoefficient_node_1.previous = NULL;
                 kcoefficient_node_1.next = NULL;
                 kcoefficient_node_1.sid = TM_CODE_K_DUMP;
                 kcoefficient_node_1.coarseTime = INIT_CHAR;
                 kcoefficient_node_1.fineTime = INIT_CHAR;
                 kcoefficient_node_1.buffer_address = (int) &kcoefficients_dump_1;
                 kcoefficient_node_1.status = INIT_CHAR;
                 kcoefficient_node_2.previous = NULL;
                 kcoefficient_node_2.next = NULL;
                 kcoefficient_node_2.sid = TM_CODE_K_DUMP;
                 kcoefficient_node_2.coarseTime = INIT_CHAR;
                 kcoefficient_node_2.fineTime = INIT_CHAR;
                 kcoefficient_node_2.buffer_address = (int) &kcoefficients_dump_2;
                 kcoefficient_node_2.status = INIT_CHAR;
             }
             void init_kcoefficients_dump_packet( Packet_TM_LFR_KCOEFFICIENTS_DUMP_t *kcoefficients_dump, unsigned char pkt_nr, unsigned char blk_nr )
             {
                 unsigned int k;
                 unsigned int packetLength;
                 packetLength =
                         ((blk_nr * KCOEFF_BLK_SIZE) + BYTE_POS_KCOEFFICIENTS_PARAMETES) - CCSDS_TC_TM_PACKET_OFFSET; // 4 bytes for the CCSDS header
                 kcoefficients_dump->targetLogicalAddress = CCSDS_DESTINATION_ID;
                 kcoefficients_dump->protocolIdentifier = CCSDS_PROTOCOLE_ID;
                 kcoefficients_dump->reserved = CCSDS_RESERVED;
                 kcoefficients_dump->userApplication = CCSDS_USER_APP;
                 kcoefficients_dump->packetID[0] = (unsigned char) (APID_TM_PARAMETER_DUMP >> SHIFT_1_BYTE);
                 kcoefficients_dump->packetID[1] = (unsigned char) APID_TM_PARAMETER_DUMP;
                 kcoefficients_dump->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 kcoefficients_dump->packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
                 kcoefficients_dump->packetLength[0] = (unsigned char) (packetLength >> SHIFT_1_BYTE);
                 kcoefficients_dump->packetLength[1] = (unsigned char) packetLength;
                 // DATA FIELD HEADER
                 kcoefficients_dump->spare1_pusVersion_spare2 = SPARE1_PUSVERSION_SPARE2;
                 kcoefficients_dump->serviceType = TM_TYPE_K_DUMP;
                 kcoefficients_dump->serviceSubType = TM_SUBTYPE_K_DUMP;
                 kcoefficients_dump->destinationID= TM_DESTINATION_ID_GROUND;
                 kcoefficients_dump->time[BYTE_0] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_1] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_2] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_3] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_4] = INIT_CHAR;
                 kcoefficients_dump->time[BYTE_5] = INIT_CHAR;
                 kcoefficients_dump->sid = SID_K_DUMP;
                 kcoefficients_dump->pkt_cnt = KCOEFF_PKTCNT;
                 kcoefficients_dump->pkt_nr = PKTNR_1;
                 kcoefficients_dump->blk_nr = blk_nr;
                 //******************
                 // SOURCE DATA repeated N times with N in [0 .. PA_LFR_KCOEFF_BLK_NR]
                 // one blk is 2 + 4 * 32 = 130 bytes, 30 blks max in one packet (30 * 130 = 3900)
                 for (k=0; k<(KCOEFF_BLK_NR_PKT1 * KCOEFF_BLK_SIZE); k++)
                 {
                     kcoefficients_dump->kcoeff_blks[k] = INIT_CHAR;
                 }
             }
             void increment_seq_counter_destination_id_dump( unsigned char *packet_sequence_control, unsigned char destination_id )
             {
                 /** This function increment the packet sequence control parameter of a TC, depending on its destination ID.
                  *
                  * @param packet_sequence_control points to the packet sequence control which will be incremented
                  * @param destination_id is the destination ID of the TM, there is one counter by destination ID
                  *
                  * If the destination ID is not known, a dedicated counter is incremented.
                  *
                  */
                 unsigned short sequence_cnt;
                 unsigned short segmentation_grouping_flag;
                 unsigned short new_packet_sequence_control;
                 unsigned char i;
                 switch (destination_id)
                 {
                 case SID_TC_GROUND:
                     i = GROUND;
                     break;
                 case SID_TC_MISSION_TIMELINE:
                     i = MISSION_TIMELINE;
                     break;
                 case SID_TC_TC_SEQUENCES:
                     i = TC_SEQUENCES;
                     break;
                 case SID_TC_RECOVERY_ACTION_CMD:
                     i = RECOVERY_ACTION_CMD;
                     break;
                 case SID_TC_BACKUP_MISSION_TIMELINE:
                     i = BACKUP_MISSION_TIMELINE;
                     break;
                 case SID_TC_DIRECT_CMD:
                     i = DIRECT_CMD;
                     break;
                 case SID_TC_SPARE_GRD_SRC1:
                     i = SPARE_GRD_SRC1;
                     break;
                 case SID_TC_SPARE_GRD_SRC2:
                     i = SPARE_GRD_SRC2;
                     break;
                 case SID_TC_OBCP:
                     i = OBCP;
                     break;
                 case SID_TC_SYSTEM_CONTROL:
                     i = SYSTEM_CONTROL;
                     break;
                 case SID_TC_AOCS:
                     i = AOCS;
                     break;
                 case SID_TC_RPW_INTERNAL:
                     i = RPW_INTERNAL;
                     break;
                 default:
                     i = GROUND;
                     break;
                 }
                 segmentation_grouping_flag  = TM_PACKET_SEQ_CTRL_STANDALONE << SHIFT_1_BYTE;
                 sequence_cnt                = sequenceCounters_TM_DUMP[ i ] & SEQ_CNT_MASK;
                 new_packet_sequence_control = segmentation_grouping_flag | sequence_cnt ;
                 packet_sequence_control[0] = (unsigned char) (new_packet_sequence_control >> SHIFT_1_BYTE);
                 packet_sequence_control[1] = (unsigned char) (new_packet_sequence_control     );
                 // increment the sequence counter
                 if ( sequenceCounters_TM_DUMP[ i ] < SEQ_CNT_MAX )
                 {
                     sequenceCounters_TM_DUMP[ i ] = sequenceCounters_TM_DUMP[ i ] + 1;
                 }
                 else
                 {
                     sequenceCounters_TM_DUMP[ i ] = 0;
                 }
             }

General Comments 0

Write
Preview

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

No TODOs yet

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

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