2 * Copyright (C) 2009 Intel Corporation.
3 * Author: Patrick Ohly <patrick.ohly@intel.com>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 #include <linux/timecompare.h>
21 #include <linux/module.h>
22 #include <linux/math64.h>
25 * fixed point arithmetic scale factor for skew
27 * Usually one would measure skew in ppb (parts per billion, 1e9), but
28 * using a factor of 2 simplifies the math.
30 #define TIMECOMPARE_SKEW_RESOLUTION (((s64)1)<<30)
32 ktime_t
timecompare_transform(struct timecompare
*sync
,
37 nsec
= source_tstamp
+ sync
->offset
;
38 nsec
+= (s64
)(source_tstamp
- sync
->last_update
) * sync
->skew
/
39 TIMECOMPARE_SKEW_RESOLUTION
;
41 return ns_to_ktime(nsec
);
43 EXPORT_SYMBOL(timecompare_transform
);
45 int timecompare_offset(struct timecompare
*sync
,
49 u64 start_source
= 0, end_source
= 0;
53 } buffer
[10], sample
, *samples
;
57 int num_samples
= sync
->num_samples
;
59 if (num_samples
> sizeof(buffer
)/sizeof(buffer
[0])) {
60 samples
= kmalloc(sizeof(*samples
) * num_samples
, GFP_ATOMIC
);
63 num_samples
= sizeof(buffer
)/sizeof(buffer
[0]);
69 /* run until we have enough valid samples, but do not try forever */
76 start
= sync
->target();
77 ts
= timecounter_read(sync
->source
);
83 /* ignore negative durations */
84 sample
.duration_target
= ktime_to_ns(ktime_sub(end
, start
));
85 if (sample
.duration_target
>= 0) {
87 * assume symetric delay to and from source:
88 * average target time corresponds to measured
92 (ktime_to_ns(end
) + ktime_to_ns(start
)) / 2 -
95 /* simple insertion sort based on duration */
98 if (samples
[index
].duration_target
<
99 sample
.duration_target
)
101 samples
[index
+ 1] = samples
[index
];
104 samples
[index
+ 1] = sample
;
109 if (counter
>= num_samples
|| i
>= 100000) {
115 *source_tstamp
= (end_source
+ start_source
) / 2;
117 /* remove outliers by only using 75% of the samples */
118 used
= counter
* 3 / 4;
122 /* calculate average */
124 for (index
= 0; index
< used
; index
++)
125 off
+= samples
[index
].offset
;
126 *offset
= div_s64(off
, used
);
129 if (samples
&& samples
!= buffer
)
134 EXPORT_SYMBOL(timecompare_offset
);
136 void __timecompare_update(struct timecompare
*sync
,
142 if (!timecompare_offset(sync
, &offset
, &average_time
))
145 if (!sync
->last_update
) {
146 sync
->last_update
= average_time
;
147 sync
->offset
= offset
;
150 s64 delta_nsec
= average_time
- sync
->last_update
;
152 /* avoid division by negative or small deltas */
153 if (delta_nsec
>= 10000) {
154 s64 delta_offset_nsec
= offset
- sync
->offset
;
155 s64 skew
; /* delta_offset_nsec *
156 TIMECOMPARE_SKEW_RESOLUTION /
160 /* div_s64() is limited to 32 bit divisor */
161 skew
= delta_offset_nsec
* TIMECOMPARE_SKEW_RESOLUTION
;
162 divisor
= delta_nsec
;
163 while (unlikely(divisor
>= ((s64
)1) << 32)) {
164 /* divide both by 2; beware, right shift
165 of negative value has undefined
166 behavior and can only be used for
167 the positive divisor */
168 skew
= div_s64(skew
, 2);
171 skew
= div_s64(skew
, divisor
);
174 * Calculate new overall skew as 4/16 the
175 * old value and 12/16 the new one. This is
176 * a rather arbitrary tradeoff between
177 * only using the latest measurement (0/16 and
178 * 16/16) and even more weight on past measurements.
180 #define TIMECOMPARE_NEW_SKEW_PER_16 12
182 div_s64((16 - TIMECOMPARE_NEW_SKEW_PER_16
) *
184 TIMECOMPARE_NEW_SKEW_PER_16
* skew
,
186 sync
->last_update
= average_time
;
187 sync
->offset
= offset
;
191 EXPORT_SYMBOL(__timecompare_update
);