|
@@ -7,6 +7,7 @@
|
|
|
#include <linux/module.h>
|
|
|
#include <linux/moduleparam.h>
|
|
|
#include <linux/time.h>
|
|
|
+#include <linux/mutex.h>
|
|
|
#include <linux/wait.h>
|
|
|
#include <linux/platform_device.h>
|
|
|
#include <linux/slab.h>
|
|
@@ -630,6 +631,8 @@ static int msm_pcm_prepare(struct snd_pcm_substream *substream)
|
|
|
|
|
|
static int msm_pcm_close(struct snd_pcm_substream *substream)
|
|
|
{
|
|
|
+ struct msm_plat_data *pdata = NULL;
|
|
|
+ struct snd_soc_component *component = NULL;
|
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
|
struct snd_soc_pcm_runtime *soc_prtd = substream->private_data;
|
|
|
struct msm_audio *prtd = runtime->private_data;
|
|
@@ -638,6 +641,25 @@ static int msm_pcm_close(struct snd_pcm_substream *substream)
|
|
|
int dir = 0;
|
|
|
int ret = 0;
|
|
|
|
|
|
+ if (!soc_prtd) {
|
|
|
+ pr_debug("%s private_data not found\n",
|
|
|
+ __func__);
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ component = snd_soc_rtdcom_lookup(soc_prtd, DRV_NAME);
|
|
|
+ if (!component) {
|
|
|
+ pr_err("%s: component is NULL\n", __func__);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ pdata = (struct msm_plat_data *) dev_get_drvdata(component->dev);
|
|
|
+ if (!pdata) {
|
|
|
+ pr_err("%s: pdata not found\n", __func__);
|
|
|
+ return -ENODEV;
|
|
|
+ }
|
|
|
+
|
|
|
+ mutex_lock(&pdata->lock);
|
|
|
if (ac) {
|
|
|
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
|
|
dir = IN;
|
|
@@ -672,6 +694,7 @@ static int msm_pcm_close(struct snd_pcm_substream *substream)
|
|
|
SNDRV_PCM_STREAM_CAPTURE);
|
|
|
kfree(prtd);
|
|
|
runtime->private_data = NULL;
|
|
|
+ mutex_unlock(&pdata->lock);
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -696,8 +719,11 @@ static int msm_pcm_volume_ctl_get(struct snd_kcontrol *kcontrol,
|
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
|
{
|
|
|
struct snd_pcm_volume *vol = snd_kcontrol_chip(kcontrol);
|
|
|
+ struct msm_plat_data *pdata = NULL;
|
|
|
struct snd_pcm_substream *substream =
|
|
|
vol->pcm->streams[vol->stream].substream;
|
|
|
+ struct snd_soc_pcm_runtime *soc_prtd = NULL;
|
|
|
+ struct snd_soc_component *component = NULL;
|
|
|
struct msm_audio *prtd;
|
|
|
|
|
|
pr_debug("%s\n", __func__);
|
|
@@ -705,13 +731,29 @@ static int msm_pcm_volume_ctl_get(struct snd_kcontrol *kcontrol,
|
|
|
pr_err("%s substream not found\n", __func__);
|
|
|
return -ENODEV;
|
|
|
}
|
|
|
- if (!substream->runtime) {
|
|
|
- pr_debug("%s substream runtime not found\n", __func__);
|
|
|
+ soc_prtd = substream->private_data;
|
|
|
+ if (!substream->runtime || !soc_prtd) {
|
|
|
+ pr_debug("%s substream runtime or private_data not found\n",
|
|
|
+ __func__);
|
|
|
return 0;
|
|
|
}
|
|
|
+
|
|
|
+ component = snd_soc_rtdcom_lookup(soc_prtd, DRV_NAME);
|
|
|
+ if (!component) {
|
|
|
+ pr_err("%s: component is NULL\n", __func__);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ pdata = (struct msm_plat_data *) dev_get_drvdata(component->dev);
|
|
|
+ if (!pdata) {
|
|
|
+ pr_err("%s: pdata not found\n", __func__);
|
|
|
+ return -ENODEV;
|
|
|
+ }
|
|
|
+ mutex_lock(&pdata->lock);
|
|
|
prtd = substream->runtime->private_data;
|
|
|
if (prtd)
|
|
|
ucontrol->value.integer.value[0] = prtd->volume;
|
|
|
+ mutex_unlock(&pdata->lock);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -720,8 +762,11 @@ static int msm_pcm_volume_ctl_put(struct snd_kcontrol *kcontrol,
|
|
|
{
|
|
|
int rc = 0;
|
|
|
struct snd_pcm_volume *vol = snd_kcontrol_chip(kcontrol);
|
|
|
+ struct msm_plat_data *pdata = NULL;
|
|
|
struct snd_pcm_substream *substream =
|
|
|
vol->pcm->streams[vol->stream].substream;
|
|
|
+ struct snd_soc_pcm_runtime *soc_prtd = NULL;
|
|
|
+ struct snd_soc_component *component = NULL;
|
|
|
struct msm_audio *prtd;
|
|
|
int volume = ucontrol->value.integer.value[0];
|
|
|
|
|
@@ -730,15 +775,32 @@ static int msm_pcm_volume_ctl_put(struct snd_kcontrol *kcontrol,
|
|
|
pr_err("%s substream not found\n", __func__);
|
|
|
return -ENODEV;
|
|
|
}
|
|
|
- if (!substream->runtime) {
|
|
|
- pr_err("%s substream runtime not found\n", __func__);
|
|
|
+ soc_prtd = substream->private_data;
|
|
|
+ if (!substream->runtime || !soc_prtd) {
|
|
|
+ pr_err("%s substream runtime or private_data not found\n",
|
|
|
+ __func__);
|
|
|
return 0;
|
|
|
}
|
|
|
+
|
|
|
+ component = snd_soc_rtdcom_lookup(soc_prtd, DRV_NAME);
|
|
|
+ if (!component) {
|
|
|
+ pr_err("%s: component is NULL\n", __func__);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ pdata = (struct msm_plat_data *) dev_get_drvdata(component->dev);
|
|
|
+ if (!pdata) {
|
|
|
+ pr_err("%s: pdata not found\n", __func__);
|
|
|
+ return -ENODEV;
|
|
|
+ }
|
|
|
+
|
|
|
+ mutex_lock(&pdata->lock);
|
|
|
prtd = substream->runtime->private_data;
|
|
|
if (prtd) {
|
|
|
rc = msm_pcm_set_volume(prtd, volume);
|
|
|
prtd->volume = volume;
|
|
|
}
|
|
|
+ mutex_unlock(&pdata->lock);
|
|
|
return rc;
|
|
|
}
|
|
|
|
|
@@ -1338,6 +1400,8 @@ static int msm_pcm_probe(struct platform_device *pdev)
|
|
|
|
|
|
pdata->perf_mode = perf_mode;
|
|
|
|
|
|
+ mutex_init(&pdata->lock);
|
|
|
+
|
|
|
dev_set_drvdata(&pdev->dev, pdata);
|
|
|
|
|
|
dev_dbg(&pdev->dev, "%s: dev name %s\n",
|
|
@@ -1359,6 +1423,7 @@ static int msm_pcm_remove(struct platform_device *pdev)
|
|
|
|
|
|
dev_dbg(&pdev->dev, "Pull mode remove\n");
|
|
|
pdata = dev_get_drvdata(&pdev->dev);
|
|
|
+ mutex_destroy(&pdata->lock);
|
|
|
devm_kfree(&pdev->dev, pdata);
|
|
|
snd_soc_unregister_component(&pdev->dev);
|
|
|
return 0;
|