HG_REPOSITORIES/LPP/INSTRUMENTATION/USERS/JEANDET/LFR_FSW Commit - r254:aca3cbff85cc

a wrong date implies the generation of a TM_LFR_TC_EXE_NOT_EXECUTABLE...

paul -

r254:aca3cbff85cc R3a

parent child

Context file:

r254:aca3cbff85cc

Collapse all files

.hgsubstate +1 -1

@@ -1,2 +1,2
1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters	1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters
2	084fd0db5e4139a1096789935e32ef498192f395 header/lfr_common_headers	2	80d727bb9d808ae67c801c4c6101811d68b94af6 header/lfr_common_headers

header/fsw_spacewire.h +1 -1

             #ifndef FSW_SPACEWIRE_H_INCLUDED
             #define FSW_SPACEWIRE_H_INCLUDED
             #include <rtems.h>
             #include <grspw.h>
             #include <fcntl.h>      // for  O_RDWR
             #include <unistd.h>     // for the read call
             #include <sys/ioctl.h>  // for the ioctl call
             #include <errno.h>
             #include "fsw_params.h"
             #include "tc_handler.h"
             #include "fsw_init.h"
             extern spw_stats spacewire_stats;
             extern spw_stats spacewire_stats_backup;
             extern rtems_name timecode_timer_name;
             extern rtems_id timecode_timer_id;
             // RTEMS TASK
             rtems_task spiq_task( rtems_task_argument argument );
             rtems_task recv_task( rtems_task_argument unused );
             rtems_task send_task( rtems_task_argument argument );
-            rtems_task wtdg_task( rtems_task_argument argument );
+            rtems_task link_task( rtems_task_argument argument );
             int spacewire_open_link( void );
             int spacewire_start_link( int fd );
             int spacewire_stop_and_start_link( int fd );
             int spacewire_configure_link(int fd );
             int spacewire_several_connect_attemps( void );
             void spacewire_set_NP( unsigned char val, unsigned int regAddr ); // No Port force
             void spacewire_set_RE( unsigned char val, unsigned int regAddr ); // RMAP Enable
             void spacewire_compute_stats_offsets( void );
             void spacewire_update_statistics( void );
             void increase_unsigned_char_counter( unsigned char *counter );
             void init_header_cwf( Header_TM_LFR_SCIENCE_CWF_t *header );
             void init_header_swf( Header_TM_LFR_SCIENCE_SWF_t *header );
             void init_header_asm( Header_TM_LFR_SCIENCE_ASM_t *header );
             int spw_send_waveform_CWF( ring_node *ring_node_to_send, Header_TM_LFR_SCIENCE_CWF_t *header );
             int spw_send_waveform_SWF( ring_node *ring_node_to_send, Header_TM_LFR_SCIENCE_SWF_t *header );
             int spw_send_waveform_CWF3_light( ring_node *ring_node_to_send, Header_TM_LFR_SCIENCE_CWF_t *header );
             void spw_send_asm_f0( ring_node *ring_node_to_send, Header_TM_LFR_SCIENCE_ASM_t *header );
             void spw_send_asm_f1( ring_node *ring_node_to_send, Header_TM_LFR_SCIENCE_ASM_t *header );
             void spw_send_asm_f2( ring_node *ring_node_to_send, Header_TM_LFR_SCIENCE_ASM_t *header );
             void spw_send_k_dump( ring_node *ring_node_to_send );
             rtems_timer_service_routine timecode_timer_routine( rtems_id timer_id, void *user_data );
             unsigned int check_timecode_and_previous_timecode_coherency(unsigned char currentTimecodeCtr);
             unsigned int check_timecode_and_internal_time_coherency(unsigned char timecode, unsigned char internalTime);
             void timecode_irq_handler( void *pDev, void *regs, int minor, unsigned int tc );
             void (*grspw_timecode_callback) ( void *pDev, void *regs, int minor, unsigned int tc );
             #endif // FSW_SPACEWIRE_H_INCLUDED

header/tc_handler.h +2 -2

             #ifndef TC_HANDLER_H_INCLUDED
             #define TC_HANDLER_H_INCLUDED
             #include <rtems.h>
             #include <leon.h>
             #include "tc_load_dump_parameters.h"
             #include "tc_acceptance.h"
             #include "tm_lfr_tc_exe.h"
             #include "wf_handler.h"
             #include "fsw_processing.h"
             #include "lfr_cpu_usage_report.h"
             extern unsigned int lastValidEnterModeTime;
             //****
             // ISR
             rtems_isr commutation_isr1( rtems_vector_number vector );
             rtems_isr commutation_isr2( rtems_vector_number vector );
             //***********
             // RTEMS TASK
             rtems_task actn_task( rtems_task_argument unused );
             //***********
             // TC ACTIONS
             int action_reset( ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time );
             int action_enter_mode(ccsdsTelecommandPacket_t *TC, rtems_id queue_id);
             int action_update_info( ccsdsTelecommandPacket_t *TC, rtems_id queue_id );
             int action_enable_calibration( ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time );
             int action_disable_calibration( ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time );
             int action_update_time( ccsdsTelecommandPacket_t *TC);
             // mode transition
             int check_mode_value( unsigned char requestedMode );
             int check_mode_transition( unsigned char requestedMode );
             void update_last_valid_transition_date( unsigned int transitionCoarseTime );
             int check_transition_date( unsigned int transitionCoarseTime );
             int stop_spectral_matrices( void );
             int stop_current_mode( void );
-            int enter_mode_standby( void );
+            int enter_mode_standby(void );
             int enter_mode_normal( unsigned int transitionCoarseTime );
             int enter_mode_burst( unsigned int transitionCoarseTime );
             int enter_mode_sbm1( unsigned int transitionCoarseTime );
             int enter_mode_sbm2( unsigned int transitionCoarseTime );
             int restart_science_tasks( unsigned char lfrRequestedMode );
             int restart_asm_tasks(unsigned char lfrRequestedMode );
             int suspend_science_tasks(void);
             int suspend_asm_tasks( void );
             void launch_waveform_picker( unsigned char mode , unsigned int transitionCoarseTime );
             void launch_spectral_matrix( void );
             void set_sm_irq_onNewMatrix( unsigned char value );
             void set_sm_irq_onError( unsigned char value );
             // other functions
-            void updateLFRCurrentMode();
+            void updateLFRCurrentMode(unsigned char requestedMode);
             void set_lfr_soft_reset( unsigned char value );
             void reset_lfr( void );
             // CALIBRATION
             void setCalibrationPrescaler( unsigned int prescaler );
             void setCalibrationDivisor( unsigned int divisionFactor );
             void setCalibrationData( void );
             void setCalibrationReload( bool state);
             void setCalibrationEnable( bool state );
             void setCalibrationInterleaved( bool state );
             void setCalibration( bool state );
             void configureCalibration( bool interleaved );
             //
             void update_last_TC_exe( ccsdsTelecommandPacket_t *TC , unsigned char *time );
             void update_last_TC_rej(ccsdsTelecommandPacket_t *TC , unsigned char *time );
             void close_action( ccsdsTelecommandPacket_t *TC, int result, rtems_id queue_id );
             extern rtems_status_code get_message_queue_id_send( rtems_id *queue_id );
             extern rtems_status_code get_message_queue_id_recv( rtems_id *queue_id );
             #endif // TC_HANDLER_H_INCLUDED

src/fsw_init.c +9 -9

             /** 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 20
             #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
-            #define CONFIGURE_MAXIMUM_TIMERS 5 // [spiq] [wtdg] [spacewire_reset_link]
+            #define CONFIGURE_MAXIMUM_TIMERS 5 // [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;
                 cacheControlRegister = CCR_getValue();
                 PRINTF1("(0) cacheControlRegister = %x\n", cacheControlRegister);
                 CCR_resetCacheControlRegister();
                 CCR_enableInstructionCache();       // ICS bits
                 CCR_enableDataCache();              // DCS bits
                 CCR_enableInstructionBurstFetch();  // IB  bit
                 cacheControlRegister = CCR_getValue();
                 PRINTF1("(1) cacheControlRegister = %x\n", cacheControlRegister);
                 CCR_faultTolerantScheme();
                 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;
                 // 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 = 0x00;
                 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();
+                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>
                 grspw_timecode_callback = &timecode_irq_handler;
                 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 );
                 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)
                 BOOT_PRINTF1("nb_interrupt_f0_MAX = %d\n", param_local.local_nb_interrupt_f0_MAX)
                 // init sequence counters
                 for(i = 0; i<SEQ_CNT_NB_DEST_ID; i++)
                 {
                     sequenceCounters_TC_EXE[i] = 0x00;
                     sequenceCounters_TM_DUMP[i] = 0x00;
                 }
                 sequenceCounters_SCIENCE_NORMAL_BURST = 0x00;
                 sequenceCounters_SCIENCE_SBM1_SBM2 =    0x00;
                 sequenceCounterHK =                     TM_PACKET_SEQ_CTRL_STANDALONE << 8;
             }
             void reset_local_time( void )
             {
                 time_management_regs->ctrl = time_management_regs->ctrl | 0x02;  // [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_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_WTDG] = rtems_build_name( 'W', 'T', 'D', 'G' );
+                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' );
                 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 * 2,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_SEND]
                     );
                 }
-                if (status == RTEMS_SUCCESSFUL) // WTDG
+                if (status == RTEMS_SUCCESSFUL) // LINK
                 {
                     status = rtems_task_create(
-                        Task_name[TASKID_WTDG], TASK_PRIORITY_WTDG, RTEMS_MINIMUM_STACK_SIZE,
+                        Task_name[TASKID_LINK], TASK_PRIORITY_LINK, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
-                        RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_WTDG]
+                        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 * 2,
                         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 * 2,
                         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 * 2,
                         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]
                     );
                 }
                 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)     // WTDG
+                if (status == RTEMS_SUCCESSFUL)     // LINK
                 {
-                    status = rtems_task_start( Task_id[TASKID_WTDG], wtdg_task, 1 );
+                    status = rtems_task_start( Task_id[TASKID_LINK], link_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
-                        BOOT_PRINTF("in INIT *** Error starting TASK_WTDG\n")
+                        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)     // 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;
                 //****************************************
                 // 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;
                 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 = 0xffffffff;
                     ring[i].fineTime = 0xffffffff;
                     ring[i].sid = 0x00;
                     ring[i].status = 0x00;
                     ring[i].buffer_address  = (int) &buffer[ i * bufferSize ];
                 }
                 //*****
                 // NEXT
                  ring[ nbNodes - 1 ].next  = (ring_node*) &ring[ 0 ];
                  for(i=0; i<nbNodes-1; i++)
                  {
                      ring[i].next      = (ring_node*) &ring[ i + 1 ];
                  }
                 //*********
                 // PREVIOUS
                 ring[ 0 ].previous       = (ring_node*) &ring[ nbNodes - 1 ];
                 for(i=1; i<nbNodes; i++)
                 {
                     ring[i].previous   = (ring_node*) &ring[ i - 1 ];
                 }
             }

src/fsw_spacewire.c +10 -7

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

src/tc_handler.c +8 -9

             /** 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 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[6];
                 rtems_id queue_rcv_id;
                 rtems_id queue_snd_id;
                 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_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_ptr;
                 unsigned int transitionCoarseTime;
                 unsigned char * bytePosPtr;
                 bytePosPtr = (unsigned char *) &TC->packetID;
                 requestedMode = bytePosPtr[ BYTE_POS_CP_MODE_LFR_SET ];
                 transitionCoarseTime_ptr = (unsigned int *) ( &bytePosPtr[ BYTE_POS_CP_LFR_ENTER_MODE_TIME ] );
                 transitionCoarseTime = (*transitionCoarseTime_ptr) & 0x7fffffff;
                 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")
+                        PRINTF("ERR *** in action_enter_mode *** check_transition_date\n");
-                                send_tm_lfr_tc_exe_inconsistent( TC, queue_id,
+                        send_tm_lfr_tc_exe_not_executable(TC, queue_id );
-                                                                 BYTE_POS_CP_LFR_ENTER_MODE_TIME,
-                                                                 bytePosPtr[ BYTE_POS_CP_LFR_ENTER_MODE_TIME + 3 ] );
                     }
                 }
                 if ( status == LFR_SUCCESSFUL )     // the date is valid, enter the mode
                 {
                     PRINTF1("OK  *** in action_enter_mode *** enter mode %d\n", requestedMode);
                     update_last_valid_transition_date( transitionCoarseTime );
                     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;
                     }
                 }
                 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;
                 bytePosPtr = (unsigned char *) &TC->packetID;
                 // check LFR mode
                 mode = (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET5 ] & 0x1e) >> 1;
                 status = check_update_info_hk_lfr_mode( mode );
                 if (status == LFR_SUCCESSFUL)  // check TDS mode
                 {
                     mode = (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET6 ] & 0xf0) >> 4;
                     status = check_update_info_hk_tds_mode( mode );
                 }
                 if (status == LFR_SUCCESSFUL)  // check THR mode
                 {
                     mode = (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET6 ] & 0x0f);
                     status = check_update_info_hk_thr_mode( mode );
                 }
                 if (status == LFR_SUCCESSFUL)  // if the parameter check is successful
                 {
                     val = housekeeping_packet.hk_lfr_update_info_tc_cnt[0] * 256
                             + housekeeping_packet.hk_lfr_update_info_tc_cnt[1];
                     val++;
                     housekeeping_packet.hk_lfr_update_info_tc_cnt[0] = (unsigned char) (val >> 8);
                     housekeeping_packet.hk_lfr_update_info_tc_cnt[1] = (unsigned char) (val);
                 }
                 // pa_bia_status_info
                 // => pa_bia_mode_mux_set       3 bits
                 // => pa_bia_mode_hv_enabled    1 bit
                 // => pa_bia_mode_bias1_enabled 1 bit
                 // => pa_bia_mode_bias2_enabled 1 bit
                 // => pa_bia_mode_bias3_enabled 1 bit
                 // => pa_bia_on_off (cp_dpu_bias_on_off)
                 pa_bia_status_info = bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET2 ] & 0xfe; // [1111 1110]
                 pa_bia_status_info = pa_bia_status_info
                         | (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET1 ] & 0x1);
                 result = 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[0] << 24)
                         + (TC->dataAndCRC[1] << 16)
                         + (TC->dataAndCRC[2] << 8)
                         + TC->dataAndCRC[3];
                 val = housekeeping_packet.hk_lfr_update_time_tc_cnt[0] * 256
                         + housekeeping_packet.hk_lfr_update_time_tc_cnt[1];
                 val++;
                 housekeeping_packet.hk_lfr_update_time_tc_cnt[0] = (unsigned char) (val >> 8);
                 housekeeping_packet.hk_lfr_update_time_tc_cnt[1] = (unsigned char) (val);
                 return LFR_SUCCESSFUL;
             }
             //*******************
             // ENTERING THE MODES
             int check_mode_value( unsigned char requestedMode )
             {
                 int status;
                 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 )
             {
                 lastValidEnterModeTime = transitionCoarseTime;
                 PRINTF1("lastValidEnterModeTime = %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 & 0x7fffffff;
                     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 > 3 )                  // 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();
                 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 );     // clear 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()
+            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:
                     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
                     break;
                 case LFR_MODE_SBM2:
                     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
                     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
                     restart_asm_activities( LFR_MODE_SBM1 );
                     status = LFR_SUCCESSFUL;
                     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:
                     restart_asm_activities( LFR_MODE_SBM1 );
                     status = LFR_SUCCESSFUL;                // lfrCurrentMode will be updated after the execution of close_action
                     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:
                     restart_asm_activities( LFR_MODE_SBM2 );
                     status = LFR_SUCCESSFUL;                // lfrCurrentMode will be updated after the execution of close_action
                     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:
                     restart_asm_activities( LFR_MODE_SBM2 );
                     status = LFR_SUCCESSFUL;                // lfrCurrentMode will be updated after the execution of close_action
                     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[10];
                 rtems_status_code ret;
                 ret = RTEMS_SUCCESSFUL;
                 status[0] = rtems_task_restart( Task_id[TASKID_AVF0], lfrRequestedMode );
                 if (status[0] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF0 ERR %d\n", status[0])
                 }
                 status[1] = rtems_task_restart( Task_id[TASKID_PRC0], lfrRequestedMode );
                 if (status[1] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC0 ERR %d\n", status[1])
                 }
                 status[2] = rtems_task_restart( Task_id[TASKID_WFRM],1 );
                 if (status[2] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** WFRM ERR %d\n", status[2])
                 }
                 status[3] = rtems_task_restart( Task_id[TASKID_CWF3],1 );
                 if (status[3] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** CWF3 ERR %d\n", status[3])
                 }
                 status[4] = rtems_task_restart( Task_id[TASKID_CWF2],1 );
                 if (status[4] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** CWF2 ERR %d\n", status[4])
                 }
                 status[5] = rtems_task_restart( Task_id[TASKID_CWF1],1 );
                 if (status[5] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** CWF1 ERR %d\n", status[5])
                 }
                 status[6] = rtems_task_restart( Task_id[TASKID_AVF1], lfrRequestedMode );
                 if (status[6] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF1 ERR %d\n", status[6])
                 }
                 status[7] = rtems_task_restart( Task_id[TASKID_PRC1],lfrRequestedMode );
                 if (status[7] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC1 ERR %d\n", status[7])
                 }
                 status[8] = rtems_task_restart( Task_id[TASKID_AVF2], 1 );
                 if (status[8] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF2 ERR %d\n", status[8])
                 }
                 status[9] = rtems_task_restart( Task_id[TASKID_PRC2], 1 );
                 if (status[9] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC2 ERR %d\n", status[9])
                 }
                 if ( (status[0] != RTEMS_SUCCESSFUL) || (status[1] != RTEMS_SUCCESSFUL) ||
                      (status[2] != RTEMS_SUCCESSFUL) || (status[3] != RTEMS_SUCCESSFUL) ||
                      (status[4] != RTEMS_SUCCESSFUL) || (status[5] != RTEMS_SUCCESSFUL) ||
                      (status[6] != RTEMS_SUCCESSFUL) || (status[7] != RTEMS_SUCCESSFUL) ||
                      (status[8] != RTEMS_SUCCESSFUL) || (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[6];
                 rtems_status_code ret;
                 ret = RTEMS_SUCCESSFUL;
                 status[0] = rtems_task_restart( Task_id[TASKID_AVF0], lfrRequestedMode );
                 if (status[0] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF0 ERR %d\n", status[0])
                 }
                 status[1] = rtems_task_restart( Task_id[TASKID_PRC0], lfrRequestedMode );
                 if (status[1] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC0 ERR %d\n", status[1])
                 }
                 status[2] = rtems_task_restart( Task_id[TASKID_AVF1], lfrRequestedMode );
                 if (status[2] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF1 ERR %d\n", status[2])
                 }
                 status[3] = rtems_task_restart( Task_id[TASKID_PRC1],lfrRequestedMode );
                 if (status[3] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC1 ERR %d\n", status[3])
                 }
                 status[4] = rtems_task_restart( Task_id[TASKID_AVF2], 1 );
                 if (status[4] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF2 ERR %d\n", status[4])
                 }
                 status[5] = rtems_task_restart( Task_id[TASKID_PRC2], 1 );
                 if (status[5] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC2 ERR %d\n", status[5])
                 }
                 if ( (status[0] != RTEMS_SUCCESSFUL) || (status[1] != RTEMS_SUCCESSFUL) ||
                      (status[2] != RTEMS_SUCCESSFUL) || (status[3] != RTEMS_SUCCESSFUL) ||
                      (status[4] != RTEMS_SUCCESSFUL) || (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 a 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;
                 }
             }
             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 | 0x01;
                 }
                 else
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config & 0xfffffffe;   // 1110
                 }
             }
             void set_sm_irq_onError( unsigned char value )
             {
                 if (value == 1)
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config | 0x02;
                 }
                 else
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config & 0xfffffffd;   // 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 ){
                 unsigned int k;
                 unsigned short data;
                 float val;
                 float f0;
                 float f1;
                 float fs;
                 float Ts;
                 float scaleFactor;
                 f0 = 625;
                 f1 = 10000;
                 fs = 160256.410;
                 Ts = 1. / fs;
                 scaleFactor = 0.250 / 0.000654; // 191, 500 mVpp, 2 sinus waves => 500 mVpp each, amplitude = 250 mV
                 time_management_regs->calDataPtr = 0x00;
                 // build the signal for the SCM calibration
                 for (k=0; k<256; k++)
                 {
                     val = sin( 2 * pi * f0 * k * Ts )
                             + sin(  2 * pi * f1 * k * Ts );
                     data = (unsigned short) ((val * scaleFactor) + 2048);
                     time_management_regs->calData = data & 0xfff;
                 }
             }
             void setCalibrationDataInterleaved( void ){
                 unsigned int k;
                 float val;
                 float f0;
                 float f1;
                 float fs;
                 float Ts;
                 unsigned short data[384];
                 unsigned char *dataPtr;
                 f0 = 625;
                 f1 = 10000;
                 fs = 240384.615;
                 Ts = 1. / fs;
                 time_management_regs->calDataPtr = 0x00;
                 // build the signal for the SCM calibration
                 for (k=0; k<384; k++)
                 {
                     val = sin( 2 * pi * f0 * k * Ts )
                             + sin(  2 * pi * f1 * k * Ts );
                     data[k] = (unsigned short) (val * 512 + 2048);
                 }
                 // write the signal in interleaved mode
                 for (k=0; k<128; k++)
                 {
                     dataPtr = (unsigned char*) &data[k*3 + 2];
                     time_management_regs->calData = (data[k*3] & 0xfff)
                             + ( (dataPtr[0] & 0x3f) << 12);
                     time_management_regs->calData = (data[k*3 + 1] & 0xfff)
                             + ( (dataPtr[1] & 0x3f) << 12);
                 }
             }
             void setCalibrationReload( bool state)
             {
                 if (state == true)
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl | 0x00000010;   // [0001 0000]
                 }
                 else
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl & 0xffffffef;   // [1110 1111]
                 }
             }
             void setCalibrationEnable( bool state )
             {
                 // this bit drives the multiplexer
                 if (state == true)
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl | 0x00000040;   // [0100 0000]
                 }
                 else
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl & 0xffffffbf; // [1011 1111]
                 }
             }
             void setCalibrationInterleaved( bool state )
             {
                 // this bit drives the multiplexer
                 if (state == true)
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl | 0x00000020;   // [0010 0000]
                 }
                 else
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl & 0xffffffdf; // [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(  26 );   //          => 240 384
                     setCalibrationDataInterleaved();
                 }
                 else
                 {
                     setCalibrationPrescaler( 0 );   // 25 MHz   => 25 000 000
                     setCalibrationDivisor(  38 );   //          => 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] = 0x00;
                 housekeeping_packet.hk_lfr_last_exe_tc_type[1] = TC->serviceType;
                 housekeeping_packet.hk_lfr_last_exe_tc_subtype[0] = 0x00;
                 housekeeping_packet.hk_lfr_last_exe_tc_subtype[1] = TC->serviceSubType;
                 housekeeping_packet.hk_lfr_last_exe_tc_time[0] = time[0];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[1] = time[1];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[2] = time[2];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[3] = time[3];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[4] = time[4];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[5] = time[5];
                 val = housekeeping_packet.hk_lfr_exe_tc_cnt[0] * 256 + housekeeping_packet.hk_lfr_exe_tc_cnt[1];
                 val++;
                 housekeeping_packet.hk_lfr_exe_tc_cnt[0] = (unsigned char) (val >> 8);
                 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] = 0x00;
                 housekeeping_packet.hk_lfr_last_rej_tc_type[1] = TC->serviceType;
                 housekeeping_packet.hk_lfr_last_rej_tc_subtype[0] = 0x00;
                 housekeeping_packet.hk_lfr_last_rej_tc_subtype[1] = TC->serviceSubType;
                 housekeeping_packet.hk_lfr_last_rej_tc_time[0] = time[0];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[1] = time[1];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[2] = time[2];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[3] = time[3];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[4] = time[4];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[5] = time[5];
                 val = housekeeping_packet.hk_lfr_rej_tc_cnt[0] * 256 + housekeeping_packet.hk_lfr_rej_tc_cnt[1];
                 val++;
                 housekeeping_packet.hk_lfr_rej_tc_cnt[0] = (unsigned char) (val >> 8);
                 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];
-                        housekeeping_packet.lfr_status_word[0] = (unsigned char) ((requestedMode << 4) + 0x0d);
+                        updateLFRCurrentMode( requestedMode );
-                        updateLFRCurrentMode();
                     }
                 }
                 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()
+            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
-                lfrCurrentMode = (housekeeping_packet.lfr_status_word[0] & 0xf0) >> 4;
+                housekeeping_packet.lfr_status_word[0] = (unsigned char) ((requestedMode << 4) + 0x0d);
+                lfrCurrentMode = requestedMode;
             }
             void set_lfr_soft_reset( unsigned char value )
             {
                 if (value == 1)
                 {
                     time_management_regs->ctrl = time_management_regs->ctrl | 0x00000004; // [0100]
                 }
                 else
                 {
                     time_management_regs->ctrl = time_management_regs->ctrl & 0xfffffffb; // [1011]
                 }
             }
             void reset_lfr( void )
             {
                 set_lfr_soft_reset( 1 );
                 set_lfr_soft_reset( 0 );
                 set_hk_lfr_sc_potential_flag( true );
             }

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