21 void time_sync_reset(time_sync_t *sync) {  in time_sync_reset()  argument
22     sync->n = 0;  in time_sync_reset()
23     sync->i = 0;  in time_sync_reset()
24     sync->estimate_valid = false;  in time_sync_reset()
26     sync->hold_count = 0;  in time_sync_reset()
29 bool time_sync_init(time_sync_t *sync) {  in time_sync_init()  argument
30     time_sync_reset(sync);  in time_sync_init()
35 void time_sync_truncate(time_sync_t *sync, size_t window_size) {  in time_sync_truncate()  argument
37     sync->n = (window_size < sync->n) ? window_size : sync->n;  in time_sync_truncate()
38     sync->estimate_valid = false;  in time_sync_truncate()
41     size_t bidx = (sync->i >= sync->n) ? (sync->i - sync->n)  in time_sync_truncate()
42         : (sync->i + NUM_TIME_SYNC_DATAPOINTS - sync->n);  in time_sync_truncate()
46         uint64_t tmp1 = sync->time1[0];  in time_sync_truncate()
47         uint64_t tmp2 = sync->time2[0];  in time_sync_truncate()
50             sync->time1[m] = sync->time1[m + 1];  in time_sync_truncate()
51             sync->time2[m] = sync->time2[m + 1];  in time_sync_truncate()
53         sync->time1[NUM_TIME_SYNC_DATAPOINTS - 1] = tmp1;  in time_sync_truncate()
54         sync->time2[NUM_TIME_SYNC_DATAPOINTS - 1] = tmp2;  in time_sync_truncate()
57     sync->i = (sync->n < NUM_TIME_SYNC_DATAPOINTS) ? sync->n : 0;  in time_sync_truncate()
60 bool time_sync_add(time_sync_t *sync, uint64_t time1, uint64_t time2) {  in time_sync_add()  argument
61     size_t i = sync->i;  in time_sync_add()
63     sync->time1[i] = time1;  in time_sync_add()
64     sync->time2[i] = time2;  in time_sync_add()
70     sync->i = i;  in time_sync_add()
72     size_t prev_n = sync->n;  in time_sync_add()
73     if (sync->n < NUM_TIME_SYNC_DATAPOINTS) {  in time_sync_add()
74         ++sync->n;  in time_sync_add()
77     sync->estimate_valid = false;  in time_sync_add()
79     if (sync->hold_count > 0) {  in time_sync_add()
80         --sync->hold_count;  in time_sync_add()
81         time_sync_truncate(sync, prev_n);  in time_sync_add()
87 bool time_sync_estimate_time1(time_sync_t *sync, uint64_t time2, uint64_t *time1)  in time_sync_estimate_time1()  argument
91     if (sync->n < 2)  in time_sync_estimate_time1()
96     if (!sync->estimate_valid) {  in time_sync_estimate_time1()
97         size_t n = sync->n;  in time_sync_estimate_time1()
100         size_t i = sync->i;  in time_sync_estimate_time1()
108         uint64_t time1_base = sync->time1[i];  in time_sync_estimate_time1()
109         uint64_t time2_base = sync->time2[i];  in time_sync_estimate_time1()
119             mean_y += floatFromUint64(sync->time1[ii] - time1_base) * invN;  in time_sync_estimate_time1()
120             mean_x += floatFromUint64(sync->time2[ii] - time2_base) * invN;  in time_sync_estimate_time1()
134             float y = floatFromUint64(sync->time1[ii] - time1_base) - mean_y;  in time_sync_estimate_time1()
135             float x = floatFromUint64(sync->time2[ii] - time2_base) - mean_x;  in time_sync_estimate_time1()
148         sync->alpha = alpha;  in time_sync_estimate_time1()
149         sync->beta = beta;  in time_sync_estimate_time1()
150         sync->time1_base = time1_base;  in time_sync_estimate_time1()
151         sync->time2_base = time2_base;  in time_sync_estimate_time1()
153         sync->estimate_valid = true;  in time_sync_estimate_time1()
156 …*time1 = sync->time1_base + floatToInt64(sync->alpha + sync->beta * floatFromInt64(time2 - sync->t…  in time_sync_estimate_time1()
161 void time_sync_hold(time_sync_t *sync, uint8_t count) {  in time_sync_hold()  argument
162     sync->hold_count = count;  in time_sync_hold()