##// END OF EJS Templates
HG_REPOSITORIES » LPP » INSTRUMENTATION » USERS » JEANDET » LFR_FSW
RSS

Fork of HG_REPOSITORIES/LPP/INSTRUMENTATION/SOLO_LFR/DEV_PLE

Clone from https://hephaistos.lpp.polytechnique.fr/rhodecode/HG_REPOSITORIES/LPP/INSTRUMENTATION/SOLO_LFR/DEV_PLE

the interrupt sub routine related to the waveform picker is now lighter...
the interrupt sub routine related to the waveform picker is now lighter no more picks are observed on the waveforms
paul - - Load All Authors

File last commit:

r112:5b5da8d2c053 VHDLib206
r112:5b5da8d2c053 VHDLib206
Show More
tc_load_dump_parameters.c
539 lines | 16.4 KiB | text/x-c | CLexer
/ src / tc_load_dump_parameters.c
History | Source | Raw |Copy content |Copy permalink
paul
Header files inclusion reworked...
 r40 /** Functions to load and dump parameters in the LFR registers.
*
* @file
* @author P. LEROY
*
* A group of functions to handle TC related to parameter loading and dumping.\n
* TC_LFR_LOAD_COMMON_PAR\n
* TC_LFR_LOAD_NORMAL_PAR\n
* TC_LFR_LOAD_BURST_PAR\n
* TC_LFR_LOAD_SBM1_PAR\n
* TC_LFR_LOAD_SBM2_PAR\n
*
*/
#include "tc_load_dump_parameters.h"
int action_load_common_par(ccsdsTelecommandPacket_t *TC)
{
/** This function updates the LFR registers with the incoming common parameters.
*
* @param TC points to the TeleCommand packet that is being processed
*
*
*/
paul
Minor changes in .h inclusion
 r45
paul
Header files inclusion reworked...
 r40 parameter_dump_packet.unused0 = TC->dataAndCRC[0];
parameter_dump_packet.bw_sp0_sp1_r0_r1 = TC->dataAndCRC[1];
paul
Sync
 r97 set_wfp_data_shaping( );
paul
Header files inclusion reworked...
 r40 return LFR_SUCCESSFUL;
}
paul
fsw-0-23...
 r75 int action_load_normal_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
paul
Header files inclusion reworked...
 r40 {
/** This function updates the LFR registers with the incoming normal parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
paul
Minor changes in .h inclusion
 r45
paul
Header files inclusion reworked...
 r40 int result;
int flag;
paul
Minor modifications to meet Logiscope requirements
 r78 rtems_status_code status;
paul
Header files inclusion reworked...
 r40
flag = LFR_SUCCESSFUL;
paul
fsw-0-20
 r58 if ( (lfrCurrentMode == LFR_MODE_NORMAL) ||
(lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) ) {
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
paul
Header files inclusion reworked...
 r40 flag = LFR_DEFAULT;
}
//***************
// sy_lfr_n_swf_l
if (flag == LFR_SUCCESSFUL)
{
paul
fsw-0-23...
 r75 result = set_sy_lfr_n_swf_l( TC, queue_id, time );
paul
Header files inclusion reworked...
 r40 if (result != LFR_SUCCESSFUL)
{
flag = LFR_DEFAULT;
}
}
//***************
// sy_lfr_n_swf_p
if (flag == LFR_SUCCESSFUL)
{
paul
fsw-0-23...
 r75 result = set_sy_lfr_n_swf_p( TC, queue_id, time );
paul
Header files inclusion reworked...
 r40 if (result != LFR_SUCCESSFUL)
{
flag = LFR_DEFAULT;
}
}
//***************
paul
rev 1.0.0.1
 r98 // sy_lfr_n_asm_p
paul
Header files inclusion reworked...
 r40 if (flag == LFR_SUCCESSFUL)
{
result = set_sy_lfr_n_asm_p( TC, queue_id );
if (result != LFR_SUCCESSFUL)
{
flag = LFR_DEFAULT;
}
}
//***************
paul
rev 1.0.0.1
 r98 // sy_lfr_n_bp_p0
paul
Header files inclusion reworked...
 r40 if (flag == LFR_SUCCESSFUL)
{
result = set_sy_lfr_n_bp_p0( TC, queue_id );
if (result != LFR_SUCCESSFUL)
{
flag = LFR_DEFAULT;
}
}
//***************
// sy_lfr_n_bp_p1
if (flag == LFR_SUCCESSFUL)
{
result = set_sy_lfr_n_bp_p1( TC, queue_id );
if (result != LFR_SUCCESSFUL)
{
flag = LFR_DEFAULT;
}
}
paul
ICD 2.0...
 r92 //*********************
// sy_lfr_n_cwf_long_f3
if (flag == LFR_SUCCESSFUL)
{
result = set_sy_lfr_n_cwf_long_f3( TC, queue_id );
if (result != LFR_SUCCESSFUL)
{
flag = LFR_DEFAULT;
}
}
paul
fsw-0-20
 r58 return flag;
paul
Header files inclusion reworked...
 r40 }
paul
fsw-0-23...
 r75 int action_load_burst_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
paul
Header files inclusion reworked...
 r40 {
/** This function updates the LFR registers with the incoming burst parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
paul
Minor changes in .h inclusion
 r45
paul
Header files inclusion reworked...
 r40 int result;
unsigned char lfrMode;
paul
Minor modifications to meet Logiscope requirements
 r78 rtems_status_code status;
paul
Header files inclusion reworked...
 r40
result = LFR_DEFAULT;
lfrMode = (housekeeping_packet.lfr_status_word[0] & 0xf0) >> 4;
if ( lfrMode == LFR_MODE_BURST ) {
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
paul
Header files inclusion reworked...
 r40 result = LFR_DEFAULT;
}
else {
parameter_dump_packet.sy_lfr_b_bp_p0 = TC->dataAndCRC[0];
parameter_dump_packet.sy_lfr_b_bp_p1 = TC->dataAndCRC[1];
result = LFR_SUCCESSFUL;
}
return result;
}
paul
fsw-0-23...
 r75 int action_load_sbm1_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
paul
Header files inclusion reworked...
 r40 {
/** This function updates the LFR registers with the incoming sbm1 parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int result;
unsigned char lfrMode;
paul
Minor modifications to meet Logiscope requirements
 r78 rtems_status_code status;
paul
Header files inclusion reworked...
 r40
result = LFR_DEFAULT;
lfrMode = (housekeeping_packet.lfr_status_word[0] & 0xf0) >> 4;
paul
the interrupt sub routine related to the waveform picker is now lighter...
 r112 if ( lfrMode == LFR_MODE_SBM1 ) {
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
paul
Header files inclusion reworked...
 r40 result = LFR_DEFAULT;
}
else {
parameter_dump_packet.sy_lfr_s1_bp_p0 = TC->dataAndCRC[0];
parameter_dump_packet.sy_lfr_s1_bp_p1 = TC->dataAndCRC[1];
result = LFR_SUCCESSFUL;
}
return result;
}
paul
fsw-0-23...
 r75 int action_load_sbm2_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time)
paul
Header files inclusion reworked...
 r40 {
/** This function updates the LFR registers with the incoming sbm2 parameters.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int result;
unsigned char lfrMode;
paul
Minor modifications to meet Logiscope requirements
 r78 rtems_status_code status;
paul
Header files inclusion reworked...
 r40
result = LFR_DEFAULT;
lfrMode = (housekeeping_packet.lfr_status_word[0] & 0xf0) >> 4;
paul
the interrupt sub routine related to the waveform picker is now lighter...
 r112 if ( lfrMode == LFR_MODE_SBM2 ) {
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_not_executable( TC, queue_id );
paul
Header files inclusion reworked...
 r40 result = LFR_DEFAULT;
}
else {
parameter_dump_packet.sy_lfr_s2_bp_p0 = TC->dataAndCRC[0];
parameter_dump_packet.sy_lfr_s2_bp_p1 = TC->dataAndCRC[1];
result = LFR_SUCCESSFUL;
}
return result;
}
int action_dump_par( rtems_id queue_id )
{
/** This function dumps the LFR parameters by sending the appropriate TM packet to the dedicated RTEMS message queue.
*
* @param queue_id is the id of the queue which handles TM related to this execution step.
*
* @return RTEMS directive status codes:
* - RTEMS_SUCCESSFUL - message sent successfully
* - RTEMS_INVALID_ID - invalid queue id
* - RTEMS_INVALID_SIZE - invalid message size
* - RTEMS_INVALID_ADDRESS - buffer is NULL
* - RTEMS_UNSATISFIED - out of message buffers
* - RTEMS_TOO_MANY - queue s limit has been reached
*
*/
int status;
paul
Ignore doc files...
 r46 // UPDATE TIME
paul
sequence counters management added
 r56 increment_seq_counter( parameter_dump_packet.packetSequenceControl );
paul
Ignore doc files...
 r46 parameter_dump_packet.time[0] = (unsigned char) (time_management_regs->coarse_time>>24);
parameter_dump_packet.time[1] = (unsigned char) (time_management_regs->coarse_time>>16);
parameter_dump_packet.time[2] = (unsigned char) (time_management_regs->coarse_time>>8);
parameter_dump_packet.time[3] = (unsigned char) (time_management_regs->coarse_time);
parameter_dump_packet.time[4] = (unsigned char) (time_management_regs->fine_time>>8);
parameter_dump_packet.time[5] = (unsigned char) (time_management_regs->fine_time);
paul
Header files inclusion reworked...
 r40 // SEND DATA
status = rtems_message_queue_send( queue_id, &parameter_dump_packet,
PACKET_LENGTH_PARAMETER_DUMP + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES);
if (status != RTEMS_SUCCESSFUL) {
PRINTF1("in action_dump *** ERR sending packet, code %d", status)
}
return status;
}
//***********************
// NORMAL MODE PARAMETERS
paul
fsw-0-23...
 r75 int set_sy_lfr_n_swf_l( ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time )
paul
Header files inclusion reworked...
 r40 {
/** This function sets the number of points of a snapshot (sy_lfr_n_swf_l).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
unsigned int tmp;
int result;
unsigned char msb;
unsigned char lsb;
paul
Minor modifications to meet Logiscope requirements
 r78 rtems_status_code status;
paul
Header files inclusion reworked...
 r40
msb = TC->dataAndCRC[ BYTE_POS_SY_LFR_N_SWF_L ];
lsb = TC->dataAndCRC[ BYTE_POS_SY_LFR_N_SWF_L+1 ];
tmp = ( unsigned int ) floor(
( ( msb*256 ) + lsb ) / 16
) * 16;
if ( (tmp < 16) || (tmp > 2048) ) // the snapshot period is a multiple of 16
paul
fsw-0-16...
 r47 { // 2048 is the maximum limit due to the size of the buffers
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, BYTE_POS_SY_LFR_N_SWF_L+10, lsb );
paul
Header files inclusion reworked...
 r40 result = WRONG_APP_DATA;
}
else if (tmp != 2048)
{
paul
Minor modifications to meet Logiscope requirements
 r78 status = send_tm_lfr_tc_exe_not_implemented( TC, queue_id, time );
paul
Header files inclusion reworked...
 r40 result = FUNCT_NOT_IMPL;
}
else
{
parameter_dump_packet.sy_lfr_n_swf_l[0] = (unsigned char) (tmp >> 8);
parameter_dump_packet.sy_lfr_n_swf_l[1] = (unsigned char) (tmp );
result = LFR_SUCCESSFUL;
}
return result;
}
paul
fsw-0-23...
 r75 int set_sy_lfr_n_swf_p(ccsdsTelecommandPacket_t *TC, rtems_id queue_id , unsigned char *time)
paul
Header files inclusion reworked...
 r40 {
/** This function sets the time between two snapshots, in s (sy_lfr_n_swf_p).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
unsigned int tmp;
int result;
unsigned char msb;
unsigned char lsb;
paul
Minor modifications to meet Logiscope requirements
 r78 rtems_status_code status;
paul
Header files inclusion reworked...
 r40
msb = TC->dataAndCRC[ BYTE_POS_SY_LFR_N_SWF_P ];
lsb = TC->dataAndCRC[ BYTE_POS_SY_LFR_N_SWF_P+1 ];
paul
Sync
 r97 tmp = msb * 256 + lsb;
paul
Header files inclusion reworked...
 r40
paul
Sync
 r97 if ( tmp < 16 )
paul
Header files inclusion reworked...
 r40 {
paul
rev 1.0.0.2...
 r104 status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, BYTE_POS_SY_LFR_N_SWF_P+10, lsb );
paul
Header files inclusion reworked...
 r40 result = WRONG_APP_DATA;
}
else
{
parameter_dump_packet.sy_lfr_n_swf_p[0] = (unsigned char) (tmp >> 8);
parameter_dump_packet.sy_lfr_n_swf_p[1] = (unsigned char) (tmp );
result = LFR_SUCCESSFUL;
}
return result;
}
int set_sy_lfr_n_asm_p( ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
{
paul
Ignore doc files...
 r46 /** This function sets the time between two full spectral matrices transmission, in s (SY_LFR_N_ASM_P).
paul
Header files inclusion reworked...
 r40 *
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int result;
unsigned char msb;
unsigned char lsb;
msb = TC->dataAndCRC[ BYTE_POS_SY_LFR_N_ASM_P ];
lsb = TC->dataAndCRC[ BYTE_POS_SY_LFR_N_ASM_P+1 ];
parameter_dump_packet.sy_lfr_n_asm_p[0] = msb;
parameter_dump_packet.sy_lfr_n_asm_p[1] = lsb;
result = LFR_SUCCESSFUL;
return result;
}
int set_sy_lfr_n_bp_p0( ccsdsTelecommandPacket_t *TC, rtems_id queue_id )
{
paul
Ignore doc files...
 r46 /** This function sets the time between two basic parameter sets, in s (SY_LFR_N_BP_P0).
paul
Header files inclusion reworked...
 r40 *
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
parameter_dump_packet.sy_lfr_n_bp_p0 = TC->dataAndCRC[ BYTE_POS_SY_LFR_N_BP_P0 ];
return status;
}
int set_sy_lfr_n_bp_p1(ccsdsTelecommandPacket_t *TC, rtems_id queue_id)
{
/** This function sets the time between two basic parameter sets (autocorrelation + crosscorrelation), in s (sy_lfr_n_bp_p1).
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
parameter_dump_packet.sy_lfr_n_bp_p1 = TC->dataAndCRC[ BYTE_POS_SY_LFR_N_BP_P1 ];
return status;
}
paul
ICD 2.0...
 r92 int set_sy_lfr_n_cwf_long_f3(ccsdsTelecommandPacket_t *TC, rtems_id queue_id)
{
/** This function allows to switch from CWF_F3 packets to CWF_LONG_F3 packets.
*
* @param TC points to the TeleCommand packet that is being processed
* @param queue_id is the id of the queue which handles TM related to this execution step
*
*/
int status;
status = LFR_SUCCESSFUL;
parameter_dump_packet.sy_lfr_n_cwf_long_f3 = TC->dataAndCRC[ BYTE_POS_SY_LFR_N_CWF_LONG_F3 ];
return status;
}
paul
Header files inclusion reworked...
 r40 //**********************
// BURST MODE PARAMETERS
//*********************
// SBM1 MODE PARAMETERS
//*********************
// SBM2 MODE PARAMETERS
paul
rev 1.0.0.2...
 r104 //*******************
// TC_LFR_UPDATE_INFO
unsigned int check_update_info_hk_lfr_mode( unsigned char mode )
{
unsigned int status;
if ( (mode == LFR_MODE_STANDBY) || (mode == LFR_MODE_NORMAL)
paul
Corrections:...
 r107 || (mode == LFR_MODE_BURST)
paul
rev 1.0.0.2...
 r104 || (mode == LFR_MODE_SBM1) || (mode == LFR_MODE_SBM2))
{
status = LFR_SUCCESSFUL;
}
else
{
status = LFR_DEFAULT;
}
return status;
}
unsigned int check_update_info_hk_tds_mode( unsigned char mode )
{
unsigned int status;
if ( (mode == TDS_MODE_STANDBY) || (mode == TDS_MODE_NORMAL)
paul
Corrections:...
 r107 || (mode == TDS_MODE_BURST)
paul
rev 1.0.0.2...
 r104 || (mode == TDS_MODE_SBM1) || (mode == TDS_MODE_SBM2)
|| (mode == TDS_MODE_LFM))
{
status = LFR_SUCCESSFUL;
}
else
{
status = LFR_DEFAULT;
}
return status;
}
unsigned int check_update_info_hk_thr_mode( unsigned char mode )
{
unsigned int status;
if ( (mode == THR_MODE_STANDBY) || (mode == THR_MODE_NORMAL)
paul
Corrections:...
 r107 || (mode == THR_MODE_BURST))
paul
rev 1.0.0.2...
 r104 {
status = LFR_SUCCESSFUL;
}
else
{
status = LFR_DEFAULT;
}
return status;
}
paul
Ignore doc files...
 r46 //**********
// init dump
void init_parameter_dump( void )
{
/** This function initialize the parameter_dump_packet global variable with default values.
*
*/
parameter_dump_packet.targetLogicalAddress = CCSDS_DESTINATION_ID;
parameter_dump_packet.protocolIdentifier = CCSDS_PROTOCOLE_ID;
parameter_dump_packet.reserved = CCSDS_RESERVED;
parameter_dump_packet.userApplication = CCSDS_USER_APP;
parameter_dump_packet.packetID[0] = (unsigned char) (TM_PACKET_ID_PARAMETER_DUMP >> 8);
parameter_dump_packet.packetID[1] = (unsigned char) TM_PACKET_ID_PARAMETER_DUMP;
parameter_dump_packet.packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
parameter_dump_packet.packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
parameter_dump_packet.packetLength[0] = (unsigned char) (PACKET_LENGTH_PARAMETER_DUMP >> 8);
parameter_dump_packet.packetLength[1] = (unsigned char) PACKET_LENGTH_PARAMETER_DUMP;
// DATA FIELD HEADER
parameter_dump_packet.spare1_pusVersion_spare2 = SPARE1_PUSVERSION_SPARE2;
parameter_dump_packet.serviceType = TM_TYPE_PARAMETER_DUMP;
parameter_dump_packet.serviceSubType = TM_SUBTYPE_PARAMETER_DUMP;
parameter_dump_packet.destinationID = TM_DESTINATION_ID_GROUND;
parameter_dump_packet.time[0] = (unsigned char) (time_management_regs->coarse_time>>24);
parameter_dump_packet.time[1] = (unsigned char) (time_management_regs->coarse_time>>16);
parameter_dump_packet.time[2] = (unsigned char) (time_management_regs->coarse_time>>8);
parameter_dump_packet.time[3] = (unsigned char) (time_management_regs->coarse_time);
parameter_dump_packet.time[4] = (unsigned char) (time_management_regs->fine_time>>8);
parameter_dump_packet.time[5] = (unsigned char) (time_management_regs->fine_time);
parameter_dump_packet.sid = SID_PARAMETER_DUMP;
//******************
// COMMON PARAMETERS
parameter_dump_packet.unused0 = DEFAULT_SY_LFR_COMMON0;
parameter_dump_packet.bw_sp0_sp1_r0_r1 = DEFAULT_SY_LFR_COMMON1;
//******************
// NORMAL PARAMETERS
parameter_dump_packet.sy_lfr_n_swf_l[0] = (unsigned char) (SY_LFR_N_SWF_L >> 8);
parameter_dump_packet.sy_lfr_n_swf_l[1] = (unsigned char) (SY_LFR_N_SWF_L );
parameter_dump_packet.sy_lfr_n_swf_p[0] = (unsigned char) (SY_LFR_N_SWF_P >> 8);
parameter_dump_packet.sy_lfr_n_swf_p[1] = (unsigned char) (SY_LFR_N_SWF_P );
parameter_dump_packet.sy_lfr_n_asm_p[0] = (unsigned char) (SY_LFR_N_ASM_P >> 8);
parameter_dump_packet.sy_lfr_n_asm_p[1] = (unsigned char) (SY_LFR_N_ASM_P );
parameter_dump_packet.sy_lfr_n_bp_p0 = (unsigned char) SY_LFR_N_BP_P0;
parameter_dump_packet.sy_lfr_n_bp_p1 = (unsigned char) SY_LFR_N_BP_P1;
paul
rev 1.0.0.1
 r98 parameter_dump_packet.sy_lfr_n_cwf_long_f3 = (unsigned char) SY_LFR_N_CWF_LONG_F3;
paul
Ignore doc files...
 r46
//*****************
// BURST PARAMETERS
parameter_dump_packet.sy_lfr_b_bp_p0 = (unsigned char) DEFAULT_SY_LFR_B_BP_P0;
parameter_dump_packet.sy_lfr_b_bp_p1 = (unsigned char) DEFAULT_SY_LFR_B_BP_P1;
//****************
// SBM1 PARAMETERS
parameter_dump_packet.sy_lfr_s1_bp_p0 = (unsigned char) DEFAULT_SY_LFR_S1_BP_P0; // min value is 0.25 s for the period
parameter_dump_packet.sy_lfr_s1_bp_p1 = (unsigned char) DEFAULT_SY_LFR_S1_BP_P1;
//****************
// SBM2 PARAMETERS
parameter_dump_packet.sy_lfr_s2_bp_p0 = (unsigned char) DEFAULT_SY_LFR_S2_BP_P0;
parameter_dump_packet.sy_lfr_s2_bp_p1 = (unsigned char) DEFAULT_SY_LFR_S2_BP_P1;
}
paul
Header files inclusion reworked...
 r40