##// END OF EJS Templates
HG_REPOSITORIES » LPP » INSTRUMENTATION » SOLO_LFR » DEV_PLE
RSS

Clone from http://pc-instru.lpp.polytechnique.fr:5000/DEV_PLE

AVF1 and PRC1 tasks are functional now
AVF1 and PRC1 tasks are functional now
paul - - Load All Authors

File last commit:

r122:be6c6d813285 VHDLib206
r122:be6c6d813285 VHDLib206
Show More
fsw_processing.c
1273 lines | 50.0 KiB | text/x-c | CLexer
/ src / fsw_processing.c
History | Source | Raw |Copy content |Copy permalink
paul
Minor changes in .h inclusion
 r45 /** 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.
*
*/
paul@pc-solar1.lab-lpp.local
Updates of the ICD taken into account...
 r18 #include <fsw_processing.h>
paul@pc-solar1.lab-lpp.local
Minor updates to use the time management VHDL module
 r12
paul
Minor changes in .h inclusion
 r45 #include "fsw_processing_globals.c"
paul@pc-solar1.lab-lpp.local
automatic reconnexion of the spacewire link...
 r17
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 unsigned int nb_sm_f0;
paul
AVF1 and PRC1 tasks are functional now
 r122 unsigned int nb_sm_f0_aux;
unsigned int nb_sm_f1;
paul
AVF1 and PRC1 tasks added for processing at f1
 r121
paul
Minor changes
 r93 //************************
// spectral matrices rings
paul
Sync...
 r117 ring_node_sm sm_ring_f0[ NB_RING_NODES_SM_F0 ];
ring_node_sm sm_ring_f1[ NB_RING_NODES_SM_F1 ];
ring_node_sm sm_ring_f2[ NB_RING_NODES_SM_F2 ];
paul
sync
 r113 ring_node_sm *current_ring_node_sm_f0;
ring_node_sm *current_ring_node_sm_f1;
ring_node_sm *current_ring_node_sm_f2;
paul
Sync at CNES before going back to 117
 r119 ring_node_sm *ring_node_for_averaging_sm_f0;
ring_node_sm *ring_node_for_averaging_sm_f1;
paul
Minor changes
 r93
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 ring_node_asm asm_ring_norm_f0 [ NB_RING_NODES_ASM_NORM_F0 ];
paul
Sync...
 r117 ring_node_asm asm_ring_burst_sbm_f0[ NB_RING_NODES_ASM_BURST_SBM_F0 ];
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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 ];
paul
Sync...
 r117 ring_node_asm *current_ring_node_asm_burst_sbm_f0;
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 ring_node_asm *current_ring_node_asm_norm_f0;
paul
Sync at CNES before going back to 117
 r119 ring_node_asm *current_ring_node_asm_burst_sbm_f1;
ring_node_asm *current_ring_node_asm_norm_f1;
paul
sync
 r113
paul
There is a message queue between AVFO and MATR...
 r118 float asm_f0_reorganized [ TOTAL_SIZE_SM ];
paul
Sync...
 r117 char asm_f0_char [ TIME_OFFSET_IN_BYTES + (TOTAL_SIZE_SM * 2) ];
paul
AVF1 and PRC1 tasks are functional now
 r122 float compressed_sm_norm_f0[ TOTAL_SIZE_COMPRESSED_ASM_NORM_F0];
float compressed_sm_sbm_f0 [ TOTAL_SIZE_COMPRESSED_ASM_SBM_F0 ];
float asm_f1_reorganized [ TOTAL_SIZE_SM ];
char asm_f1_char [ TIME_OFFSET_IN_BYTES + (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 ];
paul
Corrections:...
 r107
paul
Sync...
 r117 //***********************************************************
// Interrupt Service Routine for spectral matrices processing
paul
AVF1 and PRC1 tasks added for processing at f1
 r121
paul
Sync...
 r117 void reset_nb_sm_f0( unsigned char lfrMode )
{
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_sm_f0 = 0;
paul
AVF1 and PRC1 tasks are functional now
 r122 nb_sm_f0_aux = 0;
paul
Sync...
 r117
paul
AVF1 and PRC1 tasks are functional now
 r122 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;
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;
paul
Sync...
 r117
if (lfrMode == LFR_MODE_SBM1)
{
paul
AVF1 and PRC1 tasks are functional now
 r122 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;
paul
Sync...
 r117 }
else if (lfrMode == LFR_MODE_SBM2)
{
paul
AVF1 and PRC1 tasks are functional now
 r122 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;
paul
Sync at CNES before going back to 117
 r119 }
else if (lfrMode == LFR_MODE_BURST)
{
paul
AVF1 and PRC1 tasks are functional now
 r122 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;
paul
Sync at CNES before going back to 117
 r119 }
else
{
paul
AVF1 and PRC1 tasks are functional now
 r122 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;
paul
Sync at CNES before going back to 117
 r119 }
}
void reset_nb_sm_f1( unsigned char lfrMode )
{
paul
AVF1 and PRC1 tasks are functional now
 r122 nb_sm_f1 = 0;
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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;
paul
Sync at CNES before going back to 117
 r119
if (lfrMode == LFR_MODE_SBM2)
{
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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;
paul
Sync...
 r117 }
else if (lfrMode == LFR_MODE_BURST)
{
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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;
paul
Sync...
 r117 }
else
{
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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;
paul
Sync at CNES before going back to 117
 r119 }
}
void reset_nb_sm_f2( unsigned char lfrMode )
{
nb_sm_before_f2.norm_bp1_f2 = parameter_dump_packet.sy_lfr_n_bp_p0;
nb_sm_before_f2.norm_bp2_f2 = parameter_dump_packet.sy_lfr_n_bp_p1;
nb_sm_before_f2.norm_asm_f2 = parameter_dump_packet.sy_lfr_n_asm_p[0] * 256 + parameter_dump_packet.sy_lfr_n_asm_p[1];
nb_sm_before_f2.sbm2_bp1_f2 = parameter_dump_packet.sy_lfr_s2_bp_p0;
nb_sm_before_f2.sbm2_bp2_f2 = parameter_dump_packet.sy_lfr_s2_bp_p1;
nb_sm_before_f2.burst_bp1_f2 = parameter_dump_packet.sy_lfr_b_bp_p0;
nb_sm_before_f2.burst_bp2_f2 = parameter_dump_packet.sy_lfr_b_bp_p1;
if (lfrMode == LFR_MODE_SBM2)
{
nb_sm_before_f2.burst_sbm_bp1_f2 = nb_sm_before_f2.sbm2_bp1_f2;
nb_sm_before_f2.burst_sbm_bp2_f2 = nb_sm_before_f2.sbm2_bp2_f2;
}
else if (lfrMode == LFR_MODE_BURST)
{
nb_sm_before_f2.burst_sbm_bp1_f2 = nb_sm_before_f2.burst_bp1_f2;
nb_sm_before_f2.burst_sbm_bp2_f2 = nb_sm_before_f2.burst_bp2_f2;
}
else
{
nb_sm_before_f2.burst_sbm_bp1_f2 = nb_sm_before_f2.burst_bp1_f2;
nb_sm_before_f2.burst_sbm_bp2_f2 = nb_sm_before_f2.burst_bp2_f2;
paul
Sync...
 r117 }
}
rtems_isr spectral_matrices_isr( rtems_vector_number vector )
{
paul
There is a message queue between AVFO and MATR...
 r118 ring_node_sm *previous_ring_node_sm_f0;
paul
Sync...
 r117 // rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_8 );
paul
There is a message queue between AVFO and MATR...
 r118 previous_ring_node_sm_f0 = current_ring_node_sm_f0;
if ( (spectral_matrix_regs->status & 0x2) == 0x02) // check ready matrix bit f0_1
{
current_ring_node_sm_f0 = current_ring_node_sm_f0->next;
spectral_matrix_regs->matrixF0_Address0 = current_ring_node_sm_f0->buffer_address;
spectral_matrix_regs->status = spectral_matrix_regs->status & 0xfffffffd; // 1101
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_sm_f0 = nb_sm_f0 + 1;
paul
There is a message queue between AVFO and MATR...
 r118 }
paul
Sync...
 r117
paul
There is a message queue between AVFO and MATR...
 r118 //************************
// reset status error bits
if ( (spectral_matrix_regs->status & 0x30) != 0x00)
{
rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_8 );
spectral_matrix_regs->status = spectral_matrix_regs->status & 0xffffffcf; // 1100 1111
}
paul
Sync...
 r117
paul
There is a message queue between AVFO and MATR...
 r118 //**************************************
// reset ready matrix bits for f0_0, f1 and f2
spectral_matrix_regs->status = spectral_matrix_regs->status & 0xfffffff2; // 0010
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 if (nb_sm_f0 == NB_SM_BEFORE_AVF0)
paul
There is a message queue between AVFO and MATR...
 r118 {
ring_node_for_averaging_sm_f0 = previous_ring_node_sm_f0;
if (rtems_event_send( Task_id[TASKID_AVF0], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
{
rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
}
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_sm_f0 = 0;
paul
There is a message queue between AVFO and MATR...
 r118 }
paul
Sync...
 r117 }
rtems_isr spectral_matrices_isr_simu( rtems_vector_number vector )
{
paul
AVF1 and PRC1 tasks are functional now
 r122 //***
// F0
nb_sm_f0 = nb_sm_f0 + 1;
if (nb_sm_f0 == NB_SM_BEFORE_AVF0 )
paul
Sync...
 r117 {
ring_node_for_averaging_sm_f0 = current_ring_node_sm_f0;
if (rtems_event_send( Task_id[TASKID_AVF0], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
{
rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
}
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_sm_f0 = 0;
paul
Sync...
 r117 }
paul
AVF1 and PRC1 tasks are functional now
 r122
//***
// F1
nb_sm_f0_aux = nb_sm_f0_aux + 1;
if (nb_sm_f0_aux == 6)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks are functional now
 r122 nb_sm_f0_aux = 0;
nb_sm_f1 = nb_sm_f1 + 1;
}
if (nb_sm_f1 == NB_SM_BEFORE_AVF1 )
{
ring_node_for_averaging_sm_f1 = current_ring_node_sm_f1;
if (rtems_event_send( Task_id[TASKID_AVF1], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL)
{
rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_3 );
}
nb_sm_f1 = 0;
paul
Sync...
 r117 }
}
//************
// RTEMS TASKS
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 //*****************
// PROCESSING AT F0
paul
Sync...
 r117
rtems_task avf0_task( rtems_task_argument lfrRequestedMode )
{
int i;
rtems_event_set event_out;
rtems_status_code status;
paul
Sync at CNES before going back to 117
 r119 rtems_id queue_id_prc0;
paul
There is a message queue between AVFO and MATR...
 r118 asm_msg msgForMATR;
paul
Sync...
 r117 ring_node_sm *ring_node_tab[8];
paul
AVF1 and PRC1 tasks are functional now
 r122 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;
paul
AVF1 and PRC1 tasks added for processing at f1
 r121
nb_norm_bp1 = 0;
nb_norm_bp2 = 0;
nb_norm_asm = 0;
nb_sbm_bp1 = 0;
nb_sbm_bp2 = 0;
paul
Sync...
 r117 reset_nb_sm_f0( lfrRequestedMode ); // reset the sm counters that drive the BP and ASM computations / transmissions
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 BOOT_PRINTF1("in AVFO *** lfrRequestedMode = %d\n", (int) lfrRequestedMode)
paul
Sync...
 r117
paul
Sync at CNES before going back to 117
 r119 status = get_message_queue_id_prc0( &queue_id_prc0 );
paul
There is a message queue between AVFO and MATR...
 r118 if (status != RTEMS_SUCCESSFUL)
{
paul
Sync at CNES before going back to 117
 r119 PRINTF1("in MATR *** ERR get_message_queue_id_prc0 %d\n", status)
paul
There is a message queue between AVFO and MATR...
 r118 }
paul
Sync...
 r117 while(1){
rtems_event_receive(RTEMS_EVENT_0, RTEMS_WAIT, RTEMS_NO_TIMEOUT, &event_out); // wait for an RTEMS_EVENT0
ring_node_tab[NB_SM_BEFORE_AVF0-1] = ring_node_for_averaging_sm_f0;
for ( i = 2; i < (NB_SM_BEFORE_AVF0+1); i++ )
{
ring_node_for_averaging_sm_f0 = ring_node_for_averaging_sm_f0->previous;
ring_node_tab[NB_SM_BEFORE_AVF0-i] = ring_node_for_averaging_sm_f0;
}
// compute the average and store it in the averaged_sm_f1 buffer
paul
There is a message queue between AVFO and MATR...
 r118 SM_average( current_ring_node_asm_norm_f0->matrix,
current_ring_node_asm_burst_sbm_f0->matrix,
ring_node_tab,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_norm_bp1, nb_sbm_bp1 );
paul
Sync...
 r117
// update nb_average
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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;
paul
Sync...
 r117
paul
There is a message queue between AVFO and MATR...
 r118 //****************************************
// initialize the mesage for the MATR task
paul
Sync at CNES before going back to 117
 r119 msgForMATR.event = 0x00; // this composite event will be sent to the MATR task
msgForMATR.burst_sbm = current_ring_node_asm_burst_sbm_f0;
msgForMATR.norm = current_ring_node_asm_norm_f0;
paul
AVF1 and PRC1 tasks are functional now
 r122 // msgForMATR.coarseTime = ( (unsigned int *) (ring_node_tab[0]->buffer_address) )[0];
// msgForMATR.fineTime = ( (unsigned int *) (ring_node_tab[0]->buffer_address) )[1];
msgForMATR.coarseTime = time_management_regs->coarse_time;
msgForMATR.fineTime = time_management_regs->fine_time;
paul
Sync...
 r117
paul
AVF1 and PRC1 tasks are functional now
 r122 if (nb_sbm_bp1 == nb_sm_before_f0.burst_sbm_bp1)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_sbm_bp1 = 0;
paul
Sync...
 r117 // 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)
|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
{
paul
There is a message queue between AVFO and MATR...
 r118 msgForMATR.event = msgForMATR.event | RTEMS_EVENT_BURST_SBM_BP1_F0;
paul
Sync...
 r117 }
}
paul
AVF1 and PRC1 tasks are functional now
 r122 if (nb_sbm_bp2 == nb_sm_before_f0.burst_sbm_bp2)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_sbm_bp2 = 0;
paul
Sync...
 r117 if ( (lfrCurrentMode == LFR_MODE_BURST)
|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
{
paul
There is a message queue between AVFO and MATR...
 r118 msgForMATR.event = msgForMATR.event | RTEMS_EVENT_BURST_SBM_BP2_F0;
paul
Sync...
 r117 }
}
paul
Sync
 r99
paul
AVF1 and PRC1 tasks are functional now
 r122 if (nb_norm_bp1 == nb_sm_before_f0.norm_bp1)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_norm_bp1 = 0;
paul
There is a message queue between AVFO and MATR...
 r118 // set another ring for the ASM storage
current_ring_node_asm_norm_f0 = current_ring_node_asm_norm_f0->next;
paul
Sync at CNES before going back to 117
 r119 if ( (lfrCurrentMode == LFR_MODE_NORMAL)
|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
paul
Sync...
 r117 {
paul
There is a message queue between AVFO and MATR...
 r118 msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP1_F0;
paul
Sync...
 r117 }
}
paul
AVF1 and PRC1 tasks are functional now
 r122 if (nb_norm_bp2 == nb_sm_before_f0.norm_bp2)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_norm_bp2 = 0;
paul
Sync...
 r117 if ( (lfrCurrentMode == LFR_MODE_NORMAL)
|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
{
paul
There is a message queue between AVFO and MATR...
 r118 msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP2_F0;
paul
Sync...
 r117 }
}
paul
AVF1 and PRC1 tasks are functional now
 r122 if (nb_norm_asm == nb_sm_before_f0.norm_asm)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_norm_asm = 0;
paul
Sync...
 r117 if ( (lfrCurrentMode == LFR_MODE_NORMAL)
|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
{
// PRINTF1("%lld\n", localTime)
paul
There is a message queue between AVFO and MATR...
 r118 msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_ASM_F0;
paul
Sync...
 r117 }
}
paul
There is a message queue between AVFO and MATR...
 r118 //*************************
// send the message to MATR
if (msgForMATR.event != 0x00)
{
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 status = rtems_message_queue_send( queue_id_prc0, (char *) &msgForMATR, MSG_QUEUE_SIZE_PRC0);
paul
There is a message queue between AVFO and MATR...
 r118 }
paul
Sync...
 r117 if (status != RTEMS_SUCCESSFUL) {
paul
There is a message queue between AVFO and MATR...
 r118 printf("in AVF0 *** Error sending message to MATR, code %d\n", status);
paul
Sync...
 r117 }
}
}
paul
Sync at CNES before going back to 117
 r119 rtems_task prc0_task( rtems_task_argument lfrRequestedMode )
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 char incomingData[MSG_QUEUE_SIZE_SEND]; // incoming data buffer
size_t size; // size of the incoming TC packet
asm_msg *incomingMsg;
//
spw_ioctl_pkt_send spw_ioctl_send_ASM;
rtems_status_code status;
rtems_id queue_id;
rtems_id queue_id_q_p0;
Header_TM_LFR_SCIENCE_ASM_t headerASM;
bp_packet_with_spare packet_norm_bp1_f0;
bp_packet packet_norm_bp2_f0;
bp_packet packet_sbm_bp1_f0;
bp_packet packet_sbm_bp2_f0;
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 unsigned long long int localTime;
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 ASM_init_header( &headerASM );
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 //*************
// NORM headers
BP_init_header_with_spare( &packet_norm_bp1_f0.header,
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_f0.header,
APID_TM_SCIENCE_NORMAL_BURST, SID_NORM_BP2_F0,
PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F0, NB_BINS_COMPRESSED_SM_F0);
paul
There is a message queue between AVFO and MATR...
 r118
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 //****************************
// BURST SBM1 and SBM2 headers
if ( lfrRequestedMode == LFR_MODE_BURST )
{
BP_init_header( &packet_sbm_bp1_f0.header,
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_f0.header,
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_f0.header,
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_f0.header,
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_f0.header,
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_f0.header,
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)
}
paul
Sync...
 r117
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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)
}
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 BOOT_PRINTF1("in PRC0 *** lfrRequestedMode = %d\n", (int) lfrRequestedMode)
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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;
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 localTime = getTimeAsUnsignedLongLongInt( );
//****************
//****************
// BURST SBM1 SBM2
//****************
//****************
if (incomingMsg->event & RTEMS_EVENT_BURST_SBM_BP1_F0 )
{
// 1) compress the matrix for Basic Parameters calculation
paul
AVF1 and PRC1 tasks are functional now
 r122 ASM_compress_reorganize_and_divide( incomingMsg->burst_sbm->matrix, compressed_sm_sbm_f0,
nb_sm_before_f0.burst_sbm_bp1,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 NB_BINS_COMPRESSED_SM_SBM_F0, NB_BINS_TO_AVERAGE_ASM_SBM_F0,
ASM_F0_INDICE_START);
// 2) compute the BP1 set
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 // 3) send the BP1 set
set_time( packet_sbm_bp1_f0.header.time, (unsigned char *) &incomingMsg->coarseTime );
set_time( packet_sbm_bp1_f0.header.acquisitionTime, (unsigned char *) &incomingMsg->fineTime );
BP_send( (char *) &packet_sbm_bp1_f0.header, queue_id,
PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F0 + PACKET_LENGTH_DELTA);
// 4) compute the BP2 set if needed
if ( incomingMsg->event & RTEMS_EVENT_BURST_SBM_BP2_F0 )
{
// 1) compute the BP2 set
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 // 2) send the BP2 set
set_time( packet_sbm_bp2_f0.header.time, (unsigned char *) &incomingMsg->coarseTime );
set_time( packet_sbm_bp2_f0.header.acquisitionTime, (unsigned char *) &incomingMsg->fineTime );
BP_send( (char *) &packet_sbm_bp2_f0.header, queue_id,
PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F0 + PACKET_LENGTH_DELTA);
}
}
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 //*****
//*****
// NORM
//*****
//*****
if (incomingMsg->event & RTEMS_EVENT_NORM_BP1_F0)
{
// 1) compress the matrix for Basic Parameters calculation
ASM_compress_reorganize_and_divide( incomingMsg->norm->matrix, compressed_sm_norm_f0,
paul
AVF1 and PRC1 tasks are functional now
 r122 nb_sm_before_f0.norm_bp1,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 NB_BINS_COMPRESSED_SM_F0, NB_BINS_TO_AVERAGE_ASM_F0,
ASM_F0_INDICE_START );
// 2) compute the BP1 set
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 // 3) send the BP1 set
set_time( packet_norm_bp1_f0.header.time, (unsigned char *) &incomingMsg->coarseTime );
set_time( packet_norm_bp1_f0.header.acquisitionTime, (unsigned char *) &incomingMsg->fineTime );
BP_send( (char *) &packet_norm_bp1_f0.header, queue_id,
PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP1_F0 + PACKET_LENGTH_DELTA);
if (incomingMsg->event & RTEMS_EVENT_NORM_BP2_F0)
{
paul
AVF1 and PRC1 tasks are functional now
 r122 // 1) compute the BP2 set using the same ASM as the one used for BP1
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 // 2) send the BP2 set
set_time( packet_norm_bp2_f0.header.time, (unsigned char *) &incomingMsg->coarseTime );
set_time( packet_norm_bp2_f0.header.acquisitionTime, (unsigned char *) &incomingMsg->fineTime );
BP_send( (char *) &packet_norm_bp2_f0.header, queue_id,
PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F0 + PACKET_LENGTH_DELTA);
}
}
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 if (incomingMsg->event & RTEMS_EVENT_NORM_ASM_F0)
{
// 1) reorganize the ASM and divide
paul
AVF1 and PRC1 tasks are functional now
 r122 ASM_reorganize_and_divide( incomingMsg->norm->matrix,
asm_f0_reorganized,
nb_sm_before_f0.norm_bp1 );
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 // 2) convert the float array in a char array
ASM_convert( asm_f0_reorganized, asm_f0_char);
// 3) send the spectral matrix packets
set_time( headerASM.time , (unsigned char *) &incomingMsg->coarseTime );
set_time( headerASM.acquisitionTime, (unsigned char *) &incomingMsg->coarseTime );
ASM_send( &headerASM, asm_f0_char, SID_NORM_ASM_F0, &spw_ioctl_send_ASM, queue_id);
}
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 }
paul
Sync at CNES before going back to 117
 r119 }
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 //*****************
// PROCESSING AT F1
paul
Sync at CNES before going back to 117
 r119 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_sm *ring_node_tab[8];
paul
AVF1 and PRC1 tasks are functional now
 r122 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;
paul
AVF1 and PRC1 tasks added for processing at f1
 r121
nb_norm_bp1 = 0;
nb_norm_bp2 = 0;
nb_norm_asm = 0;
nb_sbm_bp1 = 0;
nb_sbm_bp2 = 0;
paul
Sync at CNES before going back to 117
 r119 reset_nb_sm_f1( lfrRequestedMode ); // reset the sm counters that drive the BP and ASM computations / transmissions
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 BOOT_PRINTF1("in AVF1 *** lfrRequestedMode = %d\n", (int) lfrRequestedMode)
paul
Sync at CNES before going back to 117
 r119
status = get_message_queue_id_prc1( &queue_id_prc1 );
if (status != RTEMS_SUCCESSFUL)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 PRINTF1("in AVF1 *** ERR get_message_queue_id_prc1 %d\n", status)
paul
Sync...
 r117 }
paul
Sync at CNES before going back to 117
 r119 while(1){
rtems_event_receive(RTEMS_EVENT_0, RTEMS_WAIT, RTEMS_NO_TIMEOUT, &event_out); // wait for an RTEMS_EVENT0
ring_node_tab[NB_SM_BEFORE_AVF1-1] = ring_node_for_averaging_sm_f1;
for ( i = 2; i < (NB_SM_BEFORE_AVF1+1); i++ )
{
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 ring_node_for_averaging_sm_f1 = ring_node_for_averaging_sm_f1->previous;
ring_node_tab[NB_SM_BEFORE_AVF1-i] = ring_node_for_averaging_sm_f1;
paul
Sync at CNES before going back to 117
 r119 }
paul
Sync...
 r117
paul
Sync at CNES before going back to 117
 r119 // 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,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_norm_bp1, nb_sbm_bp1 );
paul
There is a message queue between AVFO and MATR...
 r118
paul
Sync at CNES before going back to 117
 r119 // update nb_average
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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;
paul
Sync...
 r117
paul
Sync at CNES before going back to 117
 r119 //****************************************
// initialize the mesage for the MATR task
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 msgForMATR.event = 0x00; // this composite event will be sent to the PRC1 task
paul
Sync at CNES before going back to 117
 r119 msgForMATR.burst_sbm = current_ring_node_asm_burst_sbm_f1;
msgForMATR.norm = current_ring_node_asm_norm_f1;
paul
AVF1 and PRC1 tasks are functional now
 r122 // msgForMATR.coarseTime = ( (unsigned int *) (ring_node_tab[0]->buffer_address) )[0];
// msgForMATR.fineTime = ( (unsigned int *) (ring_node_tab[0]->buffer_address) )[1];
msgForMATR.coarseTime = time_management_regs->coarse_time;
msgForMATR.fineTime = time_management_regs->fine_time;
paul
Sync at CNES before going back to 117
 r119
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 if (nb_sbm_bp1 == nb_sm_before_f1.burst_sbm_bp1)
paul
Sync at CNES before going back to 117
 r119 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_sbm_bp1 = 0;
paul
Sync at CNES before going back to 117
 r119 // set another ring for the ASM storage
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 current_ring_node_asm_burst_sbm_f1 = current_ring_node_asm_burst_sbm_f1->next;
paul
Sync at CNES before going back to 117
 r119 if ( (lfrCurrentMode == LFR_MODE_BURST) || (lfrCurrentMode == LFR_MODE_SBM2) )
paul
Sync...
 r117 {
paul
Sync at CNES before going back to 117
 r119 msgForMATR.event = msgForMATR.event | RTEMS_EVENT_BURST_SBM_BP1_F1;
paul
Sync...
 r117 }
}
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 if (nb_sbm_bp2 == nb_sm_before_f1.burst_sbm_bp2)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_sbm_bp2 = 0;
paul
Sync at CNES before going back to 117
 r119 if ( (lfrCurrentMode == LFR_MODE_BURST) || (lfrCurrentMode == LFR_MODE_SBM2) )
{
msgForMATR.event = msgForMATR.event | RTEMS_EVENT_BURST_SBM_BP2_F1;
}
}
paul
Sync...
 r117
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 if (nb_norm_bp1 == nb_sm_before_f1.norm_bp1)
paul
Sync at CNES before going back to 117
 r119 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_norm_bp1 = 0;
paul
Sync at CNES before going back to 117
 r119 // set another ring for the ASM storage
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 current_ring_node_asm_norm_f1 = current_ring_node_asm_norm_f1->next;
paul
Sync at CNES before going back to 117
 r119 if ( (lfrCurrentMode == LFR_MODE_NORMAL)
|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks are functional now
 r122 msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP1_F1;
paul
Sync...
 r117 }
}
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 if (nb_norm_bp2 == nb_sm_before_f1.norm_bp2)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_norm_bp2 = 0;
paul
Sync at CNES before going back to 117
 r119 if ( (lfrCurrentMode == LFR_MODE_NORMAL)
|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
{
msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP2_F1;
}
paul
Sync...
 r117 }
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 if (nb_norm_asm == nb_sm_before_f1.norm_asm)
paul
Sync at CNES before going back to 117
 r119 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_norm_asm = 0;
paul
Sync at CNES before going back to 117
 r119 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)
{
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 status = rtems_message_queue_send( queue_id_prc1, (char *) &msgForMATR, MSG_QUEUE_SIZE_PRC1);
paul
Sync at CNES before going back to 117
 r119 }
if (status != RTEMS_SUCCESSFUL) {
printf("in AVF1 *** Error sending message to PRC1, code %d\n", status);
}
paul
Sync...
 r117 }
}
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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;
//
spw_ioctl_pkt_send spw_ioctl_send_ASM;
rtems_status_code status;
paul
AVF1 and PRC1 tasks are functional now
 r122 rtems_id queue_id_send;
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 rtems_id queue_id_q_p1;
Header_TM_LFR_SCIENCE_ASM_t headerASM;
bp_packet_with_spare packet_norm_bp1;
bp_packet packet_norm_bp2;
bp_packet packet_sbm_bp1;
bp_packet packet_sbm_bp2;
unsigned long long int localTime;
ASM_init_header( &headerASM );
//*************
// NORM headers
BP_init_header_with_spare( &packet_norm_bp1.header,
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.header,
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.header,
APID_TM_SCIENCE_NORMAL_BURST, SID_BURST_BP1_F1,
PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F0, NB_BINS_COMPRESSED_SM_SBM_F1);
BP_init_header( &packet_sbm_bp2.header,
APID_TM_SCIENCE_NORMAL_BURST, SID_BURST_BP2_F1,
PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F0, NB_BINS_COMPRESSED_SM_SBM_F1);
}
else if ( lfrRequestedMode == LFR_MODE_SBM2 )
{
BP_init_header( &packet_sbm_bp1.header,
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.header,
APID_TM_SCIENCE_SBM1_SBM2, SID_SBM2_BP2_F1,
PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F1, NB_BINS_COMPRESSED_SM_SBM_F1);
}
else
{
paul
AVF1 and PRC1 tasks are functional now
 r122 PRINTF1("in PRC1 *** lfrRequestedMode is %d, several headers not initialized\n", (unsigned int) lfrRequestedMode)
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 }
paul
AVF1 and PRC1 tasks are functional now
 r122 status = get_message_queue_id_send( &queue_id_send );
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 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;
localTime = getTimeAsUnsignedLongLongInt( );
//***********
//***********
// BURST SBM2
//***********
//***********
if (incomingMsg->event & RTEMS_EVENT_BURST_SBM_BP1_F1 )
{
// 1) compress the matrix for Basic Parameters calculation
paul
AVF1 and PRC1 tasks are functional now
 r122 ASM_compress_reorganize_and_divide( incomingMsg->burst_sbm->matrix, compressed_sm_sbm_f1,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 nb_sm_before_f1.burst_sbm_bp1,
NB_BINS_COMPRESSED_SM_SBM_F1, NB_BINS_TO_AVERAGE_ASM_SBM_F1,
ASM_F1_INDICE_START);
// 2) compute the BP1 set
// 3) send the BP1 set
set_time( packet_sbm_bp1.header.time, (unsigned char *) &incomingMsg->coarseTime );
set_time( packet_sbm_bp1.header.acquisitionTime, (unsigned char *) &incomingMsg->fineTime );
paul
AVF1 and PRC1 tasks are functional now
 r122 BP_send( (char *) &packet_sbm_bp1.header, queue_id_send,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F1 + PACKET_LENGTH_DELTA);
// 4) compute the BP2 set if needed
if ( incomingMsg->event & RTEMS_EVENT_BURST_SBM_BP2_F1 )
{
// 1) compute the BP2 set
// 2) send the BP2 set
set_time( packet_sbm_bp2.header.time, (unsigned char *) &incomingMsg->coarseTime );
set_time( packet_sbm_bp2.header.acquisitionTime, (unsigned char *) &incomingMsg->fineTime );
paul
AVF1 and PRC1 tasks are functional now
 r122 BP_send( (char *) &packet_sbm_bp2.header, queue_id_send,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F1 + PACKET_LENGTH_DELTA);
}
}
//*****
//*****
// NORM
//*****
//*****
if (incomingMsg->event & RTEMS_EVENT_NORM_BP1_F1)
{
// 1) compress the matrix for Basic Parameters calculation
paul
AVF1 and PRC1 tasks are functional now
 r122 ASM_compress_reorganize_and_divide( incomingMsg->norm->matrix, compressed_sm_norm_f1,
nb_sm_before_f0.norm_bp1,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 NB_BINS_COMPRESSED_SM_F0, NB_BINS_TO_AVERAGE_ASM_F0,
ASM_F0_INDICE_START );
// 2) compute the BP1 set
// 3) send the BP1 set
set_time( packet_norm_bp1.header.time, (unsigned char *) &incomingMsg->coarseTime );
set_time( packet_norm_bp1.header.acquisitionTime, (unsigned char *) &incomingMsg->fineTime );
paul
AVF1 and PRC1 tasks are functional now
 r122 BP_send( (char *) &packet_norm_bp1.header, queue_id_send,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP1_F1 + PACKET_LENGTH_DELTA);
if (incomingMsg->event & RTEMS_EVENT_NORM_BP2_F1)
{
// 1) compute the BP2 set
// 2) send the BP2 set
set_time( packet_norm_bp2.header.time, (unsigned char *) &incomingMsg->coarseTime );
set_time( packet_norm_bp2.header.acquisitionTime, (unsigned char *) &incomingMsg->fineTime );
paul
AVF1 and PRC1 tasks are functional now
 r122 BP_send( (char *) &packet_norm_bp2.header, queue_id_send,
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F1 + PACKET_LENGTH_DELTA);
}
}
if (incomingMsg->event & RTEMS_EVENT_NORM_ASM_F1)
{
// 1) reorganize the ASM and divide
paul
AVF1 and PRC1 tasks are functional now
 r122 ASM_reorganize_and_divide( incomingMsg->norm->matrix,
asm_f1_reorganized,
nb_sm_before_f0.norm_bp1 );
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 // 2) convert the float array in a char array
paul
AVF1 and PRC1 tasks are functional now
 r122 ASM_convert( asm_f1_reorganized, asm_f1_char);
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 // 3) send the spectral matrix packets
set_time( headerASM.time , (unsigned char *) &incomingMsg->coarseTime );
set_time( headerASM.acquisitionTime, (unsigned char *) &incomingMsg->coarseTime );
paul
AVF1 and PRC1 tasks are functional now
 r122 ASM_send( &headerASM, asm_f1_char, SID_NORM_ASM_F1, &spw_ioctl_send_ASM, queue_id_send);
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 }
}
}
paul
Sync...
 r117 //******************
// Spectral Matrices
void SM_init_rings( void )
paul
Minor changes
 r93 {
unsigned char i;
// F0 RING
paul
sync
 r113 sm_ring_f0[0].next = (ring_node_sm*) &sm_ring_f0[1];
paul
Sync...
 r117 sm_ring_f0[0].previous = (ring_node_sm*) &sm_ring_f0[NB_RING_NODES_SM_F0-1];
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 sm_ring_f0[0].buffer_address =
(int) &sm_f0[ 0 ];
paul
Minor changes
 r93
paul
Sync...
 r117 sm_ring_f0[NB_RING_NODES_SM_F0-1].next = (ring_node_sm*) &sm_ring_f0[0];
sm_ring_f0[NB_RING_NODES_SM_F0-1].previous = (ring_node_sm*) &sm_ring_f0[NB_RING_NODES_SM_F0-2];
sm_ring_f0[NB_RING_NODES_SM_F0-1].buffer_address =
(int) &sm_f0[ (NB_RING_NODES_SM_F0-1) * TOTAL_SIZE_SM ];
paul
Minor changes
 r93
paul
Sync...
 r117 for(i=1; i<NB_RING_NODES_SM_F0-1; i++)
paul
Minor changes
 r93 {
paul
sync
 r113 sm_ring_f0[i].next = (ring_node_sm*) &sm_ring_f0[i+1];
sm_ring_f0[i].previous = (ring_node_sm*) &sm_ring_f0[i-1];
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 sm_ring_f0[i].buffer_address =
(int) &sm_f0[ i * TOTAL_SIZE_SM ];
}
// F1 RING
paul
sync
 r113 sm_ring_f1[0].next = (ring_node_sm*) &sm_ring_f1[1];
paul
Sync...
 r117 sm_ring_f1[0].previous = (ring_node_sm*) &sm_ring_f1[NB_RING_NODES_SM_F1-1];
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 sm_ring_f1[0].buffer_address =
(int) &sm_f1[ 0 ];
paul
Sync...
 r117 sm_ring_f1[NB_RING_NODES_SM_F1-1].next = (ring_node_sm*) &sm_ring_f1[0];
sm_ring_f1[NB_RING_NODES_SM_F1-1].previous = (ring_node_sm*) &sm_ring_f1[NB_RING_NODES_SM_F1-2];
sm_ring_f1[NB_RING_NODES_SM_F1-1].buffer_address =
(int) &sm_f1[ (NB_RING_NODES_SM_F1-1) * TOTAL_SIZE_SM ];
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106
paul
Sync...
 r117 for(i=1; i<NB_RING_NODES_SM_F1-1; i++)
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 {
paul
sync
 r113 sm_ring_f1[i].next = (ring_node_sm*) &sm_ring_f1[i+1];
sm_ring_f1[i].previous = (ring_node_sm*) &sm_ring_f1[i-1];
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 sm_ring_f1[i].buffer_address =
(int) &sm_f1[ i * TOTAL_SIZE_SM ];
}
// F2 RING
paul
sync
 r113 sm_ring_f2[0].next = (ring_node_sm*) &sm_ring_f2[1];
paul
Sync...
 r117 sm_ring_f2[0].previous = (ring_node_sm*) &sm_ring_f2[NB_RING_NODES_SM_F2-1];
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 sm_ring_f2[0].buffer_address =
(int) &sm_f2[ 0 ];
paul
Sync...
 r117 sm_ring_f2[NB_RING_NODES_SM_F2-1].next = (ring_node_sm*) &sm_ring_f2[0];
sm_ring_f2[NB_RING_NODES_SM_F2-1].previous = (ring_node_sm*) &sm_ring_f2[NB_RING_NODES_SM_F2-2];
sm_ring_f2[NB_RING_NODES_SM_F2-1].buffer_address =
(int) &sm_f2[ (NB_RING_NODES_SM_F2-1) * TOTAL_SIZE_SM ];
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106
paul
Sync...
 r117 for(i=1; i<NB_RING_NODES_SM_F2-1; i++)
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 {
paul
sync
 r113 sm_ring_f2[i].next = (ring_node_sm*) &sm_ring_f2[i+1];
sm_ring_f2[i].previous = (ring_node_sm*) &sm_ring_f2[i-1];
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 sm_ring_f2[i].buffer_address =
(int) &sm_f2[ i * TOTAL_SIZE_SM ];
paul
Minor changes
 r93 }
DEBUG_PRINTF1("asm_ring_f0 @%x\n", (unsigned int) sm_ring_f0)
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 DEBUG_PRINTF1("asm_ring_f1 @%x\n", (unsigned int) sm_ring_f1)
DEBUG_PRINTF1("asm_ring_f2 @%x\n", (unsigned int) sm_ring_f2)
paul
Minor changes
 r93
paul
Sync
 r99 spectral_matrix_regs->matrixF0_Address0 = sm_ring_f0[0].buffer_address;
DEBUG_PRINTF1("spectral_matrix_regs->matrixF0_Address0 @%x\n", spectral_matrix_regs->matrixF0_Address0)
paul
Minor changes
 r93 }
paul
There is a message queue between AVFO and MATR...
 r118 void ASM_init_rings( void )
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 //***
// F0
// NORM
ASM_generic_init_ring( asm_ring_norm_f0, NB_RING_NODES_ASM_NORM_F0 );
// BURST_SBM
ASM_generic_init_ring( asm_ring_burst_sbm_f0, NB_RING_NODES_ASM_BURST_SBM_F0 );
//***
// F1
//*****
// NORM
ASM_generic_init_ring( asm_ring_norm_f1, NB_RING_NODES_ASM_NORM_F1 );
// BURST_SBM
ASM_generic_init_ring( asm_ring_burst_sbm_f1, NB_RING_NODES_ASM_BURST_SBM_F1 );
}
void ASM_generic_init_ring( ring_node_asm *ring, unsigned char nbNodes )
{
paul
Sync...
 r117 unsigned char i;
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 ring[ nbNodes - 1 ].next
= (ring_node_asm*) &ring[ 0 ];
paul
Sync...
 r117
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 for(i=0; i<nbNodes-1; i++)
paul
Sync...
 r117 {
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 ring[ i ].next = (ring_node_asm*) &ring[ i + 1 ];
paul
There is a message queue between AVFO and MATR...
 r118 }
paul
Sync...
 r117 }
void SM_reset_current_ring_nodes( void )
paul
Minor changes
 r93 {
paul
snapshots extraction fully functionnal in SBM1 and SBM2
 r106 current_ring_node_sm_f0 = sm_ring_f0;
current_ring_node_sm_f1 = sm_ring_f1;
current_ring_node_sm_f2 = sm_ring_f2;
paul
Sync
 r95 ring_node_for_averaging_sm_f0 = sm_ring_f0;
paul
Minor changes
 r93 }
paul
SID corrected in TM_LFR_TC_EXE packets...
 r31
paul
AVF1 and PRC1 tasks added for processing at f1
 r121 void ASM_reset_current_ring_nodes( void )
paul@pc-solar1.lab-lpp.local
All modes implemented for the waveforms...
 r23 {
paul
There is a message queue between AVFO and MATR...
 r118 current_ring_node_asm_norm_f0 = asm_ring_norm_f0;
current_ring_node_asm_burst_sbm_f0 = asm_ring_burst_sbm_f0;
paul
AVF1 and PRC1 tasks added for processing at f1
 r121
current_ring_node_asm_norm_f1 = asm_ring_norm_f1;
current_ring_node_asm_burst_sbm_f1 = asm_ring_burst_sbm_f1;
paul@pc-solar1.lab-lpp.local
Naming convention changed...
 r5 }
paul@pc-solar1.lab-lpp.local
All modes implemented for the waveforms...
 r23
paul
Sync...
 r117 void ASM_init_header( Header_TM_LFR_SCIENCE_ASM_t *header)
paul
SID corrected in TM_LFR_TC_EXE packets...
 r31 {
paul
Sync...
 r117 header->targetLogicalAddress = CCSDS_DESTINATION_ID;
header->protocolIdentifier = CCSDS_PROTOCOLE_ID;
header->reserved = 0x00;
header->userApplication = CCSDS_USER_APP;
header->packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);
header->packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
header->packetSequenceControl[0] = 0xc0;
header->packetSequenceControl[1] = 0x00;
header->packetLength[0] = 0x00;
header->packetLength[1] = 0x00;
// DATA FIELD HEADER
header->spare1_pusVersion_spare2 = 0x10;
header->serviceType = TM_TYPE_LFR_SCIENCE; // service type
header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype
header->destinationID = TM_DESTINATION_ID_GROUND;
// AUXILIARY DATA HEADER
header->sid = 0x00;
header->biaStatusInfo = 0x00;
header->pa_lfr_pkt_cnt_asm = 0x00;
header->pa_lfr_pkt_nr_asm = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->pa_lfr_asm_blk_nr[0] = 0x00; // BLK_NR MSB
header->pa_lfr_asm_blk_nr[1] = 0x00; // BLK_NR LSB
paul
SID corrected in TM_LFR_TC_EXE packets...
 r31 }
paul
Sync...
 r116 void SM_average( float *averaged_spec_mat_f0, float *averaged_spec_mat_f1,
paul
sync
 r113 ring_node_sm *ring_node_tab[],
paul
rev 1.0.0.5
 r114 unsigned int nbAverageNormF0, unsigned int nbAverageSBM1F0 )
paul
sync
 r113 {
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 ];
paul
rev 1.0.0.5
 r114 if ( (nbAverageNormF0 == 0) && (nbAverageSBM1F0 == 0) )
paul
sync
 r113 {
paul
There is a message queue between AVFO and MATR...
 r118 averaged_spec_mat_f0[ i ] = sum;
averaged_spec_mat_f1[ i ] = sum;
paul
sync
 r113 }
paul
rev 1.0.0.5
 r114 else if ( (nbAverageNormF0 != 0) && (nbAverageSBM1F0 != 0) )
paul
sync
 r113 {
paul
There is a message queue between AVFO and MATR...
 r118 averaged_spec_mat_f0[ i ] = ( averaged_spec_mat_f0[ i ] + sum );
averaged_spec_mat_f1[ i ] = ( averaged_spec_mat_f1[ i ] + sum );
paul
sync
 r113 }
paul
rev 1.0.0.5
 r114 else if ( (nbAverageNormF0 != 0) && (nbAverageSBM1F0 == 0) )
paul
sync
 r113 {
paul
There is a message queue between AVFO and MATR...
 r118 averaged_spec_mat_f0[ i ] = ( averaged_spec_mat_f0[ i ] + sum );
averaged_spec_mat_f1[ i ] = sum;
paul
sync
 r113 }
else
{
paul
Sync...
 r116 PRINTF2("ERR *** in SM_average *** unexpected parameters %d %d\n", nbAverageNormF0, nbAverageSBM1F0)
paul
sync
 r113 }
}
}
paul
Sync
 r115 void ASM_reorganize_and_divide( float *averaged_spec_mat, float *averaged_spec_mat_reorganized, float divider )
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 {
int frequencyBin;
int asmComponent;
paul
There is a message queue between AVFO and MATR...
 r118 unsigned int offsetAveragedSpecMatReorganized;
unsigned int offsetAveragedSpecMat;
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103
for (asmComponent = 0; asmComponent < NB_VALUES_PER_SM; asmComponent++)
{
for( frequencyBin = 0; frequencyBin < NB_BINS_PER_SM; frequencyBin++ )
{
paul
There is a message queue between AVFO and MATR...
 r118 offsetAveragedSpecMatReorganized =
frequencyBin * NB_VALUES_PER_SM
+ asmComponent;
offsetAveragedSpecMat =
asmComponent * NB_BINS_PER_SM
+ frequencyBin;
averaged_spec_mat_reorganized[offsetAveragedSpecMatReorganized ] =
averaged_spec_mat[ offsetAveragedSpecMat ] / divider;
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 }
}
}
paul
Sync
 r115 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 )
paul@pc-solar1.lab-lpp.local
All modes implemented for the waveforms...
 r23 {
paul
Bug #60 corrected...
 r102 int frequencyBin;
int asmComponent;
int offsetASM;
int offsetCompressed;
int k;
paul
Sync...
 r117 // build data
paul
Sync
 r115 for (asmComponent = 0; asmComponent < NB_VALUES_PER_SM; asmComponent++)
{
for( frequencyBin = 0; frequencyBin < nbBinsCompressedMatrix; frequencyBin++ )
paul
Bug #60 corrected...
 r102 {
paul
There is a message queue between AVFO and MATR...
 r118 offsetCompressed = // NO TIME OFFSET
frequencyBin * NB_VALUES_PER_SM
paul
Sync
 r115 + asmComponent;
paul
There is a message queue between AVFO and MATR...
 r118 offsetASM = // NO TIME OFFSET
asmComponent * NB_BINS_PER_SM
paul
Sync
 r115 + ASMIndexStart
+ frequencyBin * nbBinsToAverage;
compressed_spec_mat[ offsetCompressed ] = 0;
for ( k = 0; k < nbBinsToAverage; k++ )
paul
Bug #60 corrected...
 r102 {
paul
Sync
 r115 compressed_spec_mat[offsetCompressed ] =
( compressed_spec_mat[ offsetCompressed ]
+ averaged_spec_mat[ offsetASM + k ] ) / (divider * nbBinsToAverage);
paul
Bug #60 corrected...
 r102 }
}
}
}
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 void ASM_convert( volatile float *input_matrix, char *output_matrix)
paul
Bug #60 corrected...
 r102 {
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 unsigned int frequencyBin;
unsigned int asmComponent;
paul
Bug #60 corrected...
 r102 char * pt_char_input;
char * pt_char_output;
paul
There is a message queue between AVFO and MATR...
 r118 unsigned int offsetInput;
unsigned int offsetOutput;
paul
Bug #60 corrected...
 r102
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 pt_char_input = (char*) &input_matrix;
pt_char_output = (char*) &output_matrix;
paul
Bug #60 corrected...
 r102
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 // convert all other data
for( frequencyBin=0; frequencyBin<NB_BINS_PER_SM; frequencyBin++)
{
for ( asmComponent=0; asmComponent<NB_VALUES_PER_SM; asmComponent++)
paul
Bug #60 corrected...
 r102 {
paul
There is a message queue between AVFO and MATR...
 r118 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 ];
paul
Bug #60 corrected...
 r102 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
}
}
}
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 void ASM_send(Header_TM_LFR_SCIENCE_ASM_t *header, char *spectral_matrix,
paul
Bug #60 corrected...
 r102 unsigned int sid, spw_ioctl_pkt_send *spw_ioctl_send, rtems_id queue_id)
{
unsigned int i;
unsigned int length = 0;
rtems_status_code status;
for (i=0; i<2; i++)
{
// (1) BUILD THE DATA
switch(sid)
{
case SID_NORM_ASM_F0:
paul
AVF1 and PRC1 tasks are functional now
 r122 spw_ioctl_send->dlen = TOTAL_SIZE_ASM_F0_IN_BYTES / 2; // 2 packets will be sent
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 spw_ioctl_send->data = &spectral_matrix[
( (ASM_F0_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F0) ) * NB_VALUES_PER_SM ) * 2
];
paul
Bug #60 corrected...
 r102 length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F0;
header->pa_lfr_asm_blk_nr[0] = (unsigned char) ( (NB_BINS_PER_PKT_ASM_F0) >> 8 ); // BLK_NR MSB
header->pa_lfr_asm_blk_nr[1] = (unsigned char) (NB_BINS_PER_PKT_ASM_F0); // BLK_NR LSB
paul@pc-solar1.lab-lpp.local
All modes implemented for the waveforms...
 r23 break;
paul
Bug #60 corrected...
 r102 case SID_NORM_ASM_F1:
paul
AVF1 and PRC1 tasks are functional now
 r122 spw_ioctl_send->dlen = TOTAL_SIZE_ASM_F1_IN_BYTES / 2; // 2 packets will be sent
spw_ioctl_send->data = &spectral_matrix[
( (ASM_F1_INDICE_START + (i*NB_BINS_PER_PKT_ASM_F1) ) * NB_VALUES_PER_SM ) * 2
];
length = PACKET_LENGTH_TM_LFR_SCIENCE_ASM_F1;
header->pa_lfr_asm_blk_nr[0] = (unsigned char) ( (NB_BINS_PER_PKT_ASM_F1) >> 8 ); // BLK_NR MSB
header->pa_lfr_asm_blk_nr[1] = (unsigned char) (NB_BINS_PER_PKT_ASM_F1); // BLK_NR LSB
paul
Bug #60 corrected...
 r102 break;
case SID_NORM_ASM_F2:
paul@pc-solar1.lab-lpp.local
All modes implemented for the waveforms...
 r23 break;
default:
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 PRINTF1("ERR *** in ASM_send *** unexpected sid %d\n", sid)
paul@pc-solar1.lab-lpp.local
All modes implemented for the waveforms...
 r23 break;
paul
Bug #60 corrected...
 r102 }
spw_ioctl_send->hlen = HEADER_LENGTH_TM_LFR_SCIENCE_ASM + CCSDS_PROTOCOLE_EXTRA_BYTES;
spw_ioctl_send->hdr = (char *) header;
spw_ioctl_send->options = 0;
// (2) BUILD THE HEADER
header->packetLength[0] = (unsigned char) (length>>8);
header->packetLength[1] = (unsigned char) (length);
header->sid = (unsigned char) sid; // SID
header->pa_lfr_pkt_cnt_asm = 2;
header->pa_lfr_pkt_nr_asm = (unsigned char) (i+1);
// (3) SET PACKET TIME
header->time[0] = (unsigned char) (time_management_regs->coarse_time>>24);
header->time[1] = (unsigned char) (time_management_regs->coarse_time>>16);
header->time[2] = (unsigned char) (time_management_regs->coarse_time>>8);
header->time[3] = (unsigned char) (time_management_regs->coarse_time);
header->time[4] = (unsigned char) (time_management_regs->fine_time>>8);
header->time[5] = (unsigned char) (time_management_regs->fine_time);
//
header->acquisitionTime[0] = (unsigned char) (time_management_regs->coarse_time>>24);
header->acquisitionTime[1] = (unsigned char) (time_management_regs->coarse_time>>16);
header->acquisitionTime[2] = (unsigned char) (time_management_regs->coarse_time>>8);
header->acquisitionTime[3] = (unsigned char) (time_management_regs->coarse_time);
header->acquisitionTime[4] = (unsigned char) (time_management_regs->fine_time>>8);
header->acquisitionTime[5] = (unsigned char) (time_management_regs->fine_time);
// (4) SEND PACKET
status = rtems_message_queue_send( queue_id, spw_ioctl_send, ACTION_MSG_SPW_IOCTL_SEND_SIZE);
if (status != RTEMS_SUCCESSFUL) {
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 printf("in ASM_send *** ERR %d\n", (int) status);
paul
Bug #60 corrected...
 r102 }
paul@pc-solar1.lab-lpp.local
All modes implemented for the waveforms...
 r23 }
}
paul
Sync...
 r117 //*****************
// Basic Parameters
paul
Sync...
 r116
paul
Sync...
 r117 void BP_init_header( Header_TM_LFR_SCIENCE_BP_t *header,
paul
Sync...
 r116 unsigned int apid, unsigned char sid,
unsigned int packetLength, unsigned char blkNr )
paul
sync
 r113 {
header->targetLogicalAddress = CCSDS_DESTINATION_ID;
header->protocolIdentifier = CCSDS_PROTOCOLE_ID;
header->reserved = 0x00;
header->userApplication = CCSDS_USER_APP;
paul
Sync...
 r116 header->packetID[0] = (unsigned char) (apid >> 8);
header->packetID[1] = (unsigned char) (apid);
header->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
paul
sync
 r113 header->packetSequenceControl[1] = 0x00;
paul
Sync...
 r116 header->packetLength[0] = (unsigned char) (packetLength >> 8);
header->packetLength[1] = (unsigned char) (packetLength);
paul
sync
 r113 // DATA FIELD HEADER
header->spare1_pusVersion_spare2 = 0x10;
header->serviceType = TM_TYPE_LFR_SCIENCE; // service type
header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype
header->destinationID = TM_DESTINATION_ID_GROUND;
// AUXILIARY DATA HEADER
paul
Sync...
 r116 header->sid = sid;
paul
sync
 r113 header->biaStatusInfo = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->pa_lfr_bp_blk_nr[0] = 0x00; // BLK_NR MSB
paul
Sync...
 r116 header->pa_lfr_bp_blk_nr[1] = blkNr; // BLK_NR LSB
}
paul
Sync...
 r117 void BP_init_header_with_spare(Header_TM_LFR_SCIENCE_BP_with_spare_t *header,
paul
Sync...
 r116 unsigned int apid, unsigned char sid,
unsigned int packetLength , unsigned char blkNr)
{
header->targetLogicalAddress = CCSDS_DESTINATION_ID;
header->protocolIdentifier = CCSDS_PROTOCOLE_ID;
header->reserved = 0x00;
header->userApplication = CCSDS_USER_APP;
header->packetID[0] = (unsigned char) (apid >> 8);
header->packetID[1] = (unsigned char) (apid);
header->packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
header->packetSequenceControl[1] = 0x00;
header->packetLength[0] = (unsigned char) (packetLength >> 8);
header->packetLength[1] = (unsigned char) (packetLength);
// DATA FIELD HEADER
header->spare1_pusVersion_spare2 = 0x10;
header->serviceType = TM_TYPE_LFR_SCIENCE; // service type
header->serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype
header->destinationID = TM_DESTINATION_ID_GROUND;
// AUXILIARY DATA HEADER
header->sid = sid;
header->biaStatusInfo = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->time[0] = 0x00;
header->pa_lfr_bp_blk_nr[0] = 0x00; // BLK_NR MSB
header->pa_lfr_bp_blk_nr[1] = blkNr; // BLK_NR LSB
paul
sync
 r113 }
paul
Sync...
 r117 void BP_send(char *data, rtems_id queue_id, unsigned int nbBytesToSend )
{
rtems_status_code status;
// SEND PACKET
status = rtems_message_queue_send( queue_id, data, nbBytesToSend);
if (status != RTEMS_SUCCESSFUL)
{
printf("ERR *** in BP_send *** ERR %d\n", (int) status);
}
}
//******************
// general functions
paul
Sync
 r115 void reset_spectral_matrix_regs( void )
paul
SID corrected in TM_LFR_TC_EXE packets...
 r31 {
paul
Header files inclusion reworked...
 r40 /** 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
*
*/
paul
the function asm_reorganize format the spectral matrix to the ICD format
 r103 spectral_matrix_regs->config = 0x00;
spectral_matrix_regs->status = 0x00;
paul
Minor changes
 r93 spectral_matrix_regs->matrixF0_Address0 = current_ring_node_sm_f0->buffer_address;
spectral_matrix_regs->matrixFO_Address1 = current_ring_node_sm_f0->buffer_address;
spectral_matrix_regs->matrixF1_Address = current_ring_node_sm_f1->buffer_address;
spectral_matrix_regs->matrixF2_Address = current_ring_node_sm_f2->buffer_address;
paul
SID corrected in TM_LFR_TC_EXE packets...
 r31 }
paul
sy_lfr_n_swf_p implemented...
 r32
paul
Sync...
 r117 void set_time( unsigned char *time, unsigned char * timeInBuffer )
paul
Sync...
 r116 {
paul
Sync...
 r117 // time[0] = timeInBuffer[2];
// time[1] = timeInBuffer[3];
// time[2] = timeInBuffer[0];
// time[3] = timeInBuffer[1];
// time[4] = timeInBuffer[6];
// time[5] = timeInBuffer[7];
time[0] = timeInBuffer[0];
time[1] = timeInBuffer[1];
time[2] = timeInBuffer[2];
time[3] = timeInBuffer[3];
time[4] = timeInBuffer[6];
time[5] = timeInBuffer[7];
paul
Sync...
 r116 }
paul
sy_lfr_n_swf_p implemented...
 r32