HG_REPOSITORIES/LPP/INSTRUMENTATION/USERS/JEANDET/LFR_FSW Commit - r257:132f1c3627d7

snapshot resynchro changed...

paul -

r257:132f1c3627d7 R3a

parent child

Context file:

r257:132f1c3627d7

Collapse all files

.hgsubstate +1 -1

@@ -1,2 +1,2
1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters	1	3081d1f9bb20b2b64a192585337a292a9804e0c5 LFR_basic-parameters
2	80d727bb9d808ae67c801c4c6101811d68b94af6 header/lfr_common_headers	2	4ffa7549495b4d1e5ddbda520569468a5e3b8779 header/lfr_common_headers

header/wf_handler.h +2 0

                                           unsigned int sid, unsigned char pa_lfr_pkt_nr, unsigned char *acquisitionTime );
             void build_snapshot_from_ring(ring_node *ring_node_to_send, unsigned char frequencyChannel ,
                                           unsigned long long acquisitionTimeF0_asLong, ring_node *ring_node_swf_extracted, int *swf_extracted);
+            double computeCorrection( unsigned char *timePtr );
+            void applyCorrection( double correction );
             void snapshot_resynchronization( unsigned char *timePtr );
             //
             rtems_id get_pkts_queue_id( void );

src/fsw_init.c +3 0

                 set_hk_lfr_sc_potential_flag( true );
+                // start the timer used for the detection of missing parameters (started also by the timecode_irq_handler ISR)
+                status = rtems_timer_fire_after( timecode_timer_id, TIMECODE_TIMER_TIMEOUT, timecode_timer_routine, NULL );
                 status = rtems_task_delete(RTEMS_SELF);
             }

src/tc_handler.c +11 0

             void update_last_valid_transition_date( unsigned int transitionCoarseTime )
             {
+                if (transitionCoarseTime == 0)
+                {
+                    lastValidEnterModeTime = time_management_regs->coarse_time + 1;
+                    PRINTF1("lastValidEnterModeTime = 0x%x (transitionCoarseTime = 0 => coarse_time+1)\n", transitionCoarseTime);
+                }
+                else
+                {
                     lastValidEnterModeTime = transitionCoarseTime;
                     PRINTF1("lastValidEnterModeTime = 0x%x\n", transitionCoarseTime);
                 }
+            }
             int check_transition_date( unsigned int transitionCoarseTime )
             {
             void launch_waveform_picker( unsigned char mode, unsigned int transitionCoarseTime )
             {
                 WFP_reset_current_ring_nodes();
                 reset_waveform_picker_regs();
                     waveform_picker_regs->start_date = transitionCoarseTime;
                 }
+                update_last_valid_transition_date(waveform_picker_regs->start_date);
             }
             void launch_spectral_matrix( void )

src/wf_handler.c +72 -24

@@ -45,9 +45,10 ring_node ring_node_swf2_extracted;
45		45
46	typedef enum resynchro_state_t	46	typedef enum resynchro_state_t
47	{	47	{
48	IDLE,	48	MEASURE_0,
49	MEASURE_K,	49	MEASURE_1,
50	MEASURE_K_PLUS_1,	50	CORRECTION_0,
		51	CORRECTION_1
51	} resynchro_state;	52	} resynchro_state;
52		53
53	//*********************	54	//*********************
@@ -868,7 +869,7 void build_snapshot_from_ring( ring_node
868	}	869	}
869	}	870	}
870		871
871	~~voi~~d ~~snapshot_resynchroniza~~tion( unsigned char *timePtr )	872	double computeCorrection( unsigned char *timePtr )
872	{	873	{
873	unsigned long long int acquisitionTime;	874	unsigned long long int acquisitionTime;
874	unsigned long long int centerTime;	875	unsigned long long int centerTime;
@@ -876,18 +877,10 void snapshot_resynchronization( unsigne
876	unsigned long long int nextTick;	877	unsigned long long int nextTick;
877	unsigned long long int deltaPreviousTick;	878	unsigned long long int deltaPreviousTick;
878	unsigned long long int deltaNextTick;	879	unsigned long long int deltaNextTick;
879	int deltaTickInF2;
880	double deltaPrevious_ms;	880	double deltaPrevious_ms;
881	double deltaNext_ms;	881	double deltaNext_ms;
882	double correctionInF2;	882	double correctionInF2;
883	double center_k = 0.;
884	double cnter_k_plus_1 = 0.;
885	static resynchro_state state = IDLE;
886	static unsigned char resynchroEngaged = 0;
887		883
888	if (resynchroEngaged == 0)
889	{
890	resynchroEngaged = 1;
891	// get acquisition time in fine time ticks	884	// get acquisition time in fine time ticks
892	acquisitionTime = get_acquisition_time( timePtr );	885	acquisitionTime = get_acquisition_time( timePtr );
893		886
@@ -902,8 +895,9 void snapshot_resynchronization( unsigne
902	deltaPrevious_ms = ((double) deltaPreviousTick) / 65536. * 1000.;	895	deltaPrevious_ms = ((double) deltaPreviousTick) / 65536. * 1000.;
903	deltaNext_ms = ((double) deltaNextTick) / 65536. * 1000.;	896	deltaNext_ms = ((double) deltaNextTick) / 65536. * 1000.;
904		897
905	PRINTF2("delta previous = %f ms, delta next = %f ms\n", deltaPrevious_ms, deltaNext_ms);	898	PRINTF2(" delta previous = %.3f ms, delta next = %.2f ms\n", deltaPrevious_ms, deltaNext_ms);
906	PRINTF2("delta previous = %llu fine time ticks, delta next = %llu fine time ticks\n", ~~deltaPreviousTick~~, ~~deltaNextTick~~);	899	// PRINTF2(" delta previous = %llu fine time ticks, delta next = %llu fine time ticks\n",
		900	// deltaPreviousTick, deltaNextTick);
907		901
908	// which tick is the closest?	902	// which tick is the closest?
909	if (deltaPreviousTick > deltaNextTick)	903	if (deltaPreviousTick > deltaNextTick)
@@ -917,22 +911,76 void snapshot_resynchronization( unsigne
917	correctionInF2 = - (deltaPrevious_ms * 256. / 1000. );	911	correctionInF2 = - (deltaPrevious_ms * 256. / 1000. );
918	}	912	}
919		913
920	if (correctionInF2 >=0 )	914	PRINTF1(" correctionInF2 = %.2f\n", correctionInF2);
		915
		916	return correctionInF2;
		917	}
		918
		919	void applyCorrection( double correction )
921	{	920	{
922	deltaTickInF2 = ceil( correctionInF2 );	921	int correctionInt;
		922
		923	if (correction>=0)
		924	{
		925	correctionInt = floor(correction);
923	}	926	}
924	else	927	else
925	{	928	{
926	deltaTickInF2 = floor( correctionInF2 );	929	correctionInt = ceil(correction);
		930	}
		931	waveform_picker_regs->delta_snapshot = waveform_picker_regs->delta_snapshot + correctionInt;
		932	//set_wfp_delta_f0_f0_2();
927	}	933	}
928	waveform_picker_regs->delta_snapshot = waveform_picker_regs->delta_snapshot + deltaTickInF2;	934
929	set_wfp_delta_f0_f0_2(); // this is necessary to reset the value of delta_f0 as delta_snapshot has been changed	935	void snapshot_resynchronization( unsigned char *timePtr )
930	PRINTF2("Correction of = %d, delta_snapshot = %d\n\n", deltaTickInF2, waveform_picker_regs->delta_snapshot);	936	{
931	}	937	static double correction = 0.;
932	else	938	static double delay_0 = 0.;
		939	static resynchro_state state = MEASURE_0;
		940
		941	int correctionInt;
		942
		943	correctionInt = 0;
		944
		945	switch (state)
933	{	946	{
934	PRINTF1("No resynchro, delta_snapshot = %d\n\n", waveform_picker_regs->delta_snapshot);	947
935	resynchroEngaged = 0;	948	case MEASURE_0:
		949	// ********
		950	PRINTF("MEASURE_0 ===\n");
		951	state = CORRECTION_0;
		952	delay_0 = computeCorrection( timePtr );
		953	correction = delay_0;
		954	PRINTF1("MEASURE_0 === correction = %.2f\n", correction );
		955	applyCorrection( correction );
		956	PRINTF1("MEASURE_0 === delta_snapshot = %d\n", waveform_picker_regs->delta_snapshot);
		957	//****
		958	break;
		959
		960	case CORRECTION_0:
		961	//************
		962	PRINTF("CORRECTION_0 ===\n");
		963	state = CORRECTION_1;
		964	computeCorrection( timePtr );
		965	correction = -correction;
		966	PRINTF1("CORRECTION_0 === correction = %.2f\n", correction );
		967	applyCorrection( correction );
		968	PRINTF1("CORRECTION_0 === delta_snapshot = %d\n", waveform_picker_regs->delta_snapshot);
		969	//****
		970	break;
		971
		972	case CORRECTION_1:
		973	//************
		974	PRINTF("CORRECTION_1 ===\n");
		975	state = MEASURE_0;
		976	computeCorrection( timePtr );
		977	PRINTF1("CORRECTION_1 === delta_snapshot = %d\n", waveform_picker_regs->delta_snapshot);
		978	//****
		979	break;
		980
		981	default:
		982	break;
		983
936	}	984	}
937	}	985	}
938		986

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