HG_REPOSITORIES/LPP/INSTRUMENTATION/USERS/JEANDET/LFR_FSW Commit - r196:48fc5efcfe9b

TM_LFR_SCIENCE_NORMA_ASM_ packets modified, 32 bits values instead of 16 bits...

paul -

r196:48fc5efcfe9b R3

parent child

Context file:

r196:48fc5efcfe9b

Collapse all files

.hgsubstate +1 -1

@@ -1,2 +1,2
1	a586fe639ac179e95bdc150ebdbab0312f31dc30 LFR_basic-parameters	1	a586fe639ac179e95bdc150ebdbab0312f31dc30 LFR_basic-parameters
2	a806a190dcd72f71d336545073400d3cdaaa3119 header/lfr_common_headers	2	72c4d5eb0bb95a1546beb2b22c8b88c31322ae31 header/lfr_common_headers

FSW-qt/fsw-qt.pro +1 -1

             TEMPLATE = app
             # CONFIG += console v8 sim
             # CONFIG options = verbose *** boot_messages *** debug_messages *** cpu_usage_report *** stack_report *** vhdl_dev *** debug_tch
             # lpp_dpu_destid
-            CONFIG += console verbose lpp_dpu_destid
+            CONFIG += console verbose lpp_dpu_destid cpu_usage_report
             CONFIG -= qt
             include(./sparc.pri)
             # flight software version
             SWVERSION=-1-0
             DEFINES += SW_VERSION_N1=3 # major
             DEFINES += SW_VERSION_N2=0 # minor
             DEFINES += SW_VERSION_N3=0 # patch
             DEFINES += SW_VERSION_N4=0 # internal
             # <GCOV>
             #QMAKE_CFLAGS_RELEASE += -fprofile-arcs -ftest-coverage
             #LIBS += -lgcov /opt/GCOV/01A/lib/overload.o -lc
             # </GCOV>
             # <CHANGE BEFORE FLIGHT>
             contains( CONFIG, lpp_dpu_destid ) {
                 DEFINES += LPP_DPU_DESTID
             }
             # </CHANGE BEFORE FLIGHT>
             contains( CONFIG, debug_tch ) {
                 DEFINES += DEBUG_TCH
             }
             DEFINES += MSB_FIRST_TCH
             contains( CONFIG, vhdl_dev ) {
                 DEFINES += VHDL_DEV
             }
             contains( CONFIG, verbose ) {
                 DEFINES += PRINT_MESSAGES_ON_CONSOLE
             }
             contains( CONFIG, debug_messages ) {
                 DEFINES += DEBUG_MESSAGES
             }
             contains( CONFIG, cpu_usage_report ) {
                 DEFINES += PRINT_TASK_STATISTICS
             }
             contains( CONFIG, stack_report ) {
                 DEFINES += PRINT_STACK_REPORT
             }
             contains( CONFIG, boot_messages ) {
                 DEFINES += BOOT_MESSAGES
             }
             #doxygen.target = doxygen
             #doxygen.commands = doxygen ../doc/Doxyfile
             #QMAKE_EXTRA_TARGETS += doxygen
             TARGET = fsw
             INCLUDEPATH += \
                 $${PWD}/../src \
                 $${PWD}/../header \
                 $${PWD}/../header/lfr_common_headers \
                 $${PWD}/../header/processing \
                 $${PWD}/../LFR_basic-parameters
             SOURCES += \
                 ../src/wf_handler.c \
                 ../src/tc_handler.c \
                 ../src/fsw_misc.c \
                 ../src/fsw_init.c \
                 ../src/fsw_globals.c \
                 ../src/fsw_spacewire.c \
                 ../src/tc_load_dump_parameters.c \
                 ../src/tm_lfr_tc_exe.c \
                 ../src/tc_acceptance.c \
                 ../src/processing/fsw_processing.c \
                 ../src/processing/avf0_prc0.c \
                 ../src/processing/avf1_prc1.c \
                 ../src/processing/avf2_prc2.c \
                 ../src/lfr_cpu_usage_report.c \
                 ../LFR_basic-parameters/basic_parameters.c
             HEADERS += \
                 ../header/wf_handler.h \
                 ../header/tc_handler.h \
                 ../header/grlib_regs.h \
                 ../header/fsw_misc.h \
                 ../header/fsw_init.h \
                 ../header/fsw_spacewire.h \
                 ../header/tc_load_dump_parameters.h \
                 ../header/tm_lfr_tc_exe.h \
                 ../header/tc_acceptance.h \
                 ../header/processing/fsw_processing.h \
                 ../header/processing/avf0_prc0.h \
                 ../header/processing/avf1_prc1.h \
                 ../header/processing/avf2_prc2.h \
                 ../header/fsw_params_wf_handler.h \
                 ../header/lfr_cpu_usage_report.h \
                 ../header/lfr_common_headers/ccsds_types.h \
                 ../header/lfr_common_headers/fsw_params.h \
                 ../header/lfr_common_headers/fsw_params_nb_bytes.h \
                 ../header/lfr_common_headers/fsw_params_processing.h \
                 ../header/lfr_common_headers/TC_types.h \
                 ../header/lfr_common_headers/tm_byte_positions.h \
                 ../LFR_basic-parameters/basic_parameters.h \
                 ../LFR_basic-parameters/basic_parameters_params.h \
                 ../header/GscMemoryLPP.hpp

header/GscMemoryLPP.hpp +7 0

             #ifndef GSCMEMORY_HPP_
             #define GSCMEMORY_HPP_
             #ifndef LEON3
             #define LEON3
             #endif
             static unsigned int getCacheControlRegister(){
             #ifdef LEON3
                 unsigned int cacheControlRegister = 0;
                 __asm__ __volatile__("lda [%%g0] 2, %0" : "=r"(cacheControlRegister) : );
                 return cacheControlRegister;
             #endif
             }
             static void setCacheControlRegister(unsigned int cacheControlRegister)
             {
             #ifdef LEON3
                 __asm__ __volatile__("sta %0, [%%g0] 2" : : "r"(cacheControlRegister));
             #endif
             }
             /**
             * Flush the data cache and the instruction cache.
             *
             * @return
             */
             static inline void flushCache() {
                 asm("flush");
             }
+            static void resetCacheControlRegister() {
+            #ifdef LEON3
+                unsigned int cacheControlRegister;
+                cacheControlRegister = 0x00;
+                setCacheControlRegister(cacheControlRegister);
+            #endif
+            }
             static void enableInstructionCache() {
             #ifdef LEON3
                 unsigned int cacheControlRegister;
                 cacheControlRegister = getCacheControlRegister();
                 cacheControlRegister = (cacheControlRegister | 0x3);
                 setCacheControlRegister(cacheControlRegister);
             #endif
             }
             static void enableDataCache() {
             #ifdef LEON3
                 unsigned int cacheControlRegister;
                 cacheControlRegister = getCacheControlRegister();
                 cacheControlRegister = (cacheControlRegister | 0xc);
                 setCacheControlRegister(cacheControlRegister);
             #endif
             }
             static void enableInstructionBurstFetch() {
             #ifdef LEON3
                 unsigned int cacheControlRegister;
                 cacheControlRegister = getCacheControlRegister();
                 // set the bit IB to 1
                 cacheControlRegister = (cacheControlRegister | 0x10000);
                 setCacheControlRegister(cacheControlRegister);
             #endif
             }
             #endif /* GSCMEMORY_HPP_ */

header/fsw_spacewire.h +3 -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"
             extern spw_stats spacewire_stats;
             extern spw_stats spacewire_stats_backup;
             // 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 );
             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_reset_link( 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 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( ring_node *ring_node_to_send, Header_TM_LFR_SCIENCE_ASM_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 );
             void timecode_irq_handler( void *pDev, void *regs, int minor, unsigned int tc );
             rtems_timer_service_routine user_routine( rtems_id timer_id, void *user_data );
             void (*grspw_timecode_callback) ( void *pDev, void *regs, int minor, unsigned int tc );
             #endif // FSW_SPACEWIRE_H_INCLUDED

python_scripts/LFRControlPlugin_reload_fsw.py +1 -1

             # LOAD FSW USING LINK 1
-            SpwPlugin0.StarDundeeSelectLinkNumber( 2 )
+            SpwPlugin0.StarDundeeSelectLinkNumber( 1 )
             dsu3plugin0.openFile("/opt/DEV_PLE/FSW-qt/bin/fsw")
             #dsu3plugin0.openFile("/opt/LFR/LFR-FSW/2.0.2.3/fsw")
             dsu3plugin0.loadFile()
             dsu3plugin0.run()
             # START SENDING TIMECODES AT 1 Hz
             SpwPlugin0.StarDundeeStartTimecodes( 1 )
             # it is possible to change the time code frequency
             #RMAPPlugin0.changeTimecodeFrequency(2)

src/fsw_config.c +1 -1

             #include <drvmgr/ambapp_bus.h>
             // GRSPW0 resources
             struct drvmgr_key grlib_grspw_0n1_res[] = {
                 {"txBdCnt", KEY_TYPE_INT, {(unsigned int)50}}, // 7 SWF_F0, 7 SWF_F1, 7 SWF_F2, 7 CWF_F3, 7 CWF_F1 ou 7 CWF_F2
                 	{"rxBdCnt", KEY_TYPE_INT, {(unsigned int)10}},
                 	{"txDataSize", KEY_TYPE_INT, {(unsigned int)4096}},
-                	{"txHdrSize", KEY_TYPE_INT, {(unsigned int)20+12}}, // 12 is for the auxiliary header, when needed
+                    {"txHdrSize", KEY_TYPE_INT, {(unsigned int)34}},
                 	{"rxPktSize", KEY_TYPE_INT, {(unsigned int)248+4}},
                 	KEY_EMPTY
             };
             // If RTEMS_DRVMGR_STARTUP is defined we override the "weak defaults" that is defined by the LEON3 BSP.
             struct drvmgr_bus_res grlib_drv_resources = {
                 .next = NULL,
                 .resource = {
                     {DRIVER_AMBAPP_GAISLER_GRSPW_ID, 0, &grlib_grspw_0n1_res[0]},
             //        {DRIVER_AMBAPP_GAISLER_APBUART_ID, 0, &grlib_drv_res_apbuart0[0]},
             //        {DRIVER_AMBAPP_GAISLER_APBUART_ID, 1, &grlib_drv_res_apbuart1[0]},
                     RES_EMPTY /* Mark end of device resource array */
                 }
             };

src/fsw_init.c +8 -6

             /** 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  // STAT (1s), send SWF (0.3s), send CWF3 (1s)
             #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"
             void initCache()
             {
-            //    unsigned int cacheControlRegister;
+                unsigned int cacheControlRegister;
-            //    cacheControlRegister = getCacheControlRegister();
+                cacheControlRegister = getCacheControlRegister();
-            //    printf("(0) cacheControlRegister = %x\n", cacheControlRegister);
+                printf("(0) cacheControlRegister = %x\n", cacheControlRegister);
+                resetCacheControlRegister();
                 enableInstructionCache();
                 enableDataCache();
                 enableInstructionBurstFetch();
-            //    cacheControlRegister = getCacheControlRegister();
+                cacheControlRegister = getCacheControlRegister();
-            //    printf("(1) cacheControlRegister = %x\n", cacheControlRegister);
+                printf("(1) cacheControlRegister = %x\n", cacheControlRegister);
             }
             rtems_task Init( rtems_task_argument ignored )
             {
-                /** This is the RTEMS INIT taks, it the first task launched by the system.
+                /** 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
                 send_console_outputs_on_apbuart_port();
                 set_apbuart_scaler_reload_register(REGS_ADDR_APBUART, APBUART_SCALER_RELOAD_VALUE);
                 enable_apbuart_transmitter();
                 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_f0();
                 init_k_coefficients_f1();
                 init_k_coefficients_f2();
                 // waveform picker initialization
                 WFP_init_rings();      // 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();
                 BOOT_PRINTF1("in INIT *** lfrCurrentMode is %d\n", lfrCurrentMode)
                 create_names();                             // create all names
                 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)
                 }
                 //******************************
                 // <SPECTRAL MATRICES SIMULATOR>
                 LEON_Mask_interrupt( IRQ_SM_SIMULATOR );
                 configure_timer((gptimer_regs_t*) REGS_ADDR_GPTIMER, TIMER_SM_SIMULATOR, CLKDIV_SM_SIMULATOR,
                                 IRQ_SPARC_SM_SIMULATOR, spectral_matrices_isr_simu );
                 // </SPECTRAL MATRICES SIMULATOR>
                 //*******************************
                 // 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")
                 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_SCIENCE_NORMAL_BURST = 0x00;
                 sequenceCounters_SCIENCE_SBM1_SBM2 =    0x00;
                 sequenceCounterHK =                     TM_PACKET_SEQ_CTRL_STANDALONE << 8;
                 sequenceCounterParameterDump =          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_STAT] = rtems_build_name( 'S', 'T', 'A', 'T' );
                 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_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' );
             }
             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
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_WTDG], TASK_PRIORITY_WTDG, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_WTDG]
                     );
                 }
                 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) // STAT
                 {
                     status = rtems_task_create(
                         Task_name[TASKID_STAT], TASK_PRIORITY_STAT, RTEMS_MINIMUM_STACK_SIZE,
                         RTEMS_DEFAULT_MODES,
                         RTEMS_DEFAULT_ATTRIBUTES, &Task_id[TASKID_STAT]
                     );
                 }
                 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
                 {
                     status = rtems_task_start( Task_id[TASKID_WTDG], wtdg_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_WTDG\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)     // STAT
                 {
                     status = rtems_task_start( Task_id[TASKID_STAT], stat_task, 1 );
                     if (status!=RTEMS_SUCCESSFUL) {
                         BOOT_PRINTF("in INIT *** Error starting TASK_STAT\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 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;
             }

src/fsw_spacewire.c +182 -43

             /** 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;
             //***********
             // 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_reset_link( );
                     }
                     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_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 = stop_current_mode();
                         if ( status != RTEMS_SUCCESSFUL ) {
                             PRINTF1("in SPIQ *** ERR stop_current_mode *** code %d\n", status)
                         }
                         status = enter_mode( LFR_MODE_STANDBY, 0 );
                         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 );
                         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);
                             }
                         }
                     }
                 }
             }
             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
                 u_int32_t count;
                 rtems_id queue_id;
                 unsigned int sid;
                 incomingRingNodePtr = NULL;
                 ring_node_address = 0;
                 charPtr = (char *) &ring_node_address;
                 sid = 0;
                 init_header_cwf( &headerCWF );
                 init_header_swf( &headerSWF );
                 init_header_asm( &headerASM );
                 status =  get_message_queue_id_send( &queue_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in HOUS *** ERR get_message_queue_id_send %d\n", status)
                 }
                 BOOT_PRINTF("in SEND *** \n")
                 while(1)
                 {
                     status = rtems_message_queue_receive( queue_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) || (sid==SID_NORM_ASM_F1) || (sid==SID_NORM_ASM_F2) )
+                            else if (sid==SID_NORM_ASM_F0)
+                            {
+                                spw_send_asm_f0( incomingRingNodePtr, &headerASM );
+                            }
+                            else if (sid==SID_NORM_ASM_F1)
                             {
-                                spw_send_asm( incomingRingNodePtr, &headerASM );
+                                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
                             {
                                 printf("unexpected sid = %d\n", sid);
                             }
                         }
                         else if ( incomingData[0] == CCSDS_DESTINATION_ID ) // the incoming message is a ccsds packet
                         {
                             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){
                                 printf("size = %d, %x, %x, %x, %x, %x\n",
                                        size,
                                        incomingData[0],
                                         incomingData[1],
                                         incomingData[2],
                                         incomingData[3],
                                         incomingData[4]);
                                 PRINTF2("in SEND *** (2.b) ERRNO = %d, RTEMS = %d\n", errno, status)
                             }
                         }
                     }
                     status = rtems_message_queue_get_number_pending( queue_id, &count );
                     if (status != RTEMS_SUCCESSFUL)
                     {
                         PRINTF1("in SEND *** (3) ERR = %d\n", status)
                     }
                     else
                     {
                         if (count > maxCount)
                         {
                             maxCount = count;
                         }
                     }
                 }
             }
             rtems_task wtdg_task( rtems_task_argument argument )
             {
                 rtems_event_set event_out;
                 rtems_status_code status;
                 int linkStatus;
                 BOOT_PRINTF("in WTDG ***\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")
                     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)
                     }
                     else
                     {
                         PRINTF("in WTDG *** 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_reset_link( 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 timecode_irq_handler( void *pDev, void *regs, int minor, unsigned int tc )
             {
                 // a valid timecode has been received, write it in the HK report
                 unsigned int * grspwPtr;
                 grspwPtr = (unsigned int *) (REGS_ADDR_GRSPW + APB_OFFSET_GRSPW_TIME_REGISTER);
                 housekeeping_packet.hk_lfr_dpu_spw_last_timc = (unsigned char) (grspwPtr[0] & 0xff);   // [11 1111]
                 // update the number of valid timecodes that have been received
                 if (housekeeping_packet.hk_lfr_dpu_spw_tick_out_cnt == 255)
                 {
                     housekeeping_packet.hk_lfr_dpu_spw_tick_out_cnt = 0;
                 }
                 else
                 {
                     housekeeping_packet.hk_lfr_dpu_spw_tick_out_cnt = housekeeping_packet.hk_lfr_dpu_spw_tick_out_cnt + 1;
                 }
             }
             rtems_timer_service_routine user_routine( rtems_id timer_id, void *user_data )
             {
                 int linkStatus;
                 rtems_status_code status;
                 status = ioctl(fdSPW, SPACEWIRE_IOCTRL_GET_LINK_STATUS, &linkStatus);   // get the link status
                 if ( linkStatus == 5) {
                     PRINTF("in spacewire_reset_link *** link is running\n")
                     status = RTEMS_SUCCESSFUL;
                 }
             }
             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_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->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 = TM_HEADER_LEN + 4 + 10; // + 4 is for the protocole extra header, + 10 is for the auxiliary header
+                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->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) {
                         printf("%d-%d, ERR %d\n", sid, i, (int) status);
                         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 = TM_HEADER_LEN + 4 + 12; // + 4 is for the protocole extra header, + 12 is for the auxiliary header
+                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->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) {
                         printf("%d-%d, ERR %d\n", sid, i, (int) status);
                         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 = TM_HEADER_LEN + 4 + 10; // + 4 is for the protocole extra header, + 10 is for the auxiliary header
+                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->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) {
                         printf("%d-%d, ERR %d\n", sid, i, (int) status);
                         ret = LFR_DEFAULT;
                     }
                 }
                 return ret;
             }
-            void spw_send_asm( ring_node *ring_node_to_send,
+            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;
-                char *spectral_matrix;
+                float *spectral_matrix;
                 int coarseTime;
                 int fineTime;
                 spw_ioctl_pkt_send spw_ioctl_send_ASM;
                 sid = ring_node_to_send->sid;
-                spectral_matrix = (char*) ring_node_to_send->buffer_address;
+                spectral_matrix = (float*) ring_node_to_send->buffer_address;
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
-                for (i=0; i<2; i++)
+                for (i=0; i<3; i++)
                 {
-                    // (1) BUILD THE DATA
+                    if ((i==0) || (i==1))
-                    switch(sid)
                     {
-                    case SID_NORM_ASM_F0:
+                        spw_ioctl_send_ASM.dlen = DLEN_ASM_F0_PKT_1;
-                        spw_ioctl_send_ASM.dlen = TOTAL_SIZE_ASM_F0_IN_BYTES / 2;  // 2 packets will be sent
+                        spw_ioctl_send_ASM.data = (char *) &spectral_matrix[
-                        spw_ioctl_send_ASM.data = &spectral_matrix[
+                                ( (ASM_F0_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F0_1) ) * NB_VALUES_PER_SM )
-                                ( (ASM_F0_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F0) ) * NB_VALUES_PER_SM ) * 2
-                                ];
-                        length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F0;
-                        header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
-                        header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F0) >> 8 ); // BLK_NR MSB
-                        header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F0);        // BLK_NR LSB
-                        break;
-                    case SID_NORM_ASM_F1:
-                        spw_ioctl_send_ASM.dlen = TOTAL_SIZE_ASM_F1_IN_BYTES / 2;  // 2 packets will be sent
-                        spw_ioctl_send_ASM.data = &spectral_matrix[
-                                ( (ASM_F1_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F1) ) * NB_VALUES_PER_SM ) * 2
                                 ];
-                        length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F1;
+                        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_F1) >> 8 ); // BLK_NR MSB
+                        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_F1);        // BLK_NR LSB
+                        header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F0_1);        // BLK_NR LSB
-                        break;
-                    case SID_NORM_ASM_F2:
+                    else
-                        spw_ioctl_send_ASM.dlen = TOTAL_SIZE_ASM_F2_IN_BYTES / 2;  // 2 packets will be sent
-                        spw_ioctl_send_ASM.data = &spectral_matrix[
+                        spw_ioctl_send_ASM.dlen = DLEN_ASM_F0_PKT_2;
-                                ( (ASM_F2_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F2) ) * NB_VALUES_PER_SM ) * 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_F2;
+                        length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F0_2;
-                        header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_3;
+                        header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
-                        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[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_F2);        // BLK_NR LSB
+                        header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F0_2);        // BLK_NR LSB
-                        break;
-                    default:
-                        PRINTF1("ERR *** in spw_send_asm *** unexpected sid %d\n", sid)
-                        break;
                     }
-                    spw_ioctl_send_ASM.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_ASM + CCSDS_PROTOCOLE_EXTRA_BYTES;
+                    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 = 2;
+                    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) {
+                        printf("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->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) {
+                        printf("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->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) {
                         printf("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;
                 printf("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/processing/avf0_prc0.c +1 -3

             /** Functions related to data processing.
              *
              * @file
              * @author P. LEROY
              *
              * These function are related to data processing, i.e. spectral matrices averaging and basic parameters computation.
              *
              */
             #include "avf0_prc0.h"
             #include "fsw_processing.h"
             nb_sm_before_bp_asm_f0 nb_sm_before_f0;
             //***
             // F0
             ring_node_asm asm_ring_norm_f0      [ NB_RING_NODES_ASM_NORM_F0      ];
             ring_node_asm asm_ring_burst_sbm_f0 [ NB_RING_NODES_ASM_BURST_SBM_F0 ];
             ring_node ring_to_send_asm_f0       [ NB_RING_NODES_ASM_F0 ];
             int buffer_asm_f0                   [ NB_RING_NODES_ASM_F0 * TOTAL_SIZE_SM ];
             float asm_f0_patched_norm       [ TOTAL_SIZE_SM ];
             float asm_f0_patched_burst_sbm  [ TOTAL_SIZE_SM ];
             float asm_f0_reorganized        [ TOTAL_SIZE_SM ];
             char  asm_f0_char          [ TIME_OFFSET_IN_BYTES + (TOTAL_SIZE_SM * 2) ];
             float compressed_sm_norm_f0[ TOTAL_SIZE_COMPRESSED_ASM_NORM_F0];
             float compressed_sm_sbm_f0 [ TOTAL_SIZE_COMPRESSED_ASM_SBM_F0 ];
             float k_coeff_intercalib_f0_norm[ NB_BINS_COMPRESSED_SM_F0     * NB_K_COEFF_PER_BIN ];  // 11 * 32 = 352
             float k_coeff_intercalib_f0_sbm[  NB_BINS_COMPRESSED_SM_SBM_F0 * NB_K_COEFF_PER_BIN ];  // 22 * 32 = 704
             //************
             // RTEMS TASKS
             rtems_task avf0_task( rtems_task_argument lfrRequestedMode )
             {
                 int i;
                 rtems_event_set event_out;
                 rtems_status_code status;
                 rtems_id queue_id_prc0;
                 asm_msg msgForMATR;
                 ring_node *nodeForAveraging;
                 ring_node *ring_node_tab[8];
                 ring_node_asm *current_ring_node_asm_burst_sbm_f0;
                 ring_node_asm *current_ring_node_asm_norm_f0;
                 unsigned int nb_norm_bp1;
                 unsigned int nb_norm_bp2;
                 unsigned int nb_norm_asm;
                 unsigned int nb_sbm_bp1;
                 unsigned int nb_sbm_bp2;
                 nb_norm_bp1 = 0;
                 nb_norm_bp2 = 0;
                 nb_norm_asm = 0;
                 nb_sbm_bp1  = 0;
                 nb_sbm_bp2  = 0;
                 reset_nb_sm_f0( lfrRequestedMode );   // reset the sm counters that drive the BP and ASM computations / transmissions
                 ASM_generic_init_ring( asm_ring_norm_f0,      NB_RING_NODES_ASM_NORM_F0      );
                 ASM_generic_init_ring( asm_ring_burst_sbm_f0, NB_RING_NODES_ASM_BURST_SBM_F0 );
                 current_ring_node_asm_norm_f0      = asm_ring_norm_f0;
                 current_ring_node_asm_burst_sbm_f0 = asm_ring_burst_sbm_f0;
                 BOOT_PRINTF1("in AVFO *** lfrRequestedMode = %d\n", (int) lfrRequestedMode)
                 status = get_message_queue_id_prc0( &queue_id_prc0 );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in MATR *** ERR get_message_queue_id_prc0 %d\n", status)
                 }
                 while(1){
                     rtems_event_receive(RTEMS_EVENT_0, RTEMS_WAIT, RTEMS_NO_TIMEOUT, &event_out); // wait for an RTEMS_EVENT0
                     //****************************************
                     // initialize the mesage for the MATR task
                     msgForMATR.norm       = current_ring_node_asm_norm_f0;
                     msgForMATR.burst_sbm  = current_ring_node_asm_burst_sbm_f0;
                     msgForMATR.event      = 0x00;  // this composite event will be sent to the PRC0 task
                     //
                     //****************************************
                     nodeForAveraging = getRingNodeForAveraging( 0 );
                     ring_node_tab[NB_SM_BEFORE_AVF0-1] = nodeForAveraging;
                     for ( i = 2; i < (NB_SM_BEFORE_AVF0+1); i++ )
                     {
                         nodeForAveraging = nodeForAveraging->previous;
                         ring_node_tab[NB_SM_BEFORE_AVF0-i] = nodeForAveraging;
                     }
                     // compute the average and store it in the averaged_sm_f1 buffer
                     SM_average( current_ring_node_asm_norm_f0->matrix,
                                 current_ring_node_asm_burst_sbm_f0->matrix,
                                 ring_node_tab,
                                 nb_norm_bp1, nb_sbm_bp1,
                                 &msgForMATR );
                     // update nb_average
                     nb_norm_bp1 = nb_norm_bp1 + NB_SM_BEFORE_AVF0;
                     nb_norm_bp2 = nb_norm_bp2 + NB_SM_BEFORE_AVF0;
                     nb_norm_asm = nb_norm_asm + NB_SM_BEFORE_AVF0;
                     nb_sbm_bp1  = nb_sbm_bp1  + NB_SM_BEFORE_AVF0;
                     nb_sbm_bp2  = nb_sbm_bp2  + NB_SM_BEFORE_AVF0;
                     if (nb_sbm_bp1 == nb_sm_before_f0.burst_sbm_bp1)
                     {
                         nb_sbm_bp1 = 0;
                         // set another ring for the ASM storage
                         current_ring_node_asm_burst_sbm_f0 = current_ring_node_asm_burst_sbm_f0->next;
                         if ( lfrCurrentMode == LFR_MODE_BURST )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_BURST_BP1_F0;
                         }
                         else if ( (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_SBM_BP1_F0;
                         }
                     }
                     if (nb_sbm_bp2 == nb_sm_before_f0.burst_sbm_bp2)
                     {
                         nb_sbm_bp2 = 0;
                         if ( lfrCurrentMode == LFR_MODE_BURST )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_BURST_BP2_F0;
                         }
                         else if ( (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_SBM_BP2_F0;
                         }
                     }
                     if (nb_norm_bp1 == nb_sm_before_f0.norm_bp1)
                     {
                         nb_norm_bp1 = 0;
                         // set another ring for the ASM storage
                         current_ring_node_asm_norm_f0 = current_ring_node_asm_norm_f0->next;
                         if ( (lfrCurrentMode == LFR_MODE_NORMAL)
                              || (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP1_F0;
                         }
                     }
                     if (nb_norm_bp2 == nb_sm_before_f0.norm_bp2)
                     {
                         nb_norm_bp2 = 0;
                         if ( (lfrCurrentMode == LFR_MODE_NORMAL)
                              || (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP2_F0;
                         }
                     }
                     if (nb_norm_asm == nb_sm_before_f0.norm_asm)
                     {
                         nb_norm_asm = 0;
                         if ( (lfrCurrentMode == LFR_MODE_NORMAL)
                              || (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_ASM_F0;
                         }
                     }
                     //*************************
                     // send the message to MATR
                     if (msgForMATR.event != 0x00)
                     {
                         status =  rtems_message_queue_send( queue_id_prc0, (char *) &msgForMATR, MSG_QUEUE_SIZE_PRC0);
                     }
                     if (status != RTEMS_SUCCESSFUL) {
                         printf("in AVF0 *** Error sending message to MATR, code %d\n", status);
                     }
                 }
             }
             rtems_task prc0_task( rtems_task_argument lfrRequestedMode )
             {
                 char incomingData[MSG_QUEUE_SIZE_SEND];  // incoming data buffer
                 size_t size;                            // size of the incoming TC packet
                 asm_msg *incomingMsg;
                 //
                 unsigned char sid;
                 rtems_status_code status;
                 rtems_id queue_id;
                 rtems_id queue_id_q_p0;
                 bp_packet_with_spare    packet_norm_bp1;
                 bp_packet               packet_norm_bp2;
                 bp_packet               packet_sbm_bp1;
                 bp_packet               packet_sbm_bp2;
                 ring_node               *current_ring_node_to_send_asm_f0;
                 // init the ring of the averaged spectral matrices which will be transmitted to the DPU
                 init_ring( ring_to_send_asm_f0, NB_RING_NODES_ASM_F0, (volatile int*) buffer_asm_f0, TOTAL_SIZE_SM );
                 current_ring_node_to_send_asm_f0 = ring_to_send_asm_f0;
                 //*************
                 // NORM headers
                 BP_init_header_with_spare( &packet_norm_bp1,
                                            APID_TM_SCIENCE_NORMAL_BURST, SID_NORM_BP1_F0,
                                            PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP1_F0, NB_BINS_COMPRESSED_SM_F0 );
                 BP_init_header( &packet_norm_bp2,
                                 APID_TM_SCIENCE_NORMAL_BURST, SID_NORM_BP2_F0,
                                 PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F0, NB_BINS_COMPRESSED_SM_F0);
                 //****************************
                 // BURST SBM1 and SBM2 headers
                 if ( lfrRequestedMode == LFR_MODE_BURST )
                 {
                     BP_init_header( &packet_sbm_bp1,
                                     APID_TM_SCIENCE_NORMAL_BURST, SID_BURST_BP1_F0,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F0, NB_BINS_COMPRESSED_SM_SBM_F0);
                     BP_init_header( &packet_sbm_bp2,
                                     APID_TM_SCIENCE_NORMAL_BURST, SID_BURST_BP2_F0,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F0, NB_BINS_COMPRESSED_SM_SBM_F0);
                 }
                 else if ( lfrRequestedMode == LFR_MODE_SBM1 )
                 {
                     BP_init_header( &packet_sbm_bp1,
                                     APID_TM_SCIENCE_SBM1_SBM2, SID_SBM1_BP1_F0,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F0, NB_BINS_COMPRESSED_SM_SBM_F0);
                     BP_init_header( &packet_sbm_bp2,
                                     APID_TM_SCIENCE_SBM1_SBM2, SID_SBM1_BP2_F0,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F0, NB_BINS_COMPRESSED_SM_SBM_F0);
                 }
                 else if ( lfrRequestedMode == LFR_MODE_SBM2 )
                 {
                     BP_init_header( &packet_sbm_bp1,
                                     APID_TM_SCIENCE_SBM1_SBM2, SID_SBM2_BP1_F0,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F0, NB_BINS_COMPRESSED_SM_SBM_F0);
                     BP_init_header( &packet_sbm_bp2,
                                     APID_TM_SCIENCE_SBM1_SBM2, SID_SBM2_BP2_F0,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F0, NB_BINS_COMPRESSED_SM_SBM_F0);
                 }
                 else
                 {
                     PRINTF1("in PRC0 *** lfrRequestedMode is %d, several headers not initialized\n", (unsigned int) lfrRequestedMode)
                 }
                 status =  get_message_queue_id_send( &queue_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in PRC0 *** ERR get_message_queue_id_send %d\n", status)
                 }
                 status = get_message_queue_id_prc0( &queue_id_q_p0);
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in PRC0 *** ERR get_message_queue_id_prc0 %d\n", status)
                 }
                 BOOT_PRINTF1("in PRC0 *** lfrRequestedMode = %d\n", (int) lfrRequestedMode)
                 while(1){
                     status = rtems_message_queue_receive( queue_id_q_p0, incomingData, &size, //************************************
                                                          RTEMS_WAIT, RTEMS_NO_TIMEOUT );      // wait for a message coming from AVF0
                     incomingMsg = (asm_msg*) incomingData;
                     ASM_patch( incomingMsg->norm->matrix,      asm_f0_patched_norm      );
                     ASM_patch( incomingMsg->burst_sbm->matrix, asm_f0_patched_burst_sbm );
                     //****************
                     //****************
                     // BURST SBM1 SBM2
                     //****************
                     //****************
                     if ( (incomingMsg->event & RTEMS_EVENT_BURST_BP1_F0 ) || (incomingMsg->event & RTEMS_EVENT_SBM_BP1_F0 ) )
                     {
                         sid = getSID( incomingMsg->event );
                         // 1)  compress the matrix for Basic Parameters calculation
                         ASM_compress_reorganize_and_divide( asm_f0_patched_burst_sbm, compressed_sm_sbm_f0,
                                                      nb_sm_before_f0.burst_sbm_bp1,
                                                      NB_BINS_COMPRESSED_SM_SBM_F0, NB_BINS_TO_AVERAGE_ASM_SBM_F0,
                                                      ASM_F0_INDICE_START);
                         // 2) compute the BP1 set
                         BP1_set( compressed_sm_sbm_f0, k_coeff_intercalib_f0_sbm, NB_BINS_COMPRESSED_SM_SBM_F0, packet_sbm_bp1.data );
                         // 3) send the BP1 set
                         set_time( packet_sbm_bp1.time,            (unsigned char *) &incomingMsg->coarseTimeSBM );
                         set_time( packet_sbm_bp1.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeSBM );
                         packet_sbm_bp1.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send( (char *) &packet_sbm_bp1, queue_id,
                                  PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F0 + PACKET_LENGTH_DELTA,
                                  sid);
                         // 4) compute the BP2 set if needed
                         if ( (incomingMsg->event & RTEMS_EVENT_BURST_BP2_F0) || (incomingMsg->event & RTEMS_EVENT_SBM_BP2_F0) )
                         {
                             // 1) compute the BP2 set
                             BP2_set( compressed_sm_sbm_f0, NB_BINS_COMPRESSED_SM_SBM_F0, packet_sbm_bp2.data );
                             // 2) send the BP2 set
                             set_time( packet_sbm_bp2.time,            (unsigned char *) &incomingMsg->coarseTimeSBM );
                             set_time( packet_sbm_bp2.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeSBM );
                             packet_sbm_bp2.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                             BP_send( (char *) &packet_sbm_bp2, queue_id,
                                      PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F0 + PACKET_LENGTH_DELTA,
                                      sid);
                         }
                     }
                     //*****
                     //*****
                     // NORM
                     //*****
                     //*****
                     if (incomingMsg->event & RTEMS_EVENT_NORM_BP1_F0)
                     {
                         // 1)  compress the matrix for Basic Parameters calculation
                         ASM_compress_reorganize_and_divide( asm_f0_patched_norm, compressed_sm_norm_f0,
                                                      nb_sm_before_f0.norm_bp1,
                                                      NB_BINS_COMPRESSED_SM_F0, NB_BINS_TO_AVERAGE_ASM_F0,
                                                      ASM_F0_INDICE_START );
                         // 2) compute the BP1 set
                         BP1_set( compressed_sm_norm_f0, k_coeff_intercalib_f0_norm, NB_BINS_COMPRESSED_SM_F0, packet_norm_bp1.data );
                         // 3) send the BP1 set
                         set_time( packet_norm_bp1.time,            (unsigned char *) &incomingMsg->coarseTimeNORM );
                         set_time( packet_norm_bp1.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeNORM );
                         packet_norm_bp1.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send( (char *) &packet_norm_bp1, queue_id,
                                   PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP1_F0 + PACKET_LENGTH_DELTA,
                                  SID_NORM_BP1_F0 );
                         if (incomingMsg->event & RTEMS_EVENT_NORM_BP2_F0)
                         {
                             // 1) compute the BP2 set using the same ASM as the one used for BP1
                             BP2_set( compressed_sm_norm_f0, NB_BINS_COMPRESSED_SM_F0, packet_norm_bp2.data );
                             // 2) send the BP2 set
                             set_time( packet_norm_bp2.time,            (unsigned char *) &incomingMsg->coarseTimeNORM );
                             set_time( packet_norm_bp2.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeNORM );
                             packet_norm_bp2.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                             BP_send( (char *) &packet_norm_bp2, queue_id,
                                       PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F0 + PACKET_LENGTH_DELTA,
                                      SID_NORM_BP2_F0);
                         }
                     }
                     if (incomingMsg->event & RTEMS_EVENT_NORM_ASM_F0)
                     {
                         // 1) reorganize the ASM and divide
                         ASM_reorganize_and_divide( asm_f0_patched_norm,
-                                                   asm_f0_reorganized,
+                                                   (float*) current_ring_node_to_send_asm_f0->buffer_address,
                                                    nb_sm_before_f0.norm_bp1 );
-                        // 2) convert the float array in a char array
-                        ASM_convert( asm_f0_reorganized, (char*) current_ring_node_to_send_asm_f0->buffer_address );
                         current_ring_node_to_send_asm_f0->coarseTime    = incomingMsg->coarseTimeNORM;
                         current_ring_node_to_send_asm_f0->fineTime      = incomingMsg->fineTimeNORM;
                         current_ring_node_to_send_asm_f0->sid           = SID_NORM_ASM_F0;
                         // 3) send the spectral matrix packets
                         status =  rtems_message_queue_send( queue_id, &current_ring_node_to_send_asm_f0, sizeof( ring_node* ) );
                         // change asm ring node
                         current_ring_node_to_send_asm_f0 = current_ring_node_to_send_asm_f0->next;
                     }
                 }
             }
             //**********
             // FUNCTIONS
             void reset_nb_sm_f0( unsigned char lfrMode )
             {
                 nb_sm_before_f0.norm_bp1 = parameter_dump_packet.sy_lfr_n_bp_p0 * 96;
                 nb_sm_before_f0.norm_bp2 = parameter_dump_packet.sy_lfr_n_bp_p1 * 96;
                 nb_sm_before_f0.norm_asm = (parameter_dump_packet.sy_lfr_n_asm_p[0] * 256 + parameter_dump_packet.sy_lfr_n_asm_p[1]) * 96;
                 nb_sm_before_f0.sbm1_bp1 =  parameter_dump_packet.sy_lfr_s1_bp_p0 * 24;     // 0.25 s per digit
                 nb_sm_before_f0.sbm1_bp2 =  parameter_dump_packet.sy_lfr_s1_bp_p1 * 96;
                 nb_sm_before_f0.sbm2_bp1 =  parameter_dump_packet.sy_lfr_s2_bp_p0 * 96;
                 nb_sm_before_f0.sbm2_bp2 =  parameter_dump_packet.sy_lfr_s2_bp_p1 * 96;
                 nb_sm_before_f0.burst_bp1 =  parameter_dump_packet.sy_lfr_b_bp_p0 * 96;
                 nb_sm_before_f0.burst_bp2 =  parameter_dump_packet.sy_lfr_b_bp_p1 * 96;
                 if (lfrMode == LFR_MODE_SBM1)
                 {
                     nb_sm_before_f0.burst_sbm_bp1 =  nb_sm_before_f0.sbm1_bp1;
                     nb_sm_before_f0.burst_sbm_bp2 =  nb_sm_before_f0.sbm1_bp2;
                 }
                 else if (lfrMode == LFR_MODE_SBM2)
                 {
                     nb_sm_before_f0.burst_sbm_bp1 =  nb_sm_before_f0.sbm2_bp1;
                     nb_sm_before_f0.burst_sbm_bp2 =  nb_sm_before_f0.sbm2_bp2;
                 }
                 else if (lfrMode == LFR_MODE_BURST)
                 {
                     nb_sm_before_f0.burst_sbm_bp1 =  nb_sm_before_f0.burst_bp1;
                     nb_sm_before_f0.burst_sbm_bp2 =  nb_sm_before_f0.burst_bp2;
                 }
                 else
                 {
                     nb_sm_before_f0.burst_sbm_bp1 =  nb_sm_before_f0.burst_bp1;
                     nb_sm_before_f0.burst_sbm_bp2 =  nb_sm_before_f0.burst_bp2;
                 }
             }
             void init_k_coefficients_f0( void )
             {
                 init_k_coefficients( k_coeff_intercalib_f0_norm, NB_BINS_COMPRESSED_SM_F0    );
                 init_k_coefficients( k_coeff_intercalib_f0_sbm,  NB_BINS_COMPRESSED_SM_SBM_F0);
             }

src/processing/avf1_prc1.c +1 -3

             /** Functions related to data processing.
              *
              * @file
              * @author P. LEROY
              *
              * These function are related to data processing, i.e. spectral matrices averaging and basic parameters computation.
              *
              */
             #include "avf1_prc1.h"
             nb_sm_before_bp_asm_f1 nb_sm_before_f1;
             extern ring_node sm_ring_f1[ ];
             //***
             // F1
             ring_node_asm asm_ring_norm_f1      [ NB_RING_NODES_ASM_NORM_F1      ];
             ring_node_asm asm_ring_burst_sbm_f1 [ NB_RING_NODES_ASM_BURST_SBM_F1 ];
             ring_node ring_to_send_asm_f1       [ NB_RING_NODES_ASM_F1 ];
             int buffer_asm_f1                   [ NB_RING_NODES_ASM_F1 * TOTAL_SIZE_SM ];
             float asm_f1_patched_norm       [ TOTAL_SIZE_SM ];
             float asm_f1_patched_burst_sbm  [ TOTAL_SIZE_SM ];
             float asm_f1_reorganized        [ TOTAL_SIZE_SM ];
             char  asm_f1_char          [ TOTAL_SIZE_SM * 2 ];
             float compressed_sm_norm_f1[ TOTAL_SIZE_COMPRESSED_ASM_NORM_F1];
             float compressed_sm_sbm_f1 [ TOTAL_SIZE_COMPRESSED_ASM_SBM_F1 ];
             float k_coeff_intercalib_f1_norm[ NB_BINS_COMPRESSED_SM_F1     * NB_K_COEFF_PER_BIN ];   // 13 * 32 = 416
             float k_coeff_intercalib_f1_sbm[  NB_BINS_COMPRESSED_SM_SBM_F1 * NB_K_COEFF_PER_BIN ];   // 26 * 32 = 832
             //************
             // RTEMS TASKS
             rtems_task avf1_task( rtems_task_argument lfrRequestedMode )
             {
                 int i;
                 rtems_event_set event_out;
                 rtems_status_code status;
                 rtems_id queue_id_prc1;
                 asm_msg msgForMATR;
                 ring_node *nodeForAveraging;
                 ring_node *ring_node_tab[NB_SM_BEFORE_AVF0];
                 ring_node_asm *current_ring_node_asm_burst_sbm_f1;
                 ring_node_asm *current_ring_node_asm_norm_f1;
                 unsigned int nb_norm_bp1;
                 unsigned int nb_norm_bp2;
                 unsigned int nb_norm_asm;
                 unsigned int nb_sbm_bp1;
                 unsigned int nb_sbm_bp2;
                 nb_norm_bp1 = 0;
                 nb_norm_bp2 = 0;
                 nb_norm_asm = 0;
                 nb_sbm_bp1  = 0;
                 nb_sbm_bp2  = 0;
                 reset_nb_sm_f1( lfrRequestedMode );   // reset the sm counters that drive the BP and ASM computations / transmissions
                 ASM_generic_init_ring( asm_ring_norm_f1, NB_RING_NODES_ASM_NORM_F1 );
                 ASM_generic_init_ring( asm_ring_burst_sbm_f1, NB_RING_NODES_ASM_BURST_SBM_F1 );
                 current_ring_node_asm_norm_f1      = asm_ring_norm_f1;
                 current_ring_node_asm_burst_sbm_f1 = asm_ring_burst_sbm_f1;
                 BOOT_PRINTF1("in AVF1 *** lfrRequestedMode = %d\n", (int) lfrRequestedMode)
                 status = get_message_queue_id_prc1( &queue_id_prc1 );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in AVF1 *** ERR get_message_queue_id_prc1 %d\n", status)
                 }
                 while(1){
                     rtems_event_receive(RTEMS_EVENT_0, RTEMS_WAIT, RTEMS_NO_TIMEOUT, &event_out); // wait for an RTEMS_EVENT0
                     //****************************************
                     // initialize the mesage for the MATR task
                     msgForMATR.norm       = current_ring_node_asm_norm_f1;
                     msgForMATR.burst_sbm  = current_ring_node_asm_burst_sbm_f1;
                     msgForMATR.event      = 0x00;  // this composite event will be sent to the PRC1 task
                     //
                     //****************************************
                     nodeForAveraging = getRingNodeForAveraging( 1 );
                     ring_node_tab[NB_SM_BEFORE_AVF1-1] = nodeForAveraging;
                     for ( i = 2; i < (NB_SM_BEFORE_AVF1+1); i++ )
                     {
                         nodeForAveraging = nodeForAveraging->previous;
                         ring_node_tab[NB_SM_BEFORE_AVF1-i] = nodeForAveraging;
                     }
                     // compute the average and store it in the averaged_sm_f1 buffer
                     SM_average( current_ring_node_asm_norm_f1->matrix,
                                 current_ring_node_asm_burst_sbm_f1->matrix,
                                 ring_node_tab,
                                 nb_norm_bp1, nb_sbm_bp1,
                                 &msgForMATR );
                     // update nb_average
                     nb_norm_bp1 = nb_norm_bp1 + NB_SM_BEFORE_AVF1;
                     nb_norm_bp2 = nb_norm_bp2 + NB_SM_BEFORE_AVF1;
                     nb_norm_asm = nb_norm_asm + NB_SM_BEFORE_AVF1;
                     nb_sbm_bp1  = nb_sbm_bp1  + NB_SM_BEFORE_AVF1;
                     nb_sbm_bp2  = nb_sbm_bp2  + NB_SM_BEFORE_AVF1;
                     if (nb_sbm_bp1 == nb_sm_before_f1.burst_sbm_bp1)
                     {
                         nb_sbm_bp1 = 0;
                         // set another ring for the ASM storage
                         current_ring_node_asm_burst_sbm_f1 = current_ring_node_asm_burst_sbm_f1->next;
                         if ( lfrCurrentMode == LFR_MODE_BURST )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_BURST_BP1_F1;
                         }
                         else if ( lfrCurrentMode == LFR_MODE_SBM2 )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_SBM_BP1_F1;
                         }
                     }
                     if (nb_sbm_bp2 == nb_sm_before_f1.burst_sbm_bp2)
                     {
                         nb_sbm_bp2 = 0;
                         if ( lfrCurrentMode == LFR_MODE_BURST )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_BURST_BP2_F1;
                         }
                         else if ( lfrCurrentMode == LFR_MODE_SBM2 )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_SBM_BP2_F1;
                         }
                     }
                     if (nb_norm_bp1 == nb_sm_before_f1.norm_bp1)
                     {
                         nb_norm_bp1 = 0;
                         // set another ring for the ASM storage
                         current_ring_node_asm_norm_f1 = current_ring_node_asm_norm_f1->next;
                         if ( (lfrCurrentMode == LFR_MODE_NORMAL)
                              || (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP1_F1;
                         }
                     }
                     if (nb_norm_bp2 == nb_sm_before_f1.norm_bp2)
                     {
                         nb_norm_bp2 = 0;
                         if ( (lfrCurrentMode == LFR_MODE_NORMAL)
                              || (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP2_F1;
                         }
                     }
                     if (nb_norm_asm == nb_sm_before_f1.norm_asm)
                     {
                         nb_norm_asm = 0;
                         if ( (lfrCurrentMode == LFR_MODE_NORMAL)
                              || (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_ASM_F1;
                         }
                     }
                     //*************************
                     // send the message to MATR
                     if (msgForMATR.event != 0x00)
                     {
                         status =  rtems_message_queue_send( queue_id_prc1, (char *) &msgForMATR, MSG_QUEUE_SIZE_PRC1);
                     }
                     if (status != RTEMS_SUCCESSFUL) {
                         printf("in AVF1 *** Error sending message to PRC1, code %d\n", status);
                     }
                 }
             }
             rtems_task prc1_task( rtems_task_argument lfrRequestedMode )
             {
                 char incomingData[MSG_QUEUE_SIZE_SEND];  // incoming data buffer
                 size_t size;                             // size of the incoming TC packet
                 asm_msg *incomingMsg;
                 //
                 unsigned char sid;
                 rtems_status_code status;
                 rtems_id queue_id_send;
                 rtems_id queue_id_q_p1;
                 bp_packet_with_spare    packet_norm_bp1;
                 bp_packet               packet_norm_bp2;
                 bp_packet               packet_sbm_bp1;
                 bp_packet               packet_sbm_bp2;
                 ring_node               *current_ring_node_to_send_asm_f1;
                 unsigned long long int localTime;
                 // init the ring of the averaged spectral matrices which will be transmitted to the DPU
                 init_ring( ring_to_send_asm_f1, NB_RING_NODES_ASM_F1, (volatile int*) buffer_asm_f1, TOTAL_SIZE_SM );
                 current_ring_node_to_send_asm_f1 = ring_to_send_asm_f1;
                 //*************
                 // NORM headers
                 BP_init_header_with_spare( &packet_norm_bp1,
                                            APID_TM_SCIENCE_NORMAL_BURST, SID_NORM_BP1_F1,
                                            PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP1_F1, NB_BINS_COMPRESSED_SM_F1 );
                 BP_init_header( &packet_norm_bp2,
                                 APID_TM_SCIENCE_NORMAL_BURST, SID_NORM_BP2_F1,
                                 PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F1, NB_BINS_COMPRESSED_SM_F1);
                 //***********************
                 // BURST and SBM2 headers
                 if ( lfrRequestedMode == LFR_MODE_BURST )
                 {
                     BP_init_header( &packet_sbm_bp1,
                                     APID_TM_SCIENCE_NORMAL_BURST, SID_BURST_BP1_F1,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F1, NB_BINS_COMPRESSED_SM_SBM_F1);
                     BP_init_header( &packet_sbm_bp2,
                                     APID_TM_SCIENCE_NORMAL_BURST, SID_BURST_BP2_F1,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F1, NB_BINS_COMPRESSED_SM_SBM_F1);
                 }
                 else if ( lfrRequestedMode == LFR_MODE_SBM2 )
                 {
                     BP_init_header( &packet_sbm_bp1,
                                     APID_TM_SCIENCE_SBM1_SBM2, SID_SBM2_BP1_F1,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F1, NB_BINS_COMPRESSED_SM_SBM_F1);
                     BP_init_header( &packet_sbm_bp2,
                                     APID_TM_SCIENCE_SBM1_SBM2, SID_SBM2_BP2_F1,
                                     PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F1, NB_BINS_COMPRESSED_SM_SBM_F1);
                 }
                 else
                 {
                     PRINTF1("in PRC1 *** lfrRequestedMode is %d, several headers not initialized\n", (unsigned int) lfrRequestedMode)
                 }
                 status = get_message_queue_id_send( &queue_id_send );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in PRC1 *** ERR get_message_queue_id_send %d\n", status)
                 }
                 status = get_message_queue_id_prc1( &queue_id_q_p1);
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in PRC1 *** ERR get_message_queue_id_prc1 %d\n", status)
                 }
                 BOOT_PRINTF1("in PRC1 *** lfrRequestedMode = %d\n", (int) lfrRequestedMode)
                 while(1){
                     status = rtems_message_queue_receive( queue_id_q_p1, incomingData, &size, //************************************
                                                          RTEMS_WAIT, RTEMS_NO_TIMEOUT );      // wait for a message coming from AVF0
                     incomingMsg = (asm_msg*) incomingData;
                     ASM_patch( incomingMsg->norm->matrix,      asm_f1_patched_norm      );
                     ASM_patch( incomingMsg->burst_sbm->matrix, asm_f1_patched_burst_sbm );
                     localTime = getTimeAsUnsignedLongLongInt( );
                     //***********
                     //***********
                     // BURST SBM2
                     //***********
                     //***********
                     if ( (incomingMsg->event & RTEMS_EVENT_BURST_BP1_F1) || (incomingMsg->event & RTEMS_EVENT_SBM_BP1_F1) )
                     {
                         sid = getSID( incomingMsg->event );
                         // 1)  compress the matrix for Basic Parameters calculation
                         ASM_compress_reorganize_and_divide( asm_f1_patched_burst_sbm, compressed_sm_sbm_f1,
                                                      nb_sm_before_f1.burst_sbm_bp1,
                                                      NB_BINS_COMPRESSED_SM_SBM_F1, NB_BINS_TO_AVERAGE_ASM_SBM_F1,
                                                      ASM_F1_INDICE_START);
                         // 2) compute the BP1 set
                         BP1_set( compressed_sm_sbm_f1, k_coeff_intercalib_f1_sbm, NB_BINS_COMPRESSED_SM_SBM_F1, packet_sbm_bp1.data );
                         // 3) send the BP1 set
                         set_time( packet_sbm_bp1.time,            (unsigned char *) &incomingMsg->coarseTimeSBM );
                         set_time( packet_sbm_bp1.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeSBM );
                         packet_sbm_bp1.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send( (char *) &packet_sbm_bp1, queue_id_send,
                                  PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F1 + PACKET_LENGTH_DELTA,
                                  sid );
                         // 4) compute the BP2 set if needed
                         if ( (incomingMsg->event & RTEMS_EVENT_BURST_BP2_F1) || (incomingMsg->event & RTEMS_EVENT_SBM_BP2_F1) )
                         {
                             // 1) compute the BP2 set
                             BP2_set( compressed_sm_sbm_f1, NB_BINS_COMPRESSED_SM_SBM_F1, packet_norm_bp2.data );
                             // 2) send the BP2 set
                             set_time( packet_sbm_bp2.time,            (unsigned char *) &incomingMsg->coarseTimeSBM );
                             set_time( packet_sbm_bp2.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeSBM );
                             packet_sbm_bp2.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                             BP_send( (char *) &packet_sbm_bp2, queue_id_send,
                                      PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F1 + PACKET_LENGTH_DELTA,
                                      sid );
                         }
                     }
                     //*****
                     //*****
                     // NORM
                     //*****
                     //*****
                     if (incomingMsg->event & RTEMS_EVENT_NORM_BP1_F1)
                     {
                         // 1)  compress the matrix for Basic Parameters calculation
                         ASM_compress_reorganize_and_divide( asm_f1_patched_norm, compressed_sm_norm_f1,
                                                      nb_sm_before_f1.norm_bp1,
                                                      NB_BINS_COMPRESSED_SM_F1, NB_BINS_TO_AVERAGE_ASM_F1,
                                                      ASM_F1_INDICE_START );
                         // 2) compute the BP1 set
                         BP1_set( compressed_sm_norm_f1, k_coeff_intercalib_f1_norm, NB_BINS_COMPRESSED_SM_F1, packet_norm_bp1.data );
                         // 3) send the BP1 set
                         set_time( packet_norm_bp1.time,            (unsigned char *) &incomingMsg->coarseTimeNORM );
                         set_time( packet_norm_bp1.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeNORM );
                         packet_norm_bp1.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send( (char *) &packet_norm_bp1, queue_id_send,
                                  PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP1_F1 + PACKET_LENGTH_DELTA,
                                  SID_NORM_BP1_F1 );
                         if (incomingMsg->event & RTEMS_EVENT_NORM_BP2_F1)
                         {
                             // 1) compute the BP2 set
                             BP2_set( compressed_sm_norm_f1, NB_BINS_COMPRESSED_SM_F1, packet_norm_bp2.data );
                             // 2) send the BP2 set
                             set_time( packet_norm_bp2.time,            (unsigned char *) &incomingMsg->coarseTimeNORM );
                             set_time( packet_norm_bp2.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeNORM );
                             packet_norm_bp2.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                             BP_send( (char *) &packet_norm_bp2, queue_id_send,
                                      PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F1 + PACKET_LENGTH_DELTA,
                                      SID_NORM_BP2_F1 );
                         }
                     }
                     if (incomingMsg->event & RTEMS_EVENT_NORM_ASM_F1)
                     {
                         // 1) reorganize the ASM and divide
                         ASM_reorganize_and_divide( asm_f1_patched_norm,
-                                                   asm_f1_reorganized,
+                                                   (float*) current_ring_node_to_send_asm_f1->buffer_address,
                                                    nb_sm_before_f1.norm_bp1 );
-                        // 2) convert the float array in a char array
-                        ASM_convert( asm_f1_reorganized, (char*) current_ring_node_to_send_asm_f1->buffer_address );
                         current_ring_node_to_send_asm_f1->coarseTime    = incomingMsg->coarseTimeNORM;
                         current_ring_node_to_send_asm_f1->fineTime      = incomingMsg->fineTimeNORM;
                         current_ring_node_to_send_asm_f1->sid           = SID_NORM_ASM_F1;
                         // 3) send the spectral matrix packets
                         status =  rtems_message_queue_send( queue_id_send, &current_ring_node_to_send_asm_f1, sizeof( ring_node* ) );
                         // change asm ring node
                         current_ring_node_to_send_asm_f1 = current_ring_node_to_send_asm_f1->next;
                     }
                 }
             }
             //**********
             // FUNCTIONS
             void reset_nb_sm_f1( unsigned char lfrMode )
             {
                 nb_sm_before_f1.norm_bp1  = parameter_dump_packet.sy_lfr_n_bp_p0 * 16;
                 nb_sm_before_f1.norm_bp2  = parameter_dump_packet.sy_lfr_n_bp_p1 * 16;
                 nb_sm_before_f1.norm_asm  = (parameter_dump_packet.sy_lfr_n_asm_p[0] * 256 + parameter_dump_packet.sy_lfr_n_asm_p[1]) * 16;
                 nb_sm_before_f1.sbm2_bp1  =  parameter_dump_packet.sy_lfr_s2_bp_p0 * 16;
                 nb_sm_before_f1.sbm2_bp2  =  parameter_dump_packet.sy_lfr_s2_bp_p1 * 16;
                 nb_sm_before_f1.burst_bp1 =  parameter_dump_packet.sy_lfr_b_bp_p0 * 16;
                 nb_sm_before_f1.burst_bp2 =  parameter_dump_packet.sy_lfr_b_bp_p1 * 16;
                 if (lfrMode == LFR_MODE_SBM2)
                 {
                     nb_sm_before_f1.burst_sbm_bp1 =  nb_sm_before_f1.sbm2_bp1;
                     nb_sm_before_f1.burst_sbm_bp2 =  nb_sm_before_f1.sbm2_bp2;
                 }
                 else if (lfrMode == LFR_MODE_BURST)
                 {
                     nb_sm_before_f1.burst_sbm_bp1 =  nb_sm_before_f1.burst_bp1;
                     nb_sm_before_f1.burst_sbm_bp2 =  nb_sm_before_f1.burst_bp2;
                 }
                 else
                 {
                     nb_sm_before_f1.burst_sbm_bp1 =  nb_sm_before_f1.burst_bp1;
                     nb_sm_before_f1.burst_sbm_bp2 =  nb_sm_before_f1.burst_bp2;
                 }
             }
             void init_k_coefficients_f1( void )
             {
                 init_k_coefficients( k_coeff_intercalib_f1_norm, NB_BINS_COMPRESSED_SM_F1    );
                 init_k_coefficients( k_coeff_intercalib_f1_sbm,  NB_BINS_COMPRESSED_SM_SBM_F1);
             }

src/processing/avf2_prc2.c +1 -3

             /** Functions related to data processing.
              *
              * @file
              * @author P. LEROY
              *
              * These function are related to data processing, i.e. spectral matrices averaging and basic parameters computation.
              *
              */
             #include "avf2_prc2.h"
             nb_sm_before_bp_asm_f2 nb_sm_before_f2;
             extern ring_node sm_ring_f2[ ];
             //***
             // F2
             ring_node_asm asm_ring_norm_f2     [ NB_RING_NODES_ASM_NORM_F2      ];
             ring_node ring_to_send_asm_f2      [ NB_RING_NODES_ASM_F2 ];
             int buffer_asm_f2                  [ NB_RING_NODES_ASM_F2 * TOTAL_SIZE_SM ];
             float asm_f2_patched_norm   [ TOTAL_SIZE_SM ];
             float asm_f2_reorganized    [ TOTAL_SIZE_SM ];
             char  asm_f2_char          [ TOTAL_SIZE_SM * 2 ];
             float compressed_sm_norm_f2[ TOTAL_SIZE_COMPRESSED_ASM_NORM_F2];
             float k_coeff_intercalib_f2[ NB_BINS_COMPRESSED_SM_F2 * NB_K_COEFF_PER_BIN ];   // 12 * 32 = 384
             //************
             // RTEMS TASKS
             //***
             // F2
             rtems_task avf2_task( rtems_task_argument argument )
             {
                 rtems_event_set event_out;
                 rtems_status_code status;
                 rtems_id queue_id_prc2;
                 asm_msg msgForMATR;
                 ring_node *nodeForAveraging;
                 ring_node_asm *current_ring_node_asm_norm_f2;
                 unsigned int nb_norm_bp1;
                 unsigned int nb_norm_bp2;
                 unsigned int nb_norm_asm;
                 nb_norm_bp1 = 0;
                 nb_norm_bp2 = 0;
                 nb_norm_asm = 0;
                 reset_nb_sm_f2( );   // reset the sm counters that drive the BP and ASM computations / transmissions
                 ASM_generic_init_ring( asm_ring_norm_f2, NB_RING_NODES_ASM_NORM_F2 );
                 current_ring_node_asm_norm_f2 = asm_ring_norm_f2;
                 BOOT_PRINTF("in AVF2 ***\n")
                 status = get_message_queue_id_prc2( &queue_id_prc2 );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in AVF2 *** ERR get_message_queue_id_prc2 %d\n", status)
                 }
                 while(1){
                     rtems_event_receive(RTEMS_EVENT_0, RTEMS_WAIT, RTEMS_NO_TIMEOUT, &event_out); // wait for an RTEMS_EVENT0
                     //****************************************
                     // initialize the mesage for the MATR task
                     msgForMATR.norm       = current_ring_node_asm_norm_f2;
                     msgForMATR.burst_sbm  = NULL;
                     msgForMATR.event      = 0x00;  // this composite event will be sent to the PRC2 task
                     //
                     //****************************************
                     nodeForAveraging = getRingNodeForAveraging( 2 );
             //        printf(" **0** %x . %x", sm_ring_f2[0].coarseTime, sm_ring_f2[0].fineTime);
             //        printf(" **1** %x . %x", sm_ring_f2[1].coarseTime, sm_ring_f2[1].fineTime);
             //        printf(" **2** %x . %x", sm_ring_f2[2].coarseTime, sm_ring_f2[2].fineTime);
             //        printf(" **3** %x . %x", sm_ring_f2[3].coarseTime, sm_ring_f2[3].fineTime);
             //        printf(" **4** %x . %x", sm_ring_f2[4].coarseTime, sm_ring_f2[4].fineTime);
             //        printf(" **5** %x . %x", sm_ring_f2[5].coarseTime, sm_ring_f2[5].fineTime);
             //        printf(" **6** %x . %x", sm_ring_f2[6].coarseTime, sm_ring_f2[6].fineTime);
             //        printf(" **7** %x . %x", sm_ring_f2[7].coarseTime, sm_ring_f2[7].fineTime);
             //        printf(" **8** %x . %x", sm_ring_f2[8].coarseTime, sm_ring_f2[8].fineTime);
             //        printf(" **9** %x . %x", sm_ring_f2[9].coarseTime, sm_ring_f2[9].fineTime);
             //        printf(" **10** %x . %x\n", sm_ring_f2[10].coarseTime, sm_ring_f2[10].fineTime);
                     // compute the average and store it in the averaged_sm_f2 buffer
                     SM_average_f2( current_ring_node_asm_norm_f2->matrix,
                                    nodeForAveraging,
                                    nb_norm_bp1,
                                    &msgForMATR );
                     // update nb_average
                     nb_norm_bp1 = nb_norm_bp1 + NB_SM_BEFORE_AVF2;
                     nb_norm_bp2 = nb_norm_bp2 + NB_SM_BEFORE_AVF2;
                     nb_norm_asm = nb_norm_asm + NB_SM_BEFORE_AVF2;
                     if (nb_norm_bp1 == nb_sm_before_f2.norm_bp1)
                     {
                         nb_norm_bp1 = 0;
                         // set another ring for the ASM storage
                         current_ring_node_asm_norm_f2 = current_ring_node_asm_norm_f2->next;
                         if ( (lfrCurrentMode == LFR_MODE_NORMAL) || (lfrCurrentMode == LFR_MODE_SBM1)
                              || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP1_F2;
                         }
                     }
                     if (nb_norm_bp2 == nb_sm_before_f2.norm_bp2)
                     {
                         nb_norm_bp2 = 0;
                         if ( (lfrCurrentMode == LFR_MODE_NORMAL) || (lfrCurrentMode == LFR_MODE_SBM1)
                              || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP2_F2;
                         }
                     }
                     if (nb_norm_asm == nb_sm_before_f2.norm_asm)
                     {
                         nb_norm_asm = 0;
                         if ( (lfrCurrentMode == LFR_MODE_NORMAL) || (lfrCurrentMode == LFR_MODE_SBM1)
                              || (lfrCurrentMode == LFR_MODE_SBM2) )
                         {
                             msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_ASM_F2;
                         }
                     }
                     //*************************
                     // send the message to MATR
                     if (msgForMATR.event != 0x00)
                     {
                         status =  rtems_message_queue_send( queue_id_prc2, (char *) &msgForMATR, MSG_QUEUE_SIZE_PRC2);
                     }
                     if (status != RTEMS_SUCCESSFUL) {
                         printf("in AVF2 *** Error sending message to MATR, code %d\n", status);
                     }
                 }
             }
             rtems_task prc2_task( rtems_task_argument argument )
             {
                 char incomingData[MSG_QUEUE_SIZE_SEND];  // incoming data buffer
                 size_t size;                            // size of the incoming TC packet
                 asm_msg *incomingMsg;
                 //
                 rtems_status_code status;
                 rtems_id queue_id_send;
                 rtems_id queue_id_q_p2;
                 bp_packet                   packet_norm_bp1;
                 bp_packet                   packet_norm_bp2;
                 ring_node                   *current_ring_node_to_send_asm_f2;
                 unsigned long long int localTime;
                 // init the ring of the averaged spectral matrices which will be transmitted to the DPU
                 init_ring( ring_to_send_asm_f2, NB_RING_NODES_ASM_F2, (volatile int*) buffer_asm_f2, TOTAL_SIZE_SM );
                 current_ring_node_to_send_asm_f2 = ring_to_send_asm_f2;
                 //*************
                 // NORM headers
                 BP_init_header( &packet_norm_bp1,
                                 APID_TM_SCIENCE_NORMAL_BURST, SID_NORM_BP1_F2,
                                 PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP1_F2, NB_BINS_COMPRESSED_SM_F2 );
                 BP_init_header( &packet_norm_bp2,
                                 APID_TM_SCIENCE_NORMAL_BURST, SID_NORM_BP2_F2,
                                 PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F2, NB_BINS_COMPRESSED_SM_F2 );
                 status =  get_message_queue_id_send( &queue_id_send );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in PRC2 *** ERR get_message_queue_id_send %d\n", status)
                 }
                 status = get_message_queue_id_prc2( &queue_id_q_p2);
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in PRC2 *** ERR get_message_queue_id_prc2 %d\n", status)
                 }
                 BOOT_PRINTF("in PRC2 ***\n")
                 while(1){
                     status = rtems_message_queue_receive( queue_id_q_p2, incomingData, &size, //************************************
                                                          RTEMS_WAIT, RTEMS_NO_TIMEOUT );      // wait for a message coming from AVF2
                     incomingMsg = (asm_msg*) incomingData;
                     ASM_patch( incomingMsg->norm->matrix, asm_f2_patched_norm );
                     localTime = getTimeAsUnsignedLongLongInt( );
                     //*****
                     //*****
                     // NORM
                     //*****
                     //*****
                     // 1)  compress the matrix for Basic Parameters calculation
                     ASM_compress_reorganize_and_divide( asm_f2_patched_norm, compressed_sm_norm_f2,
                                                  nb_sm_before_f2.norm_bp1,
                                                  NB_BINS_COMPRESSED_SM_F2, NB_BINS_TO_AVERAGE_ASM_F2,
                                                  ASM_F2_INDICE_START );
                     // BP1_F2
                     if (incomingMsg->event & RTEMS_EVENT_NORM_BP1_F2)
                     {
                         // 1) compute the BP1 set
                         BP1_set( compressed_sm_norm_f2, k_coeff_intercalib_f2, NB_BINS_COMPRESSED_SM_F2, packet_norm_bp1.data );
                         // 2) send the BP1 set
                         set_time( packet_norm_bp1.time,            (unsigned char *) &incomingMsg->coarseTimeNORM );
                         set_time( packet_norm_bp1.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeNORM );
                         packet_norm_bp1.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send( (char *) &packet_norm_bp1, queue_id_send,
                                  PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP1_F2 + PACKET_LENGTH_DELTA,
                                  SID_NORM_BP1_F2 );
                     }
                     // BP2_F2
                     if (incomingMsg->event & RTEMS_EVENT_NORM_BP2_F2)
                     {
                         // 1) compute the BP2 set
                         BP2_set( compressed_sm_norm_f2, NB_BINS_COMPRESSED_SM_F2, packet_norm_bp2.data );
                         // 2) send the BP2 set
                         set_time( packet_norm_bp2.time,            (unsigned char *) &incomingMsg->coarseTimeNORM );
                         set_time( packet_norm_bp2.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeNORM );
                         packet_norm_bp2.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send( (char *) &packet_norm_bp2, queue_id_send,
                                  PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F2 + PACKET_LENGTH_DELTA,
                                  SID_NORM_BP2_F2 );
                     }
                     if (incomingMsg->event & RTEMS_EVENT_NORM_ASM_F2)
                     {
                         // 1) reorganize the ASM and divide
                         ASM_reorganize_and_divide( asm_f2_patched_norm,
-                                                   asm_f2_reorganized,
+                                                   (float*) current_ring_node_to_send_asm_f2->buffer_address,
                                                    nb_sm_before_f2.norm_bp1 );
-                        // 2) convert the float array in a char array
-                        ASM_convert( asm_f2_reorganized, (char*) current_ring_node_to_send_asm_f2->buffer_address );
                         current_ring_node_to_send_asm_f2->coarseTime    = incomingMsg->coarseTimeNORM;
                         current_ring_node_to_send_asm_f2->fineTime      = incomingMsg->fineTimeNORM;
                         current_ring_node_to_send_asm_f2->sid           = SID_NORM_ASM_F2;
                         // 3) send the spectral matrix packets
                         status =  rtems_message_queue_send( queue_id_send, &current_ring_node_to_send_asm_f2, sizeof( ring_node* ) );
                         // change asm ring node
                         current_ring_node_to_send_asm_f2 = current_ring_node_to_send_asm_f2->next;
                     }
                 }
             }
             //**********
             // FUNCTIONS
             void reset_nb_sm_f2( void )
             {
                 nb_sm_before_f2.norm_bp1  = parameter_dump_packet.sy_lfr_n_bp_p0;
                 nb_sm_before_f2.norm_bp2  = parameter_dump_packet.sy_lfr_n_bp_p1;
                 nb_sm_before_f2.norm_asm  = parameter_dump_packet.sy_lfr_n_asm_p[0] * 256 + parameter_dump_packet.sy_lfr_n_asm_p[1];
             }
             void SM_average_f2( float *averaged_spec_mat_f2,
                                 ring_node *ring_node,
                                 unsigned int nbAverageNormF2,
                                 asm_msg *msgForMATR )
             {
                 float sum;
                 unsigned int i;
                 for(i=0; i<TOTAL_SIZE_SM; i++)
                 {
                     sum = ( (int *) (ring_node->buffer_address) ) [ i ];
                     if ( (nbAverageNormF2 == 0) )
                     {
                         averaged_spec_mat_f2[ i ] = sum;
                         msgForMATR->coarseTimeNORM  = ring_node->coarseTime;
                         msgForMATR->fineTimeNORM    = ring_node->fineTime;
                     }
                     else
                     {
                         averaged_spec_mat_f2[ i ] = ( averaged_spec_mat_f2[  i ] + sum );
                     }
                 }
             }
             void init_k_coefficients_f2( void )
             {
                 init_k_coefficients( k_coeff_intercalib_f2, NB_BINS_COMPRESSED_SM_F2);
             }

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