1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (c) 2018, The Linux Foundation. All rights reserved.
4 */
5
6 #include <linux/module.h>
7 #include <linux/platform_device.h>
8 #include <linux/of_device.h>
9 #include <sound/core.h>
10 #include <sound/pcm.h>
11 #include <sound/pcm_params.h>
12 #include <sound/jack.h>
13 #include <sound/soc.h>
14 #include <linux/soundwire/sdw.h>
15 #include <uapi/linux/input-event-codes.h>
16 #include "common.h"
17 #include "qdsp6/q6afe.h"
18 #include "../codecs/rt5663.h"
19
20 #define DRIVER_NAME "sdm845"
21 #define DEFAULT_SAMPLE_RATE_48K 48000
22 #define DEFAULT_MCLK_RATE 24576000
23 #define TDM_BCLK_RATE 6144000
24 #define MI2S_BCLK_RATE 1536000
25 #define LEFT_SPK_TDM_TX_MASK 0x30
26 #define RIGHT_SPK_TDM_TX_MASK 0xC0
27 #define SPK_TDM_RX_MASK 0x03
28 #define NUM_TDM_SLOTS 8
29 #define SLIM_MAX_TX_PORTS 16
30 #define SLIM_MAX_RX_PORTS 13
31 #define WCD934X_DEFAULT_MCLK_RATE 9600000
32
33 struct sdm845_snd_data {
34 struct snd_soc_jack jack;
35 bool jack_setup;
36 bool slim_port_setup;
37 bool stream_prepared[AFE_PORT_MAX];
38 struct snd_soc_card *card;
39 uint32_t pri_mi2s_clk_count;
40 uint32_t sec_mi2s_clk_count;
41 uint32_t quat_tdm_clk_count;
42 struct sdw_stream_runtime *sruntime[AFE_PORT_MAX];
43 };
44
45 static struct snd_soc_jack_pin sdm845_jack_pins[] = {
46 {
47 .pin = "Headphone Jack",
48 .mask = SND_JACK_HEADPHONE,
49 },
50 {
51 .pin = "Headset Mic",
52 .mask = SND_JACK_MICROPHONE,
53 },
54 };
55
56 static unsigned int tdm_slot_offset[8] = {0, 4, 8, 12, 16, 20, 24, 28};
57
sdm845_slim_snd_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params)58 static int sdm845_slim_snd_hw_params(struct snd_pcm_substream *substream,
59 struct snd_pcm_hw_params *params)
60 {
61 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
62 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
63 struct snd_soc_dai *codec_dai;
64 struct sdm845_snd_data *pdata = snd_soc_card_get_drvdata(rtd->card);
65 u32 rx_ch[SLIM_MAX_RX_PORTS], tx_ch[SLIM_MAX_TX_PORTS];
66 struct sdw_stream_runtime *sruntime;
67 u32 rx_ch_cnt = 0, tx_ch_cnt = 0;
68 int ret = 0, i;
69
70 for_each_rtd_codec_dais(rtd, i, codec_dai) {
71 sruntime = snd_soc_dai_get_stream(codec_dai,
72 substream->stream);
73 if (sruntime != ERR_PTR(-ENOTSUPP))
74 pdata->sruntime[cpu_dai->id] = sruntime;
75
76 ret = snd_soc_dai_get_channel_map(codec_dai,
77 &tx_ch_cnt, tx_ch, &rx_ch_cnt, rx_ch);
78
79 if (ret != 0 && ret != -ENOTSUPP) {
80 pr_err("failed to get codec chan map, err:%d\n", ret);
81 return ret;
82 } else if (ret == -ENOTSUPP) {
83 /* Ignore unsupported */
84 continue;
85 }
86
87 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
88 ret = snd_soc_dai_set_channel_map(cpu_dai, 0, NULL,
89 rx_ch_cnt, rx_ch);
90 else
91 ret = snd_soc_dai_set_channel_map(cpu_dai, tx_ch_cnt,
92 tx_ch, 0, NULL);
93 }
94
95 return 0;
96 }
97
sdm845_tdm_snd_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params)98 static int sdm845_tdm_snd_hw_params(struct snd_pcm_substream *substream,
99 struct snd_pcm_hw_params *params)
100 {
101 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
102 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
103 struct snd_soc_dai *codec_dai;
104 int ret = 0, j;
105 int channels, slot_width;
106
107 switch (params_format(params)) {
108 case SNDRV_PCM_FORMAT_S16_LE:
109 slot_width = 16;
110 break;
111 default:
112 dev_err(rtd->dev, "%s: invalid param format 0x%x\n",
113 __func__, params_format(params));
114 return -EINVAL;
115 }
116
117 channels = params_channels(params);
118 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
119 ret = snd_soc_dai_set_tdm_slot(cpu_dai, 0, 0x3,
120 8, slot_width);
121 if (ret < 0) {
122 dev_err(rtd->dev, "%s: failed to set tdm slot, err:%d\n",
123 __func__, ret);
124 goto end;
125 }
126
127 ret = snd_soc_dai_set_channel_map(cpu_dai, 0, NULL,
128 channels, tdm_slot_offset);
129 if (ret < 0) {
130 dev_err(rtd->dev, "%s: failed to set channel map, err:%d\n",
131 __func__, ret);
132 goto end;
133 }
134 } else {
135 ret = snd_soc_dai_set_tdm_slot(cpu_dai, 0xf, 0,
136 8, slot_width);
137 if (ret < 0) {
138 dev_err(rtd->dev, "%s: failed to set tdm slot, err:%d\n",
139 __func__, ret);
140 goto end;
141 }
142
143 ret = snd_soc_dai_set_channel_map(cpu_dai, channels,
144 tdm_slot_offset, 0, NULL);
145 if (ret < 0) {
146 dev_err(rtd->dev, "%s: failed to set channel map, err:%d\n",
147 __func__, ret);
148 goto end;
149 }
150 }
151
152 for_each_rtd_codec_dais(rtd, j, codec_dai) {
153
154 if (!strcmp(codec_dai->component->name_prefix, "Left")) {
155 ret = snd_soc_dai_set_tdm_slot(
156 codec_dai, LEFT_SPK_TDM_TX_MASK,
157 SPK_TDM_RX_MASK, NUM_TDM_SLOTS,
158 slot_width);
159 if (ret < 0) {
160 dev_err(rtd->dev,
161 "DEV0 TDM slot err:%d\n", ret);
162 return ret;
163 }
164 }
165
166 if (!strcmp(codec_dai->component->name_prefix, "Right")) {
167 ret = snd_soc_dai_set_tdm_slot(
168 codec_dai, RIGHT_SPK_TDM_TX_MASK,
169 SPK_TDM_RX_MASK, NUM_TDM_SLOTS,
170 slot_width);
171 if (ret < 0) {
172 dev_err(rtd->dev,
173 "DEV1 TDM slot err:%d\n", ret);
174 return ret;
175 }
176 }
177 }
178
179 end:
180 return ret;
181 }
182
sdm845_snd_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params)183 static int sdm845_snd_hw_params(struct snd_pcm_substream *substream,
184 struct snd_pcm_hw_params *params)
185 {
186 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
187 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
188 struct snd_soc_dai *codec_dai = snd_soc_rtd_to_codec(rtd, 0);
189 int ret = 0;
190
191 switch (cpu_dai->id) {
192 case PRIMARY_MI2S_RX:
193 case PRIMARY_MI2S_TX:
194 /*
195 * Use ASRC for internal clocks, as PLL rate isn't multiple
196 * of BCLK.
197 */
198 rt5663_sel_asrc_clk_src(
199 codec_dai->component,
200 RT5663_DA_STEREO_FILTER | RT5663_AD_STEREO_FILTER,
201 RT5663_CLK_SEL_I2S1_ASRC);
202 ret = snd_soc_dai_set_sysclk(
203 codec_dai, RT5663_SCLK_S_MCLK, DEFAULT_MCLK_RATE,
204 SND_SOC_CLOCK_IN);
205 if (ret < 0)
206 dev_err(rtd->dev,
207 "snd_soc_dai_set_sysclk err = %d\n", ret);
208 break;
209 case QUATERNARY_TDM_RX_0:
210 case QUATERNARY_TDM_TX_0:
211 ret = sdm845_tdm_snd_hw_params(substream, params);
212 break;
213 case SLIMBUS_0_RX...SLIMBUS_6_TX:
214 ret = sdm845_slim_snd_hw_params(substream, params);
215 break;
216 case QUATERNARY_MI2S_RX:
217 break;
218 default:
219 pr_err("%s: invalid dai id 0x%x\n", __func__, cpu_dai->id);
220 break;
221 }
222 return ret;
223 }
224
sdm845_jack_free(struct snd_jack * jack)225 static void sdm845_jack_free(struct snd_jack *jack)
226 {
227 struct snd_soc_component *component = jack->private_data;
228
229 snd_soc_component_set_jack(component, NULL, NULL);
230 }
231
sdm845_dai_init(struct snd_soc_pcm_runtime * rtd)232 static int sdm845_dai_init(struct snd_soc_pcm_runtime *rtd)
233 {
234 struct snd_soc_component *component;
235 struct snd_soc_card *card = rtd->card;
236 struct snd_soc_dai *codec_dai = snd_soc_rtd_to_codec(rtd, 0);
237 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
238 struct sdm845_snd_data *pdata = snd_soc_card_get_drvdata(card);
239 struct snd_soc_dai_link *link = rtd->dai_link;
240 struct snd_jack *jack;
241 /*
242 * Codec SLIMBUS configuration
243 * RX1, RX2, RX3, RX4, RX5, RX6, RX7, RX8, RX9, RX10, RX11, RX12, RX13
244 * TX1, TX2, TX3, TX4, TX5, TX6, TX7, TX8, TX9, TX10, TX11, TX12, TX13
245 * TX14, TX15, TX16
246 */
247 unsigned int rx_ch[SLIM_MAX_RX_PORTS] = {144, 145, 146, 147, 148, 149,
248 150, 151, 152, 153, 154, 155, 156};
249 unsigned int tx_ch[SLIM_MAX_TX_PORTS] = {128, 129, 130, 131, 132, 133,
250 134, 135, 136, 137, 138, 139,
251 140, 141, 142, 143};
252 int rval, i;
253
254
255 if (!pdata->jack_setup) {
256 rval = snd_soc_card_jack_new_pins(card, "Headset Jack",
257 SND_JACK_HEADSET |
258 SND_JACK_HEADPHONE |
259 SND_JACK_BTN_0 | SND_JACK_BTN_1 |
260 SND_JACK_BTN_2 | SND_JACK_BTN_3,
261 &pdata->jack,
262 sdm845_jack_pins,
263 ARRAY_SIZE(sdm845_jack_pins));
264
265 if (rval < 0) {
266 dev_err(card->dev, "Unable to add Headphone Jack\n");
267 return rval;
268 }
269
270 jack = pdata->jack.jack;
271
272 snd_jack_set_key(jack, SND_JACK_BTN_0, KEY_PLAYPAUSE);
273 snd_jack_set_key(jack, SND_JACK_BTN_1, KEY_VOICECOMMAND);
274 snd_jack_set_key(jack, SND_JACK_BTN_2, KEY_VOLUMEUP);
275 snd_jack_set_key(jack, SND_JACK_BTN_3, KEY_VOLUMEDOWN);
276 pdata->jack_setup = true;
277 }
278
279 switch (cpu_dai->id) {
280 case PRIMARY_MI2S_RX:
281 jack = pdata->jack.jack;
282 component = codec_dai->component;
283
284 jack->private_data = component;
285 jack->private_free = sdm845_jack_free;
286 rval = snd_soc_component_set_jack(component,
287 &pdata->jack, NULL);
288 if (rval != 0 && rval != -ENOTSUPP) {
289 dev_warn(card->dev, "Failed to set jack: %d\n", rval);
290 return rval;
291 }
292 break;
293 case SLIMBUS_0_RX...SLIMBUS_6_TX:
294 /* setting up wcd multiple times for slim port is redundant */
295 if (pdata->slim_port_setup || !link->no_pcm)
296 return 0;
297
298 for_each_rtd_codec_dais(rtd, i, codec_dai) {
299 rval = snd_soc_dai_set_channel_map(codec_dai,
300 ARRAY_SIZE(tx_ch),
301 tx_ch,
302 ARRAY_SIZE(rx_ch),
303 rx_ch);
304 if (rval != 0 && rval != -ENOTSUPP)
305 return rval;
306
307 snd_soc_dai_set_sysclk(codec_dai, 0,
308 WCD934X_DEFAULT_MCLK_RATE,
309 SNDRV_PCM_STREAM_PLAYBACK);
310
311 rval = snd_soc_component_set_jack(codec_dai->component,
312 &pdata->jack, NULL);
313 if (rval != 0 && rval != -ENOTSUPP) {
314 dev_warn(card->dev, "Failed to set jack: %d\n", rval);
315 return rval;
316 }
317 }
318
319 pdata->slim_port_setup = true;
320
321 break;
322 default:
323 break;
324 }
325
326 return 0;
327 }
328
329
sdm845_snd_startup(struct snd_pcm_substream * substream)330 static int sdm845_snd_startup(struct snd_pcm_substream *substream)
331 {
332 unsigned int fmt = SND_SOC_DAIFMT_BP_FP;
333 unsigned int codec_dai_fmt = SND_SOC_DAIFMT_BC_FC;
334 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
335 struct snd_soc_card *card = rtd->card;
336 struct sdm845_snd_data *data = snd_soc_card_get_drvdata(card);
337 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
338 struct snd_soc_dai *codec_dai = snd_soc_rtd_to_codec(rtd, 0);
339 int j;
340 int ret;
341
342 switch (cpu_dai->id) {
343 case PRIMARY_MI2S_RX:
344 case PRIMARY_MI2S_TX:
345 codec_dai_fmt |= SND_SOC_DAIFMT_NB_NF;
346 if (++(data->pri_mi2s_clk_count) == 1) {
347 snd_soc_dai_set_sysclk(cpu_dai,
348 Q6AFE_LPASS_CLK_ID_MCLK_1,
349 DEFAULT_MCLK_RATE, SNDRV_PCM_STREAM_PLAYBACK);
350 snd_soc_dai_set_sysclk(cpu_dai,
351 Q6AFE_LPASS_CLK_ID_PRI_MI2S_IBIT,
352 MI2S_BCLK_RATE, SNDRV_PCM_STREAM_PLAYBACK);
353 }
354 snd_soc_dai_set_fmt(cpu_dai, fmt);
355 snd_soc_dai_set_fmt(codec_dai, codec_dai_fmt);
356 break;
357
358 case SECONDARY_MI2S_TX:
359 codec_dai_fmt |= SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_I2S;
360 if (++(data->sec_mi2s_clk_count) == 1) {
361 snd_soc_dai_set_sysclk(cpu_dai,
362 Q6AFE_LPASS_CLK_ID_SEC_MI2S_IBIT,
363 MI2S_BCLK_RATE, SNDRV_PCM_STREAM_CAPTURE);
364 }
365 snd_soc_dai_set_fmt(cpu_dai, fmt);
366 snd_soc_dai_set_fmt(codec_dai, codec_dai_fmt);
367 break;
368 case QUATERNARY_MI2S_RX:
369 snd_soc_dai_set_sysclk(cpu_dai,
370 Q6AFE_LPASS_CLK_ID_QUAD_MI2S_IBIT,
371 MI2S_BCLK_RATE, SNDRV_PCM_STREAM_PLAYBACK);
372 snd_soc_dai_set_fmt(cpu_dai, fmt);
373
374
375 break;
376
377 case QUATERNARY_TDM_RX_0:
378 case QUATERNARY_TDM_TX_0:
379 if (++(data->quat_tdm_clk_count) == 1) {
380 snd_soc_dai_set_sysclk(cpu_dai,
381 Q6AFE_LPASS_CLK_ID_QUAD_TDM_IBIT,
382 TDM_BCLK_RATE, SNDRV_PCM_STREAM_PLAYBACK);
383 }
384
385 codec_dai_fmt |= SND_SOC_DAIFMT_IB_NF | SND_SOC_DAIFMT_DSP_B;
386
387 for_each_rtd_codec_dais(rtd, j, codec_dai) {
388
389 if (!strcmp(codec_dai->component->name_prefix,
390 "Left")) {
391 ret = snd_soc_dai_set_fmt(
392 codec_dai, codec_dai_fmt);
393 if (ret < 0) {
394 dev_err(rtd->dev,
395 "Left TDM fmt err:%d\n", ret);
396 return ret;
397 }
398 }
399
400 if (!strcmp(codec_dai->component->name_prefix,
401 "Right")) {
402 ret = snd_soc_dai_set_fmt(
403 codec_dai, codec_dai_fmt);
404 if (ret < 0) {
405 dev_err(rtd->dev,
406 "Right TDM slot err:%d\n", ret);
407 return ret;
408 }
409 }
410 }
411 break;
412 case SLIMBUS_0_RX...SLIMBUS_6_TX:
413 break;
414
415 default:
416 pr_err("%s: invalid dai id 0x%x\n", __func__, cpu_dai->id);
417 break;
418 }
419 return 0;
420 }
421
sdm845_snd_shutdown(struct snd_pcm_substream * substream)422 static void sdm845_snd_shutdown(struct snd_pcm_substream *substream)
423 {
424 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
425 struct snd_soc_card *card = rtd->card;
426 struct sdm845_snd_data *data = snd_soc_card_get_drvdata(card);
427 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
428
429 switch (cpu_dai->id) {
430 case PRIMARY_MI2S_RX:
431 case PRIMARY_MI2S_TX:
432 if (--(data->pri_mi2s_clk_count) == 0) {
433 snd_soc_dai_set_sysclk(cpu_dai,
434 Q6AFE_LPASS_CLK_ID_MCLK_1,
435 0, SNDRV_PCM_STREAM_PLAYBACK);
436 snd_soc_dai_set_sysclk(cpu_dai,
437 Q6AFE_LPASS_CLK_ID_PRI_MI2S_IBIT,
438 0, SNDRV_PCM_STREAM_PLAYBACK);
439 }
440 break;
441
442 case SECONDARY_MI2S_TX:
443 if (--(data->sec_mi2s_clk_count) == 0) {
444 snd_soc_dai_set_sysclk(cpu_dai,
445 Q6AFE_LPASS_CLK_ID_SEC_MI2S_IBIT,
446 0, SNDRV_PCM_STREAM_CAPTURE);
447 }
448 break;
449
450 case QUATERNARY_TDM_RX_0:
451 case QUATERNARY_TDM_TX_0:
452 if (--(data->quat_tdm_clk_count) == 0) {
453 snd_soc_dai_set_sysclk(cpu_dai,
454 Q6AFE_LPASS_CLK_ID_QUAD_TDM_IBIT,
455 0, SNDRV_PCM_STREAM_PLAYBACK);
456 }
457 break;
458 case SLIMBUS_0_RX...SLIMBUS_6_TX:
459 case QUATERNARY_MI2S_RX:
460 break;
461
462 default:
463 pr_err("%s: invalid dai id 0x%x\n", __func__, cpu_dai->id);
464 break;
465 }
466 }
467
sdm845_snd_prepare(struct snd_pcm_substream * substream)468 static int sdm845_snd_prepare(struct snd_pcm_substream *substream)
469 {
470 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
471 struct sdm845_snd_data *data = snd_soc_card_get_drvdata(rtd->card);
472 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
473 struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id];
474 int ret;
475
476 if (!sruntime)
477 return 0;
478
479 if (data->stream_prepared[cpu_dai->id]) {
480 sdw_disable_stream(sruntime);
481 sdw_deprepare_stream(sruntime);
482 data->stream_prepared[cpu_dai->id] = false;
483 }
484
485 ret = sdw_prepare_stream(sruntime);
486 if (ret)
487 return ret;
488
489 /**
490 * NOTE: there is a strict hw requirement about the ordering of port
491 * enables and actual WSA881x PA enable. PA enable should only happen
492 * after soundwire ports are enabled if not DC on the line is
493 * accumulated resulting in Click/Pop Noise
494 * PA enable/mute are handled as part of codec DAPM and digital mute.
495 */
496
497 ret = sdw_enable_stream(sruntime);
498 if (ret) {
499 sdw_deprepare_stream(sruntime);
500 return ret;
501 }
502 data->stream_prepared[cpu_dai->id] = true;
503
504 return ret;
505 }
506
sdm845_snd_hw_free(struct snd_pcm_substream * substream)507 static int sdm845_snd_hw_free(struct snd_pcm_substream *substream)
508 {
509 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
510 struct sdm845_snd_data *data = snd_soc_card_get_drvdata(rtd->card);
511 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
512 struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id];
513
514 if (sruntime && data->stream_prepared[cpu_dai->id]) {
515 sdw_disable_stream(sruntime);
516 sdw_deprepare_stream(sruntime);
517 data->stream_prepared[cpu_dai->id] = false;
518 }
519
520 return 0;
521 }
522
523 static const struct snd_soc_ops sdm845_be_ops = {
524 .hw_params = sdm845_snd_hw_params,
525 .hw_free = sdm845_snd_hw_free,
526 .prepare = sdm845_snd_prepare,
527 .startup = sdm845_snd_startup,
528 .shutdown = sdm845_snd_shutdown,
529 };
530
sdm845_be_hw_params_fixup(struct snd_soc_pcm_runtime * rtd,struct snd_pcm_hw_params * params)531 static int sdm845_be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd,
532 struct snd_pcm_hw_params *params)
533 {
534 struct snd_interval *rate = hw_param_interval(params,
535 SNDRV_PCM_HW_PARAM_RATE);
536 struct snd_interval *channels = hw_param_interval(params,
537 SNDRV_PCM_HW_PARAM_CHANNELS);
538 struct snd_mask *fmt = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
539
540 rate->min = rate->max = DEFAULT_SAMPLE_RATE_48K;
541 channels->min = channels->max = 2;
542 snd_mask_set_format(fmt, SNDRV_PCM_FORMAT_S16_LE);
543
544 return 0;
545 }
546
547 static const struct snd_soc_dapm_widget sdm845_snd_widgets[] = {
548 SND_SOC_DAPM_HP("Headphone Jack", NULL),
549 SND_SOC_DAPM_MIC("Headset Mic", NULL),
550 SND_SOC_DAPM_SPK("Left Spk", NULL),
551 SND_SOC_DAPM_SPK("Right Spk", NULL),
552 SND_SOC_DAPM_MIC("Int Mic", NULL),
553 };
554
555 static const struct snd_kcontrol_new sdm845_snd_controls[] = {
556 SOC_DAPM_PIN_SWITCH("Headphone Jack"),
557 SOC_DAPM_PIN_SWITCH("Headset Mic"),
558 };
559
sdm845_add_ops(struct snd_soc_card * card)560 static void sdm845_add_ops(struct snd_soc_card *card)
561 {
562 struct snd_soc_dai_link *link;
563 int i;
564
565 for_each_card_prelinks(card, i, link) {
566 if (link->no_pcm == 1) {
567 link->ops = &sdm845_be_ops;
568 link->be_hw_params_fixup = sdm845_be_hw_params_fixup;
569 }
570 link->init = sdm845_dai_init;
571 }
572 }
573
sdm845_snd_platform_probe(struct platform_device * pdev)574 static int sdm845_snd_platform_probe(struct platform_device *pdev)
575 {
576 struct snd_soc_card *card;
577 struct sdm845_snd_data *data;
578 struct device *dev = &pdev->dev;
579 int ret;
580
581 card = devm_kzalloc(dev, sizeof(*card), GFP_KERNEL);
582 if (!card)
583 return -ENOMEM;
584
585 /* Allocate the private data */
586 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
587 if (!data)
588 return -ENOMEM;
589
590 card->driver_name = DRIVER_NAME;
591 card->dapm_widgets = sdm845_snd_widgets;
592 card->num_dapm_widgets = ARRAY_SIZE(sdm845_snd_widgets);
593 card->controls = sdm845_snd_controls;
594 card->num_controls = ARRAY_SIZE(sdm845_snd_controls);
595 card->dev = dev;
596 card->owner = THIS_MODULE;
597 dev_set_drvdata(dev, card);
598 ret = qcom_snd_parse_of(card);
599 if (ret)
600 return ret;
601
602 data->card = card;
603 snd_soc_card_set_drvdata(card, data);
604
605 sdm845_add_ops(card);
606 return devm_snd_soc_register_card(dev, card);
607 }
608
609 static const struct of_device_id sdm845_snd_device_id[] = {
610 { .compatible = "qcom,sdm845-sndcard" },
611 /* Do not grow the list for compatible devices */
612 { .compatible = "qcom,db845c-sndcard" },
613 { .compatible = "lenovo,yoga-c630-sndcard" },
614 {},
615 };
616 MODULE_DEVICE_TABLE(of, sdm845_snd_device_id);
617
618 static struct platform_driver sdm845_snd_driver = {
619 .probe = sdm845_snd_platform_probe,
620 .driver = {
621 .name = "msm-snd-sdm845",
622 .of_match_table = sdm845_snd_device_id,
623 },
624 };
625 module_platform_driver(sdm845_snd_driver);
626
627 MODULE_DESCRIPTION("sdm845 ASoC Machine Driver");
628 MODULE_LICENSE("GPL v2");
629