mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-09-12 13:55:32 +00:00
![Uwe Kleine-König](/assets/img/avatar_default.png)
The .remove() callback for a platform driver returns an int which makes many driver authors wrongly assume it's possible to do error handling by returning an error code. However the value returned is (mostly) ignored and this typically results in resource leaks. To improve here there is a quest to make the remove callback return void. In the first step of this quest all drivers are converted to .remove_new() which already returns void. Trivially convert this driver from always returning zero in the remove callback to the void returning variant. Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de> Acked-by: Ban Tao <fengzheng923@gmail.com> Acked-by: Jernej Skrabec <jernej.skrabec@gmail.com> Acked-by: Takashi Iwai <tiwai@suse.de> Acked-by: Nicolas Ferre <nicolas.ferre@microchip.com> Link: https://lore.kernel.org/r/20230315150745.67084-144-u.kleine-koenig@pengutronix.de Signed-off-by: Mark Brown <broonie@kernel.org>
403 lines
11 KiB
C
403 lines
11 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
//
|
|
// This driver supports the DMIC in Allwinner's H6 SoCs.
|
|
//
|
|
// Copyright 2021 Ban Tao <fengzheng923@gmail.com>
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/device.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/reset.h>
|
|
#include <sound/dmaengine_pcm.h>
|
|
#include <sound/pcm_params.h>
|
|
#include <sound/soc.h>
|
|
|
|
#define SUN50I_DMIC_EN_CTL (0x00)
|
|
#define SUN50I_DMIC_EN_CTL_GLOBE BIT(8)
|
|
#define SUN50I_DMIC_EN_CTL_CHAN(v) ((v) << 0)
|
|
#define SUN50I_DMIC_EN_CTL_CHAN_MASK GENMASK(7, 0)
|
|
#define SUN50I_DMIC_SR (0x04)
|
|
#define SUN50I_DMIC_SR_SAMPLE_RATE(v) ((v) << 0)
|
|
#define SUN50I_DMIC_SR_SAMPLE_RATE_MASK GENMASK(2, 0)
|
|
#define SUN50I_DMIC_CTL (0x08)
|
|
#define SUN50I_DMIC_CTL_OVERSAMPLE_RATE BIT(0)
|
|
#define SUN50I_DMIC_DATA (0x10)
|
|
#define SUN50I_DMIC_INTC (0x14)
|
|
#define SUN50I_DMIC_FIFO_DRQ_EN BIT(2)
|
|
#define SUN50I_DMIC_INT_STA (0x18)
|
|
#define SUN50I_DMIC_INT_STA_OVERRUN_IRQ_PENDING BIT(1)
|
|
#define SUN50I_DMIC_INT_STA_DATA_IRQ_PENDING BIT(0)
|
|
#define SUN50I_DMIC_RXFIFO_CTL (0x1c)
|
|
#define SUN50I_DMIC_RXFIFO_CTL_FLUSH BIT(31)
|
|
#define SUN50I_DMIC_RXFIFO_CTL_MODE_MASK BIT(9)
|
|
#define SUN50I_DMIC_RXFIFO_CTL_MODE_LSB (0 << 9)
|
|
#define SUN50I_DMIC_RXFIFO_CTL_MODE_MSB (1 << 9)
|
|
#define SUN50I_DMIC_RXFIFO_CTL_SAMPLE_MASK BIT(8)
|
|
#define SUN50I_DMIC_RXFIFO_CTL_SAMPLE_16 (0 << 8)
|
|
#define SUN50I_DMIC_RXFIFO_CTL_SAMPLE_24 (1 << 8)
|
|
#define SUN50I_DMIC_CH_NUM (0x24)
|
|
#define SUN50I_DMIC_CH_NUM_N(v) ((v) << 0)
|
|
#define SUN50I_DMIC_CH_NUM_N_MASK GENMASK(2, 0)
|
|
#define SUN50I_DMIC_CNT (0x2c)
|
|
#define SUN50I_DMIC_CNT_N (1 << 0)
|
|
#define SUN50I_DMIC_HPF_CTRL (0x38)
|
|
#define SUN50I_DMIC_VERSION (0x50)
|
|
|
|
struct sun50i_dmic_dev {
|
|
struct clk *dmic_clk;
|
|
struct clk *bus_clk;
|
|
struct reset_control *rst;
|
|
struct regmap *regmap;
|
|
struct snd_dmaengine_dai_dma_data dma_params_rx;
|
|
};
|
|
|
|
struct dmic_rate {
|
|
unsigned int samplerate;
|
|
unsigned int rate_bit;
|
|
};
|
|
|
|
static const struct dmic_rate dmic_rate_s[] = {
|
|
{48000, 0x0},
|
|
{44100, 0x0},
|
|
{32000, 0x1},
|
|
{24000, 0x2},
|
|
{22050, 0x2},
|
|
{16000, 0x3},
|
|
{12000, 0x4},
|
|
{11025, 0x4},
|
|
{8000, 0x5},
|
|
};
|
|
|
|
static int sun50i_dmic_startup(struct snd_pcm_substream *substream,
|
|
struct snd_soc_dai *cpu_dai)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = substream->private_data;
|
|
struct sun50i_dmic_dev *host = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
|
|
|
|
/* only support capture */
|
|
if (substream->stream != SNDRV_PCM_STREAM_CAPTURE)
|
|
return -EINVAL;
|
|
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_RXFIFO_CTL,
|
|
SUN50I_DMIC_RXFIFO_CTL_FLUSH,
|
|
SUN50I_DMIC_RXFIFO_CTL_FLUSH);
|
|
regmap_write(host->regmap, SUN50I_DMIC_CNT, SUN50I_DMIC_CNT_N);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sun50i_dmic_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *params,
|
|
struct snd_soc_dai *cpu_dai)
|
|
{
|
|
int i = 0;
|
|
unsigned long rate = params_rate(params);
|
|
unsigned int mclk = 0;
|
|
unsigned int channels = params_channels(params);
|
|
unsigned int chan_en = (1 << channels) - 1;
|
|
struct sun50i_dmic_dev *host = snd_soc_dai_get_drvdata(cpu_dai);
|
|
|
|
/* DMIC num is N+1 */
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_CH_NUM,
|
|
SUN50I_DMIC_CH_NUM_N_MASK,
|
|
SUN50I_DMIC_CH_NUM_N(channels - 1));
|
|
regmap_write(host->regmap, SUN50I_DMIC_HPF_CTRL, chan_en);
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_EN_CTL,
|
|
SUN50I_DMIC_EN_CTL_CHAN_MASK,
|
|
SUN50I_DMIC_EN_CTL_CHAN(chan_en));
|
|
|
|
switch (params_format(params)) {
|
|
case SNDRV_PCM_FORMAT_S16_LE:
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_RXFIFO_CTL,
|
|
SUN50I_DMIC_RXFIFO_CTL_SAMPLE_MASK,
|
|
SUN50I_DMIC_RXFIFO_CTL_SAMPLE_16);
|
|
break;
|
|
case SNDRV_PCM_FORMAT_S24_LE:
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_RXFIFO_CTL,
|
|
SUN50I_DMIC_RXFIFO_CTL_SAMPLE_MASK,
|
|
SUN50I_DMIC_RXFIFO_CTL_SAMPLE_24);
|
|
break;
|
|
default:
|
|
dev_err(cpu_dai->dev, "Invalid format!\n");
|
|
return -EINVAL;
|
|
}
|
|
/* The hardware supports FIFO mode 1 for 24-bit samples */
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_RXFIFO_CTL,
|
|
SUN50I_DMIC_RXFIFO_CTL_MODE_MASK,
|
|
SUN50I_DMIC_RXFIFO_CTL_MODE_MSB);
|
|
|
|
switch (rate) {
|
|
case 11025:
|
|
case 22050:
|
|
case 44100:
|
|
mclk = 22579200;
|
|
break;
|
|
case 8000:
|
|
case 12000:
|
|
case 16000:
|
|
case 24000:
|
|
case 32000:
|
|
case 48000:
|
|
mclk = 24576000;
|
|
break;
|
|
default:
|
|
dev_err(cpu_dai->dev, "Invalid rate!\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (clk_set_rate(host->dmic_clk, mclk)) {
|
|
dev_err(cpu_dai->dev, "mclk : %u not support\n", mclk);
|
|
return -EINVAL;
|
|
}
|
|
|
|
for (i = 0; i < ARRAY_SIZE(dmic_rate_s); i++) {
|
|
if (dmic_rate_s[i].samplerate == rate) {
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_SR,
|
|
SUN50I_DMIC_SR_SAMPLE_RATE_MASK,
|
|
SUN50I_DMIC_SR_SAMPLE_RATE(dmic_rate_s[i].rate_bit));
|
|
break;
|
|
}
|
|
}
|
|
|
|
switch (params_physical_width(params)) {
|
|
case 16:
|
|
host->dma_params_rx.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES;
|
|
break;
|
|
case 32:
|
|
host->dma_params_rx.addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
|
|
break;
|
|
default:
|
|
dev_err(cpu_dai->dev, "Unsupported physical sample width: %d\n",
|
|
params_physical_width(params));
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* oversamplerate adjust */
|
|
if (params_rate(params) >= 24000)
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_CTL,
|
|
SUN50I_DMIC_CTL_OVERSAMPLE_RATE,
|
|
SUN50I_DMIC_CTL_OVERSAMPLE_RATE);
|
|
else
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_CTL,
|
|
SUN50I_DMIC_CTL_OVERSAMPLE_RATE, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sun50i_dmic_trigger(struct snd_pcm_substream *substream, int cmd,
|
|
struct snd_soc_dai *dai)
|
|
{
|
|
int ret = 0;
|
|
struct sun50i_dmic_dev *host = snd_soc_dai_get_drvdata(dai);
|
|
|
|
if (substream->stream != SNDRV_PCM_STREAM_CAPTURE)
|
|
return -EINVAL;
|
|
|
|
switch (cmd) {
|
|
case SNDRV_PCM_TRIGGER_START:
|
|
case SNDRV_PCM_TRIGGER_RESUME:
|
|
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
|
/* DRQ ENABLE */
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_INTC,
|
|
SUN50I_DMIC_FIFO_DRQ_EN,
|
|
SUN50I_DMIC_FIFO_DRQ_EN);
|
|
/* Global enable */
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_EN_CTL,
|
|
SUN50I_DMIC_EN_CTL_GLOBE,
|
|
SUN50I_DMIC_EN_CTL_GLOBE);
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
|
case SNDRV_PCM_TRIGGER_SUSPEND:
|
|
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
|
/* DRQ DISABLE */
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_INTC,
|
|
SUN50I_DMIC_FIFO_DRQ_EN, 0);
|
|
/* Global disable */
|
|
regmap_update_bits(host->regmap, SUN50I_DMIC_EN_CTL,
|
|
SUN50I_DMIC_EN_CTL_GLOBE, 0);
|
|
break;
|
|
default:
|
|
ret = -EINVAL;
|
|
break;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static int sun50i_dmic_soc_dai_probe(struct snd_soc_dai *dai)
|
|
{
|
|
struct sun50i_dmic_dev *host = snd_soc_dai_get_drvdata(dai);
|
|
|
|
snd_soc_dai_init_dma_data(dai, NULL, &host->dma_params_rx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct snd_soc_dai_ops sun50i_dmic_dai_ops = {
|
|
.startup = sun50i_dmic_startup,
|
|
.trigger = sun50i_dmic_trigger,
|
|
.hw_params = sun50i_dmic_hw_params,
|
|
};
|
|
|
|
static const struct regmap_config sun50i_dmic_regmap_config = {
|
|
.reg_bits = 32,
|
|
.reg_stride = 4,
|
|
.val_bits = 32,
|
|
.max_register = SUN50I_DMIC_VERSION,
|
|
.cache_type = REGCACHE_NONE,
|
|
};
|
|
|
|
#define SUN50I_DMIC_RATES (SNDRV_PCM_RATE_8000_48000)
|
|
#define SUN50I_DMIC_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE)
|
|
|
|
static struct snd_soc_dai_driver sun50i_dmic_dai = {
|
|
.capture = {
|
|
.channels_min = 1,
|
|
.channels_max = 8,
|
|
.rates = SUN50I_DMIC_RATES,
|
|
.formats = SUN50I_DMIC_FORMATS,
|
|
.sig_bits = 21,
|
|
},
|
|
.probe = sun50i_dmic_soc_dai_probe,
|
|
.ops = &sun50i_dmic_dai_ops,
|
|
.name = "dmic",
|
|
};
|
|
|
|
static const struct of_device_id sun50i_dmic_of_match[] = {
|
|
{
|
|
.compatible = "allwinner,sun50i-h6-dmic",
|
|
},
|
|
{ /* sentinel */ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, sun50i_dmic_of_match);
|
|
|
|
static const struct snd_soc_component_driver sun50i_dmic_component = {
|
|
.name = "sun50i-dmic",
|
|
};
|
|
|
|
static int sun50i_dmic_runtime_suspend(struct device *dev)
|
|
{
|
|
struct sun50i_dmic_dev *host = dev_get_drvdata(dev);
|
|
|
|
clk_disable_unprepare(host->dmic_clk);
|
|
clk_disable_unprepare(host->bus_clk);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sun50i_dmic_runtime_resume(struct device *dev)
|
|
{
|
|
struct sun50i_dmic_dev *host = dev_get_drvdata(dev);
|
|
int ret;
|
|
|
|
ret = clk_prepare_enable(host->dmic_clk);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = clk_prepare_enable(host->bus_clk);
|
|
if (ret) {
|
|
clk_disable_unprepare(host->dmic_clk);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sun50i_dmic_probe(struct platform_device *pdev)
|
|
{
|
|
struct sun50i_dmic_dev *host;
|
|
struct resource *res;
|
|
int ret;
|
|
void __iomem *base;
|
|
|
|
host = devm_kzalloc(&pdev->dev, sizeof(*host), GFP_KERNEL);
|
|
if (!host)
|
|
return -ENOMEM;
|
|
|
|
/* Get the addresses */
|
|
base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);
|
|
if (IS_ERR(base))
|
|
return dev_err_probe(&pdev->dev, PTR_ERR(base),
|
|
"get resource failed.\n");
|
|
|
|
host->regmap = devm_regmap_init_mmio(&pdev->dev, base,
|
|
&sun50i_dmic_regmap_config);
|
|
|
|
/* Clocks */
|
|
host->bus_clk = devm_clk_get(&pdev->dev, "bus");
|
|
if (IS_ERR(host->bus_clk))
|
|
return dev_err_probe(&pdev->dev, PTR_ERR(host->bus_clk),
|
|
"failed to get bus clock.\n");
|
|
|
|
host->dmic_clk = devm_clk_get(&pdev->dev, "mod");
|
|
if (IS_ERR(host->dmic_clk))
|
|
return dev_err_probe(&pdev->dev, PTR_ERR(host->dmic_clk),
|
|
"failed to get dmic clock.\n");
|
|
|
|
host->dma_params_rx.addr = res->start + SUN50I_DMIC_DATA;
|
|
host->dma_params_rx.maxburst = 8;
|
|
|
|
platform_set_drvdata(pdev, host);
|
|
|
|
host->rst = devm_reset_control_get_optional_exclusive(&pdev->dev, NULL);
|
|
if (IS_ERR(host->rst))
|
|
return dev_err_probe(&pdev->dev, PTR_ERR(host->rst),
|
|
"Failed to get reset.\n");
|
|
reset_control_deassert(host->rst);
|
|
|
|
ret = devm_snd_soc_register_component(&pdev->dev, &sun50i_dmic_component,
|
|
&sun50i_dmic_dai, 1);
|
|
if (ret)
|
|
return dev_err_probe(&pdev->dev, ret,
|
|
"failed to register component.\n");
|
|
|
|
pm_runtime_enable(&pdev->dev);
|
|
if (!pm_runtime_enabled(&pdev->dev)) {
|
|
ret = sun50i_dmic_runtime_resume(&pdev->dev);
|
|
if (ret)
|
|
goto err_disable_runtime_pm;
|
|
}
|
|
|
|
ret = devm_snd_dmaengine_pcm_register(&pdev->dev, NULL, 0);
|
|
if (ret)
|
|
goto err_suspend;
|
|
|
|
return 0;
|
|
err_suspend:
|
|
if (!pm_runtime_status_suspended(&pdev->dev))
|
|
sun50i_dmic_runtime_suspend(&pdev->dev);
|
|
err_disable_runtime_pm:
|
|
pm_runtime_disable(&pdev->dev);
|
|
return ret;
|
|
}
|
|
|
|
static void sun50i_dmic_remove(struct platform_device *pdev)
|
|
{
|
|
pm_runtime_disable(&pdev->dev);
|
|
if (!pm_runtime_status_suspended(&pdev->dev))
|
|
sun50i_dmic_runtime_suspend(&pdev->dev);
|
|
}
|
|
|
|
static const struct dev_pm_ops sun50i_dmic_pm = {
|
|
SET_RUNTIME_PM_OPS(sun50i_dmic_runtime_suspend,
|
|
sun50i_dmic_runtime_resume, NULL)
|
|
};
|
|
|
|
static struct platform_driver sun50i_dmic_driver = {
|
|
.driver = {
|
|
.name = "sun50i-dmic",
|
|
.of_match_table = sun50i_dmic_of_match,
|
|
.pm = &sun50i_dmic_pm,
|
|
},
|
|
.probe = sun50i_dmic_probe,
|
|
.remove_new = sun50i_dmic_remove,
|
|
};
|
|
|
|
module_platform_driver(sun50i_dmic_driver);
|
|
|
|
MODULE_DESCRIPTION("Allwinner sun50i DMIC SoC Interface");
|
|
MODULE_AUTHOR("Ban Tao <fengzheng923@gmail.com>");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_ALIAS("platform:sun50i-dmic");
|