HG_REPOSITORIES/LPP/INSTRUMENTATION/SOLO_LFR/DEV_PLE Commit - r230:f6bd2f6c2315

corrected, TC_LFR_UPDATE_INFO fields copied in...

paul -

r230:f6bd2f6c2315 R3

parent child

Context file:

r230:f6bd2f6c2315

Collapse all files

.hgsubstate +1 -1

@@ -1,2 +1,2
1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters	1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters
2	6a30b7a924d9c3824f432332ed79bcee25954455 header/lfr_common_headers	2	82603593a3f6185e68418200fe1fee7d81fe6e3d 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 -= 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=9 # internal
+            DEFINES += SW_VERSION_N4=10 # internal
             # <GCOV>
             #QMAKE_CFLAGS_RELEASE += -fprofile-arcs -ftest-coverage
             #LIBS += -lgcov /opt/GCOV/01A/lib/overload.o -lc
             #LIBS += -lgcov /opt/GCOV/HOWTO_gcov_for_lfr_test/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

src/fsw_spacewire.c +3 -7

             /** Functions related to the SpaceWire interface.
              *
              * @file
              * @author P. LEROY
              *
              * A group of functions to handle SpaceWire transmissions:
              * - configuration of the SpaceWire link
              * - SpaceWire related interruption requests processing
              * - transmission of TeleMetry packets by a dedicated RTEMS task
              * - reception of TeleCommands by a dedicated RTEMS task
              *
              */
             #include "fsw_spacewire.h"
             rtems_name semq_name;
             rtems_id semq_id;
             //*****************
             // waveform headers
             Header_TM_LFR_SCIENCE_CWF_t headerCWF;
             Header_TM_LFR_SCIENCE_SWF_t headerSWF;
             Header_TM_LFR_SCIENCE_ASM_t headerASM;
             //***********
             // 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_stop_and_start_link %d\n", status)
                         }
                     }
                     // [3] COMPLETE RECOVERY ACTION AFTER SY_LFR_DPU_CONNECT_ATTEMPTS
                     if ( status == RTEMS_SUCCESSFUL )   // [3.a] the link is in run state and has been started successfully
                     {
                         status = rtems_task_restart( Task_id[ TASKID_SEND ], 1 );
                         if ( status != RTEMS_SUCCESSFUL ) {
                             PRINTF("in SPIQ *** ERR resuming SEND Task\n")
                         }
                         status = rtems_task_restart( Task_id[ TASKID_RECV ], 1 );
                         if ( status != RTEMS_SUCCESSFUL ) {
                             PRINTF("in SPIQ *** ERR resuming RECV Task\n")
                         }
                     }
                     else                                // [3.b] the link is not in run state, go in STANDBY mode
                     {
                         status = enter_mode( 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);
                             }
                         }
                     }
                     update_queue_max_count( queue_recv_id, &hk_lfr_q_rv_fifo_size_max );
                 }
             }
             rtems_task send_task( rtems_task_argument argument)
             {
                 /** This RTEMS task is dedicated to the transmission of TeleMetry packets.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The SEND task waits for a message to become available in the dedicated RTEMS queue. When a message arrives:
                  * - if the first byte is equal to CCSDS_DESTINATION_ID, the message is sent as is using the write system call.
                  * - if the first byte is not equal to CCSDS_DESTINATION_ID, the message is handled as a spw_ioctl_pkt_send. After
                  * analyzis, the packet is sent either using the write system call or using the ioctl call SPACEWIRE_IOCTRL_SEND, depending on the
                  * data it contains.
                  *
                  */
                 rtems_status_code status;                // RTEMS status code
                 char incomingData[MSG_QUEUE_SIZE_SEND];  // incoming data buffer
                 ring_node *incomingRingNodePtr;
                 int ring_node_address;
                 char *charPtr;
                 spw_ioctl_pkt_send *spw_ioctl_send;
                 size_t size;                            // size of the incoming TC packet
                 rtems_id queue_send_id;
                 unsigned int sid;
                 unsigned char sidAsUnsignedChar;
+                unsigned char type;
                 incomingRingNodePtr = NULL;
                 ring_node_address = 0;
                 charPtr = (char *) &ring_node_address;
                 sid = 0;
                 sidAsUnsignedChar = 0;
                 init_header_cwf( &headerCWF );
                 init_header_swf( &headerSWF );
                 init_header_asm( &headerASM );
                 status =  get_message_queue_id_send( &queue_send_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in HOUS *** ERR get_message_queue_id_send %d\n", status)
                 }
                 BOOT_PRINTF("in SEND *** \n")
                 while(1)
                 {
                     status = rtems_message_queue_receive( queue_send_id, incomingData, &size,
                                                          RTEMS_WAIT, RTEMS_NO_TIMEOUT );
                     if (status!=RTEMS_SUCCESSFUL)
                     {
                         PRINTF1("in SEND *** (1) ERR = %d\n", status)
                     }
                     else
                     {
                         if ( size == sizeof(ring_node*) )
                         {
                             charPtr[0] = incomingData[0];
                             charPtr[1] = incomingData[1];
                             charPtr[2] = incomingData[2];
                             charPtr[3] = incomingData[3];
                             incomingRingNodePtr = (ring_node*) ring_node_address;
                             sid = incomingRingNodePtr->sid;
                             if ( (sid==SID_NORM_CWF_LONG_F3)
                                  || (sid==SID_BURST_CWF_F2 )
                                  || (sid==SID_SBM1_CWF_F1  )
                                  || (sid==SID_SBM2_CWF_F2  ))
                             {
                                 spw_send_waveform_CWF( incomingRingNodePtr, &headerCWF );
                             }
                             else if ( (sid==SID_NORM_SWF_F0) || (sid== SID_NORM_SWF_F1) || (sid==SID_NORM_SWF_F2) )
                             {
                                 spw_send_waveform_SWF( incomingRingNodePtr, &headerSWF );
                             }
                             else if ( (sid==SID_NORM_CWF_F3) )
                             {
                                 spw_send_waveform_CWF3_light( incomingRingNodePtr, &headerCWF );
                             }
                             else if (sid==SID_NORM_ASM_F0)
                             {
                                 spw_send_asm_f0( incomingRingNodePtr, &headerASM );
                             }
                             else if (sid==SID_NORM_ASM_F1)
                             {
                                 spw_send_asm_f1( incomingRingNodePtr, &headerASM );
                             }
                             else if (sid==SID_NORM_ASM_F2)
                             {
                                 spw_send_asm_f2( incomingRingNodePtr, &headerASM );
                             }
                             else if ( sid==TM_CODE_K_DUMP )
                             {
                                 spw_send_k_dump( incomingRingNodePtr );
                             }
                             else
                             {
                                 PRINTF1("unexpected sid = %d\n", sid);
                             }
                         }
                         else if ( incomingData[0] == CCSDS_DESTINATION_ID ) // the incoming message is a ccsds packet
                         {
                             sidAsUnsignedChar = (unsigned char) incomingData[ PACKET_POS_PA_LFR_SID_PKT ];
                             sid = sidAsUnsignedChar;
+                            type = (unsigned char) incomingData[ PACKET_POS_SERVICE_TYPE ];
+                            if (type == TM_TYPE_LFR_SCIENCE)    // this is a BP packet, all other types are handled differently
                             // SET THE SEQUENCE_CNT PARAMETER IN CASE OF BP0 OR BP1 PACKETS
-                            if ( (sid == SID_NORM_BP1_F0) || (sid == SID_NORM_BP1_F1) || (sid == SID_NORM_BP1_F2)
-                                 || (sid == SID_NORM_BP2_F0) || (sid == SID_NORM_BP2_F1) || (sid == SID_NORM_BP2_F2)
-                                 || (sid == SID_BURST_BP1_F0) || (sid == SID_BURST_BP1_F1)
-                                 || (sid == SID_BURST_BP2_F0) || (sid == SID_BURST_BP2_F1)
-                                 || (sid == SID_SBM1_BP1_F0) || (sid == SID_SBM1_BP2_F0)
-                                 || (sid == SID_SBM2_BP1_F0) || (sid == SID_SBM2_BP1_F1)
-                                 || (sid == SID_SBM2_BP2_F0) || (sid == SID_SBM2_BP2_F1))
                             {
                                 increment_seq_counter_source_id( (unsigned char*) &incomingData[ PACKET_POS_SEQUENCE_CNT ], sid );
                             }
                             status = write( fdSPW, incomingData, size );
                             if (status == -1){
                                 PRINTF2("in SEND *** (2.a) ERRNO = %d, size = %d\n", errno, size)
                             }
                         }
                         else // the incoming message is a spw_ioctl_pkt_send structure
                         {
                             spw_ioctl_send = (spw_ioctl_pkt_send*) incomingData;
                             status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, spw_ioctl_send );
                             if (status == -1){
                                 PRINTF2("in SEND *** (2.b) ERRNO = %d, RTEMS = %d\n", errno, status)
                             }
                         }
                     }
                     update_queue_max_count( queue_send_id, &hk_lfr_q_sd_fifo_size_max );
                 }
             }
             rtems_task wtdg_task( rtems_task_argument argument )
             {
                 rtems_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;
                 unsigned char timecodeCtr;
                 unsigned char updateTimeCtr;
                 grspwPtr = (unsigned int *) (REGS_ADDR_GRSPW + APB_OFFSET_GRSPW_TIME_REGISTER);
                 housekeeping_packet.hk_lfr_dpu_spw_last_timc = (unsigned char) (grspwPtr[0] & 0xff);   // [1111 1111]
                 timecodeCtr = (unsigned char) (grspwPtr[0] & 0x3f);             // [0011 1111]
                 updateTimeCtr = time_management_regs->coarse_time_load & 0x3f;  // [0011 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;
                 }
                 // check the value of the timecode with respect to the last TC_LFR_UPDATE_TIME => SSS-CP-FS-370
                 if (timecodeCtr != updateTimeCtr)
                 {
                     if (housekeeping_packet.hk_lfr_time_timecode_ctr == 255)
                     {
                         housekeeping_packet.hk_lfr_time_timecode_ctr = 0;
                     }
                     else
                     {
                         housekeeping_packet.hk_lfr_time_timecode_ctr = housekeeping_packet.hk_lfr_time_timecode_ctr + 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_6; // service subtype
                 header->destinationID   = TM_DESTINATION_ID_GROUND;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 // AUXILIARY DATA HEADER
                 header->sid     = 0x00;
                 header->hkBIA   = DEFAULT_HKBIA;
                 header->pktCnt  = DEFAULT_PKTCNT;  // PKT_CNT
                 header->pktNr   = 0x00;
                 header->blkNr[0]        = (unsigned char) (BLK_NR_CWF >> 8);
                 header->blkNr[1]        = (unsigned char) (BLK_NR_CWF     );
             }
             void init_header_asm( Header_TM_LFR_SCIENCE_ASM_t *header )
             {
                 header->targetLogicalAddress        = CCSDS_DESTINATION_ID;
                 header->protocolIdentifier          = CCSDS_PROTOCOLE_ID;
                 header->reserved        = DEFAULT_RESERVED;
                 header->userApplication = CCSDS_USER_APP;
                 header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);
                 header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                 header->packetSequenceControl[0]    = TM_PACKET_SEQ_CTRL_STANDALONE;
                 header->packetSequenceControl[1]    = TM_PACKET_SEQ_CNT_DEFAULT;
                 header->packetLength[0] = 0x00;
                 header->packetLength[1] = 0x00;
                 // DATA FIELD HEADER
                 header->spare1_pusVersion_spare2    = DEFAULT_SPARE1_PUSVERSION_SPARE2;
                 header->serviceType     = TM_TYPE_LFR_SCIENCE; // service type
                 header->serviceSubType  = TM_SUBTYPE_LFR_SCIENCE_3; // service subtype
                 header->destinationID   = TM_DESTINATION_ID_GROUND;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 header->time[0] = 0x00;
                 // AUXILIARY DATA HEADER
                 header->sid     = 0x00;
                 header->biaStatusInfo = 0x00;
                 header->pa_lfr_pkt_cnt_asm = 0x00;
                 header->pa_lfr_pkt_nr_asm = 0x00;
                 header->pa_lfr_asm_blk_nr[0] = 0x00;
                 header->pa_lfr_asm_blk_nr[1] = 0x00;
             }
             int spw_send_waveform_CWF( ring_node *ring_node_to_send,
                                   Header_TM_LFR_SCIENCE_CWF_t *header )
             {
                 /** This function sends CWF CCSDS packets (F2, F1 or F0).
                  *
                  * @param waveform points to the buffer containing the data that will be send.
                  * @param sid is the source identifier of the data that will be sent.
                  * @param headerCWF points to a table of headers that have been prepared for the data transmission.
                  * @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures
                  * contain information to setup the transmission of the data packets.
                  *
                  * One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.
                  *
                  */
                 unsigned int i;
                 int ret;
                 unsigned int coarseTime;
                 unsigned int fineTime;
                 rtems_status_code status;
                 spw_ioctl_pkt_send spw_ioctl_send_CWF;
                 int *dataPtr;
                 unsigned char sid;
                 spw_ioctl_send_CWF.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_CWF;
                 spw_ioctl_send_CWF.options = 0;
                 ret = LFR_DEFAULT;
                 sid = (unsigned char) ring_node_to_send->sid;
                 coarseTime  = ring_node_to_send->coarseTime;
                 fineTime    = ring_node_to_send->fineTime;
                 dataPtr     = (int*) ring_node_to_send->buffer_address;
                 header->packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_336 >> 8);
                 header->packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_336     );
                 header->hkBIA = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 header->blkNr[0] = (unsigned char) (BLK_NR_CWF >> 8);
                 header->blkNr[1] = (unsigned char) (BLK_NR_CWF     );
                 for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF; i++) // send waveform
                 {
                     spw_ioctl_send_CWF.data = (char*) &dataPtr[ (i * BLK_NR_CWF * NB_WORDS_SWF_BLK) ];
                     spw_ioctl_send_CWF.hdr  = (char*) header;
                     // BUILD THE DATA
                     spw_ioctl_send_CWF.dlen = BLK_NR_CWF * NB_BYTES_SWF_BLK;
                     // SET PACKET SEQUENCE CONTROL
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     // SET SID
                     header->sid = sid;
                     // SET PACKET TIME
                     compute_acquisition_time( coarseTime, fineTime, sid, i, header->acquisitionTime);
                     //
                     header->time[0] = header->acquisitionTime[0];
                     header->time[1] = header->acquisitionTime[1];
                     header->time[2] = header->acquisitionTime[2];
                     header->time[3] = header->acquisitionTime[3];
                     header->time[4] = header->acquisitionTime[4];
                     header->time[5] = header->acquisitionTime[5];
                     // SET PACKET ID
                     if ( (sid == SID_SBM1_CWF_F1) || (sid == SID_SBM2_CWF_F2) )
                     {
                         header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2 >> 8);
                         header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2);
                     }
                     else
                     {
                         header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);
                         header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                     }
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_CWF );
                     if (status != RTEMS_SUCCESSFUL) {
                         ret = LFR_DEFAULT;
                     }
                 }
                 return ret;
             }
             int spw_send_waveform_SWF( ring_node *ring_node_to_send,
                                    Header_TM_LFR_SCIENCE_SWF_t *header )
             {
                 /** This function sends SWF CCSDS packets (F2, F1 or F0).
                  *
                  * @param waveform points to the buffer containing the data that will be send.
                  * @param sid is the source identifier of the data that will be sent.
                  * @param headerSWF points to a table of headers that have been prepared for the data transmission.
                  * @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures
                  * contain information to setup the transmission of the data packets.
                  *
                  * One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.
                  *
                  */
                 unsigned int i;
                 int ret;
                 unsigned int coarseTime;
                 unsigned int fineTime;
                 rtems_status_code status;
                 spw_ioctl_pkt_send spw_ioctl_send_SWF;
                 int *dataPtr;
                 unsigned char sid;
                 spw_ioctl_send_SWF.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_SWF;
                 spw_ioctl_send_SWF.options = 0;
                 ret = LFR_DEFAULT;
                 coarseTime  = ring_node_to_send->coarseTime;
                 fineTime    = ring_node_to_send->fineTime;
                 dataPtr     = (int*) ring_node_to_send->buffer_address;
                 sid = ring_node_to_send->sid;
                 header->hkBIA = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<7; i++) // send waveform
                 {
                     spw_ioctl_send_SWF.data = (char*) &dataPtr[ (i * BLK_NR_304 * NB_WORDS_SWF_BLK) ];
                     spw_ioctl_send_SWF.hdr = (char*) header;
                     // SET PACKET SEQUENCE CONTROL
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     // SET PACKET LENGTH AND BLKNR
                     if (i == 6)
                     {
                         spw_ioctl_send_SWF.dlen = BLK_NR_224 * NB_BYTES_SWF_BLK;
                         header->packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_224 >> 8);
                         header->packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_224     );
                         header->blkNr[0] = (unsigned char) (BLK_NR_224 >> 8);
                         header->blkNr[1] = (unsigned char) (BLK_NR_224     );
                     }
                     else
                     {
                         spw_ioctl_send_SWF.dlen = BLK_NR_304 * NB_BYTES_SWF_BLK;
                         header->packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_304 >> 8);
                         header->packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_304     );
                         header->blkNr[0] = (unsigned char) (BLK_NR_304 >> 8);
                         header->blkNr[1] = (unsigned char) (BLK_NR_304     );
                     }
                     // SET PACKET TIME
                     compute_acquisition_time( coarseTime, fineTime, sid, i, header->acquisitionTime );
                     //
                     header->time[0] = header->acquisitionTime[0];
                     header->time[1] = header->acquisitionTime[1];
                     header->time[2] = header->acquisitionTime[2];
                     header->time[3] = header->acquisitionTime[3];
                     header->time[4] = header->acquisitionTime[4];
                     header->time[5] = header->acquisitionTime[5];
                     // SET SID
                     header->sid = sid;
                     // SET PKTNR
                     header->pktNr = i+1;    // PKT_NR
                     // SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_SWF );
                     if (status != RTEMS_SUCCESSFUL) {
                         ret = LFR_DEFAULT;
                     }
                 }
                 return ret;
             }
             int spw_send_waveform_CWF3_light( ring_node *ring_node_to_send,
                                               Header_TM_LFR_SCIENCE_CWF_t *header )
             {
                 /** This function sends CWF_F3 CCSDS packets without the b1, b2 and b3 data.
                  *
                  * @param waveform points to the buffer containing the data that will be send.
                  * @param headerCWF points to a table of headers that have been prepared for the data transmission.
                  * @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures
                  * contain information to setup the transmission of the data packets.
                  *
                  * By default, CWF_F3 packet are send without the b1, b2 and b3 data. This function rebuilds a data buffer
                  * from the incoming data and sends it in 7 packets, 6 containing 340 blocks and 1 one containing 8 blocks.
                  *
                  */
                 unsigned int i;
                 int ret;
                 unsigned int coarseTime;
                 unsigned int fineTime;
                 rtems_status_code status;
                 spw_ioctl_pkt_send spw_ioctl_send_CWF;
                 char *dataPtr;
                 unsigned char sid;
                 spw_ioctl_send_CWF.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_CWF;
                 spw_ioctl_send_CWF.options = 0;
                 ret = LFR_DEFAULT;
                 sid = ring_node_to_send->sid;
                 coarseTime  = ring_node_to_send->coarseTime;
                 fineTime    = ring_node_to_send->fineTime;
                 dataPtr     = (char*) ring_node_to_send->buffer_address;
                 header->packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_672 >> 8);
                 header->packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_672     );
                 header->hkBIA = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 header->blkNr[0] = (unsigned char) (BLK_NR_CWF_SHORT_F3 >> 8);
                 header->blkNr[1] = (unsigned char) (BLK_NR_CWF_SHORT_F3     );
                 //*********************
                 // SEND CWF3_light DATA
                 for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF_LIGHT; i++) // send waveform
                 {
                     spw_ioctl_send_CWF.data = (char*) &dataPtr[ (i * BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK) ];
                     spw_ioctl_send_CWF.hdr = (char*) header;
                     // BUILD THE DATA
                     spw_ioctl_send_CWF.dlen = BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK;
                     // SET PACKET SEQUENCE COUNTER
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     // SET SID
                     header->sid = sid;
                     // SET PACKET TIME
                     compute_acquisition_time( coarseTime, fineTime, SID_NORM_CWF_F3, i, header->acquisitionTime );
                     //
                     header->time[0] = header->acquisitionTime[0];
                     header->time[1] = header->acquisitionTime[1];
                     header->time[2] = header->acquisitionTime[2];
                     header->time[3] = header->acquisitionTime[3];
                     header->time[4] = header->acquisitionTime[4];
                     header->time[5] = header->acquisitionTime[5];
                     // SET PACKET ID
                     header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);
                     header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                     // SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_CWF );
                     if (status != RTEMS_SUCCESSFUL) {
                         ret = LFR_DEFAULT;
                     }
                 }
                 return ret;
             }
             void spw_send_asm_f0( ring_node *ring_node_to_send,
                                Header_TM_LFR_SCIENCE_ASM_t *header )
             {
                 unsigned int i;
                 unsigned int length = 0;
                 rtems_status_code status;
                 unsigned int sid;
                 float *spectral_matrix;
                 int coarseTime;
                 int fineTime;
                 spw_ioctl_pkt_send spw_ioctl_send_ASM;
                 sid = ring_node_to_send->sid;
                 spectral_matrix = (float*) ring_node_to_send->buffer_address;
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
                 header->biaStatusInfo = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<3; i++)
                 {
                     if ((i==0) || (i==1))
                     {
                         spw_ioctl_send_ASM.dlen = DLEN_ASM_F0_PKT_1;
                         spw_ioctl_send_ASM.data = (char *) &spectral_matrix[
                                 ( (ASM_F0_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F0_1) ) * NB_VALUES_PER_SM )
                                 ];
                         length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F0_1;
                         header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
                         header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F0_1) >> 8 ); // BLK_NR MSB
                         header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F0_1);        // BLK_NR LSB
                     }
                     else
                     {
                         spw_ioctl_send_ASM.dlen = DLEN_ASM_F0_PKT_2;
                         spw_ioctl_send_ASM.data = (char*) &spectral_matrix[
                                 ( (ASM_F0_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F0_1) ) * NB_VALUES_PER_SM )
                                 ];
                         length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F0_2;
                         header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
                         header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F0_2) >> 8 ); // BLK_NR MSB
                         header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F0_2);        // BLK_NR LSB
                     }
                     spw_ioctl_send_ASM.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_ASM;
                     spw_ioctl_send_ASM.hdr = (char *) header;
                     spw_ioctl_send_ASM.options = 0;
                     // (2) BUILD THE HEADER
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     header->packetLength[0] = (unsigned char) (length>>8);
                     header->packetLength[1] = (unsigned char) (length);
                     header->sid = (unsigned char) sid;   // SID
                     header->pa_lfr_pkt_cnt_asm = 3;
                     header->pa_lfr_pkt_nr_asm = (unsigned char) (i+1);
                     // (3) SET PACKET TIME
                     header->time[0] = (unsigned char) (coarseTime>>24);
                     header->time[1] = (unsigned char) (coarseTime>>16);
                     header->time[2] = (unsigned char) (coarseTime>>8);
                     header->time[3] = (unsigned char) (coarseTime);
                     header->time[4] = (unsigned char) (fineTime>>8);
                     header->time[5] = (unsigned char) (fineTime);
                     //
                     header->acquisitionTime[0] = header->time[0];
                     header->acquisitionTime[1] = header->time[1];
                     header->acquisitionTime[2] = header->time[2];
                     header->acquisitionTime[3] = header->time[3];
                     header->acquisitionTime[4] = header->time[4];
                     header->acquisitionTime[5] = header->time[5];
                     // (4) SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_ASM );
                     if (status != RTEMS_SUCCESSFUL) {
                         PRINTF1("in ASM_send *** ERR %d\n", (int) status)
                     }
                 }
             }
             void spw_send_asm_f1( ring_node *ring_node_to_send,
                                Header_TM_LFR_SCIENCE_ASM_t *header )
             {
                 unsigned int i;
                 unsigned int length = 0;
                 rtems_status_code status;
                 unsigned int sid;
                 float *spectral_matrix;
                 int coarseTime;
                 int fineTime;
                 spw_ioctl_pkt_send spw_ioctl_send_ASM;
                 sid = ring_node_to_send->sid;
                 spectral_matrix = (float*) ring_node_to_send->buffer_address;
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
                 header->biaStatusInfo = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<3; i++)
                 {
                     if ((i==0) || (i==1))
                     {
                         spw_ioctl_send_ASM.dlen = DLEN_ASM_F1_PKT_1;
                         spw_ioctl_send_ASM.data = (char *) &spectral_matrix[
                                 ( (ASM_F1_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F1_1) ) * NB_VALUES_PER_SM )
                                 ];
                         length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F1_1;
                         header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
                         header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F1_1) >> 8 ); // BLK_NR MSB
                         header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F1_1);        // BLK_NR LSB
                     }
                     else
                     {
                         spw_ioctl_send_ASM.dlen = DLEN_ASM_F1_PKT_2;
                         spw_ioctl_send_ASM.data = (char*) &spectral_matrix[
                                 ( (ASM_F1_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F1_1) ) * NB_VALUES_PER_SM )
                                 ];
                         length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F1_2;
                         header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_6;
                         header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F1_2) >> 8 ); // BLK_NR MSB
                         header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F1_2);        // BLK_NR LSB
                     }
                     spw_ioctl_send_ASM.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_ASM;
                     spw_ioctl_send_ASM.hdr = (char *) header;
                     spw_ioctl_send_ASM.options = 0;
                     // (2) BUILD THE HEADER
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     header->packetLength[0] = (unsigned char) (length>>8);
                     header->packetLength[1] = (unsigned char) (length);
                     header->sid = (unsigned char) sid;   // SID
                     header->pa_lfr_pkt_cnt_asm = 3;
                     header->pa_lfr_pkt_nr_asm = (unsigned char) (i+1);
                     // (3) SET PACKET TIME
                     header->time[0] = (unsigned char) (coarseTime>>24);
                     header->time[1] = (unsigned char) (coarseTime>>16);
                     header->time[2] = (unsigned char) (coarseTime>>8);
                     header->time[3] = (unsigned char) (coarseTime);
                     header->time[4] = (unsigned char) (fineTime>>8);
                     header->time[5] = (unsigned char) (fineTime);
                     //
                     header->acquisitionTime[0] = header->time[0];
                     header->acquisitionTime[1] = header->time[1];
                     header->acquisitionTime[2] = header->time[2];
                     header->acquisitionTime[3] = header->time[3];
                     header->acquisitionTime[4] = header->time[4];
                     header->acquisitionTime[5] = header->time[5];
                     // (4) SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_ASM );
                     if (status != RTEMS_SUCCESSFUL) {
                         PRINTF1("in ASM_send *** ERR %d\n", (int) status)
                     }
                 }
             }
             void spw_send_asm_f2( ring_node *ring_node_to_send,
                                Header_TM_LFR_SCIENCE_ASM_t *header )
             {
                 unsigned int i;
                 unsigned int length = 0;
                 rtems_status_code status;
                 unsigned int sid;
                 float *spectral_matrix;
                 int coarseTime;
                 int fineTime;
                 spw_ioctl_pkt_send spw_ioctl_send_ASM;
                 sid = ring_node_to_send->sid;
                 spectral_matrix = (float*) ring_node_to_send->buffer_address;
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
                 header->biaStatusInfo = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<3; i++)
                 {
                     spw_ioctl_send_ASM.dlen = DLEN_ASM_F2_PKT;
                     spw_ioctl_send_ASM.data = (char *) &spectral_matrix[
                             ( (ASM_F2_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F2) ) * NB_VALUES_PER_SM )
                             ];
                     length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F2;
                     header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_3;
                     header->pa_lfr_asm_blk_nr[0] = (unsigned char)  ( (NB_BINS_PER_PKT_ASM_F2) >> 8 ); // BLK_NR MSB
                     header->pa_lfr_asm_blk_nr[1] = (unsigned char)    (NB_BINS_PER_PKT_ASM_F2);        // BLK_NR LSB
                     spw_ioctl_send_ASM.hlen = HEADER_LENGTH_TM_LFR_SCIENCE_ASM;
                     spw_ioctl_send_ASM.hdr = (char *) header;
                     spw_ioctl_send_ASM.options = 0;
                     // (2) BUILD THE HEADER
                     increment_seq_counter_source_id( header->packetSequenceControl, sid );
                     header->packetLength[0] = (unsigned char) (length>>8);
                     header->packetLength[1] = (unsigned char) (length);
                     header->sid = (unsigned char) sid;   // SID
                     header->pa_lfr_pkt_cnt_asm = 3;
                     header->pa_lfr_pkt_nr_asm = (unsigned char) (i+1);
                     // (3) SET PACKET TIME
                     header->time[0] = (unsigned char) (coarseTime>>24);
                     header->time[1] = (unsigned char) (coarseTime>>16);
                     header->time[2] = (unsigned char) (coarseTime>>8);
                     header->time[3] = (unsigned char) (coarseTime);
                     header->time[4] = (unsigned char) (fineTime>>8);
                     header->time[5] = (unsigned char) (fineTime);
                     //
                     header->acquisitionTime[0] = header->time[0];
                     header->acquisitionTime[1] = header->time[1];
                     header->acquisitionTime[2] = header->time[2];
                     header->acquisitionTime[3] = header->time[3];
                     header->acquisitionTime[4] = header->time[4];
                     header->acquisitionTime[5] = header->time[5];
                     // (4) SEND PACKET
                     status = ioctl( fdSPW, SPACEWIRE_IOCTRL_SEND, &spw_ioctl_send_ASM );
                     if (status != RTEMS_SUCCESSFUL) {
                         PRINTF1("in ASM_send *** ERR %d\n", (int) status)
                     }
                 }
             }
             void spw_send_k_dump( ring_node *ring_node_to_send )
             {
                 rtems_status_code status;
                 Packet_TM_LFR_KCOEFFICIENTS_DUMP_t *kcoefficients_dump;
                 unsigned int packetLength;
                 unsigned int size;
                 PRINTF("spw_send_k_dump\n")
                 kcoefficients_dump = (Packet_TM_LFR_KCOEFFICIENTS_DUMP_t *) ring_node_to_send->buffer_address;
                 packetLength = kcoefficients_dump->packetLength[0] * 256 + kcoefficients_dump->packetLength[1];
                 size = packetLength + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES;
                 PRINTF2("packetLength %d, size %d\n", packetLength, size )
                 status = write( fdSPW, (char *) ring_node_to_send->buffer_address, size );
                 if (status == -1){
                     PRINTF2("in SEND *** (2.a) ERRNO = %d, size = %d\n", errno, size)
                 }
                 ring_node_to_send->status = 0x00;
             }

src/processing/avf0_prc0.c +4 0

             /** Functions related to data processing.
              *
              * @file
              * @author P. LEROY
              *
              * These function are related to data processing, i.e. spectral matrices averaging and basic parameters computation.
              *
              */
             #include "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) {
                         PRINTF1("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.biaStatusInfo = pa_bia_status_info;
                         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.biaStatusInfo = pa_bia_status_info;
                             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.biaStatusInfo = pa_bia_status_info;
                         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.biaStatusInfo = pa_bia_status_info;
                             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,
                                                    (float*) current_ring_node_to_send_asm_f0->buffer_address,
                                                    nb_sm_before_f0.norm_bp1 );
                         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;
                     }
                     update_queue_max_count( queue_id_q_p0, &hk_lfr_q_p0_fifo_size_max );
                 }
             }
             //**********
             // 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_prc0( void )
             {
                 init_k_coefficients( k_coeff_intercalib_f0_norm, NB_BINS_COMPRESSED_SM_F0 );
                 init_kcoeff_sbm_from_kcoeff_norm( k_coeff_intercalib_f0_norm, k_coeff_intercalib_f0_sbm, NB_BINS_COMPRESSED_SM_F0);
             }

src/processing/avf1_prc1.c +4 0

             /** Functions related to data processing.
              *
              * @file
              * @author P. LEROY
              *
              * These function are related to data processing, i.e. spectral matrices averaging and basic parameters computation.
              *
              */
             #include "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) {
                         PRINTF1("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.biaStatusInfo = pa_bia_status_info;
                         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_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.biaStatusInfo = pa_bia_status_info;
                             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.biaStatusInfo = pa_bia_status_info;
                         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.biaStatusInfo = pa_bia_status_info;
                             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,
                                                    (float*) current_ring_node_to_send_asm_f1->buffer_address,
                                                    nb_sm_before_f1.norm_bp1 );
                         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;
                     }
                     update_queue_max_count( queue_id_q_p1, &hk_lfr_q_p1_fifo_size_max );
                 }
             }
             //**********
             // 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_prc1( void )
             {
                 init_k_coefficients( k_coeff_intercalib_f1_norm, NB_BINS_COMPRESSED_SM_F1 );
                 init_kcoeff_sbm_from_kcoeff_norm( k_coeff_intercalib_f1_norm, k_coeff_intercalib_f1_sbm, NB_BINS_COMPRESSED_SM_F1);
             }

src/processing/avf2_prc2.c +2 0

             /** Functions related to data processing.
              *
              * @file
              * @author P. LEROY
              *
              * These function are related to data processing, i.e. spectral matrices averaging and basic parameters computation.
              *
              */
             #include "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 );
                     // 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) {
                         PRINTF1("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.biaStatusInfo = pa_bia_status_info;
                         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.biaStatusInfo = pa_bia_status_info;
                         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,
                                                    (float*) current_ring_node_to_send_asm_f2->buffer_address,
                                                    nb_sm_before_f2.norm_bp1 );
                         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;
                     }
                     update_queue_max_count( queue_id_q_p2, &hk_lfr_q_p2_fifo_size_max );
                 }
             }
             //**********
             // 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_prc2( 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