|
@@ -38,6 +38,7 @@
|
|
#include <linux/ctype.h>
|
|
#include <linux/ctype.h>
|
|
#include <linux/device.h>
|
|
#include <linux/device.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/delay.h>
|
|
|
|
+#include <linux/mutex.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of.h>
|
|
@@ -265,6 +266,8 @@ struct fsl_ssi_private {
|
|
|
|
|
|
u32 fifo_watermark;
|
|
u32 fifo_watermark;
|
|
u32 dma_maxburst;
|
|
u32 dma_maxburst;
|
|
|
|
+
|
|
|
|
+ struct mutex ac97_reg_lock;
|
|
};
|
|
};
|
|
|
|
|
|
/*
|
|
/*
|
|
@@ -1260,11 +1263,13 @@ static void fsl_ssi_ac97_write(struct snd_ac97 *ac97, unsigned short reg,
|
|
if (reg > 0x7f)
|
|
if (reg > 0x7f)
|
|
return;
|
|
return;
|
|
|
|
|
|
|
|
+ mutex_lock(&fsl_ac97_data->ac97_reg_lock);
|
|
|
|
+
|
|
ret = clk_prepare_enable(fsl_ac97_data->clk);
|
|
ret = clk_prepare_enable(fsl_ac97_data->clk);
|
|
if (ret) {
|
|
if (ret) {
|
|
pr_err("ac97 write clk_prepare_enable failed: %d\n",
|
|
pr_err("ac97 write clk_prepare_enable failed: %d\n",
|
|
ret);
|
|
ret);
|
|
- return;
|
|
|
|
|
|
+ goto ret_unlock;
|
|
}
|
|
}
|
|
|
|
|
|
lreg = reg << 12;
|
|
lreg = reg << 12;
|
|
@@ -1278,6 +1283,9 @@ static void fsl_ssi_ac97_write(struct snd_ac97 *ac97, unsigned short reg,
|
|
udelay(100);
|
|
udelay(100);
|
|
|
|
|
|
clk_disable_unprepare(fsl_ac97_data->clk);
|
|
clk_disable_unprepare(fsl_ac97_data->clk);
|
|
|
|
+
|
|
|
|
+ret_unlock:
|
|
|
|
+ mutex_unlock(&fsl_ac97_data->ac97_reg_lock);
|
|
}
|
|
}
|
|
|
|
|
|
static unsigned short fsl_ssi_ac97_read(struct snd_ac97 *ac97,
|
|
static unsigned short fsl_ssi_ac97_read(struct snd_ac97 *ac97,
|
|
@@ -1285,16 +1293,18 @@ static unsigned short fsl_ssi_ac97_read(struct snd_ac97 *ac97,
|
|
{
|
|
{
|
|
struct regmap *regs = fsl_ac97_data->regs;
|
|
struct regmap *regs = fsl_ac97_data->regs;
|
|
|
|
|
|
- unsigned short val = -1;
|
|
|
|
|
|
+ unsigned short val = 0;
|
|
u32 reg_val;
|
|
u32 reg_val;
|
|
unsigned int lreg;
|
|
unsigned int lreg;
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
|
|
+ mutex_lock(&fsl_ac97_data->ac97_reg_lock);
|
|
|
|
+
|
|
ret = clk_prepare_enable(fsl_ac97_data->clk);
|
|
ret = clk_prepare_enable(fsl_ac97_data->clk);
|
|
if (ret) {
|
|
if (ret) {
|
|
pr_err("ac97 read clk_prepare_enable failed: %d\n",
|
|
pr_err("ac97 read clk_prepare_enable failed: %d\n",
|
|
ret);
|
|
ret);
|
|
- return -1;
|
|
|
|
|
|
+ goto ret_unlock;
|
|
}
|
|
}
|
|
|
|
|
|
lreg = (reg & 0x7f) << 12;
|
|
lreg = (reg & 0x7f) << 12;
|
|
@@ -1309,6 +1319,8 @@ static unsigned short fsl_ssi_ac97_read(struct snd_ac97 *ac97,
|
|
|
|
|
|
clk_disable_unprepare(fsl_ac97_data->clk);
|
|
clk_disable_unprepare(fsl_ac97_data->clk);
|
|
|
|
|
|
|
|
+ret_unlock:
|
|
|
|
+ mutex_unlock(&fsl_ac97_data->ac97_reg_lock);
|
|
return val;
|
|
return val;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1458,12 +1470,6 @@ static int fsl_ssi_probe(struct platform_device *pdev)
|
|
sizeof(fsl_ssi_ac97_dai));
|
|
sizeof(fsl_ssi_ac97_dai));
|
|
|
|
|
|
fsl_ac97_data = ssi_private;
|
|
fsl_ac97_data = ssi_private;
|
|
-
|
|
|
|
- ret = snd_soc_set_ac97_ops_of_reset(&fsl_ssi_ac97_ops, pdev);
|
|
|
|
- if (ret) {
|
|
|
|
- dev_err(&pdev->dev, "could not set AC'97 ops\n");
|
|
|
|
- return ret;
|
|
|
|
- }
|
|
|
|
} else {
|
|
} else {
|
|
/* Initialize this copy of the CPU DAI driver structure */
|
|
/* Initialize this copy of the CPU DAI driver structure */
|
|
memcpy(&ssi_private->cpu_dai_drv, &fsl_ssi_dai_template,
|
|
memcpy(&ssi_private->cpu_dai_drv, &fsl_ssi_dai_template,
|
|
@@ -1574,6 +1580,15 @@ static int fsl_ssi_probe(struct platform_device *pdev)
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+ if (fsl_ssi_is_ac97(ssi_private)) {
|
|
|
|
+ mutex_init(&ssi_private->ac97_reg_lock);
|
|
|
|
+ ret = snd_soc_set_ac97_ops_of_reset(&fsl_ssi_ac97_ops, pdev);
|
|
|
|
+ if (ret) {
|
|
|
|
+ dev_err(&pdev->dev, "could not set AC'97 ops\n");
|
|
|
|
+ goto error_ac97_ops;
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
ret = devm_snd_soc_register_component(&pdev->dev, &fsl_ssi_component,
|
|
ret = devm_snd_soc_register_component(&pdev->dev, &fsl_ssi_component,
|
|
&ssi_private->cpu_dai_drv, 1);
|
|
&ssi_private->cpu_dai_drv, 1);
|
|
if (ret) {
|
|
if (ret) {
|
|
@@ -1657,6 +1672,13 @@ error_sound_card:
|
|
fsl_ssi_debugfs_remove(&ssi_private->dbg_stats);
|
|
fsl_ssi_debugfs_remove(&ssi_private->dbg_stats);
|
|
|
|
|
|
error_asoc_register:
|
|
error_asoc_register:
|
|
|
|
+ if (fsl_ssi_is_ac97(ssi_private))
|
|
|
|
+ snd_soc_set_ac97_ops(NULL);
|
|
|
|
+
|
|
|
|
+error_ac97_ops:
|
|
|
|
+ if (fsl_ssi_is_ac97(ssi_private))
|
|
|
|
+ mutex_destroy(&ssi_private->ac97_reg_lock);
|
|
|
|
+
|
|
if (ssi_private->soc->imx)
|
|
if (ssi_private->soc->imx)
|
|
fsl_ssi_imx_clean(pdev, ssi_private);
|
|
fsl_ssi_imx_clean(pdev, ssi_private);
|
|
|
|
|
|
@@ -1675,8 +1697,10 @@ static int fsl_ssi_remove(struct platform_device *pdev)
|
|
if (ssi_private->soc->imx)
|
|
if (ssi_private->soc->imx)
|
|
fsl_ssi_imx_clean(pdev, ssi_private);
|
|
fsl_ssi_imx_clean(pdev, ssi_private);
|
|
|
|
|
|
- if (fsl_ssi_is_ac97(ssi_private))
|
|
|
|
|
|
+ if (fsl_ssi_is_ac97(ssi_private)) {
|
|
snd_soc_set_ac97_ops(NULL);
|
|
snd_soc_set_ac97_ops(NULL);
|
|
|
|
+ mutex_destroy(&ssi_private->ac97_reg_lock);
|
|
|
|
+ }
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|