asoc: Add msm_common.c for I2S, TDM and AUXPCM interfaces

Change-Id: I675ec1f266a68c87882094d64055481305c6bdfb Signed-off-by: Rohit kumar <rohitkr@codeaurora.org>
2019-10-31 12:22:01 +05:30
parent ebf0162590
commit f6eb3aac0f
3 changed files with 214 additions and 0 deletions
--- a/asoc/msm_common.c
+++ b/asoc/msm_common.c
@@ -0,0 +1,159 @@
+/* Copyright (c) 2020, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <linux/platform_device.h>
+#include <linux/slab.h>
+#include <linux/of_device.h>
+#include "asoc/msm-cdc-pinctrl.h"
+#include "msm_common.h"
+
+static int get_intf_index(const char *stream_name)
+{
+	if (strnstr(stream_name, "PRIMARY", strlen("PRIMARY")))
+		return PRI_MI2S_TDM_AUXPCM;
+	else if (strnstr(stream_name, "SECONDARY", strlen("SECONDARY")))
+		return SEC_MI2S_TDM_AUXPCM;
+	else if (strnstr(stream_name, "TERTIARY", strlen("TERTIARY")))
+		return TER_MI2S_TDM_AUXPCM;
+	else if (strnstr(stream_name, "QUATERNARY", strlen("QUATERNARY")))
+		return QUAT_MI2S_TDM_AUXPCM;
+	else if (strnstr(stream_name, "QUINARY", strlen("QUINARY")))
+		return QUIN_MI2S_TDM_AUXPCM;
+	else if (strnstr(stream_name, "SENARY", strlen("SENARY")))
+		return SEN_MI2S_TDM_AUXPCM;
+	else
+		return -EINVAL;
+}
+
+int msm_common_snd_startup(struct snd_pcm_substream *substream)
+{
+	int ret = 0;
+	struct snd_soc_pcm_runtime *rtd = substream->private_data;
+	struct snd_soc_card *card = rtd->card;
+	struct msm_common_pdata *pdata = msm_common_get_pdata(card);
+	const char *stream_name = rtd->dai_link->stream_name;
+	int index = get_intf_index(stream_name);
+
+	dev_dbg(rtd->card->dev,
+		"%s: substream = %s  stream = %d\n",
+		__func__, substream->name, substream->stream);
+
+	if (!pdata) {
+		dev_err(rtd->card->dev, "%s: pdata is NULL\n", __func__);
+		return -EINVAL;
+	}
+
+	if (index < 0) {
+		dev_err(rtd->card->dev,
+			"%s: Invalid Backend interface %d\n", __func__, index);
+		return -EINVAL;
+	}
+
+	mutex_lock(&pdata->lock[index]);
+	if (pdata->mi2s_gpio_p[index]) {
+		if (atomic_read(&(pdata->mi2s_gpio_ref_cnt[index])) == 0) {
+			ret = msm_cdc_pinctrl_select_active_state(
+					pdata->mi2s_gpio_p[index]);
+			if (ret) {
+				pr_err("%s: GPIO pinctrl set active failed with %d\n",
+						__func__, ret);
+				goto done;
+			}
+		}
+		atomic_inc(&(pdata->mi2s_gpio_ref_cnt[index]));
+	}
+done:
+	mutex_unlock(&pdata->lock[index]);
+	return ret;
+}
+
+void msm_common_snd_shutdown(struct snd_pcm_substream *substream)
+{
+	int ret;
+	struct snd_soc_pcm_runtime *rtd = substream->private_data;
+	struct snd_soc_card *card = rtd->card;
+	struct msm_common_pdata *pdata = msm_common_get_pdata(card);
+	const char *stream_name = rtd->dai_link->stream_name;
+	int index = get_intf_index(stream_name);
+
+	pr_debug("%s(): substream = %s  stream = %d\n", __func__,
+			substream->name, substream->stream);
+
+	if (!pdata) {
+		dev_err(card->dev, "%s: pdata is NULL\n", __func__);
+		return;
+	}
+
+	if (index < 0) {
+		dev_err(card->dev,
+			"%s: Invalid Backend interface %d\n", __func__, index);
+		return;
+	}
+
+	mutex_lock(&pdata->lock[index]);
+	if (pdata->mi2s_gpio_p[index]) {
+		atomic_dec(&pdata->mi2s_gpio_ref_cnt[index]);
+		if (atomic_read(&pdata->mi2s_gpio_ref_cnt[index]) == 0) {
+			ret = msm_cdc_pinctrl_select_active_state(
+					pdata->mi2s_gpio_p[index]);
+			if (ret)
+				dev_err(card->dev, "%s: GPIO pinctrl set active failed with %d\n",
+						__func__, ret);
+		}
+	}
+	mutex_unlock(&pdata->lock[index]);
+}
+
+int msm_common_snd_init(struct platform_device *pdev, struct snd_soc_card *card)
+{
+	struct msm_common_pdata *common_pdata = NULL;
+	int count;
+
+	common_pdata = kcalloc(1, sizeof(struct msm_common_pdata), GFP_KERNEL);
+	if (!common_pdata)
+		return -ENOMEM;
+
+	for (count = 0; count < MI2S_TDM_AUXPCM_MAX; count++) {
+		mutex_init(&common_pdata->lock[count]);
+		atomic_set(&common_pdata->mi2s_gpio_ref_cnt[count], 0);
+	}
+
+	common_pdata->mi2s_gpio_p[PRI_MI2S_TDM_AUXPCM] = of_parse_phandle(pdev->dev.of_node,
+			"qcom,pri-mi2s-gpios", 0);
+	common_pdata->mi2s_gpio_p[SEC_MI2S_TDM_AUXPCM] = of_parse_phandle(pdev->dev.of_node,
+			"qcom,sec-mi2s-gpios", 0);
+	common_pdata->mi2s_gpio_p[TER_MI2S_TDM_AUXPCM] = of_parse_phandle(pdev->dev.of_node,
+			"qcom,tert-mi2s-gpios", 0);
+	common_pdata->mi2s_gpio_p[QUAT_MI2S_TDM_AUXPCM] = of_parse_phandle(pdev->dev.of_node,
+			"qcom,quat-mi2s-gpios", 0);
+	common_pdata->mi2s_gpio_p[QUIN_MI2S_TDM_AUXPCM] = of_parse_phandle(pdev->dev.of_node,
+			"qcom,quin-mi2s-gpios", 0);
+	common_pdata->mi2s_gpio_p[SEN_MI2S_TDM_AUXPCM] = of_parse_phandle(pdev->dev.of_node,
+			"qcom,sen-mi2s-gpios", 0);
+
+	msm_common_set_pdata(card, common_pdata);
+	return 0;
+};
+
+void msm_common_snd_deinit(struct msm_common_pdata *common_pdata)
+{
+	int count;
+
+	if (!common_pdata)
+		return;
+
+	for (count = 0; count < MI2S_TDM_AUXPCM_MAX; count++) {
+		mutex_destroy(&common_pdata->lock[count]);
+	}
+}