1 // SPDX-License-Identifier: GPL-2.0-only
2 //
3 // Copyright(c) 2021-2022 Intel Corporation. All rights reserved.
4 //
5 // Authors: Cezary Rojewski <cezary.rojewski@intel.com>
6 // Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com>
7 //
8
9 #include <linux/debugfs.h>
10 #include <linux/device.h>
11 #include <sound/hda_register.h>
12 #include <sound/hdaudio_ext.h>
13 #include <sound/pcm_params.h>
14 #include <sound/soc-acpi.h>
15 #include <sound/soc-acpi-intel-match.h>
16 #include <sound/soc-component.h>
17 #include "avs.h"
18 #include "path.h"
19 #include "topology.h"
20
21 struct avs_dma_data {
22 struct avs_tplg_path_template *template;
23 struct avs_path *path;
24 /*
25 * link stream is stored within substream's runtime
26 * private_data to fulfill the needs of codec BE path
27 *
28 * host stream assigned
29 */
30 struct hdac_ext_stream *host_stream;
31
32 struct snd_pcm_substream *substream;
33 };
34
35 static struct avs_tplg_path_template *
avs_dai_find_path_template(struct snd_soc_dai * dai,bool is_fe,int direction)36 avs_dai_find_path_template(struct snd_soc_dai *dai, bool is_fe, int direction)
37 {
38 struct snd_soc_dapm_widget *dw = snd_soc_dai_get_widget(dai, direction);
39 struct snd_soc_dapm_path *dp;
40 enum snd_soc_dapm_direction dir;
41
42 if (direction == SNDRV_PCM_STREAM_CAPTURE) {
43 dir = is_fe ? SND_SOC_DAPM_DIR_OUT : SND_SOC_DAPM_DIR_IN;
44 } else {
45 dir = is_fe ? SND_SOC_DAPM_DIR_IN : SND_SOC_DAPM_DIR_OUT;
46 }
47
48 dp = list_first_entry_or_null(&dw->edges[dir], typeof(*dp), list_node[dir]);
49 if (!dp)
50 return NULL;
51
52 /* Get the other widget, with actual path template data */
53 dw = (dp->source == dw) ? dp->sink : dp->source;
54
55 return dw->priv;
56 }
57
avs_dai_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai,bool is_fe,const struct snd_soc_dai_ops * ops)58 static int avs_dai_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai, bool is_fe,
59 const struct snd_soc_dai_ops *ops)
60 {
61 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
62 struct avs_dev *adev = to_avs_dev(dai->dev);
63 struct avs_tplg_path_template *template;
64 struct avs_dma_data *data;
65
66 template = avs_dai_find_path_template(dai, is_fe, substream->stream);
67 if (!template) {
68 dev_err(dai->dev, "no %s path for dai %s, invalid tplg?\n",
69 snd_pcm_stream_str(substream), dai->name);
70 return -EINVAL;
71 }
72
73 data = kzalloc(sizeof(*data), GFP_KERNEL);
74 if (!data)
75 return -ENOMEM;
76
77 data->substream = substream;
78 data->template = template;
79 snd_soc_dai_set_dma_data(dai, substream, data);
80
81 if (rtd->dai_link->ignore_suspend)
82 adev->num_lp_paths++;
83
84 return 0;
85 }
86
avs_dai_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * fe_hw_params,struct snd_pcm_hw_params * be_hw_params,struct snd_soc_dai * dai,int dma_id)87 static int avs_dai_hw_params(struct snd_pcm_substream *substream,
88 struct snd_pcm_hw_params *fe_hw_params,
89 struct snd_pcm_hw_params *be_hw_params, struct snd_soc_dai *dai,
90 int dma_id)
91 {
92 struct avs_dma_data *data;
93 struct avs_path *path;
94 struct avs_dev *adev = to_avs_dev(dai->dev);
95 int ret;
96
97 data = snd_soc_dai_get_dma_data(dai, substream);
98
99 dev_dbg(dai->dev, "%s FE hw_params str %p rtd %p",
100 __func__, substream, substream->runtime);
101 dev_dbg(dai->dev, "rate %d chn %d vbd %d bd %d\n",
102 params_rate(fe_hw_params), params_channels(fe_hw_params),
103 params_width(fe_hw_params), params_physical_width(fe_hw_params));
104
105 dev_dbg(dai->dev, "%s BE hw_params str %p rtd %p",
106 __func__, substream, substream->runtime);
107 dev_dbg(dai->dev, "rate %d chn %d vbd %d bd %d\n",
108 params_rate(be_hw_params), params_channels(be_hw_params),
109 params_width(be_hw_params), params_physical_width(be_hw_params));
110
111 path = avs_path_create(adev, dma_id, data->template, fe_hw_params, be_hw_params);
112 if (IS_ERR(path)) {
113 ret = PTR_ERR(path);
114 dev_err(dai->dev, "create path failed: %d\n", ret);
115 return ret;
116 }
117
118 data->path = path;
119 return 0;
120 }
121
avs_dai_be_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * be_hw_params,struct snd_soc_dai * dai,int dma_id)122 static int avs_dai_be_hw_params(struct snd_pcm_substream *substream,
123 struct snd_pcm_hw_params *be_hw_params, struct snd_soc_dai *dai,
124 int dma_id)
125 {
126 struct snd_pcm_hw_params *fe_hw_params = NULL;
127 struct snd_soc_pcm_runtime *fe, *be;
128 struct snd_soc_dpcm *dpcm;
129
130 be = asoc_substream_to_rtd(substream);
131 for_each_dpcm_fe(be, substream->stream, dpcm) {
132 fe = dpcm->fe;
133 fe_hw_params = &fe->dpcm[substream->stream].hw_params;
134 }
135
136 return avs_dai_hw_params(substream, fe_hw_params, be_hw_params, dai, dma_id);
137 }
138
avs_dai_prepare(struct avs_dev * adev,struct snd_pcm_substream * substream,struct snd_soc_dai * dai)139 static int avs_dai_prepare(struct avs_dev *adev, struct snd_pcm_substream *substream,
140 struct snd_soc_dai *dai)
141 {
142 struct avs_dma_data *data;
143 int ret;
144
145 data = snd_soc_dai_get_dma_data(dai, substream);
146 if (!data->path)
147 return 0;
148
149 ret = avs_path_reset(data->path);
150 if (ret < 0) {
151 dev_err(dai->dev, "reset path failed: %d\n", ret);
152 return ret;
153 }
154
155 ret = avs_path_pause(data->path);
156 if (ret < 0)
157 dev_err(dai->dev, "pause path failed: %d\n", ret);
158 return ret;
159 }
160
161 static const struct snd_soc_dai_ops avs_dai_nonhda_be_ops;
162
avs_dai_nonhda_be_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)163 static int avs_dai_nonhda_be_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
164 {
165 return avs_dai_startup(substream, dai, false, &avs_dai_nonhda_be_ops);
166 }
167
avs_dai_nonhda_be_shutdown(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)168 static void avs_dai_nonhda_be_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
169 {
170 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
171 struct avs_dev *adev = to_avs_dev(dai->dev);
172 struct avs_dma_data *data;
173
174 if (rtd->dai_link->ignore_suspend)
175 adev->num_lp_paths--;
176
177 data = snd_soc_dai_get_dma_data(dai, substream);
178
179 snd_soc_dai_set_dma_data(dai, substream, NULL);
180 kfree(data);
181 }
182
avs_dai_nonhda_be_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * hw_params,struct snd_soc_dai * dai)183 static int avs_dai_nonhda_be_hw_params(struct snd_pcm_substream *substream,
184 struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai)
185 {
186 struct avs_dma_data *data;
187
188 data = snd_soc_dai_get_dma_data(dai, substream);
189 if (data->path)
190 return 0;
191
192 /* Actual port-id comes from topology. */
193 return avs_dai_be_hw_params(substream, hw_params, dai, 0);
194 }
195
avs_dai_nonhda_be_hw_free(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)196 static int avs_dai_nonhda_be_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
197 {
198 struct avs_dma_data *data;
199
200 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
201
202 data = snd_soc_dai_get_dma_data(dai, substream);
203 if (data->path) {
204 avs_path_free(data->path);
205 data->path = NULL;
206 }
207
208 return 0;
209 }
210
avs_dai_nonhda_be_prepare(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)211 static int avs_dai_nonhda_be_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
212 {
213 return avs_dai_prepare(to_avs_dev(dai->dev), substream, dai);
214 }
215
avs_dai_nonhda_be_trigger(struct snd_pcm_substream * substream,int cmd,struct snd_soc_dai * dai)216 static int avs_dai_nonhda_be_trigger(struct snd_pcm_substream *substream, int cmd,
217 struct snd_soc_dai *dai)
218 {
219 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
220 struct avs_dma_data *data;
221 int ret = 0;
222
223 data = snd_soc_dai_get_dma_data(dai, substream);
224
225 switch (cmd) {
226 case SNDRV_PCM_TRIGGER_RESUME:
227 if (rtd->dai_link->ignore_suspend)
228 break;
229 fallthrough;
230 case SNDRV_PCM_TRIGGER_START:
231 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
232 ret = avs_path_pause(data->path);
233 if (ret < 0) {
234 dev_err(dai->dev, "pause BE path failed: %d\n", ret);
235 break;
236 }
237
238 ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO);
239 if (ret < 0)
240 dev_err(dai->dev, "run BE path failed: %d\n", ret);
241 break;
242
243 case SNDRV_PCM_TRIGGER_SUSPEND:
244 if (rtd->dai_link->ignore_suspend)
245 break;
246 fallthrough;
247 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
248 case SNDRV_PCM_TRIGGER_STOP:
249 ret = avs_path_pause(data->path);
250 if (ret < 0)
251 dev_err(dai->dev, "pause BE path failed: %d\n", ret);
252
253 ret = avs_path_reset(data->path);
254 if (ret < 0)
255 dev_err(dai->dev, "reset BE path failed: %d\n", ret);
256 break;
257
258 default:
259 ret = -EINVAL;
260 break;
261 }
262
263 return ret;
264 }
265
266 static const struct snd_soc_dai_ops avs_dai_nonhda_be_ops = {
267 .startup = avs_dai_nonhda_be_startup,
268 .shutdown = avs_dai_nonhda_be_shutdown,
269 .hw_params = avs_dai_nonhda_be_hw_params,
270 .hw_free = avs_dai_nonhda_be_hw_free,
271 .prepare = avs_dai_nonhda_be_prepare,
272 .trigger = avs_dai_nonhda_be_trigger,
273 };
274
275 static const struct snd_soc_dai_ops avs_dai_hda_be_ops;
276
avs_dai_hda_be_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)277 static int avs_dai_hda_be_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
278 {
279 return avs_dai_startup(substream, dai, false, &avs_dai_hda_be_ops);
280 }
281
avs_dai_hda_be_shutdown(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)282 static void avs_dai_hda_be_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
283 {
284 return avs_dai_nonhda_be_shutdown(substream, dai);
285 }
286
avs_dai_hda_be_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * hw_params,struct snd_soc_dai * dai)287 static int avs_dai_hda_be_hw_params(struct snd_pcm_substream *substream,
288 struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai)
289 {
290 struct avs_dma_data *data;
291 struct hdac_ext_stream *link_stream;
292
293 data = snd_soc_dai_get_dma_data(dai, substream);
294 if (data->path)
295 return 0;
296
297 link_stream = substream->runtime->private_data;
298
299 return avs_dai_be_hw_params(substream, hw_params, dai,
300 hdac_stream(link_stream)->stream_tag - 1);
301 }
302
avs_dai_hda_be_hw_free(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)303 static int avs_dai_hda_be_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
304 {
305 struct avs_dma_data *data;
306 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
307 struct hdac_ext_stream *link_stream;
308 struct hdac_ext_link *link;
309 struct hda_codec *codec;
310
311 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
312
313 data = snd_soc_dai_get_dma_data(dai, substream);
314 if (!data->path)
315 return 0;
316
317 link_stream = substream->runtime->private_data;
318 link_stream->link_prepared = false;
319 avs_path_free(data->path);
320 data->path = NULL;
321
322 /* clear link <-> stream mapping */
323 codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev);
324 link = snd_hdac_ext_bus_get_hlink_by_addr(&codec->bus->core, codec->core.addr);
325 if (!link)
326 return -EINVAL;
327
328 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
329 snd_hdac_ext_bus_link_clear_stream_id(link, hdac_stream(link_stream)->stream_tag);
330
331 return 0;
332 }
333
avs_dai_hda_be_prepare(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)334 static int avs_dai_hda_be_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
335 {
336 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
337 struct snd_pcm_runtime *runtime = substream->runtime;
338 struct hdac_ext_stream *link_stream = runtime->private_data;
339 struct hdac_ext_link *link;
340 struct hda_codec *codec;
341 struct hdac_bus *bus;
342 unsigned int format_val;
343 int ret;
344
345 if (link_stream->link_prepared)
346 return 0;
347
348 codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev);
349 bus = &codec->bus->core;
350 format_val = snd_hdac_calc_stream_format(runtime->rate, runtime->channels, runtime->format,
351 runtime->sample_bits, 0);
352
353 snd_hdac_ext_stream_decouple(bus, link_stream, true);
354 snd_hdac_ext_stream_reset(link_stream);
355 snd_hdac_ext_stream_setup(link_stream, format_val);
356
357 link = snd_hdac_ext_bus_get_hlink_by_addr(bus, codec->core.addr);
358 if (!link)
359 return -EINVAL;
360
361 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
362 snd_hdac_ext_bus_link_set_stream_id(link, hdac_stream(link_stream)->stream_tag);
363
364 ret = avs_dai_prepare(to_avs_dev(dai->dev), substream, dai);
365 if (ret)
366 return ret;
367
368 link_stream->link_prepared = true;
369 return 0;
370 }
371
avs_dai_hda_be_trigger(struct snd_pcm_substream * substream,int cmd,struct snd_soc_dai * dai)372 static int avs_dai_hda_be_trigger(struct snd_pcm_substream *substream, int cmd,
373 struct snd_soc_dai *dai)
374 {
375 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
376 struct hdac_ext_stream *link_stream;
377 struct avs_dma_data *data;
378 int ret = 0;
379
380 dev_dbg(dai->dev, "entry %s cmd=%d\n", __func__, cmd);
381
382 data = snd_soc_dai_get_dma_data(dai, substream);
383 link_stream = substream->runtime->private_data;
384
385 switch (cmd) {
386 case SNDRV_PCM_TRIGGER_RESUME:
387 if (rtd->dai_link->ignore_suspend)
388 break;
389 fallthrough;
390 case SNDRV_PCM_TRIGGER_START:
391 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
392 snd_hdac_ext_stream_start(link_stream);
393
394 ret = avs_path_pause(data->path);
395 if (ret < 0) {
396 dev_err(dai->dev, "pause BE path failed: %d\n", ret);
397 break;
398 }
399
400 ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO);
401 if (ret < 0)
402 dev_err(dai->dev, "run BE path failed: %d\n", ret);
403 break;
404
405 case SNDRV_PCM_TRIGGER_SUSPEND:
406 if (rtd->dai_link->ignore_suspend)
407 break;
408 fallthrough;
409 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
410 case SNDRV_PCM_TRIGGER_STOP:
411 ret = avs_path_pause(data->path);
412 if (ret < 0)
413 dev_err(dai->dev, "pause BE path failed: %d\n", ret);
414
415 snd_hdac_ext_stream_clear(link_stream);
416
417 ret = avs_path_reset(data->path);
418 if (ret < 0)
419 dev_err(dai->dev, "reset BE path failed: %d\n", ret);
420 break;
421
422 default:
423 ret = -EINVAL;
424 break;
425 }
426
427 return ret;
428 }
429
430 static const struct snd_soc_dai_ops avs_dai_hda_be_ops = {
431 .startup = avs_dai_hda_be_startup,
432 .shutdown = avs_dai_hda_be_shutdown,
433 .hw_params = avs_dai_hda_be_hw_params,
434 .hw_free = avs_dai_hda_be_hw_free,
435 .prepare = avs_dai_hda_be_prepare,
436 .trigger = avs_dai_hda_be_trigger,
437 };
438
439 static const unsigned int rates[] = {
440 8000, 11025, 12000, 16000,
441 22050, 24000, 32000, 44100,
442 48000, 64000, 88200, 96000,
443 128000, 176400, 192000,
444 };
445
446 static const struct snd_pcm_hw_constraint_list hw_rates = {
447 .count = ARRAY_SIZE(rates),
448 .list = rates,
449 .mask = 0,
450 };
451
452 const struct snd_soc_dai_ops avs_dai_fe_ops;
453
avs_dai_fe_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)454 static int avs_dai_fe_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
455 {
456 struct snd_pcm_runtime *runtime = substream->runtime;
457 struct avs_dma_data *data;
458 struct avs_dev *adev = to_avs_dev(dai->dev);
459 struct hdac_bus *bus = &adev->base.core;
460 struct hdac_ext_stream *host_stream;
461 int ret;
462
463 ret = avs_dai_startup(substream, dai, true, &avs_dai_fe_ops);
464 if (ret)
465 return ret;
466
467 data = snd_soc_dai_get_dma_data(dai, substream);
468
469 host_stream = snd_hdac_ext_stream_assign(bus, substream, HDAC_EXT_STREAM_TYPE_HOST);
470 if (!host_stream) {
471 ret = -EBUSY;
472 goto err;
473 }
474
475 data->host_stream = host_stream;
476 ret = snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
477 if (ret < 0)
478 goto err;
479
480 /* avoid wrap-around with wall-clock */
481 ret = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_TIME, 20, 178000000);
482 if (ret < 0)
483 goto err;
484
485 ret = snd_pcm_hw_constraint_list(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, &hw_rates);
486 if (ret < 0)
487 goto err;
488
489 snd_pcm_set_sync(substream);
490
491 dev_dbg(dai->dev, "%s fe STARTUP tag %d str %p",
492 __func__, hdac_stream(host_stream)->stream_tag, substream);
493
494 return 0;
495
496 err:
497 kfree(data);
498 return ret;
499 }
500
avs_dai_fe_shutdown(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)501 static void avs_dai_fe_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
502 {
503 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
504 struct avs_dev *adev = to_avs_dev(dai->dev);
505 struct avs_dma_data *data;
506
507 if (rtd->dai_link->ignore_suspend)
508 adev->num_lp_paths--;
509
510 data = snd_soc_dai_get_dma_data(dai, substream);
511
512 snd_soc_dai_set_dma_data(dai, substream, NULL);
513 snd_hdac_ext_stream_release(data->host_stream, HDAC_EXT_STREAM_TYPE_HOST);
514 kfree(data);
515 }
516
avs_dai_fe_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * hw_params,struct snd_soc_dai * dai)517 static int avs_dai_fe_hw_params(struct snd_pcm_substream *substream,
518 struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai)
519 {
520 struct snd_pcm_hw_params *be_hw_params = NULL;
521 struct snd_soc_pcm_runtime *fe, *be;
522 struct snd_soc_dpcm *dpcm;
523 struct avs_dma_data *data;
524 struct hdac_ext_stream *host_stream;
525 int ret;
526
527 data = snd_soc_dai_get_dma_data(dai, substream);
528 if (data->path)
529 return 0;
530
531 host_stream = data->host_stream;
532
533 hdac_stream(host_stream)->bufsize = 0;
534 hdac_stream(host_stream)->period_bytes = 0;
535 hdac_stream(host_stream)->format_val = 0;
536
537 fe = asoc_substream_to_rtd(substream);
538 for_each_dpcm_be(fe, substream->stream, dpcm) {
539 be = dpcm->be;
540 be_hw_params = &be->dpcm[substream->stream].hw_params;
541 }
542
543 ret = avs_dai_hw_params(substream, hw_params, be_hw_params, dai,
544 hdac_stream(host_stream)->stream_tag - 1);
545 if (ret)
546 goto create_err;
547
548 ret = avs_path_bind(data->path);
549 if (ret < 0) {
550 dev_err(dai->dev, "bind FE <-> BE failed: %d\n", ret);
551 goto bind_err;
552 }
553
554 return 0;
555
556 bind_err:
557 avs_path_free(data->path);
558 data->path = NULL;
559 create_err:
560 snd_pcm_lib_free_pages(substream);
561 return ret;
562 }
563
__avs_dai_fe_hw_free(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)564 static int __avs_dai_fe_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
565 {
566 struct avs_dma_data *data;
567 struct hdac_ext_stream *host_stream;
568 int ret;
569
570 dev_dbg(dai->dev, "%s fe HW_FREE str %p rtd %p",
571 __func__, substream, substream->runtime);
572
573 data = snd_soc_dai_get_dma_data(dai, substream);
574 if (!data->path)
575 return 0;
576
577 host_stream = data->host_stream;
578
579 ret = avs_path_unbind(data->path);
580 if (ret < 0)
581 dev_err(dai->dev, "unbind FE <-> BE failed: %d\n", ret);
582
583 avs_path_free(data->path);
584 data->path = NULL;
585 snd_hdac_stream_cleanup(hdac_stream(host_stream));
586 hdac_stream(host_stream)->prepared = false;
587
588 return ret;
589 }
590
avs_dai_fe_hw_free(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)591 static int avs_dai_fe_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
592 {
593 int ret;
594
595 ret = __avs_dai_fe_hw_free(substream, dai);
596 snd_pcm_lib_free_pages(substream);
597
598 return ret;
599 }
600
avs_dai_fe_prepare(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)601 static int avs_dai_fe_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
602 {
603 struct snd_pcm_runtime *runtime = substream->runtime;
604 struct avs_dma_data *data;
605 struct avs_dev *adev = to_avs_dev(dai->dev);
606 struct hdac_ext_stream *host_stream;
607 struct hdac_bus *bus;
608 unsigned int format_val;
609 int ret;
610
611 data = snd_soc_dai_get_dma_data(dai, substream);
612 host_stream = data->host_stream;
613
614 if (hdac_stream(host_stream)->prepared)
615 return 0;
616
617 bus = hdac_stream(host_stream)->bus;
618 snd_hdac_ext_stream_decouple(bus, data->host_stream, true);
619 snd_hdac_stream_reset(hdac_stream(host_stream));
620
621 format_val = snd_hdac_calc_stream_format(runtime->rate, runtime->channels, runtime->format,
622 runtime->sample_bits, 0);
623
624 ret = snd_hdac_stream_set_params(hdac_stream(host_stream), format_val);
625 if (ret < 0)
626 return ret;
627
628 ret = snd_hdac_stream_setup(hdac_stream(host_stream));
629 if (ret < 0)
630 return ret;
631
632 ret = avs_dai_prepare(adev, substream, dai);
633 if (ret)
634 return ret;
635
636 hdac_stream(host_stream)->prepared = true;
637 return 0;
638 }
639
avs_dai_fe_trigger(struct snd_pcm_substream * substream,int cmd,struct snd_soc_dai * dai)640 static int avs_dai_fe_trigger(struct snd_pcm_substream *substream, int cmd, struct snd_soc_dai *dai)
641 {
642 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
643 struct avs_dma_data *data;
644 struct hdac_ext_stream *host_stream;
645 struct hdac_bus *bus;
646 unsigned long flags;
647 int ret = 0;
648
649 data = snd_soc_dai_get_dma_data(dai, substream);
650 host_stream = data->host_stream;
651 bus = hdac_stream(host_stream)->bus;
652
653 switch (cmd) {
654 case SNDRV_PCM_TRIGGER_RESUME:
655 if (rtd->dai_link->ignore_suspend)
656 break;
657 fallthrough;
658 case SNDRV_PCM_TRIGGER_START:
659 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
660 spin_lock_irqsave(&bus->reg_lock, flags);
661 snd_hdac_stream_start(hdac_stream(host_stream));
662 spin_unlock_irqrestore(&bus->reg_lock, flags);
663
664 /* Timeout on DRSM poll shall not stop the resume so ignore the result. */
665 if (cmd == SNDRV_PCM_TRIGGER_RESUME)
666 snd_hdac_stream_wait_drsm(hdac_stream(host_stream));
667
668 ret = avs_path_pause(data->path);
669 if (ret < 0) {
670 dev_err(dai->dev, "pause FE path failed: %d\n", ret);
671 break;
672 }
673
674 ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO);
675 if (ret < 0)
676 dev_err(dai->dev, "run FE path failed: %d\n", ret);
677
678 break;
679
680 case SNDRV_PCM_TRIGGER_SUSPEND:
681 if (rtd->dai_link->ignore_suspend)
682 break;
683 fallthrough;
684 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
685 case SNDRV_PCM_TRIGGER_STOP:
686 ret = avs_path_pause(data->path);
687 if (ret < 0)
688 dev_err(dai->dev, "pause FE path failed: %d\n", ret);
689
690 spin_lock_irqsave(&bus->reg_lock, flags);
691 snd_hdac_stream_stop(hdac_stream(host_stream));
692 spin_unlock_irqrestore(&bus->reg_lock, flags);
693
694 ret = avs_path_reset(data->path);
695 if (ret < 0)
696 dev_err(dai->dev, "reset FE path failed: %d\n", ret);
697 break;
698
699 default:
700 ret = -EINVAL;
701 break;
702 }
703
704 return ret;
705 }
706
707 const struct snd_soc_dai_ops avs_dai_fe_ops = {
708 .startup = avs_dai_fe_startup,
709 .shutdown = avs_dai_fe_shutdown,
710 .hw_params = avs_dai_fe_hw_params,
711 .hw_free = avs_dai_fe_hw_free,
712 .prepare = avs_dai_fe_prepare,
713 .trigger = avs_dai_fe_trigger,
714 };
715
topology_name_read(struct file * file,char __user * user_buf,size_t count,loff_t * ppos)716 static ssize_t topology_name_read(struct file *file, char __user *user_buf, size_t count,
717 loff_t *ppos)
718 {
719 struct snd_soc_component *component = file->private_data;
720 struct snd_soc_card *card = component->card;
721 struct snd_soc_acpi_mach *mach = dev_get_platdata(card->dev);
722 char buf[64];
723 size_t len;
724
725 len = scnprintf(buf, sizeof(buf), "%s/%s\n", component->driver->topology_name_prefix,
726 mach->tplg_filename);
727
728 return simple_read_from_buffer(user_buf, count, ppos, buf, len);
729 }
730
731 static const struct file_operations topology_name_fops = {
732 .open = simple_open,
733 .read = topology_name_read,
734 .llseek = default_llseek,
735 };
736
avs_component_load_libraries(struct avs_soc_component * acomp)737 static int avs_component_load_libraries(struct avs_soc_component *acomp)
738 {
739 struct avs_tplg *tplg = acomp->tplg;
740 struct avs_dev *adev = to_avs_dev(acomp->base.dev);
741 int ret;
742
743 if (!tplg->num_libs)
744 return 0;
745
746 /* Parent device may be asleep and library loading involves IPCs. */
747 ret = pm_runtime_resume_and_get(adev->dev);
748 if (ret < 0)
749 return ret;
750
751 avs_hda_power_gating_enable(adev, false);
752 avs_hda_clock_gating_enable(adev, false);
753 avs_hda_l1sen_enable(adev, false);
754
755 ret = avs_dsp_load_libraries(adev, tplg->libs, tplg->num_libs);
756
757 avs_hda_l1sen_enable(adev, true);
758 avs_hda_clock_gating_enable(adev, true);
759 avs_hda_power_gating_enable(adev, true);
760
761 if (!ret)
762 ret = avs_module_info_init(adev, false);
763
764 pm_runtime_mark_last_busy(adev->dev);
765 pm_runtime_put_autosuspend(adev->dev);
766
767 return ret;
768 }
769
avs_component_probe(struct snd_soc_component * component)770 static int avs_component_probe(struct snd_soc_component *component)
771 {
772 struct snd_soc_card *card = component->card;
773 struct snd_soc_acpi_mach *mach;
774 struct avs_soc_component *acomp;
775 struct avs_dev *adev;
776 char *filename;
777 int ret;
778
779 dev_dbg(card->dev, "probing %s card %s\n", component->name, card->name);
780 mach = dev_get_platdata(card->dev);
781 acomp = to_avs_soc_component(component);
782 adev = to_avs_dev(component->dev);
783
784 acomp->tplg = avs_tplg_new(component);
785 if (!acomp->tplg)
786 return -ENOMEM;
787
788 if (!mach->tplg_filename)
789 goto finalize;
790
791 /* Load specified topology and create debugfs for it. */
792 filename = kasprintf(GFP_KERNEL, "%s/%s", component->driver->topology_name_prefix,
793 mach->tplg_filename);
794 if (!filename)
795 return -ENOMEM;
796
797 ret = avs_load_topology(component, filename);
798 kfree(filename);
799 if (ret == -ENOENT && !strncmp(mach->tplg_filename, "hda-", 4)) {
800 unsigned int vendor_id;
801
802 if (sscanf(mach->tplg_filename, "hda-%08x-tplg.bin", &vendor_id) != 1)
803 return ret;
804
805 if (((vendor_id >> 16) & 0xFFFF) == 0x8086)
806 mach->tplg_filename = devm_kasprintf(adev->dev, GFP_KERNEL,
807 "hda-8086-generic-tplg.bin");
808 else
809 mach->tplg_filename = devm_kasprintf(adev->dev, GFP_KERNEL,
810 "hda-generic-tplg.bin");
811
812 filename = kasprintf(GFP_KERNEL, "%s/%s", component->driver->topology_name_prefix,
813 mach->tplg_filename);
814 if (!filename)
815 return -ENOMEM;
816
817 dev_info(card->dev, "trying to load fallback topology %s\n", mach->tplg_filename);
818 ret = avs_load_topology(component, filename);
819 kfree(filename);
820 }
821 if (ret < 0)
822 return ret;
823
824 ret = avs_component_load_libraries(acomp);
825 if (ret < 0) {
826 dev_err(card->dev, "libraries loading failed: %d\n", ret);
827 goto err_load_libs;
828 }
829
830 finalize:
831 debugfs_create_file("topology_name", 0444, component->debugfs_root, component,
832 &topology_name_fops);
833
834 mutex_lock(&adev->comp_list_mutex);
835 list_add_tail(&acomp->node, &adev->comp_list);
836 mutex_unlock(&adev->comp_list_mutex);
837
838 return 0;
839
840 err_load_libs:
841 avs_remove_topology(component);
842 return ret;
843 }
844
avs_component_remove(struct snd_soc_component * component)845 static void avs_component_remove(struct snd_soc_component *component)
846 {
847 struct avs_soc_component *acomp = to_avs_soc_component(component);
848 struct snd_soc_acpi_mach *mach;
849 struct avs_dev *adev = to_avs_dev(component->dev);
850 int ret;
851
852 mach = dev_get_platdata(component->card->dev);
853
854 mutex_lock(&adev->comp_list_mutex);
855 list_del(&acomp->node);
856 mutex_unlock(&adev->comp_list_mutex);
857
858 if (mach->tplg_filename) {
859 ret = avs_remove_topology(component);
860 if (ret < 0)
861 dev_err(component->dev, "unload topology failed: %d\n", ret);
862 }
863 }
864
avs_dai_resume_hw_params(struct snd_soc_dai * dai,struct avs_dma_data * data)865 static int avs_dai_resume_hw_params(struct snd_soc_dai *dai, struct avs_dma_data *data)
866 {
867 struct snd_pcm_substream *substream;
868 struct snd_soc_pcm_runtime *rtd;
869 int ret;
870
871 substream = data->substream;
872 rtd = asoc_substream_to_rtd(substream);
873
874 ret = dai->driver->ops->hw_params(substream, &rtd->dpcm[substream->stream].hw_params, dai);
875 if (ret)
876 dev_err(dai->dev, "hw_params on resume failed: %d\n", ret);
877
878 return ret;
879 }
880
avs_dai_resume_fe_prepare(struct snd_soc_dai * dai,struct avs_dma_data * data)881 static int avs_dai_resume_fe_prepare(struct snd_soc_dai *dai, struct avs_dma_data *data)
882 {
883 struct hdac_ext_stream *host_stream;
884 struct hdac_stream *hstream;
885 struct hdac_bus *bus;
886 int ret;
887
888 host_stream = data->host_stream;
889 hstream = hdac_stream(host_stream);
890 bus = hdac_stream(host_stream)->bus;
891
892 /* Set DRSM before programming stream and position registers. */
893 snd_hdac_stream_drsm_enable(bus, true, hstream->index);
894
895 ret = dai->driver->ops->prepare(data->substream, dai);
896 if (ret) {
897 dev_err(dai->dev, "prepare FE on resume failed: %d\n", ret);
898 return ret;
899 }
900
901 writel(host_stream->pphcllpl, host_stream->pphc_addr + AZX_REG_PPHCLLPL);
902 writel(host_stream->pphcllpu, host_stream->pphc_addr + AZX_REG_PPHCLLPU);
903 writel(host_stream->pphcldpl, host_stream->pphc_addr + AZX_REG_PPHCLDPL);
904 writel(host_stream->pphcldpu, host_stream->pphc_addr + AZX_REG_PPHCLDPU);
905
906 /* As per HW spec recommendation, program LPIB and DPIB to the same value. */
907 snd_hdac_stream_set_lpib(hstream, hstream->lpib);
908 snd_hdac_stream_set_dpibr(bus, hstream, hstream->lpib);
909
910 return 0;
911 }
912
avs_dai_resume_be_prepare(struct snd_soc_dai * dai,struct avs_dma_data * data)913 static int avs_dai_resume_be_prepare(struct snd_soc_dai *dai, struct avs_dma_data *data)
914 {
915 int ret;
916
917 ret = dai->driver->ops->prepare(data->substream, dai);
918 if (ret)
919 dev_err(dai->dev, "prepare BE on resume failed: %d\n", ret);
920
921 return ret;
922 }
923
avs_dai_suspend_fe_hw_free(struct snd_soc_dai * dai,struct avs_dma_data * data)924 static int avs_dai_suspend_fe_hw_free(struct snd_soc_dai *dai, struct avs_dma_data *data)
925 {
926 struct hdac_ext_stream *host_stream;
927 int ret;
928
929 host_stream = data->host_stream;
930
931 /* Store position addresses so we can resume from them later on. */
932 hdac_stream(host_stream)->lpib = snd_hdac_stream_get_pos_lpib(hdac_stream(host_stream));
933 host_stream->pphcllpl = readl(host_stream->pphc_addr + AZX_REG_PPHCLLPL);
934 host_stream->pphcllpu = readl(host_stream->pphc_addr + AZX_REG_PPHCLLPU);
935 host_stream->pphcldpl = readl(host_stream->pphc_addr + AZX_REG_PPHCLDPL);
936 host_stream->pphcldpu = readl(host_stream->pphc_addr + AZX_REG_PPHCLDPU);
937
938 ret = __avs_dai_fe_hw_free(data->substream, dai);
939 if (ret < 0)
940 dev_err(dai->dev, "hw_free FE on suspend failed: %d\n", ret);
941
942 return ret;
943 }
944
avs_dai_suspend_be_hw_free(struct snd_soc_dai * dai,struct avs_dma_data * data)945 static int avs_dai_suspend_be_hw_free(struct snd_soc_dai *dai, struct avs_dma_data *data)
946 {
947 int ret;
948
949 ret = dai->driver->ops->hw_free(data->substream, dai);
950 if (ret < 0)
951 dev_err(dai->dev, "hw_free BE on suspend failed: %d\n", ret);
952
953 return ret;
954 }
955
avs_component_pm_op(struct snd_soc_component * component,bool be,int (* op)(struct snd_soc_dai *,struct avs_dma_data *))956 static int avs_component_pm_op(struct snd_soc_component *component, bool be,
957 int (*op)(struct snd_soc_dai *, struct avs_dma_data *))
958 {
959 struct snd_soc_pcm_runtime *rtd;
960 struct avs_dma_data *data;
961 struct snd_soc_dai *dai;
962 int ret;
963
964 for_each_component_dais(component, dai) {
965 data = snd_soc_dai_dma_data_get_playback(dai);
966 if (data) {
967 rtd = asoc_substream_to_rtd(data->substream);
968 if (rtd->dai_link->no_pcm == be && !rtd->dai_link->ignore_suspend) {
969 ret = op(dai, data);
970 if (ret < 0) {
971 __snd_pcm_set_state(data->substream->runtime,
972 SNDRV_PCM_STATE_DISCONNECTED);
973 return ret;
974 }
975 }
976 }
977
978 data = snd_soc_dai_dma_data_get_capture(dai);
979 if (data) {
980 rtd = asoc_substream_to_rtd(data->substream);
981 if (rtd->dai_link->no_pcm == be && !rtd->dai_link->ignore_suspend) {
982 ret = op(dai, data);
983 if (ret < 0) {
984 __snd_pcm_set_state(data->substream->runtime,
985 SNDRV_PCM_STATE_DISCONNECTED);
986 return ret;
987 }
988 }
989 }
990 }
991
992 return 0;
993 }
994
avs_component_resume_hw_params(struct snd_soc_component * component,bool be)995 static int avs_component_resume_hw_params(struct snd_soc_component *component, bool be)
996 {
997 return avs_component_pm_op(component, be, &avs_dai_resume_hw_params);
998 }
999
avs_component_resume_prepare(struct snd_soc_component * component,bool be)1000 static int avs_component_resume_prepare(struct snd_soc_component *component, bool be)
1001 {
1002 int (*prepare_cb)(struct snd_soc_dai *dai, struct avs_dma_data *data);
1003
1004 if (be)
1005 prepare_cb = &avs_dai_resume_be_prepare;
1006 else
1007 prepare_cb = &avs_dai_resume_fe_prepare;
1008
1009 return avs_component_pm_op(component, be, prepare_cb);
1010 }
1011
avs_component_suspend_hw_free(struct snd_soc_component * component,bool be)1012 static int avs_component_suspend_hw_free(struct snd_soc_component *component, bool be)
1013 {
1014 int (*hw_free_cb)(struct snd_soc_dai *dai, struct avs_dma_data *data);
1015
1016 if (be)
1017 hw_free_cb = &avs_dai_suspend_be_hw_free;
1018 else
1019 hw_free_cb = &avs_dai_suspend_fe_hw_free;
1020
1021 return avs_component_pm_op(component, be, hw_free_cb);
1022 }
1023
avs_component_suspend(struct snd_soc_component * component)1024 static int avs_component_suspend(struct snd_soc_component *component)
1025 {
1026 int ret;
1027
1028 /*
1029 * When freeing paths, FEs need to be first as they perform
1030 * path unbinding.
1031 */
1032 ret = avs_component_suspend_hw_free(component, false);
1033 if (ret)
1034 return ret;
1035
1036 return avs_component_suspend_hw_free(component, true);
1037 }
1038
avs_component_resume(struct snd_soc_component * component)1039 static int avs_component_resume(struct snd_soc_component *component)
1040 {
1041 int ret;
1042
1043 /*
1044 * When creating paths, FEs need to be last as they perform
1045 * path binding.
1046 */
1047 ret = avs_component_resume_hw_params(component, true);
1048 if (ret)
1049 return ret;
1050
1051 ret = avs_component_resume_hw_params(component, false);
1052 if (ret)
1053 return ret;
1054
1055 /* It is expected that the LINK stream is prepared first. */
1056 ret = avs_component_resume_prepare(component, true);
1057 if (ret)
1058 return ret;
1059
1060 return avs_component_resume_prepare(component, false);
1061 }
1062
1063 static const struct snd_pcm_hardware avs_pcm_hardware = {
1064 .info = SNDRV_PCM_INFO_MMAP |
1065 SNDRV_PCM_INFO_MMAP_VALID |
1066 SNDRV_PCM_INFO_INTERLEAVED |
1067 SNDRV_PCM_INFO_PAUSE |
1068 SNDRV_PCM_INFO_RESUME |
1069 SNDRV_PCM_INFO_NO_PERIOD_WAKEUP,
1070 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1071 SNDRV_PCM_FMTBIT_S24_LE |
1072 SNDRV_PCM_FMTBIT_S32_LE,
1073 .buffer_bytes_max = AZX_MAX_BUF_SIZE,
1074 .period_bytes_min = 128,
1075 .period_bytes_max = AZX_MAX_BUF_SIZE / 2,
1076 .periods_min = 2,
1077 .periods_max = AZX_MAX_FRAG,
1078 .fifo_size = 0,
1079 };
1080
avs_component_open(struct snd_soc_component * component,struct snd_pcm_substream * substream)1081 static int avs_component_open(struct snd_soc_component *component,
1082 struct snd_pcm_substream *substream)
1083 {
1084 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1085
1086 /* only FE DAI links are handled here */
1087 if (rtd->dai_link->no_pcm)
1088 return 0;
1089
1090 return snd_soc_set_runtime_hwparams(substream, &avs_pcm_hardware);
1091 }
1092
avs_hda_stream_dpib_read(struct hdac_ext_stream * stream)1093 static unsigned int avs_hda_stream_dpib_read(struct hdac_ext_stream *stream)
1094 {
1095 return readl(hdac_stream(stream)->bus->remap_addr + AZX_REG_VS_SDXDPIB_XBASE +
1096 (AZX_REG_VS_SDXDPIB_XINTERVAL * hdac_stream(stream)->index));
1097 }
1098
1099 static snd_pcm_uframes_t
avs_component_pointer(struct snd_soc_component * component,struct snd_pcm_substream * substream)1100 avs_component_pointer(struct snd_soc_component *component, struct snd_pcm_substream *substream)
1101 {
1102 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1103 struct avs_dma_data *data;
1104 struct hdac_ext_stream *host_stream;
1105 unsigned int pos;
1106
1107 data = snd_soc_dai_get_dma_data(asoc_rtd_to_cpu(rtd, 0), substream);
1108 if (!data->host_stream)
1109 return 0;
1110
1111 host_stream = data->host_stream;
1112 pos = avs_hda_stream_dpib_read(host_stream);
1113
1114 if (pos >= hdac_stream(host_stream)->bufsize)
1115 pos = 0;
1116
1117 return bytes_to_frames(substream->runtime, pos);
1118 }
1119
avs_component_mmap(struct snd_soc_component * component,struct snd_pcm_substream * substream,struct vm_area_struct * vma)1120 static int avs_component_mmap(struct snd_soc_component *component,
1121 struct snd_pcm_substream *substream,
1122 struct vm_area_struct *vma)
1123 {
1124 return snd_pcm_lib_default_mmap(substream, vma);
1125 }
1126
1127 #define MAX_PREALLOC_SIZE (32 * 1024 * 1024)
1128
avs_component_construct(struct snd_soc_component * component,struct snd_soc_pcm_runtime * rtd)1129 static int avs_component_construct(struct snd_soc_component *component,
1130 struct snd_soc_pcm_runtime *rtd)
1131 {
1132 struct snd_soc_dai *dai = asoc_rtd_to_cpu(rtd, 0);
1133 struct snd_pcm *pcm = rtd->pcm;
1134
1135 if (dai->driver->playback.channels_min)
1136 snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream,
1137 SNDRV_DMA_TYPE_DEV_SG, component->dev, 0,
1138 MAX_PREALLOC_SIZE);
1139
1140 if (dai->driver->capture.channels_min)
1141 snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream,
1142 SNDRV_DMA_TYPE_DEV_SG, component->dev, 0,
1143 MAX_PREALLOC_SIZE);
1144
1145 return 0;
1146 }
1147
1148 static const struct snd_soc_component_driver avs_component_driver = {
1149 .name = "avs-pcm",
1150 .probe = avs_component_probe,
1151 .remove = avs_component_remove,
1152 .suspend = avs_component_suspend,
1153 .resume = avs_component_resume,
1154 .open = avs_component_open,
1155 .pointer = avs_component_pointer,
1156 .mmap = avs_component_mmap,
1157 .pcm_construct = avs_component_construct,
1158 .module_get_upon_open = 1, /* increment refcount when a pcm is opened */
1159 .topology_name_prefix = "intel/avs",
1160 };
1161
avs_soc_component_register(struct device * dev,const char * name,const struct snd_soc_component_driver * drv,struct snd_soc_dai_driver * cpu_dais,int num_cpu_dais)1162 int avs_soc_component_register(struct device *dev, const char *name,
1163 const struct snd_soc_component_driver *drv,
1164 struct snd_soc_dai_driver *cpu_dais, int num_cpu_dais)
1165 {
1166 struct avs_soc_component *acomp;
1167 int ret;
1168
1169 acomp = devm_kzalloc(dev, sizeof(*acomp), GFP_KERNEL);
1170 if (!acomp)
1171 return -ENOMEM;
1172
1173 ret = snd_soc_component_initialize(&acomp->base, drv, dev);
1174 if (ret < 0)
1175 return ret;
1176
1177 /* force name change after ASoC is done with its init */
1178 acomp->base.name = name;
1179 INIT_LIST_HEAD(&acomp->node);
1180
1181 return snd_soc_add_component(&acomp->base, cpu_dais, num_cpu_dais);
1182 }
1183
1184 static struct snd_soc_dai_driver dmic_cpu_dais[] = {
1185 {
1186 .name = "DMIC Pin",
1187 .ops = &avs_dai_nonhda_be_ops,
1188 .capture = {
1189 .stream_name = "DMIC Rx",
1190 .channels_min = 1,
1191 .channels_max = 4,
1192 .rates = SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000,
1193 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
1194 },
1195 },
1196 {
1197 .name = "DMIC WoV Pin",
1198 .ops = &avs_dai_nonhda_be_ops,
1199 .capture = {
1200 .stream_name = "DMIC WoV Rx",
1201 .channels_min = 1,
1202 .channels_max = 4,
1203 .rates = SNDRV_PCM_RATE_16000,
1204 .formats = SNDRV_PCM_FMTBIT_S16_LE,
1205 },
1206 },
1207 };
1208
avs_dmic_platform_register(struct avs_dev * adev,const char * name)1209 int avs_dmic_platform_register(struct avs_dev *adev, const char *name)
1210 {
1211 return avs_soc_component_register(adev->dev, name, &avs_component_driver, dmic_cpu_dais,
1212 ARRAY_SIZE(dmic_cpu_dais));
1213 }
1214
1215 static const struct snd_soc_dai_driver i2s_dai_template = {
1216 .ops = &avs_dai_nonhda_be_ops,
1217 .playback = {
1218 .channels_min = 1,
1219 .channels_max = 8,
1220 .rates = SNDRV_PCM_RATE_8000_192000 |
1221 SNDRV_PCM_RATE_KNOT,
1222 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1223 SNDRV_PCM_FMTBIT_S24_LE |
1224 SNDRV_PCM_FMTBIT_S32_LE,
1225 },
1226 .capture = {
1227 .channels_min = 1,
1228 .channels_max = 8,
1229 .rates = SNDRV_PCM_RATE_8000_192000 |
1230 SNDRV_PCM_RATE_KNOT,
1231 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1232 SNDRV_PCM_FMTBIT_S24_LE |
1233 SNDRV_PCM_FMTBIT_S32_LE,
1234 },
1235 };
1236
avs_i2s_platform_register(struct avs_dev * adev,const char * name,unsigned long port_mask,unsigned long * tdms)1237 int avs_i2s_platform_register(struct avs_dev *adev, const char *name, unsigned long port_mask,
1238 unsigned long *tdms)
1239 {
1240 struct snd_soc_dai_driver *cpus, *dai;
1241 size_t ssp_count, cpu_count;
1242 int i, j;
1243
1244 ssp_count = adev->hw_cfg.i2s_caps.ctrl_count;
1245 cpu_count = hweight_long(port_mask);
1246 if (tdms)
1247 for_each_set_bit(i, &port_mask, ssp_count)
1248 cpu_count += hweight_long(tdms[i]);
1249
1250 cpus = devm_kzalloc(adev->dev, sizeof(*cpus) * cpu_count, GFP_KERNEL);
1251 if (!cpus)
1252 return -ENOMEM;
1253
1254 dai = cpus;
1255 for_each_set_bit(i, &port_mask, ssp_count) {
1256 memcpy(dai, &i2s_dai_template, sizeof(*dai));
1257
1258 dai->name =
1259 devm_kasprintf(adev->dev, GFP_KERNEL, "SSP%d Pin", i);
1260 dai->playback.stream_name =
1261 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d Tx", i);
1262 dai->capture.stream_name =
1263 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d Rx", i);
1264
1265 if (!dai->name || !dai->playback.stream_name || !dai->capture.stream_name)
1266 return -ENOMEM;
1267 dai++;
1268 }
1269
1270 if (!tdms)
1271 goto plat_register;
1272
1273 for_each_set_bit(i, &port_mask, ssp_count) {
1274 for_each_set_bit(j, &tdms[i], ssp_count) {
1275 memcpy(dai, &i2s_dai_template, sizeof(*dai));
1276
1277 dai->name =
1278 devm_kasprintf(adev->dev, GFP_KERNEL, "SSP%d:%d Pin", i, j);
1279 dai->playback.stream_name =
1280 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d:%d Tx", i, j);
1281 dai->capture.stream_name =
1282 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d:%d Rx", i, j);
1283
1284 if (!dai->name || !dai->playback.stream_name || !dai->capture.stream_name)
1285 return -ENOMEM;
1286 dai++;
1287 }
1288 }
1289
1290 plat_register:
1291 return avs_soc_component_register(adev->dev, name, &avs_component_driver, cpus, cpu_count);
1292 }
1293
1294 /* HD-Audio CPU DAI template */
1295 static const struct snd_soc_dai_driver hda_cpu_dai = {
1296 .ops = &avs_dai_hda_be_ops,
1297 .playback = {
1298 .channels_min = 1,
1299 .channels_max = 8,
1300 .rates = SNDRV_PCM_RATE_8000_192000,
1301 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1302 SNDRV_PCM_FMTBIT_S24_LE |
1303 SNDRV_PCM_FMTBIT_S32_LE,
1304 },
1305 .capture = {
1306 .channels_min = 1,
1307 .channels_max = 8,
1308 .rates = SNDRV_PCM_RATE_8000_192000,
1309 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1310 SNDRV_PCM_FMTBIT_S24_LE |
1311 SNDRV_PCM_FMTBIT_S32_LE,
1312 },
1313 };
1314
avs_component_hda_unregister_dais(struct snd_soc_component * component)1315 static void avs_component_hda_unregister_dais(struct snd_soc_component *component)
1316 {
1317 struct snd_soc_acpi_mach *mach;
1318 struct snd_soc_dai *dai, *save;
1319 struct hda_codec *codec;
1320 char name[32];
1321
1322 mach = dev_get_platdata(component->card->dev);
1323 codec = mach->pdata;
1324 sprintf(name, "%s-cpu", dev_name(&codec->core.dev));
1325
1326 for_each_component_dais_safe(component, dai, save) {
1327 int stream;
1328
1329 if (!strstr(dai->driver->name, name))
1330 continue;
1331
1332 for_each_pcm_streams(stream)
1333 snd_soc_dapm_free_widget(snd_soc_dai_get_widget(dai, stream));
1334
1335 snd_soc_unregister_dai(dai);
1336 }
1337 }
1338
avs_component_hda_probe(struct snd_soc_component * component)1339 static int avs_component_hda_probe(struct snd_soc_component *component)
1340 {
1341 struct snd_soc_dapm_context *dapm;
1342 struct snd_soc_dai_driver *dais;
1343 struct snd_soc_acpi_mach *mach;
1344 struct hda_codec *codec;
1345 struct hda_pcm *pcm;
1346 const char *cname;
1347 int pcm_count = 0, ret, i;
1348
1349 mach = dev_get_platdata(component->card->dev);
1350 if (!mach)
1351 return -EINVAL;
1352
1353 codec = mach->pdata;
1354 if (list_empty(&codec->pcm_list_head))
1355 return -EINVAL;
1356 list_for_each_entry(pcm, &codec->pcm_list_head, list)
1357 pcm_count++;
1358
1359 dais = devm_kcalloc(component->dev, pcm_count, sizeof(*dais),
1360 GFP_KERNEL);
1361 if (!dais)
1362 return -ENOMEM;
1363
1364 cname = dev_name(&codec->core.dev);
1365 dapm = snd_soc_component_get_dapm(component);
1366 pcm = list_first_entry(&codec->pcm_list_head, struct hda_pcm, list);
1367
1368 for (i = 0; i < pcm_count; i++, pcm = list_next_entry(pcm, list)) {
1369 struct snd_soc_dai *dai;
1370
1371 memcpy(&dais[i], &hda_cpu_dai, sizeof(*dais));
1372 dais[i].id = i;
1373 dais[i].name = devm_kasprintf(component->dev, GFP_KERNEL,
1374 "%s-cpu%d", cname, i);
1375 if (!dais[i].name) {
1376 ret = -ENOMEM;
1377 goto exit;
1378 }
1379
1380 if (pcm->stream[0].substreams) {
1381 dais[i].playback.stream_name =
1382 devm_kasprintf(component->dev, GFP_KERNEL,
1383 "%s-cpu%d Tx", cname, i);
1384 if (!dais[i].playback.stream_name) {
1385 ret = -ENOMEM;
1386 goto exit;
1387 }
1388 }
1389
1390 if (pcm->stream[1].substreams) {
1391 dais[i].capture.stream_name =
1392 devm_kasprintf(component->dev, GFP_KERNEL,
1393 "%s-cpu%d Rx", cname, i);
1394 if (!dais[i].capture.stream_name) {
1395 ret = -ENOMEM;
1396 goto exit;
1397 }
1398 }
1399
1400 dai = snd_soc_register_dai(component, &dais[i], false);
1401 if (!dai) {
1402 dev_err(component->dev, "register dai for %s failed\n",
1403 pcm->name);
1404 ret = -EINVAL;
1405 goto exit;
1406 }
1407
1408 ret = snd_soc_dapm_new_dai_widgets(dapm, dai);
1409 if (ret < 0) {
1410 dev_err(component->dev, "create widgets failed: %d\n",
1411 ret);
1412 goto exit;
1413 }
1414 }
1415
1416 ret = avs_component_probe(component);
1417 exit:
1418 if (ret)
1419 avs_component_hda_unregister_dais(component);
1420
1421 return ret;
1422 }
1423
avs_component_hda_remove(struct snd_soc_component * component)1424 static void avs_component_hda_remove(struct snd_soc_component *component)
1425 {
1426 avs_component_hda_unregister_dais(component);
1427 avs_component_remove(component);
1428 }
1429
avs_component_hda_open(struct snd_soc_component * component,struct snd_pcm_substream * substream)1430 static int avs_component_hda_open(struct snd_soc_component *component,
1431 struct snd_pcm_substream *substream)
1432 {
1433 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1434 struct hdac_ext_stream *link_stream;
1435 struct hda_codec *codec;
1436
1437 if (!rtd->dai_link->no_pcm) {
1438 struct snd_pcm_hardware hwparams = avs_pcm_hardware;
1439 struct snd_soc_pcm_runtime *be;
1440 struct snd_soc_dpcm *dpcm;
1441 int dir = substream->stream;
1442
1443 /*
1444 * Support the DPCM reparenting while still fulfilling expectations of HDAudio
1445 * common code - a valid stream pointer at substream->runtime->private_data -
1446 * by having all FEs point to the same private data.
1447 */
1448 for_each_dpcm_be(rtd, dir, dpcm) {
1449 struct snd_pcm_substream *be_substream;
1450
1451 be = dpcm->be;
1452 if (be->dpcm[dir].users == 1)
1453 break;
1454
1455 be_substream = snd_soc_dpcm_get_substream(be, dir);
1456 substream->runtime->private_data = be_substream->runtime->private_data;
1457 break;
1458 }
1459
1460 /* RESUME unsupported for de-coupled HD-Audio capture. */
1461 if (dir == SNDRV_PCM_STREAM_CAPTURE)
1462 hwparams.info &= ~SNDRV_PCM_INFO_RESUME;
1463
1464 return snd_soc_set_runtime_hwparams(substream, &hwparams);
1465 }
1466
1467 codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev);
1468 link_stream = snd_hdac_ext_stream_assign(&codec->bus->core, substream,
1469 HDAC_EXT_STREAM_TYPE_LINK);
1470 if (!link_stream)
1471 return -EBUSY;
1472
1473 substream->runtime->private_data = link_stream;
1474 return 0;
1475 }
1476
avs_component_hda_close(struct snd_soc_component * component,struct snd_pcm_substream * substream)1477 static int avs_component_hda_close(struct snd_soc_component *component,
1478 struct snd_pcm_substream *substream)
1479 {
1480 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1481 struct hdac_ext_stream *link_stream;
1482
1483 /* only BE DAI links are handled here */
1484 if (!rtd->dai_link->no_pcm)
1485 return 0;
1486
1487 link_stream = substream->runtime->private_data;
1488 snd_hdac_ext_stream_release(link_stream, HDAC_EXT_STREAM_TYPE_LINK);
1489 substream->runtime->private_data = NULL;
1490
1491 return 0;
1492 }
1493
1494 static const struct snd_soc_component_driver avs_hda_component_driver = {
1495 .name = "avs-hda-pcm",
1496 .probe = avs_component_hda_probe,
1497 .remove = avs_component_hda_remove,
1498 .suspend = avs_component_suspend,
1499 .resume = avs_component_resume,
1500 .open = avs_component_hda_open,
1501 .close = avs_component_hda_close,
1502 .pointer = avs_component_pointer,
1503 .mmap = avs_component_mmap,
1504 .pcm_construct = avs_component_construct,
1505 /*
1506 * hda platform component's probe() is dependent on
1507 * codec->pcm_list_head, it needs to be initialized after codec
1508 * component. remove_order is here for completeness sake
1509 */
1510 .probe_order = SND_SOC_COMP_ORDER_LATE,
1511 .remove_order = SND_SOC_COMP_ORDER_EARLY,
1512 .module_get_upon_open = 1,
1513 .topology_name_prefix = "intel/avs",
1514 };
1515
avs_hda_platform_register(struct avs_dev * adev,const char * name)1516 int avs_hda_platform_register(struct avs_dev *adev, const char *name)
1517 {
1518 return avs_soc_component_register(adev->dev, name,
1519 &avs_hda_component_driver, NULL, 0);
1520 }
1521