[mirror_ubuntu-zesty-kernel.git] / sound / soc / omap / omap-abe-twl6040.c

/*
 * omap-abe-twl6040.c  --  SoC audio for TI OMAP based boards with ABE and
 *			   twl6040 codec
 *
 * Author: Misael Lopez Cruz <misael.lopez@ti.com>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * 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.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 * 02110-1301 USA
 *
 */

#include <linux/clk.h>
#include <linux/platform_device.h>
#include <linux/mfd/twl6040.h>
#include <linux/platform_data/omap-abe-twl6040.h>
#include <linux/module.h>
#include <linux/of.h>

#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/soc.h>
#include <sound/jack.h>

#include "omap-dmic.h"
#include "omap-mcpdm.h"
#include "omap-pcm.h"
#include "../codecs/twl6040.h"

struct abe_twl6040 {
	int	jack_detection;	/* board can detect jack events */
	int	mclk_freq;	/* MCLK frequency speed for twl6040 */

	struct platform_device *dmic_codec_dev;
};

static int omap_abe_hw_params(struct snd_pcm_substream *substream,
	struct snd_pcm_hw_params *params)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	struct snd_soc_dai *codec_dai = rtd->codec_dai;
	struct snd_soc_codec *codec = rtd->codec;
	struct snd_soc_card *card = codec->card;
	struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card);
	int clk_id, freq;
	int ret;

	clk_id = twl6040_get_clk_id(rtd->codec);
	if (clk_id == TWL6040_SYSCLK_SEL_HPPLL)
		freq = priv->mclk_freq;
	else if (clk_id == TWL6040_SYSCLK_SEL_LPPLL)
		freq = 32768;
	else
		return -EINVAL;

	/* set the codec mclk */
	ret = snd_soc_dai_set_sysclk(codec_dai, clk_id, freq,
				SND_SOC_CLOCK_IN);
	if (ret) {
		printk(KERN_ERR "can't set codec system clock\n");
		return ret;
	}
	return ret;
}

static struct snd_soc_ops omap_abe_ops = {
	.hw_params = omap_abe_hw_params,
};

static int omap_abe_dmic_hw_params(struct snd_pcm_substream *substream,
	struct snd_pcm_hw_params *params)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
	int ret = 0;

	ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_DMIC_SYSCLK_PAD_CLKS,
				     19200000, SND_SOC_CLOCK_IN);
	if (ret < 0) {
		printk(KERN_ERR "can't set DMIC cpu system clock\n");
		return ret;
	}
	ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_DMIC_ABE_DMIC_CLK, 2400000,
				     SND_SOC_CLOCK_OUT);
	if (ret < 0) {
		printk(KERN_ERR "can't set DMIC output clock\n");
		return ret;
	}
	return 0;
}

static struct snd_soc_ops omap_abe_dmic_ops = {
	.hw_params = omap_abe_dmic_hw_params,
};

/* Headset jack */
static struct snd_soc_jack hs_jack;

/*Headset jack detection DAPM pins */
static struct snd_soc_jack_pin hs_jack_pins[] = {
	{
		.pin = "Headset Mic",
		.mask = SND_JACK_MICROPHONE,
	},
	{
		.pin = "Headset Stereophone",
		.mask = SND_JACK_HEADPHONE,
	},
};

/* SDP4430 machine DAPM */
static const struct snd_soc_dapm_widget twl6040_dapm_widgets[] = {
	/* Outputs */
	SND_SOC_DAPM_HP("Headset Stereophone", NULL),
	SND_SOC_DAPM_SPK("Earphone Spk", NULL),
	SND_SOC_DAPM_SPK("Ext Spk", NULL),
	SND_SOC_DAPM_LINE("Line Out", NULL),
	SND_SOC_DAPM_SPK("Vibrator", NULL),

	/* Inputs */
	SND_SOC_DAPM_MIC("Headset Mic", NULL),
	SND_SOC_DAPM_MIC("Main Handset Mic", NULL),
	SND_SOC_DAPM_MIC("Sub Handset Mic", NULL),
	SND_SOC_DAPM_LINE("Line In", NULL),

	/* Digital microphones */
	SND_SOC_DAPM_MIC("Digital Mic", NULL),
};

static const struct snd_soc_dapm_route audio_map[] = {
	/* Routings for outputs */
	{"Headset Stereophone", NULL, "HSOL"},
	{"Headset Stereophone", NULL, "HSOR"},

	{"Earphone Spk", NULL, "EP"},

	{"Ext Spk", NULL, "HFL"},
	{"Ext Spk", NULL, "HFR"},

	{"Line Out", NULL, "AUXL"},
	{"Line Out", NULL, "AUXR"},

	{"Vibrator", NULL, "VIBRAL"},
	{"Vibrator", NULL, "VIBRAR"},

	/* Routings for inputs */
	{"HSMIC", NULL, "Headset Mic"},
	{"Headset Mic", NULL, "Headset Mic Bias"},

	{"MAINMIC", NULL, "Main Handset Mic"},
	{"Main Handset Mic", NULL, "Main Mic Bias"},

	{"SUBMIC", NULL, "Sub Handset Mic"},
	{"Sub Handset Mic", NULL, "Main Mic Bias"},

	{"AFML", NULL, "Line In"},
	{"AFMR", NULL, "Line In"},
};

static inline void twl6040_disconnect_pin(struct snd_soc_dapm_context *dapm,
					  int connected, char *pin)
{
	if (!connected)
		snd_soc_dapm_disable_pin(dapm, pin);
}

static int omap_abe_twl6040_init(struct snd_soc_pcm_runtime *rtd)
{
	struct snd_soc_codec *codec = rtd->codec;
	struct snd_soc_card *card = codec->card;
	struct snd_soc_dapm_context *dapm = &codec->dapm;
	struct omap_abe_twl6040_data *pdata = dev_get_platdata(card->dev);
	struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card);
	int hs_trim;
	int ret = 0;

	/*
	 * Configure McPDM offset cancellation based on the HSOTRIM value from
	 * twl6040.
	 */
	hs_trim = twl6040_get_trim_value(codec, TWL6040_TRIM_HSOTRIM);
	omap_mcpdm_configure_dn_offsets(rtd, TWL6040_HSF_TRIM_LEFT(hs_trim),
					TWL6040_HSF_TRIM_RIGHT(hs_trim));

	/* Headset jack detection only if it is supported */
	if (priv->jack_detection) {
		ret = snd_soc_jack_new(codec, "Headset Jack",
					SND_JACK_HEADSET, &hs_jack);
		if (ret)
			return ret;

		ret = snd_soc_jack_add_pins(&hs_jack, ARRAY_SIZE(hs_jack_pins),
					hs_jack_pins);
		twl6040_hs_jack_detect(codec, &hs_jack, SND_JACK_HEADSET);
	}

	/*
	 * NULL pdata means we booted with DT. In this case the routing is
	 * provided and the card is fully routed, no need to mark pins.
	 */
	if (!pdata)
		return ret;

	/* Disable not connected paths if not used */
	twl6040_disconnect_pin(dapm, pdata->has_hs, "Headset Stereophone");
	twl6040_disconnect_pin(dapm, pdata->has_hf, "Ext Spk");
	twl6040_disconnect_pin(dapm, pdata->has_ep, "Earphone Spk");
	twl6040_disconnect_pin(dapm, pdata->has_aux, "Line Out");
	twl6040_disconnect_pin(dapm, pdata->has_vibra, "Vibrator");
	twl6040_disconnect_pin(dapm, pdata->has_hsmic, "Headset Mic");
	twl6040_disconnect_pin(dapm, pdata->has_mainmic, "Main Handset Mic");
	twl6040_disconnect_pin(dapm, pdata->has_submic, "Sub Handset Mic");
	twl6040_disconnect_pin(dapm, pdata->has_afm, "Line In");

	return ret;
}

static const struct snd_soc_dapm_route dmic_audio_map[] = {
	{"DMic", NULL, "Digital Mic"},
	{"Digital Mic", NULL, "Digital Mic1 Bias"},
};

static int omap_abe_dmic_init(struct snd_soc_pcm_runtime *rtd)
{
	struct snd_soc_codec *codec = rtd->codec;
	struct snd_soc_dapm_context *dapm = &codec->dapm;

	return snd_soc_dapm_add_routes(dapm, dmic_audio_map,
				ARRAY_SIZE(dmic_audio_map));
}

/* Digital audio interface glue - connects codec <--> CPU */
static struct snd_soc_dai_link abe_twl6040_dai_links[] = {
	{
		.name = "TWL6040",
		.stream_name = "TWL6040",
		.cpu_dai_name = "omap-mcpdm",
		.codec_dai_name = "twl6040-legacy",
		.platform_name = "omap-pcm-audio",
		.codec_name = "twl6040-codec",
		.init = omap_abe_twl6040_init,
		.ops = &omap_abe_ops,
	},
	{
		.name = "DMIC",
		.stream_name = "DMIC Capture",
		.cpu_dai_name = "omap-dmic",
		.codec_dai_name = "dmic-hifi",
		.platform_name = "omap-pcm-audio",
		.codec_name = "dmic-codec",
		.init = omap_abe_dmic_init,
		.ops = &omap_abe_dmic_ops,
	},
};

/* Audio machine driver */
static struct snd_soc_card omap_abe_card = {
	.owner = THIS_MODULE,

	.dapm_widgets = twl6040_dapm_widgets,
	.num_dapm_widgets = ARRAY_SIZE(twl6040_dapm_widgets),
	.dapm_routes = audio_map,
	.num_dapm_routes = ARRAY_SIZE(audio_map),
};

static __devinit int omap_abe_probe(struct platform_device *pdev)
{
	struct omap_abe_twl6040_data *pdata = dev_get_platdata(&pdev->dev);
	struct device_node *node = pdev->dev.of_node;
	struct snd_soc_card *card = &omap_abe_card;
	struct abe_twl6040 *priv;
	int num_links = 0;
	int ret = 0;

	card->dev = &pdev->dev;

	priv = devm_kzalloc(&pdev->dev, sizeof(struct abe_twl6040), GFP_KERNEL);
	if (priv == NULL)
		return -ENOMEM;

	priv->dmic_codec_dev = ERR_PTR(-EINVAL);

	if (node) {
		struct device_node *dai_node;

		if (snd_soc_of_parse_card_name(card, "ti,model")) {
			dev_err(&pdev->dev, "Card name is not provided\n");
			return -ENODEV;
		}

		ret = snd_soc_of_parse_audio_routing(card,
						"ti,audio-routing");
		if (ret) {
			dev_err(&pdev->dev,
				"Error while parsing DAPM routing\n");
			return ret;
		}

		dai_node = of_parse_phandle(node, "ti,mcpdm", 0);
		if (!dai_node) {
			dev_err(&pdev->dev, "McPDM node is not provided\n");
			return -EINVAL;
		}
		abe_twl6040_dai_links[0].cpu_dai_name  = NULL;
		abe_twl6040_dai_links[0].cpu_of_node = dai_node;

		dai_node = of_parse_phandle(node, "ti,dmic", 0);
		if (dai_node) {
			num_links = 2;
			abe_twl6040_dai_links[1].cpu_dai_name  = NULL;
			abe_twl6040_dai_links[1].cpu_of_node = dai_node;

			priv->dmic_codec_dev = platform_device_register_simple(
						"dmic-codec", -1, NULL, 0);
			if (IS_ERR(priv->dmic_codec_dev)) {
				dev_err(&pdev->dev,
					"Can't instantiate dmic-codec\n");
				return PTR_ERR(priv->dmic_codec_dev);
			}
		} else {
			num_links = 1;
		}

		priv->jack_detection = of_property_read_bool(node,
							   "ti,jack-detection");
		of_property_read_u32(node, "ti,mclk-freq",
				     &priv->mclk_freq);
		if (!priv->mclk_freq) {
			dev_err(&pdev->dev, "MCLK frequency not provided\n");
			ret = -EINVAL;
			goto err_unregister;
		}

		omap_abe_card.fully_routed = 1;
	} else if (pdata) {
		if (pdata->card_name) {
			card->name = pdata->card_name;
		} else {
			dev_err(&pdev->dev, "Card name is not provided\n");
			return -ENODEV;
		}

		if (pdata->has_dmic)
			num_links = 2;
		else
			num_links = 1;

		priv->jack_detection = pdata->jack_detection;
		priv->mclk_freq = pdata->mclk_freq;
	} else {
		dev_err(&pdev->dev, "Missing pdata\n");
		return -ENODEV;
	}


	if (!priv->mclk_freq) {
		dev_err(&pdev->dev, "MCLK frequency missing\n");
		ret = -ENODEV;
		goto err_unregister;
	}

	card->dai_link = abe_twl6040_dai_links;
	card->num_links = num_links;

	snd_soc_card_set_drvdata(card, priv);

	ret = snd_soc_register_card(card);
	if (ret) {
		dev_err(&pdev->dev, "snd_soc_register_card() failed: %d\n",
			ret);
		goto err_unregister;
	}

	return 0;

err_unregister:
	if (!IS_ERR(priv->dmic_codec_dev))
		platform_device_unregister(priv->dmic_codec_dev);

	return ret;
}

static int __devexit omap_abe_remove(struct platform_device *pdev)
{
	struct snd_soc_card *card = platform_get_drvdata(pdev);
	struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card);

	snd_soc_unregister_card(card);

	if (!IS_ERR(priv->dmic_codec_dev))
		platform_device_unregister(priv->dmic_codec_dev);

	return 0;
}

static const struct of_device_id omap_abe_of_match[] = {
	{.compatible = "ti,abe-twl6040", },
	{ },
};
MODULE_DEVICE_TABLE(of, omap_abe_of_match);

static struct platform_driver omap_abe_driver = {
	.driver = {
		.name = "omap-abe-twl6040",
		.owner = THIS_MODULE,
		.pm = &snd_soc_pm_ops,
		.of_match_table = omap_abe_of_match,
	},
	.probe = omap_abe_probe,
	.remove = __devexit_p(omap_abe_remove),
};

module_platform_driver(omap_abe_driver);

MODULE_AUTHOR("Misael Lopez Cruz <misael.lopez@ti.com>");
MODULE_DESCRIPTION("ALSA SoC for OMAP boards with ABE and twl6040 codec");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:omap-abe-twl6040");
Commit	Line	Data
5e64d6aa	1	/*
13f81d65 PU	2	* omap-abe-twl6040.c -- SoC audio for TI OMAP based boards with ABE and
13f81d65 PU	3	* twl6040 codec
5e64d6aa	4	*
8747a6b7	5	* Author: Misael Lopez Cruz <misael.lopez@ti.com>
5e64d6aa MLC	6	*
	7	* This program is free software; you can redistribute it and/or
	8	* modify it under the terms of the GNU General Public License
	9	* version 2 as published by the Free Software Foundation.
	10	*
	11	* This program is distributed in the hope that it will be useful, but
	12	* WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	14	* General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program; if not, write to the Free Software
	18	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
	19	* 02110-1301 USA
	20	*
	21	*/
	22
	23	#include <linux/clk.h>
	24	#include <linux/platform_device.h>
fb34d3d5	25	#include <linux/mfd/twl6040.h>
d1be1d2f	26	#include <linux/platform_data/omap-abe-twl6040.h>
da155d5b	27	#include <linux/module.h>
5ef75e71	28	#include <linux/of.h>
fb34d3d5	29
5e64d6aa MLC	30	#include <sound/core.h>
	31	#include <sound/pcm.h>
	32	#include <sound/soc.h>
96dc227c	33	#include <sound/jack.h>
5e64d6aa	34
6524c8e3	35	#include "omap-dmic.h"
f5f9d7bf	36	#include "omap-mcpdm.h"
5e64d6aa MLC	37	#include "omap-pcm.h"
	38	#include "../codecs/twl6040.h"
	39
356bccbe PU	40	struct abe_twl6040 {
	41	int jack_detection; /* board can detect jack events */
	42	int mclk_freq; /* MCLK frequency speed for twl6040 */
5ef75e71 PU	43
5ef75e71 PU	44	struct platform_device *dmic_codec_dev;
356bccbe PU	45	};
356bccbe PU	46
13f81d65	47	static int omap_abe_hw_params(struct snd_pcm_substream *substream,
5e64d6aa MLC	48	struct snd_pcm_hw_params *params)
	49	{
	50	struct snd_soc_pcm_runtime *rtd = substream->private_data;
f0fba2ad	51	struct snd_soc_dai *codec_dai = rtd->codec_dai;
62ba98ce PU	52	struct snd_soc_codec *codec = rtd->codec;
62ba98ce PU	53	struct snd_soc_card *card = codec->card;
356bccbe	54	struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card);
5e64d6aa MLC	55	int clk_id, freq;
	56	int ret;
	57
af958c72 PU	58	clk_id = twl6040_get_clk_id(rtd->codec);
af958c72 PU	59	if (clk_id == TWL6040_SYSCLK_SEL_HPPLL)
356bccbe	60	freq = priv->mclk_freq;
af958c72	61	else if (clk_id == TWL6040_SYSCLK_SEL_LPPLL)
5e64d6aa	62	freq = 32768;
af958c72 PU	63	else
af958c72 PU	64	return -EINVAL;
5e64d6aa MLC	65
	66	/* set the codec mclk */
	67	ret = snd_soc_dai_set_sysclk(codec_dai, clk_id, freq,
	68	SND_SOC_CLOCK_IN);
	69	if (ret) {
	70	printk(KERN_ERR "can't set codec system clock\n");
	71	return ret;
	72	}
f0fba2ad	73	return ret;
5e64d6aa MLC	74	}
5e64d6aa MLC	75
13f81d65 PU	76	static struct snd_soc_ops omap_abe_ops = {
13f81d65 PU	77	.hw_params = omap_abe_hw_params,
5e64d6aa MLC	78	};
5e64d6aa MLC	79
13f81d65	80	static int omap_abe_dmic_hw_params(struct snd_pcm_substream *substream,
6524c8e3 PU	81	struct snd_pcm_hw_params *params)
	82	{
	83	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	84	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
	85	int ret = 0;
	86
	87	ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_DMIC_SYSCLK_PAD_CLKS,
	88	19200000, SND_SOC_CLOCK_IN);
	89	if (ret < 0) {
	90	printk(KERN_ERR "can't set DMIC cpu system clock\n");
	91	return ret;
	92	}
	93	ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_DMIC_ABE_DMIC_CLK, 2400000,
	94	SND_SOC_CLOCK_OUT);
	95	if (ret < 0) {
	96	printk(KERN_ERR "can't set DMIC output clock\n");
	97	return ret;
	98	}
	99	return 0;
	100	}
	101
13f81d65 PU	102	static struct snd_soc_ops omap_abe_dmic_ops = {
13f81d65 PU	103	.hw_params = omap_abe_dmic_hw_params,
6524c8e3 PU	104	};
6524c8e3 PU	105
96dc227c JEC	106	/* Headset jack */
	107	static struct snd_soc_jack hs_jack;
	108
	109	/Headset jack detection DAPM pins /
	110	static struct snd_soc_jack_pin hs_jack_pins[] = {
	111	{
	112	.pin = "Headset Mic",
	113	.mask = SND_JACK_MICROPHONE,
	114	},
	115	{
	116	.pin = "Headset Stereophone",
	117	.mask = SND_JACK_HEADPHONE,
	118	},
	119	};
	120
5e64d6aa	121	/* SDP4430 machine DAPM */
13f81d65	122	static const struct snd_soc_dapm_widget twl6040_dapm_widgets[] = {
b3208839	123	/* Outputs */
5e64d6aa	124	SND_SOC_DAPM_HP("Headset Stereophone", NULL),
7254e2bd	125	SND_SOC_DAPM_SPK("Earphone Spk", NULL),
b3208839 PU	126	SND_SOC_DAPM_SPK("Ext Spk", NULL),
	127	SND_SOC_DAPM_LINE("Line Out", NULL),
	128	SND_SOC_DAPM_SPK("Vibrator", NULL),
	129
	130	/* Inputs */
	131	SND_SOC_DAPM_MIC("Headset Mic", NULL),
	132	SND_SOC_DAPM_MIC("Main Handset Mic", NULL),
	133	SND_SOC_DAPM_MIC("Sub Handset Mic", NULL),
	134	SND_SOC_DAPM_LINE("Line In", NULL),
7d09f9e9 PU	135
	136	/* Digital microphones */
	137	SND_SOC_DAPM_MIC("Digital Mic", NULL),
5e64d6aa MLC	138	};
	139
	140	static const struct snd_soc_dapm_route audio_map[] = {
b3208839 PU	141	/* Routings for outputs */
	142	{"Headset Stereophone", NULL, "HSOL"},
	143	{"Headset Stereophone", NULL, "HSOR"},
	144
	145	{"Earphone Spk", NULL, "EP"},
5e64d6aa	146
5e64d6aa MLC	147	{"Ext Spk", NULL, "HFL"},
	148	{"Ext Spk", NULL, "HFR"},
	149
b3208839 PU	150	{"Line Out", NULL, "AUXL"},
	151	{"Line Out", NULL, "AUXR"},
	152
	153	{"Vibrator", NULL, "VIBRAL"},
	154	{"Vibrator", NULL, "VIBRAR"},
	155
	156	/* Routings for inputs */
778cee7a PU	157	{"HSMIC", NULL, "Headset Mic"},
778cee7a PU	158	{"Headset Mic", NULL, "Headset Mic Bias"},
5e64d6aa	159
b3208839 PU	160	{"MAINMIC", NULL, "Main Handset Mic"},
b3208839 PU	161	{"Main Handset Mic", NULL, "Main Mic Bias"},
7254e2bd	162
b3208839 PU	163	{"SUBMIC", NULL, "Sub Handset Mic"},
b3208839 PU	164	{"Sub Handset Mic", NULL, "Main Mic Bias"},
23ac3b61	165
b3208839 PU	166	{"AFML", NULL, "Line In"},
b3208839 PU	167	{"AFMR", NULL, "Line In"},
5e64d6aa MLC	168	};
5e64d6aa MLC	169
4ca07cb0 PU	170	static inline void twl6040_disconnect_pin(struct snd_soc_dapm_context *dapm,
	171	int connected, char *pin)
	172	{
	173	if (!connected)
	174	snd_soc_dapm_disable_pin(dapm, pin);
	175	}
	176
13f81d65	177	static int omap_abe_twl6040_init(struct snd_soc_pcm_runtime *rtd)
5e64d6aa	178	{
f0fba2ad	179	struct snd_soc_codec *codec = rtd->codec;
4ca07cb0 PU	180	struct snd_soc_card *card = codec->card;
	181	struct snd_soc_dapm_context *dapm = &codec->dapm;
	182	struct omap_abe_twl6040_data *pdata = dev_get_platdata(card->dev);
356bccbe	183	struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card);
4ca07cb0 PU	184	int hs_trim;
	185	int ret = 0;
	186
7bf3d92c PU	187	/*
	188	* Configure McPDM offset cancellation based on the HSOTRIM value from
	189	* twl6040.
	190	*/
	191	hs_trim = twl6040_get_trim_value(codec, TWL6040_TRIM_HSOTRIM);
	192	omap_mcpdm_configure_dn_offsets(rtd, TWL6040_HSF_TRIM_LEFT(hs_trim),
	193	TWL6040_HSF_TRIM_RIGHT(hs_trim));
	194
4ca07cb0	195	/* Headset jack detection only if it is supported */
356bccbe	196	if (priv->jack_detection) {
4ca07cb0 PU	197	ret = snd_soc_jack_new(codec, "Headset Jack",
	198	SND_JACK_HEADSET, &hs_jack);
	199	if (ret)
	200	return ret;
96dc227c	201
4ca07cb0 PU	202	ret = snd_soc_jack_add_pins(&hs_jack, ARRAY_SIZE(hs_jack_pins),
4ca07cb0 PU	203	hs_jack_pins);
96dc227c	204	twl6040_hs_jack_detect(codec, &hs_jack, SND_JACK_HEADSET);
4ca07cb0	205	}
5e64d6aa	206
5ef75e71 PU	207	/*
	208	* NULL pdata means we booted with DT. In this case the routing is
	209	* provided and the card is fully routed, no need to mark pins.
	210	*/
	211	if (!pdata)
	212	return ret;
	213
	214	/* Disable not connected paths if not used */
	215	twl6040_disconnect_pin(dapm, pdata->has_hs, "Headset Stereophone");
	216	twl6040_disconnect_pin(dapm, pdata->has_hf, "Ext Spk");
	217	twl6040_disconnect_pin(dapm, pdata->has_ep, "Earphone Spk");
	218	twl6040_disconnect_pin(dapm, pdata->has_aux, "Line Out");
034940a6	219	twl6040_disconnect_pin(dapm, pdata->has_vibra, "Vibrator");
5ef75e71 PU	220	twl6040_disconnect_pin(dapm, pdata->has_hsmic, "Headset Mic");
	221	twl6040_disconnect_pin(dapm, pdata->has_mainmic, "Main Handset Mic");
	222	twl6040_disconnect_pin(dapm, pdata->has_submic, "Sub Handset Mic");
	223	twl6040_disconnect_pin(dapm, pdata->has_afm, "Line In");
	224
5e64d6aa MLC	225	return ret;
	226	}
	227
6524c8e3	228	static const struct snd_soc_dapm_route dmic_audio_map[] = {
778cee7a PU	229	{"DMic", NULL, "Digital Mic"},
778cee7a PU	230	{"Digital Mic", NULL, "Digital Mic1 Bias"},
6524c8e3 PU	231	};
6524c8e3 PU	232
13f81d65	233	static int omap_abe_dmic_init(struct snd_soc_pcm_runtime *rtd)
6524c8e3 PU	234	{
	235	struct snd_soc_codec *codec = rtd->codec;
	236	struct snd_soc_dapm_context *dapm = &codec->dapm;
6524c8e3 PU	237
	238	return snd_soc_dapm_add_routes(dapm, dmic_audio_map,
	239	ARRAY_SIZE(dmic_audio_map));
	240	}
	241
5e64d6aa	242	/* Digital audio interface glue - connects codec <--> CPU */
c2f98956	243	static struct snd_soc_dai_link abe_twl6040_dai_links[] = {
6524c8e3 PU	244	{
	245	.name = "TWL6040",
	246	.stream_name = "TWL6040",
	247	.cpu_dai_name = "omap-mcpdm",
	248	.codec_dai_name = "twl6040-legacy",
	249	.platform_name = "omap-pcm-audio",
	250	.codec_name = "twl6040-codec",
13f81d65 PU	251	.init = omap_abe_twl6040_init,
13f81d65 PU	252	.ops = &omap_abe_ops,
6524c8e3 PU	253	},
	254	{
	255	.name = "DMIC",
	256	.stream_name = "DMIC Capture",
	257	.cpu_dai_name = "omap-dmic",
	258	.codec_dai_name = "dmic-hifi",
	259	.platform_name = "omap-pcm-audio",
	260	.codec_name = "dmic-codec",
13f81d65 PU	261	.init = omap_abe_dmic_init,
13f81d65 PU	262	.ops = &omap_abe_dmic_ops,
6524c8e3	263	},
5e64d6aa MLC	264	};
	265
	266	/* Audio machine driver */
13f81d65	267	static struct snd_soc_card omap_abe_card = {
b425b884	268	.owner = THIS_MODULE,
fc8e5b4c	269
13f81d65 PU	270	.dapm_widgets = twl6040_dapm_widgets,
13f81d65 PU	271	.num_dapm_widgets = ARRAY_SIZE(twl6040_dapm_widgets),
fc8e5b4c PU	272	.dapm_routes = audio_map,
fc8e5b4c PU	273	.num_dapm_routes = ARRAY_SIZE(audio_map),
5e64d6aa MLC	274	};
5e64d6aa MLC	275
d1be1d2f	276	static __devinit int omap_abe_probe(struct platform_device *pdev)
5e64d6aa	277	{
d1be1d2f	278	struct omap_abe_twl6040_data *pdata = dev_get_platdata(&pdev->dev);
5ef75e71	279	struct device_node *node = pdev->dev.of_node;
d1be1d2f	280	struct snd_soc_card *card = &omap_abe_card;
356bccbe	281	struct abe_twl6040 *priv;
c2f98956	282	int num_links = 0;
5ef75e71	283	int ret = 0;
5e64d6aa	284
d1be1d2f	285	card->dev = &pdev->dev;
5e64d6aa	286
356bccbe PU	287	priv = devm_kzalloc(&pdev->dev, sizeof(struct abe_twl6040), GFP_KERNEL);
	288	if (priv == NULL)
	289	return -ENOMEM;
	290
5ef75e71 PU	291	priv->dmic_codec_dev = ERR_PTR(-EINVAL);
	292
	293	if (node) {
	294	struct device_node *dai_node;
	295
	296	if (snd_soc_of_parse_card_name(card, "ti,model")) {
	297	dev_err(&pdev->dev, "Card name is not provided\n");
	298	return -ENODEV;
	299	}
	300
	301	ret = snd_soc_of_parse_audio_routing(card,
	302	"ti,audio-routing");
	303	if (ret) {
	304	dev_err(&pdev->dev,
	305	"Error while parsing DAPM routing\n");
	306	return ret;
	307	}
	308
	309	dai_node = of_parse_phandle(node, "ti,mcpdm", 0);
	310	if (!dai_node) {
	311	dev_err(&pdev->dev, "McPDM node is not provided\n");
	312	return -EINVAL;
	313	}
	314	abe_twl6040_dai_links[0].cpu_dai_name = NULL;
	315	abe_twl6040_dai_links[0].cpu_of_node = dai_node;
	316
	317	dai_node = of_parse_phandle(node, "ti,dmic", 0);
	318	if (dai_node) {
	319	num_links = 2;
	320	abe_twl6040_dai_links[1].cpu_dai_name = NULL;
	321	abe_twl6040_dai_links[1].cpu_of_node = dai_node;
	322
	323	priv->dmic_codec_dev = platform_device_register_simple(
	324	"dmic-codec", -1, NULL, 0);
	325	if (IS_ERR(priv->dmic_codec_dev)) {
	326	dev_err(&pdev->dev,
	327	"Can't instantiate dmic-codec\n");
	328	return PTR_ERR(priv->dmic_codec_dev);
	329	}
	330	} else {
	331	num_links = 1;
	332	}
	333
1c08e7e3 PU	334	priv->jack_detection = of_property_read_bool(node,
1c08e7e3 PU	335	"ti,jack-detection");
5ef75e71 PU	336	of_property_read_u32(node, "ti,mclk-freq",
	337	&priv->mclk_freq);
	338	if (!priv->mclk_freq) {
	339	dev_err(&pdev->dev, "MCLK frequency not provided\n");
	340	ret = -EINVAL;
	341	goto err_unregister;
	342	}
	343
	344	omap_abe_card.fully_routed = 1;
	345	} else if (pdata) {
	346	if (pdata->card_name) {
	347	card->name = pdata->card_name;
	348	} else {
	349	dev_err(&pdev->dev, "Card name is not provided\n");
	350	return -ENODEV;
	351	}
	352
	353	if (pdata->has_dmic)
	354	num_links = 2;
	355	else
	356	num_links = 1;
	357
	358	priv->jack_detection = pdata->jack_detection;
	359	priv->mclk_freq = pdata->mclk_freq;
d1be1d2f	360	} else {
5ef75e71	361	dev_err(&pdev->dev, "Missing pdata\n");
d1be1d2f PU	362	return -ENODEV;
d1be1d2f PU	363	}
5e64d6aa	364
356bccbe PU	365
356bccbe PU	366	if (!priv->mclk_freq) {
62ba98ce	367	dev_err(&pdev->dev, "MCLK frequency missing\n");
5ef75e71 PU	368	ret = -ENODEV;
5ef75e71 PU	369	goto err_unregister;
62ba98ce PU	370	}
62ba98ce PU	371
c2f98956 PU	372	card->dai_link = abe_twl6040_dai_links;
c2f98956 PU	373	card->num_links = num_links;
8d946dd7	374
356bccbe PU	375	snd_soc_card_set_drvdata(card, priv);
356bccbe PU	376
d1be1d2f	377	ret = snd_soc_register_card(card);
5ef75e71	378	if (ret) {
d1be1d2f PU	379	dev_err(&pdev->dev, "snd_soc_register_card() failed: %d\n",
d1be1d2f PU	380	ret);
5ef75e71 PU	381	goto err_unregister;
	382	}
	383
	384	return 0;
	385
	386	err_unregister:
	387	if (!IS_ERR(priv->dmic_codec_dev))
	388	platform_device_unregister(priv->dmic_codec_dev);
5e64d6aa	389
5e64d6aa MLC	390	return ret;
5e64d6aa MLC	391	}
5e64d6aa	392
d1be1d2f	393	static int __devexit omap_abe_remove(struct platform_device *pdev)
5e64d6aa	394	{
d1be1d2f	395	struct snd_soc_card *card = platform_get_drvdata(pdev);
5ef75e71	396	struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card);
d1be1d2f PU	397
	398	snd_soc_unregister_card(card);
	399
5ef75e71 PU	400	if (!IS_ERR(priv->dmic_codec_dev))
	401	platform_device_unregister(priv->dmic_codec_dev);
	402
d1be1d2f	403	return 0;
5e64d6aa	404	}
d1be1d2f	405
5ef75e71 PU	406	static const struct of_device_id omap_abe_of_match[] = {
	407	{.compatible = "ti,abe-twl6040", },
	408	{ },
	409	};
	410	MODULE_DEVICE_TABLE(of, omap_abe_of_match);
	411
d1be1d2f PU	412	static struct platform_driver omap_abe_driver = {
	413	.driver = {
	414	.name = "omap-abe-twl6040",
	415	.owner = THIS_MODULE,
	416	.pm = &snd_soc_pm_ops,
5ef75e71	417	.of_match_table = omap_abe_of_match,
d1be1d2f PU	418	},
	419	.probe = omap_abe_probe,
	420	.remove = __devexit_p(omap_abe_remove),
	421	};
	422
	423	module_platform_driver(omap_abe_driver);
5e64d6aa	424
8747a6b7	425	MODULE_AUTHOR("Misael Lopez Cruz <misael.lopez@ti.com>");
13f81d65	426	MODULE_DESCRIPTION("ALSA SoC for OMAP boards with ABE and twl6040 codec");
5e64d6aa	427	MODULE_LICENSE("GPL");
d1be1d2f	428	MODULE_ALIAS("platform:omap-abe-twl6040");