1
2
3
4
5
6
7
8
9#include <linux/clk.h>
10#include <linux/platform_device.h>
11#include <linux/mfd/twl6040.h>
12#include <linux/module.h>
13#include <linux/of.h>
14
15#include <sound/core.h>
16#include <sound/pcm.h>
17#include <sound/soc.h>
18#include <sound/jack.h>
19
20#include "omap-dmic.h"
21#include "omap-mcpdm.h"
22#include "../codecs/twl6040.h"
23
24struct abe_twl6040 {
25 struct snd_soc_card card;
26 struct snd_soc_dai_link dai_links[2];
27 int jack_detection;
28 int mclk_freq;
29};
30
31static struct platform_device *dmic_codec_dev;
32
33static int omap_abe_hw_params(struct snd_pcm_substream *substream,
34 struct snd_pcm_hw_params *params)
35{
36 struct snd_soc_pcm_runtime *rtd = substream->private_data;
37 struct snd_soc_dai *codec_dai = rtd->codec_dai;
38 struct snd_soc_card *card = rtd->card;
39 struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card);
40 int clk_id, freq;
41 int ret;
42
43 clk_id = twl6040_get_clk_id(codec_dai->component);
44 if (clk_id == TWL6040_SYSCLK_SEL_HPPLL)
45 freq = priv->mclk_freq;
46 else if (clk_id == TWL6040_SYSCLK_SEL_LPPLL)
47 freq = 32768;
48 else
49 return -EINVAL;
50
51
52 ret = snd_soc_dai_set_sysclk(codec_dai, clk_id, freq,
53 SND_SOC_CLOCK_IN);
54 if (ret) {
55 printk(KERN_ERR "can't set codec system clock\n");
56 return ret;
57 }
58 return ret;
59}
60
61static const struct snd_soc_ops omap_abe_ops = {
62 .hw_params = omap_abe_hw_params,
63};
64
65static int omap_abe_dmic_hw_params(struct snd_pcm_substream *substream,
66 struct snd_pcm_hw_params *params)
67{
68 struct snd_soc_pcm_runtime *rtd = substream->private_data;
69 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
70 int ret = 0;
71
72 ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_DMIC_SYSCLK_PAD_CLKS,
73 19200000, SND_SOC_CLOCK_IN);
74 if (ret < 0) {
75 printk(KERN_ERR "can't set DMIC cpu system clock\n");
76 return ret;
77 }
78 ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_DMIC_ABE_DMIC_CLK, 2400000,
79 SND_SOC_CLOCK_OUT);
80 if (ret < 0) {
81 printk(KERN_ERR "can't set DMIC output clock\n");
82 return ret;
83 }
84 return 0;
85}
86
87static struct snd_soc_ops omap_abe_dmic_ops = {
88 .hw_params = omap_abe_dmic_hw_params,
89};
90
91
92static struct snd_soc_jack hs_jack;
93
94
95static struct snd_soc_jack_pin hs_jack_pins[] = {
96 {
97 .pin = "Headset Mic",
98 .mask = SND_JACK_MICROPHONE,
99 },
100 {
101 .pin = "Headset Stereophone",
102 .mask = SND_JACK_HEADPHONE,
103 },
104};
105
106
107static const struct snd_soc_dapm_widget twl6040_dapm_widgets[] = {
108
109 SND_SOC_DAPM_HP("Headset Stereophone", NULL),
110 SND_SOC_DAPM_SPK("Earphone Spk", NULL),
111 SND_SOC_DAPM_SPK("Ext Spk", NULL),
112 SND_SOC_DAPM_LINE("Line Out", NULL),
113 SND_SOC_DAPM_SPK("Vibrator", NULL),
114
115
116 SND_SOC_DAPM_MIC("Headset Mic", NULL),
117 SND_SOC_DAPM_MIC("Main Handset Mic", NULL),
118 SND_SOC_DAPM_MIC("Sub Handset Mic", NULL),
119 SND_SOC_DAPM_LINE("Line In", NULL),
120
121
122 SND_SOC_DAPM_MIC("Digital Mic", NULL),
123};
124
125static const struct snd_soc_dapm_route audio_map[] = {
126
127 {"Headset Stereophone", NULL, "HSOL"},
128 {"Headset Stereophone", NULL, "HSOR"},
129
130 {"Earphone Spk", NULL, "EP"},
131
132 {"Ext Spk", NULL, "HFL"},
133 {"Ext Spk", NULL, "HFR"},
134
135 {"Line Out", NULL, "AUXL"},
136 {"Line Out", NULL, "AUXR"},
137
138 {"Vibrator", NULL, "VIBRAL"},
139 {"Vibrator", NULL, "VIBRAR"},
140
141
142 {"HSMIC", NULL, "Headset Mic"},
143 {"Headset Mic", NULL, "Headset Mic Bias"},
144
145 {"MAINMIC", NULL, "Main Handset Mic"},
146 {"Main Handset Mic", NULL, "Main Mic Bias"},
147
148 {"SUBMIC", NULL, "Sub Handset Mic"},
149 {"Sub Handset Mic", NULL, "Main Mic Bias"},
150
151 {"AFML", NULL, "Line In"},
152 {"AFMR", NULL, "Line In"},
153};
154
155static int omap_abe_twl6040_init(struct snd_soc_pcm_runtime *rtd)
156{
157 struct snd_soc_component *component = rtd->codec_dai->component;
158 struct snd_soc_card *card = rtd->card;
159 struct abe_twl6040 *priv = snd_soc_card_get_drvdata(card);
160 int hs_trim;
161 int ret = 0;
162
163
164
165
166
167 hs_trim = twl6040_get_trim_value(component, TWL6040_TRIM_HSOTRIM);
168 omap_mcpdm_configure_dn_offsets(rtd, TWL6040_HSF_TRIM_LEFT(hs_trim),
169 TWL6040_HSF_TRIM_RIGHT(hs_trim));
170
171
172 if (priv->jack_detection) {
173 ret = snd_soc_card_jack_new(rtd->card, "Headset Jack",
174 SND_JACK_HEADSET, &hs_jack,
175 hs_jack_pins,
176 ARRAY_SIZE(hs_jack_pins));
177 if (ret)
178 return ret;
179
180 twl6040_hs_jack_detect(component, &hs_jack, SND_JACK_HEADSET);
181 }
182
183 return 0;
184}
185
186static const struct snd_soc_dapm_route dmic_audio_map[] = {
187 {"DMic", NULL, "Digital Mic"},
188 {"Digital Mic", NULL, "Digital Mic1 Bias"},
189};
190
191static int omap_abe_dmic_init(struct snd_soc_pcm_runtime *rtd)
192{
193 struct snd_soc_dapm_context *dapm = &rtd->card->dapm;
194
195 return snd_soc_dapm_add_routes(dapm, dmic_audio_map,
196 ARRAY_SIZE(dmic_audio_map));
197}
198
199static int omap_abe_probe(struct platform_device *pdev)
200{
201 struct device_node *node = pdev->dev.of_node;
202 struct snd_soc_card *card;
203 struct device_node *dai_node;
204 struct abe_twl6040 *priv;
205 int num_links = 0;
206 int ret = 0;
207
208 if (!node) {
209 dev_err(&pdev->dev, "of node is missing.\n");
210 return -ENODEV;
211 }
212
213 priv = devm_kzalloc(&pdev->dev, sizeof(struct abe_twl6040), GFP_KERNEL);
214 if (priv == NULL)
215 return -ENOMEM;
216
217 card = &priv->card;
218 card->dev = &pdev->dev;
219 card->owner = THIS_MODULE;
220 card->dapm_widgets = twl6040_dapm_widgets;
221 card->num_dapm_widgets = ARRAY_SIZE(twl6040_dapm_widgets);
222 card->dapm_routes = audio_map;
223 card->num_dapm_routes = ARRAY_SIZE(audio_map);
224
225 if (snd_soc_of_parse_card_name(card, "ti,model")) {
226 dev_err(&pdev->dev, "Card name is not provided\n");
227 return -ENODEV;
228 }
229
230 ret = snd_soc_of_parse_audio_routing(card, "ti,audio-routing");
231 if (ret) {
232 dev_err(&pdev->dev, "Error while parsing DAPM routing\n");
233 return ret;
234 }
235
236 dai_node = of_parse_phandle(node, "ti,mcpdm", 0);
237 if (!dai_node) {
238 dev_err(&pdev->dev, "McPDM node is not provided\n");
239 return -EINVAL;
240 }
241
242 priv->dai_links[0].name = "DMIC";
243 priv->dai_links[0].stream_name = "TWL6040";
244 priv->dai_links[0].cpu_of_node = dai_node;
245 priv->dai_links[0].platform_of_node = dai_node;
246 priv->dai_links[0].codec_dai_name = "twl6040-legacy";
247 priv->dai_links[0].codec_name = "twl6040-codec";
248 priv->dai_links[0].init = omap_abe_twl6040_init;
249 priv->dai_links[0].ops = &omap_abe_ops;
250
251 dai_node = of_parse_phandle(node, "ti,dmic", 0);
252 if (dai_node) {
253 num_links = 2;
254 priv->dai_links[1].name = "TWL6040";
255 priv->dai_links[1].stream_name = "DMIC Capture";
256 priv->dai_links[1].cpu_of_node = dai_node;
257 priv->dai_links[1].platform_of_node = dai_node;
258 priv->dai_links[1].codec_dai_name = "dmic-hifi";
259 priv->dai_links[1].codec_name = "dmic-codec";
260 priv->dai_links[1].init = omap_abe_dmic_init;
261 priv->dai_links[1].ops = &omap_abe_dmic_ops;
262 } else {
263 num_links = 1;
264 }
265
266 priv->jack_detection = of_property_read_bool(node, "ti,jack-detection");
267 of_property_read_u32(node, "ti,mclk-freq", &priv->mclk_freq);
268 if (!priv->mclk_freq) {
269 dev_err(&pdev->dev, "MCLK frequency not provided\n");
270 return -EINVAL;
271 }
272
273 card->fully_routed = 1;
274
275 if (!priv->mclk_freq) {
276 dev_err(&pdev->dev, "MCLK frequency missing\n");
277 return -ENODEV;
278 }
279
280 card->dai_link = priv->dai_links;
281 card->num_links = num_links;
282
283 snd_soc_card_set_drvdata(card, priv);
284
285 ret = devm_snd_soc_register_card(&pdev->dev, card);
286 if (ret)
287 dev_err(&pdev->dev, "devm_snd_soc_register_card() failed: %d\n",
288 ret);
289
290 return ret;
291}
292
293static const struct of_device_id omap_abe_of_match[] = {
294 {.compatible = "ti,abe-twl6040", },
295 { },
296};
297MODULE_DEVICE_TABLE(of, omap_abe_of_match);
298
299static struct platform_driver omap_abe_driver = {
300 .driver = {
301 .name = "omap-abe-twl6040",
302 .pm = &snd_soc_pm_ops,
303 .of_match_table = omap_abe_of_match,
304 },
305 .probe = omap_abe_probe,
306};
307
308static int __init omap_abe_init(void)
309{
310 int ret;
311
312 dmic_codec_dev = platform_device_register_simple("dmic-codec", -1, NULL,
313 0);
314 if (IS_ERR(dmic_codec_dev)) {
315 pr_err("%s: dmic-codec device registration failed\n", __func__);
316 return PTR_ERR(dmic_codec_dev);
317 }
318
319 ret = platform_driver_register(&omap_abe_driver);
320 if (ret) {
321 pr_err("%s: platform driver registration failed\n", __func__);
322 platform_device_unregister(dmic_codec_dev);
323 }
324
325 return ret;
326}
327module_init(omap_abe_init);
328
329static void __exit omap_abe_exit(void)
330{
331 platform_driver_unregister(&omap_abe_driver);
332 platform_device_unregister(dmic_codec_dev);
333}
334module_exit(omap_abe_exit);
335
336MODULE_AUTHOR("Misael Lopez Cruz <misael.lopez@ti.com>");
337MODULE_DESCRIPTION("ALSA SoC for OMAP boards with ABE and twl6040 codec");
338MODULE_LICENSE("GPL");
339MODULE_ALIAS("platform:omap-abe-twl6040");
340