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