]> Git Repo - J-linux.git/blob - sound/soc/intel/boards/sof_sdw.c
Merge tag 'amd-drm-next-6.5-2023-06-09' of https://gitlab.freedesktop.org/agd5f/linux...
[J-linux.git] / sound / soc / intel / boards / sof_sdw.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 // Copyright (c) 2020 Intel Corporation
3
4 /*
5  *  sof_sdw - ASOC Machine driver for Intel SoundWire platforms
6  */
7
8 #include <linux/device.h>
9 #include <linux/dmi.h>
10 #include <linux/module.h>
11 #include <linux/soundwire/sdw.h>
12 #include <linux/soundwire/sdw_type.h>
13 #include <sound/soc.h>
14 #include <sound/soc-acpi.h>
15 #include "sof_sdw_common.h"
16 #include "../../codecs/rt711.h"
17
18 unsigned long sof_sdw_quirk = RT711_JD1;
19 static int quirk_override = -1;
20 module_param_named(quirk, quirk_override, int, 0444);
21 MODULE_PARM_DESC(quirk, "Board-specific quirk override");
22
23 #define INC_ID(BE, CPU, LINK)   do { (BE)++; (CPU)++; (LINK)++; } while (0)
24
25 static void log_quirks(struct device *dev)
26 {
27         if (SOF_RT711_JDSRC(sof_sdw_quirk))
28                 dev_dbg(dev, "quirk realtek,jack-detect-source %ld\n",
29                         SOF_RT711_JDSRC(sof_sdw_quirk));
30         if (sof_sdw_quirk & SOF_SDW_FOUR_SPK)
31                 dev_dbg(dev, "quirk SOF_SDW_FOUR_SPK enabled\n");
32         if (sof_sdw_quirk & SOF_SDW_TGL_HDMI)
33                 dev_dbg(dev, "quirk SOF_SDW_TGL_HDMI enabled\n");
34         if (sof_sdw_quirk & SOF_SDW_PCH_DMIC)
35                 dev_dbg(dev, "quirk SOF_SDW_PCH_DMIC enabled\n");
36         if (SOF_SSP_GET_PORT(sof_sdw_quirk))
37                 dev_dbg(dev, "SSP port %ld\n",
38                         SOF_SSP_GET_PORT(sof_sdw_quirk));
39         if (sof_sdw_quirk & SOF_SDW_NO_AGGREGATION)
40                 dev_dbg(dev, "quirk SOF_SDW_NO_AGGREGATION enabled\n");
41 }
42
43 static int sof_sdw_quirk_cb(const struct dmi_system_id *id)
44 {
45         sof_sdw_quirk = (unsigned long)id->driver_data;
46         return 1;
47 }
48
49 static const struct dmi_system_id sof_sdw_quirk_table[] = {
50         /* CometLake devices */
51         {
52                 .callback = sof_sdw_quirk_cb,
53                 .matches = {
54                         DMI_MATCH(DMI_SYS_VENDOR, "Intel Corporation"),
55                         DMI_MATCH(DMI_PRODUCT_NAME, "CometLake Client"),
56                 },
57                 .driver_data = (void *)SOF_SDW_PCH_DMIC,
58         },
59         {
60                 .callback = sof_sdw_quirk_cb,
61                 .matches = {
62                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
63                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "09C6")
64                 },
65                 .driver_data = (void *)RT711_JD2,
66         },
67         {
68                 /* early version of SKU 09C6 */
69                 .callback = sof_sdw_quirk_cb,
70                 .matches = {
71                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
72                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0983")
73                 },
74                 .driver_data = (void *)RT711_JD2,
75         },
76         {
77                 .callback = sof_sdw_quirk_cb,
78                 .matches = {
79                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
80                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "098F"),
81                 },
82                 .driver_data = (void *)(RT711_JD2 |
83                                         SOF_SDW_FOUR_SPK),
84         },
85         {
86                 .callback = sof_sdw_quirk_cb,
87                 .matches = {
88                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
89                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0990"),
90                 },
91                 .driver_data = (void *)(RT711_JD2 |
92                                         SOF_SDW_FOUR_SPK),
93         },
94         /* IceLake devices */
95         {
96                 .callback = sof_sdw_quirk_cb,
97                 .matches = {
98                         DMI_MATCH(DMI_SYS_VENDOR, "Intel Corporation"),
99                         DMI_MATCH(DMI_PRODUCT_NAME, "Ice Lake Client"),
100                 },
101                 .driver_data = (void *)SOF_SDW_PCH_DMIC,
102         },
103         /* TigerLake devices */
104         {
105                 .callback = sof_sdw_quirk_cb,
106                 .matches = {
107                         DMI_MATCH(DMI_SYS_VENDOR, "Intel Corporation"),
108                         DMI_MATCH(DMI_PRODUCT_NAME,
109                                   "Tiger Lake Client Platform"),
110                 },
111                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
112                                         RT711_JD1 |
113                                         SOF_SDW_PCH_DMIC |
114                                         SOF_SSP_PORT(SOF_I2S_SSP2)),
115         },
116         {
117                 .callback = sof_sdw_quirk_cb,
118                 .matches = {
119                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
120                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0A3E")
121                 },
122                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
123                                         RT711_JD2),
124         },
125         {
126                 /* another SKU of Dell Latitude 9520 */
127                 .callback = sof_sdw_quirk_cb,
128                 .matches = {
129                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
130                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0A3F")
131                 },
132                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
133                                         RT711_JD2),
134         },
135         {
136                 /* Dell XPS 9710 */
137                 .callback = sof_sdw_quirk_cb,
138                 .matches = {
139                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
140                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0A5D")
141                 },
142                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
143                                         RT711_JD2 |
144                                         SOF_SDW_FOUR_SPK),
145         },
146         {
147                 .callback = sof_sdw_quirk_cb,
148                 .matches = {
149                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
150                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0A5E")
151                 },
152                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
153                                         RT711_JD2 |
154                                         SOF_SDW_FOUR_SPK),
155         },
156         {
157                 .callback = sof_sdw_quirk_cb,
158                 .matches = {
159                         DMI_MATCH(DMI_SYS_VENDOR, "Google"),
160                         DMI_MATCH(DMI_PRODUCT_NAME, "Volteer"),
161                 },
162                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
163                                         SOF_SDW_PCH_DMIC |
164                                         SOF_SDW_FOUR_SPK |
165                                         SOF_BT_OFFLOAD_SSP(2) |
166                                         SOF_SSP_BT_OFFLOAD_PRESENT),
167         },
168         {
169                 .callback = sof_sdw_quirk_cb,
170                 .matches = {
171                         DMI_MATCH(DMI_SYS_VENDOR, "Google"),
172                         DMI_MATCH(DMI_PRODUCT_NAME, "Ripto"),
173                 },
174                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
175                                         SOF_SDW_PCH_DMIC |
176                                         SOF_SDW_FOUR_SPK),
177         },
178         {
179                 /*
180                  * this entry covers multiple HP SKUs. The family name
181                  * does not seem robust enough, so we use a partial
182                  * match that ignores the product name suffix
183                  * (e.g. 15-eb1xxx, 14t-ea000 or 13-aw2xxx)
184                  */
185                 .callback = sof_sdw_quirk_cb,
186                 .matches = {
187                         DMI_MATCH(DMI_SYS_VENDOR, "HP"),
188                         DMI_MATCH(DMI_PRODUCT_NAME, "HP Spectre x360 Conv"),
189                 },
190                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
191                                         SOF_SDW_PCH_DMIC |
192                                         RT711_JD1),
193         },
194         {
195                 /* NUC15 'Bishop County' LAPBC510 and LAPBC710 skews */
196                 .callback = sof_sdw_quirk_cb,
197                 .matches = {
198                         DMI_MATCH(DMI_SYS_VENDOR, "Intel(R) Client Systems"),
199                         DMI_MATCH(DMI_PRODUCT_NAME, "LAPBC"),
200                 },
201                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
202                                         SOF_SDW_PCH_DMIC |
203                                         RT711_JD1),
204         },
205         {
206                 /* NUC15 LAPBC710 skews */
207                 .callback = sof_sdw_quirk_cb,
208                 .matches = {
209                         DMI_MATCH(DMI_BOARD_VENDOR, "Intel Corporation"),
210                         DMI_MATCH(DMI_BOARD_NAME, "LAPBC710"),
211                 },
212                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
213                                         SOF_SDW_PCH_DMIC |
214                                         RT711_JD1),
215         },
216         {
217                 /* NUC15 'Rooks County' LAPRC510 and LAPRC710 skews */
218                 .callback = sof_sdw_quirk_cb,
219                 .matches = {
220                         DMI_MATCH(DMI_SYS_VENDOR, "Intel(R) Client Systems"),
221                         DMI_MATCH(DMI_PRODUCT_NAME, "LAPRC"),
222                 },
223                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
224                                         SOF_SDW_PCH_DMIC |
225                                         RT711_JD2_100K),
226         },
227         /* TigerLake-SDCA devices */
228         {
229                 .callback = sof_sdw_quirk_cb,
230                 .matches = {
231                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
232                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0A32")
233                 },
234                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
235                                         RT711_JD2 |
236                                         SOF_SDW_FOUR_SPK),
237         },
238         {
239                 .callback = sof_sdw_quirk_cb,
240                 .matches = {
241                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
242                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0A45")
243                 },
244                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
245                                         RT711_JD2),
246         },
247         /* AlderLake devices */
248         {
249                 .callback = sof_sdw_quirk_cb,
250                 .matches = {
251                         DMI_MATCH(DMI_SYS_VENDOR, "Intel Corporation"),
252                         DMI_MATCH(DMI_PRODUCT_NAME, "Alder Lake Client Platform"),
253                 },
254                 .driver_data = (void *)(RT711_JD2_100K |
255                                         SOF_SDW_TGL_HDMI |
256                                         SOF_BT_OFFLOAD_SSP(2) |
257                                         SOF_SSP_BT_OFFLOAD_PRESENT),
258         },
259         {
260                 .callback = sof_sdw_quirk_cb,
261                 .matches = {
262                         DMI_MATCH(DMI_SYS_VENDOR, "Google"),
263                         DMI_MATCH(DMI_PRODUCT_NAME, "Brya"),
264                 },
265                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
266                                         SOF_SDW_PCH_DMIC |
267                                         SOF_SDW_FOUR_SPK |
268                                         SOF_BT_OFFLOAD_SSP(2) |
269                                         SOF_SSP_BT_OFFLOAD_PRESENT),
270         },
271         {
272                 .callback = sof_sdw_quirk_cb,
273                 .matches = {
274                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
275                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0AF0")
276                 },
277                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
278                                         RT711_JD2 |
279                                         SOF_SDW_FOUR_SPK),
280         },
281         {
282                 .callback = sof_sdw_quirk_cb,
283                 .matches = {
284                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
285                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0AF3"),
286                 },
287                 /* No Jack */
288                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
289                                         SOF_SDW_FOUR_SPK),
290         },
291         {
292                 .callback = sof_sdw_quirk_cb,
293                 .matches = {
294                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
295                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0AFF")
296                 },
297                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
298                                         RT711_JD2 |
299                                         SOF_SDW_FOUR_SPK),
300         },
301         {
302                 .callback = sof_sdw_quirk_cb,
303                 .matches = {
304                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
305                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0B00")
306                 },
307                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
308                                         RT711_JD2 |
309                                         SOF_SDW_FOUR_SPK),
310         },
311         {
312                 .callback = sof_sdw_quirk_cb,
313                 .matches = {
314                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
315                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0B01")
316                 },
317                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
318                                         RT711_JD2 |
319                                         SOF_SDW_FOUR_SPK),
320         },
321         {
322                 .callback = sof_sdw_quirk_cb,
323                 .matches = {
324                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
325                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0B11")
326                 },
327                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
328                                         RT711_JD2 |
329                                         SOF_SDW_FOUR_SPK),
330         },
331         {
332                 .callback = sof_sdw_quirk_cb,
333                 .matches = {
334                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
335                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0B12")
336                 },
337                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
338                                         RT711_JD2 |
339                                         SOF_SDW_FOUR_SPK),
340         },
341         {
342                 .callback = sof_sdw_quirk_cb,
343                 .matches = {
344                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
345                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0B13"),
346                 },
347                 /* No Jack */
348                 .driver_data = (void *)SOF_SDW_TGL_HDMI,
349         },
350         {
351                 .callback = sof_sdw_quirk_cb,
352                 .matches = {
353                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
354                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0B29"),
355                 },
356                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
357                                         RT711_JD2 |
358                                         SOF_SDW_FOUR_SPK),
359         },
360         {
361                 .callback = sof_sdw_quirk_cb,
362                 .matches = {
363                         DMI_MATCH(DMI_SYS_VENDOR, "HP"),
364                         DMI_MATCH(DMI_PRODUCT_NAME, "OMEN by HP Gaming Laptop 16-k0xxx"),
365                 },
366                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
367                                         RT711_JD2),
368         },
369         /* RaptorLake devices */
370         {
371                 .callback = sof_sdw_quirk_cb,
372                 .matches = {
373                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
374                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0C10"),
375                 },
376                 /* No Jack */
377                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
378                                         SOF_SDW_FOUR_SPK),
379         },
380         {
381                 .callback = sof_sdw_quirk_cb,
382                 .matches = {
383                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
384                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0C11")
385                 },
386                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
387                                         RT711_JD2 |
388                                         SOF_SDW_FOUR_SPK),
389         },
390         {
391                 .callback = sof_sdw_quirk_cb,
392                 .matches = {
393                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
394                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0C40")
395                 },
396                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
397                                         RT711_JD2 |
398                                         SOF_SDW_FOUR_SPK),
399         },
400         {
401                 .callback = sof_sdw_quirk_cb,
402                 .matches = {
403                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc"),
404                         DMI_EXACT_MATCH(DMI_PRODUCT_SKU, "0C4F")
405                 },
406                 .driver_data = (void *)(SOF_SDW_TGL_HDMI |
407                                         RT711_JD2 |
408                                         SOF_SDW_FOUR_SPK),
409         },
410         /* MeteorLake devices */
411         {
412                 .callback = sof_sdw_quirk_cb,
413                 .matches = {
414                         DMI_MATCH(DMI_PRODUCT_FAMILY, "Intel_mtlrvp"),
415                 },
416                 .driver_data = (void *)(RT711_JD1 | SOF_SDW_TGL_HDMI),
417         },
418         {}
419 };
420
421 static struct snd_soc_dai_link_component dmic_component[] = {
422         {
423                 .name = "dmic-codec",
424                 .dai_name = "dmic-hifi",
425         }
426 };
427
428 static struct snd_soc_dai_link_component platform_component[] = {
429         {
430                 /* name might be overridden during probe */
431                 .name = "0000:00:1f.3"
432         }
433 };
434
435 /* these wrappers are only needed to avoid typecast compilation errors */
436 int sdw_startup(struct snd_pcm_substream *substream)
437 {
438         return sdw_startup_stream(substream);
439 }
440
441 int sdw_prepare(struct snd_pcm_substream *substream)
442 {
443         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
444         struct sdw_stream_runtime *sdw_stream;
445         struct snd_soc_dai *dai;
446
447         /* Find stream from first CPU DAI */
448         dai = asoc_rtd_to_cpu(rtd, 0);
449
450         sdw_stream = snd_soc_dai_get_stream(dai, substream->stream);
451
452         if (IS_ERR(sdw_stream)) {
453                 dev_err(rtd->dev, "no stream found for DAI %s", dai->name);
454                 return PTR_ERR(sdw_stream);
455         }
456
457         return sdw_prepare_stream(sdw_stream);
458 }
459
460 int sdw_trigger(struct snd_pcm_substream *substream, int cmd)
461 {
462         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
463         struct sdw_stream_runtime *sdw_stream;
464         struct snd_soc_dai *dai;
465         int ret;
466
467         /* Find stream from first CPU DAI */
468         dai = asoc_rtd_to_cpu(rtd, 0);
469
470         sdw_stream = snd_soc_dai_get_stream(dai, substream->stream);
471
472         if (IS_ERR(sdw_stream)) {
473                 dev_err(rtd->dev, "no stream found for DAI %s", dai->name);
474                 return PTR_ERR(sdw_stream);
475         }
476
477         switch (cmd) {
478         case SNDRV_PCM_TRIGGER_START:
479         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
480         case SNDRV_PCM_TRIGGER_RESUME:
481                 ret = sdw_enable_stream(sdw_stream);
482                 break;
483
484         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
485         case SNDRV_PCM_TRIGGER_SUSPEND:
486         case SNDRV_PCM_TRIGGER_STOP:
487                 ret = sdw_disable_stream(sdw_stream);
488                 break;
489         default:
490                 ret = -EINVAL;
491                 break;
492         }
493
494         if (ret)
495                 dev_err(rtd->dev, "%s trigger %d failed: %d", __func__, cmd, ret);
496
497         return ret;
498 }
499
500 int sdw_hw_free(struct snd_pcm_substream *substream)
501 {
502         struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
503         struct sdw_stream_runtime *sdw_stream;
504         struct snd_soc_dai *dai;
505
506         /* Find stream from first CPU DAI */
507         dai = asoc_rtd_to_cpu(rtd, 0);
508
509         sdw_stream = snd_soc_dai_get_stream(dai, substream->stream);
510
511         if (IS_ERR(sdw_stream)) {
512                 dev_err(rtd->dev, "no stream found for DAI %s", dai->name);
513                 return PTR_ERR(sdw_stream);
514         }
515
516         return sdw_deprepare_stream(sdw_stream);
517 }
518
519 void sdw_shutdown(struct snd_pcm_substream *substream)
520 {
521         sdw_shutdown_stream(substream);
522 }
523
524 static const struct snd_soc_ops sdw_ops = {
525         .startup = sdw_startup,
526         .prepare = sdw_prepare,
527         .trigger = sdw_trigger,
528         .hw_free = sdw_hw_free,
529         .shutdown = sdw_shutdown,
530 };
531
532 static struct sof_sdw_codec_info codec_info_list[] = {
533         {
534                 .part_id = 0x700,
535                 .direction = {true, true},
536                 .dai_name = "rt700-aif1",
537                 .init = sof_sdw_rt700_init,
538                 .codec_type = SOF_SDW_CODEC_TYPE_JACK,
539         },
540         {
541                 .part_id = 0x711,
542                 .version_id = 3,
543                 .direction = {true, true},
544                 .dai_name = "rt711-sdca-aif1",
545                 .init = sof_sdw_rt711_sdca_init,
546                 .exit = sof_sdw_rt711_sdca_exit,
547                 .codec_type = SOF_SDW_CODEC_TYPE_JACK,
548         },
549         {
550                 .part_id = 0x711,
551                 .version_id = 2,
552                 .direction = {true, true},
553                 .dai_name = "rt711-aif1",
554                 .init = sof_sdw_rt711_init,
555                 .exit = sof_sdw_rt711_exit,
556                 .codec_type = SOF_SDW_CODEC_TYPE_JACK,
557         },
558         {
559                 .part_id = 0x1308,
560                 .acpi_id = "10EC1308",
561                 .direction = {true, false},
562                 .dai_name = "rt1308-aif",
563                 .ops = &sof_sdw_rt1308_i2s_ops,
564                 .init = sof_sdw_rt_amp_init,
565                 .exit = sof_sdw_rt_amp_exit,
566                 .codec_type = SOF_SDW_CODEC_TYPE_AMP,
567         },
568         {
569                 .part_id = 0x1316,
570                 .direction = {true, true},
571                 .dai_name = "rt1316-aif",
572                 .init = sof_sdw_rt_amp_init,
573                 .exit = sof_sdw_rt_amp_exit,
574                 .codec_type = SOF_SDW_CODEC_TYPE_AMP,
575         },
576         {
577                 .part_id = 0x1318,
578                 .direction = {true, true},
579                 .dai_name = "rt1318-aif",
580                 .init = sof_sdw_rt_amp_init,
581                 .codec_type = SOF_SDW_CODEC_TYPE_AMP,
582         },
583         {
584                 .part_id = 0x714,
585                 .version_id = 3,
586                 .direction = {false, true},
587                 .ignore_pch_dmic = true,
588                 .dai_name = "rt715-aif2",
589                 .init = sof_sdw_rt715_sdca_init,
590                 .codec_type = SOF_SDW_CODEC_TYPE_MIC,
591         },
592         {
593                 .part_id = 0x715,
594                 .version_id = 3,
595                 .direction = {false, true},
596                 .ignore_pch_dmic = true,
597                 .dai_name = "rt715-aif2",
598                 .init = sof_sdw_rt715_sdca_init,
599                 .codec_type = SOF_SDW_CODEC_TYPE_MIC,
600         },
601         {
602                 .part_id = 0x714,
603                 .version_id = 2,
604                 .direction = {false, true},
605                 .ignore_pch_dmic = true,
606                 .dai_name = "rt715-aif2",
607                 .init = sof_sdw_rt715_init,
608                 .codec_type = SOF_SDW_CODEC_TYPE_MIC,
609         },
610         {
611                 .part_id = 0x715,
612                 .version_id = 2,
613                 .direction = {false, true},
614                 .ignore_pch_dmic = true,
615                 .dai_name = "rt715-aif2",
616                 .init = sof_sdw_rt715_init,
617                 .codec_type = SOF_SDW_CODEC_TYPE_MIC,
618         },
619         {
620                 .part_id = 0x8373,
621                 .direction = {true, true},
622                 .dai_name = "max98373-aif1",
623                 .init = sof_sdw_mx8373_init,
624                 .codec_type = SOF_SDW_CODEC_TYPE_AMP,
625         },
626         {
627                 .part_id = 0x5682,
628                 .direction = {true, true},
629                 .dai_name = "rt5682-sdw",
630                 .init = sof_sdw_rt5682_init,
631                 .codec_type = SOF_SDW_CODEC_TYPE_JACK,
632         },
633         {
634                 .part_id = 0xaaaa, /* generic codec mockup */
635                 .version_id = 0,
636                 .direction = {true, true},
637                 .dai_name = "sdw-mockup-aif1",
638                 .init = NULL,
639                 .codec_type = SOF_SDW_CODEC_TYPE_JACK,
640         },
641         {
642                 .part_id = 0xaa55, /* headset codec mockup */
643                 .version_id = 0,
644                 .direction = {true, true},
645                 .dai_name = "sdw-mockup-aif1",
646                 .init = NULL,
647                 .codec_type = SOF_SDW_CODEC_TYPE_JACK,
648         },
649         {
650                 .part_id = 0x55aa, /* amplifier mockup */
651                 .version_id = 0,
652                 .direction = {true, false},
653                 .dai_name = "sdw-mockup-aif1",
654                 .init = NULL,
655                 .codec_type = SOF_SDW_CODEC_TYPE_AMP,
656         },
657         {
658                 .part_id = 0x5555,
659                 .version_id = 0,
660                 .direction = {false, true},
661                 .dai_name = "sdw-mockup-aif1",
662                 .codec_type = SOF_SDW_CODEC_TYPE_MIC,
663         },
664 };
665
666 static inline int find_codec_info_part(u64 adr)
667 {
668         unsigned int part_id, sdw_version;
669         int i;
670
671         part_id = SDW_PART_ID(adr);
672         sdw_version = SDW_VERSION(adr);
673         for (i = 0; i < ARRAY_SIZE(codec_info_list); i++)
674                 /*
675                  * A codec info is for all sdw version with the part id if
676                  * version_id is not specified in the codec info.
677                  */
678                 if (part_id == codec_info_list[i].part_id &&
679                     (!codec_info_list[i].version_id ||
680                      sdw_version == codec_info_list[i].version_id))
681                         return i;
682
683         return -EINVAL;
684
685 }
686
687 static inline int find_codec_info_acpi(const u8 *acpi_id)
688 {
689         int i;
690
691         if (!acpi_id[0])
692                 return -EINVAL;
693
694         for (i = 0; i < ARRAY_SIZE(codec_info_list); i++)
695                 if (!memcmp(codec_info_list[i].acpi_id, acpi_id,
696                             ACPI_ID_LEN))
697                         break;
698
699         if (i == ARRAY_SIZE(codec_info_list))
700                 return -EINVAL;
701
702         return i;
703 }
704
705 /*
706  * get BE dailink number and CPU DAI number based on sdw link adr.
707  * Since some sdw slaves may be aggregated, the CPU DAI number
708  * may be larger than the number of BE dailinks.
709  */
710 static int get_sdw_dailink_info(struct device *dev, const struct snd_soc_acpi_link_adr *links,
711                                 int *sdw_be_num, int *sdw_cpu_dai_num)
712 {
713         const struct snd_soc_acpi_link_adr *link;
714         int _codec_type = SOF_SDW_CODEC_TYPE_JACK;
715         bool group_visited[SDW_MAX_GROUPS];
716         bool no_aggregation;
717         int i;
718
719         no_aggregation = sof_sdw_quirk & SOF_SDW_NO_AGGREGATION;
720         *sdw_cpu_dai_num = 0;
721         *sdw_be_num  = 0;
722
723         if (!links)
724                 return -EINVAL;
725
726         for (i = 0; i < SDW_MAX_GROUPS; i++)
727                 group_visited[i] = false;
728
729         for (link = links; link->num_adr; link++) {
730                 const struct snd_soc_acpi_endpoint *endpoint;
731                 int codec_index;
732                 int stream;
733                 u64 adr;
734
735                 for (i = 0; i < link->num_adr; i++) {
736                         adr = link->adr_d[i].adr;
737                         codec_index = find_codec_info_part(adr);
738                         if (codec_index < 0)
739                                 return codec_index;
740
741                         if (codec_info_list[codec_index].codec_type < _codec_type)
742                                 dev_warn(dev,
743                                          "Unexpected address table ordering. Expected order: jack -> amp -> mic\n");
744
745                         _codec_type = codec_info_list[codec_index].codec_type;
746
747                         endpoint = link->adr_d[i].endpoints;
748
749                         /* count DAI number for playback and capture */
750                         for_each_pcm_streams(stream) {
751                                 if (!codec_info_list[codec_index].direction[stream])
752                                         continue;
753
754                                 (*sdw_cpu_dai_num)++;
755
756                                 /* count BE for each non-aggregated slave or group */
757                                 if (!endpoint->aggregated || no_aggregation ||
758                                     !group_visited[endpoint->group_id])
759                                         (*sdw_be_num)++;
760                         }
761
762                         if (endpoint->aggregated)
763                                 group_visited[endpoint->group_id] = true;
764                 }
765         }
766
767         return 0;
768 }
769
770 static void init_dai_link(struct device *dev, struct snd_soc_dai_link *dai_links,
771                           int be_id, char *name, int playback, int capture,
772                           struct snd_soc_dai_link_component *cpus, int cpus_num,
773                           struct snd_soc_dai_link_component *codecs, int codecs_num,
774                           int (*init)(struct snd_soc_pcm_runtime *rtd),
775                           const struct snd_soc_ops *ops)
776 {
777         dev_dbg(dev, "create dai link %s, id %d\n", name, be_id);
778         dai_links->id = be_id;
779         dai_links->name = name;
780         dai_links->platforms = platform_component;
781         dai_links->num_platforms = ARRAY_SIZE(platform_component);
782         dai_links->no_pcm = 1;
783         dai_links->cpus = cpus;
784         dai_links->num_cpus = cpus_num;
785         dai_links->codecs = codecs;
786         dai_links->num_codecs = codecs_num;
787         dai_links->dpcm_playback = playback;
788         dai_links->dpcm_capture = capture;
789         dai_links->init = init;
790         dai_links->ops = ops;
791 }
792
793 static bool is_unique_device(const struct snd_soc_acpi_link_adr *link,
794                              unsigned int sdw_version,
795                              unsigned int mfg_id,
796                              unsigned int part_id,
797                              unsigned int class_id,
798                              int index_in_link
799                             )
800 {
801         int i;
802
803         for (i = 0; i < link->num_adr; i++) {
804                 unsigned int sdw1_version, mfg1_id, part1_id, class1_id;
805                 u64 adr;
806
807                 /* skip itself */
808                 if (i == index_in_link)
809                         continue;
810
811                 adr = link->adr_d[i].adr;
812
813                 sdw1_version = SDW_VERSION(adr);
814                 mfg1_id = SDW_MFG_ID(adr);
815                 part1_id = SDW_PART_ID(adr);
816                 class1_id = SDW_CLASS_ID(adr);
817
818                 if (sdw_version == sdw1_version &&
819                     mfg_id == mfg1_id &&
820                     part_id == part1_id &&
821                     class_id == class1_id)
822                         return false;
823         }
824
825         return true;
826 }
827
828 static int create_codec_dai_name(struct device *dev,
829                                  const struct snd_soc_acpi_link_adr *link,
830                                  struct snd_soc_dai_link_component *codec,
831                                  int offset,
832                                  struct snd_soc_codec_conf *codec_conf,
833                                  int codec_count,
834                                  int *codec_conf_index,
835                                  int adr_index)
836 {
837         int _codec_index = -1;
838         int i;
839
840         /* sanity check */
841         if (*codec_conf_index + link->num_adr - adr_index > codec_count) {
842                 dev_err(dev, "codec_conf: out-of-bounds access requested\n");
843                 return -EINVAL;
844         }
845
846         for (i = adr_index; i < link->num_adr; i++) {
847                 unsigned int sdw_version, unique_id, mfg_id;
848                 unsigned int link_id, part_id, class_id;
849                 int codec_index, comp_index;
850                 char *codec_str;
851                 u64 adr;
852
853                 adr = link->adr_d[i].adr;
854
855                 sdw_version = SDW_VERSION(adr);
856                 link_id = SDW_DISCO_LINK_ID(adr);
857                 unique_id = SDW_UNIQUE_ID(adr);
858                 mfg_id = SDW_MFG_ID(adr);
859                 part_id = SDW_PART_ID(adr);
860                 class_id = SDW_CLASS_ID(adr);
861
862                 comp_index = i - adr_index + offset;
863                 if (is_unique_device(link, sdw_version, mfg_id, part_id,
864                                      class_id, i)) {
865                         codec_str = "sdw:%01x:%04x:%04x:%02x";
866                         codec[comp_index].name =
867                                 devm_kasprintf(dev, GFP_KERNEL, codec_str,
868                                                link_id, mfg_id, part_id,
869                                                class_id);
870                 } else {
871                         codec_str = "sdw:%01x:%04x:%04x:%02x:%01x";
872                         codec[comp_index].name =
873                                 devm_kasprintf(dev, GFP_KERNEL, codec_str,
874                                                link_id, mfg_id, part_id,
875                                                class_id, unique_id);
876                 }
877
878                 if (!codec[comp_index].name)
879                         return -ENOMEM;
880
881                 codec_index = find_codec_info_part(adr);
882                 if (codec_index < 0)
883                         return codec_index;
884                 if (_codec_index != -1 && codec_index != _codec_index) {
885                         dev_dbg(dev, "Different devices on the same sdw link\n");
886                         break;
887                 }
888                 _codec_index = codec_index;
889
890                 codec[comp_index].dai_name =
891                         codec_info_list[codec_index].dai_name;
892
893                 codec_conf[*codec_conf_index].dlc = codec[comp_index];
894                 codec_conf[*codec_conf_index].name_prefix = link->adr_d[i].name_prefix;
895
896                 ++*codec_conf_index;
897         }
898
899         return 0;
900 }
901
902 static int set_codec_init_func(struct snd_soc_card *card,
903                                const struct snd_soc_acpi_link_adr *link,
904                                struct snd_soc_dai_link *dai_links,
905                                bool playback, int group_id)
906 {
907         int i;
908
909         do {
910                 /*
911                  * Initialize the codec. If codec is part of an aggregated
912                  * group (group_id>0), initialize all codecs belonging to
913                  * same group.
914                  */
915                 for (i = 0; i < link->num_adr; i++) {
916                         int codec_index;
917
918                         codec_index = find_codec_info_part(link->adr_d[i].adr);
919
920                         if (codec_index < 0)
921                                 return codec_index;
922                         /* The group_id is > 0 iff the codec is aggregated */
923                         if (link->adr_d[i].endpoints->group_id != group_id)
924                                 continue;
925                         if (codec_info_list[codec_index].init)
926                                 codec_info_list[codec_index].init(card,
927                                                 link,
928                                                 dai_links,
929                                                 &codec_info_list[codec_index],
930                                                 playback);
931                 }
932                 link++;
933         } while (link->mask && group_id);
934
935         return 0;
936 }
937
938 /*
939  * check endpoint status in slaves and gather link ID for all slaves in
940  * the same group to generate different CPU DAI. Now only support
941  * one sdw link with all slaves set with only single group id.
942  *
943  * one slave on one sdw link with aggregated = 0
944  * one sdw BE DAI <---> one-cpu DAI <---> one-codec DAI
945  *
946  * two or more slaves on one sdw link with aggregated = 0
947  * one sdw BE DAI  <---> one-cpu DAI <---> multi-codec DAIs
948  *
949  * multiple links with multiple slaves with aggregated = 1
950  * one sdw BE DAI  <---> 1 .. N CPU DAIs <----> 1 .. N codec DAIs
951  */
952 static int get_slave_info(const struct snd_soc_acpi_link_adr *adr_link,
953                           struct device *dev, int *cpu_dai_id, int *cpu_dai_num,
954                           int *codec_num, unsigned int *group_id,
955                           bool *group_generated, int adr_index)
956 {
957         const struct snd_soc_acpi_adr_device *adr_d;
958         const struct snd_soc_acpi_link_adr *adr_next;
959         bool no_aggregation;
960         int index = 0;
961         int i;
962
963         no_aggregation = sof_sdw_quirk & SOF_SDW_NO_AGGREGATION;
964         adr_d = &adr_link->adr_d[adr_index];
965
966         /* make sure the link mask has a single bit set */
967         if (!is_power_of_2(adr_link->mask))
968                 return -EINVAL;
969
970         cpu_dai_id[index++] = ffs(adr_link->mask) - 1;
971         if (!adr_d->endpoints->aggregated || no_aggregation) {
972                 *cpu_dai_num = 1;
973                 *codec_num = 1;
974                 *group_id = 0;
975                 return 0;
976         }
977
978         *group_id = adr_d->endpoints->group_id;
979
980         /* Count endpoints with the same group_id in the adr_link */
981         *codec_num = 0;
982         for (i = 0; i < adr_link->num_adr; i++) {
983                 if (adr_link->adr_d[i].endpoints->aggregated &&
984                     adr_link->adr_d[i].endpoints->group_id == *group_id)
985                         (*codec_num)++;
986         }
987
988         /* gather other link ID of slaves in the same group */
989         for (adr_next = adr_link + 1; adr_next && adr_next->num_adr;
990                 adr_next++) {
991                 const struct snd_soc_acpi_endpoint *endpoint;
992
993                 endpoint = adr_next->adr_d->endpoints;
994                 if (!endpoint->aggregated ||
995                     endpoint->group_id != *group_id)
996                         continue;
997
998                 /* make sure the link mask has a single bit set */
999                 if (!is_power_of_2(adr_next->mask))
1000                         return -EINVAL;
1001
1002                 if (index >= SDW_MAX_CPU_DAIS) {
1003                         dev_err(dev, " cpu_dai_id array overflows");
1004                         return -EINVAL;
1005                 }
1006
1007                 cpu_dai_id[index++] = ffs(adr_next->mask) - 1;
1008                 for (i = 0; i < adr_next->num_adr; i++) {
1009                         if (adr_next->adr_d[i].endpoints->aggregated &&
1010                             adr_next->adr_d[i].endpoints->group_id == *group_id)
1011                                 (*codec_num)++;
1012                 }
1013         }
1014
1015         /*
1016          * indicate CPU DAIs for this group have been generated
1017          * to avoid generating CPU DAIs for this group again.
1018          */
1019         group_generated[*group_id] = true;
1020         *cpu_dai_num = index;
1021
1022         return 0;
1023 }
1024
1025 static const char * const type_strings[] = {"SimpleJack", "SmartAmp", "SmartMic"};
1026
1027 static int create_sdw_dailink(struct snd_soc_card *card,
1028                               struct device *dev, int *link_index,
1029                               struct snd_soc_dai_link *dai_links,
1030                               int sdw_be_num, int sdw_cpu_dai_num,
1031                               struct snd_soc_dai_link_component *cpus,
1032                               const struct snd_soc_acpi_link_adr *link,
1033                               int *cpu_id, bool *group_generated,
1034                               struct snd_soc_codec_conf *codec_conf,
1035                               int codec_count, int *link_id,
1036                               int *codec_conf_index,
1037                               bool *ignore_pch_dmic,
1038                               bool append_codec_type,
1039                               int adr_index)
1040 {
1041         const struct snd_soc_acpi_link_adr *link_next;
1042         struct snd_soc_dai_link_component *codecs;
1043         int cpu_dai_id[SDW_MAX_CPU_DAIS];
1044         int cpu_dai_num, cpu_dai_index;
1045         unsigned int group_id;
1046         int codec_idx = 0;
1047         int i = 0, j = 0;
1048         int codec_index;
1049         int codec_num;
1050         int stream;
1051         int ret;
1052         int k;
1053
1054         ret = get_slave_info(link, dev, cpu_dai_id, &cpu_dai_num, &codec_num,
1055                              &group_id, group_generated, adr_index);
1056         if (ret)
1057                 return ret;
1058
1059         codecs = devm_kcalloc(dev, codec_num, sizeof(*codecs), GFP_KERNEL);
1060         if (!codecs)
1061                 return -ENOMEM;
1062
1063         /* generate codec name on different links in the same group */
1064         for (link_next = link; link_next && link_next->num_adr &&
1065              i < cpu_dai_num; link_next++) {
1066                 const struct snd_soc_acpi_endpoint *endpoints;
1067
1068                 endpoints = link_next->adr_d->endpoints;
1069                 if (group_id && (!endpoints->aggregated ||
1070                                  endpoints->group_id != group_id))
1071                         continue;
1072
1073                 /* skip the link excluded by this processed group */
1074                 if (cpu_dai_id[i] != ffs(link_next->mask) - 1)
1075                         continue;
1076
1077                 ret = create_codec_dai_name(dev, link_next, codecs, codec_idx,
1078                                             codec_conf, codec_count, codec_conf_index, adr_index);
1079                 if (ret < 0)
1080                         return ret;
1081
1082                 /* check next link to create codec dai in the processed group */
1083                 i++;
1084                 codec_idx += link_next->num_adr;
1085         }
1086
1087         /* find codec info to create BE DAI */
1088         codec_index = find_codec_info_part(link->adr_d[adr_index].adr);
1089         if (codec_index < 0)
1090                 return codec_index;
1091
1092         if (codec_info_list[codec_index].ignore_pch_dmic)
1093                 *ignore_pch_dmic = true;
1094
1095         /* Shift the first amplifier's *link_id to SDW_AMP_DAI_ID */
1096         if (codec_info_list[codec_index].codec_type == SOF_SDW_CODEC_TYPE_AMP &&
1097             *link_id < SDW_AMP_DAI_ID)
1098                 *link_id = SDW_AMP_DAI_ID;
1099
1100         /*
1101          * DAI ID is fixed at SDW_DMIC_DAI_ID for MICs to
1102          * keep sdw DMIC and HDMI setting static in UCM
1103          */
1104         if (codec_info_list[codec_index].codec_type == SOF_SDW_CODEC_TYPE_MIC &&
1105             *link_id < SDW_DMIC_DAI_ID)
1106                 *link_id = SDW_DMIC_DAI_ID;
1107
1108         cpu_dai_index = *cpu_id;
1109         for_each_pcm_streams(stream) {
1110                 char *name, *cpu_name;
1111                 int playback, capture;
1112                 static const char * const sdw_stream_name[] = {
1113                         "SDW%d-Playback",
1114                         "SDW%d-Capture",
1115                         "SDW%d-Playback-%s",
1116                         "SDW%d-Capture-%s",
1117                 };
1118
1119                 if (!codec_info_list[codec_index].direction[stream])
1120                         continue;
1121
1122                 /* create stream name according to first link id */
1123                 if (append_codec_type) {
1124                         name = devm_kasprintf(dev, GFP_KERNEL,
1125                                               sdw_stream_name[stream + 2], cpu_dai_id[0],
1126                                               type_strings[codec_info_list[codec_index].codec_type]);
1127                 } else {
1128                         name = devm_kasprintf(dev, GFP_KERNEL,
1129                                               sdw_stream_name[stream], cpu_dai_id[0]);
1130                 }
1131                 if (!name)
1132                         return -ENOMEM;
1133
1134                 /*
1135                  * generate CPU DAI name base on the sdw link ID and
1136                  * PIN ID with offset of 2 according to sdw dai driver.
1137                  */
1138                 for (k = 0; k < cpu_dai_num; k++) {
1139                         cpu_name = devm_kasprintf(dev, GFP_KERNEL,
1140                                                   "SDW%d Pin%d", cpu_dai_id[k],
1141                                                   j + SDW_INTEL_BIDIR_PDI_BASE);
1142                         if (!cpu_name)
1143                                 return -ENOMEM;
1144
1145                         if (cpu_dai_index >= sdw_cpu_dai_num) {
1146                                 dev_err(dev, "invalid cpu dai index %d",
1147                                         cpu_dai_index);
1148                                 return -EINVAL;
1149                         }
1150
1151                         cpus[cpu_dai_index++].dai_name = cpu_name;
1152                 }
1153
1154                 /*
1155                  * We create sdw dai links at first stage, so link index should
1156                  * not be larger than sdw_be_num
1157                  */
1158                 if (*link_index >= sdw_be_num) {
1159                         dev_err(dev, "invalid dai link index %d", *link_index);
1160                         return -EINVAL;
1161                 }
1162
1163                 if (*cpu_id >= sdw_cpu_dai_num) {
1164                         dev_err(dev, " invalid cpu dai index %d", *cpu_id);
1165                         return -EINVAL;
1166                 }
1167
1168                 playback = (stream == SNDRV_PCM_STREAM_PLAYBACK);
1169                 capture = (stream == SNDRV_PCM_STREAM_CAPTURE);
1170                 init_dai_link(dev, dai_links + *link_index, (*link_id)++, name,
1171                               playback, capture,
1172                               cpus + *cpu_id, cpu_dai_num,
1173                               codecs, codec_num,
1174                               NULL, &sdw_ops);
1175
1176                 /*
1177                  * SoundWire DAILINKs use 'stream' functions and Bank Switch operations
1178                  * based on wait_for_completion(), tag them as 'nonatomic'.
1179                  */
1180                 dai_links[*link_index].nonatomic = true;
1181
1182                 ret = set_codec_init_func(card, link, dai_links + (*link_index)++,
1183                                           playback, group_id);
1184                 if (ret < 0) {
1185                         dev_err(dev, "failed to init codec %d", codec_index);
1186                         return ret;
1187                 }
1188
1189                 *cpu_id += cpu_dai_num;
1190                 j++;
1191         }
1192
1193         return 0;
1194 }
1195
1196 #define IDISP_CODEC_MASK        0x4
1197
1198 static int sof_card_codec_conf_alloc(struct device *dev,
1199                                      struct snd_soc_acpi_mach_params *mach_params,
1200                                      struct snd_soc_codec_conf **codec_conf,
1201                                      int *codec_conf_count)
1202 {
1203         const struct snd_soc_acpi_link_adr *adr_link;
1204         struct snd_soc_codec_conf *c_conf;
1205         int num_codecs = 0;
1206         int i;
1207
1208         adr_link = mach_params->links;
1209         if (!adr_link)
1210                 return -EINVAL;
1211
1212         /* generate DAI links by each sdw link */
1213         for (; adr_link->num_adr; adr_link++) {
1214                 for (i = 0; i < adr_link->num_adr; i++) {
1215                         if (!adr_link->adr_d[i].name_prefix) {
1216                                 dev_err(dev, "codec 0x%llx does not have a name prefix\n",
1217                                         adr_link->adr_d[i].adr);
1218                                 return -EINVAL;
1219                         }
1220                 }
1221                 num_codecs += adr_link->num_adr;
1222         }
1223
1224         c_conf = devm_kzalloc(dev, num_codecs * sizeof(*c_conf), GFP_KERNEL);
1225         if (!c_conf)
1226                 return -ENOMEM;
1227
1228         *codec_conf = c_conf;
1229         *codec_conf_count = num_codecs;
1230
1231         return 0;
1232 }
1233
1234 static int sof_card_dai_links_create(struct device *dev,
1235                                      struct snd_soc_acpi_mach *mach,
1236                                      struct snd_soc_card *card)
1237 {
1238         int ssp_num, sdw_be_num = 0, hdmi_num = 0, dmic_num;
1239         struct mc_private *ctx = snd_soc_card_get_drvdata(card);
1240         struct snd_soc_dai_link_component *idisp_components;
1241         struct snd_soc_dai_link_component *ssp_components;
1242         struct snd_soc_acpi_mach_params *mach_params;
1243         const struct snd_soc_acpi_link_adr *adr_link;
1244         struct snd_soc_dai_link_component *cpus;
1245         struct snd_soc_codec_conf *codec_conf;
1246         bool append_codec_type = false;
1247         bool ignore_pch_dmic = false;
1248         int codec_conf_count;
1249         int codec_conf_index = 0;
1250         bool group_generated[SDW_MAX_GROUPS];
1251         int ssp_codec_index, ssp_mask;
1252         struct snd_soc_dai_link *links;
1253         int num_links, link_index = 0;
1254         char *name, *cpu_name;
1255         int total_cpu_dai_num;
1256         int sdw_cpu_dai_num;
1257         int i, j, be_id = 0;
1258         int cpu_id = 0;
1259         int comp_num;
1260         int ret;
1261
1262         mach_params = &mach->mach_params;
1263
1264         /* allocate codec conf, will be populated when dailinks are created */
1265         ret = sof_card_codec_conf_alloc(dev, mach_params, &codec_conf, &codec_conf_count);
1266         if (ret < 0)
1267                 return ret;
1268
1269         /* reset amp_num to ensure amp_num++ starts from 0 in each probe */
1270         for (i = 0; i < ARRAY_SIZE(codec_info_list); i++)
1271                 codec_info_list[i].amp_num = 0;
1272
1273         if (mach_params->codec_mask & IDISP_CODEC_MASK) {
1274                 ctx->idisp_codec = true;
1275
1276                 if (sof_sdw_quirk & SOF_SDW_TGL_HDMI)
1277                         hdmi_num = SOF_TGL_HDMI_COUNT;
1278                 else
1279                         hdmi_num = SOF_PRE_TGL_HDMI_COUNT;
1280         }
1281
1282         ssp_mask = SOF_SSP_GET_PORT(sof_sdw_quirk);
1283         /*
1284          * on generic tgl platform, I2S or sdw mode is supported
1285          * based on board rework. A ACPI device is registered in
1286          * system only when I2S mode is supported, not sdw mode.
1287          * Here check ACPI ID to confirm I2S is supported.
1288          */
1289         ssp_codec_index = find_codec_info_acpi(mach->id);
1290         ssp_num = ssp_codec_index >= 0 ? hweight_long(ssp_mask) : 0;
1291         comp_num = hdmi_num + ssp_num;
1292
1293         ret = get_sdw_dailink_info(dev, mach_params->links,
1294                                    &sdw_be_num, &sdw_cpu_dai_num);
1295         if (ret < 0) {
1296                 dev_err(dev, "failed to get sdw link info %d", ret);
1297                 return ret;
1298         }
1299
1300         /* enable dmic01 & dmic16k */
1301         dmic_num = (sof_sdw_quirk & SOF_SDW_PCH_DMIC || mach_params->dmic_num) ? 2 : 0;
1302         comp_num += dmic_num;
1303
1304         if (sof_sdw_quirk & SOF_SSP_BT_OFFLOAD_PRESENT)
1305                 comp_num++;
1306
1307         dev_dbg(dev, "sdw %d, ssp %d, dmic %d, hdmi %d", sdw_be_num, ssp_num,
1308                 dmic_num, ctx->idisp_codec ? hdmi_num : 0);
1309
1310         /* allocate BE dailinks */
1311         num_links = comp_num + sdw_be_num;
1312         links = devm_kcalloc(dev, num_links, sizeof(*links), GFP_KERNEL);
1313
1314         /* allocated CPU DAIs */
1315         total_cpu_dai_num = comp_num + sdw_cpu_dai_num;
1316         cpus = devm_kcalloc(dev, total_cpu_dai_num, sizeof(*cpus),
1317                             GFP_KERNEL);
1318
1319         if (!links || !cpus)
1320                 return -ENOMEM;
1321
1322         /* SDW */
1323         if (!sdw_be_num)
1324                 goto SSP;
1325
1326         adr_link = mach_params->links;
1327         if (!adr_link)
1328                 return -EINVAL;
1329
1330         /*
1331          * SoundWire Slaves aggregated in the same group may be
1332          * located on different hardware links. Clear array to indicate
1333          * CPU DAIs for this group have not been generated.
1334          */
1335         for (i = 0; i < SDW_MAX_GROUPS; i++)
1336                 group_generated[i] = false;
1337
1338         for (; adr_link->num_adr; adr_link++) {
1339                 /*
1340                  * If there are two or more different devices on the same sdw link, we have to
1341                  * append the codec type to the dai link name to prevent duplicated dai link name.
1342                  * The same type devices on the same sdw link will be in the same
1343                  * snd_soc_acpi_adr_device array. They won't be described in different adr_links.
1344                  */
1345                 for (i = 0; i < adr_link->num_adr; i++) {
1346                         for (j = 0; j < i; j++) {
1347                                 if ((SDW_PART_ID(adr_link->adr_d[i].adr) !=
1348                                     SDW_PART_ID(adr_link->adr_d[j].adr)) ||
1349                                     (SDW_MFG_ID(adr_link->adr_d[i].adr) !=
1350                                     SDW_MFG_ID(adr_link->adr_d[i].adr))) {
1351                                         append_codec_type = true;
1352                                         goto out;
1353                                 }
1354                         }
1355                 }
1356         }
1357 out:
1358
1359         /* generate DAI links by each sdw link */
1360         for (adr_link = mach_params->links ; adr_link->num_adr; adr_link++) {
1361                 for (i = 0; i < adr_link->num_adr; i++) {
1362                         const struct snd_soc_acpi_endpoint *endpoint;
1363
1364                         endpoint = adr_link->adr_d[i].endpoints;
1365                         if (endpoint->aggregated && !endpoint->group_id) {
1366                                 dev_err(dev, "invalid group id on link %x",
1367                                         adr_link->mask);
1368                                 continue;
1369                         }
1370
1371                         /* this group has been generated */
1372                         if (endpoint->aggregated &&
1373                             group_generated[endpoint->group_id])
1374                                 continue;
1375
1376                         ret = create_sdw_dailink(card, dev, &link_index, links, sdw_be_num,
1377                                                  sdw_cpu_dai_num, cpus, adr_link,
1378                                                  &cpu_id, group_generated,
1379                                                  codec_conf, codec_conf_count,
1380                                                  &be_id, &codec_conf_index,
1381                                                  &ignore_pch_dmic, append_codec_type, i);
1382                         if (ret < 0) {
1383                                 dev_err(dev, "failed to create dai link %d", link_index);
1384                                 return ret;
1385                         }
1386                 }
1387         }
1388
1389 SSP:
1390         /* SSP */
1391         if (!ssp_num)
1392                 goto DMIC;
1393
1394         for (i = 0, j = 0; ssp_mask; i++, ssp_mask >>= 1) {
1395                 struct sof_sdw_codec_info *info;
1396                 int playback, capture;
1397                 char *codec_name;
1398
1399                 if (!(ssp_mask & 0x1))
1400                         continue;
1401
1402                 name = devm_kasprintf(dev, GFP_KERNEL,
1403                                       "SSP%d-Codec", i);
1404                 if (!name)
1405                         return -ENOMEM;
1406
1407                 cpu_name = devm_kasprintf(dev, GFP_KERNEL, "SSP%d Pin", i);
1408                 if (!cpu_name)
1409                         return -ENOMEM;
1410
1411                 ssp_components = devm_kzalloc(dev, sizeof(*ssp_components),
1412                                               GFP_KERNEL);
1413                 if (!ssp_components)
1414                         return -ENOMEM;
1415
1416                 info = &codec_info_list[ssp_codec_index];
1417                 codec_name = devm_kasprintf(dev, GFP_KERNEL, "i2c-%s:0%d",
1418                                             info->acpi_id, j++);
1419                 if (!codec_name)
1420                         return -ENOMEM;
1421
1422                 ssp_components->name = codec_name;
1423                 ssp_components->dai_name = info->dai_name;
1424                 cpus[cpu_id].dai_name = cpu_name;
1425
1426                 playback = info->direction[SNDRV_PCM_STREAM_PLAYBACK];
1427                 capture = info->direction[SNDRV_PCM_STREAM_CAPTURE];
1428                 init_dai_link(dev, links + link_index, be_id, name,
1429                               playback, capture,
1430                               cpus + cpu_id, 1,
1431                               ssp_components, 1,
1432                               NULL, info->ops);
1433
1434                 ret = info->init(card, NULL, links + link_index, info, 0);
1435                 if (ret < 0)
1436                         return ret;
1437
1438                 INC_ID(be_id, cpu_id, link_index);
1439         }
1440
1441 DMIC:
1442         /* dmic */
1443         if (dmic_num > 0) {
1444                 if (ignore_pch_dmic) {
1445                         dev_warn(dev, "Ignoring PCH DMIC\n");
1446                         goto HDMI;
1447                 }
1448                 cpus[cpu_id].dai_name = "DMIC01 Pin";
1449                 init_dai_link(dev, links + link_index, be_id, "dmic01",
1450                               0, 1, // DMIC only supports capture
1451                               cpus + cpu_id, 1,
1452                               dmic_component, 1,
1453                               sof_sdw_dmic_init, NULL);
1454                 INC_ID(be_id, cpu_id, link_index);
1455
1456                 cpus[cpu_id].dai_name = "DMIC16k Pin";
1457                 init_dai_link(dev, links + link_index, be_id, "dmic16k",
1458                               0, 1, // DMIC only supports capture
1459                               cpus + cpu_id, 1,
1460                               dmic_component, 1,
1461                               /* don't call sof_sdw_dmic_init() twice */
1462                               NULL, NULL);
1463                 INC_ID(be_id, cpu_id, link_index);
1464         }
1465
1466 HDMI:
1467         /* HDMI */
1468         if (hdmi_num > 0) {
1469                 idisp_components = devm_kcalloc(dev, hdmi_num,
1470                                                 sizeof(*idisp_components),
1471                                                 GFP_KERNEL);
1472                 if (!idisp_components)
1473                         return -ENOMEM;
1474         }
1475
1476         for (i = 0; i < hdmi_num; i++) {
1477                 name = devm_kasprintf(dev, GFP_KERNEL,
1478                                       "iDisp%d", i + 1);
1479                 if (!name)
1480                         return -ENOMEM;
1481
1482                 if (ctx->idisp_codec) {
1483                         idisp_components[i].name = "ehdaudio0D2";
1484                         idisp_components[i].dai_name = devm_kasprintf(dev,
1485                                                                       GFP_KERNEL,
1486                                                                       "intel-hdmi-hifi%d",
1487                                                                       i + 1);
1488                         if (!idisp_components[i].dai_name)
1489                                 return -ENOMEM;
1490                 } else {
1491                         idisp_components[i].name = "snd-soc-dummy";
1492                         idisp_components[i].dai_name = "snd-soc-dummy-dai";
1493                 }
1494
1495                 cpu_name = devm_kasprintf(dev, GFP_KERNEL,
1496                                           "iDisp%d Pin", i + 1);
1497                 if (!cpu_name)
1498                         return -ENOMEM;
1499
1500                 cpus[cpu_id].dai_name = cpu_name;
1501                 init_dai_link(dev, links + link_index, be_id, name,
1502                               1, 0, // HDMI only supports playback
1503                               cpus + cpu_id, 1,
1504                               idisp_components + i, 1,
1505                               sof_sdw_hdmi_init, NULL);
1506                 INC_ID(be_id, cpu_id, link_index);
1507         }
1508
1509         if (sof_sdw_quirk & SOF_SSP_BT_OFFLOAD_PRESENT) {
1510                 int port = (sof_sdw_quirk & SOF_BT_OFFLOAD_SSP_MASK) >>
1511                                 SOF_BT_OFFLOAD_SSP_SHIFT;
1512
1513                 name = devm_kasprintf(dev, GFP_KERNEL, "SSP%d-BT", port);
1514                 if (!name)
1515                         return -ENOMEM;
1516
1517                 ssp_components = devm_kzalloc(dev, sizeof(*ssp_components),
1518                                                 GFP_KERNEL);
1519                 if (!ssp_components)
1520                         return -ENOMEM;
1521
1522                 ssp_components->name = "snd-soc-dummy";
1523                 ssp_components->dai_name = "snd-soc-dummy-dai";
1524
1525                 cpu_name = devm_kasprintf(dev, GFP_KERNEL, "SSP%d Pin", port);
1526                 if (!cpu_name)
1527                         return -ENOMEM;
1528
1529                 cpus[cpu_id].dai_name = cpu_name;
1530                 init_dai_link(dev, links + link_index, be_id, name, 1, 1,
1531                                 cpus + cpu_id, 1, ssp_components, 1, NULL, NULL);
1532         }
1533
1534         card->dai_link = links;
1535         card->num_links = num_links;
1536
1537         card->codec_conf = codec_conf;
1538         card->num_configs = codec_conf_count;
1539
1540         return 0;
1541 }
1542
1543 static int sof_sdw_card_late_probe(struct snd_soc_card *card)
1544 {
1545         struct mc_private *ctx = snd_soc_card_get_drvdata(card);
1546         int ret = 0;
1547         int i;
1548
1549         for (i = 0; i < ARRAY_SIZE(codec_info_list); i++) {
1550                 if (codec_info_list[i].codec_card_late_probe) {
1551                         ret = codec_info_list[i].codec_card_late_probe(card);
1552
1553                         if (ret < 0)
1554                                 return ret;
1555                 }
1556         }
1557
1558         if (ctx->idisp_codec)
1559                 ret = sof_sdw_hdmi_card_late_probe(card);
1560
1561         return ret;
1562 }
1563
1564 /* SoC card */
1565 static const char sdw_card_long_name[] = "Intel Soundwire SOF";
1566
1567 static struct snd_soc_card card_sof_sdw = {
1568         .name = "soundwire",
1569         .owner = THIS_MODULE,
1570         .late_probe = sof_sdw_card_late_probe,
1571 };
1572
1573 static void mc_dailink_exit_loop(struct snd_soc_card *card)
1574 {
1575         struct snd_soc_dai_link *link;
1576         int ret;
1577         int i, j;
1578
1579         for (i = 0; i < ARRAY_SIZE(codec_info_list); i++) {
1580                 if (!codec_info_list[i].exit)
1581                         continue;
1582                 /*
1583                  * We don't need to call .exit function if there is no matched
1584                  * dai link found.
1585                  */
1586                 for_each_card_prelinks(card, j, link) {
1587                         if (!strcmp(link->codecs[0].dai_name,
1588                                     codec_info_list[i].dai_name)) {
1589                                 ret = codec_info_list[i].exit(card, link);
1590                                 if (ret)
1591                                         dev_warn(card->dev,
1592                                                  "codec exit failed %d\n",
1593                                                  ret);
1594                                 break;
1595                         }
1596                 }
1597         }
1598 }
1599
1600 static int mc_probe(struct platform_device *pdev)
1601 {
1602         struct snd_soc_card *card = &card_sof_sdw;
1603         struct snd_soc_acpi_mach *mach;
1604         struct mc_private *ctx;
1605         int amp_num = 0, i;
1606         int ret;
1607
1608         dev_dbg(&pdev->dev, "Entry\n");
1609
1610         ctx = devm_kzalloc(&pdev->dev, sizeof(*ctx), GFP_KERNEL);
1611         if (!ctx)
1612                 return -ENOMEM;
1613
1614         dmi_check_system(sof_sdw_quirk_table);
1615
1616         if (quirk_override != -1) {
1617                 dev_info(&pdev->dev, "Overriding quirk 0x%lx => 0x%x\n",
1618                          sof_sdw_quirk, quirk_override);
1619                 sof_sdw_quirk = quirk_override;
1620         }
1621         log_quirks(&pdev->dev);
1622
1623         INIT_LIST_HEAD(&ctx->hdmi_pcm_list);
1624
1625         card->dev = &pdev->dev;
1626         snd_soc_card_set_drvdata(card, ctx);
1627
1628         mach = pdev->dev.platform_data;
1629         ret = sof_card_dai_links_create(&pdev->dev, mach,
1630                                         card);
1631         if (ret < 0)
1632                 return ret;
1633
1634         /*
1635          * the default amp_num is zero for each codec and
1636          * amp_num will only be increased for active amp
1637          * codecs on used platform
1638          */
1639         for (i = 0; i < ARRAY_SIZE(codec_info_list); i++)
1640                 amp_num += codec_info_list[i].amp_num;
1641
1642         card->components = devm_kasprintf(card->dev, GFP_KERNEL,
1643                                           "cfg-spk:%d cfg-amp:%d",
1644                                           (sof_sdw_quirk & SOF_SDW_FOUR_SPK)
1645                                           ? 4 : 2, amp_num);
1646         if (!card->components)
1647                 return -ENOMEM;
1648
1649         if (mach->mach_params.dmic_num) {
1650                 card->components = devm_kasprintf(card->dev, GFP_KERNEL,
1651                                                   "%s mic:dmic cfg-mics:%d",
1652                                                   card->components,
1653                                                   mach->mach_params.dmic_num);
1654                 if (!card->components)
1655                         return -ENOMEM;
1656         }
1657
1658         card->long_name = sdw_card_long_name;
1659
1660         /* Register the card */
1661         ret = devm_snd_soc_register_card(&pdev->dev, card);
1662         if (ret) {
1663                 dev_err(card->dev, "snd_soc_register_card failed %d\n", ret);
1664                 mc_dailink_exit_loop(card);
1665                 return ret;
1666         }
1667
1668         platform_set_drvdata(pdev, card);
1669
1670         return ret;
1671 }
1672
1673 static void mc_remove(struct platform_device *pdev)
1674 {
1675         struct snd_soc_card *card = platform_get_drvdata(pdev);
1676
1677         mc_dailink_exit_loop(card);
1678 }
1679
1680 static struct platform_driver sof_sdw_driver = {
1681         .driver = {
1682                 .name = "sof_sdw",
1683                 .pm = &snd_soc_pm_ops,
1684         },
1685         .probe = mc_probe,
1686         .remove_new = mc_remove,
1687 };
1688
1689 module_platform_driver(sof_sdw_driver);
1690
1691 MODULE_DESCRIPTION("ASoC SoundWire Generic Machine driver");
1692 MODULE_AUTHOR("Bard Liao <[email protected]>");
1693 MODULE_AUTHOR("Rander Wang <[email protected]>");
1694 MODULE_AUTHOR("Pierre-Louis Bossart <[email protected]>");
1695 MODULE_LICENSE("GPL v2");
1696 MODULE_ALIAS("platform:sof_sdw");
1697 MODULE_IMPORT_NS(SND_SOC_INTEL_HDA_DSP_COMMON);
1698 MODULE_IMPORT_NS(SND_SOC_INTEL_SOF_MAXIM_COMMON);
This page took 0.166896 seconds and 4 git commands to generate.