| 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
| 2 | /* |
| 3 | * Digital Audio (PCM) abstract layer |
| 4 | * Copyright (c) by Jaroslav Kysela <perex@perex.cz> |
| 5 | */ |
| 6 | |
| 7 | #include <linux/time.h> |
| 8 | #include <linux/gcd.h> |
| 9 | #include <sound/core.h> |
| 10 | #include <sound/pcm.h> |
| 11 | #include <sound/timer.h> |
| 12 | |
| 13 | #include "pcm_local.h" |
| 14 | |
| 15 | /* |
| 16 | * Timer functions |
| 17 | */ |
| 18 | |
| 19 | void snd_pcm_timer_resolution_change(struct snd_pcm_substream *substream) |
| 20 | { |
| 21 | unsigned long rate, mult, fsize, l, post; |
| 22 | struct snd_pcm_runtime *runtime = substream->runtime; |
| 23 | |
| 24 | mult = 1000000000; |
| 25 | rate = runtime->rate; |
| 26 | if (snd_BUG_ON(!rate)) |
| 27 | return; |
| 28 | l = gcd(a: mult, b: rate); |
| 29 | mult /= l; |
| 30 | rate /= l; |
| 31 | fsize = runtime->period_size; |
| 32 | if (snd_BUG_ON(!fsize)) |
| 33 | return; |
| 34 | l = gcd(a: rate, b: fsize); |
| 35 | rate /= l; |
| 36 | fsize /= l; |
| 37 | post = 1; |
| 38 | while ((mult * fsize) / fsize != mult) { |
| 39 | mult /= 2; |
| 40 | post *= 2; |
| 41 | } |
| 42 | if (rate == 0) { |
| 43 | pcm_err(substream->pcm, |
| 44 | "pcm timer resolution out of range (rate = %u, period_size = %lu)\n" , |
| 45 | runtime->rate, runtime->period_size); |
| 46 | runtime->timer_resolution = -1; |
| 47 | return; |
| 48 | } |
| 49 | runtime->timer_resolution = (mult * fsize / rate) * post; |
| 50 | } |
| 51 | |
| 52 | static unsigned long snd_pcm_timer_resolution(struct snd_timer * timer) |
| 53 | { |
| 54 | struct snd_pcm_substream *substream; |
| 55 | |
| 56 | substream = timer->private_data; |
| 57 | return substream->runtime ? substream->runtime->timer_resolution : 0; |
| 58 | } |
| 59 | |
| 60 | static int snd_pcm_timer_start(struct snd_timer * timer) |
| 61 | { |
| 62 | struct snd_pcm_substream *substream; |
| 63 | |
| 64 | substream = snd_timer_chip(timer); |
| 65 | substream->timer_running = 1; |
| 66 | return 0; |
| 67 | } |
| 68 | |
| 69 | static int snd_pcm_timer_stop(struct snd_timer * timer) |
| 70 | { |
| 71 | struct snd_pcm_substream *substream; |
| 72 | |
| 73 | substream = snd_timer_chip(timer); |
| 74 | substream->timer_running = 0; |
| 75 | return 0; |
| 76 | } |
| 77 | |
| 78 | static const struct snd_timer_hardware snd_pcm_timer = |
| 79 | { |
| 80 | .flags = SNDRV_TIMER_HW_AUTO | SNDRV_TIMER_HW_SLAVE, |
| 81 | .resolution = 0, |
| 82 | .ticks = 1, |
| 83 | .c_resolution = snd_pcm_timer_resolution, |
| 84 | .start = snd_pcm_timer_start, |
| 85 | .stop = snd_pcm_timer_stop, |
| 86 | }; |
| 87 | |
| 88 | /* |
| 89 | * Init functions |
| 90 | */ |
| 91 | |
| 92 | static void snd_pcm_timer_free(struct snd_timer *timer) |
| 93 | { |
| 94 | struct snd_pcm_substream *substream = timer->private_data; |
| 95 | substream->timer = NULL; |
| 96 | } |
| 97 | |
| 98 | void snd_pcm_timer_init(struct snd_pcm_substream *substream) |
| 99 | { |
| 100 | struct snd_timer_id tid; |
| 101 | struct snd_timer *timer; |
| 102 | |
| 103 | tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE; |
| 104 | tid.dev_class = SNDRV_TIMER_CLASS_PCM; |
| 105 | tid.card = substream->pcm->card->number; |
| 106 | tid.device = substream->pcm->device; |
| 107 | tid.subdevice = (substream->number << 1) | (substream->stream & 1); |
| 108 | if (snd_timer_new(card: substream->pcm->card, id: "PCM" , tid: &tid, rtimer: &timer) < 0) |
| 109 | return; |
| 110 | sprintf(buf: timer->name, fmt: "PCM %s %i-%i-%i" , |
| 111 | snd_pcm_direction_name(direction: substream->stream), |
| 112 | tid.card, tid.device, tid.subdevice); |
| 113 | timer->hw = snd_pcm_timer; |
| 114 | if (snd_device_register(card: timer->card, device_data: timer) < 0) { |
| 115 | snd_device_free(card: timer->card, device_data: timer); |
| 116 | return; |
| 117 | } |
| 118 | timer->private_data = substream; |
| 119 | timer->private_free = snd_pcm_timer_free; |
| 120 | substream->timer = timer; |
| 121 | } |
| 122 | |
| 123 | void snd_pcm_timer_done(struct snd_pcm_substream *substream) |
| 124 | { |
| 125 | if (substream->timer) { |
| 126 | snd_device_free(card: substream->pcm->card, device_data: substream->timer); |
| 127 | substream->timer = NULL; |
| 128 | } |
| 129 | } |
| 130 | |