mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-12 21:44:06 +08:00
711c5b4e36
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: Takashi Iwai <tiwai@suse.de> Acked-by: Nicolas Ferre <nicolas.ferre@microchip.com> Link: https://lore.kernel.org/r/20230315150745.67084-14-u.kleine-koenig@pengutronix.de Signed-off-by: Mark Brown <broonie@kernel.org>
303 lines
7.3 KiB
C
303 lines
7.3 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Copyright (C) 2012-2013, Analog Devices Inc.
|
|
* Author: Lars-Peter Clausen <lars@metafoo.de>
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/init.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/slab.h>
|
|
|
|
#include <sound/core.h>
|
|
#include <sound/pcm.h>
|
|
#include <sound/pcm_params.h>
|
|
#include <sound/soc.h>
|
|
#include <sound/dmaengine_pcm.h>
|
|
|
|
#define AXI_I2S_REG_RESET 0x00
|
|
#define AXI_I2S_REG_CTRL 0x04
|
|
#define AXI_I2S_REG_CLK_CTRL 0x08
|
|
#define AXI_I2S_REG_STATUS 0x10
|
|
|
|
#define AXI_I2S_REG_RX_FIFO 0x28
|
|
#define AXI_I2S_REG_TX_FIFO 0x2C
|
|
|
|
#define AXI_I2S_RESET_GLOBAL BIT(0)
|
|
#define AXI_I2S_RESET_TX_FIFO BIT(1)
|
|
#define AXI_I2S_RESET_RX_FIFO BIT(2)
|
|
|
|
#define AXI_I2S_CTRL_TX_EN BIT(0)
|
|
#define AXI_I2S_CTRL_RX_EN BIT(1)
|
|
|
|
/* The frame size is configurable, but for now we always set it 64 bit */
|
|
#define AXI_I2S_BITS_PER_FRAME 64
|
|
|
|
struct axi_i2s {
|
|
struct regmap *regmap;
|
|
struct clk *clk;
|
|
struct clk *clk_ref;
|
|
|
|
bool has_capture;
|
|
bool has_playback;
|
|
|
|
struct snd_soc_dai_driver dai_driver;
|
|
|
|
struct snd_dmaengine_dai_dma_data capture_dma_data;
|
|
struct snd_dmaengine_dai_dma_data playback_dma_data;
|
|
|
|
struct snd_ratnum ratnum;
|
|
struct snd_pcm_hw_constraint_ratnums rate_constraints;
|
|
};
|
|
|
|
static int axi_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
|
|
struct snd_soc_dai *dai)
|
|
{
|
|
struct axi_i2s *i2s = snd_soc_dai_get_drvdata(dai);
|
|
unsigned int mask, val;
|
|
|
|
if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
|
|
mask = AXI_I2S_CTRL_RX_EN;
|
|
else
|
|
mask = AXI_I2S_CTRL_TX_EN;
|
|
|
|
switch (cmd) {
|
|
case SNDRV_PCM_TRIGGER_START:
|
|
case SNDRV_PCM_TRIGGER_RESUME:
|
|
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
|
val = mask;
|
|
break;
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
|
case SNDRV_PCM_TRIGGER_SUSPEND:
|
|
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
|
val = 0;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
regmap_update_bits(i2s->regmap, AXI_I2S_REG_CTRL, mask, val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int axi_i2s_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
|
|
{
|
|
struct axi_i2s *i2s = snd_soc_dai_get_drvdata(dai);
|
|
unsigned int bclk_div, word_size;
|
|
unsigned int bclk_rate;
|
|
|
|
bclk_rate = params_rate(params) * AXI_I2S_BITS_PER_FRAME;
|
|
|
|
word_size = AXI_I2S_BITS_PER_FRAME / 2 - 1;
|
|
bclk_div = DIV_ROUND_UP(clk_get_rate(i2s->clk_ref), bclk_rate) / 2 - 1;
|
|
|
|
regmap_write(i2s->regmap, AXI_I2S_REG_CLK_CTRL, (word_size << 16) |
|
|
bclk_div);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int axi_i2s_startup(struct snd_pcm_substream *substream,
|
|
struct snd_soc_dai *dai)
|
|
{
|
|
struct axi_i2s *i2s = snd_soc_dai_get_drvdata(dai);
|
|
uint32_t mask;
|
|
int ret;
|
|
|
|
if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
|
|
mask = AXI_I2S_RESET_RX_FIFO;
|
|
else
|
|
mask = AXI_I2S_RESET_TX_FIFO;
|
|
|
|
regmap_write(i2s->regmap, AXI_I2S_REG_RESET, mask);
|
|
|
|
ret = snd_pcm_hw_constraint_ratnums(substream->runtime, 0,
|
|
SNDRV_PCM_HW_PARAM_RATE,
|
|
&i2s->rate_constraints);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return clk_prepare_enable(i2s->clk_ref);
|
|
}
|
|
|
|
static void axi_i2s_shutdown(struct snd_pcm_substream *substream,
|
|
struct snd_soc_dai *dai)
|
|
{
|
|
struct axi_i2s *i2s = snd_soc_dai_get_drvdata(dai);
|
|
|
|
clk_disable_unprepare(i2s->clk_ref);
|
|
}
|
|
|
|
static int axi_i2s_dai_probe(struct snd_soc_dai *dai)
|
|
{
|
|
struct axi_i2s *i2s = snd_soc_dai_get_drvdata(dai);
|
|
|
|
snd_soc_dai_init_dma_data(
|
|
dai,
|
|
i2s->has_playback ? &i2s->playback_dma_data : NULL,
|
|
i2s->has_capture ? &i2s->capture_dma_data : NULL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct snd_soc_dai_ops axi_i2s_dai_ops = {
|
|
.startup = axi_i2s_startup,
|
|
.shutdown = axi_i2s_shutdown,
|
|
.trigger = axi_i2s_trigger,
|
|
.hw_params = axi_i2s_hw_params,
|
|
};
|
|
|
|
static struct snd_soc_dai_driver axi_i2s_dai = {
|
|
.probe = axi_i2s_dai_probe,
|
|
.ops = &axi_i2s_dai_ops,
|
|
.symmetric_rate = 1,
|
|
};
|
|
|
|
static const struct snd_soc_component_driver axi_i2s_component = {
|
|
.name = "axi-i2s",
|
|
.legacy_dai_naming = 1,
|
|
};
|
|
|
|
static const struct regmap_config axi_i2s_regmap_config = {
|
|
.reg_bits = 32,
|
|
.reg_stride = 4,
|
|
.val_bits = 32,
|
|
.max_register = AXI_I2S_REG_STATUS,
|
|
};
|
|
|
|
static void axi_i2s_parse_of(struct axi_i2s *i2s, const struct device_node *np)
|
|
{
|
|
struct property *dma_names;
|
|
const char *dma_name;
|
|
|
|
of_property_for_each_string(np, "dma-names", dma_names, dma_name) {
|
|
if (strcmp(dma_name, "rx") == 0)
|
|
i2s->has_capture = true;
|
|
if (strcmp(dma_name, "tx") == 0)
|
|
i2s->has_playback = true;
|
|
}
|
|
}
|
|
|
|
static int axi_i2s_probe(struct platform_device *pdev)
|
|
{
|
|
struct resource *res;
|
|
struct axi_i2s *i2s;
|
|
void __iomem *base;
|
|
int ret;
|
|
|
|
i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL);
|
|
if (!i2s)
|
|
return -ENOMEM;
|
|
|
|
platform_set_drvdata(pdev, i2s);
|
|
|
|
axi_i2s_parse_of(i2s, pdev->dev.of_node);
|
|
|
|
base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);
|
|
if (IS_ERR(base))
|
|
return PTR_ERR(base);
|
|
|
|
i2s->regmap = devm_regmap_init_mmio(&pdev->dev, base,
|
|
&axi_i2s_regmap_config);
|
|
if (IS_ERR(i2s->regmap))
|
|
return PTR_ERR(i2s->regmap);
|
|
|
|
i2s->clk = devm_clk_get(&pdev->dev, "axi");
|
|
if (IS_ERR(i2s->clk))
|
|
return PTR_ERR(i2s->clk);
|
|
|
|
i2s->clk_ref = devm_clk_get(&pdev->dev, "ref");
|
|
if (IS_ERR(i2s->clk_ref))
|
|
return PTR_ERR(i2s->clk_ref);
|
|
|
|
ret = clk_prepare_enable(i2s->clk);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (i2s->has_playback) {
|
|
axi_i2s_dai.playback.channels_min = 2;
|
|
axi_i2s_dai.playback.channels_max = 2;
|
|
axi_i2s_dai.playback.rates = SNDRV_PCM_RATE_KNOT;
|
|
axi_i2s_dai.playback.formats =
|
|
SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_U32_LE;
|
|
|
|
i2s->playback_dma_data.addr = res->start + AXI_I2S_REG_TX_FIFO;
|
|
i2s->playback_dma_data.addr_width = 4;
|
|
i2s->playback_dma_data.maxburst = 1;
|
|
}
|
|
|
|
if (i2s->has_capture) {
|
|
axi_i2s_dai.capture.channels_min = 2;
|
|
axi_i2s_dai.capture.channels_max = 2;
|
|
axi_i2s_dai.capture.rates = SNDRV_PCM_RATE_KNOT;
|
|
axi_i2s_dai.capture.formats =
|
|
SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_U32_LE;
|
|
|
|
i2s->capture_dma_data.addr = res->start + AXI_I2S_REG_RX_FIFO;
|
|
i2s->capture_dma_data.addr_width = 4;
|
|
i2s->capture_dma_data.maxburst = 1;
|
|
}
|
|
|
|
i2s->ratnum.num = clk_get_rate(i2s->clk_ref) / 2 / AXI_I2S_BITS_PER_FRAME;
|
|
i2s->ratnum.den_step = 1;
|
|
i2s->ratnum.den_min = 1;
|
|
i2s->ratnum.den_max = 64;
|
|
|
|
i2s->rate_constraints.rats = &i2s->ratnum;
|
|
i2s->rate_constraints.nrats = 1;
|
|
|
|
regmap_write(i2s->regmap, AXI_I2S_REG_RESET, AXI_I2S_RESET_GLOBAL);
|
|
|
|
ret = devm_snd_soc_register_component(&pdev->dev, &axi_i2s_component,
|
|
&axi_i2s_dai, 1);
|
|
if (ret)
|
|
goto err_clk_disable;
|
|
|
|
ret = devm_snd_dmaengine_pcm_register(&pdev->dev, NULL, 0);
|
|
if (ret)
|
|
goto err_clk_disable;
|
|
|
|
dev_info(&pdev->dev, "probed, capture %s, playback %s\n",
|
|
i2s->has_capture ? "enabled" : "disabled",
|
|
i2s->has_playback ? "enabled" : "disabled");
|
|
|
|
return 0;
|
|
|
|
err_clk_disable:
|
|
clk_disable_unprepare(i2s->clk);
|
|
return ret;
|
|
}
|
|
|
|
static void axi_i2s_dev_remove(struct platform_device *pdev)
|
|
{
|
|
struct axi_i2s *i2s = platform_get_drvdata(pdev);
|
|
|
|
clk_disable_unprepare(i2s->clk);
|
|
}
|
|
|
|
static const struct of_device_id axi_i2s_of_match[] = {
|
|
{ .compatible = "adi,axi-i2s-1.00.a", },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, axi_i2s_of_match);
|
|
|
|
static struct platform_driver axi_i2s_driver = {
|
|
.driver = {
|
|
.name = "axi-i2s",
|
|
.of_match_table = axi_i2s_of_match,
|
|
},
|
|
.probe = axi_i2s_probe,
|
|
.remove_new = axi_i2s_dev_remove,
|
|
};
|
|
module_platform_driver(axi_i2s_driver);
|
|
|
|
MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
|
|
MODULE_DESCRIPTION("AXI I2S driver");
|
|
MODULE_LICENSE("GPL");
|