GNU Linux-libre 4.19.263-gnu1
[releases.git] / sound / pci / ctxfi / cttimer.c
1 /*
2  * PCM timer handling on ctxfi
3  *
4  * This source file is released under GPL v2 license (no other versions).
5  * See the COPYING file included in the main directory of this source
6  * distribution for the license terms and conditions.
7  */
8
9 #include <linux/slab.h>
10 #include <linux/math64.h>
11 #include <linux/moduleparam.h>
12 #include <sound/core.h>
13 #include <sound/pcm.h>
14 #include "ctatc.h"
15 #include "cthardware.h"
16 #include "cttimer.h"
17
18 static bool use_system_timer;
19 MODULE_PARM_DESC(use_system_timer, "Force to use system-timer");
20 module_param(use_system_timer, bool, 0444);
21
22 struct ct_timer_ops {
23         void (*init)(struct ct_timer_instance *);
24         void (*prepare)(struct ct_timer_instance *);
25         void (*start)(struct ct_timer_instance *);
26         void (*stop)(struct ct_timer_instance *);
27         void (*free_instance)(struct ct_timer_instance *);
28         void (*interrupt)(struct ct_timer *);
29         void (*free_global)(struct ct_timer *);
30 };
31
32 /* timer instance -- assigned to each PCM stream */
33 struct ct_timer_instance {
34         spinlock_t lock;
35         struct ct_timer *timer_base;
36         struct ct_atc_pcm *apcm;
37         struct snd_pcm_substream *substream;
38         struct timer_list timer;
39         struct list_head instance_list;
40         struct list_head running_list;
41         unsigned int position;
42         unsigned int frag_count;
43         unsigned int running:1;
44         unsigned int need_update:1;
45 };
46
47 /* timer instance manager */
48 struct ct_timer {
49         spinlock_t lock;                /* global timer lock (for xfitimer) */
50         spinlock_t list_lock;           /* lock for instance list */
51         struct ct_atc *atc;
52         const struct ct_timer_ops *ops;
53         struct list_head instance_head;
54         struct list_head running_head;
55         unsigned int wc;                /* current wallclock */
56         unsigned int irq_handling:1;    /* in IRQ handling */
57         unsigned int reprogram:1;       /* need to reprogram the internval */
58         unsigned int running:1;         /* global timer running */
59 };
60
61
62 /*
63  * system-timer-based updates
64  */
65
66 static void ct_systimer_callback(struct timer_list *t)
67 {
68         struct ct_timer_instance *ti = from_timer(ti, t, timer);
69         struct snd_pcm_substream *substream = ti->substream;
70         struct snd_pcm_runtime *runtime = substream->runtime;
71         struct ct_atc_pcm *apcm = ti->apcm;
72         unsigned int period_size = runtime->period_size;
73         unsigned int buffer_size = runtime->buffer_size;
74         unsigned long flags;
75         unsigned int position, dist, interval;
76
77         position = substream->ops->pointer(substream);
78         dist = (position + buffer_size - ti->position) % buffer_size;
79         if (dist >= period_size ||
80             position / period_size != ti->position / period_size) {
81                 apcm->interrupt(apcm);
82                 ti->position = position;
83         }
84         /* Add extra HZ*5/1000 to avoid overrun issue when recording
85          * at 8kHz in 8-bit format or at 88kHz in 24-bit format. */
86         interval = ((period_size - (position % period_size))
87                    * HZ + (runtime->rate - 1)) / runtime->rate + HZ * 5 / 1000;
88         spin_lock_irqsave(&ti->lock, flags);
89         if (ti->running)
90                 mod_timer(&ti->timer, jiffies + interval);
91         spin_unlock_irqrestore(&ti->lock, flags);
92 }
93
94 static void ct_systimer_init(struct ct_timer_instance *ti)
95 {
96         timer_setup(&ti->timer, ct_systimer_callback, 0);
97 }
98
99 static void ct_systimer_start(struct ct_timer_instance *ti)
100 {
101         struct snd_pcm_runtime *runtime = ti->substream->runtime;
102         unsigned long flags;
103
104         spin_lock_irqsave(&ti->lock, flags);
105         ti->running = 1;
106         mod_timer(&ti->timer,
107                   jiffies + (runtime->period_size * HZ +
108                              (runtime->rate - 1)) / runtime->rate);
109         spin_unlock_irqrestore(&ti->lock, flags);
110 }
111
112 static void ct_systimer_stop(struct ct_timer_instance *ti)
113 {
114         unsigned long flags;
115
116         spin_lock_irqsave(&ti->lock, flags);
117         ti->running = 0;
118         del_timer(&ti->timer);
119         spin_unlock_irqrestore(&ti->lock, flags);
120 }
121
122 static void ct_systimer_prepare(struct ct_timer_instance *ti)
123 {
124         ct_systimer_stop(ti);
125         try_to_del_timer_sync(&ti->timer);
126 }
127
128 #define ct_systimer_free        ct_systimer_prepare
129
130 static const struct ct_timer_ops ct_systimer_ops = {
131         .init = ct_systimer_init,
132         .free_instance = ct_systimer_free,
133         .prepare = ct_systimer_prepare,
134         .start = ct_systimer_start,
135         .stop = ct_systimer_stop,
136 };
137
138
139 /*
140  * Handling multiple streams using a global emu20k1 timer irq
141  */
142
143 #define CT_TIMER_FREQ   48000
144 #define MIN_TICKS       1
145 #define MAX_TICKS       ((1 << 13) - 1)
146
147 static void ct_xfitimer_irq_rearm(struct ct_timer *atimer, int ticks)
148 {
149         struct hw *hw = atimer->atc->hw;
150         if (ticks > MAX_TICKS)
151                 ticks = MAX_TICKS;
152         hw->set_timer_tick(hw, ticks);
153         if (!atimer->running)
154                 hw->set_timer_irq(hw, 1);
155         atimer->running = 1;
156 }
157
158 static void ct_xfitimer_irq_stop(struct ct_timer *atimer)
159 {
160         if (atimer->running) {
161                 struct hw *hw = atimer->atc->hw;
162                 hw->set_timer_irq(hw, 0);
163                 hw->set_timer_tick(hw, 0);
164                 atimer->running = 0;
165         }
166 }
167
168 static inline unsigned int ct_xfitimer_get_wc(struct ct_timer *atimer)
169 {
170         struct hw *hw = atimer->atc->hw;
171         return hw->get_wc(hw);
172 }
173
174 /*
175  * reprogram the timer interval;
176  * checks the running instance list and determines the next timer interval.
177  * also updates the each stream position, returns the number of streams
178  * to call snd_pcm_period_elapsed() appropriately
179  *
180  * call this inside the lock and irq disabled
181  */
182 static int ct_xfitimer_reprogram(struct ct_timer *atimer, int can_update)
183 {
184         struct ct_timer_instance *ti;
185         unsigned int min_intr = (unsigned int)-1;
186         int updates = 0;
187         unsigned int wc, diff;
188
189         if (list_empty(&atimer->running_head)) {
190                 ct_xfitimer_irq_stop(atimer);
191                 atimer->reprogram = 0; /* clear flag */
192                 return 0;
193         }
194
195         wc = ct_xfitimer_get_wc(atimer);
196         diff = wc - atimer->wc;
197         atimer->wc = wc;
198         list_for_each_entry(ti, &atimer->running_head, running_list) {
199                 if (ti->frag_count > diff)
200                         ti->frag_count -= diff;
201                 else {
202                         unsigned int pos;
203                         unsigned int period_size, rate;
204
205                         period_size = ti->substream->runtime->period_size;
206                         rate = ti->substream->runtime->rate;
207                         pos = ti->substream->ops->pointer(ti->substream);
208                         if (pos / period_size != ti->position / period_size) {
209                                 ti->need_update = 1;
210                                 ti->position = pos;
211                                 updates++;
212                         }
213                         pos %= period_size;
214                         pos = period_size - pos;
215                         ti->frag_count = div_u64((u64)pos * CT_TIMER_FREQ +
216                                                  rate - 1, rate);
217                 }
218                 if (ti->need_update && !can_update)
219                         min_intr = 0; /* pending to the next irq */
220                 if (ti->frag_count < min_intr)
221                         min_intr = ti->frag_count;
222         }
223
224         if (min_intr < MIN_TICKS)
225                 min_intr = MIN_TICKS;
226         ct_xfitimer_irq_rearm(atimer, min_intr);
227         atimer->reprogram = 0; /* clear flag */
228         return updates;
229 }
230
231 /* look through the instance list and call period_elapsed if needed */
232 static void ct_xfitimer_check_period(struct ct_timer *atimer)
233 {
234         struct ct_timer_instance *ti;
235         unsigned long flags;
236
237         spin_lock_irqsave(&atimer->list_lock, flags);
238         list_for_each_entry(ti, &atimer->instance_head, instance_list) {
239                 if (ti->running && ti->need_update) {
240                         ti->need_update = 0;
241                         ti->apcm->interrupt(ti->apcm);
242                 }
243         }
244         spin_unlock_irqrestore(&atimer->list_lock, flags);
245 }
246
247 /* Handle timer-interrupt */
248 static void ct_xfitimer_callback(struct ct_timer *atimer)
249 {
250         int update;
251         unsigned long flags;
252
253         spin_lock_irqsave(&atimer->lock, flags);
254         atimer->irq_handling = 1;
255         do {
256                 update = ct_xfitimer_reprogram(atimer, 1);
257                 spin_unlock(&atimer->lock);
258                 if (update)
259                         ct_xfitimer_check_period(atimer);
260                 spin_lock(&atimer->lock);
261         } while (atimer->reprogram);
262         atimer->irq_handling = 0;
263         spin_unlock_irqrestore(&atimer->lock, flags);
264 }
265
266 static void ct_xfitimer_prepare(struct ct_timer_instance *ti)
267 {
268         ti->frag_count = ti->substream->runtime->period_size;
269         ti->running = 0;
270         ti->need_update = 0;
271 }
272
273
274 /* start/stop the timer */
275 static void ct_xfitimer_update(struct ct_timer *atimer)
276 {
277         unsigned long flags;
278
279         spin_lock_irqsave(&atimer->lock, flags);
280         if (atimer->irq_handling) {
281                 /* reached from IRQ handler; let it handle later */
282                 atimer->reprogram = 1;
283                 spin_unlock_irqrestore(&atimer->lock, flags);
284                 return;
285         }
286
287         ct_xfitimer_irq_stop(atimer);
288         ct_xfitimer_reprogram(atimer, 0);
289         spin_unlock_irqrestore(&atimer->lock, flags);
290 }
291
292 static void ct_xfitimer_start(struct ct_timer_instance *ti)
293 {
294         struct ct_timer *atimer = ti->timer_base;
295         unsigned long flags;
296
297         spin_lock_irqsave(&atimer->lock, flags);
298         if (list_empty(&ti->running_list))
299                 atimer->wc = ct_xfitimer_get_wc(atimer);
300         ti->running = 1;
301         ti->need_update = 0;
302         list_add(&ti->running_list, &atimer->running_head);
303         spin_unlock_irqrestore(&atimer->lock, flags);
304         ct_xfitimer_update(atimer);
305 }
306
307 static void ct_xfitimer_stop(struct ct_timer_instance *ti)
308 {
309         struct ct_timer *atimer = ti->timer_base;
310         unsigned long flags;
311
312         spin_lock_irqsave(&atimer->lock, flags);
313         list_del_init(&ti->running_list);
314         ti->running = 0;
315         spin_unlock_irqrestore(&atimer->lock, flags);
316         ct_xfitimer_update(atimer);
317 }
318
319 static void ct_xfitimer_free_global(struct ct_timer *atimer)
320 {
321         ct_xfitimer_irq_stop(atimer);
322 }
323
324 static const struct ct_timer_ops ct_xfitimer_ops = {
325         .prepare = ct_xfitimer_prepare,
326         .start = ct_xfitimer_start,
327         .stop = ct_xfitimer_stop,
328         .interrupt = ct_xfitimer_callback,
329         .free_global = ct_xfitimer_free_global,
330 };
331
332 /*
333  * timer instance
334  */
335
336 struct ct_timer_instance *
337 ct_timer_instance_new(struct ct_timer *atimer, struct ct_atc_pcm *apcm)
338 {
339         struct ct_timer_instance *ti;
340
341         ti = kzalloc(sizeof(*ti), GFP_KERNEL);
342         if (!ti)
343                 return NULL;
344         spin_lock_init(&ti->lock);
345         INIT_LIST_HEAD(&ti->instance_list);
346         INIT_LIST_HEAD(&ti->running_list);
347         ti->timer_base = atimer;
348         ti->apcm = apcm;
349         ti->substream = apcm->substream;
350         if (atimer->ops->init)
351                 atimer->ops->init(ti);
352
353         spin_lock_irq(&atimer->list_lock);
354         list_add(&ti->instance_list, &atimer->instance_head);
355         spin_unlock_irq(&atimer->list_lock);
356
357         return ti;
358 }
359
360 void ct_timer_prepare(struct ct_timer_instance *ti)
361 {
362         if (ti->timer_base->ops->prepare)
363                 ti->timer_base->ops->prepare(ti);
364         ti->position = 0;
365         ti->running = 0;
366 }
367
368 void ct_timer_start(struct ct_timer_instance *ti)
369 {
370         struct ct_timer *atimer = ti->timer_base;
371         atimer->ops->start(ti);
372 }
373
374 void ct_timer_stop(struct ct_timer_instance *ti)
375 {
376         struct ct_timer *atimer = ti->timer_base;
377         atimer->ops->stop(ti);
378 }
379
380 void ct_timer_instance_free(struct ct_timer_instance *ti)
381 {
382         struct ct_timer *atimer = ti->timer_base;
383
384         atimer->ops->stop(ti); /* to be sure */
385         if (atimer->ops->free_instance)
386                 atimer->ops->free_instance(ti);
387
388         spin_lock_irq(&atimer->list_lock);
389         list_del(&ti->instance_list);
390         spin_unlock_irq(&atimer->list_lock);
391
392         kfree(ti);
393 }
394
395 /*
396  * timer manager
397  */
398
399 static void ct_timer_interrupt(void *data, unsigned int status)
400 {
401         struct ct_timer *timer = data;
402
403         /* Interval timer interrupt */
404         if ((status & IT_INT) && timer->ops->interrupt)
405                 timer->ops->interrupt(timer);
406 }
407
408 struct ct_timer *ct_timer_new(struct ct_atc *atc)
409 {
410         struct ct_timer *atimer;
411         struct hw *hw;
412
413         atimer = kzalloc(sizeof(*atimer), GFP_KERNEL);
414         if (!atimer)
415                 return NULL;
416         spin_lock_init(&atimer->lock);
417         spin_lock_init(&atimer->list_lock);
418         INIT_LIST_HEAD(&atimer->instance_head);
419         INIT_LIST_HEAD(&atimer->running_head);
420         atimer->atc = atc;
421         hw = atc->hw;
422         if (!use_system_timer && hw->set_timer_irq) {
423                 dev_info(atc->card->dev, "Use xfi-native timer\n");
424                 atimer->ops = &ct_xfitimer_ops;
425                 hw->irq_callback_data = atimer;
426                 hw->irq_callback = ct_timer_interrupt;
427         } else {
428                 dev_info(atc->card->dev, "Use system timer\n");
429                 atimer->ops = &ct_systimer_ops;
430         }
431         return atimer;
432 }
433
434 void ct_timer_free(struct ct_timer *atimer)
435 {
436         struct hw *hw = atimer->atc->hw;
437         hw->irq_callback = NULL;
438         if (atimer->ops->free_global)
439                 atimer->ops->free_global(atimer);
440         kfree(atimer);
441 }
442