summaryrefslogtreecommitdiffstats
path: root/sound
diff options
context:
space:
mode:
Diffstat (limited to 'sound')
-rw-r--r--sound/soc/soc-core.c781
1 files changed, 148 insertions, 633 deletions
diff --git a/sound/soc/soc-core.c b/sound/soc/soc-core.c
index 87be938622d..36519aef55d 100644
--- a/sound/soc/soc-core.c
+++ b/sound/soc/soc-core.c
@@ -47,27 +47,11 @@
#else
#define dbg(format, arg...)
#endif
-/* debug DAI capabilities matching */
-#define SOC_DEBUG_DAI 0
-#if SOC_DEBUG_DAI
-#define dbgc(format, arg...) printk(format, ## arg)
-#else
-#define dbgc(format, arg...)
-#endif
-
-#define CODEC_CPU(codec, cpu) ((codec << 4) | cpu)
static DEFINE_MUTEX(pcm_mutex);
static DEFINE_MUTEX(io_mutex);
static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq);
-/* supported sample rates */
-/* ATTENTION: these values depend on the definition in pcm.h! */
-static const unsigned int rates[] = {
- 5512, 8000, 11025, 16000, 22050, 32000, 44100,
- 48000, 64000, 88200, 96000, 176400, 192000
-};
-
/*
* This is a timeout to do a DAPM powerdown after a stream is closed().
* It can be used to eliminate pops between different playback streams, e.g.
@@ -142,458 +126,6 @@ static inline const char* get_dai_name(int type)
return NULL;
}
-/* get rate format from rate */
-static inline int soc_get_rate_format(int rate)
-{
- int i;
-
- for (i = 0; i < ARRAY_SIZE(rates); i++) {
- if (rates[i] == rate)
- return 1 << i;
- }
- return 0;
-}
-
-/* gets the audio system mclk/sysclk for the given parameters */
-static unsigned inline int soc_get_mclk(struct snd_soc_pcm_runtime *rtd,
- struct snd_soc_clock_info *info)
-{
- struct snd_soc_device *socdev = rtd->socdev;
- struct snd_soc_machine *machine = socdev->machine;
- int i;
-
- /* find the matching machine config and get it's mclk for the given
- * sample rate and hardware format */
- for(i = 0; i < machine->num_links; i++) {
- if (machine->dai_link[i].cpu_dai == rtd->cpu_dai &&
- machine->dai_link[i].config_sysclk)
- return machine->dai_link[i].config_sysclk(rtd, info);
- }
- return 0;
-}
-
-/* changes a bitclk multiplier mask to a divider mask */
-static u64 soc_bfs_rcw_to_div(u64 bfs, int rate, unsigned int mclk,
- unsigned int pcmfmt, unsigned int chn)
-{
- int i, j;
- u64 bfs_ = 0;
- int size = snd_pcm_format_physical_width(pcmfmt), min = 0;
-
- if (size <= 0)
- return 0;
-
- /* the minimum bit clock that has enough bandwidth */
- min = size * rate * chn;
- dbgc("rcw --> div min bclk %d with mclk %d\n", min, mclk);
-
- for (i = 0; i < 64; i++) {
- if ((bfs >> i) & 0x1) {
- j = min * (i + 1);
- bfs_ |= SND_SOC_FSBD(mclk/j);
- dbgc("rcw --> div support mult %d\n",
- SND_SOC_FSBD_REAL(1<<i));
- }
- }
-
- return bfs_;
-}
-
-/* changes a bitclk divider mask to a multiplier mask */
-static u64 soc_bfs_div_to_rcw(u64 bfs, int rate, unsigned int mclk,
- unsigned int pcmfmt, unsigned int chn)
-{
- int i, j;
- u64 bfs_ = 0;
-
- int size = snd_pcm_format_physical_width(pcmfmt), min = 0;
-
- if (size <= 0)
- return 0;
-
- /* the minimum bit clock that has enough bandwidth */
- min = size * rate * chn;
- dbgc("div to rcw min bclk %d with mclk %d\n", min, mclk);
-
- for (i = 0; i < 64; i++) {
- if ((bfs >> i) & 0x1) {
- j = mclk / (i + 1);
- if (j >= min) {
- bfs_ |= SND_SOC_FSBW(j/min);
- dbgc("div --> rcw support div %d\n",
- SND_SOC_FSBW_REAL(1<<i));
- }
- }
- }
-
- return bfs_;
-}
-
-/* changes a constant bitclk to a multiplier mask */
-static u64 soc_bfs_rate_to_rcw(u64 bfs, int rate, unsigned int mclk,
- unsigned int pcmfmt, unsigned int chn)
-{
- unsigned int bfs_ = rate * bfs;
- int size = snd_pcm_format_physical_width(pcmfmt), min = 0;
-
- if (size <= 0)
- return 0;
-
- /* the minimum bit clock that has enough bandwidth */
- min = size * rate * chn;
- dbgc("rate --> rcw min bclk %d with mclk %d\n", min, mclk);
-
- if (bfs_ < min)
- return 0;
- else {
- bfs_ = SND_SOC_FSBW(bfs_/min);
- dbgc("rate --> rcw support div %d\n", SND_SOC_FSBW_REAL(bfs_));
- return bfs_;
- }
-}
-
-/* changes a bitclk multiplier mask to a divider mask */
-static u64 soc_bfs_rate_to_div(u64 bfs, int rate, unsigned int mclk,
- unsigned int pcmfmt, unsigned int chn)
-{
- unsigned int bfs_ = rate * bfs;
- int size = snd_pcm_format_physical_width(pcmfmt), min = 0;
-
- if (size <= 0)
- return 0;
-
- /* the minimum bit clock that has enough bandwidth */
- min = size * rate * chn;
- dbgc("rate --> div min bclk %d with mclk %d\n", min, mclk);
-
- if (bfs_ < min)
- return 0;
- else {
- bfs_ = SND_SOC_FSBW(mclk/bfs_);
- dbgc("rate --> div support div %d\n", SND_SOC_FSBD_REAL(bfs_));
- return bfs_;
- }
-}
-
-/* Matches codec DAI and SoC CPU DAI hardware parameters */
-static int soc_hw_match_params(struct snd_pcm_substream *substream,
- struct snd_pcm_hw_params *params)
-{
- struct snd_soc_pcm_runtime *rtd = substream->private_data;
- struct snd_soc_dai_mode *codec_dai_mode = NULL;
- struct snd_soc_dai_mode *cpu_dai_mode = NULL;
- struct snd_soc_clock_info clk_info;
- unsigned int fs, mclk, rate = params_rate(params),
- chn, j, k, cpu_bclk, codec_bclk, pcmrate;
- u16 fmt = 0;
- u64 codec_bfs, cpu_bfs;
-
- dbg("asoc: match version %s\n", SND_SOC_VERSION);
- clk_info.rate = rate;
- pcmrate = soc_get_rate_format(rate);
-
- /* try and find a match from the codec and cpu DAI capabilities */
- for (j = 0; j < rtd->codec_dai->caps.num_modes; j++) {
- for (k = 0; k < rtd->cpu_dai->caps.num_modes; k++) {
- codec_dai_mode = &rtd->codec_dai->caps.mode[j];
- cpu_dai_mode = &rtd->cpu_dai->caps.mode[k];
-
- if (!(codec_dai_mode->pcmrate & cpu_dai_mode->pcmrate &
- pcmrate)) {
- dbgc("asoc: DAI[%d:%d] failed to match rate\n", j, k);
- continue;
- }
-
- fmt = codec_dai_mode->fmt & cpu_dai_mode->fmt;
- if (!(fmt & SND_SOC_DAIFMT_FORMAT_MASK)) {
- dbgc("asoc: DAI[%d:%d] failed to match format\n", j, k);
- continue;
- }
-
- if (!(fmt & SND_SOC_DAIFMT_CLOCK_MASK)) {
- dbgc("asoc: DAI[%d:%d] failed to match clock masters\n",
- j, k);
- continue;
- }
-
- if (!(fmt & SND_SOC_DAIFMT_INV_MASK)) {
- dbgc("asoc: DAI[%d:%d] failed to match invert\n", j, k);
- continue;
- }
-
- if (!(codec_dai_mode->pcmfmt & cpu_dai_mode->pcmfmt)) {
- dbgc("asoc: DAI[%d:%d] failed to match pcm format\n", j, k);
- continue;
- }
-
- if (!(codec_dai_mode->pcmdir & cpu_dai_mode->pcmdir)) {
- dbgc("asoc: DAI[%d:%d] failed to match direction\n", j, k);
- continue;
- }
-
- /* todo - still need to add tdm selection */
- rtd->cpu_dai->dai_runtime.fmt =
- rtd->codec_dai->dai_runtime.fmt =
- 1 << (ffs(fmt & SND_SOC_DAIFMT_FORMAT_MASK) -1) |
- 1 << (ffs(fmt & SND_SOC_DAIFMT_CLOCK_MASK) - 1) |
- 1 << (ffs(fmt & SND_SOC_DAIFMT_INV_MASK) - 1);
- clk_info.bclk_master =
- rtd->cpu_dai->dai_runtime.fmt & SND_SOC_DAIFMT_CLOCK_MASK;
-
- /* make sure the ratio between rate and master
- * clock is acceptable*/
- fs = (cpu_dai_mode->fs & codec_dai_mode->fs);
- if (fs == 0) {
- dbgc("asoc: DAI[%d:%d] failed to match FS\n", j, k);
- continue;
- }
- clk_info.fs = rtd->cpu_dai->dai_runtime.fs =
- rtd->codec_dai->dai_runtime.fs = fs;
-
- /* calculate audio system clocking using slowest clocks possible*/
- mclk = soc_get_mclk(rtd, &clk_info);
- if (mclk == 0) {
- dbgc("asoc: DAI[%d:%d] configuration not clockable\n", j, k);
- dbgc("asoc: rate %d fs %d master %x\n", rate, fs,
- clk_info.bclk_master);
- continue;
- }
-
- /* calculate word size (per channel) and frame size */
- rtd->codec_dai->dai_runtime.pcmfmt =
- rtd->cpu_dai->dai_runtime.pcmfmt =
- 1 << params_format(params);
-
- chn = params_channels(params);
- /* i2s always has left and right */
- if (params_channels(params) == 1 &&
- rtd->cpu_dai->dai_runtime.fmt & (SND_SOC_DAIFMT_I2S |
- SND_SOC_DAIFMT_RIGHT_J | SND_SOC_DAIFMT_LEFT_J))
- chn <<= 1;
-
- /* Calculate bfs - the ratio between bitclock and the sample rate
- * We must take into consideration the dividers and multipliers
- * used in the codec and cpu DAI modes. We always choose the
- * lowest possible clocks to reduce power.
- */
- switch (CODEC_CPU(codec_dai_mode->flags, cpu_dai_mode->flags)) {
- case CODEC_CPU(SND_SOC_DAI_BFS_DIV, SND_SOC_DAI_BFS_DIV):
- /* cpu & codec bfs dividers */
- rtd->cpu_dai->dai_runtime.bfs =
- rtd->codec_dai->dai_runtime.bfs =
- 1 << (fls(codec_dai_mode->bfs & cpu_dai_mode->bfs) - 1);
- break;
- case CODEC_CPU(SND_SOC_DAI_BFS_DIV, SND_SOC_DAI_BFS_RCW):
- /* normalise bfs codec divider & cpu rcw mult */
- codec_bfs = soc_bfs_div_to_rcw(codec_dai_mode->bfs, rate,
- mclk, rtd->codec_dai->dai_runtime.pcmfmt, chn);
- rtd->cpu_dai->dai_runtime.bfs =
- 1 << (ffs(codec_bfs & cpu_dai_mode->bfs) - 1);
- cpu_bfs = soc_bfs_rcw_to_div(cpu_dai_mode->bfs, rate, mclk,
- rtd->codec_dai->dai_runtime.pcmfmt, chn);
- rtd->codec_dai->dai_runtime.bfs =
- 1 << (fls(codec_dai_mode->bfs & cpu_bfs) - 1);
- break;
- case CODEC_CPU(SND_SOC_DAI_BFS_RCW, SND_SOC_DAI_BFS_DIV):
- /* normalise bfs codec rcw mult & cpu divider */
- codec_bfs = soc_bfs_rcw_to_div(codec_dai_mode->bfs, rate,
- mclk, rtd->codec_dai->dai_runtime.pcmfmt, chn);
- rtd->cpu_dai->dai_runtime.bfs =
- 1 << (fls(codec_bfs & cpu_dai_mode->bfs) -1);
- cpu_bfs = soc_bfs_div_to_rcw(cpu_dai_mode->bfs, rate, mclk,
- rtd->codec_dai->dai_runtime.pcmfmt, chn);
- rtd->codec_dai->dai_runtime.bfs =
- 1 << (ffs(codec_dai_mode->bfs & cpu_bfs) -1);
- break;
- case CODEC_CPU(SND_SOC_DAI_BFS_RCW, SND_SOC_DAI_BFS_RCW):
- /* codec & cpu bfs rate rcw multipliers */
- rtd->cpu_dai->dai_runtime.bfs =
- rtd->codec_dai->dai_runtime.bfs =
- 1 << (ffs(codec_dai_mode->bfs & cpu_dai_mode->bfs) -1);
- break;
- case CODEC_CPU(SND_SOC_DAI_BFS_DIV, SND_SOC_DAI_BFS_RATE):
- /* normalise cpu bfs rate const multiplier & codec div */
- cpu_bfs = soc_bfs_rate_to_div(cpu_dai_mode->bfs, rate,
- mclk, rtd->codec_dai->dai_runtime.pcmfmt, chn);
- if(codec_dai_mode->bfs & cpu_bfs) {
- rtd->codec_dai->dai_runtime.bfs = cpu_bfs;
- rtd->cpu_dai->dai_runtime.bfs = cpu_dai_mode->bfs;
- } else
- rtd->cpu_dai->dai_runtime.bfs = 0;
- break;
- case CODEC_CPU(SND_SOC_DAI_BFS_RCW, SND_SOC_DAI_BFS_RATE):
- /* normalise cpu bfs rate const multiplier & codec rcw mult */
- cpu_bfs = soc_bfs_rate_to_rcw(cpu_dai_mode->bfs, rate,
- mclk, rtd->codec_dai->dai_runtime.pcmfmt, chn);
- if(codec_dai_mode->bfs & cpu_bfs) {
- rtd->codec_dai->dai_runtime.bfs = cpu_bfs;
- rtd->cpu_dai->dai_runtime.bfs = cpu_dai_mode->bfs;
- } else
- rtd->cpu_dai->dai_runtime.bfs = 0;
- break;
- case CODEC_CPU(SND_SOC_DAI_BFS_RATE, SND_SOC_DAI_BFS_RCW):
- /* normalise cpu bfs rate rcw multiplier & codec const mult */
- codec_bfs = soc_bfs_rate_to_rcw(codec_dai_mode->bfs, rate,
- mclk, rtd->codec_dai->dai_runtime.pcmfmt, chn);
- if(cpu_dai_mode->bfs & codec_bfs) {
- rtd->cpu_dai->dai_runtime.bfs = codec_bfs;
- rtd->codec_dai->dai_runtime.bfs = codec_dai_mode->bfs;
- } else
- rtd->cpu_dai->dai_runtime.bfs = 0;
- break;
- case CODEC_CPU(SND_SOC_DAI_BFS_RATE, SND_SOC_DAI_BFS_DIV):
- /* normalise cpu bfs div & codec const mult */
- codec_bfs = soc_bfs_rate_to_div(codec_dai_mode->bfs, rate,
- mclk, rtd->codec_dai->dai_runtime.pcmfmt, chn);
- if(cpu_dai_mode->bfs & codec_bfs) {
- rtd->cpu_dai->dai_runtime.bfs = codec_bfs;
- rtd->codec_dai->dai_runtime.bfs = codec_dai_mode->bfs;
- } else
- rtd->cpu_dai->dai_runtime.bfs = 0;
- break;
- case CODEC_CPU(SND_SOC_DAI_BFS_RATE, SND_SOC_DAI_BFS_RATE):
- /* cpu & codec constant mult */
- if(codec_dai_mode->bfs == cpu_dai_mode->bfs)
- rtd->cpu_dai->dai_runtime.bfs =
- rtd->codec_dai->dai_runtime.bfs =
- codec_dai_mode->bfs;
- else
- rtd->cpu_dai->dai_runtime.bfs =
- rtd->codec_dai->dai_runtime.bfs = 0;
- break;
- }
-
- /* make sure the bit clock speed is acceptable */
- if (!rtd->cpu_dai->dai_runtime.bfs ||
- !rtd->codec_dai->dai_runtime.bfs) {
- dbgc("asoc: DAI[%d:%d] failed to match BFS\n", j, k);
- dbgc("asoc: cpu_dai %llu codec %llu\n",
- rtd->cpu_dai->dai_runtime.bfs,
- rtd->codec_dai->dai_runtime.bfs);
- dbgc("asoc: mclk %d hwfmt %x\n", mclk, fmt);
- continue;
- }
-
- goto found;
- }
- }
- printk(KERN_ERR "asoc: no matching DAI found between codec and CPU\n");
- return -EINVAL;
-
-found:
- /* we have matching DAI's, so complete the runtime info */
- rtd->codec_dai->dai_runtime.pcmrate =
- rtd->cpu_dai->dai_runtime.pcmrate =
- soc_get_rate_format(rate);
-
- rtd->codec_dai->dai_runtime.priv = codec_dai_mode->priv;
- rtd->cpu_dai->dai_runtime.priv = cpu_dai_mode->priv;
- rtd->codec_dai->dai_runtime.flags = codec_dai_mode->flags;
- rtd->cpu_dai->dai_runtime.flags = cpu_dai_mode->flags;
-
- /* for debug atm */
- dbg("asoc: DAI[%d:%d] Match OK\n", j, k);
- if (rtd->codec_dai->dai_runtime.flags == SND_SOC_DAI_BFS_DIV) {
- codec_bclk = (rtd->codec_dai->dai_runtime.fs * params_rate(params)) /
- SND_SOC_FSBD_REAL(rtd->codec_dai->dai_runtime.bfs);
- dbg("asoc: codec fs %d mclk %d bfs div %d bclk %d\n",
- rtd->codec_dai->dai_runtime.fs, mclk,
- SND_SOC_FSBD_REAL(rtd->codec_dai->dai_runtime.bfs), codec_bclk);
- } else if(rtd->codec_dai->dai_runtime.flags == SND_SOC_DAI_BFS_RATE) {
- codec_bclk = params_rate(params) * rtd->codec_dai->dai_runtime.bfs;
- dbg("asoc: codec fs %d mclk %d bfs rate mult %llu bclk %d\n",
- rtd->codec_dai->dai_runtime.fs, mclk,
- rtd->codec_dai->dai_runtime.bfs, codec_bclk);
- } else if (rtd->cpu_dai->dai_runtime.flags == SND_SOC_DAI_BFS_RCW) {
- codec_bclk = params_rate(params) * params_channels(params) *
- snd_pcm_format_physical_width(rtd->codec_dai->dai_runtime.pcmfmt) *
- SND_SOC_FSBW_REAL(rtd->codec_dai->dai_runtime.bfs);
- dbg("asoc: codec fs %d mclk %d bfs rcw mult %d bclk %d\n",
- rtd->codec_dai->dai_runtime.fs, mclk,
- SND_SOC_FSBW_REAL(rtd->codec_dai->dai_runtime.bfs), codec_bclk);
- } else
- codec_bclk = 0;
-
- if (rtd->cpu_dai->dai_runtime.flags == SND_SOC_DAI_BFS_DIV) {
- cpu_bclk = (rtd->cpu_dai->dai_runtime.fs * params_rate(params)) /
- SND_SOC_FSBD_REAL(rtd->cpu_dai->dai_runtime.bfs);
- dbg("asoc: cpu fs %d mclk %d bfs div %d bclk %d\n",
- rtd->cpu_dai->dai_runtime.fs, mclk,
- SND_SOC_FSBD_REAL(rtd->cpu_dai->dai_runtime.bfs), cpu_bclk);
- } else if (rtd->cpu_dai->dai_runtime.flags == SND_SOC_DAI_BFS_RATE) {
- cpu_bclk = params_rate(params) * rtd->cpu_dai->dai_runtime.bfs;
- dbg("asoc: cpu fs %d mclk %d bfs rate mult %llu bclk %d\n",
- rtd->cpu_dai->dai_runtime.fs, mclk,
- rtd->cpu_dai->dai_runtime.bfs, cpu_bclk);
- } else if (rtd->cpu_dai->dai_runtime.flags == SND_SOC_DAI_BFS_RCW) {
- cpu_bclk = params_rate(params) * params_channels(params) *
- snd_pcm_format_physical_width(rtd->cpu_dai->dai_runtime.pcmfmt) *
- SND_SOC_FSBW_REAL(rtd->cpu_dai->dai_runtime.bfs);
- dbg("asoc: cpu fs %d mclk %d bfs mult rcw %d bclk %d\n",
- rtd->cpu_dai->dai_runtime.fs, mclk,
- SND_SOC_FSBW_REAL(rtd->cpu_dai->dai_runtime.bfs), cpu_bclk);
- } else
- cpu_bclk = 0;
-
- /*
- * Check we have matching bitclocks. If we don't then it means the
- * sysclock returned by either the codec or cpu DAI (selected by the
- * machine sysclock function) is wrong compared with the supported DAI
- * modes for the codec or cpu DAI. Check your codec or CPU DAI
- * config_sysclock() functions.
- */
- if (cpu_bclk != codec_bclk && cpu_bclk){
- printk(KERN_ERR
- "asoc: codec and cpu bitclocks differ, audio may be wrong speed\n"
- );
- printk(KERN_ERR "asoc: codec %d != cpu %d\n", codec_bclk, cpu_bclk);
- }
-
- switch(rtd->cpu_dai->dai_runtime.fmt & SND_SOC_DAIFMT_CLOCK_MASK) {
- case SND_SOC_DAIFMT_CBM_CFM:
- dbg("asoc: DAI codec BCLK master, LRC master\n");
- break;
- case SND_SOC_DAIFMT_CBS_CFM:
- dbg("asoc: DAI codec BCLK slave, LRC master\n");
- break;
- case SND_SOC_DAIFMT_CBM_CFS:
- dbg("asoc: DAI codec BCLK master, LRC slave\n");
- break;
- case SND_SOC_DAIFMT_CBS_CFS:
- dbg("asoc: DAI codec BCLK slave, LRC slave\n");
- break;
- }
- dbg("asoc: mode %x, invert %x\n",
- rtd->cpu_dai->dai_runtime.fmt & SND_SOC_DAIFMT_FORMAT_MASK,
- rtd->cpu_dai->dai_runtime.fmt & SND_SOC_DAIFMT_INV_MASK);
- dbg("asoc: audio rate %d chn %d fmt %x\n", params_rate(params),
- params_channels(params), params_format(params));
-
- return 0;
-}
-
-static inline u32 get_rates(struct snd_soc_dai_mode *modes, int nmodes)
-{
- int i;
- u32 rates = 0;
-
- for(i = 0; i < nmodes; i++)
- rates |= modes[i].pcmrate;
-
- return rates;
-}
-
-static inline u64 get_formats(struct snd_soc_dai_mode *modes, int nmodes)
-{
- int i;
- u64 formats = 0;
-
- for(i = 0; i < nmodes; i++)
- formats |= modes[i].pcmfmt;
-
- return formats;
-}
-
/*
* Called by ALSA when a PCM substream is opened, the runtime->hw record is
* then initialized and any private data can be allocated. This also calls
@@ -604,20 +136,20 @@ static int soc_pcm_open(struct snd_pcm_substream *substream)
struct snd_soc_pcm_runtime *rtd = substream->private_data;
struct snd_soc_device *socdev = rtd->socdev;
struct snd_pcm_runtime *runtime = substream->runtime;
- struct snd_soc_machine *machine = socdev->machine;
+ struct snd_soc_dai_link *machine = rtd->dai;
struct snd_soc_platform *platform = socdev->platform;
- struct snd_soc_codec_dai *codec_dai = rtd->codec_dai;
- struct snd_soc_cpu_dai *cpu_dai = rtd->cpu_dai;
+ struct snd_soc_cpu_dai *cpu_dai = machine->cpu_dai;
+ struct snd_soc_codec_dai *codec_dai = machine->codec_dai;
int ret = 0;
mutex_lock(&pcm_mutex);
/* startup the audio subsystem */
- if (rtd->cpu_dai->ops.startup) {
- ret = rtd->cpu_dai->ops.startup(substream);
+ if (cpu_dai->ops.startup) {
+ ret = cpu_dai->ops.startup(substream);
if (ret < 0) {
printk(KERN_ERR "asoc: can't open interface %s\n",
- rtd->cpu_dai->name);
+ cpu_dai->name);
goto out;
}
}
@@ -630,116 +162,101 @@ static int soc_pcm_open(struct snd_pcm_substream *substream)
}
}
- if (machine->ops && machine->ops->startup) {
- ret = machine->ops->startup(substream);
+ if (codec_dai->ops.startup) {
+ ret = codec_dai->ops.startup(substream);
if (ret < 0) {
- printk(KERN_ERR "asoc: %s startup failed\n", machine->name);
- goto machine_err;
+ printk(KERN_ERR "asoc: can't open codec %s\n",
+ codec_dai->name);
+ goto codec_dai_err;
}
}
- if (rtd->codec_dai->ops.startup) {
- ret = rtd->codec_dai->ops.startup(substream);
+ if (machine->ops && machine->ops->startup) {
+ ret = machine->ops->startup(substream);
if (ret < 0) {
- printk(KERN_ERR "asoc: can't open codec %s\n",
- rtd->codec_dai->name);
- goto codec_dai_err;
+ printk(KERN_ERR "asoc: %s startup failed\n", machine->name);
+ goto machine_err;
}
}
- /* create runtime params from DMA, codec and cpu DAI */
- if (runtime->hw.rates)
- runtime->hw.rates &=
- get_rates(codec_dai->caps.mode, codec_dai->caps.num_modes) &
- get_rates(cpu_dai->caps.mode, cpu_dai->caps.num_modes);
- else
- runtime->hw.rates =
- get_rates(codec_dai->caps.mode, codec_dai->caps.num_modes) &
- get_rates(cpu_dai->caps.mode, cpu_dai->caps.num_modes);
- if (runtime->hw.formats)
- runtime->hw.formats &=
- get_formats(codec_dai->caps.mode, codec_dai->caps.num_modes) &
- get_formats(cpu_dai->caps.mode, cpu_dai->caps.num_modes);
- else
- runtime->hw.formats =
- get_formats(codec_dai->caps.mode, codec_dai->caps.num_modes) &
- get_formats(cpu_dai->caps.mode, cpu_dai->caps.num_modes);
-
/* Check that the codec and cpu DAI's are compatible */
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
runtime->hw.rate_min =
- max(rtd->codec_dai->playback.rate_min,
- rtd->cpu_dai->playback.rate_min);
+ max(codec_dai->playback.rate_min, cpu_dai->playback.rate_min);
runtime->hw.rate_max =
- min(rtd->codec_dai->playback.rate_max,
- rtd->cpu_dai->playback.rate_max);
+ min(codec_dai->playback.rate_max, cpu_dai->playback.rate_max);
runtime->hw.channels_min =
- max(rtd->codec_dai->playback.channels_min,
- rtd->cpu_dai->playback.channels_min);
+ max(codec_dai->playback.channels_min,
+ cpu_dai->playback.channels_min);
runtime->hw.channels_max =
- min(rtd->codec_dai->playback.channels_max,
- rtd->cpu_dai->playback.channels_max);
+ min(codec_dai->playback.channels_max,
+ cpu_dai->playback.channels_max);
+ runtime->hw.formats =
+ codec_dai->playback.formats & cpu_dai->playback.formats;
+ runtime->hw.rates =
+ codec_dai->playback.rates & cpu_dai->playback.rates;
} else {
runtime->hw.rate_min =
- max(rtd->codec_dai->capture.rate_min,
- rtd->cpu_dai->capture.rate_min);
+ max(codec_dai->capture.rate_min, cpu_dai->capture.rate_min);
runtime->hw.rate_max =
- min(rtd->codec_dai->capture.rate_max,
- rtd->cpu_dai->capture.rate_max);
+ min(codec_dai->capture.rate_max, cpu_dai->capture.rate_max);
runtime->hw.channels_min =
- max(rtd->codec_dai->capture.channels_min,
- rtd->cpu_dai->capture.channels_min);
+ max(codec_dai->capture.channels_min,
+ cpu_dai->capture.channels_min);
runtime->hw.channels_max =
- min(rtd->codec_dai->capture.channels_max,
- rtd->cpu_dai->capture.channels_max);
+ min(codec_dai->capture.channels_max,
+ cpu_dai->capture.channels_max);
+ runtime->hw.formats =
+ codec_dai->capture.formats & cpu_dai->capture.formats;
+ runtime->hw.rates =
+ codec_dai->capture.rates & cpu_dai->capture.rates;
}
snd_pcm_limit_hw_rates(runtime);
if (!runtime->hw.rates) {
printk(KERN_ERR "asoc: %s <-> %s No matching rates\n",
- rtd->codec_dai->name, rtd->cpu_dai->name);
- goto codec_dai_err;
+ codec_dai->name, cpu_dai->name);
+ goto machine_err;
}
if (!runtime->hw.formats) {
printk(KERN_ERR "asoc: %s <-> %s No matching formats\n",
- rtd->codec_dai->name, rtd->cpu_dai->name);
- goto codec_dai_err;
+ codec_dai->name, cpu_dai->name);
+ goto machine_err;
}
if (!runtime->hw.channels_min || !runtime->hw.channels_max) {
printk(KERN_ERR "asoc: %s <-> %s No matching channels\n",
- rtd->codec_dai->name, rtd->cpu_dai->name);
- goto codec_dai_err;
+ codec_dai->name, cpu_dai->name);
+ goto machine_err;
}
- dbg("asoc: %s <-> %s info:\n", rtd->codec_dai->name, rtd->cpu_dai->name);
+ dbg("asoc: %s <-> %s info:\n",codec_dai->name, cpu_dai->name);
dbg("asoc: rate mask 0x%x\n", runtime->hw.rates);
dbg("asoc: min ch %d max ch %d\n", runtime->hw.channels_min,
runtime->hw.channels_max);
dbg("asoc: min rate %d max rate %d\n", runtime->hw.rate_min,
runtime->hw.rate_max);
-
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
- rtd->cpu_dai->playback.active = rtd->codec_dai->playback.active = 1;
+ cpu_dai->playback.active = codec_dai->playback.active = 1;
else
- rtd->cpu_dai->capture.active = rtd->codec_dai->capture.active = 1;
- rtd->cpu_dai->active = rtd->codec_dai->active = 1;
- rtd->cpu_dai->runtime = runtime;
+ cpu_dai->capture.active = codec_dai->capture.active = 1;
+ cpu_dai->active = codec_dai->active = 1;
+ cpu_dai->runtime = runtime;
socdev->codec->active++;
mutex_unlock(&pcm_mutex);
return 0;
-codec_dai_err:
+machine_err:
if (machine->ops && machine->ops->shutdown)
machine->ops->shutdown(substream);
-machine_err:
+codec_dai_err:
if (platform->pcm_ops->close)
platform->pcm_ops->close(substream);
platform_err:
- if (rtd->cpu_dai->ops.shutdown)
- rtd->cpu_dai->ops.shutdown(substream);
+ if (cpu_dai->ops.shutdown)
+ cpu_dai->ops.shutdown(substream);
out:
mutex_unlock(&pcm_mutex);
return ret;
@@ -795,47 +312,49 @@ static int soc_codec_close(struct snd_pcm_substream *substream)
{
struct snd_soc_pcm_runtime *rtd = substream->private_data;
struct snd_soc_device *socdev = rtd->socdev;
- struct snd_soc_machine *machine = socdev->machine;
+ struct snd_soc_dai_link *machine = rtd->dai;
struct snd_soc_platform *platform = socdev->platform;
+ struct snd_soc_cpu_dai *cpu_dai = machine->cpu_dai;
+ struct snd_soc_codec_dai *codec_dai = machine->codec_dai;
struct snd_soc_codec *codec = socdev->codec;
mutex_lock(&pcm_mutex);
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
- rtd->cpu_dai->playback.active = rtd->codec_dai->playback.active = 0;
+ cpu_dai->playback.active = codec_dai->playback.active = 0;
else
- rtd->cpu_dai->capture.active = rtd->codec_dai->capture.active = 0;
+ cpu_dai->capture.active = codec_dai->capture.active = 0;
- if (rtd->codec_dai->playback.active == 0 &&
- rtd->codec_dai->capture.active == 0) {
- rtd->cpu_dai->active = rtd->codec_dai->active = 0;
+ if (codec_dai->playback.active == 0 &&
+ codec_dai->capture.active == 0) {
+ cpu_dai->active = codec_dai->active = 0;
}
codec->active--;
- if (rtd->cpu_dai->ops.shutdown)
- rtd->cpu_dai->ops.shutdown(substream);
+ if (cpu_dai->ops.shutdown)
+ cpu_dai->ops.shutdown(substream);
- if (rtd->codec_dai->ops.shutdown)
- rtd->codec_dai->ops.shutdown(substream);
+ if (codec_dai->ops.shutdown)
+ codec_dai->ops.shutdown(substream);
if (machine->ops && machine->ops->shutdown)
machine->ops->shutdown(substream);
if (platform->pcm_ops->close)
platform->pcm_ops->close(substream);
- rtd->cpu_dai->runtime = NULL;
+ cpu_dai->runtime = NULL;
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
/* start delayed pop wq here for playback streams */
- rtd->codec_dai->pop_wait = 1;
+ codec_dai->pop_wait = 1;
schedule_delayed_work(&socdev->delayed_work,
msecs_to_jiffies(pmdown_time));
} else {
/* capture streams can be powered down now */
- snd_soc_dapm_stream_event(codec, rtd->codec_dai->capture.stream_name,
- SND_SOC_DAPM_STREAM_STOP);
+ snd_soc_dapm_stream_event(codec,
+ codec_dai->capture.stream_name, SND_SOC_DAPM_STREAM_STOP);
- if (codec->active == 0 && rtd->codec_dai->pop_wait == 0){
+ if (codec->active == 0 && codec_dai->pop_wait == 0){
if (codec->dapm_event)
codec->dapm_event(codec, SNDRV_CTL_POWER_D3hot);
}
@@ -854,11 +373,23 @@ static int soc_pcm_prepare(struct snd_pcm_substream *substream)
{
struct snd_soc_pcm_runtime *rtd = substream->private_data;
struct snd_soc_device *socdev = rtd->socdev;
+ struct snd_soc_dai_link *machine = rtd->dai;
struct snd_soc_platform *platform = socdev->platform;
+ struct snd_soc_cpu_dai *cpu_dai = machine->cpu_dai;
+ struct snd_soc_codec_dai *codec_dai = machine->codec_dai;
struct snd_soc_codec *codec = socdev->codec;
int ret = 0;
mutex_lock(&pcm_mutex);
+
+ if (machine->ops && machine->ops->prepare) {
+ ret = machine->ops->prepare(substream);
+ if (ret < 0) {
+ printk(KERN_ERR "asoc: machine prepare error\n");
+ goto out;
+ }
+ }
+
if (platform->pcm_ops->prepare) {
ret = platform->pcm_ops->prepare(substream);
if (ret < 0) {
@@ -867,30 +398,35 @@ static int soc_pcm_prepare(struct snd_pcm_substream *substream)
}
}
- if (rtd->codec_dai->ops.prepare) {
- ret = rtd->codec_dai->ops.prepare(substream);
+ if (codec_dai->ops.prepare) {
+ ret = codec_dai->ops.prepare(substream);
if (ret < 0) {
printk(KERN_ERR "asoc: codec DAI prepare error\n");
goto out;
}
}
- if (rtd->cpu_dai->ops.prepare)
- ret = rtd->cpu_dai->ops.prepare(substream);
+ if (cpu_dai->ops.prepare) {
+ ret = cpu_dai->ops.prepare(substream);
+ if (ret < 0) {
+ printk(KERN_ERR "asoc: cpu DAI prepare error\n");
+ goto out;
+ }
+ }
/* we only want to start a DAPM playback stream if we are not waiting
* on an existing one stopping */
- if (rtd->codec_dai->pop_wait) {
+ if (codec_dai->pop_wait) {
/* we are waiting for the delayed work to start */
if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
- snd_soc_dapm_stream_event(codec,
- rtd->codec_dai->capture.stream_name,
+ snd_soc_dapm_stream_event(socdev->codec,
+ codec_dai->capture.stream_name,
SND_SOC_DAPM_STREAM_START);
else {
- rtd->codec_dai->pop_wait = 0;
+ codec_dai->pop_wait = 0;
cancel_delayed_work(&socdev->delayed_work);
- if (rtd->codec_dai->digital_mute)
- rtd->codec_dai->digital_mute(codec, rtd->codec_dai, 0);
+ if (codec_dai->dai_ops.digital_mute)
+ codec_dai->dai_ops.digital_mute(codec_dai, 0);
}
} else {
/* no delayed work - do we need to power up codec */
@@ -901,30 +437,30 @@ static int soc_pcm_prepare(struct snd_pcm_substream *substream)
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
snd_soc_dapm_stream_event(codec,
- rtd->codec_dai->playback.stream_name,
+ codec_dai->playback.stream_name,
SND_SOC_DAPM_STREAM_START);
else
snd_soc_dapm_stream_event(codec,
- rtd->codec_dai->capture.stream_name,
+ codec_dai->capture.stream_name,
SND_SOC_DAPM_STREAM_START);
if (codec->dapm_event)
codec->dapm_event(codec, SNDRV_CTL_POWER_D0);
- if (rtd->codec_dai->digital_mute)
- rtd->codec_dai->digital_mute(codec, rtd->codec_dai, 0);
+ if (codec_dai->dai_ops.digital_mute)
+ codec_dai->dai_ops.digital_mute(codec_dai, 0);
} else {
/* codec already powered - power on widgets */
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
snd_soc_dapm_stream_event(codec,
- rtd->codec_dai->playback.stream_name,
+ codec_dai->playback.stream_name,
SND_SOC_DAPM_STREAM_START);
else
snd_soc_dapm_stream_event(codec,
- rtd->codec_dai->capture.stream_name,
+ codec_dai->capture.stream_name,
SND_SOC_DAPM_STREAM_START);
- if (rtd->codec_dai->digital_mute)
- rtd->codec_dai->digital_mute(codec, rtd->codec_dai, 0);
+ if (codec_dai->dai_ops.digital_mute)
+ codec_dai->dai_ops.digital_mute(codec_dai, 0);
}
}
@@ -943,39 +479,36 @@ static int soc_pcm_hw_params(struct snd_pcm_substream *substream,
{
struct snd_soc_pcm_runtime *rtd = substream->private_data;
struct snd_soc_device *socdev = rtd->socdev;
+ struct snd_soc_dai_link *machine = rtd->dai;
struct snd_soc_platform *platform = socdev->platform;
- struct snd_soc_machine *machine = socdev->machine;
+ struct snd_soc_cpu_dai *cpu_dai = machine->cpu_dai;
+ struct snd_soc_codec_dai *codec_dai = machine->codec_dai;
int ret = 0;
mutex_lock(&pcm_mutex);
- /* we don't need to match any AC97 params */
- if (rtd->cpu_dai->type != SND_SOC_DAI_AC97) {
- ret = soc_hw_match_params(substream, params);
- if (ret < 0)
- goto out;
- } else {
- struct snd_soc_clock_info clk_info;
- clk_info.rate = params_rate(params);
- ret = soc_get_mclk(rtd, &clk_info);
- if (ret < 0)
+ if (machine->ops && machine->ops->hw_params) {
+ ret = machine->ops->hw_params(substream, params);
+ if (ret < 0) {
+ printk(KERN_ERR "asoc: machine hw_params failed\n");
goto out;
+ }
}
- if (rtd->codec_dai->ops.hw_params) {
- ret = rtd->codec_dai->ops.hw_params(substream, params);
+ if (codec_dai->ops.hw_params) {
+ ret = codec_dai->ops.hw_params(substream, params);
if (ret < 0) {
printk(KERN_ERR "asoc: can't set codec %s hw params\n",
- rtd->codec_dai->name);
- goto out;
+ codec_dai->name);
+ goto codec_err;
}
}
- if (rtd->cpu_dai->ops.hw_params) {
- ret = rtd->cpu_dai->ops.hw_params(substream, params);
+ if (cpu_dai->ops.hw_params) {
+ ret = cpu_dai->ops.hw_params(substream, params);
if (ret < 0) {
printk(KERN_ERR "asoc: can't set interface %s hw params\n",
- rtd->cpu_dai->name);
+ cpu_dai->name);
goto interface_err;
}
}
@@ -989,29 +522,21 @@ static int soc_pcm_hw_params(struct snd_pcm_substream *substream,
}
}
- if (machine->ops && machine->ops->hw_params) {
- ret = machine->ops->hw_params(substream, params);
- if (ret < 0) {
- printk(KERN_ERR "asoc: machine hw_params failed\n");
- goto machine_err;
- }
- }
-
out:
mutex_unlock(&pcm_mutex);
return ret;
-machine_err:
- if (platform->pcm_ops->hw_free)
- platform->pcm_ops->hw_free(substream);
-
platform_err:
- if (rtd->cpu_dai->ops.hw_free)
- rtd->cpu_dai->ops.hw_free(substream);
+ if (cpu_dai->ops.hw_free)
+ cpu_dai->ops.hw_free(substream);
interface_err:
- if (rtd->codec_dai->ops.hw_free)
- rtd->codec_dai->ops.hw_free(substream);
+ if (codec_dai->ops.hw_free)
+ codec_dai->ops.hw_free(substream);
+
+codec_err:
+ if(machine->ops && machine->ops->hw_free)
+ machine->ops->hw_free(substream);
mutex_unlock(&pcm_mutex);
return ret;
@@ -1024,15 +549,17 @@ static int soc_pcm_hw_free(struct snd_pcm_substream *substream)
{
struct snd_soc_pcm_runtime *rtd = substream->private_data;
struct snd_soc_device *socdev = rtd->socdev;
+ struct snd_soc_dai_link *machine = rtd->dai;
struct snd_soc_platform *platform = socdev->platform;
+ struct snd_soc_cpu_dai *cpu_dai = machine->cpu_dai;
+ struct snd_soc_codec_dai *codec_dai = machine->codec_dai;
struct snd_soc_codec *codec = socdev->codec;
- struct snd_soc_machine *machine = socdev->machine;
mutex_lock(&pcm_mutex);
/* apply codec digital mute */
- if (!codec->active && rtd->codec_dai->digital_mute)
- rtd->codec_dai->digital_mute(codec, rtd->codec_dai, 1);
+ if (!codec->active && codec_dai->dai_ops.digital_mute)
+ codec_dai->dai_ops.digital_mute(codec_dai, 1);
/* free any machine hw params */
if (machine->ops && machine->ops->hw_free)
@@ -1043,11 +570,11 @@ static int soc_pcm_hw_free(struct snd_pcm_substream *substream)
platform->pcm_ops->hw_free(substream);
/* now free hw params for the DAI's */
- if (rtd->codec_dai->ops.hw_free)
- rtd->codec_dai->ops.hw_free(substream);
+ if (codec_dai->ops.hw_free)
+ codec_dai->ops.hw_free(substream);
- if (rtd->cpu_dai->ops.hw_free)
- rtd->cpu_dai->ops.hw_free(substream);
+ if (cpu_dai->ops.hw_free)
+ cpu_dai->ops.hw_free(substream);
mutex_unlock(&pcm_mutex);
return 0;
@@ -1057,11 +584,14 @@ static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
{
struct snd_soc_pcm_runtime *rtd = substream->private_data;
struct snd_soc_device *socdev = rtd->socdev;
+ struct snd_soc_dai_link *machine = rtd->dai;
struct snd_soc_platform *platform = socdev->platform;
+ struct snd_soc_cpu_dai *cpu_dai = machine->cpu_dai;
+ struct snd_soc_codec_dai *codec_dai = machine->codec_dai;
int ret;
- if (rtd->codec_dai->ops.trigger) {
- ret = rtd->codec_dai->ops.trigger(substream, cmd);
+ if (codec_dai->ops.trigger) {
+ ret = codec_dai->ops.trigger(substream, cmd);
if (ret < 0)
return ret;
}
@@ -1072,8 +602,8 @@ static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
return ret;
}
- if (rtd->cpu_dai->ops.trigger) {
- ret = rtd->cpu_dai->ops.trigger(substream, cmd);
+ if (cpu_dai->ops.trigger) {
+ ret = cpu_dai->ops.trigger(substream, cmd);
if (ret < 0)
return ret;
}
@@ -1104,8 +634,8 @@ static int soc_suspend(struct platform_device *pdev, pm_message_t state)
/* mute any active DAC's */
for(i = 0; i < machine->num_links; i++) {
struct snd_soc_codec_dai *dai = machine->dai_link[i].codec_dai;
- if (dai->digital_mute && dai->playback.active)
- dai->digital_mute(codec, dai, 1);
+ if (dai->dai_ops.digital_mute && dai->playback.active)
+ dai->dai_ops.digital_mute(dai, 1);
}
if (machine->suspend_pre)
@@ -1185,8 +715,8 @@ static int soc_resume(struct platform_device *pdev)
/* unmute any active DAC's */
for(i = 0; i < machine->num_links; i++) {
struct snd_soc_codec_dai *dai = machine->dai_link[i].codec_dai;
- if (dai->digital_mute && dai->playback.active)
- dai->digital_mute(codec, dai, 0);
+ if (dai->dai_ops.digital_mute && dai->playback.active)
+ dai->dai_ops.digital_mute(dai, 0);
}
for(i = 0; i < machine->num_links; i++) {
@@ -1320,9 +850,10 @@ static int soc_new_pcm(struct snd_soc_device *socdev,
rtd = kzalloc(sizeof(struct snd_soc_pcm_runtime), GFP_KERNEL);
if (rtd == NULL)
return -ENOMEM;
- rtd->cpu_dai = cpu_dai;
- rtd->codec_dai = codec_dai;
+
+ rtd->dai = dai_link;
rtd->socdev = socdev;
+ codec_dai->codec = socdev->codec;
/* check client and interface hw capabilities */
sprintf(new_name, "%s %s-%s-%d",dai_link->stream_name, codec_dai->name,
@@ -1499,22 +1030,6 @@ int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
EXPORT_SYMBOL_GPL(snd_soc_test_bits);
/**
- * snd_soc_get_rate - get int sample rate
- * @hwpcmrate: the hardware pcm rate
- *
- * Returns the audio rate integaer value, else 0.
- */
-int snd_soc_get_rate(int hwpcmrate)
-{
- int rate = ffs(hwpcmrate) - 1;
-
- if (rate > ARRAY_SIZE(rates))
- return 0;
- return rates[rate];
-}
-EXPORT_SYMBOL_GPL(snd_soc_get_rate);
-
-/**
* snd_soc_new_pcms - create new sound card and pcms
* @socdev: the SoC audio device
*
generated by cgit v1.2.3-70-g09d2 (git 2.46.0) at 2024-11-16 01:03:05 +0000