^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (C) 2010-2013 Bluecherry, LLC <https://www.bluecherrydvr.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Original author:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Ben Collins <bcollins@ubuntu.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * Additional work by:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * John Brooks <john.brooks@bluecherry.net>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/mempool.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/poll.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/kthread.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/freezer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <sound/core.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <sound/initval.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <sound/pcm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <sound/control.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include "solo6x10.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include "solo6x10-tw28.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define G723_FDMA_PAGES 32
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define G723_PERIOD_BYTES 48
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define G723_PERIOD_BLOCK 1024
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define G723_FRAMES_PER_PAGE 48
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) /* Sets up channels 16-19 for decoding and 0-15 for encoding */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define OUTMODE_MASK 0x300
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define SAMPLERATE 8000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define BITRATE 25
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) /* The solo writes to 1k byte pages, 32 pages, in the dma. Each 1k page
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) * is broken down to 20 * 48 byte regions (one for each channel possible)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) * with the rest of the page being dummy data. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define PERIODS G723_FDMA_PAGES
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define G723_INTR_ORDER 4 /* 0 - 4 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) struct solo_snd_pcm {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) int on;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) spinlock_t lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) struct solo_dev *solo_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) u8 *g723_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) dma_addr_t g723_dma;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) static void solo_g723_config(struct solo_dev *solo_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) int clk_div;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) clk_div = (solo_dev->clock_mhz * 1000000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) / (SAMPLERATE * (BITRATE * 2) * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) solo_reg_write(solo_dev, SOLO_AUDIO_SAMPLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) SOLO_AUDIO_BITRATE(BITRATE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) | SOLO_AUDIO_CLK_DIV(clk_div));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) solo_reg_write(solo_dev, SOLO_AUDIO_FDMA_INTR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) SOLO_AUDIO_FDMA_INTERVAL(1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) | SOLO_AUDIO_INTR_ORDER(G723_INTR_ORDER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) | SOLO_AUDIO_FDMA_BASE(SOLO_G723_EXT_ADDR(solo_dev) >> 16));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) solo_reg_write(solo_dev, SOLO_AUDIO_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) SOLO_AUDIO_ENABLE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) | SOLO_AUDIO_I2S_MODE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) | SOLO_AUDIO_I2S_MULTI(3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) | SOLO_AUDIO_MODE(OUTMODE_MASK));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) void solo_g723_isr(struct solo_dev *solo_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) struct snd_pcm_str *pstr =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) &solo_dev->snd_pcm->streams[SNDRV_PCM_STREAM_CAPTURE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) struct snd_pcm_substream *ss;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) struct solo_snd_pcm *solo_pcm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) for (ss = pstr->substream; ss != NULL; ss = ss->next) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) if (snd_pcm_substream_chip(ss) == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) /* This means open() hasn't been called on this one */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) if (snd_pcm_substream_chip(ss) == solo_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) /* Haven't triggered a start yet */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) solo_pcm = snd_pcm_substream_chip(ss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) if (!solo_pcm->on)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) snd_pcm_period_elapsed(ss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) static const struct snd_pcm_hardware snd_solo_pcm_hw = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) .info = (SNDRV_PCM_INFO_MMAP |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) SNDRV_PCM_INFO_INTERLEAVED |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) SNDRV_PCM_INFO_BLOCK_TRANSFER |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) SNDRV_PCM_INFO_MMAP_VALID),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) .formats = SNDRV_PCM_FMTBIT_U8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) .rates = SNDRV_PCM_RATE_8000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) .rate_min = SAMPLERATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) .rate_max = SAMPLERATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) .channels_min = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) .channels_max = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) .buffer_bytes_max = G723_PERIOD_BYTES * PERIODS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) .period_bytes_min = G723_PERIOD_BYTES,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) .period_bytes_max = G723_PERIOD_BYTES,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) .periods_min = PERIODS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) .periods_max = PERIODS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) static int snd_solo_pcm_open(struct snd_pcm_substream *ss)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) struct solo_dev *solo_dev = snd_pcm_substream_chip(ss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) struct solo_snd_pcm *solo_pcm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) solo_pcm = kzalloc(sizeof(*solo_pcm), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) if (solo_pcm == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) goto oom;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) solo_pcm->g723_buf = pci_alloc_consistent(solo_dev->pdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) G723_PERIOD_BYTES,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) &solo_pcm->g723_dma);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) if (solo_pcm->g723_buf == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) goto oom;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) spin_lock_init(&solo_pcm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) solo_pcm->solo_dev = solo_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) ss->runtime->hw = snd_solo_pcm_hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) snd_pcm_substream_chip(ss) = solo_pcm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) oom:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) kfree(solo_pcm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static int snd_solo_pcm_close(struct snd_pcm_substream *ss)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) struct solo_snd_pcm *solo_pcm = snd_pcm_substream_chip(ss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) snd_pcm_substream_chip(ss) = solo_pcm->solo_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) pci_free_consistent(solo_pcm->solo_dev->pdev, G723_PERIOD_BYTES,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) solo_pcm->g723_buf, solo_pcm->g723_dma);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) kfree(solo_pcm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) static int snd_solo_pcm_trigger(struct snd_pcm_substream *ss, int cmd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) struct solo_snd_pcm *solo_pcm = snd_pcm_substream_chip(ss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) struct solo_dev *solo_dev = solo_pcm->solo_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) spin_lock(&solo_pcm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) case SNDRV_PCM_TRIGGER_START:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) if (solo_pcm->on == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) /* If this is the first user, switch on interrupts */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) if (atomic_inc_return(&solo_dev->snd_users) == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) solo_irq_on(solo_dev, SOLO_IRQ_G723);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) solo_pcm->on = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) case SNDRV_PCM_TRIGGER_STOP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) if (solo_pcm->on) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) /* If this was our last user, switch them off */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) if (atomic_dec_return(&solo_dev->snd_users) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) solo_irq_off(solo_dev, SOLO_IRQ_G723);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) solo_pcm->on = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) spin_unlock(&solo_pcm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) static int snd_solo_pcm_prepare(struct snd_pcm_substream *ss)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) static snd_pcm_uframes_t snd_solo_pcm_pointer(struct snd_pcm_substream *ss)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) struct solo_snd_pcm *solo_pcm = snd_pcm_substream_chip(ss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) struct solo_dev *solo_dev = solo_pcm->solo_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) snd_pcm_uframes_t idx = solo_reg_read(solo_dev, SOLO_AUDIO_STA) & 0x1f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) return idx * G723_FRAMES_PER_PAGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) static int snd_solo_pcm_copy_user(struct snd_pcm_substream *ss, int channel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) unsigned long pos, void __user *dst,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) unsigned long count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) struct solo_snd_pcm *solo_pcm = snd_pcm_substream_chip(ss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) struct solo_dev *solo_dev = solo_pcm->solo_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) int err, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) for (i = 0; i < (count / G723_FRAMES_PER_PAGE); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) int page = (pos / G723_FRAMES_PER_PAGE) + i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) err = solo_p2m_dma_t(solo_dev, 0, solo_pcm->g723_dma,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) SOLO_G723_EXT_ADDR(solo_dev) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) (page * G723_PERIOD_BLOCK) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) (ss->number * G723_PERIOD_BYTES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) G723_PERIOD_BYTES, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) if (copy_to_user(dst, solo_pcm->g723_buf, G723_PERIOD_BYTES))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) dst += G723_PERIOD_BYTES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) static int snd_solo_pcm_copy_kernel(struct snd_pcm_substream *ss, int channel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) unsigned long pos, void *dst,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) unsigned long count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) struct solo_snd_pcm *solo_pcm = snd_pcm_substream_chip(ss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) struct solo_dev *solo_dev = solo_pcm->solo_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) int err, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) for (i = 0; i < (count / G723_FRAMES_PER_PAGE); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) int page = (pos / G723_FRAMES_PER_PAGE) + i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) err = solo_p2m_dma_t(solo_dev, 0, solo_pcm->g723_dma,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) SOLO_G723_EXT_ADDR(solo_dev) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) (page * G723_PERIOD_BLOCK) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) (ss->number * G723_PERIOD_BYTES),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) G723_PERIOD_BYTES, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) memcpy(dst, solo_pcm->g723_buf, G723_PERIOD_BYTES);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) dst += G723_PERIOD_BYTES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) static const struct snd_pcm_ops snd_solo_pcm_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) .open = snd_solo_pcm_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) .close = snd_solo_pcm_close,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) .prepare = snd_solo_pcm_prepare,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) .trigger = snd_solo_pcm_trigger,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) .pointer = snd_solo_pcm_pointer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) .copy_user = snd_solo_pcm_copy_user,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) .copy_kernel = snd_solo_pcm_copy_kernel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) static int snd_solo_capture_volume_info(struct snd_kcontrol *kcontrol,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) struct snd_ctl_elem_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) info->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) info->count = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) info->value.integer.min = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) info->value.integer.max = 15;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) info->value.integer.step = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) static int snd_solo_capture_volume_get(struct snd_kcontrol *kcontrol,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) struct snd_ctl_elem_value *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) struct solo_dev *solo_dev = snd_kcontrol_chip(kcontrol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) u8 ch = value->id.numid - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) value->value.integer.value[0] = tw28_get_audio_gain(solo_dev, ch);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) static int snd_solo_capture_volume_put(struct snd_kcontrol *kcontrol,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) struct snd_ctl_elem_value *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) struct solo_dev *solo_dev = snd_kcontrol_chip(kcontrol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) u8 ch = value->id.numid - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) u8 old_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) old_val = tw28_get_audio_gain(solo_dev, ch);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) if (old_val == value->value.integer.value[0])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) tw28_set_audio_gain(solo_dev, ch, value->value.integer.value[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) static const struct snd_kcontrol_new snd_solo_capture_volume = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) .name = "Capture Volume",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) .info = snd_solo_capture_volume_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) .get = snd_solo_capture_volume_get,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) .put = snd_solo_capture_volume_put,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) static int solo_snd_pcm_init(struct solo_dev *solo_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) struct snd_card *card = solo_dev->snd_card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) struct snd_pcm *pcm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) struct snd_pcm_substream *ss;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) ret = snd_pcm_new(card, card->driver, 0, 0, solo_dev->nr_chans,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) &pcm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) &snd_solo_pcm_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) snd_pcm_chip(pcm) = solo_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) pcm->info_flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) strscpy(pcm->name, card->shortname, sizeof(pcm->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) for (i = 0, ss = pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) ss; ss = ss->next, i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) sprintf(ss->name, "Camera #%d Audio", i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) snd_pcm_set_managed_buffer_all(pcm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) SNDRV_DMA_TYPE_CONTINUOUS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) G723_PERIOD_BYTES * PERIODS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) G723_PERIOD_BYTES * PERIODS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) solo_dev->snd_pcm = pcm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) int solo_g723_init(struct solo_dev *solo_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) static struct snd_device_ops ops = { };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) struct snd_card *card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) struct snd_kcontrol_new kctl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) char name[32];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) atomic_set(&solo_dev->snd_users, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) /* Allows for easier mapping between video and audio */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) sprintf(name, "Softlogic%d", solo_dev->vfd->num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) ret = snd_card_new(&solo_dev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) SNDRV_DEFAULT_IDX1, name, THIS_MODULE, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) &solo_dev->snd_card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) card = solo_dev->snd_card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) strscpy(card->driver, SOLO6X10_NAME, sizeof(card->driver));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) strscpy(card->shortname, "SOLO-6x10 Audio", sizeof(card->shortname));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) sprintf(card->longname, "%s on %s IRQ %d", card->shortname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) pci_name(solo_dev->pdev), solo_dev->pdev->irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) ret = snd_device_new(card, SNDRV_DEV_LOWLEVEL, solo_dev, &ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) goto snd_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) /* Mixer controls */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) strscpy(card->mixername, "SOLO-6x10", sizeof(card->mixername));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) kctl = snd_solo_capture_volume;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) kctl.count = solo_dev->nr_chans;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) ret = snd_ctl_add(card, snd_ctl_new1(&kctl, solo_dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) goto snd_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) ret = solo_snd_pcm_init(solo_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) goto snd_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) ret = snd_card_register(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) goto snd_error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) solo_g723_config(solo_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) dev_info(&solo_dev->pdev->dev, "Alsa sound card as %s\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) snd_error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) snd_card_free(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) void solo_g723_exit(struct solo_dev *solo_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) if (!solo_dev->snd_card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) solo_reg_write(solo_dev, SOLO_AUDIO_CONTROL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) solo_irq_off(solo_dev, SOLO_IRQ_G723);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) snd_card_free(solo_dev->snd_card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) solo_dev->snd_card = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags