Improve clock sync.

src/prrt/clock.c

@@ -36,7 +36,7 @@ bool PrrtClock_update(PrrtClock *clock, uint32_t referenceTime, uint32_t rtt)
     prrtTimeDifference_t clockSkew = clock->skew;
     prrtTimedelta_t delay = rtt/2; // half the rtt
     prrtTimeDifference_t phaseError = referenceTime - virtualTime + delay;
-    debug("V: %13u, C: %13u, S: %13d, R: %13u, E: %13d, D: %3u", virtualTime, currentTime, clockSkew, referenceTime, phaseError, delay);
+    //printf("V: %13u, C: %13u, S: %13d, R: %13u, E: %13d, D: %3u L: %u\n", virtualTime, currentTime, clockSkew, referenceTime, phaseError, delay, clock->lastMeasurement);
 
     if(abs(phaseError) > 10000) {
         clock->meanDeviation = 0;
@@ -45,7 +45,7 @@ bool PrrtClock_update(PrrtClock *clock, uint32_t referenceTime, uint32_t rtt)
         clock->virtualTime = currentTime;
     }
 
-    prrtTimeDifference_t deviationSum = (prrtTimeDifference_t) phaseError + 3 * clock->meanDeviation; // TODO: why 3?
+    prrtTimeDifference_t deviationSum = (prrtTimeDifference_t) (phaseError + 3 * clock->meanDeviation); // TODO: why 3?
     prrtTimeDifference_t meanDeviation = (prrtTimeDifference_t) (deviationSum / 4); // TODO: find out why???
     prrtTimeDifference_t period = diff_abs_ts(currentTime, clock->lastMeasurement);
 
@@ -61,7 +61,11 @@ bool PrrtClock_update(PrrtClock *clock, uint32_t referenceTime, uint32_t rtt)
     clock->lastMeasurement = currentTime;
     clock->virtualTime = virtualTime;
 
-    //debug("V: %13u, C: %13u; S: %13d; M: %13u", virtualTime, currentTime, clockSkew, meanDeviation);
+    if(abs(phaseError) > 10000) {
+        clock->virtualTime = currentTime;
+    }
+
+    //printf("V: %13u, C: %13u; S: %13d; M: %13d, P:%13u\n", virtualTime, currentTime, clockSkew, meanDeviation, period);
     return true;
 }