HG_REPOSITORIES/LPP/INSTRUMENTATION/SOLO_LFR/DEV_PLE Commit - r243:e8fa8af1f64c

BP sending filtered depending on the lastValidEnterModeTime

paul -

r243:e8fa8af1f64c R3a

parent child

Context file:

r243:e8fa8af1f64c

Collapse all files

.hgsubstate +1 -1

@@ -1,2 +1,2
1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters	1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters
2	ff85ce82cd9845f180cb578272717bcb76b62cb5 header/lfr_common_headers	2	ce0c2f17257170a8529605f68687c18f23973087 header/lfr_common_headers

header/processing/fsw_processing.h +22 -19

             #ifndef FSW_PROCESSING_H_INCLUDED
             #define FSW_PROCESSING_H_INCLUDED
             #include <rtems.h>
             #include <grspw.h>
             #include <math.h>
             #include <stdlib.h> // abs() is in the stdlib
             #include <stdio.h>
             #include <math.h>
             #include <grlib_regs.h>
             #include "fsw_params.h"
             typedef struct ring_node_asm
             {
                 struct ring_node_asm *next;
                 float  matrix[ TOTAL_SIZE_SM ];
                 unsigned int status;
             } ring_node_asm;
             typedef struct
             {
                 unsigned char targetLogicalAddress;
                 unsigned char protocolIdentifier;
                 unsigned char reserved;
                 unsigned char userApplication;
                 unsigned char packetID[2];
                 unsigned char packetSequenceControl[2];
                 unsigned char packetLength[2];
                 // DATA FIELD HEADER
                 unsigned char spare1_pusVersion_spare2;
                 unsigned char serviceType;
                 unsigned char serviceSubType;
                 unsigned char destinationID;
                 unsigned char time[6];
                 // AUXILIARY HEADER
                 unsigned char sid;
                 unsigned char biaStatusInfo;
                 unsigned char sy_lfr_common_parameters_spare;
                 unsigned char sy_lfr_common_parameters;
                 unsigned char acquisitionTime[6];
                 unsigned char pa_lfr_bp_blk_nr[2];
                 // SOURCE DATA
                 unsigned char data[ 780 ];   // MAX size is 26 bins * 30 Bytes [TM_LFR_SCIENCE_BURST_BP2_F1]
             } bp_packet;
             typedef struct
             {
                 unsigned char targetLogicalAddress;
                 unsigned char protocolIdentifier;
                 unsigned char reserved;
                 unsigned char userApplication;
                 unsigned char packetID[2];
                 unsigned char packetSequenceControl[2];
                 unsigned char packetLength[2];
                 // DATA FIELD HEADER
                 unsigned char spare1_pusVersion_spare2;
                 unsigned char serviceType;
                 unsigned char serviceSubType;
                 unsigned char destinationID;
                 unsigned char time[6];
                 // AUXILIARY HEADER
                 unsigned char sid;
                 unsigned char biaStatusInfo;
                 unsigned char sy_lfr_common_parameters_spare;
                 unsigned char sy_lfr_common_parameters;
                 unsigned char acquisitionTime[6];
                 unsigned char source_data_spare;
                 unsigned char pa_lfr_bp_blk_nr[2];
                 // SOURCE DATA
                 unsigned char data[ 143 ];   // 13 bins  * 11 Bytes
             } bp_packet_with_spare; // only for TM_LFR_SCIENCE_NORMAL_BP1_F0 and F1
             typedef struct asm_msg
             {
                 ring_node_asm *norm;
                 ring_node_asm *burst_sbm;
                 rtems_event_set event;
                 unsigned int coarseTimeNORM;
                 unsigned int fineTimeNORM;
                 unsigned int coarseTimeSBM;
                 unsigned int fineTimeSBM;
             } asm_msg;
             extern volatile int sm_f0[ ];
             extern volatile int sm_f1[ ];
             extern volatile int sm_f2[ ];
             // parameters
             extern struct param_local_str param_local;
             extern Packet_TM_LFR_PARAMETER_DUMP_t parameter_dump_packet;
             // registers
             extern time_management_regs_t *time_management_regs;
             extern volatile spectral_matrix_regs_t *spectral_matrix_regs;
             extern rtems_name  misc_name[5];
             extern rtems_id    Task_id[20];         /* array of task ids */
             ring_node * getRingNodeForAveraging( unsigned char frequencyChannel);
             // ISR
             rtems_isr spectral_matrices_isr( rtems_vector_number vector );
             //******************
             // Spectral Matrices
             void reset_nb_sm( void );
             // SM
             void SM_init_rings( void );
             void SM_reset_current_ring_nodes( void );
             // ASM
             void ASM_generic_init_ring(ring_node_asm *ring, unsigned char nbNodes );
             //*****************
             // Basic Parameters
             void BP_reset_current_ring_nodes( void );
             void BP_init_header(bp_packet *packet,
-                                 unsigned int apid, unsigned char sid,
+                                unsigned int apid, unsigned char sid,
-                                 unsigned int packetLength , unsigned char blkNr);
+                                unsigned int packetLength , unsigned char blkNr);
             void BP_init_header_with_spare(bp_packet_with_spare *packet,
-                                            unsigned int apid, unsigned char sid,
+                                           unsigned int apid, unsigned char sid,
-                                            unsigned int packetLength, unsigned char blkNr );
+                                           unsigned int packetLength, unsigned char blkNr );
             void BP_send( char *data,
-                          rtems_id queue_id ,
+                          rtems_id queue_id,
                           unsigned int nbBytesToSend , unsigned int sid );
+            void BP_send_s1_s2(char *data,
+                               rtems_id queue_id,
+                               unsigned int nbBytesToSend, unsigned int sid );
             //******************
             // general functions
             void reset_sm_status( void );
             void reset_spectral_matrix_regs( void );
             void set_time(unsigned char *time, unsigned char *timeInBuffer );
             unsigned long long int get_acquisition_time( unsigned char *timePtr );
             unsigned char getSID( rtems_event_set event );
             extern rtems_status_code get_message_queue_id_prc1( rtems_id *queue_id );
             extern rtems_status_code get_message_queue_id_prc2( rtems_id *queue_id );
             //***************************************
             // DEFINITIONS OF STATIC INLINE FUNCTIONS
             static inline void SM_average(float *averaged_spec_mat_NORM, float *averaged_spec_mat_SBM,
                                           ring_node *ring_node_tab[],
                                           unsigned int nbAverageNORM, unsigned int nbAverageSBM,
                                           asm_msg *msgForMATR );
             static inline void SM_average_debug(float *averaged_spec_mat_NORM, float *averaged_spec_mat_SBM,
-                                          ring_node *ring_node_tab[],
+                                                ring_node *ring_node_tab[],
-                                          unsigned int nbAverageNORM, unsigned int nbAverageSBM,
+                                                unsigned int nbAverageNORM, unsigned int nbAverageSBM,
-                                          asm_msg *msgForMATR );
+                                                asm_msg *msgForMATR );
             void ASM_patch( float *inputASM, float *outputASM );
             void extractReImVectors(float *inputASM, float *outputASM, unsigned int asmComponent );
             static inline void ASM_reorganize_and_divide(float *averaged_spec_mat, float *averaged_spec_mat_reorganized,
-                                           float divider );
+                                                         float divider );
             static inline void ASM_compress_reorganize_and_divide(float *averaged_spec_mat, float *compressed_spec_mat,
-                                              float divider,
+                                                                  float divider,
-                                              unsigned char nbBinsCompressedMatrix, unsigned char nbBinsToAverage , unsigned char ASMIndexStart);
+                                                                  unsigned char nbBinsCompressedMatrix, unsigned char nbBinsToAverage , unsigned char ASMIndexStart);
             static inline void ASM_convert(volatile float *input_matrix, char *output_matrix);
             void SM_average( float *averaged_spec_mat_NORM, float *averaged_spec_mat_SBM,
                              ring_node *ring_node_tab[],
                              unsigned int nbAverageNORM, unsigned int nbAverageSBM,
                              asm_msg *msgForMATR )
             {
                 float sum;
                 unsigned int i;
                 for(i=0; i<TOTAL_SIZE_SM; i++)
                 {
                     sum = ( (int *) (ring_node_tab[0]->buffer_address) ) [ i ]
                             + ( (int *) (ring_node_tab[1]->buffer_address) ) [ i ]
                             + ( (int *) (ring_node_tab[2]->buffer_address) ) [ i ]
                             + ( (int *) (ring_node_tab[3]->buffer_address) ) [ i ]
                             + ( (int *) (ring_node_tab[4]->buffer_address) ) [ i ]
                             + ( (int *) (ring_node_tab[5]->buffer_address) ) [ i ]
                             + ( (int *) (ring_node_tab[6]->buffer_address) ) [ i ]
                             + ( (int *) (ring_node_tab[7]->buffer_address) ) [ i ];
                     if ( (nbAverageNORM == 0) && (nbAverageSBM == 0) )
                     {
                         averaged_spec_mat_NORM[ i ] = sum;
                         averaged_spec_mat_SBM[  i ] = sum;
                         msgForMATR->coarseTimeNORM  = ring_node_tab[0]->coarseTime;
                         msgForMATR->fineTimeNORM    = ring_node_tab[0]->fineTime;
                         msgForMATR->coarseTimeSBM   = ring_node_tab[0]->coarseTime;
                         msgForMATR->fineTimeSBM     = ring_node_tab[0]->fineTime;
                     }
                     else if ( (nbAverageNORM != 0) && (nbAverageSBM != 0) )
                     {
                         averaged_spec_mat_NORM[ i ] = ( averaged_spec_mat_NORM[  i ] + sum );
                         averaged_spec_mat_SBM[  i ] = ( averaged_spec_mat_SBM[   i ] + sum );
                     }
                     else if ( (nbAverageNORM != 0) && (nbAverageSBM == 0) )
                     {
                         averaged_spec_mat_NORM[ i ] = ( averaged_spec_mat_NORM[ i ] + sum );
                         averaged_spec_mat_SBM[  i ] = sum;
                         msgForMATR->coarseTimeSBM   = ring_node_tab[0]->coarseTime;
                         msgForMATR->fineTimeSBM     = ring_node_tab[0]->fineTime;
                     }
                     else
                     {
                         averaged_spec_mat_NORM[ i ] = sum;
                         averaged_spec_mat_SBM[  i ] = ( averaged_spec_mat_SBM[   i ] + sum );
                         msgForMATR->coarseTimeNORM   = ring_node_tab[0]->coarseTime;
                         msgForMATR->fineTimeNORM     = ring_node_tab[0]->fineTime;
-            //            PRINTF2("ERR *** in SM_average *** unexpected parameters %d %d\n", nbAverageNORM, nbAverageSBM)
+                        //            PRINTF2("ERR *** in SM_average *** unexpected parameters %d %d\n", nbAverageNORM, nbAverageSBM)
                     }
                 }
             }
             void SM_average_debug( float *averaged_spec_mat_NORM, float *averaged_spec_mat_SBM,
-                             ring_node *ring_node_tab[],
+                                   ring_node *ring_node_tab[],
-                             unsigned int nbAverageNORM, unsigned int nbAverageSBM,
+                                   unsigned int nbAverageNORM, unsigned int nbAverageSBM,
-                             asm_msg *msgForMATR )
+                                   asm_msg *msgForMATR )
             {
                 float sum;
                 unsigned int i;
                 for(i=0; i<TOTAL_SIZE_SM; i++)
                 {
                     sum = ( (int *) (ring_node_tab[0]->buffer_address) ) [ i ];
                     averaged_spec_mat_NORM[ i ] = sum;
                     averaged_spec_mat_SBM[  i ] = sum;
                     msgForMATR->coarseTimeNORM  = ring_node_tab[0]->coarseTime;
                     msgForMATR->fineTimeNORM    = ring_node_tab[0]->fineTime;
                     msgForMATR->coarseTimeSBM   = ring_node_tab[0]->coarseTime;
                     msgForMATR->fineTimeSBM     = ring_node_tab[0]->fineTime;
                 }
             }
             void ASM_reorganize_and_divide( float *averaged_spec_mat, float *averaged_spec_mat_reorganized, float divider )
             {
                 int frequencyBin;
                 int asmComponent;
                 unsigned int offsetASM;
                 unsigned int offsetASMReorganized;
                 // BUILD DATA
                 for (asmComponent = 0; asmComponent < NB_VALUES_PER_SM; asmComponent++)
                 {
                     for( frequencyBin = 0; frequencyBin < NB_BINS_PER_SM; frequencyBin++ )
                     {
                         offsetASMReorganized =
                                 frequencyBin * NB_VALUES_PER_SM
                                 + asmComponent;
                         offsetASM            =
                                 asmComponent * NB_BINS_PER_SM
                                 + frequencyBin;
                         averaged_spec_mat_reorganized[offsetASMReorganized  ] =
                                 averaged_spec_mat[ offsetASM ] / divider;
                     }
                 }
             }
             void ASM_compress_reorganize_and_divide(float *averaged_spec_mat, float *compressed_spec_mat , float divider,
-                                             unsigned char nbBinsCompressedMatrix, unsigned char nbBinsToAverage, unsigned char ASMIndexStart )
+                                                    unsigned char nbBinsCompressedMatrix, unsigned char nbBinsToAverage, unsigned char ASMIndexStart )
             {
                 int frequencyBin;
                 int asmComponent;
                 int offsetASM;
                 int offsetCompressed;
                 int k;
                 // BUILD DATA
                 for (asmComponent = 0; asmComponent < NB_VALUES_PER_SM; asmComponent++)
                 {
                     for( frequencyBin = 0; frequencyBin < nbBinsCompressedMatrix; frequencyBin++ )
                     {
                         offsetCompressed =  // NO TIME OFFSET
                                 frequencyBin * NB_VALUES_PER_SM
                                 + asmComponent;
                         offsetASM =         // NO TIME OFFSET
                                 asmComponent * NB_BINS_PER_SM
                                 + ASMIndexStart
                                 + frequencyBin * nbBinsToAverage;
                         compressed_spec_mat[ offsetCompressed ] = 0;
                         for ( k = 0; k < nbBinsToAverage; k++ )
                         {
                             compressed_spec_mat[offsetCompressed ] =
                                     ( compressed_spec_mat[ offsetCompressed ]
-                                    + averaged_spec_mat[ offsetASM + k ] );
+                                      + averaged_spec_mat[ offsetASM + k ] );
                         }
                         compressed_spec_mat[ offsetCompressed ] =
                                 compressed_spec_mat[ offsetCompressed ] / (divider * nbBinsToAverage);
                     }
                 }
             }
             void ASM_convert( volatile float *input_matrix, char *output_matrix)
             {
                 unsigned int frequencyBin;
                 unsigned int asmComponent;
                 char * pt_char_input;
                 char * pt_char_output;
                 unsigned int offsetInput;
                 unsigned int offsetOutput;
                 pt_char_input = (char*) &input_matrix;
                 pt_char_output = (char*) &output_matrix;
                 // convert all other data
                 for( frequencyBin=0; frequencyBin<NB_BINS_PER_SM; frequencyBin++)
                 {
                     for ( asmComponent=0; asmComponent<NB_VALUES_PER_SM; asmComponent++)
                     {
                         offsetInput  =       (frequencyBin*NB_VALUES_PER_SM) + asmComponent   ;
                         offsetOutput = 2 * ( (frequencyBin*NB_VALUES_PER_SM) + asmComponent ) ;
                         pt_char_input =  (char*) &input_matrix [ offsetInput  ];
                         pt_char_output = (char*) &output_matrix[ offsetOutput ];
                         pt_char_output[0] = pt_char_input[0];   // bits 31 downto 24 of the float
                         pt_char_output[1] = pt_char_input[1];   // bits 23 downto 16 of the float
                     }
                 }
             }
             void ASM_compress_reorganize_and_divide_mask(float *averaged_spec_mat, float *compressed_spec_mat,
-                                              float divider,
+                                                         float divider,
-                                              unsigned char nbBinsCompressedMatrix, unsigned char nbBinsToAverage , unsigned char ASMIndexStart, unsigned char channel);
+                                                         unsigned char nbBinsCompressedMatrix, unsigned char nbBinsToAverage , unsigned char ASMIndexStart, unsigned char channel);
             int getFBinMask(int k, unsigned char channel);
             void init_kcoeff_sbm_from_kcoeff_norm( float *input_kcoeff, float *output_kcoeff, unsigned char nb_bins_norm);
             #endif // FSW_PROCESSING_H_INCLUDED

header/tc_handler.h +2 -1

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

src/fsw_globals.c +2 -1

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

src/processing/avf0_prc0.c +2 -2

             /** 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_mask( 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, CHANNELF0);
                         // 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,
+                        BP_send_s1_s2( (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,
+                            BP_send_s1_s2( (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_mask( 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, CHANNELF0 );
                         // 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 +2 -2

             /** 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_mask( 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, CHANNELF1);
                         // 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,
+                        BP_send_s1_s2( (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,
+                            BP_send_s1_s2( (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_mask( 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, CHANNELF1 );
                         // 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/fsw_processing.c +28 0

             /** Functions related to data processing.
              *
              * @file
              * @author P. LEROY
              *
              * These function are related to data processing, i.e. spectral matrices averaging and basic parameters computation.
              *
              */
             #include "fsw_processing.h"
             #include "fsw_processing_globals.c"
             #include "fsw_init.h"
             unsigned int nb_sm_f0;
             unsigned int nb_sm_f0_aux_f1;
             unsigned int nb_sm_f1;
             unsigned int nb_sm_f0_aux_f2;
             //************************
             // spectral matrices rings
             ring_node sm_ring_f0[ NB_RING_NODES_SM_F0 ];
             ring_node sm_ring_f1[ NB_RING_NODES_SM_F1 ];
             ring_node sm_ring_f2[ NB_RING_NODES_SM_F2 ];
             ring_node *current_ring_node_sm_f0;
             ring_node *current_ring_node_sm_f1;
             ring_node *current_ring_node_sm_f2;
             ring_node *ring_node_for_averaging_sm_f0;
             ring_node *ring_node_for_averaging_sm_f1;
             ring_node *ring_node_for_averaging_sm_f2;
             //
             ring_node * getRingNodeForAveraging( unsigned char frequencyChannel)
             {
                 ring_node *node;
                 node = NULL;
                 switch ( frequencyChannel ) {
                 case 0:
                     node = ring_node_for_averaging_sm_f0;
                     break;
                 case 1:
                     node = ring_node_for_averaging_sm_f1;
                     break;
                 case 2:
                     node = ring_node_for_averaging_sm_f2;
                     break;
                 default:
                     break;
                 }
                 return node;
             }
             //***********************************************************
             // Interrupt Service Routine for spectral matrices processing
             void spectral_matrices_isr_f0( unsigned char statusReg )
             {
                 unsigned char status;
                 rtems_status_code status_code;
                 ring_node *full_ring_node;
                 status = statusReg & 0x03;   // [0011] get the status_ready_matrix_f0_x bits
                 switch(status)
                 {
                 case 0:
                     break;
                 case 3:
                     // UNEXPECTED VALUE
                     spectral_matrix_regs->status = 0x03;   // [0011]
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_11 );
                     break;
                 case 1:
                     full_ring_node = current_ring_node_sm_f0->previous;
                     full_ring_node->coarseTime = spectral_matrix_regs->f0_0_coarse_time;
                     full_ring_node->fineTime = spectral_matrix_regs->f0_0_fine_time;
                     current_ring_node_sm_f0 = current_ring_node_sm_f0->next;
                     spectral_matrix_regs->f0_0_address = current_ring_node_sm_f0->buffer_address;
                     // if there are enough ring nodes ready, wake up an AVFx task
                     nb_sm_f0 = nb_sm_f0 + 1;
                     if (nb_sm_f0 == NB_SM_BEFORE_AVF0)
                     {
                         ring_node_for_averaging_sm_f0 = full_ring_node;
                         if (rtems_event_send( Task_id[TASKID_AVF0], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                         {
                             status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                         }
                         nb_sm_f0 = 0;
                     }
                     spectral_matrix_regs->status = 0x01;   // [0000 0001]
                     break;
                 case 2:
                     full_ring_node = current_ring_node_sm_f0->previous;
                     full_ring_node->coarseTime = spectral_matrix_regs->f0_1_coarse_time;
                     full_ring_node->fineTime = spectral_matrix_regs->f0_1_fine_time;
                     current_ring_node_sm_f0 = current_ring_node_sm_f0->next;
                     spectral_matrix_regs->f0_1_address = current_ring_node_sm_f0->buffer_address;
                     // if there are enough ring nodes ready, wake up an AVFx task
                     nb_sm_f0 = nb_sm_f0 + 1;
                     if (nb_sm_f0 == NB_SM_BEFORE_AVF0)
                     {
                         ring_node_for_averaging_sm_f0 = full_ring_node;
                         if (rtems_event_send( Task_id[TASKID_AVF0], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                         {
                             status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                         }
                         nb_sm_f0 = 0;
                     }
                     spectral_matrix_regs->status = 0x02;   // [0000 0010]
                     break;
                 }
             }
             void spectral_matrices_isr_f1( unsigned char statusReg )
             {
                 rtems_status_code status_code;
                 unsigned char status;
                 ring_node *full_ring_node;
                 status = (statusReg & 0x0c) >> 2;   // [1100] get the status_ready_matrix_f0_x bits
                 switch(status)
                 {
                 case 0:
                     break;
                 case 3:
                     // UNEXPECTED VALUE
                     spectral_matrix_regs->status = 0xc0;   // [1100]
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_11 );
                     break;
                 case 1:
                     full_ring_node = current_ring_node_sm_f1->previous;
                     full_ring_node->coarseTime = spectral_matrix_regs->f1_0_coarse_time;
                     full_ring_node->fineTime = spectral_matrix_regs->f1_0_fine_time;
                     current_ring_node_sm_f1 = current_ring_node_sm_f1->next;
                     spectral_matrix_regs->f1_0_address = current_ring_node_sm_f1->buffer_address;
                     // if there are enough ring nodes ready, wake up an AVFx task
                     nb_sm_f1 = nb_sm_f1 + 1;
                     if (nb_sm_f1 == NB_SM_BEFORE_AVF1)
                     {
                         ring_node_for_averaging_sm_f1 = full_ring_node;
                         if (rtems_event_send( Task_id[TASKID_AVF1], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                         {
                             status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                         }
                         nb_sm_f1 = 0;
                     }
                     spectral_matrix_regs->status = 0x04;   // [0000 0100]
                     break;
                 case 2:
                     full_ring_node = current_ring_node_sm_f1->previous;
                     full_ring_node->coarseTime = spectral_matrix_regs->f1_1_coarse_time;
                     full_ring_node->fineTime = spectral_matrix_regs->f1_1_fine_time;
                     current_ring_node_sm_f1 = current_ring_node_sm_f1->next;
                     spectral_matrix_regs->f1_1_address = current_ring_node_sm_f1->buffer_address;
                     // if there are enough ring nodes ready, wake up an AVFx task
                     nb_sm_f1 = nb_sm_f1 + 1;
                     if (nb_sm_f1 == NB_SM_BEFORE_AVF1)
                     {
                         ring_node_for_averaging_sm_f1 = full_ring_node;
                         if (rtems_event_send( Task_id[TASKID_AVF1], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                         {
                             status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                         }
                         nb_sm_f1 = 0;
                     }
                     spectral_matrix_regs->status = 0x08;   // [1000 0000]
                     break;
                 }
             }
             void spectral_matrices_isr_f2( unsigned char statusReg )
             {
                 unsigned char status;
                 rtems_status_code status_code;
                 status = (statusReg & 0x30) >> 4;   // [0011 0000] get the status_ready_matrix_f0_x bits
                 switch(status)
                 {
                 case 0:
                     break;
                 case 3:
                     // UNEXPECTED VALUE
                     spectral_matrix_regs->status = 0x30;   // [0011 0000]
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_11 );
                     break;
                 case 1:
                     ring_node_for_averaging_sm_f2 = current_ring_node_sm_f2->previous;
                     current_ring_node_sm_f2 = current_ring_node_sm_f2->next;
                     ring_node_for_averaging_sm_f2->coarseTime = spectral_matrix_regs->f2_0_coarse_time;
                     ring_node_for_averaging_sm_f2->fineTime = spectral_matrix_regs->f2_0_fine_time;
                     spectral_matrix_regs->f2_0_address = current_ring_node_sm_f2->buffer_address;
                     spectral_matrix_regs->status = 0x10;   // [0001 0000]
                     if (rtems_event_send( Task_id[TASKID_AVF2], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                     {
                         status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                     }
                     break;
                 case 2:
                     ring_node_for_averaging_sm_f2 = current_ring_node_sm_f2->previous;
                     current_ring_node_sm_f2 = current_ring_node_sm_f2->next;
                     ring_node_for_averaging_sm_f2->coarseTime = spectral_matrix_regs->f2_1_coarse_time;
                     ring_node_for_averaging_sm_f2->fineTime = spectral_matrix_regs->f2_1_fine_time;
                     spectral_matrix_regs->f2_1_address = current_ring_node_sm_f2->buffer_address;
                     spectral_matrix_regs->status = 0x20;   // [0010 0000]
                     if (rtems_event_send( Task_id[TASKID_AVF2], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
                     {
                         status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
                     }
                     break;
                 }
             }
             void spectral_matrix_isr_error_handler( unsigned char statusReg )
             {
                 rtems_status_code status_code;
                 if (statusReg & 0x7c0)    // [0111 1100 0000]
                 {
                     status_code = rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_8 );
                 }
                 spectral_matrix_regs->status = spectral_matrix_regs->status & 0x7c0;
             }
             rtems_isr spectral_matrices_isr( rtems_vector_number vector )
             {
                 // STATUS REGISTER
                 // input_fifo_write(2) *** input_fifo_write(1) *** input_fifo_write(0)
                 //           10                    9                       8
                 // buffer_full ** bad_component_err ** f2_1 ** f2_0 ** f1_1 ** f1_0 ** f0_1 ** f0_0
                 //      7                  6             5       4       3       2       1       0
                 unsigned char statusReg;
                 statusReg = spectral_matrix_regs->status;
                 spectral_matrices_isr_f0( statusReg );
                 spectral_matrices_isr_f1( statusReg );
                 spectral_matrices_isr_f2( statusReg );
                 spectral_matrix_isr_error_handler( statusReg );
             }
             //******************
             // Spectral Matrices
             void reset_nb_sm( void )
             {
                 nb_sm_f0 = 0;
                 nb_sm_f0_aux_f1 = 0;
                 nb_sm_f0_aux_f2 = 0;
                 nb_sm_f1 = 0;
             }
             void SM_init_rings( void )
             {
                 init_ring( sm_ring_f0, NB_RING_NODES_SM_F0, sm_f0, TOTAL_SIZE_SM );
                 init_ring( sm_ring_f1, NB_RING_NODES_SM_F1, sm_f1, TOTAL_SIZE_SM );
                 init_ring( sm_ring_f2, NB_RING_NODES_SM_F2, sm_f2, TOTAL_SIZE_SM );
                 DEBUG_PRINTF1("sm_ring_f0 @%x\n", (unsigned int) sm_ring_f0)
                 DEBUG_PRINTF1("sm_ring_f1 @%x\n", (unsigned int) sm_ring_f1)
                 DEBUG_PRINTF1("sm_ring_f2 @%x\n", (unsigned int) sm_ring_f2)
                 DEBUG_PRINTF1("sm_f0 @%x\n", (unsigned int) sm_f0)
                 DEBUG_PRINTF1("sm_f1 @%x\n", (unsigned int) sm_f1)
                 DEBUG_PRINTF1("sm_f2 @%x\n", (unsigned int) sm_f2)
             }
             void ASM_generic_init_ring( ring_node_asm *ring, unsigned char nbNodes )
             {
                 unsigned char i;
                 ring[ nbNodes - 1 ].next
                         = (ring_node_asm*) &ring[ 0 ];
                 for(i=0; i<nbNodes-1; i++)
                 {
                     ring[ i ].next            = (ring_node_asm*) &ring[ i + 1 ];
                 }
             }
             void SM_reset_current_ring_nodes( void )
             {
                 current_ring_node_sm_f0 = sm_ring_f0[0].next;
                 current_ring_node_sm_f1 = sm_ring_f1[0].next;
                 current_ring_node_sm_f2 = sm_ring_f2[0].next;
                 ring_node_for_averaging_sm_f0 = NULL;
                 ring_node_for_averaging_sm_f1 = NULL;
                 ring_node_for_averaging_sm_f2 = NULL;
             }
             //*****************
             // Basic Parameters
             void BP_init_header( bp_packet *packet,
                                  unsigned int apid, unsigned char sid,
                                  unsigned int packetLength, unsigned char blkNr )
             {
                 packet->targetLogicalAddress = CCSDS_DESTINATION_ID;
                 packet->protocolIdentifier = CCSDS_PROTOCOLE_ID;
                 packet->reserved = 0x00;
                 packet->userApplication = CCSDS_USER_APP;
                 packet->packetID[0] = (unsigned char) (apid >> 8);
                 packet->packetID[1] = (unsigned char) (apid);
                 packet->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 packet->packetSequenceControl[1] = 0x00;
                 packet->packetLength[0] = (unsigned char) (packetLength >> 8);
                 packet->packetLength[1] = (unsigned char) (packetLength);
                 // DATA FIELD HEADER
                 packet->spare1_pusVersion_spare2 = 0x10;
                 packet->serviceType = TM_TYPE_LFR_SCIENCE; // service type
                 packet->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_3; // service subtype
                 packet->destinationID = TM_DESTINATION_ID_GROUND;
                 packet->time[0] = 0x00;
                 packet->time[1] = 0x00;
                 packet->time[2] = 0x00;
                 packet->time[3] = 0x00;
                 packet->time[4] = 0x00;
                 packet->time[5] = 0x00;
                 // AUXILIARY DATA HEADER
                 packet->sid = sid;
                 packet->biaStatusInfo = 0x00;
                 packet->sy_lfr_common_parameters_spare = 0x00;
                 packet->sy_lfr_common_parameters = 0x00;
                 packet->acquisitionTime[0] = 0x00;
                 packet->acquisitionTime[1] = 0x00;
                 packet->acquisitionTime[2] = 0x00;
                 packet->acquisitionTime[3] = 0x00;
                 packet->acquisitionTime[4] = 0x00;
                 packet->acquisitionTime[5] = 0x00;
                 packet->pa_lfr_bp_blk_nr[0] = 0x00;  // BLK_NR MSB
                 packet->pa_lfr_bp_blk_nr[1] = blkNr;  // BLK_NR LSB
             }
             void BP_init_header_with_spare( bp_packet_with_spare *packet,
                                             unsigned int apid, unsigned char sid,
                                             unsigned int packetLength , unsigned char blkNr)
             {
                 packet->targetLogicalAddress = CCSDS_DESTINATION_ID;
                 packet->protocolIdentifier = CCSDS_PROTOCOLE_ID;
                 packet->reserved = 0x00;
                 packet->userApplication = CCSDS_USER_APP;
                 packet->packetID[0] = (unsigned char) (apid >> 8);
                 packet->packetID[1] = (unsigned char) (apid);
                 packet->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                 packet->packetSequenceControl[1] = 0x00;
                 packet->packetLength[0] = (unsigned char) (packetLength >> 8);
                 packet->packetLength[1] = (unsigned char) (packetLength);
                 // DATA FIELD HEADER
                 packet->spare1_pusVersion_spare2 = 0x10;
                 packet->serviceType = TM_TYPE_LFR_SCIENCE; // service type
                 packet->serviceSubType = TM_SUBTYPE_LFR_SCIENCE_3; // service subtype
                 packet->destinationID = TM_DESTINATION_ID_GROUND;
                 // AUXILIARY DATA HEADER
                 packet->sid = sid;
                 packet->biaStatusInfo = 0x00;
                 packet->sy_lfr_common_parameters_spare = 0x00;
                 packet->sy_lfr_common_parameters = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->time[0] = 0x00;
                 packet->source_data_spare = 0x00;
                 packet->pa_lfr_bp_blk_nr[0] = 0x00;  // BLK_NR MSB
                 packet->pa_lfr_bp_blk_nr[1] = blkNr;  // BLK_NR LSB
             }
             void BP_send(char *data, rtems_id queue_id, unsigned int nbBytesToSend, unsigned int sid )
             {
                 rtems_status_code status;
                 // SEND PACKET
                 status =  rtems_message_queue_send( queue_id, data, nbBytesToSend);
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in BP_send *** ERR %d\n", (int) status)
                 }
             }
+            void BP_send_s1_s2(char *data, rtems_id queue_id, unsigned int nbBytesToSend, unsigned int sid )
+            {
+                /** This function is used to send the BP paquets when needed.
+                 *
+                 * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
+                 *
+                 * @return void
+                 *
+                 * SBM1 and SBM2 paquets are sent depending on the type of the LFR mode transition.
+                 * BURST paquets are sent everytime.
+                 *
+                 */
+                rtems_status_code status;
+                // SEND PACKET
+                // before lastValidTransitionDate, the data are drops even if they are ready
+                // this guarantees that no SBM packets will be received before the requestion enter mode time
+                if ( time_management_regs->coarse_time >= lastValidEnterModeTime)
+                {
+                    status =  rtems_message_queue_send( queue_id, data, nbBytesToSend);
+                    if (status != RTEMS_SUCCESSFUL)
+                    {
+                        PRINTF1("ERR *** in BP_send *** ERR %d\n", (int) status)
+                    }
+                }
+            }
             //******************
             // general functions
             void reset_sm_status( void )
             {
                 // error
                 // 10 --------------- 9 ---------------- 8 ---------------- 7 ---------
                 // input_fif0_write_2 input_fifo_write_1 input_fifo_write_0 buffer_full
                 // ---------- 5 -- 4 -- 3 -- 2 -- 1 -- 0 --
                 // ready bits f2_1 f2_0 f1_1 f1_1 f0_1 f0_0
                 spectral_matrix_regs->status = 0x7ff;   // [0111 1111 1111]
             }
             void reset_spectral_matrix_regs( void )
             {
                 /** This function resets the spectral matrices module registers.
                  *
                  * The registers affected by this function are located at the following offset addresses:
                  *
                  * - 0x00 config
                  * - 0x04 status
                  * - 0x08 matrixF0_Address0
                  * - 0x10 matrixFO_Address1
                  * - 0x14 matrixF1_Address
                  * - 0x18 matrixF2_Address
                  *
                  */
                 set_sm_irq_onError( 0 );
                 set_sm_irq_onNewMatrix( 0 );
                 reset_sm_status();
                 // F1
                 spectral_matrix_regs->f0_0_address = current_ring_node_sm_f0->previous->buffer_address;
                 spectral_matrix_regs->f0_1_address = current_ring_node_sm_f0->buffer_address;
                 // F2
                 spectral_matrix_regs->f1_0_address = current_ring_node_sm_f1->previous->buffer_address;
                 spectral_matrix_regs->f1_1_address = current_ring_node_sm_f1->buffer_address;
                 // F3
                 spectral_matrix_regs->f2_0_address = current_ring_node_sm_f2->previous->buffer_address;
                 spectral_matrix_regs->f2_1_address = current_ring_node_sm_f2->buffer_address;
                 spectral_matrix_regs->matrix_length = 0xc8; // 25 * 128 / 16 = 200 = 0xc8
             }
             void set_time( unsigned char *time, unsigned char * timeInBuffer )
             {
                 time[0] = timeInBuffer[0];
                 time[1] = timeInBuffer[1];
                 time[2] = timeInBuffer[2];
                 time[3] = timeInBuffer[3];
                 time[4] = timeInBuffer[6];
                 time[5] = timeInBuffer[7];
             }
             unsigned long long int get_acquisition_time( unsigned char *timePtr )
             {
                 unsigned long long int acquisitionTimeAslong;
                 acquisitionTimeAslong = 0x00;
                 acquisitionTimeAslong = ( (unsigned long long int) (timePtr[0] & 0x7f) << 40 ) // [0111 1111] mask the synchronization bit
                         + ( (unsigned long long int) timePtr[1] << 32 )
                         + ( (unsigned long long int) timePtr[2] << 24 )
                         + ( (unsigned long long int) timePtr[3] << 16 )
                         + ( (unsigned long long int) timePtr[6] << 8  )
                         + ( (unsigned long long int) timePtr[7]       );
                 return acquisitionTimeAslong;
             }
             unsigned char getSID( rtems_event_set event )
             {
                 unsigned char sid;
                 rtems_event_set eventSetBURST;
                 rtems_event_set eventSetSBM;
                 //******
                 // BURST
                 eventSetBURST = RTEMS_EVENT_BURST_BP1_F0
                         | RTEMS_EVENT_BURST_BP1_F1
                         | RTEMS_EVENT_BURST_BP2_F0
                         | RTEMS_EVENT_BURST_BP2_F1;
                 //****
                 // SBM
                 eventSetSBM = RTEMS_EVENT_SBM_BP1_F0
                         | RTEMS_EVENT_SBM_BP1_F1
                         | RTEMS_EVENT_SBM_BP2_F0
                         | RTEMS_EVENT_SBM_BP2_F1;
                 if (event & eventSetBURST)
                 {
                     sid = SID_BURST_BP1_F0;
                 }
                 else if (event & eventSetSBM)
                 {
                     sid = SID_SBM1_BP1_F0;
                 }
                 else
                 {
                     sid = 0;
                 }
                 return sid;
             }
             void extractReImVectors( float *inputASM, float *outputASM, unsigned int asmComponent )
             {
                 unsigned int i;
                 float re;
                 float im;
                 for (i=0; i<NB_BINS_PER_SM; i++){
                     re = inputASM[ (asmComponent*NB_BINS_PER_SM) + i * 2    ];
                     im = inputASM[ (asmComponent*NB_BINS_PER_SM) + i * 2 + 1];
                     outputASM[ (asmComponent   *NB_BINS_PER_SM)  +  i] = re;
                     outputASM[ (asmComponent+1)*NB_BINS_PER_SM   +  i] = im;
                 }
             }
             void copyReVectors( float *inputASM, float *outputASM, unsigned int asmComponent )
             {
                 unsigned int i;
                 float re;
                 for (i=0; i<NB_BINS_PER_SM; i++){
                     re = inputASM[ (asmComponent*NB_BINS_PER_SM) + i];
                     outputASM[ (asmComponent*NB_BINS_PER_SM)  +  i] = re;
                 }
             }
             void ASM_patch( float *inputASM, float *outputASM )
             {
                 extractReImVectors( inputASM, outputASM, 1);    // b1b2
                 extractReImVectors( inputASM, outputASM, 3 );   // b1b3
                 extractReImVectors( inputASM, outputASM, 5 );   // b1e1
                 extractReImVectors( inputASM, outputASM, 7 );   // b1e2
                 extractReImVectors( inputASM, outputASM, 10 );  // b2b3
                 extractReImVectors( inputASM, outputASM, 12 );  // b2e1
                 extractReImVectors( inputASM, outputASM, 14 );  // b2e2
                 extractReImVectors( inputASM, outputASM, 17 );  // b3e1
                 extractReImVectors( inputASM, outputASM, 19 );  // b3e2
                 extractReImVectors( inputASM, outputASM, 22 );  // e1e2
                 copyReVectors(inputASM, outputASM, 0 );    // b1b1
                 copyReVectors(inputASM, outputASM, 9 );    // b2b2
                 copyReVectors(inputASM, outputASM, 16);    // b3b3
                 copyReVectors(inputASM, outputASM, 21);    // e1e1
                 copyReVectors(inputASM, outputASM, 24);    // e2e2
             }
             void ASM_compress_reorganize_and_divide_mask(float *averaged_spec_mat, float *compressed_spec_mat , float divider,
                                                          unsigned char nbBinsCompressedMatrix, unsigned char nbBinsToAverage,
                                                          unsigned char ASMIndexStart,
                                                          unsigned char channel )
             {
                 //*************
                 // input format
                 // component0[0 .. 127] component1[0 .. 127] .. component24[0 .. 127]
                 //**************
                 // output format
                 // matr0[0 .. 24]      matr1[0 .. 24]       .. matr127[0 .. 24]
                 //************
                 // compression
                 // matr0[0 .. 24]      matr1[0 .. 24]       .. matr11[0 .. 24] => f0 NORM
                 // matr0[0 .. 24]      matr1[0 .. 24]       .. matr22[0 .. 24] => f0 BURST, SBM
                 int frequencyBin;
                 int asmComponent;
                 int offsetASM;
                 int offsetCompressed;
                 int offsetFBin;
                 int fBinMask;
                 int k;
                 // BUILD DATA
                 for (asmComponent = 0; asmComponent < NB_VALUES_PER_SM; asmComponent++)
                 {
                     for( frequencyBin = 0; frequencyBin < nbBinsCompressedMatrix; frequencyBin++ )
                     {
                         offsetCompressed =  // NO TIME OFFSET
                                 frequencyBin * NB_VALUES_PER_SM
                                 + asmComponent;
                         offsetASM =         // NO TIME OFFSET
                                 asmComponent * NB_BINS_PER_SM
                                 + ASMIndexStart
                                 + frequencyBin * nbBinsToAverage;
                         offsetFBin = ASMIndexStart
                                 + frequencyBin * nbBinsToAverage;
                         compressed_spec_mat[ offsetCompressed ] = 0;
                         for ( k = 0; k < nbBinsToAverage; k++ )
                         {
                             fBinMask = getFBinMask( offsetFBin + k, channel );
                             compressed_spec_mat[offsetCompressed ] =
                                     ( compressed_spec_mat[ offsetCompressed ]
                                     + averaged_spec_mat[ offsetASM + k ] * fBinMask );
                         }
                         compressed_spec_mat[ offsetCompressed ] =
                                 compressed_spec_mat[ offsetCompressed ] / (divider * nbBinsToAverage);
                     }
                 }
             }
             int getFBinMask( int index, unsigned char channel )
             {
                 unsigned int indexInChar;
                 unsigned int indexInTheChar;
                 int fbin;
                 unsigned char *sy_lfr_fbins_fx_word1;
                 sy_lfr_fbins_fx_word1 = parameter_dump_packet.sy_lfr_fbins_f0_word1;
                 switch(channel)
                 {
                 case 0:
                     sy_lfr_fbins_fx_word1 = parameter_dump_packet.sy_lfr_fbins_f0_word1;
                     break;
                 case 1:
                     sy_lfr_fbins_fx_word1 = parameter_dump_packet.sy_lfr_fbins_f1_word1;
                     break;
                 case 2:
                     sy_lfr_fbins_fx_word1 = parameter_dump_packet.sy_lfr_fbins_f2_word1;
                     break;
                 default:
                     PRINTF("ERR *** in getFBinMask, wrong frequency channel")
                 }
                 indexInChar = index >> 3;
                 indexInTheChar = index - indexInChar * 8;
                 fbin = (int) ((sy_lfr_fbins_fx_word1[ NB_BYTES_PER_FREQ_MASK - 1 - indexInChar] >> indexInTheChar) & 0x1);
                 return fbin;
             }
             void init_kcoeff_sbm_from_kcoeff_norm(float *input_kcoeff, float *output_kcoeff, unsigned char nb_bins_norm)
             {
                 unsigned char bin;
                 unsigned char kcoeff;
                 for (bin=0; bin<nb_bins_norm; bin++)
                 {
                     for (kcoeff=0; kcoeff<NB_K_COEFF_PER_BIN; kcoeff++)
                     {
                         output_kcoeff[ (bin*NB_K_COEFF_PER_BIN + kcoeff)*2     ] = input_kcoeff[ bin*NB_K_COEFF_PER_BIN + kcoeff ];
                         output_kcoeff[ (bin*NB_K_COEFF_PER_BIN + kcoeff)*2 + 1 ] = input_kcoeff[ bin*NB_K_COEFF_PER_BIN + kcoeff ];
                     }
                 }
             }

src/tc_handler.c +16 -2

             /** Functions and tasks related to TeleCommand handling.
              *
              * @file
              * @author P. LEROY
              *
              * A group of functions to handle TeleCommands:\n
              * action launching\n
              * TC parsing\n
              * ...
              *
              */
             #include "tc_handler.h"
             #include "math.h"
             //***********
             // RTEMS TASK
             rtems_task actn_task( rtems_task_argument unused )
             {
                 /** This RTEMS task is responsible for launching actions upton the reception of valid TeleCommands.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The ACTN task waits for data coming from an RTEMS msesage queue. When data arrives, it launches specific actions depending
                  * on the incoming TeleCommand.
                  *
                  */
                 int result;
                 rtems_status_code status;       // RTEMS status code
                 ccsdsTelecommandPacket_t TC;    // TC sent to the ACTN task
                 size_t size;                    // size of the incoming TC packet
                 unsigned char subtype;          // subtype of the current TC packet
                 unsigned char time[6];
                 rtems_id queue_rcv_id;
                 rtems_id queue_snd_id;
                 status =  get_message_queue_id_recv( &queue_rcv_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in ACTN *** ERR get_message_queue_id_recv %d\n", status)
                 }
                 status =  get_message_queue_id_send( &queue_snd_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in ACTN *** ERR get_message_queue_id_send %d\n", status)
                 }
                 result = LFR_SUCCESSFUL;
                 subtype = 0;          // subtype of the current TC packet
                 BOOT_PRINTF("in ACTN *** \n")
                         while(1)
                 {
                     status = rtems_message_queue_receive( queue_rcv_id, (char*) &TC, &size,
                                                           RTEMS_WAIT, RTEMS_NO_TIMEOUT);
                     getTime( time );    // set time to the current time
                     if (status!=RTEMS_SUCCESSFUL)
                     {
                         PRINTF1("ERR *** in task ACTN *** error receiving a message, code %d \n", status)
                     }
                     else
                     {
                         subtype = TC.serviceSubType;
                         switch(subtype)
                         {
                         case TC_SUBTYPE_RESET:
                             result = action_reset( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_COMM:
                             result = action_load_common_par( &TC );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_NORM:
                             result = action_load_normal_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_BURST:
                             result = action_load_burst_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_SBM1:
                             result = action_load_sbm1_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_SBM2:
                             result = action_load_sbm2_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_DUMP:
                             result = action_dump_par( &TC,  queue_snd_id );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_ENTER:
                             result = action_enter_mode( &TC, queue_snd_id );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_UPDT_INFO:
                             result = action_update_info( &TC, queue_snd_id );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_EN_CAL:
                             result = action_enable_calibration( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_DIS_CAL:
                             result = action_disable_calibration( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_K:
                             result = action_load_kcoefficients( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_DUMP_K:
                             result = action_dump_kcoefficients( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_LOAD_FBINS:
                             result = action_load_fbins_mask( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_UPDT_TIME:
                             result = action_update_time( &TC );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         default:
                             break;
                         }
                     }
                 }
             }
             //***********
             // TC ACTIONS
             int action_reset(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function executes specific actions when a TC_LFR_RESET TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  */
                 PRINTF("this is the end!!!\n")
                         exit(0);
                 send_tm_lfr_tc_exe_not_implemented( TC, queue_id, time );
                 return LFR_DEFAULT;
             }
             int action_enter_mode(ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
             {
                 /** This function executes specific actions when a TC_LFR_ENTER_MODE TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  */
                 rtems_status_code status;
                 unsigned char requestedMode;
                 unsigned int *transitionCoarseTime_ptr;
                 unsigned int transitionCoarseTime;
                 unsigned char * bytePosPtr;
                 bytePosPtr = (unsigned char *) &TC->packetID;
                 requestedMode = bytePosPtr[ BYTE_POS_CP_MODE_LFR_SET ];
                 transitionCoarseTime_ptr = (unsigned int *) ( &bytePosPtr[ BYTE_POS_CP_LFR_ENTER_MODE_TIME ] );
                 transitionCoarseTime = (*transitionCoarseTime_ptr) & 0x7fffffff;
                 status = check_mode_value( requestedMode );
                 if ( status != LFR_SUCCESSFUL )     // the mode value is inconsistent
                 {
                     send_tm_lfr_tc_exe_inconsistent( TC, queue_id, BYTE_POS_CP_MODE_LFR_SET, requestedMode );
                 }
                 else                                // the mode value is valid, check the transition
                 {
                     status = check_mode_transition(requestedMode);
                     if (status != LFR_SUCCESSFUL)
                     {
                         PRINTF("ERR *** in action_enter_mode *** check_mode_transition\n")
                                 send_tm_lfr_tc_exe_not_executable( TC, queue_id );
                     }
                 }
                 if ( status == LFR_SUCCESSFUL )     // the transition is valid, check the date
                 {
                     status = check_transition_date( transitionCoarseTime );
                     if (status != LFR_SUCCESSFUL)
                     {
                         PRINTF("ERR *** in action_enter_mode *** check_transition_date\n")
                                 send_tm_lfr_tc_exe_inconsistent( TC, queue_id,
                                                                  BYTE_POS_CP_LFR_ENTER_MODE_TIME,
                                                                  bytePosPtr[ BYTE_POS_CP_LFR_ENTER_MODE_TIME + 3 ] );
                     }
                 }
                 if ( status == LFR_SUCCESSFUL )     // the date is valid, enter the mode
                 {
                     PRINTF1("OK  *** in action_enter_mode *** enter mode %d\n", requestedMode);
+                    update_last_valid_transition_date( transitionCoarseTime );
                     switch(requestedMode)
                     {
                     case LFR_MODE_STANDBY:
                         status = enter_mode_standby();
                         break;
                     case LFR_MODE_NORMAL:
                         status = enter_mode_normal( transitionCoarseTime );
                         break;
                     case LFR_MODE_BURST:
                         status = enter_mode_burst( transitionCoarseTime );
                         break;
                     case LFR_MODE_SBM1:
                         status = enter_mode_sbm1( transitionCoarseTime );
                         break;
                     case LFR_MODE_SBM2:
                         status = enter_mode_sbm2( transitionCoarseTime );
                         break;
                     default:
                         break;
                     }
                 }
                 return status;
             }
             int action_update_info(ccsdsTelecommandPacket_t *TC, rtems_id queue_id)
             {
                 /** This function executes specific actions when a TC_LFR_UPDATE_INFO TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  * @return LFR directive status code:
                  * - LFR_DEFAULT
                  * - LFR_SUCCESSFUL
                  *
                  */
                 unsigned int val;
                 int result;
                 unsigned int status;
                 unsigned char mode;
                 unsigned char * bytePosPtr;
                 bytePosPtr = (unsigned char *) &TC->packetID;
                 // check LFR mode
                 mode = (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET5 ] & 0x1e) >> 1;
                 status = check_update_info_hk_lfr_mode( mode );
                 if (status == LFR_SUCCESSFUL)  // check TDS mode
                 {
                     mode = (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET6 ] & 0xf0) >> 4;
                     status = check_update_info_hk_tds_mode( mode );
                 }
                 if (status == LFR_SUCCESSFUL)  // check THR mode
                 {
                     mode = (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET6 ] & 0x0f);
                     status = check_update_info_hk_thr_mode( mode );
                 }
                 if (status == LFR_SUCCESSFUL)  // if the parameter check is successful
                 {
                     val = housekeeping_packet.hk_lfr_update_info_tc_cnt[0] * 256
                             + housekeeping_packet.hk_lfr_update_info_tc_cnt[1];
                     val++;
                     housekeeping_packet.hk_lfr_update_info_tc_cnt[0] = (unsigned char) (val >> 8);
                     housekeeping_packet.hk_lfr_update_info_tc_cnt[1] = (unsigned char) (val);
                 }
                 // pa_bia_status_info
                 // => pa_bia_mode_mux_set       3 bits
                 // => pa_bia_mode_hv_enabled    1 bit
                 // => pa_bia_mode_bias1_enabled 1 bit
                 // => pa_bia_mode_bias2_enabled 1 bit
                 // => pa_bia_mode_bias3_enabled 1 bit
                 // => pa_bia_on_off (cp_dpu_bias_on_off)
                 pa_bia_status_info = bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET2 ] & 0xfe; // [1111 1110]
                 pa_bia_status_info = pa_bia_status_info
                         | (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET1 ] & 0x1);
                 result = status;
                 return result;
             }
             int action_enable_calibration(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function executes specific actions when a TC_LFR_ENABLE_CALIBRATION TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  */
                 int result;
                 result = LFR_DEFAULT;
                 setCalibration( true );
                 result = LFR_SUCCESSFUL;
                 return result;
             }
             int action_disable_calibration(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
             {
                 /** This function executes specific actions when a TC_LFR_DISABLE_CALIBRATION TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  */
                 int result;
                 result = LFR_DEFAULT;
                 setCalibration( false );
                 result = LFR_SUCCESSFUL;
                 return result;
             }
             int action_update_time(ccsdsTelecommandPacket_t *TC)
             {
                 /** This function executes specific actions when a TC_LFR_UPDATE_TIME TeleCommand has been received.
                  *
                  * @param TC points to the TeleCommand packet that is being processed
                  * @param queue_id is the id of the queue which handles TM transmission by the SpaceWire driver
                  *
                  * @return LFR_SUCCESSFUL
                  *
                  */
                 unsigned int val;
                 time_management_regs->coarse_time_load = (TC->dataAndCRC[0] << 24)
                         + (TC->dataAndCRC[1] << 16)
                         + (TC->dataAndCRC[2] << 8)
                         + TC->dataAndCRC[3];
                 val = housekeeping_packet.hk_lfr_update_time_tc_cnt[0] * 256
                         + housekeeping_packet.hk_lfr_update_time_tc_cnt[1];
                 val++;
                 housekeeping_packet.hk_lfr_update_time_tc_cnt[0] = (unsigned char) (val >> 8);
                 housekeeping_packet.hk_lfr_update_time_tc_cnt[1] = (unsigned char) (val);
                 return LFR_SUCCESSFUL;
             }
             //*******************
             // ENTERING THE MODES
             int check_mode_value( unsigned char requestedMode )
             {
                 int status;
                 if ( (requestedMode != LFR_MODE_STANDBY)
                      && (requestedMode != LFR_MODE_NORMAL) && (requestedMode != LFR_MODE_BURST)
                      && (requestedMode != LFR_MODE_SBM1) && (requestedMode != LFR_MODE_SBM2) )
                 {
                     status = LFR_DEFAULT;
                 }
                 else
                 {
                     status = LFR_SUCCESSFUL;
                 }
                 return status;
             }
             int check_mode_transition( unsigned char requestedMode )
             {
                 /** This function checks the validity of the transition requested by the TC_LFR_ENTER_MODE.
                  *
                  * @param requestedMode is the mode requested by the TC_LFR_ENTER_MODE
                  *
                  * @return LFR directive status codes:
                  * - LFR_SUCCESSFUL - the transition is authorized
                  * - LFR_DEFAULT - the transition is not authorized
                  *
                  */
                 int status;
                 switch (requestedMode)
                 {
                 case LFR_MODE_STANDBY:
                     if ( lfrCurrentMode == LFR_MODE_STANDBY ) {
                         status = LFR_DEFAULT;
                     }
                     else
                     {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 case LFR_MODE_NORMAL:
                     if ( lfrCurrentMode == LFR_MODE_NORMAL ) {
                         status = LFR_DEFAULT;
                     }
                     else {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 case LFR_MODE_BURST:
                     if ( lfrCurrentMode == LFR_MODE_BURST ) {
                         status = LFR_DEFAULT;
                     }
                     else {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 case LFR_MODE_SBM1:
                     if ( lfrCurrentMode == LFR_MODE_SBM1 ) {
                         status = LFR_DEFAULT;
                     }
                     else {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 case LFR_MODE_SBM2:
                     if ( lfrCurrentMode == LFR_MODE_SBM2 ) {
                         status = LFR_DEFAULT;
                     }
                     else {
                         status = LFR_SUCCESSFUL;
                     }
                     break;
                 default:
                     status = LFR_DEFAULT;
                     break;
                 }
                 return status;
             }
             void update_last_valid_transition_date(unsigned int transitionCoarseTime)
             {
-                lastValidTransitionDate = transitionCoarseTime;
+                lastValidEnterModeTime = transitionCoarseTime;
             }
             int check_transition_date( unsigned int transitionCoarseTime )
             {
                 int status;
                 unsigned int localCoarseTime;
                 unsigned int deltaCoarseTime;
                 status = LFR_SUCCESSFUL;
                 if (transitionCoarseTime == 0)  // transition time = 0 means an instant transition
                 {
                     status = LFR_SUCCESSFUL;
                 }
                 else
                 {
                     localCoarseTime = time_management_regs->coarse_time & 0x7fffffff;
                     PRINTF2("localTime = %x, transitionTime = %x\n", localCoarseTime, transitionCoarseTime)
                             if ( transitionCoarseTime <= localCoarseTime )   // SSS-CP-EQS-322
                     {
                         status = LFR_DEFAULT;
                         PRINTF("ERR *** in check_transition_date *** transitionCoarseTime <= localCoarseTime\n")
                     }
                     if (status == LFR_SUCCESSFUL)
                     {
                         deltaCoarseTime = transitionCoarseTime - localCoarseTime;
                         if ( deltaCoarseTime > 3 )                  // SSS-CP-EQS-323
                         {
                             status = LFR_DEFAULT;
                             PRINTF1("ERR *** in check_transition_date *** deltaCoarseTime = %x\n", deltaCoarseTime)
                         }
                     }
                 }
                 return status;
             }
             int restart_asm_activities( unsigned char lfrRequestedMode )
             {
                 rtems_status_code status;
                 status = stop_spectral_matrices();
                 status = restart_asm_tasks( lfrRequestedMode );
                 launch_spectral_matrix();
                 return status;
             }
             int stop_spectral_matrices( void )
             {
                 /** This function stops and restarts the current mode average spectral matrices activities.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_ALREADY_SUSPENDED - task already suspended
                  *
                  */
                 rtems_status_code status;
                 status = RTEMS_SUCCESSFUL;
                 // (1) mask interruptions
                 LEON_Mask_interrupt( IRQ_SPECTRAL_MATRIX );     // clear spectral matrix interrupt
                 // (2) reset spectral matrices registers
                 set_sm_irq_onNewMatrix( 0 );                    // stop the spectral matrices
                 reset_sm_status();
                 // (3) clear interruptions
                 LEON_Clear_interrupt( IRQ_SPECTRAL_MATRIX );    // clear spectral matrix interrupt
                 // suspend several tasks
                 if (lfrCurrentMode != LFR_MODE_STANDBY) {
                     status = suspend_asm_tasks();
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in stop_current_mode *** in suspend_science_tasks *** ERR code: %d\n", status)
                 }
                 return status;
             }
             int stop_current_mode( void )
             {
                 /** This function stops the current mode by masking interrupt lines and suspending science tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_ALREADY_SUSPENDED - task already suspended
                  *
                  */
                 rtems_status_code status;
                 status = RTEMS_SUCCESSFUL;
                 // (1) mask interruptions
                 LEON_Mask_interrupt( IRQ_WAVEFORM_PICKER );     // mask waveform picker interrupt
                 LEON_Mask_interrupt( IRQ_SPECTRAL_MATRIX );     // clear spectral matrix interrupt
                 // (2) reset waveform picker registers
                 reset_wfp_burst_enable();                       // reset burst and enable bits
                 reset_wfp_status();                             // reset all the status bits
                 // (3) reset spectral matrices registers
                 set_sm_irq_onNewMatrix( 0 );                    // stop the spectral matrices
                 reset_sm_status();
                 // reset lfr VHDL module
                 reset_lfr();
                 reset_extractSWF();                             // reset the extractSWF flag to false
                 // (4) clear interruptions
                 LEON_Clear_interrupt( IRQ_WAVEFORM_PICKER );    // clear waveform picker interrupt
                 LEON_Clear_interrupt( IRQ_SPECTRAL_MATRIX );    // clear spectral matrix interrupt
                 // suspend several tasks
                 if (lfrCurrentMode != LFR_MODE_STANDBY) {
                     status = suspend_science_tasks();
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in stop_current_mode *** in suspend_science_tasks *** ERR code: %d\n", status)
                 }
                 return status;
             }
             int enter_mode_standby()
             {
                 /** This function is used to put LFR in the STANDBY mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The STANDBY mode does not depends on a specific transition date, the effect of the TC_LFR_ENTER_MODE
                  * is immediate.
                  *
                  */
                 int status;
                 status = stop_current_mode();       // STOP THE CURRENT MODE
+                lfrTransitionType = TRANSITION_NOT_SPECIFIC;
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_report();
             #endif
             #ifdef PRINT_STACK_REPORT
                 PRINTF("stack report selected\n")
                 rtems_stack_checker_report_usage();
             #endif
                 return status;
             }
             int enter_mode_normal( unsigned int transitionCoarseTime )
             {
                 /** This function is used to start the NORMAL mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The way the NORMAL mode is started depends on the LFR current mode. If LFR is in SBM1 or SBM2,
                  * the snapshots are not restarted, only ASM, BP and CWF data generation are affected.
                  *
                  */
                 int status;
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_reset();
             #endif
                 status = RTEMS_UNSATISFIED;
                 switch( lfrCurrentMode )
                 {
                 case LFR_MODE_STANDBY:
+                    lfrTransitionType = TRANSITION_NOT_SPECIFIC;
                     status = restart_science_tasks( LFR_MODE_NORMAL ); // restart science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_NORMAL, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_BURST:
+                    lfrTransitionType = TRANSITION_NOT_SPECIFIC;
                     status = stop_current_mode();           // stop the current mode
                     status = restart_science_tasks( LFR_MODE_NORMAL ); // restart the science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_NORMAL, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_SBM1:
+                    lfrTransitionType = TRANSITION_S1_TO_NORM;
                     restart_asm_activities( LFR_MODE_NORMAL ); //  this is necessary to restart ASM tasks to update the parameters
                     status = LFR_SUCCESSFUL;                   // lfrCurrentMode will be updated after the execution of close_action
                     break;
                 case LFR_MODE_SBM2:
+                    lfrTransitionType = TRANSITION_S2_TO_NORM;
                     restart_asm_activities( LFR_MODE_NORMAL ); //  this is necessary to restart ASM tasks to update the parameters
                     status = LFR_SUCCESSFUL;                   // lfrCurrentMode will be updated after the execution of close_action
                     break;
                 default:
                     break;
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in enter_mode_normal *** status = %d\n", status)
                             status = RTEMS_UNSATISFIED;
                 }
                 return status;
             }
             int enter_mode_burst( unsigned int transitionCoarseTime )
             {
                 /** This function is used to start the BURST mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The way the BURST mode is started does not depend on the LFR current mode.
                  *
                  */
                 int status;
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_reset();
             #endif
+                lfrTransitionType = TRANSITION_NOT_SPECIFIC;
                 status = stop_current_mode();           // stop the current mode
                 status = restart_science_tasks( LFR_MODE_BURST ); // restart the science tasks
                 if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                 {
                     launch_spectral_matrix( );
                     launch_waveform_picker( LFR_MODE_BURST, transitionCoarseTime );
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in enter_mode_burst *** status = %d\n", status)
                             status = RTEMS_UNSATISFIED;
                 }
                 return status;
             }
             int enter_mode_sbm1( unsigned int transitionCoarseTime )
             {
                 /** This function is used to start the SBM1 mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The way the SBM1 mode is started depends on the LFR current mode. If LFR is in NORMAL or SBM2,
                  * the snapshots are not restarted, only ASM, BP and CWF data generation are affected. In other
                  * cases, the acquisition is completely restarted.
                  *
                  */
                 int status;
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_reset();
             #endif
                 status = RTEMS_UNSATISFIED;
                 switch( lfrCurrentMode )
                 {
                 case LFR_MODE_STANDBY:
+                    lfrTransitionType = TRANSITION_NOT_SPECIFIC;
                     status = restart_science_tasks( LFR_MODE_SBM1 ); // restart science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_SBM1, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_NORMAL:                       // lfrCurrentMode will be updated after the execution of close_action
+                    lfrTransitionType = TRANSITION_NORM_TO_S1;
                     restart_asm_activities( LFR_MODE_SBM1 );
                     status = LFR_SUCCESSFUL;
                     break;
                 case LFR_MODE_BURST:
+                    lfrTransitionType = TRANSITION_NOT_SPECIFIC;
                     status = stop_current_mode();           // stop the current mode
                     status = restart_science_tasks( LFR_MODE_SBM1 ); // restart the science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_SBM1, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_SBM2:
+                    lfrTransitionType = TRANSITION_S2_TO_S1;
                     restart_asm_activities( LFR_MODE_SBM1 );
                     status = LFR_SUCCESSFUL;                // lfrCurrentMode will be updated after the execution of close_action
                     break;
                 default:
                     break;
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in enter_mode_sbm1 *** status = %d\n", status)
                             status = RTEMS_UNSATISFIED;
                 }
                 return status;
             }
             int enter_mode_sbm2( unsigned int transitionCoarseTime )
             {
                 /** This function is used to start the SBM2 mode.
                  *
                  * @param transitionCoarseTime is the requested transition time contained in the TC_LFR_ENTER_MODE
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * The way the SBM2 mode is started depends on the LFR current mode. If LFR is in NORMAL or SBM1,
                  * the snapshots are not restarted, only ASM, BP and CWF data generation are affected. In other
                  * cases, the acquisition is completely restarted.
                  *
                  */
                 int status;
             #ifdef PRINT_TASK_STATISTICS
                 rtems_cpu_usage_reset();
             #endif
                 status = RTEMS_UNSATISFIED;
                 switch( lfrCurrentMode )
                 {
                 case LFR_MODE_STANDBY:
+                    lfrTransitionType = TRANSITION_NOT_SPECIFIC;
                     status = restart_science_tasks( LFR_MODE_SBM2 ); // restart science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_SBM2, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_NORMAL:
+                    lfrTransitionType = TRANSITION_NORM_TO_S2;
                     restart_asm_activities( LFR_MODE_SBM2 );
                     status = LFR_SUCCESSFUL;                // lfrCurrentMode will be updated after the execution of close_action
                     break;
                 case LFR_MODE_BURST:
+                    lfrTransitionType = TRANSITION_NOT_SPECIFIC;
                     status = stop_current_mode();           // stop the current mode
                     status = restart_science_tasks( LFR_MODE_SBM2 ); // restart the science tasks
                     if (status == RTEMS_SUCCESSFUL)         // relaunch spectral_matrix and waveform_picker modules
                     {
                         launch_spectral_matrix( );
                         launch_waveform_picker( LFR_MODE_SBM2, transitionCoarseTime );
                     }
                     break;
                 case LFR_MODE_SBM1:
+                    lfrTransitionType = TRANSITION_S1_TO_S2;
                     restart_asm_activities( LFR_MODE_SBM2 );
                     status = LFR_SUCCESSFUL;                // lfrCurrentMode will be updated after the execution of close_action
                     break;
                 default:
                     break;
                 }
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("ERR *** in enter_mode_sbm2 *** status = %d\n", status)
                             status = RTEMS_UNSATISFIED;
                 }
                 return status;
             }
             int restart_science_tasks( unsigned char lfrRequestedMode )
             {
                 /** This function is used to restart all science tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * Science tasks are AVF0, PRC0, WFRM, CWF3, CW2, CWF1
                  *
                  */
                 rtems_status_code status[10];
                 rtems_status_code ret;
                 ret = RTEMS_SUCCESSFUL;
                 status[0] = rtems_task_restart( Task_id[TASKID_AVF0], lfrRequestedMode );
                 if (status[0] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF0 ERR %d\n", status[0])
                 }
                 status[1] = rtems_task_restart( Task_id[TASKID_PRC0], lfrRequestedMode );
                 if (status[1] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC0 ERR %d\n", status[1])
                 }
                 status[2] = rtems_task_restart( Task_id[TASKID_WFRM],1 );
                 if (status[2] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** WFRM ERR %d\n", status[2])
                 }
                 status[3] = rtems_task_restart( Task_id[TASKID_CWF3],1 );
                 if (status[3] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** CWF3 ERR %d\n", status[3])
                 }
                 status[4] = rtems_task_restart( Task_id[TASKID_CWF2],1 );
                 if (status[4] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** CWF2 ERR %d\n", status[4])
                 }
                 status[5] = rtems_task_restart( Task_id[TASKID_CWF1],1 );
                 if (status[5] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** CWF1 ERR %d\n", status[5])
                 }
                 status[6] = rtems_task_restart( Task_id[TASKID_AVF1], lfrRequestedMode );
                 if (status[6] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF1 ERR %d\n", status[6])
                 }
                 status[7] = rtems_task_restart( Task_id[TASKID_PRC1],lfrRequestedMode );
                 if (status[7] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC1 ERR %d\n", status[7])
                 }
                 status[8] = rtems_task_restart( Task_id[TASKID_AVF2], 1 );
                 if (status[8] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF2 ERR %d\n", status[8])
                 }
                 status[9] = rtems_task_restart( Task_id[TASKID_PRC2], 1 );
                 if (status[9] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC2 ERR %d\n", status[9])
                 }
                 if ( (status[0] != RTEMS_SUCCESSFUL) || (status[1] != RTEMS_SUCCESSFUL) ||
                      (status[2] != RTEMS_SUCCESSFUL) || (status[3] != RTEMS_SUCCESSFUL) ||
                      (status[4] != RTEMS_SUCCESSFUL) || (status[5] != RTEMS_SUCCESSFUL) ||
                      (status[6] != RTEMS_SUCCESSFUL) || (status[7] != RTEMS_SUCCESSFUL) ||
                      (status[8] != RTEMS_SUCCESSFUL) || (status[9] != RTEMS_SUCCESSFUL) )
                 {
                     ret = RTEMS_UNSATISFIED;
                 }
                 return ret;
             }
             int restart_asm_tasks( unsigned char lfrRequestedMode )
             {
                 /** This function is used to restart average spectral matrices tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_INCORRECT_STATE - task never started
                  * - RTEMS_ILLEGAL_ON_REMOTE_OBJECT - cannot restart remote task
                  *
                  * ASM tasks are AVF0, PRC0, AVF1, PRC1, AVF2 and PRC2
                  *
                  */
                 rtems_status_code status[6];
                 rtems_status_code ret;
                 ret = RTEMS_SUCCESSFUL;
                 status[0] = rtems_task_restart( Task_id[TASKID_AVF0], lfrRequestedMode );
                 if (status[0] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF0 ERR %d\n", status[0])
                 }
                 status[1] = rtems_task_restart( Task_id[TASKID_PRC0], lfrRequestedMode );
                 if (status[1] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC0 ERR %d\n", status[1])
                 }
                 status[2] = rtems_task_restart( Task_id[TASKID_AVF1], lfrRequestedMode );
                 if (status[2] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF1 ERR %d\n", status[2])
                 }
                 status[3] = rtems_task_restart( Task_id[TASKID_PRC1],lfrRequestedMode );
                 if (status[3] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC1 ERR %d\n", status[3])
                 }
                 status[4] = rtems_task_restart( Task_id[TASKID_AVF2], 1 );
                 if (status[4] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** AVF2 ERR %d\n", status[4])
                 }
                 status[5] = rtems_task_restart( Task_id[TASKID_PRC2], 1 );
                 if (status[5] != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in restart_science_task *** PRC2 ERR %d\n", status[5])
                 }
                 if ( (status[0] != RTEMS_SUCCESSFUL) || (status[1] != RTEMS_SUCCESSFUL) ||
                      (status[2] != RTEMS_SUCCESSFUL) || (status[3] != RTEMS_SUCCESSFUL) ||
                      (status[4] != RTEMS_SUCCESSFUL) || (status[5] != RTEMS_SUCCESSFUL) )
                 {
                     ret = RTEMS_UNSATISFIED;
                 }
                 return ret;
             }
             int suspend_science_tasks( void )
             {
                 /** This function suspends the science tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_ALREADY_SUSPENDED - task already suspended
                  *
                  */
                 rtems_status_code status;
                 PRINTF("in suspend_science_tasks\n")
                         status = rtems_task_suspend( Task_id[TASKID_AVF0] );    // suspend AVF0
                 if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                 {
                     PRINTF1("in suspend_science_task *** AVF0 ERR %d\n", status)
                 }
                 else
                 {
                     status = RTEMS_SUCCESSFUL;
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC0
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC0] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC0 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend AVF1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_AVF1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** AVF1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend AVF2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_AVF2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** AVF2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend WFRM
                 {
                     status = rtems_task_suspend( Task_id[TASKID_WFRM] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** WFRM ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend CWF3
                 {
                     status = rtems_task_suspend( Task_id[TASKID_CWF3] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** CWF3 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend CWF2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_CWF2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** CWF2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend CWF1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_CWF1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** CWF1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 return status;
             }
             int suspend_asm_tasks( void )
             {
                 /** This function suspends the science tasks.
                  *
                  * @return RTEMS directive status codes:
                  * - RTEMS_SUCCESSFUL - task restarted successfully
                  * - RTEMS_INVALID_ID - task id invalid
                  * - RTEMS_ALREADY_SUSPENDED - task already suspended
                  *
                  */
                 rtems_status_code status;
                 PRINTF("in suspend_science_tasks\n")
                         status = rtems_task_suspend( Task_id[TASKID_AVF0] );    // suspend AVF0
                 if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                 {
                     PRINTF1("in suspend_science_task *** AVF0 ERR %d\n", status)
                 }
                 else
                 {
                     status = RTEMS_SUCCESSFUL;
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC0
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC0] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC0 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend AVF1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_AVF1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** AVF1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC1
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC1] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC1 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend AVF2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_AVF2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** AVF2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 if (status == RTEMS_SUCCESSFUL)        // suspend PRC2
                 {
                     status = rtems_task_suspend( Task_id[TASKID_PRC2] );
                     if ((status != RTEMS_SUCCESSFUL) && (status != RTEMS_ALREADY_SUSPENDED))
                     {
                         PRINTF1("in suspend_science_task *** PRC2 ERR %d\n", status)
                     }
                     else
                     {
                         status = RTEMS_SUCCESSFUL;
                     }
                 }
                 return status;
             }
             void launch_waveform_picker( unsigned char mode, unsigned int transitionCoarseTime )
             {
                 WFP_reset_current_ring_nodes();
                 reset_waveform_picker_regs();
                 set_wfp_burst_enable_register( mode );
                 LEON_Clear_interrupt( IRQ_WAVEFORM_PICKER );
                 LEON_Unmask_interrupt( IRQ_WAVEFORM_PICKER );
                 if (transitionCoarseTime == 0)
                 {
                     waveform_picker_regs->start_date = time_management_regs->coarse_time;
                 }
                 else
                 {
                     waveform_picker_regs->start_date = transitionCoarseTime;
                 }
             }
             void launch_spectral_matrix( void )
             {
                 SM_reset_current_ring_nodes();
                 reset_spectral_matrix_regs();
                 reset_nb_sm();
                 set_sm_irq_onNewMatrix( 1 );
                 LEON_Clear_interrupt( IRQ_SPECTRAL_MATRIX );
                 LEON_Unmask_interrupt( IRQ_SPECTRAL_MATRIX );
             }
             void set_sm_irq_onNewMatrix( unsigned char value )
             {
                 if (value == 1)
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config | 0x01;
                 }
                 else
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config & 0xfffffffe;   // 1110
                 }
             }
             void set_sm_irq_onError( unsigned char value )
             {
                 if (value == 1)
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config | 0x02;
                 }
                 else
                 {
                     spectral_matrix_regs->config = spectral_matrix_regs->config & 0xfffffffd;   // 1101
                 }
             }
             //*****************************
             // CONFIGURE CALIBRATION SIGNAL
             void setCalibrationPrescaler( unsigned int prescaler )
             {
                 // prescaling of the master clock (25 MHz)
                 // master clock is divided by 2^prescaler
                 time_management_regs->calPrescaler = prescaler;
             }
             void setCalibrationDivisor( unsigned int divisionFactor )
             {
                 // division of the prescaled clock by the division factor
                 time_management_regs->calDivisor = divisionFactor;
             }
             void setCalibrationData( void ){
                 unsigned int k;
                 unsigned short data;
                 float val;
                 float f0;
                 float f1;
                 float fs;
                 float Ts;
                 float scaleFactor;
                 f0 = 625;
                 f1 = 10000;
                 fs = 160256.410;
                 Ts = 1. / fs;
                 scaleFactor = 0.250 / 0.000654; // 191, 500 mVpp, 2 sinus waves => 500 mVpp each, amplitude = 250 mV
                 time_management_regs->calDataPtr = 0x00;
                 // build the signal for the SCM calibration
                 for (k=0; k<256; k++)
                 {
                     val = sin( 2 * pi * f0 * k * Ts )
                             + sin(  2 * pi * f1 * k * Ts );
                     data = (unsigned short) ((val * scaleFactor) + 2048);
                     time_management_regs->calData = data & 0xfff;
                 }
             }
             void setCalibrationDataInterleaved( void ){
                 unsigned int k;
                 float val;
                 float f0;
                 float f1;
                 float fs;
                 float Ts;
                 unsigned short data[384];
                 unsigned char *dataPtr;
                 f0 = 625;
                 f1 = 10000;
                 fs = 240384.615;
                 Ts = 1. / fs;
                 time_management_regs->calDataPtr = 0x00;
                 // build the signal for the SCM calibration
                 for (k=0; k<384; k++)
                 {
                     val = sin( 2 * pi * f0 * k * Ts )
                             + sin(  2 * pi * f1 * k * Ts );
                     data[k] = (unsigned short) (val * 512 + 2048);
                 }
                 // write the signal in interleaved mode
                 for (k=0; k<128; k++)
                 {
                     dataPtr = (unsigned char*) &data[k*3 + 2];
                     time_management_regs->calData = (data[k*3] & 0xfff)
                             + ( (dataPtr[0] & 0x3f) << 12);
                     time_management_regs->calData = (data[k*3 + 1] & 0xfff)
                             + ( (dataPtr[1] & 0x3f) << 12);
                 }
             }
             void setCalibrationReload( bool state)
             {
                 if (state == true)
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl | 0x00000010;   // [0001 0000]
                 }
                 else
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl & 0xffffffef;   // [1110 1111]
                 }
             }
             void setCalibrationEnable( bool state )
             {
                 // this bit drives the multiplexer
                 if (state == true)
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl | 0x00000040;   // [0100 0000]
                 }
                 else
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl & 0xffffffbf; // [1011 1111]
                 }
             }
             void setCalibrationInterleaved( bool state )
             {
                 // this bit drives the multiplexer
                 if (state == true)
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl | 0x00000020;   // [0010 0000]
                 }
                 else
                 {
                     time_management_regs->calDACCtrl = time_management_regs->calDACCtrl & 0xffffffdf; // [1101 1111]
                 }
             }
             void setCalibration( bool state )
             {
                 if (state == true)
                 {
                     setCalibrationEnable( true );
                     setCalibrationReload( false );
                     set_hk_lfr_calib_enable( true );
                 }
                 else
                 {
                     setCalibrationEnable( false );
                     setCalibrationReload( true );
                     set_hk_lfr_calib_enable( false );
                 }
             }
             void configureCalibration( bool interleaved )
             {
                 setCalibration( false );
                 if ( interleaved == true )
                 {
                     setCalibrationInterleaved( true );
                     setCalibrationPrescaler( 0 );   // 25 MHz   => 25 000 000
                     setCalibrationDivisor(  26 );   //          => 240 384
                     setCalibrationDataInterleaved();
                 }
                 else
                 {
                     setCalibrationPrescaler( 0 );   // 25 MHz   => 25 000 000
                     setCalibrationDivisor(  38 );   //          => 160 256 (39 - 1)
                     setCalibrationData();
                 }
             }
             //****************
             // CLOSING ACTIONS
             void update_last_TC_exe( ccsdsTelecommandPacket_t *TC, unsigned char * time )
             {
                 /** This function is used to update the HK packets statistics after a successful TC execution.
                  *
                  * @param TC points to the TC being processed
                  * @param time is the time used to date the TC execution
                  *
                  */
                 unsigned int val;
                 housekeeping_packet.hk_lfr_last_exe_tc_id[0] = TC->packetID[0];
                 housekeeping_packet.hk_lfr_last_exe_tc_id[1] = TC->packetID[1];
                 housekeeping_packet.hk_lfr_last_exe_tc_type[0] = 0x00;
                 housekeeping_packet.hk_lfr_last_exe_tc_type[1] = TC->serviceType;
                 housekeeping_packet.hk_lfr_last_exe_tc_subtype[0] = 0x00;
                 housekeeping_packet.hk_lfr_last_exe_tc_subtype[1] = TC->serviceSubType;
                 housekeeping_packet.hk_lfr_last_exe_tc_time[0] = time[0];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[1] = time[1];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[2] = time[2];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[3] = time[3];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[4] = time[4];
                 housekeeping_packet.hk_lfr_last_exe_tc_time[5] = time[5];
                 val = housekeeping_packet.hk_lfr_exe_tc_cnt[0] * 256 + housekeeping_packet.hk_lfr_exe_tc_cnt[1];
                 val++;
                 housekeeping_packet.hk_lfr_exe_tc_cnt[0] = (unsigned char) (val >> 8);
                 housekeeping_packet.hk_lfr_exe_tc_cnt[1] = (unsigned char) (val);
             }
             void update_last_TC_rej(ccsdsTelecommandPacket_t *TC, unsigned char * time )
             {
                 /** This function is used to update the HK packets statistics after a TC rejection.
                  *
                  * @param TC points to the TC being processed
                  * @param time is the time used to date the TC rejection
                  *
                  */
                 unsigned int val;
                 housekeeping_packet.hk_lfr_last_rej_tc_id[0] = TC->packetID[0];
                 housekeeping_packet.hk_lfr_last_rej_tc_id[1] = TC->packetID[1];
                 housekeeping_packet.hk_lfr_last_rej_tc_type[0] = 0x00;
                 housekeeping_packet.hk_lfr_last_rej_tc_type[1] = TC->serviceType;
                 housekeeping_packet.hk_lfr_last_rej_tc_subtype[0] = 0x00;
                 housekeeping_packet.hk_lfr_last_rej_tc_subtype[1] = TC->serviceSubType;
                 housekeeping_packet.hk_lfr_last_rej_tc_time[0] = time[0];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[1] = time[1];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[2] = time[2];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[3] = time[3];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[4] = time[4];
                 housekeeping_packet.hk_lfr_last_rej_tc_time[5] = time[5];
                 val = housekeeping_packet.hk_lfr_rej_tc_cnt[0] * 256 + housekeeping_packet.hk_lfr_rej_tc_cnt[1];
                 val++;
                 housekeeping_packet.hk_lfr_rej_tc_cnt[0] = (unsigned char) (val >> 8);
                 housekeeping_packet.hk_lfr_rej_tc_cnt[1] = (unsigned char) (val);
             }
             void close_action(ccsdsTelecommandPacket_t *TC, int result, rtems_id queue_id )
             {
                 /** This function is the last step of the TC execution workflow.
                  *
                  * @param TC points to the TC being processed
                  * @param result is the result of the TC execution (LFR_SUCCESSFUL / LFR_DEFAULT)
                  * @param queue_id is the id of the RTEMS message queue used to send TM packets
                  * @param time is the time used to date the TC execution
                  *
                  */
                 unsigned char requestedMode;
                 if (result == LFR_SUCCESSFUL)
                 {
                     if ( !( (TC->serviceType==TC_TYPE_TIME) & (TC->serviceSubType==TC_SUBTYPE_UPDT_TIME) )
                          &
                          !( (TC->serviceType==TC_TYPE_GEN) & (TC->serviceSubType==TC_SUBTYPE_UPDT_INFO))
                          )
                     {
                         send_tm_lfr_tc_exe_success( TC, queue_id );
                     }
                     if ( (TC->serviceType == TC_TYPE_GEN) & (TC->serviceSubType == TC_SUBTYPE_ENTER) )
                     {
                         //**********************************
                         // UPDATE THE LFRMODE LOCAL VARIABLE
                         requestedMode = TC->dataAndCRC[1];
                         housekeeping_packet.lfr_status_word[0] = (unsigned char) ((requestedMode << 4) + 0x0d);
                         updateLFRCurrentMode();
                     }
                 }
                 else if (result == LFR_EXE_ERROR)
                 {
                     send_tm_lfr_tc_exe_error( TC, queue_id );
                 }
             }
             //***************************
             // Interrupt Service Routines
             rtems_isr commutation_isr1( rtems_vector_number vector )
             {
                 if (rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL) {
                     PRINTF("In commutation_isr1 *** Error sending event to DUMB\n")
                 }
             }
             rtems_isr commutation_isr2( rtems_vector_number vector )
             {
                 if (rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL) {
                     PRINTF("In commutation_isr2 *** Error sending event to DUMB\n")
                 }
             }
             //****************
             // OTHER FUNCTIONS
             void updateLFRCurrentMode()
             {
                 /** This function updates the value of the global variable lfrCurrentMode.
                  *
                  * lfrCurrentMode is a parameter used by several functions to know in which mode LFR is running.
                  *
                  */
                 // update the local value of lfrCurrentMode with the value contained in the housekeeping_packet structure
                 lfrCurrentMode = (housekeeping_packet.lfr_status_word[0] & 0xf0) >> 4;
             }
             void set_lfr_soft_reset( unsigned char value )
             {
                 if (value == 1)
                 {
                     time_management_regs->ctrl = time_management_regs->ctrl | 0x00000004; // [0100]
                 }
                 else
                 {
                     time_management_regs->ctrl = time_management_regs->ctrl & 0xfffffffb; // [1011]
                 }
             }
             void reset_lfr( void )
             {
                 set_lfr_soft_reset( 1 );
                 set_lfr_soft_reset( 0 );
                 set_hk_lfr_sc_potential_flag( true );
             }

General Comments 0

Write
Preview

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

No TODOs yet

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

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