Commit 4d9b7926 authored by Markus Pargmann's avatar Markus Pargmann Committed by Mark Brown

ASoC: fsl-ssi: Cleanup probe function

Reorder the probe function to be able to move the second imx-specific
block to the seperate imx probe function. The patch also removes some
comments/variables/code that are not used anymore or could be simply
replaced by other variables.
Signed-off-by: default avatarMarkus Pargmann <mpa@pengutronix.de>
Tested-By: default avatarMichael Grzeschik <mgr@pengutronix.de>
Signed-off-by: default avatarMark Brown <broonie@linaro.org>
parent ed0f1604
...@@ -159,7 +159,6 @@ struct fsl_ssi_private { ...@@ -159,7 +159,6 @@ struct fsl_ssi_private {
bool imx_ac97; bool imx_ac97;
bool use_dma; bool use_dma;
bool baudclk_locked; bool baudclk_locked;
bool irq_stats;
bool offline_config; bool offline_config;
bool use_dual_fifo; bool use_dual_fifo;
u8 i2s_mode; u8 i2s_mode;
...@@ -991,7 +990,7 @@ static void make_lowercase(char *s) ...@@ -991,7 +990,7 @@ static void make_lowercase(char *s)
} }
static int fsl_ssi_imx_probe(struct platform_device *pdev, static int fsl_ssi_imx_probe(struct platform_device *pdev,
struct fsl_ssi_private *ssi_private) struct fsl_ssi_private *ssi_private, void __iomem *iomem)
{ {
struct device_node *np = pdev->dev.of_node; struct device_node *np = pdev->dev.of_node;
u32 dmas[4]; u32 dmas[4];
...@@ -1041,12 +1040,47 @@ static int fsl_ssi_imx_probe(struct platform_device *pdev, ...@@ -1041,12 +1040,47 @@ static int fsl_ssi_imx_probe(struct platform_device *pdev,
ssi_private->dma_params_rx.maxburst &= ~0x1; ssi_private->dma_params_rx.maxburst &= ~0x1;
} }
if (!ssi_private->use_dma) {
/*
* Some boards use an incompatible codec. To get it
* working, we are using imx-fiq-pcm-audio, that
* can handle those codecs. DMA is not possible in this
* situation.
*/
ssi_private->fiq_params.irq = ssi_private->irq;
ssi_private->fiq_params.base = iomem;
ssi_private->fiq_params.dma_params_rx =
&ssi_private->dma_params_rx;
ssi_private->fiq_params.dma_params_tx =
&ssi_private->dma_params_tx;
ret = imx_pcm_fiq_init(pdev, &ssi_private->fiq_params);
if (ret)
goto error_pcm;
} else {
ret = imx_pcm_dma_init(pdev);
if (ret)
goto error_pcm;
}
return 0; return 0;
error_pcm:
if (!IS_ERR(ssi_private->baudclk))
clk_disable_unprepare(ssi_private->baudclk);
clk_disable_unprepare(ssi_private->clk);
return ret;
} }
static void fsl_ssi_imx_clean(struct platform_device *pdev, static void fsl_ssi_imx_clean(struct platform_device *pdev,
struct fsl_ssi_private *ssi_private) struct fsl_ssi_private *ssi_private)
{ {
if (!ssi_private->use_dma)
imx_pcm_fiq_exit(pdev);
if (!IS_ERR(ssi_private->baudclk)) if (!IS_ERR(ssi_private->baudclk))
clk_disable_unprepare(ssi_private->baudclk); clk_disable_unprepare(ssi_private->baudclk);
clk_disable_unprepare(ssi_private->clk); clk_disable_unprepare(ssi_private->clk);
...@@ -1056,7 +1090,6 @@ static int fsl_ssi_probe(struct platform_device *pdev) ...@@ -1056,7 +1090,6 @@ static int fsl_ssi_probe(struct platform_device *pdev)
{ {
struct fsl_ssi_private *ssi_private; struct fsl_ssi_private *ssi_private;
int ret = 0; int ret = 0;
struct device_attribute *dev_attr = NULL;
struct device_node *np = pdev->dev.of_node; struct device_node *np = pdev->dev.of_node;
const struct of_device_id *of_id; const struct of_device_id *of_id;
enum fsl_ssi_type hw_type; enum fsl_ssi_type hw_type;
...@@ -1149,6 +1182,8 @@ static int fsl_ssi_probe(struct platform_device *pdev) ...@@ -1149,6 +1182,8 @@ static int fsl_ssi_probe(struct platform_device *pdev)
ssi_private->baudclk_locked = false; ssi_private->baudclk_locked = false;
spin_lock_init(&ssi_private->baudclk_lock); spin_lock_init(&ssi_private->baudclk_lock);
dev_set_drvdata(&pdev->dev, ssi_private);
/* /*
* imx51 and later SoCs have a slightly different IP that allows the * imx51 and later SoCs have a slightly different IP that allows the
* SSI configuration while the SSI unit is running. * SSI configuration while the SSI unit is running.
...@@ -1179,20 +1214,22 @@ static int fsl_ssi_probe(struct platform_device *pdev) ...@@ -1179,20 +1214,22 @@ static int fsl_ssi_probe(struct platform_device *pdev)
hw_type == FSL_SSI_MX35) { hw_type == FSL_SSI_MX35) {
ssi_private->ssi_on_imx = true; ssi_private->ssi_on_imx = true;
ret = fsl_ssi_imx_probe(pdev, ssi_private); ret = fsl_ssi_imx_probe(pdev, ssi_private, ssi_private->ssi);
if (ret) if (ret)
goto error_irqmap; goto error_irqmap;
} }
/* ret = snd_soc_register_component(&pdev->dev, &fsl_ssi_component,
* Enable interrupts only for MCP8610 and MX51. The other MXs have &ssi_private->cpu_dai_drv, 1);
* different writeable interrupt status registers. if (ret) {
*/ dev_err(&pdev->dev, "failed to register DAI: %d\n", ret);
goto error_asoc_register;
}
if (ssi_private->use_dma) { if (ssi_private->use_dma) {
ret = devm_request_irq(&pdev->dev, ssi_private->irq, ret = devm_request_irq(&pdev->dev, ssi_private->irq,
fsl_ssi_isr, 0, ssi_private->name, fsl_ssi_isr, 0, ssi_private->name,
ssi_private); ssi_private);
ssi_private->irq_stats = true;
if (ret < 0) { if (ret < 0) {
dev_err(&pdev->dev, "could not claim irq %u\n", dev_err(&pdev->dev, "could not claim irq %u\n",
ssi_private->irq); ssi_private->irq);
...@@ -1200,46 +1237,9 @@ static int fsl_ssi_probe(struct platform_device *pdev) ...@@ -1200,46 +1237,9 @@ static int fsl_ssi_probe(struct platform_device *pdev)
} }
} }
/* Register with ASoC */
dev_set_drvdata(&pdev->dev, ssi_private);
ret = snd_soc_register_component(&pdev->dev, &fsl_ssi_component,
&ssi_private->cpu_dai_drv, 1);
if (ret) {
dev_err(&pdev->dev, "failed to register DAI: %d\n", ret);
goto error_dev;
}
ret = fsl_ssi_debugfs_create(&ssi_private->dbg_stats, &pdev->dev); ret = fsl_ssi_debugfs_create(&ssi_private->dbg_stats, &pdev->dev);
if (ret) if (ret)
goto error_dbgfs; goto error_asoc_register;
if (ssi_private->ssi_on_imx) {
if (!ssi_private->use_dma) {
/*
* Some boards use an incompatible codec. To get it
* working, we are using imx-fiq-pcm-audio, that
* can handle those codecs. DMA is not possible in this
* situation.
*/
ssi_private->fiq_params.irq = ssi_private->irq;
ssi_private->fiq_params.base = ssi_private->ssi;
ssi_private->fiq_params.dma_params_rx =
&ssi_private->dma_params_rx;
ssi_private->fiq_params.dma_params_tx =
&ssi_private->dma_params_tx;
ret = imx_pcm_fiq_init(pdev, &ssi_private->fiq_params);
if (ret)
goto error_pcm;
} else {
ret = imx_pcm_dma_init(pdev);
if (ret)
goto error_pcm;
}
}
/* /*
* If codec-handle property is missing from SSI node, we assume * If codec-handle property is missing from SSI node, we assume
...@@ -1269,32 +1269,25 @@ static int fsl_ssi_probe(struct platform_device *pdev) ...@@ -1269,32 +1269,25 @@ static int fsl_ssi_probe(struct platform_device *pdev)
if (IS_ERR(ssi_private->pdev)) { if (IS_ERR(ssi_private->pdev)) {
ret = PTR_ERR(ssi_private->pdev); ret = PTR_ERR(ssi_private->pdev);
dev_err(&pdev->dev, "failed to register platform: %d\n", ret); dev_err(&pdev->dev, "failed to register platform: %d\n", ret);
goto error_dai; goto error_sound_card;
} }
done: done:
return 0; return 0;
error_dai: error_sound_card:
if (ssi_private->ssi_on_imx && !ssi_private->use_dma)
imx_pcm_fiq_exit(pdev);
error_pcm:
fsl_ssi_debugfs_remove(&ssi_private->dbg_stats); fsl_ssi_debugfs_remove(&ssi_private->dbg_stats);
error_dbgfs: error_irq:
snd_soc_unregister_component(&pdev->dev); snd_soc_unregister_component(&pdev->dev);
error_dev: error_asoc_register:
device_remove_file(&pdev->dev, dev_attr);
error_irq:
if (ssi_private->ssi_on_imx) { if (ssi_private->ssi_on_imx) {
fsl_ssi_imx_clean(pdev, ssi_private); fsl_ssi_imx_clean(pdev, ssi_private);
} }
error_irqmap: error_irqmap:
if (ssi_private->irq_stats) if (ssi_private->use_dma)
irq_dispose_mapping(ssi_private->irq); irq_dispose_mapping(ssi_private->irq);
return ret; return ret;
...@@ -1313,7 +1306,7 @@ static int fsl_ssi_remove(struct platform_device *pdev) ...@@ -1313,7 +1306,7 @@ static int fsl_ssi_remove(struct platform_device *pdev)
if (ssi_private->ssi_on_imx) if (ssi_private->ssi_on_imx)
fsl_ssi_imx_clean(pdev, ssi_private); fsl_ssi_imx_clean(pdev, ssi_private);
if (ssi_private->irq_stats) if (ssi_private->use_dma)
irq_dispose_mapping(ssi_private->irq); irq_dispose_mapping(ssi_private->irq);
return 0; return 0;
......
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