HG_REPOSITORIES/LPP/INSTRUMENTATION/USERS/JEANDET/LFR_FSW Commit - r283:c0251025dc7b

ICD 4.1 taken into account

paul -

r283:c0251025dc7b R3_plus

parent child

Context file:

r283:c0251025dc7b

Collapse all files

.hgsubstate +1 -1

@@ -1,2 +1,2
1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters	1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters
2	c3197ff831df5057bdd145a4efd94ded0618661f header/lfr_common_headers	2	81c3289ebd2a13e3b3147acdf60e34678378f905 header/lfr_common_headers

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

                 ../header/lfr_common_headers/fsw_params.h \
                 ../header/lfr_common_headers/fsw_params_nb_bytes.h \
                 ../header/lfr_common_headers/fsw_params_processing.h \
-                ../header/lfr_common_headers/TC_types.h \
                 ../header/lfr_common_headers/tm_byte_positions.h \
                 ../LFR_basic-parameters/basic_parameters.h \
                 ../LFR_basic-parameters/basic_parameters_params.h \

header/fsw_init.h +9 0

@@ -21,6 +21,15 extern rtems_id Task_id[20];
21	extern rtems_name timecode_timer_name;	21	extern rtems_name timecode_timer_name;
22	extern rtems_id timecode_timer_id;	22	extern rtems_id timecode_timer_id;
23	extern unsigned char pa_bia_status_info;	23	extern unsigned char pa_bia_status_info;
		24	extern unsigned char cp_rpw_sc_rw_f_flags;
		25	extern float cp_rpw_sc_rw1_f1;
		26	extern float cp_rpw_sc_rw1_f2;
		27	extern float cp_rpw_sc_rw2_f1;
		28	extern float cp_rpw_sc_rw2_f2;
		29	extern float cp_rpw_sc_rw3_f1;
		30	extern float cp_rpw_sc_rw3_f2;
		31	extern float cp_rpw_sc_rw4_f1;
		32	extern float cp_rpw_sc_rw4_f2;
24		33
25	// RTEMS TASKS	34	// RTEMS TASKS
26	rtems_task Init( rtems_task_argument argument);	35	rtems_task Init( rtems_task_argument argument);

header/processing/fsw_processing.h +5 -2

                 unsigned char time[6];
                 // AUXILIARY HEADER
                 unsigned char sid;
-                unsigned char biaStatusInfo;
+                unsigned char pa_bia_status_info;
                 unsigned char sy_lfr_common_parameters_spare;
                 unsigned char sy_lfr_common_parameters;
                 unsigned char acquisitionTime[6];
                 unsigned char time[6];
                 // AUXILIARY HEADER
                 unsigned char sid;
-                unsigned char biaStatusInfo;
+                unsigned char pa_bia_status_info;
                 unsigned char sy_lfr_common_parameters_spare;
                 unsigned char sy_lfr_common_parameters;
                 unsigned char acquisitionTime[6];
             // parameters
             extern struct param_local_str param_local;
             extern Packet_TM_LFR_PARAMETER_DUMP_t parameter_dump_packet;
+            extern unsigned char rw_fbins_mask_f0[16];
+            extern unsigned char rw_fbins_mask_f1[16];
+            extern unsigned char rw_fbins_mask_f2[16];
             // registers
             extern time_management_regs_t *time_management_regs;

header/tc_load_dump_parameters.h +7 -1

             extern float k_coeff_intercalib_f1_norm[ ];
             extern float k_coeff_intercalib_f1_sbm[ ];
             extern float k_coeff_intercalib_f2[ ];
+            extern unsigned char rw_fbins_mask_f0[16];
+            extern unsigned char rw_fbins_mask_f1[16];
+            extern unsigned char rw_fbins_mask_f2[16];
             int action_load_common_par( ccsdsTelecommandPacket_t *TC );
             int action_load_normal_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id , unsigned char *time);
             int action_load_sbm2_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id , unsigned char *time);
             int action_load_kcoefficients(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time);
             int action_load_fbins_mask(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time);
-            int action_load_pas_filter_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time);
+            int action_load_filter_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time);
             int action_dump_kcoefficients(ccsdsTelecommandPacket_t *TC, rtems_id queue_id, unsigned char *time);
             int action_dump_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id );
             unsigned int check_update_info_hk_lfr_mode( unsigned char mode );
             unsigned int check_update_info_hk_tds_mode( unsigned char mode );
             unsigned int check_update_info_hk_thr_mode( unsigned char mode );
+            void getReactionWheelsFrequencies( ccsdsTelecommandPacket_t *TC );
+            void build_rw_fbins_mask( unsigned int channel );
+            void build_rw_fbins_masks();
             // FBINS_MASK
             int set_sy_lfr_fbins( ccsdsTelecommandPacket_t *TC );

src/fsw_globals.c +14 0

@@ -66,6 +66,7 unsigned int lastValidEnterModeTime;
66		66
67	// HK PACKETS	67	// HK PACKETS
68	Packet_TM_LFR_HK_t housekeeping_packet;	68	Packet_TM_LFR_HK_t housekeeping_packet;
		69	unsigned char cp_rpw_sc_rw_f_flags;
69	// message queues occupancy	70	// message queues occupancy
70	unsigned char hk_lfr_q_sd_fifo_size_max;	71	unsigned char hk_lfr_q_sd_fifo_size_max;
71	unsigned char hk_lfr_q_rv_fifo_size_max;	72	unsigned char hk_lfr_q_rv_fifo_size_max;
@@ -79,3 +80,16 unsigned short sequenceCounters_TC_EXE[S
79	unsigned short sequenceCounters_TM_DUMP[SEQ_CNT_NB_DEST_ID];	80	unsigned short sequenceCounters_TM_DUMP[SEQ_CNT_NB_DEST_ID];
80	unsigned short sequenceCounterHK;	81	unsigned short sequenceCounterHK;
81	spw_stats grspw_stats;	82	spw_stats grspw_stats;
		83
		84	// TC_LFR_UPDATE_INFO
		85	float cp_rpw_sc_rw1_f1;
		86	float cp_rpw_sc_rw1_f2;
		87	float cp_rpw_sc_rw2_f1;
		88	float cp_rpw_sc_rw2_f2;
		89	float cp_rpw_sc_rw3_f1;
		90	float cp_rpw_sc_rw3_f2;
		91	float cp_rpw_sc_rw4_f1;
		92	float cp_rpw_sc_rw4_f2;
		93	unsigned char rw_fbins_mask_f0[16];
		94	unsigned char rw_fbins_mask_f1[16];
		95	unsigned char rw_fbins_mask_f2[16];

src/fsw_init.c +9 0

@@ -160,6 +160,15 rtems_task Init( rtems_task_argument ign
160	init_k_coefficients_prc1();	160	init_k_coefficients_prc1();
161	init_k_coefficients_prc2();	161	init_k_coefficients_prc2();
162	pa_bia_status_info = 0x00;	162	pa_bia_status_info = 0x00;
		163	cp_rpw_sc_rw_f_flags = 0x00;
		164	cp_rpw_sc_rw1_f1 = 0.0;
		165	cp_rpw_sc_rw1_f2 = 0.0;
		166	cp_rpw_sc_rw2_f1 = 0.0;
		167	cp_rpw_sc_rw2_f2 = 0.0;
		168	cp_rpw_sc_rw3_f1 = 0.0;
		169	cp_rpw_sc_rw3_f2 = 0.0;
		170	cp_rpw_sc_rw4_f1 = 0.0;
		171	cp_rpw_sc_rw4_f2 = 0.0;
163	update_last_valid_transition_date( DEFAULT_LAST_VALID_TRANSITION_DATE );	172	update_last_valid_transition_date( DEFAULT_LAST_VALID_TRANSITION_DATE );
164		173
165	// waveform picker initialization	174	// waveform picker initialization

src/fsw_misc.c +2 0

                         hk_lfr_le_me_he_update();
+                        housekeeping_packet.hk_lfr_sc_rw_f_flags = cp_rpw_sc_rw_f_flags;
                         // SEND PACKET
                         status =  rtems_message_queue_send( queue_id, &housekeeping_packet,
                                                             PACKET_LENGTH_HK + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES);

src/fsw_spacewire.c +9 -9

                 header->time[0] = 0x00;
                 // AUXILIARY DATA HEADER
                 header->sid = 0x00;
-                header->hkBIA = DEFAULT_HKBIA;
+                header->pa_bia_status_info = DEFAULT_HKBIA;
                 header->blkNr[0] = 0x00;
                 header->blkNr[1] = 0x00;
             }
                 header->time[0] = 0x00;
                 // AUXILIARY DATA HEADER
                 header->sid     = 0x00;
-                header->hkBIA   = DEFAULT_HKBIA;
+                header->pa_bia_status_info   = DEFAULT_HKBIA;
                 header->pktCnt  = DEFAULT_PKTCNT;  // PKT_CNT
                 header->pktNr   = 0x00;
                 header->blkNr[0]        = (unsigned char) (BLK_NR_CWF >> 8);
                 header->time[0] = 0x00;
                 // AUXILIARY DATA HEADER
                 header->sid     = 0x00;
-                header->biaStatusInfo = 0x00;
+                header->pa_bia_status_info = 0x00;
                 header->pa_lfr_pkt_cnt_asm = 0x00;
                 header->pa_lfr_pkt_nr_asm = 0x00;
                 header->pa_lfr_asm_blk_nr[0] = 0x00;
                 header->packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_336 >> 8);
                 header->packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_336     );
-                header->hkBIA = pa_bia_status_info;
+                header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 header->blkNr[0] = (unsigned char) (BLK_NR_CWF >> 8);
                 header->blkNr[1] = (unsigned char) (BLK_NR_CWF     );
                 dataPtr     = (int*) ring_node_to_send->buffer_address;
                 sid = ring_node_to_send->sid;
-                header->hkBIA = pa_bia_status_info;
+                header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<7; i++) // send waveform
                 header->packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_672 >> 8);
                 header->packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_672     );
-                header->hkBIA = pa_bia_status_info;
+                header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 header->blkNr[0] = (unsigned char) (BLK_NR_CWF_SHORT_F3 >> 8);
                 header->blkNr[1] = (unsigned char) (BLK_NR_CWF_SHORT_F3     );
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
-                header->biaStatusInfo = pa_bia_status_info;
+                header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<3; i++)
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
-                header->biaStatusInfo = pa_bia_status_info;
+                header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<3; i++)
                 coarseTime = ring_node_to_send->coarseTime;
                 fineTime = ring_node_to_send->fineTime;
-                header->biaStatusInfo = pa_bia_status_info;
+                header->pa_bia_status_info = pa_bia_status_info;
                 header->sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                 for (i=0; i<3; i++)

src/processing/avf0_prc0.c +4 -4

                         // 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.pa_bia_status_info = pa_bia_status_info;
                         packet_sbm_bp1.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send_s1_s2( (char *) &packet_sbm_bp1, queue_id,
                                  PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F0 + PACKET_LENGTH_DELTA,
                             // 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.pa_bia_status_info = pa_bia_status_info;
                             packet_sbm_bp2.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                             BP_send_s1_s2( (char *) &packet_sbm_bp2, queue_id,
                                      PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F0 + PACKET_LENGTH_DELTA,
                         // 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.pa_bia_status_info = 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,
                             // 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.pa_bia_status_info = 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,

src/processing/avf1_prc1.c +4 -4

                         // 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.pa_bia_status_info = pa_bia_status_info;
                         packet_sbm_bp1.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send_s1_s2( (char *) &packet_sbm_bp1, queue_id_send,
                                  PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP1_F1 + PACKET_LENGTH_DELTA,
                             // 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.pa_bia_status_info = pa_bia_status_info;
                             packet_sbm_bp2.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                             BP_send_s1_s2( (char *) &packet_sbm_bp2, queue_id_send,
                                      PACKET_LENGTH_TM_LFR_SCIENCE_SBM_BP2_F1 + PACKET_LENGTH_DELTA,
                         // 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.pa_bia_status_info = 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,
                             // 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.pa_bia_status_info = 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,

src/processing/avf2_prc2.c +2 -2

                         // 2) send the BP1 set
                         set_time( packet_norm_bp1.time,            (unsigned char *) &incomingMsg->coarseTimeNORM );
                         set_time( packet_norm_bp1.acquisitionTime, (unsigned char *) &incomingMsg->coarseTimeNORM );
-                        packet_norm_bp1.biaStatusInfo = pa_bia_status_info;
+                        packet_norm_bp1.pa_bia_status_info = pa_bia_status_info;
                         packet_norm_bp1.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send( (char *) &packet_norm_bp1, queue_id_send,
                                  PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP1_F2 + PACKET_LENGTH_DELTA,
                         // 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.pa_bia_status_info = pa_bia_status_info;
                         packet_norm_bp2.sy_lfr_common_parameters = parameter_dump_packet.sy_lfr_common_parameters;
                         BP_send( (char *) &packet_norm_bp2, queue_id_send,
                                  PACKET_LENGTH_TM_LFR_SCIENCE_NORM_BP2_F2 + PACKET_LENGTH_DELTA,

src/processing/fsw_processing.c +2 -2

                 packet->time[5] = 0x00;
                 // AUXILIARY DATA HEADER
                 packet->sid = sid;
-                packet->biaStatusInfo = 0x00;
+                packet->pa_bia_status_info = 0x00;
                 packet->sy_lfr_common_parameters_spare = 0x00;
                 packet->sy_lfr_common_parameters = 0x00;
                 packet->acquisitionTime[0] = 0x00;
                 packet->destinationID = TM_DESTINATION_ID_GROUND;
                 // AUXILIARY DATA HEADER
                 packet->sid = sid;
-                packet->biaStatusInfo = 0x00;
+                packet->pa_bia_status_info = 0x00;
                 packet->sy_lfr_common_parameters_spare = 0x00;
                 packet->sy_lfr_common_parameters = 0x00;
                 packet->time[0] = 0x00;

src/tc_acceptance.c +3 -3

                          || (packetSubType == TC_SUBTYPE_EN_CAL)    || (packetSubType == TC_SUBTYPE_DIS_CAL)
                          || (packetSubType == TC_SUBTYPE_LOAD_K)    || (packetSubType == TC_SUBTYPE_DUMP_K)
                          || (packetSubType == TC_SUBTYPE_LOAD_FBINS)
-                         || (packetSubType == TC_SUBTYPE_LOAD_PAS_FILTER_PAR))
+                         || (packetSubType == TC_SUBTYPE_LOAD_FILTER_PAR))
                     {
                         status = CCSDS_TM_VALID;
                     }
                         status = CCSDS_TM_VALID;
                     }
                     break;
-                case TC_SUBTYPE_LOAD_PAS_FILTER_PAR:
+                case TC_SUBTYPE_LOAD_FILTER_PAR:
-                    if (length!=(TC_LEN_LOAD_PAS_FILTER_PAR-CCSDS_TC_TM_PACKET_OFFSET)) {
+                    if (length!=(TC_LEN_LOAD_FILTER_PAR-CCSDS_TC_TM_PACKET_OFFSET)) {
                         status = WRONG_LEN_PKT;
                     }
                     else {

src/tc_handler.c +7 -2

                             result = action_load_fbins_mask( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
-                        case TC_SUBTYPE_LOAD_PAS_FILTER_PAR:
+                        case TC_SUBTYPE_LOAD_FILTER_PAR:
-                            result = action_load_pas_filter_par( &TC, queue_snd_id, time );
+                            result = action_load_filter_par( &TC, queue_snd_id, time );
                             close_action( &TC, result, queue_snd_id );
                             break;
                         case TC_SUBTYPE_UPDT_TIME:
                 pa_bia_status_info = pa_bia_status_info
                         | (bytePosPtr[ BYTE_POS_UPDATE_INFO_PARAMETERS_SET1 ] & 0x1);
+                // REACTION_WHEELS_FREQUENCY, copy the incoming parameters in the local variable (to be copied in HK packets)
+                cp_rpw_sc_rw_f_flags = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW_F_FLAGS ];
+                getReactionWheelsFrequencies( TC );
+                build_rw_fbins_masks();
                 result = status;
                 return result;

src/tc_load_dump_parameters.c +163 -13

@@ -310,7 +310,7 int action_load_fbins_mask(ccsdsTelecomm
310	return flag;	310	return flag;
311	}	311	}
312		312
313	int action_load_~~pas_~~filter_par(ccsdsTelecommandPacket_t TC, rtems_id queue_id, unsigned char time)	313	int action_load_filter_par(ccsdsTelecommandPacket_t TC, rtems_id queue_id, unsigned char time)
314	{	314	{
315	/** This function updates the LFR registers with the incoming sbm2 parameters.	315	/** This function updates the LFR registers with the incoming sbm2 parameters.
316	*	316	*
@@ -329,8 +329,19 int action_load_pas_filter_par(ccsdsTele
329	{	329	{
330	parameter_dump_packet.spare_sy_lfr_pas_filter_enabled = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_ENABLED ];	330	parameter_dump_packet.spare_sy_lfr_pas_filter_enabled = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_ENABLED ];
331	parameter_dump_packet.sy_lfr_pas_filter_modulus = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS ];	331	parameter_dump_packet.sy_lfr_pas_filter_modulus = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS ];
332	parameter_dump_packet.sy_lfr_pas_filter_nstd = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_NSTD ];	332	parameter_dump_packet.sy_lfr_pas_filter_tbad[0] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + 0 ];
		333	parameter_dump_packet.sy_lfr_pas_filter_tbad[1] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + 1 ];
		334	parameter_dump_packet.sy_lfr_pas_filter_tbad[2] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + 2 ];
		335	parameter_dump_packet.sy_lfr_pas_filter_tbad[3] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_TBAD + 3 ];
333	parameter_dump_packet.sy_lfr_pas_filter_offset = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET ];	336	parameter_dump_packet.sy_lfr_pas_filter_offset = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET ];
		337	parameter_dump_packet.sy_lfr_pas_filter_shift[0] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + 0 ];
		338	parameter_dump_packet.sy_lfr_pas_filter_shift[1] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + 1 ];
		339	parameter_dump_packet.sy_lfr_pas_filter_shift[2] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + 2 ];
		340	parameter_dump_packet.sy_lfr_pas_filter_shift[3] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_SHIFT + 3 ];
		341	parameter_dump_packet.sy_lfr_sc_rw_delta_f[0] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + 0 ];
		342	parameter_dump_packet.sy_lfr_sc_rw_delta_f[1] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + 1 ];
		343	parameter_dump_packet.sy_lfr_sc_rw_delta_f[2] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + 2 ];
		344	parameter_dump_packet.sy_lfr_sc_rw_delta_f[3] = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_SC_RW_DELTA_F + 3 ];
334	}	345	}
335		346
336	return flag;	347	return flag;
@@ -882,6 +893,149 unsigned int check_update_info_hk_thr_mo
882	return status;	893	return status;
883	}	894	}
884		895
		896	void getReactionWheelsFrequencies( ccsdsTelecommandPacket_t *TC )
		897	{
		898	/** This function get the reaction wheels frequencies in the incoming TC_LFR_UPDATE_INFO and copy the values locally.
		899	*
		900	* @param TC points to the TeleCommand packet that is being processed
		901	*
		902	*/
		903
		904	unsigned char * bytePosPtr; // pointer to the beginning of the incoming TC packet
		905	unsigned char * floatPtr; // pointer to the Most Significant Byte of the considered float
		906
		907	bytePosPtr = (unsigned char *) &TC->packetID;
		908
		909	// cp_rpw_sc_rw1_f1
		910	floatPtr = (unsigned char *) &cp_rpw_sc_rw1_f1;
		911	floatPtr[0] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F1 ];
		912	floatPtr[1] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F1 + 1 ];
		913	floatPtr[2] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F1 + 2 ];
		914	floatPtr[3] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F1 + 3 ];
		915	// cp_rpw_sc_rw1_f2
		916	floatPtr = (unsigned char *) &cp_rpw_sc_rw1_f2;
		917	floatPtr[0] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F2 ];
		918	floatPtr[1] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F2 + 1 ];
		919	floatPtr[2] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F2 + 2 ];
		920	floatPtr[3] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW1_F2 + 3 ];
		921	// cp_rpw_sc_rw2_f1
		922	floatPtr = (unsigned char *) &cp_rpw_sc_rw2_f1;
		923	floatPtr[0] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F1 ];
		924	floatPtr[1] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F1 + 1 ];
		925	floatPtr[2] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F1 + 2 ];
		926	floatPtr[3] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F1 + 3 ];
		927	// cp_rpw_sc_rw2_f2
		928	floatPtr = (unsigned char *) &cp_rpw_sc_rw2_f2;
		929	floatPtr[0] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F2 ];
		930	floatPtr[1] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F2 + 1 ];
		931	floatPtr[2] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F2 + 2 ];
		932	floatPtr[3] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW2_F2 + 3 ];
		933	// cp_rpw_sc_rw3_f1
		934	floatPtr = (unsigned char *) &cp_rpw_sc_rw3_f1;
		935	floatPtr[0] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F1 ];
		936	floatPtr[1] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F1 + 1 ];
		937	floatPtr[2] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F1 + 2 ];
		938	floatPtr[3] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F1 + 3 ];
		939	// cp_rpw_sc_rw3_f2
		940	floatPtr = (unsigned char *) &cp_rpw_sc_rw3_f2;
		941	floatPtr[0] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F2 ];
		942	floatPtr[1] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F2 + 1 ];
		943	floatPtr[2] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F2 + 2 ];
		944	floatPtr[3] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW3_F2 + 3 ];
		945	// cp_rpw_sc_rw4_f1
		946	floatPtr = (unsigned char *) &cp_rpw_sc_rw4_f1;
		947	floatPtr[0] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F1 ];
		948	floatPtr[1] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F1 + 1 ];
		949	floatPtr[2] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F1 + 2 ];
		950	floatPtr[3] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F1 + 3 ];
		951	// cp_rpw_sc_rw4_f2
		952	floatPtr = (unsigned char *) &cp_rpw_sc_rw4_f2;
		953	floatPtr[0] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F2 ];
		954	floatPtr[1] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F2 + 1 ];
		955	floatPtr[2] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F2 + 2 ];
		956	floatPtr[3] = bytePosPtr[ BYTE_POS_UPDATE_INFO_CP_RPW_SC_RW4_F2 + 3 ];
		957	}
		958
		959	void setFBinMask( unsigned char *fbins_mask, float freq, unsigned char deltaFreq, unsigned char flag )
		960	{
		961	unsigned int fBelow;
		962
		963	// compute the index of the frequency immediately below the reaction wheel frequency
		964	fBelow = (unsigned int) ( floor( ((double) cp_rpw_sc_rw1_f1) / ((double) deltaFreq)) );
		965
		966	if (fBelow < 127) // if fbelow is greater than 127 or equal to 127, this means that the reaction wheel frequency is outside the frequency range
		967	{
		968	if (flag == 1)
		969	{
		970	// rw_fbins_mask[k] = (1 << fBelow) \| (1 << fAbove);
		971	}
		972	}
		973	}
		974
		975	void build_rw_fbins_mask( unsigned int channel )
		976	{
		977	unsigned char rw_fbins_mask[16];
		978	unsigned char *maskPtr;
		979	double deltaF;
		980	unsigned k;
		981
		982	k = 0;
		983
		984	switch (channel)
		985	{
		986	case 0:
		987	maskPtr = rw_fbins_mask_f0;
		988	deltaF = 96.;
		989	break;
		990	case 1:
		991	maskPtr = rw_fbins_mask_f1;
		992	deltaF = 16.;
		993	break;
		994	case 2:
		995	maskPtr = rw_fbins_mask_f2;
		996	deltaF = 1.;
		997	break;
		998	default:
		999	break;
		1000	}
		1001
		1002	for (k = 0; k < 16; k++)
		1003	{
		1004	rw_fbins_mask[k] = 0x00;
		1005	}
		1006
		1007	// RW1 F1
		1008	// setFBinMask( rw_fbins_mask, fBelow );
		1009
		1010	// RW1 F2
		1011
		1012	// RW2 F1
		1013
		1014	// RW2 F2
		1015
		1016	// RW3 F1
		1017
		1018	// RW3 F2
		1019
		1020	// RW4 F1
		1021
		1022	// RW4 F2
		1023
		1024
		1025	// update the value of the fbins related to reaction wheels frequency filtering
		1026	for (k = 0; k < 16; k++)
		1027	{
		1028	maskPtr[k] = rw_fbins_mask[k];
		1029	}
		1030	}
		1031
		1032	void build_rw_fbins_masks()
		1033	{
		1034	build_rw_fbins_mask( 0 );
		1035	build_rw_fbins_mask( 1 );
		1036	build_rw_fbins_mask( 2 );
		1037	}
		1038
885	//***********	1039	//***********
886	// FBINS MASK	1040	// FBINS MASK
887		1041
@@ -921,8 +1075,10 int check_sy_lfr_pas_filter_parameters(
921		1075
922	unsigned char sy_lfr_pas_filter_enabled;	1076	unsigned char sy_lfr_pas_filter_enabled;
923	unsigned char sy_lfr_pas_filter_modulus;	1077	unsigned char sy_lfr_pas_filter_modulus;
924	~~unsigned~~ ~~char~~ sy_lfr_pas_filter_nstd;	1078	float sy_lfr_pas_filter_tbad;
925	unsigned char sy_lfr_pas_filter_offset;	1079	unsigned char sy_lfr_pas_filter_offset;
		1080	float sy_lfr_pas_filtershift;
		1081	float sy_lfr_sc_rw_delta_f;
926		1082
927	flag = LFR_SUCCESSFUL;	1083	flag = LFR_SUCCESSFUL;
928		1084
@@ -930,7 +1086,7 int check_sy_lfr_pas_filter_parameters(
930	// get parameters	1086	// get parameters
931	sy_lfr_pas_filter_enabled = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_ENABLED ] & 0x01; // [0000 0001]	1087	sy_lfr_pas_filter_enabled = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_ENABLED ] & 0x01; // [0000 0001]
932	sy_lfr_pas_filter_modulus = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS ];	1088	sy_lfr_pas_filter_modulus = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS ];
933	sy_lfr_pas_filter_nstd = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_NSTD ];	1089
934	sy_lfr_pas_filter_offset = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET ];	1090	sy_lfr_pas_filter_offset = TC->dataAndCRC[ DATAFIELD_POS_SY_LFR_PAS_FILTER_OFFSET ];
935		1091
936	//******************	1092	//******************
@@ -942,15 +1098,7 int check_sy_lfr_pas_filter_parameters(
942	status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS+10, sy_lfr_pas_filter_modulus );	1098	status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_MODULUS+10, sy_lfr_pas_filter_modulus );
943	flag = WRONG_APP_DATA;	1099	flag = WRONG_APP_DATA;
944	}	1100	}
945	// sy_lfr_pas_filter_nstd	1101	// sy_lfr_pas_filter_tbad
946	if (flag == LFR_SUCCESSFUL)
947	{
948	if ( sy_lfr_pas_filter_nstd > 8 )
949	{
950	status = send_tm_lfr_tc_exe_inconsistent( TC, queue_id, DATAFIELD_POS_SY_LFR_PAS_FILTER_NSTD+10, sy_lfr_pas_filter_nstd );
951	flag = WRONG_APP_DATA;
952	}
953	}
954	// sy_lfr_pas_filter_offset	1102	// sy_lfr_pas_filter_offset
955	if (flag == LFR_SUCCESSFUL)	1103	if (flag == LFR_SUCCESSFUL)
956	{	1104	{
@@ -960,6 +1108,8 int check_sy_lfr_pas_filter_parameters(
960	flag = WRONG_APP_DATA;	1108	flag = WRONG_APP_DATA;
961	}	1109	}
962	}	1110	}
		1111	// sy_lfr_pas_filtershift
		1112	// sy_lfr_sc_rw_delta_f
963		1113
964	return flag;	1114	return flag;
965	}	1115	}

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