353 lines
8.8 KiB
C
353 lines
8.8 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
|
/*
|
||
|
|
* MediaTek ALSA SoC Audio DAI PCM I/F Control
|
||
|
|
*
|
||
|
|
* Copyright (c) 2020 MediaTek Inc.
|
||
|
|
* Author: Bicycle Tsai <bicycle.tsai@mediatek.com>
|
||
|
|
* Trevor Wu <trevor.wu@mediatek.com>
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/regmap.h>
|
||
|
|
#include <sound/pcm_params.h>
|
||
|
|
#include "mt8195-afe-clk.h"
|
||
|
|
#include "mt8195-afe-common.h"
|
||
|
|
#include "mt8195-reg.h"
|
||
|
|
|
||
|
|
enum {
|
||
|
|
MTK_DAI_PCM_FMT_I2S,
|
||
|
|
MTK_DAI_PCM_FMT_EIAJ,
|
||
|
|
MTK_DAI_PCM_FMT_MODEA,
|
||
|
|
MTK_DAI_PCM_FMT_MODEB,
|
||
|
|
};
|
||
|
|
|
||
|
|
enum {
|
||
|
|
MTK_DAI_PCM_CLK_A1SYS,
|
||
|
|
MTK_DAI_PCM_CLK_A2SYS,
|
||
|
|
MTK_DAI_PCM_CLK_26M_48K,
|
||
|
|
MTK_DAI_PCM_CLK_26M_441K,
|
||
|
|
};
|
||
|
|
|
||
|
|
struct mtk_dai_pcm_rate {
|
||
|
|
unsigned int rate;
|
||
|
|
unsigned int reg_value;
|
||
|
|
};
|
||
|
|
|
||
|
|
struct mtk_dai_pcmif_priv {
|
||
|
|
unsigned int slave_mode;
|
||
|
|
unsigned int lrck_inv;
|
||
|
|
unsigned int bck_inv;
|
||
|
|
unsigned int format;
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct mtk_dai_pcm_rate mtk_dai_pcm_rates[] = {
|
||
|
|
{ .rate = 8000, .reg_value = 0, },
|
||
|
|
{ .rate = 16000, .reg_value = 1, },
|
||
|
|
{ .rate = 32000, .reg_value = 2, },
|
||
|
|
{ .rate = 48000, .reg_value = 3, },
|
||
|
|
{ .rate = 11025, .reg_value = 1, },
|
||
|
|
{ .rate = 22050, .reg_value = 2, },
|
||
|
|
{ .rate = 44100, .reg_value = 3, },
|
||
|
|
};
|
||
|
|
|
||
|
|
static int mtk_dai_pcm_mode(unsigned int rate)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
|
||
|
|
for (i = 0; i < ARRAY_SIZE(mtk_dai_pcm_rates); i++)
|
||
|
|
if (mtk_dai_pcm_rates[i].rate == rate)
|
||
|
|
return mtk_dai_pcm_rates[i].reg_value;
|
||
|
|
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct snd_kcontrol_new mtk_dai_pcm_o000_mix[] = {
|
||
|
|
SOC_DAPM_SINGLE_AUTODISABLE("I000 Switch", AFE_CONN0, 0, 1, 0),
|
||
|
|
SOC_DAPM_SINGLE_AUTODISABLE("I070 Switch", AFE_CONN0_2, 6, 1, 0),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct snd_kcontrol_new mtk_dai_pcm_o001_mix[] = {
|
||
|
|
SOC_DAPM_SINGLE_AUTODISABLE("I001 Switch", AFE_CONN1, 1, 1, 0),
|
||
|
|
SOC_DAPM_SINGLE_AUTODISABLE("I071 Switch", AFE_CONN1_2, 7, 1, 0),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct snd_soc_dapm_widget mtk_dai_pcm_widgets[] = {
|
||
|
|
SND_SOC_DAPM_MIXER("I002", SND_SOC_NOPM, 0, 0, NULL, 0),
|
||
|
|
SND_SOC_DAPM_MIXER("I003", SND_SOC_NOPM, 0, 0, NULL, 0),
|
||
|
|
SND_SOC_DAPM_MIXER("O000", SND_SOC_NOPM, 0, 0,
|
||
|
|
mtk_dai_pcm_o000_mix,
|
||
|
|
ARRAY_SIZE(mtk_dai_pcm_o000_mix)),
|
||
|
|
SND_SOC_DAPM_MIXER("O001", SND_SOC_NOPM, 0, 0,
|
||
|
|
mtk_dai_pcm_o001_mix,
|
||
|
|
ARRAY_SIZE(mtk_dai_pcm_o001_mix)),
|
||
|
|
|
||
|
|
SND_SOC_DAPM_SUPPLY("PCM_EN", PCM_INTF_CON1,
|
||
|
|
PCM_INTF_CON1_PCM_EN_SHIFT, 0, NULL, 0),
|
||
|
|
|
||
|
|
SND_SOC_DAPM_INPUT("PCM1_INPUT"),
|
||
|
|
SND_SOC_DAPM_OUTPUT("PCM1_OUTPUT"),
|
||
|
|
|
||
|
|
SND_SOC_DAPM_CLOCK_SUPPLY("aud_asrc11"),
|
||
|
|
SND_SOC_DAPM_CLOCK_SUPPLY("aud_asrc12"),
|
||
|
|
SND_SOC_DAPM_CLOCK_SUPPLY("aud_pcmif"),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct snd_soc_dapm_route mtk_dai_pcm_routes[] = {
|
||
|
|
{"I002", NULL, "PCM1 Capture"},
|
||
|
|
{"I003", NULL, "PCM1 Capture"},
|
||
|
|
|
||
|
|
{"O000", "I000 Switch", "I000"},
|
||
|
|
{"O001", "I001 Switch", "I001"},
|
||
|
|
|
||
|
|
{"O000", "I070 Switch", "I070"},
|
||
|
|
{"O001", "I071 Switch", "I071"},
|
||
|
|
|
||
|
|
{"PCM1 Playback", NULL, "O000"},
|
||
|
|
{"PCM1 Playback", NULL, "O001"},
|
||
|
|
|
||
|
|
{"PCM1 Playback", NULL, "PCM_EN"},
|
||
|
|
{"PCM1 Playback", NULL, "aud_asrc12"},
|
||
|
|
{"PCM1 Playback", NULL, "aud_pcmif"},
|
||
|
|
|
||
|
|
{"PCM1 Capture", NULL, "PCM_EN"},
|
||
|
|
{"PCM1 Capture", NULL, "aud_asrc11"},
|
||
|
|
{"PCM1 Capture", NULL, "aud_pcmif"},
|
||
|
|
|
||
|
|
{"PCM1_OUTPUT", NULL, "PCM1 Playback"},
|
||
|
|
{"PCM1 Capture", NULL, "PCM1_INPUT"},
|
||
|
|
};
|
||
|
|
|
||
|
|
static int mtk_dai_pcm_configure(struct snd_pcm_substream *substream,
|
||
|
|
struct snd_soc_dai *dai)
|
||
|
|
{
|
||
|
|
struct snd_pcm_runtime * const runtime = substream->runtime;
|
||
|
|
struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
|
||
|
|
struct mt8195_afe_private *afe_priv = afe->platform_priv;
|
||
|
|
struct mtk_dai_pcmif_priv *pcmif_priv = afe_priv->dai_priv[dai->id];
|
||
|
|
unsigned int slave_mode = pcmif_priv->slave_mode;
|
||
|
|
unsigned int lrck_inv = pcmif_priv->lrck_inv;
|
||
|
|
unsigned int bck_inv = pcmif_priv->bck_inv;
|
||
|
|
unsigned int fmt = pcmif_priv->format;
|
||
|
|
unsigned int bit_width = dai->sample_bits;
|
||
|
|
unsigned int val = 0;
|
||
|
|
unsigned int mask = 0;
|
||
|
|
int fs = 0;
|
||
|
|
int mode = 0;
|
||
|
|
|
||
|
|
/* sync freq mode */
|
||
|
|
fs = mt8195_afe_fs_timing(runtime->rate);
|
||
|
|
if (fs < 0)
|
||
|
|
return -EINVAL;
|
||
|
|
val |= PCM_INTF_CON2_SYNC_FREQ_MODE(fs);
|
||
|
|
mask |= PCM_INTF_CON2_SYNC_FREQ_MODE_MASK;
|
||
|
|
|
||
|
|
/* clk domain sel */
|
||
|
|
if (runtime->rate % 8000)
|
||
|
|
val |= PCM_INTF_CON2_CLK_DOMAIN_SEL(MTK_DAI_PCM_CLK_26M_441K);
|
||
|
|
else
|
||
|
|
val |= PCM_INTF_CON2_CLK_DOMAIN_SEL(MTK_DAI_PCM_CLK_26M_48K);
|
||
|
|
mask |= PCM_INTF_CON2_CLK_DOMAIN_SEL_MASK;
|
||
|
|
|
||
|
|
regmap_update_bits(afe->regmap, PCM_INTF_CON2, mask, val);
|
||
|
|
|
||
|
|
val = 0;
|
||
|
|
mask = 0;
|
||
|
|
|
||
|
|
/* pcm mode */
|
||
|
|
mode = mtk_dai_pcm_mode(runtime->rate);
|
||
|
|
if (mode < 0)
|
||
|
|
return -EINVAL;
|
||
|
|
val |= PCM_INTF_CON1_PCM_MODE(mode);
|
||
|
|
mask |= PCM_INTF_CON1_PCM_MODE_MASK;
|
||
|
|
|
||
|
|
/* pcm format */
|
||
|
|
val |= PCM_INTF_CON1_PCM_FMT(fmt);
|
||
|
|
mask |= PCM_INTF_CON1_PCM_FMT_MASK;
|
||
|
|
|
||
|
|
/* pcm sync length */
|
||
|
|
if (fmt == MTK_DAI_PCM_FMT_MODEA ||
|
||
|
|
fmt == MTK_DAI_PCM_FMT_MODEB)
|
||
|
|
val |= PCM_INTF_CON1_SYNC_LENGTH(1);
|
||
|
|
else
|
||
|
|
val |= PCM_INTF_CON1_SYNC_LENGTH(bit_width);
|
||
|
|
mask |= PCM_INTF_CON1_SYNC_LENGTH_MASK;
|
||
|
|
|
||
|
|
/* pcm bits, word length */
|
||
|
|
if (bit_width > 16) {
|
||
|
|
val |= PCM_INTF_CON1_PCM_24BIT;
|
||
|
|
val |= PCM_INTF_CON1_PCM_WLEN_64BCK;
|
||
|
|
} else {
|
||
|
|
val |= PCM_INTF_CON1_PCM_16BIT;
|
||
|
|
val |= PCM_INTF_CON1_PCM_WLEN_32BCK;
|
||
|
|
}
|
||
|
|
mask |= PCM_INTF_CON1_PCM_BIT_MASK;
|
||
|
|
mask |= PCM_INTF_CON1_PCM_WLEN_MASK;
|
||
|
|
|
||
|
|
/* master/slave */
|
||
|
|
if (!slave_mode) {
|
||
|
|
val |= PCM_INTF_CON1_PCM_MASTER;
|
||
|
|
|
||
|
|
if (lrck_inv)
|
||
|
|
val |= PCM_INTF_CON1_SYNC_OUT_INV;
|
||
|
|
if (bck_inv)
|
||
|
|
val |= PCM_INTF_CON1_BCLK_OUT_INV;
|
||
|
|
mask |= PCM_INTF_CON1_CLK_OUT_INV_MASK;
|
||
|
|
} else {
|
||
|
|
val |= PCM_INTF_CON1_PCM_SLAVE;
|
||
|
|
|
||
|
|
if (lrck_inv)
|
||
|
|
val |= PCM_INTF_CON1_SYNC_IN_INV;
|
||
|
|
if (bck_inv)
|
||
|
|
val |= PCM_INTF_CON1_BCLK_IN_INV;
|
||
|
|
mask |= PCM_INTF_CON1_CLK_IN_INV_MASK;
|
||
|
|
|
||
|
|
/* TODO: add asrc setting for slave mode */
|
||
|
|
}
|
||
|
|
mask |= PCM_INTF_CON1_PCM_M_S_MASK;
|
||
|
|
|
||
|
|
regmap_update_bits(afe->regmap, PCM_INTF_CON1, mask, val);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* dai ops */
|
||
|
|
static int mtk_dai_pcm_prepare(struct snd_pcm_substream *substream,
|
||
|
|
struct snd_soc_dai *dai)
|
||
|
|
{
|
||
|
|
dev_dbg(dai->dev, "%s(), id %d, stream %d, widget active p %d, c %d\n",
|
||
|
|
__func__, dai->id, substream->stream,
|
||
|
|
dai->playback_widget->active, dai->capture_widget->active);
|
||
|
|
|
||
|
|
if (dai->playback_widget->active || dai->capture_widget->active)
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
return mtk_dai_pcm_configure(substream, dai);
|
||
|
|
}
|
||
|
|
|
||
|
|
static int mtk_dai_pcm_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
|
||
|
|
{
|
||
|
|
struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
|
||
|
|
struct mt8195_afe_private *afe_priv = afe->platform_priv;
|
||
|
|
struct mtk_dai_pcmif_priv *pcmif_priv = afe_priv->dai_priv[dai->id];
|
||
|
|
|
||
|
|
dev_dbg(dai->dev, "%s fmt 0x%x\n", __func__, fmt);
|
||
|
|
|
||
|
|
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
||
|
|
case SND_SOC_DAIFMT_I2S:
|
||
|
|
pcmif_priv->format = MTK_DAI_PCM_FMT_I2S;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_DSP_A:
|
||
|
|
pcmif_priv->format = MTK_DAI_PCM_FMT_MODEA;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_DSP_B:
|
||
|
|
pcmif_priv->format = MTK_DAI_PCM_FMT_MODEB;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
|
||
|
|
case SND_SOC_DAIFMT_NB_NF:
|
||
|
|
pcmif_priv->bck_inv = 0;
|
||
|
|
pcmif_priv->lrck_inv = 0;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_NB_IF:
|
||
|
|
pcmif_priv->bck_inv = 0;
|
||
|
|
pcmif_priv->lrck_inv = 1;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_IB_NF:
|
||
|
|
pcmif_priv->bck_inv = 1;
|
||
|
|
pcmif_priv->lrck_inv = 0;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_IB_IF:
|
||
|
|
pcmif_priv->bck_inv = 1;
|
||
|
|
pcmif_priv->lrck_inv = 1;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
|
||
|
|
case SND_SOC_DAIFMT_BC_FC:
|
||
|
|
pcmif_priv->slave_mode = 1;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_BP_FP:
|
||
|
|
pcmif_priv->slave_mode = 0;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct snd_soc_dai_ops mtk_dai_pcm_ops = {
|
||
|
|
.prepare = mtk_dai_pcm_prepare,
|
||
|
|
.set_fmt = mtk_dai_pcm_set_fmt,
|
||
|
|
};
|
||
|
|
|
||
|
|
/* dai driver */
|
||
|
|
#define MTK_PCM_RATES (SNDRV_PCM_RATE_8000_48000)
|
||
|
|
|
||
|
|
#define MTK_PCM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
|
||
|
|
SNDRV_PCM_FMTBIT_S24_LE |\
|
||
|
|
SNDRV_PCM_FMTBIT_S32_LE)
|
||
|
|
|
||
|
|
static struct snd_soc_dai_driver mtk_dai_pcm_driver[] = {
|
||
|
|
{
|
||
|
|
.name = "PCM1",
|
||
|
|
.id = MT8195_AFE_IO_PCM,
|
||
|
|
.playback = {
|
||
|
|
.stream_name = "PCM1 Playback",
|
||
|
|
.channels_min = 1,
|
||
|
|
.channels_max = 2,
|
||
|
|
.rates = MTK_PCM_RATES,
|
||
|
|
.formats = MTK_PCM_FORMATS,
|
||
|
|
},
|
||
|
|
.capture = {
|
||
|
|
.stream_name = "PCM1 Capture",
|
||
|
|
.channels_min = 1,
|
||
|
|
.channels_max = 2,
|
||
|
|
.rates = MTK_PCM_RATES,
|
||
|
|
.formats = MTK_PCM_FORMATS,
|
||
|
|
},
|
||
|
|
.ops = &mtk_dai_pcm_ops,
|
||
|
|
.symmetric_rate = 1,
|
||
|
|
.symmetric_sample_bits = 1,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static int init_pcmif_priv_data(struct mtk_base_afe *afe)
|
||
|
|
{
|
||
|
|
struct mt8195_afe_private *afe_priv = afe->platform_priv;
|
||
|
|
struct mtk_dai_pcmif_priv *pcmif_priv;
|
||
|
|
|
||
|
|
pcmif_priv = devm_kzalloc(afe->dev, sizeof(struct mtk_dai_pcmif_priv),
|
||
|
|
GFP_KERNEL);
|
||
|
|
if (!pcmif_priv)
|
||
|
|
return -ENOMEM;
|
||
|
|
|
||
|
|
afe_priv->dai_priv[MT8195_AFE_IO_PCM] = pcmif_priv;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int mt8195_dai_pcm_register(struct mtk_base_afe *afe)
|
||
|
|
{
|
||
|
|
struct mtk_base_afe_dai *dai;
|
||
|
|
|
||
|
|
dai = devm_kzalloc(afe->dev, sizeof(*dai), GFP_KERNEL);
|
||
|
|
if (!dai)
|
||
|
|
return -ENOMEM;
|
||
|
|
|
||
|
|
list_add(&dai->list, &afe->sub_dais);
|
||
|
|
|
||
|
|
dai->dai_drivers = mtk_dai_pcm_driver;
|
||
|
|
dai->num_dai_drivers = ARRAY_SIZE(mtk_dai_pcm_driver);
|
||
|
|
|
||
|
|
dai->dapm_widgets = mtk_dai_pcm_widgets;
|
||
|
|
dai->num_dapm_widgets = ARRAY_SIZE(mtk_dai_pcm_widgets);
|
||
|
|
dai->dapm_routes = mtk_dai_pcm_routes;
|
||
|
|
dai->num_dapm_routes = ARRAY_SIZE(mtk_dai_pcm_routes);
|
||
|
|
|
||
|
|
return init_pcmif_priv_data(afe);
|
||
|
|
}
|