mirror of
https://github.com/torvalds/linux.git
synced 2024-11-25 05:32:00 +00:00
ASoC: imx-card: Add imx-card machine driver
Add machine driver for i.MX boards, which supports AK4458/AK5558/AK4497/AK5552 DAC/ADC attached to SAI interface currently, but these DAC/ADCs are not only supported codecs. This machine driver is designed to be a more common machine driver for i.MX platform, it can support widely cpu dai interface and codec dai interface. Signed-off-by: Shengjiu Wang <shengjiu.wang@nxp.com> Signed-off-by: Mihai Serban <mihai.serban@nxp.com> Signed-off-by: Cosmin-Gabriel Samoila <cosmin.samoila@nxp.com> Signed-off-by: Viorel Suman <viorel.suman@nxp.com> Signed-off-by: Daniel Baluta <daniel.baluta@nxp.com> Signed-off-by: Adrian Alonso <adrian.alonso@nxp.com> Link: https://lore.kernel.org/r/1621247488-21412-2-git-send-email-shengjiu.wang@nxp.com Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
parent
623cd9cfca
commit
aa736700f4
@ -350,6 +350,19 @@ config SND_SOC_IMX_RPMSG
|
||||
Say Y if you want to add support for SoC audio on an i.MX board with
|
||||
a rpmsg devices.
|
||||
|
||||
config SND_SOC_IMX_CARD
|
||||
tristate "SoC Audio Graph Sound Card support for i.MX boards"
|
||||
depends on OF && I2C
|
||||
select SND_SOC_AK4458
|
||||
select SND_SOC_AK5558
|
||||
select SND_SOC_IMX_PCM_DMA
|
||||
select SND_SOC_FSL_SAI
|
||||
select SND_SIMPLE_CARD_UTILS
|
||||
help
|
||||
This option enables audio sound card support for i.MX boards
|
||||
with OF-graph DT bindings.
|
||||
It also support DPCM of single CPU multi Codec ststem.
|
||||
|
||||
endif # SND_IMX_SOC
|
||||
|
||||
endmenu
|
||||
|
@ -71,6 +71,7 @@ snd-soc-imx-spdif-objs := imx-spdif.o
|
||||
snd-soc-imx-audmix-objs := imx-audmix.o
|
||||
snd-soc-imx-hdmi-objs := imx-hdmi.o
|
||||
snd-soc-imx-rpmsg-objs := imx-rpmsg.o
|
||||
snd-soc-imx-card-objs := imx-card.o
|
||||
|
||||
obj-$(CONFIG_SND_SOC_EUKREA_TLV320) += snd-soc-eukrea-tlv320.o
|
||||
obj-$(CONFIG_SND_SOC_IMX_ES8328) += snd-soc-imx-es8328.o
|
||||
@ -79,3 +80,4 @@ obj-$(CONFIG_SND_SOC_IMX_SPDIF) += snd-soc-imx-spdif.o
|
||||
obj-$(CONFIG_SND_SOC_IMX_AUDMIX) += snd-soc-imx-audmix.o
|
||||
obj-$(CONFIG_SND_SOC_IMX_HDMI) += snd-soc-imx-hdmi.o
|
||||
obj-$(CONFIG_SND_SOC_IMX_RPMSG) += snd-soc-imx-rpmsg.o
|
||||
obj-$(CONFIG_SND_SOC_IMX_CARD) += snd-soc-imx-card.o
|
||||
|
844
sound/soc/fsl/imx-card.c
Normal file
844
sound/soc/fsl/imx-card.c
Normal file
@ -0,0 +1,844 @@
|
||||
// SPDX-License-Identifier: GPL-2.0+
|
||||
// Copyright 2017-2021 NXP
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/gpio/consumer.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/of_gpio.h>
|
||||
#include <linux/clk.h>
|
||||
#include <sound/soc.h>
|
||||
#include <sound/pcm_params.h>
|
||||
#include <sound/pcm.h>
|
||||
#include <sound/soc-dapm.h>
|
||||
#include <sound/simple_card_utils.h>
|
||||
|
||||
#include "fsl_sai.h"
|
||||
|
||||
enum codec_type {
|
||||
CODEC_DUMMY = 0,
|
||||
CODEC_AK5558 = 1,
|
||||
CODEC_AK4458,
|
||||
CODEC_AK4497,
|
||||
CODEC_AK5552,
|
||||
};
|
||||
|
||||
/*
|
||||
* Mapping LRCK fs and frame width, table 3 & 4 in datasheet
|
||||
* @rmin: min rate
|
||||
* @rmax: max rate
|
||||
* @wmin: min frame ratio
|
||||
* @wmax: max frame ratio
|
||||
*/
|
||||
struct imx_akcodec_fs_mul {
|
||||
unsigned int rmin;
|
||||
unsigned int rmax;
|
||||
unsigned int wmin;
|
||||
unsigned int wmax;
|
||||
};
|
||||
|
||||
/*
|
||||
* Mapping TDM mode and frame width
|
||||
*/
|
||||
struct imx_akcodec_tdm_fs_mul {
|
||||
unsigned int min;
|
||||
unsigned int max;
|
||||
unsigned int mul;
|
||||
};
|
||||
|
||||
/*
|
||||
* struct imx_card_plat_data - specific info for codecs
|
||||
*
|
||||
* @fs_mul: ratio of mclk/fs for normal mode
|
||||
* @tdm_fs_mul: ratio of mclk/fs for tdm mode
|
||||
* @support_rates: supported sample rate
|
||||
* @support_tdm_rates: supported sample rate for tdm mode
|
||||
* @support_channels: supported channels
|
||||
* @support_tdm_channels: supported channels for tdm mode
|
||||
* @num_fs_mul: ARRAY_SIZE of fs_mul
|
||||
* @num_tdm_fs_mul: ARRAY_SIZE of tdm_fs_mul
|
||||
* @num_rates: ARRAY_SIZE of support_rates
|
||||
* @num_tdm_rates: ARRAY_SIZE of support_tdm_rates
|
||||
* @num_channels: ARRAY_SIZE of support_channels
|
||||
* @num_tdm_channels: ARRAY_SIZE of support_tdm_channels
|
||||
* @type: codec type
|
||||
*/
|
||||
struct imx_card_plat_data {
|
||||
struct imx_akcodec_fs_mul *fs_mul;
|
||||
struct imx_akcodec_tdm_fs_mul *tdm_fs_mul;
|
||||
const u32 *support_rates;
|
||||
const u32 *support_tdm_rates;
|
||||
const u32 *support_channels;
|
||||
const u32 *support_tdm_channels;
|
||||
unsigned int num_fs_mul;
|
||||
unsigned int num_tdm_fs_mul;
|
||||
unsigned int num_rates;
|
||||
unsigned int num_tdm_rates;
|
||||
unsigned int num_channels;
|
||||
unsigned int num_tdm_channels;
|
||||
unsigned int num_codecs;
|
||||
enum codec_type type;
|
||||
};
|
||||
|
||||
/*
|
||||
* struct dai_link_data - specific info for dai link
|
||||
*
|
||||
* @slots: slot number
|
||||
* @slot_width: slot width value
|
||||
* @cpu_sysclk_id: sysclk id for cpu dai
|
||||
* @one2one_ratio: true if mclk equal to bclk
|
||||
*/
|
||||
struct dai_link_data {
|
||||
unsigned int slots;
|
||||
unsigned int slot_width;
|
||||
unsigned int cpu_sysclk_id;
|
||||
bool one2one_ratio;
|
||||
};
|
||||
|
||||
/*
|
||||
* struct imx_card_data - platform device data
|
||||
*
|
||||
* @plat_data: pointer of imx_card_plat_data
|
||||
* @dapm_routes: pointer of dapm_routes
|
||||
* @link_data: private data for dai link
|
||||
* @card: card instance
|
||||
* @num_dapm_routes: number of dapm_routes
|
||||
* @asrc_rate: asrc rates
|
||||
* @asrc_format: asrc format
|
||||
*/
|
||||
struct imx_card_data {
|
||||
struct imx_card_plat_data *plat_data;
|
||||
struct snd_soc_dapm_route *dapm_routes;
|
||||
struct dai_link_data *link_data;
|
||||
struct snd_soc_card card;
|
||||
int num_dapm_routes;
|
||||
u32 asrc_rate;
|
||||
u32 asrc_format;
|
||||
};
|
||||
|
||||
struct imx_akcodec_fs_mul ak4458_fs_mul[] = {
|
||||
/* Normal, < 32kHz */
|
||||
{ .rmin = 8000, .rmax = 24000, .wmin = 1024, .wmax = 1024, },
|
||||
/* Normal, 32kHz */
|
||||
{ .rmin = 32000, .rmax = 32000, .wmin = 256, .wmax = 1024, },
|
||||
/* Normal */
|
||||
{ .rmin = 44100, .rmax = 48000, .wmin = 256, .wmax = 768, },
|
||||
/* Double */
|
||||
{ .rmin = 88200, .rmax = 96000, .wmin = 256, .wmax = 512, },
|
||||
/* Quad */
|
||||
{ .rmin = 176400, .rmax = 192000, .wmin = 128, .wmax = 256, },
|
||||
/* Oct */
|
||||
{ .rmin = 352800, .rmax = 384000, .wmin = 32, .wmax = 128, },
|
||||
/* Hex */
|
||||
{ .rmin = 705600, .rmax = 768000, .wmin = 16, .wmax = 64, },
|
||||
};
|
||||
|
||||
struct imx_akcodec_tdm_fs_mul ak4458_tdm_fs_mul[] = {
|
||||
/*
|
||||
* Table 13 - Audio Interface Format
|
||||
* For TDM mode, MCLK should is set to
|
||||
* obtained from 2 * slots * slot_width
|
||||
*/
|
||||
{ .min = 128, .max = 128, .mul = 256 }, /* TDM128 */
|
||||
{ .min = 256, .max = 256, .mul = 512 }, /* TDM256 */
|
||||
{ .min = 512, .max = 512, .mul = 1024 }, /* TDM512 */
|
||||
};
|
||||
|
||||
struct imx_akcodec_fs_mul ak4497_fs_mul[] = {
|
||||
/**
|
||||
* Table 7 - mapping multiplier and speed mode
|
||||
* Tables 8 & 9 - mapping speed mode and LRCK fs
|
||||
*/
|
||||
{ .rmin = 8000, .rmax = 32000, .wmin = 1024, .wmax = 1024, }, /* Normal, <= 32kHz */
|
||||
{ .rmin = 44100, .rmax = 48000, .wmin = 512, .wmax = 512, }, /* Normal */
|
||||
{ .rmin = 88200, .rmax = 96000, .wmin = 256, .wmax = 256, }, /* Double */
|
||||
{ .rmin = 176400, .rmax = 192000, .wmin = 128, .wmax = 128, }, /* Quad */
|
||||
{ .rmin = 352800, .rmax = 384000, .wmin = 128, .wmax = 128, }, /* Oct */
|
||||
{ .rmin = 705600, .rmax = 768000, .wmin = 64, .wmax = 64, }, /* Hex */
|
||||
};
|
||||
|
||||
/*
|
||||
* Auto MCLK selection based on LRCK for Normal Mode
|
||||
* (Table 4 from datasheet)
|
||||
*/
|
||||
struct imx_akcodec_fs_mul ak5558_fs_mul[] = {
|
||||
{ .rmin = 8000, .rmax = 32000, .wmin = 1024, .wmax = 1024, },
|
||||
{ .rmin = 44100, .rmax = 48000, .wmin = 512, .wmax = 512, },
|
||||
{ .rmin = 88200, .rmax = 96000, .wmin = 256, .wmax = 256, },
|
||||
{ .rmin = 176400, .rmax = 192000, .wmin = 128, .wmax = 128, },
|
||||
{ .rmin = 352800, .rmax = 384000, .wmin = 64, .wmax = 64, },
|
||||
{ .rmin = 705600, .rmax = 768000, .wmin = 32, .wmax = 32, },
|
||||
};
|
||||
|
||||
/*
|
||||
* MCLK and BCLK selection based on TDM mode
|
||||
* because of SAI we also add the restriction: MCLK >= 2 * BCLK
|
||||
* (Table 9 from datasheet)
|
||||
*/
|
||||
struct imx_akcodec_tdm_fs_mul ak5558_tdm_fs_mul[] = {
|
||||
{ .min = 128, .max = 128, .mul = 256 },
|
||||
{ .min = 256, .max = 256, .mul = 512 },
|
||||
{ .min = 512, .max = 512, .mul = 1024 },
|
||||
};
|
||||
|
||||
static const u32 akcodec_rates[] = {
|
||||
8000, 11025, 16000, 22050, 32000, 44100, 48000, 88200,
|
||||
96000, 176400, 192000, 352800, 384000, 705600, 768000,
|
||||
};
|
||||
|
||||
static const u32 akcodec_tdm_rates[] = {
|
||||
8000, 16000, 32000, 48000, 96000,
|
||||
};
|
||||
|
||||
static const u32 ak4458_channels[] = {
|
||||
1, 2, 4, 6, 8, 10, 12, 14, 16,
|
||||
};
|
||||
|
||||
static const u32 ak4458_tdm_channels[] = {
|
||||
1, 2, 3, 4, 5, 6, 7, 8, 16,
|
||||
};
|
||||
|
||||
static const u32 ak5558_channels[] = {
|
||||
1, 2, 4, 6, 8,
|
||||
};
|
||||
|
||||
static const u32 ak5558_tdm_channels[] = {
|
||||
1, 2, 3, 4, 5, 6, 7, 8,
|
||||
};
|
||||
|
||||
static bool format_is_dsd(struct snd_pcm_hw_params *params)
|
||||
{
|
||||
snd_pcm_format_t format = params_format(params);
|
||||
|
||||
switch (format) {
|
||||
case SNDRV_PCM_FORMAT_DSD_U8:
|
||||
case SNDRV_PCM_FORMAT_DSD_U16_LE:
|
||||
case SNDRV_PCM_FORMAT_DSD_U16_BE:
|
||||
case SNDRV_PCM_FORMAT_DSD_U32_LE:
|
||||
case SNDRV_PCM_FORMAT_DSD_U32_BE:
|
||||
return true;
|
||||
default:
|
||||
return false;
|
||||
}
|
||||
}
|
||||
|
||||
static bool format_is_tdm(struct dai_link_data *link_data)
|
||||
{
|
||||
if (link_data->slots > 2)
|
||||
return true;
|
||||
else
|
||||
return false;
|
||||
}
|
||||
|
||||
static bool codec_is_akcodec(unsigned int type)
|
||||
{
|
||||
switch (type) {
|
||||
case CODEC_AK4458:
|
||||
case CODEC_AK4497:
|
||||
case CODEC_AK5558:
|
||||
case CODEC_AK5552:
|
||||
return true;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
static unsigned long akcodec_get_mclk_rate(struct snd_pcm_substream *substream,
|
||||
struct snd_pcm_hw_params *params)
|
||||
{
|
||||
struct snd_soc_pcm_runtime *rtd = substream->private_data;
|
||||
struct imx_card_data *data = snd_soc_card_get_drvdata(rtd->card);
|
||||
const struct imx_card_plat_data *plat_data = data->plat_data;
|
||||
struct dai_link_data *link_data = &data->link_data[rtd->num];
|
||||
unsigned int width = link_data->slots * link_data->slot_width;
|
||||
unsigned int rate = params_rate(params);
|
||||
int i;
|
||||
|
||||
if (format_is_tdm(link_data)) {
|
||||
for (i = 0; i < plat_data->num_tdm_fs_mul; i++) {
|
||||
/* min = max = slots * slots_width */
|
||||
if (width != plat_data->tdm_fs_mul[i].min)
|
||||
continue;
|
||||
return rate * plat_data->tdm_fs_mul[i].mul;
|
||||
}
|
||||
} else {
|
||||
for (i = 0; i < plat_data->num_fs_mul; i++) {
|
||||
if (rate >= plat_data->fs_mul[i].rmin &&
|
||||
rate <= plat_data->fs_mul[i].rmax) {
|
||||
width = max(width, plat_data->fs_mul[i].wmin);
|
||||
width = min(width, plat_data->fs_mul[i].wmax);
|
||||
|
||||
/* Adjust SAI bclk:mclk ratio */
|
||||
width *= link_data->one2one_ratio ? 1 : 2;
|
||||
|
||||
return rate * width;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* Let DAI manage clk frequency by default */
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int imx_aif_hw_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 *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
||||
struct snd_soc_card *card = rtd->card;
|
||||
struct imx_card_data *data = snd_soc_card_get_drvdata(card);
|
||||
struct dai_link_data *link_data = &data->link_data[rtd->num];
|
||||
struct imx_card_plat_data *plat_data = data->plat_data;
|
||||
struct device *dev = card->dev;
|
||||
struct snd_soc_dai *codec_dai;
|
||||
unsigned long mclk_freq;
|
||||
unsigned int fmt = rtd->dai_link->dai_fmt;
|
||||
unsigned int slots, slot_width;
|
||||
int ret, i;
|
||||
|
||||
slots = link_data->slots;
|
||||
slot_width = link_data->slot_width;
|
||||
|
||||
if (!format_is_tdm(link_data)) {
|
||||
if (format_is_dsd(params)) {
|
||||
slots = 1;
|
||||
slot_width = params_width(params);
|
||||
fmt = (rtd->dai_link->dai_fmt & ~SND_SOC_DAIFMT_FORMAT_MASK) |
|
||||
SND_SOC_DAIFMT_PDM;
|
||||
} else {
|
||||
slots = 2;
|
||||
slot_width = params_physical_width(params);
|
||||
fmt = (rtd->dai_link->dai_fmt & ~SND_SOC_DAIFMT_FORMAT_MASK) |
|
||||
SND_SOC_DAIFMT_I2S;
|
||||
}
|
||||
}
|
||||
|
||||
ret = snd_soc_dai_set_fmt(cpu_dai, fmt);
|
||||
if (ret && ret != -ENOTSUPP) {
|
||||
dev_err(dev, "failed to set cpu dai fmt: %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
ret = snd_soc_dai_set_tdm_slot(cpu_dai,
|
||||
BIT(slots) - 1,
|
||||
BIT(slots) - 1,
|
||||
slots, slot_width);
|
||||
if (ret && ret != -ENOTSUPP) {
|
||||
dev_err(dev, "failed to set cpu dai tdm slot: %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
for_each_rtd_codec_dais(rtd, i, codec_dai) {
|
||||
ret = snd_soc_dai_set_fmt(codec_dai, fmt);
|
||||
if (ret && ret != -ENOTSUPP) {
|
||||
dev_err(dev, "failed to set codec dai[%d] fmt: %d\n", i, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = snd_soc_dai_set_tdm_slot(codec_dai,
|
||||
BIT(slots) - 1,
|
||||
BIT(slots) - 1,
|
||||
slots, slot_width);
|
||||
if (ret && ret != -ENOTSUPP) {
|
||||
dev_err(dev, "failed to set codec dai[%d] tdm slot: %d\n", i, ret);
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
/* Set MCLK freq */
|
||||
if (codec_is_akcodec(plat_data->type))
|
||||
mclk_freq = akcodec_get_mclk_rate(substream, params);
|
||||
else
|
||||
mclk_freq = params_rate(params) * slots * slot_width;
|
||||
/* Use the maximum freq from DSD512 (512*44100 = 22579200) */
|
||||
if (format_is_dsd(params))
|
||||
mclk_freq = 22579200;
|
||||
|
||||
ret = snd_soc_dai_set_sysclk(cpu_dai, link_data->cpu_sysclk_id, mclk_freq,
|
||||
SND_SOC_CLOCK_OUT);
|
||||
if (ret && ret != -ENOTSUPP) {
|
||||
dev_err(dev, "failed to set cpui dai mclk1 rate (%lu): %d\n", mclk_freq, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ak5558_hw_rule_rate(struct snd_pcm_hw_params *p, struct snd_pcm_hw_rule *r)
|
||||
{
|
||||
struct dai_link_data *link_data = r->private;
|
||||
struct snd_interval t = { .min = 8000, .max = 8000, };
|
||||
unsigned long mclk_freq;
|
||||
unsigned int fs;
|
||||
int i;
|
||||
|
||||
fs = hw_param_interval(p, SNDRV_PCM_HW_PARAM_SAMPLE_BITS)->min;
|
||||
fs *= link_data->slots;
|
||||
|
||||
/* Identify maximum supported rate */
|
||||
for (i = 0; i < ARRAY_SIZE(akcodec_rates); i++) {
|
||||
mclk_freq = fs * akcodec_rates[i];
|
||||
/* Adjust SAI bclk:mclk ratio */
|
||||
mclk_freq *= link_data->one2one_ratio ? 1 : 2;
|
||||
|
||||
/* Skip rates for which MCLK is beyond supported value */
|
||||
if (mclk_freq > 36864000)
|
||||
continue;
|
||||
|
||||
if (t.max < akcodec_rates[i])
|
||||
t.max = akcodec_rates[i];
|
||||
}
|
||||
|
||||
return snd_interval_refine(hw_param_interval(p, r->var), &t);
|
||||
}
|
||||
|
||||
static int imx_aif_startup(struct snd_pcm_substream *substream)
|
||||
{
|
||||
struct snd_pcm_runtime *runtime = substream->runtime;
|
||||
struct snd_soc_pcm_runtime *rtd = substream->private_data;
|
||||
struct snd_soc_card *card = rtd->card;
|
||||
struct imx_card_data *data = snd_soc_card_get_drvdata(card);
|
||||
struct dai_link_data *link_data = &data->link_data[rtd->num];
|
||||
static struct snd_pcm_hw_constraint_list constraint_rates;
|
||||
static struct snd_pcm_hw_constraint_list constraint_channels;
|
||||
int ret = 0;
|
||||
|
||||
if (format_is_tdm(link_data)) {
|
||||
constraint_channels.list = data->plat_data->support_tdm_channels;
|
||||
constraint_channels.count = data->plat_data->num_tdm_channels;
|
||||
constraint_rates.list = data->plat_data->support_tdm_rates;
|
||||
constraint_rates.count = data->plat_data->num_tdm_rates;
|
||||
} else {
|
||||
constraint_channels.list = data->plat_data->support_channels;
|
||||
constraint_channels.count = data->plat_data->num_channels;
|
||||
constraint_rates.list = data->plat_data->support_rates;
|
||||
constraint_rates.count = data->plat_data->num_rates;
|
||||
}
|
||||
|
||||
if (constraint_channels.count) {
|
||||
ret = snd_pcm_hw_constraint_list(runtime, 0,
|
||||
SNDRV_PCM_HW_PARAM_CHANNELS,
|
||||
&constraint_channels);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (constraint_rates.count) {
|
||||
ret = snd_pcm_hw_constraint_list(runtime, 0,
|
||||
SNDRV_PCM_HW_PARAM_RATE,
|
||||
&constraint_rates);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (data->plat_data->type == CODEC_AK5558)
|
||||
ret = snd_pcm_hw_rule_add(substream->runtime, 0,
|
||||
SNDRV_PCM_HW_PARAM_RATE,
|
||||
ak5558_hw_rule_rate, link_data,
|
||||
SNDRV_PCM_HW_PARAM_SAMPLE_BITS, -1);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static struct snd_soc_ops imx_aif_ops = {
|
||||
.hw_params = imx_aif_hw_params,
|
||||
.startup = imx_aif_startup,
|
||||
};
|
||||
|
||||
static struct snd_soc_ops imx_aif_ops_be = {
|
||||
.hw_params = imx_aif_hw_params,
|
||||
};
|
||||
|
||||
static int be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd,
|
||||
struct snd_pcm_hw_params *params)
|
||||
{
|
||||
struct snd_soc_card *card = rtd->card;
|
||||
struct imx_card_data *data = snd_soc_card_get_drvdata(card);
|
||||
struct snd_interval *rate;
|
||||
struct snd_mask *mask;
|
||||
|
||||
rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
|
||||
rate->max = data->asrc_rate;
|
||||
rate->min = data->asrc_rate;
|
||||
|
||||
mask = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
|
||||
snd_mask_none(mask);
|
||||
snd_mask_set(mask, data->asrc_format);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int imx_card_parse_of(struct imx_card_data *data)
|
||||
{
|
||||
struct imx_card_plat_data *plat_data = data->plat_data;
|
||||
struct snd_soc_card *card = &data->card;
|
||||
struct snd_soc_dai_link_component *dlc;
|
||||
struct device_node *platform = NULL;
|
||||
struct device_node *codec = NULL;
|
||||
struct device_node *cpu = NULL;
|
||||
struct device_node *np;
|
||||
struct device *dev = card->dev;
|
||||
struct snd_soc_dai_link *link;
|
||||
struct dai_link_data *link_data;
|
||||
struct of_phandle_args args;
|
||||
int ret, num_links;
|
||||
u32 width;
|
||||
|
||||
ret = snd_soc_of_parse_card_name(card, "model");
|
||||
if (ret) {
|
||||
dev_err(dev, "Error parsing card name: %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* DAPM routes */
|
||||
if (of_property_read_bool(dev->of_node, "audio-routing")) {
|
||||
ret = snd_soc_of_parse_audio_routing(card, "audio-routing");
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Populate links */
|
||||
num_links = of_get_child_count(dev->of_node);
|
||||
|
||||
/* Allocate the DAI link array */
|
||||
card->dai_link = devm_kcalloc(dev, num_links, sizeof(*link), GFP_KERNEL);
|
||||
if (!card->dai_link)
|
||||
return -ENOMEM;
|
||||
|
||||
data->link_data = devm_kcalloc(dev, num_links, sizeof(*link), GFP_KERNEL);
|
||||
if (!data->link_data)
|
||||
return -ENOMEM;
|
||||
|
||||
card->num_links = num_links;
|
||||
link = card->dai_link;
|
||||
link_data = data->link_data;
|
||||
|
||||
for_each_child_of_node(dev->of_node, np) {
|
||||
dlc = devm_kzalloc(dev, 2 * sizeof(*dlc), GFP_KERNEL);
|
||||
if (!dlc) {
|
||||
ret = -ENOMEM;
|
||||
goto err_put_np;
|
||||
}
|
||||
|
||||
link->cpus = &dlc[0];
|
||||
link->platforms = &dlc[1];
|
||||
|
||||
link->num_cpus = 1;
|
||||
link->num_platforms = 1;
|
||||
|
||||
ret = of_property_read_string(np, "link-name", &link->name);
|
||||
if (ret) {
|
||||
dev_err(card->dev, "error getting codec dai_link name\n");
|
||||
goto err_put_np;
|
||||
}
|
||||
|
||||
cpu = of_get_child_by_name(np, "cpu");
|
||||
if (!cpu) {
|
||||
dev_err(dev, "%s: Can't find cpu DT node\n", link->name);
|
||||
ret = -EINVAL;
|
||||
goto err;
|
||||
}
|
||||
|
||||
ret = of_parse_phandle_with_args(cpu, "sound-dai",
|
||||
"#sound-dai-cells", 0, &args);
|
||||
if (ret) {
|
||||
dev_err(card->dev, "%s: error getting cpu phandle\n", link->name);
|
||||
goto err;
|
||||
}
|
||||
|
||||
if (of_node_name_eq(args.np, "sai")) {
|
||||
/* sai sysclk id */
|
||||
link_data->cpu_sysclk_id = FSL_SAI_CLK_MAST1;
|
||||
|
||||
/* sai may support mclk/bclk = 1 */
|
||||
if (of_find_property(np, "fsl,mclk-equal-bclk", NULL))
|
||||
link_data->one2one_ratio = true;
|
||||
}
|
||||
|
||||
link->cpus->of_node = args.np;
|
||||
link->platforms->of_node = link->cpus->of_node;
|
||||
link->id = args.args[0];
|
||||
|
||||
ret = snd_soc_of_get_dai_name(cpu, &link->cpus->dai_name);
|
||||
if (ret) {
|
||||
if (ret != -EPROBE_DEFER)
|
||||
dev_err(card->dev, "%s: error getting cpu dai name: %d\n",
|
||||
link->name, ret);
|
||||
goto err;
|
||||
}
|
||||
|
||||
codec = of_get_child_by_name(np, "codec");
|
||||
if (codec) {
|
||||
ret = snd_soc_of_get_dai_link_codecs(dev, codec, link);
|
||||
if (ret < 0) {
|
||||
if (ret != -EPROBE_DEFER)
|
||||
dev_err(dev, "%s: codec dai not found: %d\n",
|
||||
link->name, ret);
|
||||
goto err;
|
||||
}
|
||||
|
||||
plat_data->num_codecs = link->num_codecs;
|
||||
|
||||
/* Check the akcodec type */
|
||||
if (!strcmp(link->codecs->dai_name, "ak4458-aif"))
|
||||
plat_data->type = CODEC_AK4458;
|
||||
else if (!strcmp(link->codecs->dai_name, "ak4497-aif"))
|
||||
plat_data->type = CODEC_AK4497;
|
||||
else if (!strcmp(link->codecs->dai_name, "ak5558-aif"))
|
||||
plat_data->type = CODEC_AK5558;
|
||||
else if (!strcmp(link->codecs->dai_name, "ak5552-aif"))
|
||||
plat_data->type = CODEC_AK5552;
|
||||
|
||||
} else {
|
||||
dlc = devm_kzalloc(dev, sizeof(*dlc), GFP_KERNEL);
|
||||
if (!dlc) {
|
||||
ret = -ENOMEM;
|
||||
goto err;
|
||||
}
|
||||
|
||||
link->codecs = dlc;
|
||||
link->num_codecs = 1;
|
||||
|
||||
link->codecs->dai_name = "snd-soc-dummy-dai";
|
||||
link->codecs->name = "snd-soc-dummy";
|
||||
}
|
||||
|
||||
if (!strncmp(link->name, "HiFi-ASRC-FE", 12)) {
|
||||
/* DPCM frontend */
|
||||
link->dynamic = 1;
|
||||
link->dpcm_merged_chan = 1;
|
||||
|
||||
ret = of_property_read_u32(args.np, "fsl,asrc-rate", &data->asrc_rate);
|
||||
if (ret) {
|
||||
dev_err(dev, "failed to get output rate\n");
|
||||
ret = -EINVAL;
|
||||
goto err;
|
||||
}
|
||||
|
||||
ret = of_property_read_u32(args.np, "fsl,asrc-format", &data->asrc_format);
|
||||
if (ret) {
|
||||
/* Fallback to old binding; translate to asrc_format */
|
||||
ret = of_property_read_u32(args.np, "fsl,asrc-width", &width);
|
||||
if (ret) {
|
||||
dev_err(dev,
|
||||
"failed to decide output format\n");
|
||||
goto err;
|
||||
}
|
||||
|
||||
if (width == 24)
|
||||
data->asrc_format = SNDRV_PCM_FORMAT_S24_LE;
|
||||
else
|
||||
data->asrc_format = SNDRV_PCM_FORMAT_S16_LE;
|
||||
}
|
||||
} else if (!strncmp(link->name, "HiFi-ASRC-BE", 12)) {
|
||||
/* DPCM backend */
|
||||
link->no_pcm = 1;
|
||||
link->platforms->of_node = NULL;
|
||||
link->platforms->name = "snd-soc-dummy";
|
||||
|
||||
link->be_hw_params_fixup = be_hw_params_fixup;
|
||||
link->ops = &imx_aif_ops_be;
|
||||
} else {
|
||||
link->ops = &imx_aif_ops;
|
||||
}
|
||||
|
||||
if (link->no_pcm || link->dynamic)
|
||||
snd_soc_dai_link_set_capabilities(link);
|
||||
|
||||
/* Get dai fmt */
|
||||
ret = asoc_simple_parse_daifmt(dev, np, codec,
|
||||
NULL, &link->dai_fmt);
|
||||
if (ret)
|
||||
link->dai_fmt = SND_SOC_DAIFMT_NB_NF |
|
||||
SND_SOC_DAIFMT_CBS_CFS |
|
||||
SND_SOC_DAIFMT_I2S;
|
||||
|
||||
/* Get tdm slot */
|
||||
snd_soc_of_parse_tdm_slot(np, NULL, NULL,
|
||||
&link_data->slots,
|
||||
&link_data->slot_width);
|
||||
/* default value */
|
||||
if (!link_data->slots)
|
||||
link_data->slots = 2;
|
||||
|
||||
if (!link_data->slot_width)
|
||||
link_data->slot_width = 32;
|
||||
|
||||
link->ignore_pmdown_time = 1;
|
||||
link->stream_name = link->name;
|
||||
link++;
|
||||
link_data++;
|
||||
|
||||
of_node_put(cpu);
|
||||
of_node_put(codec);
|
||||
of_node_put(platform);
|
||||
}
|
||||
|
||||
return 0;
|
||||
err:
|
||||
of_node_put(cpu);
|
||||
of_node_put(codec);
|
||||
of_node_put(platform);
|
||||
err_put_np:
|
||||
of_node_put(np);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int imx_card_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct snd_soc_dai_link *link_be = NULL, *link;
|
||||
struct imx_card_plat_data *plat_data;
|
||||
struct imx_card_data *data;
|
||||
int ret, i;
|
||||
|
||||
data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
|
||||
if (!data)
|
||||
return -ENOMEM;
|
||||
|
||||
plat_data = devm_kzalloc(&pdev->dev, sizeof(*plat_data), GFP_KERNEL);
|
||||
if (!plat_data)
|
||||
return -ENOMEM;
|
||||
|
||||
data->plat_data = plat_data;
|
||||
data->card.dev = &pdev->dev;
|
||||
|
||||
dev_set_drvdata(&pdev->dev, &data->card);
|
||||
snd_soc_card_set_drvdata(&data->card, data);
|
||||
ret = imx_card_parse_of(data);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
data->num_dapm_routes = plat_data->num_codecs + 1;
|
||||
data->dapm_routes = devm_kcalloc(&pdev->dev, data->num_dapm_routes,
|
||||
sizeof(struct snd_soc_dapm_route),
|
||||
GFP_KERNEL);
|
||||
if (!data->dapm_routes)
|
||||
return -ENOMEM;
|
||||
|
||||
/* configure the dapm routes */
|
||||
switch (plat_data->type) {
|
||||
case CODEC_AK4458:
|
||||
case CODEC_AK4497:
|
||||
if (plat_data->num_codecs == 1) {
|
||||
data->dapm_routes[0].sink = "Playback";
|
||||
data->dapm_routes[0].source = "CPU-Playback";
|
||||
i = 1;
|
||||
} else {
|
||||
for (i = 0; i < plat_data->num_codecs; i++) {
|
||||
data->dapm_routes[i].sink =
|
||||
devm_kasprintf(&pdev->dev, GFP_KERNEL, "%d %s",
|
||||
i + 1, "Playback");
|
||||
data->dapm_routes[i].source = "CPU-Playback";
|
||||
}
|
||||
}
|
||||
data->dapm_routes[i].sink = "CPU-Playback";
|
||||
data->dapm_routes[i].source = "ASRC-Playback";
|
||||
break;
|
||||
case CODEC_AK5558:
|
||||
case CODEC_AK5552:
|
||||
if (plat_data->num_codecs == 1) {
|
||||
data->dapm_routes[0].sink = "CPU-Capture";
|
||||
data->dapm_routes[0].source = "Capture";
|
||||
i = 1;
|
||||
} else {
|
||||
for (i = 0; i < plat_data->num_codecs; i++) {
|
||||
data->dapm_routes[i].source =
|
||||
devm_kasprintf(&pdev->dev, GFP_KERNEL, "%d %s",
|
||||
i + 1, "Capture");
|
||||
data->dapm_routes[i].sink = "CPU-Capture";
|
||||
}
|
||||
}
|
||||
data->dapm_routes[i].sink = "ASRC-Capture";
|
||||
data->dapm_routes[i].source = "CPU-Capture";
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
/* default platform data for akcodecs */
|
||||
if (codec_is_akcodec(plat_data->type)) {
|
||||
plat_data->support_rates = akcodec_rates;
|
||||
plat_data->num_rates = ARRAY_SIZE(akcodec_rates);
|
||||
plat_data->support_tdm_rates = akcodec_tdm_rates;
|
||||
plat_data->num_tdm_rates = ARRAY_SIZE(akcodec_tdm_rates);
|
||||
|
||||
switch (plat_data->type) {
|
||||
case CODEC_AK4458:
|
||||
plat_data->fs_mul = ak4458_fs_mul;
|
||||
plat_data->num_fs_mul = ARRAY_SIZE(ak4458_fs_mul);
|
||||
plat_data->tdm_fs_mul = ak4458_tdm_fs_mul;
|
||||
plat_data->num_tdm_fs_mul = ARRAY_SIZE(ak4458_tdm_fs_mul);
|
||||
plat_data->support_channels = ak4458_channels;
|
||||
plat_data->num_channels = ARRAY_SIZE(ak4458_channels);
|
||||
plat_data->support_tdm_channels = ak4458_tdm_channels;
|
||||
plat_data->num_tdm_channels = ARRAY_SIZE(ak4458_tdm_channels);
|
||||
break;
|
||||
case CODEC_AK4497:
|
||||
plat_data->fs_mul = ak4497_fs_mul;
|
||||
plat_data->num_fs_mul = ARRAY_SIZE(ak4497_fs_mul);
|
||||
plat_data->support_channels = ak4458_channels;
|
||||
plat_data->num_channels = ARRAY_SIZE(ak4458_channels);
|
||||
break;
|
||||
case CODEC_AK5558:
|
||||
case CODEC_AK5552:
|
||||
plat_data->fs_mul = ak5558_fs_mul;
|
||||
plat_data->num_fs_mul = ARRAY_SIZE(ak5558_fs_mul);
|
||||
plat_data->tdm_fs_mul = ak5558_tdm_fs_mul;
|
||||
plat_data->num_tdm_fs_mul = ARRAY_SIZE(ak5558_tdm_fs_mul);
|
||||
plat_data->support_channels = ak5558_channels;
|
||||
plat_data->num_channels = ARRAY_SIZE(ak5558_channels);
|
||||
plat_data->support_tdm_channels = ak5558_tdm_channels;
|
||||
plat_data->num_tdm_channels = ARRAY_SIZE(ak5558_tdm_channels);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* with asrc as front end */
|
||||
if (data->card.num_links == 3) {
|
||||
data->card.dapm_routes = data->dapm_routes;
|
||||
data->card.num_dapm_routes = data->num_dapm_routes;
|
||||
for_each_card_prelinks(&data->card, i, link) {
|
||||
if (link->no_pcm == 1)
|
||||
link_be = link;
|
||||
}
|
||||
for_each_card_prelinks(&data->card, i, link) {
|
||||
if (link->dynamic == 1 && link_be) {
|
||||
link->dpcm_playback = link_be->dpcm_playback;
|
||||
link->dpcm_capture = link_be->dpcm_capture;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
ret = devm_snd_soc_register_card(&pdev->dev, &data->card);
|
||||
if (ret) {
|
||||
if (ret != -EPROBE_DEFER)
|
||||
dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id imx_card_dt_ids[] = {
|
||||
{ .compatible = "fsl,imx-audio-card", },
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, imx_card_dt_ids);
|
||||
|
||||
static struct platform_driver imx_card_driver = {
|
||||
.driver = {
|
||||
.name = "imx-card",
|
||||
.pm = &snd_soc_pm_ops,
|
||||
.of_match_table = imx_card_dt_ids,
|
||||
},
|
||||
.probe = imx_card_probe,
|
||||
};
|
||||
module_platform_driver(imx_card_driver);
|
||||
|
||||
MODULE_DESCRIPTION("Freescale i.MX ASoC Machine Driver");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_ALIAS("platform:imx-card");
|
Loading…
Reference in New Issue
Block a user