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 kfree(data);
472 return -EBUSY;
473 }
474
475 data->host_stream = host_stream;
476 snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
477 /* avoid wrap-around with wall-clock */
478 snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_TIME, 20, 178000000);
479 snd_pcm_hw_constraint_list(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, &hw_rates);
480 snd_pcm_set_sync(substream);
481
482 dev_dbg(dai->dev, "%s fe STARTUP tag %d str %p",
483 __func__, hdac_stream(host_stream)->stream_tag, substream);
484
485 return 0;
486 }
487
avs_dai_fe_shutdown(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)488 static void avs_dai_fe_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
489 {
490 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
491 struct avs_dev *adev = to_avs_dev(dai->dev);
492 struct avs_dma_data *data;
493
494 if (rtd->dai_link->ignore_suspend)
495 adev->num_lp_paths--;
496
497 data = snd_soc_dai_get_dma_data(dai, substream);
498
499 snd_soc_dai_set_dma_data(dai, substream, NULL);
500 snd_hdac_ext_stream_release(data->host_stream, HDAC_EXT_STREAM_TYPE_HOST);
501 kfree(data);
502 }
503
avs_dai_fe_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * hw_params,struct snd_soc_dai * dai)504 static int avs_dai_fe_hw_params(struct snd_pcm_substream *substream,
505 struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai)
506 {
507 struct snd_pcm_hw_params *be_hw_params = NULL;
508 struct snd_soc_pcm_runtime *fe, *be;
509 struct snd_soc_dpcm *dpcm;
510 struct avs_dma_data *data;
511 struct hdac_ext_stream *host_stream;
512 int ret;
513
514 data = snd_soc_dai_get_dma_data(dai, substream);
515 if (data->path)
516 return 0;
517
518 host_stream = data->host_stream;
519
520 hdac_stream(host_stream)->bufsize = 0;
521 hdac_stream(host_stream)->period_bytes = 0;
522 hdac_stream(host_stream)->format_val = 0;
523
524 fe = asoc_substream_to_rtd(substream);
525 for_each_dpcm_be(fe, substream->stream, dpcm) {
526 be = dpcm->be;
527 be_hw_params = &be->dpcm[substream->stream].hw_params;
528 }
529
530 ret = avs_dai_hw_params(substream, hw_params, be_hw_params, dai,
531 hdac_stream(host_stream)->stream_tag - 1);
532 if (ret)
533 goto create_err;
534
535 ret = avs_path_bind(data->path);
536 if (ret < 0) {
537 dev_err(dai->dev, "bind FE <-> BE failed: %d\n", ret);
538 goto bind_err;
539 }
540
541 return 0;
542
543 bind_err:
544 avs_path_free(data->path);
545 data->path = NULL;
546 create_err:
547 snd_pcm_lib_free_pages(substream);
548 return ret;
549 }
550
__avs_dai_fe_hw_free(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)551 static int __avs_dai_fe_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
552 {
553 struct avs_dma_data *data;
554 struct hdac_ext_stream *host_stream;
555 int ret;
556
557 dev_dbg(dai->dev, "%s fe HW_FREE str %p rtd %p",
558 __func__, substream, substream->runtime);
559
560 data = snd_soc_dai_get_dma_data(dai, substream);
561 if (!data->path)
562 return 0;
563
564 host_stream = data->host_stream;
565
566 ret = avs_path_unbind(data->path);
567 if (ret < 0)
568 dev_err(dai->dev, "unbind FE <-> BE failed: %d\n", ret);
569
570 avs_path_free(data->path);
571 data->path = NULL;
572 snd_hdac_stream_cleanup(hdac_stream(host_stream));
573 hdac_stream(host_stream)->prepared = false;
574
575 return ret;
576 }
577
avs_dai_fe_hw_free(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)578 static int avs_dai_fe_hw_free(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
579 {
580 int ret;
581
582 ret = __avs_dai_fe_hw_free(substream, dai);
583 snd_pcm_lib_free_pages(substream);
584
585 return ret;
586 }
587
avs_dai_fe_prepare(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)588 static int avs_dai_fe_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
589 {
590 struct snd_pcm_runtime *runtime = substream->runtime;
591 struct avs_dma_data *data;
592 struct avs_dev *adev = to_avs_dev(dai->dev);
593 struct hdac_ext_stream *host_stream;
594 struct hdac_bus *bus;
595 unsigned int format_val;
596 int ret;
597
598 data = snd_soc_dai_get_dma_data(dai, substream);
599 host_stream = data->host_stream;
600
601 if (hdac_stream(host_stream)->prepared)
602 return 0;
603
604 bus = hdac_stream(host_stream)->bus;
605 snd_hdac_ext_stream_decouple(bus, data->host_stream, true);
606 snd_hdac_stream_reset(hdac_stream(host_stream));
607
608 format_val = snd_hdac_calc_stream_format(runtime->rate, runtime->channels, runtime->format,
609 runtime->sample_bits, 0);
610
611 ret = snd_hdac_stream_set_params(hdac_stream(host_stream), format_val);
612 if (ret < 0)
613 return ret;
614
615 ret = snd_hdac_stream_setup(hdac_stream(host_stream));
616 if (ret < 0)
617 return ret;
618
619 ret = avs_dai_prepare(adev, substream, dai);
620 if (ret)
621 return ret;
622
623 hdac_stream(host_stream)->prepared = true;
624 return 0;
625 }
626
avs_dai_fe_trigger(struct snd_pcm_substream * substream,int cmd,struct snd_soc_dai * dai)627 static int avs_dai_fe_trigger(struct snd_pcm_substream *substream, int cmd, struct snd_soc_dai *dai)
628 {
629 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
630 struct avs_dma_data *data;
631 struct hdac_ext_stream *host_stream;
632 struct hdac_bus *bus;
633 unsigned long flags;
634 int ret = 0;
635
636 data = snd_soc_dai_get_dma_data(dai, substream);
637 host_stream = data->host_stream;
638 bus = hdac_stream(host_stream)->bus;
639
640 switch (cmd) {
641 case SNDRV_PCM_TRIGGER_RESUME:
642 if (rtd->dai_link->ignore_suspend)
643 break;
644 fallthrough;
645 case SNDRV_PCM_TRIGGER_START:
646 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
647 spin_lock_irqsave(&bus->reg_lock, flags);
648 snd_hdac_stream_start(hdac_stream(host_stream));
649 spin_unlock_irqrestore(&bus->reg_lock, flags);
650
651 /* Timeout on DRSM poll shall not stop the resume so ignore the result. */
652 if (cmd == SNDRV_PCM_TRIGGER_RESUME)
653 snd_hdac_stream_wait_drsm(hdac_stream(host_stream));
654
655 ret = avs_path_pause(data->path);
656 if (ret < 0) {
657 dev_err(dai->dev, "pause FE path failed: %d\n", ret);
658 break;
659 }
660
661 ret = avs_path_run(data->path, AVS_TPLG_TRIGGER_AUTO);
662 if (ret < 0)
663 dev_err(dai->dev, "run FE path failed: %d\n", ret);
664
665 break;
666
667 case SNDRV_PCM_TRIGGER_SUSPEND:
668 if (rtd->dai_link->ignore_suspend)
669 break;
670 fallthrough;
671 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
672 case SNDRV_PCM_TRIGGER_STOP:
673 ret = avs_path_pause(data->path);
674 if (ret < 0)
675 dev_err(dai->dev, "pause FE path failed: %d\n", ret);
676
677 spin_lock_irqsave(&bus->reg_lock, flags);
678 snd_hdac_stream_stop(hdac_stream(host_stream));
679 spin_unlock_irqrestore(&bus->reg_lock, flags);
680
681 ret = avs_path_reset(data->path);
682 if (ret < 0)
683 dev_err(dai->dev, "reset FE path failed: %d\n", ret);
684 break;
685
686 default:
687 ret = -EINVAL;
688 break;
689 }
690
691 return ret;
692 }
693
694 const struct snd_soc_dai_ops avs_dai_fe_ops = {
695 .startup = avs_dai_fe_startup,
696 .shutdown = avs_dai_fe_shutdown,
697 .hw_params = avs_dai_fe_hw_params,
698 .hw_free = avs_dai_fe_hw_free,
699 .prepare = avs_dai_fe_prepare,
700 .trigger = avs_dai_fe_trigger,
701 };
702
topology_name_read(struct file * file,char __user * user_buf,size_t count,loff_t * ppos)703 static ssize_t topology_name_read(struct file *file, char __user *user_buf, size_t count,
704 loff_t *ppos)
705 {
706 struct snd_soc_component *component = file->private_data;
707 struct snd_soc_card *card = component->card;
708 struct snd_soc_acpi_mach *mach = dev_get_platdata(card->dev);
709 char buf[64];
710 size_t len;
711
712 len = scnprintf(buf, sizeof(buf), "%s/%s\n", component->driver->topology_name_prefix,
713 mach->tplg_filename);
714
715 return simple_read_from_buffer(user_buf, count, ppos, buf, len);
716 }
717
718 static const struct file_operations topology_name_fops = {
719 .open = simple_open,
720 .read = topology_name_read,
721 .llseek = default_llseek,
722 };
723
avs_component_load_libraries(struct avs_soc_component * acomp)724 static int avs_component_load_libraries(struct avs_soc_component *acomp)
725 {
726 struct avs_tplg *tplg = acomp->tplg;
727 struct avs_dev *adev = to_avs_dev(acomp->base.dev);
728 int ret;
729
730 if (!tplg->num_libs)
731 return 0;
732
733 /* Parent device may be asleep and library loading involves IPCs. */
734 ret = pm_runtime_resume_and_get(adev->dev);
735 if (ret < 0)
736 return ret;
737
738 avs_hda_power_gating_enable(adev, false);
739 avs_hda_clock_gating_enable(adev, false);
740 avs_hda_l1sen_enable(adev, false);
741
742 ret = avs_dsp_load_libraries(adev, tplg->libs, tplg->num_libs);
743
744 avs_hda_l1sen_enable(adev, true);
745 avs_hda_clock_gating_enable(adev, true);
746 avs_hda_power_gating_enable(adev, true);
747
748 if (!ret)
749 ret = avs_module_info_init(adev, false);
750
751 pm_runtime_mark_last_busy(adev->dev);
752 pm_runtime_put_autosuspend(adev->dev);
753
754 return ret;
755 }
756
avs_component_probe(struct snd_soc_component * component)757 static int avs_component_probe(struct snd_soc_component *component)
758 {
759 struct snd_soc_card *card = component->card;
760 struct snd_soc_acpi_mach *mach;
761 struct avs_soc_component *acomp;
762 struct avs_dev *adev;
763 char *filename;
764 int ret;
765
766 dev_dbg(card->dev, "probing %s card %s\n", component->name, card->name);
767 mach = dev_get_platdata(card->dev);
768 acomp = to_avs_soc_component(component);
769 adev = to_avs_dev(component->dev);
770
771 acomp->tplg = avs_tplg_new(component);
772 if (!acomp->tplg)
773 return -ENOMEM;
774
775 if (!mach->tplg_filename)
776 goto finalize;
777
778 /* Load specified topology and create debugfs for it. */
779 filename = kasprintf(GFP_KERNEL, "%s/%s", component->driver->topology_name_prefix,
780 mach->tplg_filename);
781 if (!filename)
782 return -ENOMEM;
783
784 ret = avs_load_topology(component, filename);
785 kfree(filename);
786 if (ret < 0)
787 return ret;
788
789 ret = avs_component_load_libraries(acomp);
790 if (ret < 0) {
791 dev_err(card->dev, "libraries loading failed: %d\n", ret);
792 goto err_load_libs;
793 }
794
795 finalize:
796 debugfs_create_file("topology_name", 0444, component->debugfs_root, component,
797 &topology_name_fops);
798
799 mutex_lock(&adev->comp_list_mutex);
800 list_add_tail(&acomp->node, &adev->comp_list);
801 mutex_unlock(&adev->comp_list_mutex);
802
803 return 0;
804
805 err_load_libs:
806 avs_remove_topology(component);
807 return ret;
808 }
809
avs_component_remove(struct snd_soc_component * component)810 static void avs_component_remove(struct snd_soc_component *component)
811 {
812 struct avs_soc_component *acomp = to_avs_soc_component(component);
813 struct snd_soc_acpi_mach *mach;
814 struct avs_dev *adev = to_avs_dev(component->dev);
815 int ret;
816
817 mach = dev_get_platdata(component->card->dev);
818
819 mutex_lock(&adev->comp_list_mutex);
820 list_del(&acomp->node);
821 mutex_unlock(&adev->comp_list_mutex);
822
823 if (mach->tplg_filename) {
824 ret = avs_remove_topology(component);
825 if (ret < 0)
826 dev_err(component->dev, "unload topology failed: %d\n", ret);
827 }
828 }
829
avs_dai_resume_hw_params(struct snd_soc_dai * dai,struct avs_dma_data * data)830 static int avs_dai_resume_hw_params(struct snd_soc_dai *dai, struct avs_dma_data *data)
831 {
832 struct snd_pcm_substream *substream;
833 struct snd_soc_pcm_runtime *rtd;
834 int ret;
835
836 substream = data->substream;
837 rtd = asoc_substream_to_rtd(substream);
838
839 ret = dai->driver->ops->hw_params(substream, &rtd->dpcm[substream->stream].hw_params, dai);
840 if (ret)
841 dev_err(dai->dev, "hw_params on resume failed: %d\n", ret);
842
843 return ret;
844 }
845
avs_dai_resume_fe_prepare(struct snd_soc_dai * dai,struct avs_dma_data * data)846 static int avs_dai_resume_fe_prepare(struct snd_soc_dai *dai, struct avs_dma_data *data)
847 {
848 struct hdac_ext_stream *host_stream;
849 struct hdac_stream *hstream;
850 struct hdac_bus *bus;
851 int ret;
852
853 host_stream = data->host_stream;
854 hstream = hdac_stream(host_stream);
855 bus = hdac_stream(host_stream)->bus;
856
857 /* Set DRSM before programming stream and position registers. */
858 snd_hdac_stream_drsm_enable(bus, true, hstream->index);
859
860 ret = dai->driver->ops->prepare(data->substream, dai);
861 if (ret) {
862 dev_err(dai->dev, "prepare FE on resume failed: %d\n", ret);
863 return ret;
864 }
865
866 writel(host_stream->pphcllpl, host_stream->pphc_addr + AZX_REG_PPHCLLPL);
867 writel(host_stream->pphcllpu, host_stream->pphc_addr + AZX_REG_PPHCLLPU);
868 writel(host_stream->pphcldpl, host_stream->pphc_addr + AZX_REG_PPHCLDPL);
869 writel(host_stream->pphcldpu, host_stream->pphc_addr + AZX_REG_PPHCLDPU);
870
871 /* As per HW spec recommendation, program LPIB and DPIB to the same value. */
872 snd_hdac_stream_set_lpib(hstream, hstream->lpib);
873 snd_hdac_stream_set_dpibr(bus, hstream, hstream->lpib);
874
875 return 0;
876 }
877
avs_dai_resume_be_prepare(struct snd_soc_dai * dai,struct avs_dma_data * data)878 static int avs_dai_resume_be_prepare(struct snd_soc_dai *dai, struct avs_dma_data *data)
879 {
880 int ret;
881
882 ret = dai->driver->ops->prepare(data->substream, dai);
883 if (ret)
884 dev_err(dai->dev, "prepare BE on resume failed: %d\n", ret);
885
886 return ret;
887 }
888
avs_dai_suspend_fe_hw_free(struct snd_soc_dai * dai,struct avs_dma_data * data)889 static int avs_dai_suspend_fe_hw_free(struct snd_soc_dai *dai, struct avs_dma_data *data)
890 {
891 struct hdac_ext_stream *host_stream;
892 int ret;
893
894 host_stream = data->host_stream;
895
896 /* Store position addresses so we can resume from them later on. */
897 hdac_stream(host_stream)->lpib = snd_hdac_stream_get_pos_lpib(hdac_stream(host_stream));
898 host_stream->pphcllpl = readl(host_stream->pphc_addr + AZX_REG_PPHCLLPL);
899 host_stream->pphcllpu = readl(host_stream->pphc_addr + AZX_REG_PPHCLLPU);
900 host_stream->pphcldpl = readl(host_stream->pphc_addr + AZX_REG_PPHCLDPL);
901 host_stream->pphcldpu = readl(host_stream->pphc_addr + AZX_REG_PPHCLDPU);
902
903 ret = __avs_dai_fe_hw_free(data->substream, dai);
904 if (ret < 0)
905 dev_err(dai->dev, "hw_free FE on suspend failed: %d\n", ret);
906
907 return ret;
908 }
909
avs_dai_suspend_be_hw_free(struct snd_soc_dai * dai,struct avs_dma_data * data)910 static int avs_dai_suspend_be_hw_free(struct snd_soc_dai *dai, struct avs_dma_data *data)
911 {
912 int ret;
913
914 ret = dai->driver->ops->hw_free(data->substream, dai);
915 if (ret < 0)
916 dev_err(dai->dev, "hw_free BE on suspend failed: %d\n", ret);
917
918 return ret;
919 }
920
avs_component_pm_op(struct snd_soc_component * component,bool be,int (* op)(struct snd_soc_dai *,struct avs_dma_data *))921 static int avs_component_pm_op(struct snd_soc_component *component, bool be,
922 int (*op)(struct snd_soc_dai *, struct avs_dma_data *))
923 {
924 struct snd_soc_pcm_runtime *rtd;
925 struct avs_dma_data *data;
926 struct snd_soc_dai *dai;
927 int ret;
928
929 for_each_component_dais(component, dai) {
930 data = snd_soc_dai_dma_data_get_playback(dai);
931 if (data) {
932 rtd = asoc_substream_to_rtd(data->substream);
933 if (rtd->dai_link->no_pcm == be && !rtd->dai_link->ignore_suspend) {
934 ret = op(dai, data);
935 if (ret < 0) {
936 __snd_pcm_set_state(data->substream->runtime,
937 SNDRV_PCM_STATE_DISCONNECTED);
938 return ret;
939 }
940 }
941 }
942
943 data = snd_soc_dai_dma_data_get_capture(dai);
944 if (data) {
945 rtd = asoc_substream_to_rtd(data->substream);
946 if (rtd->dai_link->no_pcm == be && !rtd->dai_link->ignore_suspend) {
947 ret = op(dai, data);
948 if (ret < 0) {
949 __snd_pcm_set_state(data->substream->runtime,
950 SNDRV_PCM_STATE_DISCONNECTED);
951 return ret;
952 }
953 }
954 }
955 }
956
957 return 0;
958 }
959
avs_component_resume_hw_params(struct snd_soc_component * component,bool be)960 static int avs_component_resume_hw_params(struct snd_soc_component *component, bool be)
961 {
962 return avs_component_pm_op(component, be, &avs_dai_resume_hw_params);
963 }
964
avs_component_resume_prepare(struct snd_soc_component * component,bool be)965 static int avs_component_resume_prepare(struct snd_soc_component *component, bool be)
966 {
967 int (*prepare_cb)(struct snd_soc_dai *dai, struct avs_dma_data *data);
968
969 if (be)
970 prepare_cb = &avs_dai_resume_be_prepare;
971 else
972 prepare_cb = &avs_dai_resume_fe_prepare;
973
974 return avs_component_pm_op(component, be, prepare_cb);
975 }
976
avs_component_suspend_hw_free(struct snd_soc_component * component,bool be)977 static int avs_component_suspend_hw_free(struct snd_soc_component *component, bool be)
978 {
979 int (*hw_free_cb)(struct snd_soc_dai *dai, struct avs_dma_data *data);
980
981 if (be)
982 hw_free_cb = &avs_dai_suspend_be_hw_free;
983 else
984 hw_free_cb = &avs_dai_suspend_fe_hw_free;
985
986 return avs_component_pm_op(component, be, hw_free_cb);
987 }
988
avs_component_suspend(struct snd_soc_component * component)989 static int avs_component_suspend(struct snd_soc_component *component)
990 {
991 int ret;
992
993 /*
994 * When freeing paths, FEs need to be first as they perform
995 * path unbinding.
996 */
997 ret = avs_component_suspend_hw_free(component, false);
998 if (ret)
999 return ret;
1000
1001 return avs_component_suspend_hw_free(component, true);
1002 }
1003
avs_component_resume(struct snd_soc_component * component)1004 static int avs_component_resume(struct snd_soc_component *component)
1005 {
1006 int ret;
1007
1008 /*
1009 * When creating paths, FEs need to be last as they perform
1010 * path binding.
1011 */
1012 ret = avs_component_resume_hw_params(component, true);
1013 if (ret)
1014 return ret;
1015
1016 ret = avs_component_resume_hw_params(component, false);
1017 if (ret)
1018 return ret;
1019
1020 /* It is expected that the LINK stream is prepared first. */
1021 ret = avs_component_resume_prepare(component, true);
1022 if (ret)
1023 return ret;
1024
1025 return avs_component_resume_prepare(component, false);
1026 }
1027
1028 static const struct snd_pcm_hardware avs_pcm_hardware = {
1029 .info = SNDRV_PCM_INFO_MMAP |
1030 SNDRV_PCM_INFO_MMAP_VALID |
1031 SNDRV_PCM_INFO_INTERLEAVED |
1032 SNDRV_PCM_INFO_PAUSE |
1033 SNDRV_PCM_INFO_RESUME |
1034 SNDRV_PCM_INFO_NO_PERIOD_WAKEUP,
1035 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1036 SNDRV_PCM_FMTBIT_S24_LE |
1037 SNDRV_PCM_FMTBIT_S32_LE,
1038 .buffer_bytes_max = AZX_MAX_BUF_SIZE,
1039 .period_bytes_min = 128,
1040 .period_bytes_max = AZX_MAX_BUF_SIZE / 2,
1041 .periods_min = 2,
1042 .periods_max = AZX_MAX_FRAG,
1043 .fifo_size = 0,
1044 };
1045
avs_component_open(struct snd_soc_component * component,struct snd_pcm_substream * substream)1046 static int avs_component_open(struct snd_soc_component *component,
1047 struct snd_pcm_substream *substream)
1048 {
1049 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1050
1051 /* only FE DAI links are handled here */
1052 if (rtd->dai_link->no_pcm)
1053 return 0;
1054
1055 return snd_soc_set_runtime_hwparams(substream, &avs_pcm_hardware);
1056 }
1057
avs_hda_stream_dpib_read(struct hdac_ext_stream * stream)1058 static unsigned int avs_hda_stream_dpib_read(struct hdac_ext_stream *stream)
1059 {
1060 return readl(hdac_stream(stream)->bus->remap_addr + AZX_REG_VS_SDXDPIB_XBASE +
1061 (AZX_REG_VS_SDXDPIB_XINTERVAL * hdac_stream(stream)->index));
1062 }
1063
1064 static snd_pcm_uframes_t
avs_component_pointer(struct snd_soc_component * component,struct snd_pcm_substream * substream)1065 avs_component_pointer(struct snd_soc_component *component, struct snd_pcm_substream *substream)
1066 {
1067 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1068 struct avs_dma_data *data;
1069 struct hdac_ext_stream *host_stream;
1070 unsigned int pos;
1071
1072 data = snd_soc_dai_get_dma_data(asoc_rtd_to_cpu(rtd, 0), substream);
1073 if (!data->host_stream)
1074 return 0;
1075
1076 host_stream = data->host_stream;
1077 pos = avs_hda_stream_dpib_read(host_stream);
1078
1079 if (pos >= hdac_stream(host_stream)->bufsize)
1080 pos = 0;
1081
1082 return bytes_to_frames(substream->runtime, pos);
1083 }
1084
avs_component_mmap(struct snd_soc_component * component,struct snd_pcm_substream * substream,struct vm_area_struct * vma)1085 static int avs_component_mmap(struct snd_soc_component *component,
1086 struct snd_pcm_substream *substream,
1087 struct vm_area_struct *vma)
1088 {
1089 return snd_pcm_lib_default_mmap(substream, vma);
1090 }
1091
1092 #define MAX_PREALLOC_SIZE (32 * 1024 * 1024)
1093
avs_component_construct(struct snd_soc_component * component,struct snd_soc_pcm_runtime * rtd)1094 static int avs_component_construct(struct snd_soc_component *component,
1095 struct snd_soc_pcm_runtime *rtd)
1096 {
1097 struct snd_soc_dai *dai = asoc_rtd_to_cpu(rtd, 0);
1098 struct snd_pcm *pcm = rtd->pcm;
1099
1100 if (dai->driver->playback.channels_min)
1101 snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream,
1102 SNDRV_DMA_TYPE_DEV_SG, component->dev, 0,
1103 MAX_PREALLOC_SIZE);
1104
1105 if (dai->driver->capture.channels_min)
1106 snd_pcm_set_managed_buffer(pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream,
1107 SNDRV_DMA_TYPE_DEV_SG, component->dev, 0,
1108 MAX_PREALLOC_SIZE);
1109
1110 return 0;
1111 }
1112
1113 static const struct snd_soc_component_driver avs_component_driver = {
1114 .name = "avs-pcm",
1115 .probe = avs_component_probe,
1116 .remove = avs_component_remove,
1117 .suspend = avs_component_suspend,
1118 .resume = avs_component_resume,
1119 .open = avs_component_open,
1120 .pointer = avs_component_pointer,
1121 .mmap = avs_component_mmap,
1122 .pcm_construct = avs_component_construct,
1123 .module_get_upon_open = 1, /* increment refcount when a pcm is opened */
1124 .topology_name_prefix = "intel/avs",
1125 };
1126
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)1127 int avs_soc_component_register(struct device *dev, const char *name,
1128 const struct snd_soc_component_driver *drv,
1129 struct snd_soc_dai_driver *cpu_dais, int num_cpu_dais)
1130 {
1131 struct avs_soc_component *acomp;
1132 int ret;
1133
1134 acomp = devm_kzalloc(dev, sizeof(*acomp), GFP_KERNEL);
1135 if (!acomp)
1136 return -ENOMEM;
1137
1138 ret = snd_soc_component_initialize(&acomp->base, drv, dev);
1139 if (ret < 0)
1140 return ret;
1141
1142 /* force name change after ASoC is done with its init */
1143 acomp->base.name = name;
1144 INIT_LIST_HEAD(&acomp->node);
1145
1146 return snd_soc_add_component(&acomp->base, cpu_dais, num_cpu_dais);
1147 }
1148
1149 static struct snd_soc_dai_driver dmic_cpu_dais[] = {
1150 {
1151 .name = "DMIC Pin",
1152 .ops = &avs_dai_nonhda_be_ops,
1153 .capture = {
1154 .stream_name = "DMIC Rx",
1155 .channels_min = 1,
1156 .channels_max = 4,
1157 .rates = SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_48000,
1158 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
1159 },
1160 },
1161 {
1162 .name = "DMIC WoV Pin",
1163 .ops = &avs_dai_nonhda_be_ops,
1164 .capture = {
1165 .stream_name = "DMIC WoV Rx",
1166 .channels_min = 1,
1167 .channels_max = 4,
1168 .rates = SNDRV_PCM_RATE_16000,
1169 .formats = SNDRV_PCM_FMTBIT_S16_LE,
1170 },
1171 },
1172 };
1173
avs_dmic_platform_register(struct avs_dev * adev,const char * name)1174 int avs_dmic_platform_register(struct avs_dev *adev, const char *name)
1175 {
1176 return avs_soc_component_register(adev->dev, name, &avs_component_driver, dmic_cpu_dais,
1177 ARRAY_SIZE(dmic_cpu_dais));
1178 }
1179
1180 static const struct snd_soc_dai_driver i2s_dai_template = {
1181 .ops = &avs_dai_nonhda_be_ops,
1182 .playback = {
1183 .channels_min = 1,
1184 .channels_max = 8,
1185 .rates = SNDRV_PCM_RATE_8000_192000 |
1186 SNDRV_PCM_RATE_KNOT,
1187 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1188 SNDRV_PCM_FMTBIT_S24_LE |
1189 SNDRV_PCM_FMTBIT_S32_LE,
1190 },
1191 .capture = {
1192 .channels_min = 1,
1193 .channels_max = 8,
1194 .rates = SNDRV_PCM_RATE_8000_192000 |
1195 SNDRV_PCM_RATE_KNOT,
1196 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1197 SNDRV_PCM_FMTBIT_S24_LE |
1198 SNDRV_PCM_FMTBIT_S32_LE,
1199 },
1200 };
1201
avs_i2s_platform_register(struct avs_dev * adev,const char * name,unsigned long port_mask,unsigned long * tdms)1202 int avs_i2s_platform_register(struct avs_dev *adev, const char *name, unsigned long port_mask,
1203 unsigned long *tdms)
1204 {
1205 struct snd_soc_dai_driver *cpus, *dai;
1206 size_t ssp_count, cpu_count;
1207 int i, j;
1208
1209 ssp_count = adev->hw_cfg.i2s_caps.ctrl_count;
1210 cpu_count = hweight_long(port_mask);
1211 if (tdms)
1212 for_each_set_bit(i, &port_mask, ssp_count)
1213 cpu_count += hweight_long(tdms[i]);
1214
1215 cpus = devm_kzalloc(adev->dev, sizeof(*cpus) * cpu_count, GFP_KERNEL);
1216 if (!cpus)
1217 return -ENOMEM;
1218
1219 dai = cpus;
1220 for_each_set_bit(i, &port_mask, ssp_count) {
1221 memcpy(dai, &i2s_dai_template, sizeof(*dai));
1222
1223 dai->name =
1224 devm_kasprintf(adev->dev, GFP_KERNEL, "SSP%d Pin", i);
1225 dai->playback.stream_name =
1226 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d Tx", i);
1227 dai->capture.stream_name =
1228 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d Rx", i);
1229
1230 if (!dai->name || !dai->playback.stream_name || !dai->capture.stream_name)
1231 return -ENOMEM;
1232 dai++;
1233 }
1234
1235 if (!tdms)
1236 goto plat_register;
1237
1238 for_each_set_bit(i, &port_mask, ssp_count) {
1239 for_each_set_bit(j, &tdms[i], ssp_count) {
1240 memcpy(dai, &i2s_dai_template, sizeof(*dai));
1241
1242 dai->name =
1243 devm_kasprintf(adev->dev, GFP_KERNEL, "SSP%d:%d Pin", i, j);
1244 dai->playback.stream_name =
1245 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d:%d Tx", i, j);
1246 dai->capture.stream_name =
1247 devm_kasprintf(adev->dev, GFP_KERNEL, "ssp%d:%d Rx", i, j);
1248
1249 if (!dai->name || !dai->playback.stream_name || !dai->capture.stream_name)
1250 return -ENOMEM;
1251 dai++;
1252 }
1253 }
1254
1255 plat_register:
1256 return avs_soc_component_register(adev->dev, name, &avs_component_driver, cpus, cpu_count);
1257 }
1258
1259 /* HD-Audio CPU DAI template */
1260 static const struct snd_soc_dai_driver hda_cpu_dai = {
1261 .ops = &avs_dai_hda_be_ops,
1262 .playback = {
1263 .channels_min = 1,
1264 .channels_max = 8,
1265 .rates = SNDRV_PCM_RATE_8000_192000,
1266 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1267 SNDRV_PCM_FMTBIT_S24_LE |
1268 SNDRV_PCM_FMTBIT_S32_LE,
1269 },
1270 .capture = {
1271 .channels_min = 1,
1272 .channels_max = 8,
1273 .rates = SNDRV_PCM_RATE_8000_192000,
1274 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1275 SNDRV_PCM_FMTBIT_S24_LE |
1276 SNDRV_PCM_FMTBIT_S32_LE,
1277 },
1278 };
1279
avs_component_hda_unregister_dais(struct snd_soc_component * component)1280 static void avs_component_hda_unregister_dais(struct snd_soc_component *component)
1281 {
1282 struct snd_soc_acpi_mach *mach;
1283 struct snd_soc_dai *dai, *save;
1284 struct hda_codec *codec;
1285 char name[32];
1286
1287 mach = dev_get_platdata(component->card->dev);
1288 codec = mach->pdata;
1289 sprintf(name, "%s-cpu", dev_name(&codec->core.dev));
1290
1291 for_each_component_dais_safe(component, dai, save) {
1292 int stream;
1293
1294 if (!strstr(dai->driver->name, name))
1295 continue;
1296
1297 for_each_pcm_streams(stream)
1298 snd_soc_dapm_free_widget(snd_soc_dai_get_widget(dai, stream));
1299
1300 snd_soc_unregister_dai(dai);
1301 }
1302 }
1303
avs_component_hda_probe(struct snd_soc_component * component)1304 static int avs_component_hda_probe(struct snd_soc_component *component)
1305 {
1306 struct snd_soc_dapm_context *dapm;
1307 struct snd_soc_dai_driver *dais;
1308 struct snd_soc_acpi_mach *mach;
1309 struct hda_codec *codec;
1310 struct hda_pcm *pcm;
1311 const char *cname;
1312 int pcm_count = 0, ret, i;
1313
1314 mach = dev_get_platdata(component->card->dev);
1315 if (!mach)
1316 return -EINVAL;
1317
1318 codec = mach->pdata;
1319 if (list_empty(&codec->pcm_list_head))
1320 return -EINVAL;
1321 list_for_each_entry(pcm, &codec->pcm_list_head, list)
1322 pcm_count++;
1323
1324 dais = devm_kcalloc(component->dev, pcm_count, sizeof(*dais),
1325 GFP_KERNEL);
1326 if (!dais)
1327 return -ENOMEM;
1328
1329 cname = dev_name(&codec->core.dev);
1330 dapm = snd_soc_component_get_dapm(component);
1331 pcm = list_first_entry(&codec->pcm_list_head, struct hda_pcm, list);
1332
1333 for (i = 0; i < pcm_count; i++, pcm = list_next_entry(pcm, list)) {
1334 struct snd_soc_dai *dai;
1335
1336 memcpy(&dais[i], &hda_cpu_dai, sizeof(*dais));
1337 dais[i].id = i;
1338 dais[i].name = devm_kasprintf(component->dev, GFP_KERNEL,
1339 "%s-cpu%d", cname, i);
1340 if (!dais[i].name) {
1341 ret = -ENOMEM;
1342 goto exit;
1343 }
1344
1345 if (pcm->stream[0].substreams) {
1346 dais[i].playback.stream_name =
1347 devm_kasprintf(component->dev, GFP_KERNEL,
1348 "%s-cpu%d Tx", cname, i);
1349 if (!dais[i].playback.stream_name) {
1350 ret = -ENOMEM;
1351 goto exit;
1352 }
1353 }
1354
1355 if (pcm->stream[1].substreams) {
1356 dais[i].capture.stream_name =
1357 devm_kasprintf(component->dev, GFP_KERNEL,
1358 "%s-cpu%d Rx", cname, i);
1359 if (!dais[i].capture.stream_name) {
1360 ret = -ENOMEM;
1361 goto exit;
1362 }
1363 }
1364
1365 dai = snd_soc_register_dai(component, &dais[i], false);
1366 if (!dai) {
1367 dev_err(component->dev, "register dai for %s failed\n",
1368 pcm->name);
1369 ret = -EINVAL;
1370 goto exit;
1371 }
1372
1373 ret = snd_soc_dapm_new_dai_widgets(dapm, dai);
1374 if (ret < 0) {
1375 dev_err(component->dev, "create widgets failed: %d\n",
1376 ret);
1377 goto exit;
1378 }
1379 }
1380
1381 ret = avs_component_probe(component);
1382 exit:
1383 if (ret)
1384 avs_component_hda_unregister_dais(component);
1385
1386 return ret;
1387 }
1388
avs_component_hda_remove(struct snd_soc_component * component)1389 static void avs_component_hda_remove(struct snd_soc_component *component)
1390 {
1391 avs_component_hda_unregister_dais(component);
1392 avs_component_remove(component);
1393 }
1394
avs_component_hda_open(struct snd_soc_component * component,struct snd_pcm_substream * substream)1395 static int avs_component_hda_open(struct snd_soc_component *component,
1396 struct snd_pcm_substream *substream)
1397 {
1398 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1399 struct hdac_ext_stream *link_stream;
1400 struct hda_codec *codec;
1401
1402 if (!rtd->dai_link->no_pcm) {
1403 struct snd_pcm_hardware hwparams = avs_pcm_hardware;
1404 struct snd_soc_pcm_runtime *be;
1405 struct snd_soc_dpcm *dpcm;
1406 int dir = substream->stream;
1407
1408 /*
1409 * Support the DPCM reparenting while still fulfilling expectations of HDAudio
1410 * common code - a valid stream pointer at substream->runtime->private_data -
1411 * by having all FEs point to the same private data.
1412 */
1413 for_each_dpcm_be(rtd, dir, dpcm) {
1414 struct snd_pcm_substream *be_substream;
1415
1416 be = dpcm->be;
1417 if (be->dpcm[dir].users == 1)
1418 break;
1419
1420 be_substream = snd_soc_dpcm_get_substream(be, dir);
1421 substream->runtime->private_data = be_substream->runtime->private_data;
1422 break;
1423 }
1424
1425 /* RESUME unsupported for de-coupled HD-Audio capture. */
1426 if (dir == SNDRV_PCM_STREAM_CAPTURE)
1427 hwparams.info &= ~SNDRV_PCM_INFO_RESUME;
1428
1429 return snd_soc_set_runtime_hwparams(substream, &hwparams);
1430 }
1431
1432 codec = dev_to_hda_codec(asoc_rtd_to_codec(rtd, 0)->dev);
1433 link_stream = snd_hdac_ext_stream_assign(&codec->bus->core, substream,
1434 HDAC_EXT_STREAM_TYPE_LINK);
1435 if (!link_stream)
1436 return -EBUSY;
1437
1438 substream->runtime->private_data = link_stream;
1439 return 0;
1440 }
1441
avs_component_hda_close(struct snd_soc_component * component,struct snd_pcm_substream * substream)1442 static int avs_component_hda_close(struct snd_soc_component *component,
1443 struct snd_pcm_substream *substream)
1444 {
1445 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
1446 struct hdac_ext_stream *link_stream;
1447
1448 /* only BE DAI links are handled here */
1449 if (!rtd->dai_link->no_pcm)
1450 return 0;
1451
1452 link_stream = substream->runtime->private_data;
1453 snd_hdac_ext_stream_release(link_stream, HDAC_EXT_STREAM_TYPE_LINK);
1454 substream->runtime->private_data = NULL;
1455
1456 return 0;
1457 }
1458
1459 static const struct snd_soc_component_driver avs_hda_component_driver = {
1460 .name = "avs-hda-pcm",
1461 .probe = avs_component_hda_probe,
1462 .remove = avs_component_hda_remove,
1463 .suspend = avs_component_suspend,
1464 .resume = avs_component_resume,
1465 .open = avs_component_hda_open,
1466 .close = avs_component_hda_close,
1467 .pointer = avs_component_pointer,
1468 .mmap = avs_component_mmap,
1469 .pcm_construct = avs_component_construct,
1470 /*
1471 * hda platform component's probe() is dependent on
1472 * codec->pcm_list_head, it needs to be initialized after codec
1473 * component. remove_order is here for completeness sake
1474 */
1475 .probe_order = SND_SOC_COMP_ORDER_LATE,
1476 .remove_order = SND_SOC_COMP_ORDER_EARLY,
1477 .module_get_upon_open = 1,
1478 .topology_name_prefix = "intel/avs",
1479 };
1480
avs_hda_platform_register(struct avs_dev * adev,const char * name)1481 int avs_hda_platform_register(struct avs_dev *adev, const char *name)
1482 {
1483 return avs_soc_component_register(adev->dev, name,
1484 &avs_hda_component_driver, NULL, 0);
1485 }
1486