yading@10
|
1 /*
|
yading@10
|
2 * Delay Locked Loop based time filter
|
yading@10
|
3 * Copyright (c) 2009 Samalyse
|
yading@10
|
4 * Copyright (c) 2009 Michael Niedermayer
|
yading@10
|
5 * Author: Olivier Guilyardi <olivier samalyse com>
|
yading@10
|
6 * Michael Niedermayer <michaelni gmx at>
|
yading@10
|
7 *
|
yading@10
|
8 * This file is part of FFmpeg.
|
yading@10
|
9 *
|
yading@10
|
10 * FFmpeg is free software; you can redistribute it and/or
|
yading@10
|
11 * modify it under the terms of the GNU Lesser General Public
|
yading@10
|
12 * License as published by the Free Software Foundation; either
|
yading@10
|
13 * version 2.1 of the License, or (at your option) any later version.
|
yading@10
|
14 *
|
yading@10
|
15 * FFmpeg is distributed in the hope that it will be useful,
|
yading@10
|
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
yading@10
|
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
yading@10
|
18 * Lesser General Public License for more details.
|
yading@10
|
19 *
|
yading@10
|
20 * You should have received a copy of the GNU Lesser General Public
|
yading@10
|
21 * License along with FFmpeg; if not, write to the Free Software
|
yading@10
|
22 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
yading@10
|
23 */
|
yading@10
|
24
|
yading@10
|
25 #include "libavutil/common.h"
|
yading@10
|
26 #include "libavutil/mem.h"
|
yading@10
|
27 #include "config.h"
|
yading@10
|
28 #include "timefilter.h"
|
yading@10
|
29
|
yading@10
|
30 struct TimeFilter {
|
yading@10
|
31 // Delay Locked Loop data. These variables refer to mathematical
|
yading@10
|
32 // concepts described in: http://www.kokkinizita.net/papers/usingdll.pdf
|
yading@10
|
33 double cycle_time;
|
yading@10
|
34 double feedback2_factor;
|
yading@10
|
35 double feedback3_factor;
|
yading@10
|
36 double clock_period;
|
yading@10
|
37 int count;
|
yading@10
|
38 };
|
yading@10
|
39
|
yading@10
|
40 /* 1 - exp(-x) using a 3-order power series */
|
yading@10
|
41 static double qexpneg(double x)
|
yading@10
|
42 {
|
yading@10
|
43 return 1 - 1 / (1 + x * (1 + x / 2 * (1 + x / 3)));
|
yading@10
|
44 }
|
yading@10
|
45
|
yading@10
|
46 TimeFilter *ff_timefilter_new(double time_base,
|
yading@10
|
47 double period,
|
yading@10
|
48 double bandwidth)
|
yading@10
|
49 {
|
yading@10
|
50 TimeFilter *self = av_mallocz(sizeof(TimeFilter));
|
yading@10
|
51 double o = 2 * M_PI * bandwidth * period * time_base;
|
yading@10
|
52 self->clock_period = time_base;
|
yading@10
|
53 self->feedback2_factor = qexpneg(M_SQRT2 * o);
|
yading@10
|
54 self->feedback3_factor = qexpneg(o * o) / period;
|
yading@10
|
55 return self;
|
yading@10
|
56 }
|
yading@10
|
57
|
yading@10
|
58 void ff_timefilter_destroy(TimeFilter *self)
|
yading@10
|
59 {
|
yading@10
|
60 av_freep(&self);
|
yading@10
|
61 }
|
yading@10
|
62
|
yading@10
|
63 void ff_timefilter_reset(TimeFilter *self)
|
yading@10
|
64 {
|
yading@10
|
65 self->count = 0;
|
yading@10
|
66 }
|
yading@10
|
67
|
yading@10
|
68 double ff_timefilter_update(TimeFilter *self, double system_time, double period)
|
yading@10
|
69 {
|
yading@10
|
70 self->count++;
|
yading@10
|
71 if (self->count == 1) {
|
yading@10
|
72 self->cycle_time = system_time;
|
yading@10
|
73 } else {
|
yading@10
|
74 double loop_error;
|
yading@10
|
75 self->cycle_time += self->clock_period * period;
|
yading@10
|
76 loop_error = system_time - self->cycle_time;
|
yading@10
|
77
|
yading@10
|
78 self->cycle_time += FFMAX(self->feedback2_factor, 1.0 / self->count) * loop_error;
|
yading@10
|
79 self->clock_period += self->feedback3_factor * loop_error;
|
yading@10
|
80 }
|
yading@10
|
81 return self->cycle_time;
|
yading@10
|
82 }
|
yading@10
|
83
|
yading@10
|
84 double ff_timefilter_eval(TimeFilter *self, double delta)
|
yading@10
|
85 {
|
yading@10
|
86 return self->cycle_time + self->clock_period * delta;
|
yading@10
|
87 }
|
yading@10
|
88
|
yading@10
|
89 #ifdef TEST
|
yading@10
|
90 #include "libavutil/lfg.h"
|
yading@10
|
91 #define LFG_MAX ((1LL << 32) - 1)
|
yading@10
|
92
|
yading@10
|
93 int main(void)
|
yading@10
|
94 {
|
yading@10
|
95 AVLFG prng;
|
yading@10
|
96 double n0, n1;
|
yading@10
|
97 #define SAMPLES 1000
|
yading@10
|
98 double ideal[SAMPLES];
|
yading@10
|
99 double samples[SAMPLES];
|
yading@10
|
100 double samplet[SAMPLES];
|
yading@10
|
101 for (n0 = 0; n0 < 40; n0 = 2 * n0 + 1) {
|
yading@10
|
102 for (n1 = 0; n1 < 10; n1 = 2 * n1 + 1) {
|
yading@10
|
103 double best_error = 1000000000;
|
yading@10
|
104 double bestpar0 = 1;
|
yading@10
|
105 double bestpar1 = 1;
|
yading@10
|
106 int better, i;
|
yading@10
|
107
|
yading@10
|
108 av_lfg_init(&prng, 123);
|
yading@10
|
109 for (i = 0; i < SAMPLES; i++) {
|
yading@10
|
110 samplet[i] = 10 + i + (av_lfg_get(&prng) < LFG_MAX/2 ? 0 : 0.999);
|
yading@10
|
111 ideal[i] = samplet[i] + n1 * i / (1000);
|
yading@10
|
112 samples[i] = ideal[i] + n0 * (av_lfg_get(&prng) - LFG_MAX / 2) / (LFG_MAX * 10LL);
|
yading@10
|
113 if(i && samples[i]<samples[i-1])
|
yading@10
|
114 samples[i]=samples[i-1]+0.001;
|
yading@10
|
115 }
|
yading@10
|
116
|
yading@10
|
117 do {
|
yading@10
|
118 double par0, par1;
|
yading@10
|
119 better = 0;
|
yading@10
|
120 for (par0 = bestpar0 * 0.8; par0 <= bestpar0 * 1.21; par0 += bestpar0 * 0.05) {
|
yading@10
|
121 for (par1 = bestpar1 * 0.8; par1 <= bestpar1 * 1.21; par1 += bestpar1 * 0.05) {
|
yading@10
|
122 double error = 0;
|
yading@10
|
123 TimeFilter *tf = ff_timefilter_new(1, par0, par1);
|
yading@10
|
124 for (i = 0; i < SAMPLES; i++) {
|
yading@10
|
125 double filtered;
|
yading@10
|
126 filtered = ff_timefilter_update(tf, samples[i], i ? (samplet[i] - samplet[i-1]) : 1);
|
yading@10
|
127 if(filtered < 0 || filtered > 1000000000)
|
yading@10
|
128 printf("filter is unstable\n");
|
yading@10
|
129 error += (filtered - ideal[i]) * (filtered - ideal[i]);
|
yading@10
|
130 }
|
yading@10
|
131 ff_timefilter_destroy(tf);
|
yading@10
|
132 if (error < best_error) {
|
yading@10
|
133 best_error = error;
|
yading@10
|
134 bestpar0 = par0;
|
yading@10
|
135 bestpar1 = par1;
|
yading@10
|
136 better = 1;
|
yading@10
|
137 }
|
yading@10
|
138 }
|
yading@10
|
139 }
|
yading@10
|
140 } while (better);
|
yading@10
|
141 #if 0
|
yading@10
|
142 double lastfil = 9;
|
yading@10
|
143 TimeFilter *tf = ff_timefilter_new(1, bestpar0, bestpar1);
|
yading@10
|
144 for (i = 0; i < SAMPLES; i++) {
|
yading@10
|
145 double filtered;
|
yading@10
|
146 filtered = ff_timefilter_update(tf, samples[i], 1);
|
yading@10
|
147 printf("%f %f %f %f\n", i - samples[i] + 10, filtered - samples[i],
|
yading@10
|
148 samples[FFMAX(i, 1)] - samples[FFMAX(i - 1, 0)], filtered - lastfil);
|
yading@10
|
149 lastfil = filtered;
|
yading@10
|
150 }
|
yading@10
|
151 ff_timefilter_destroy(tf);
|
yading@10
|
152 #else
|
yading@10
|
153 printf(" [%f %f %9f]", bestpar0, bestpar1, best_error);
|
yading@10
|
154 #endif
|
yading@10
|
155 }
|
yading@10
|
156 printf("\n");
|
yading@10
|
157 }
|
yading@10
|
158 return 0;
|
yading@10
|
159 }
|
yading@10
|
160 #endif
|