Skip to content

L
linux
Commit cb666e5b authored by Liam Girdwood's avatar Liam Girdwood Committed by Jaroslav Kysela
Browse files
Options

[ALSA] soc - ASoC 0.13 core changes 

This patch updates the ASoC core to the new DAI matching and clocking
API in version 0.13
Changes:-
 o Removed DAI capabilities matching code in favour of manual matching
in the machine drivers.
 o Added DAI operations for codec and CPU interfaces.
 o Removed config_sysclk() function and struct snd_soc_clock_info. No
longer needed as clocking is now configured manually in the machine
drivers. Also removed other clocking data from structures.
 o Added machine driver prepare callback.
Signed-off-by: default avatarLiam Girdwood <lg@opensource.wolfsonmicro.com>
Signed-off-by: default avatarTakashi Iwai <tiwai@suse.de>
Signed-off-by: default avatarJaroslav Kysela <perex@suse.cz>
parent 1c433fbd
Hide whitespace changes
Inline Side-by-side
Showing with 148 additions and 633 deletions
sound/soc/soc-core.c
View file @ cb666e5b
......@@ -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,
......@@ -1498,22 +1029,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
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7