Commit db364492 authored by Grzegorz Daniluk's avatar Grzegorz Daniluk

[t24_fix]: rxts_calibrator: fix generating second sample of rising edge from falling edge

Previous one was not working when:
* tR and tF were both inside (0; 4000) and tR < tF
* tR and tF were both inside (4000; 8000) and tF < tR

in those cases it was calculating ttrans around falling edge instead of rising
edge. This commit fixes it.
parent 1b91e320
...@@ -129,6 +129,8 @@ void rxts_calibration_start() ...@@ -129,6 +129,8 @@ void rxts_calibration_start()
calibration is done. */ calibration is done. */
int rxts_calibration_update(uint32_t *t24p_value) int rxts_calibration_update(uint32_t *t24p_value)
{ {
int32_t ttrans;
if (spll_shifter_busy(0)) if (spll_shifter_busy(0))
return 0; return 0;
...@@ -154,19 +156,23 @@ int rxts_calibration_update(uint32_t *t24p_value) ...@@ -154,19 +156,23 @@ int rxts_calibration_update(uint32_t *t24p_value)
det_rising.trans_phase -= REF_CLOCK_PERIOD_PS; det_rising.trans_phase -= REF_CLOCK_PERIOD_PS;
/* Use falling edge as second sample of rising edge */ /* Use falling edge as second sample of rising edge */
uint32_t ttrans = det_falling.trans_phase; if (det_falling.trans_phase > det_rising.trans_phase)
ttrans += REF_CLOCK_PERIOD_PS/2; ttrans = det_falling.trans_phase - REF_CLOCK_PERIOD_PS/2;
if (ttrans >= REF_CLOCK_PERIOD_PS) else if(det_falling.trans_phase < det_rising.trans_phase)
ttrans -= REF_CLOCK_PERIOD_PS; ttrans = det_falling.trans_phase + REF_CLOCK_PERIOD_PS/2;
ttrans += det_rising.trans_phase; ttrans += det_rising.trans_phase;
ttrans /= 2; ttrans /= 2;
/*normalize ttrans*/
if(ttrans < 0) ttrans += REF_CLOCK_PERIOD_PS;
if(ttrans >= REF_CLOCK_PERIOD_PS) ttrans -= REF_CLOCK_PERIOD_PS;
TRACE_DEV("RXTS calibration: R@%dps, F@%dps, transition@%dps\n", TRACE_DEV("RXTS calibration: R@%dps, F@%dps, transition@%dps\n",
det_rising.trans_phase, det_falling.trans_phase, det_rising.trans_phase, det_falling.trans_phase,
ttrans); ttrans);
*t24p_value = ttrans; *t24p_value = (uint32_t)ttrans;
return 1; return 1;
} }
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment