1// SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
2//
3// This file is provided under a dual BSD/GPLv2 license.  When using or
4// redistributing this file, you may do so under either license.
5//
6// Copyright(c) 2018 Intel Corporation. All rights reserved.
7//
8// Authors: Keyon Jie <yang.jie@linux.intel.com>
9//
10
11#include <sound/pcm_params.h>
12#include <sound/hdaudio_ext.h>
13#include "../sof-priv.h"
14#include "../sof-audio.h"
15#include "hda.h"
16
17#if IS_ENABLED(CONFIG_SND_SOC_SOF_HDA)
18
19struct hda_pipe_params {
20	u8 host_dma_id;
21	u8 link_dma_id;
22	u32 ch;
23	u32 s_freq;
24	u32 s_fmt;
25	u8 linktype;
26	snd_pcm_format_t format;
27	int link_index;
28	int stream;
29	unsigned int host_bps;
30	unsigned int link_bps;
31};
32
33/*
34 * This function checks if the host dma channel corresponding
35 * to the link DMA stream_tag argument is assigned to one
36 * of the FEs connected to the BE DAI.
37 */
38static bool hda_check_fes(struct snd_soc_pcm_runtime *rtd,
39			  int dir, int stream_tag)
40{
41	struct snd_pcm_substream *fe_substream;
42	struct hdac_stream *fe_hstream;
43	struct snd_soc_dpcm *dpcm;
44
45	for_each_dpcm_fe(rtd, dir, dpcm) {
46		fe_substream = snd_soc_dpcm_get_substream(dpcm->fe, dir);
47		fe_hstream = fe_substream->runtime->private_data;
48		if (fe_hstream->stream_tag == stream_tag)
49			return true;
50	}
51
52	return false;
53}
54
55static struct hdac_ext_stream *
56	hda_link_stream_assign(struct hdac_bus *bus,
57			       struct snd_pcm_substream *substream)
58{
59	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
60	struct sof_intel_hda_stream *hda_stream;
61	struct hdac_ext_stream *res = NULL;
62	struct hdac_stream *stream = NULL;
63
64	int stream_dir = substream->stream;
65
66	if (!bus->ppcap) {
67		dev_err(bus->dev, "stream type not supported\n");
68		return NULL;
69	}
70
71	spin_lock_irq(&bus->reg_lock);
72	list_for_each_entry(stream, &bus->stream_list, list) {
73		struct hdac_ext_stream *hstream =
74			stream_to_hdac_ext_stream(stream);
75		if (stream->direction != substream->stream)
76			continue;
77
78		hda_stream = hstream_to_sof_hda_stream(hstream);
79
80		/* check if link is available */
81		if (!hstream->link_locked) {
82			if (stream->opened) {
83				/*
84				 * check if the stream tag matches the stream
85				 * tag of one of the connected FEs
86				 */
87				if (hda_check_fes(rtd, stream_dir,
88						  stream->stream_tag)) {
89					res = hstream;
90					break;
91				}
92			} else {
93				res = hstream;
94
95				/*
96				 * This must be a hostless stream.
97				 * So reserve the host DMA channel.
98				 */
99				hda_stream->host_reserved = 1;
100				break;
101			}
102		}
103	}
104
105	if (res) {
106		/*
107		 * Decouple host and link DMA. The decoupled flag
108		 * is updated in snd_hdac_ext_stream_decouple().
109		 */
110		if (!res->decoupled)
111			snd_hdac_ext_stream_decouple_locked(bus, res, true);
112
113		res->link_locked = 1;
114		res->link_substream = substream;
115	}
116	spin_unlock_irq(&bus->reg_lock);
117
118	return res;
119}
120
121static int hda_link_dma_params(struct hdac_ext_stream *stream,
122			       struct hda_pipe_params *params)
123{
124	struct hdac_stream *hstream = &stream->hstream;
125	unsigned char stream_tag = hstream->stream_tag;
126	struct hdac_bus *bus = hstream->bus;
127	struct hdac_ext_link *link;
128	unsigned int format_val;
129
130	snd_hdac_ext_stream_decouple(bus, stream, true);
131	snd_hdac_ext_link_stream_reset(stream);
132
133	format_val = snd_hdac_calc_stream_format(params->s_freq, params->ch,
134						 params->format,
135						 params->link_bps, 0);
136
137	dev_dbg(bus->dev, "format_val=%d, rate=%d, ch=%d, format=%d\n",
138		format_val, params->s_freq, params->ch, params->format);
139
140	snd_hdac_ext_link_stream_setup(stream, format_val);
141
142	if (stream->hstream.direction == SNDRV_PCM_STREAM_PLAYBACK) {
143		list_for_each_entry(link, &bus->hlink_list, list) {
144			if (link->index == params->link_index)
145				snd_hdac_ext_link_set_stream_id(link,
146								stream_tag);
147		}
148	}
149
150	stream->link_prepared = 1;
151
152	return 0;
153}
154
155/* Send DAI_CONFIG IPC to the DAI that matches the dai_name and direction */
156static int hda_link_config_ipc(struct sof_intel_hda_stream *hda_stream,
157			       const char *dai_name, int channel, int dir)
158{
159	struct sof_ipc_dai_config *config;
160	struct snd_sof_dai *sof_dai;
161	struct sof_ipc_reply reply;
162	int ret = 0;
163
164	list_for_each_entry(sof_dai, &hda_stream->sdev->dai_list, list) {
165		if (!sof_dai->cpu_dai_name)
166			continue;
167
168		if (!strcmp(dai_name, sof_dai->cpu_dai_name) &&
169		    dir == sof_dai->comp_dai.direction) {
170			config = sof_dai->dai_config;
171
172			if (!config) {
173				dev_err(hda_stream->sdev->dev,
174					"error: no config for DAI %s\n",
175					sof_dai->name);
176				return -EINVAL;
177			}
178
179			/* update config with stream tag */
180			config->hda.link_dma_ch = channel;
181
182			/* send IPC */
183			ret = sof_ipc_tx_message(hda_stream->sdev->ipc,
184						 config->hdr.cmd,
185						 config,
186						 config->hdr.size,
187						 &reply, sizeof(reply));
188
189			if (ret < 0)
190				dev_err(hda_stream->sdev->dev,
191					"error: failed to set dai config for %s\n",
192					sof_dai->name);
193			return ret;
194		}
195	}
196
197	return -EINVAL;
198}
199
200static int hda_link_hw_params(struct snd_pcm_substream *substream,
201			      struct snd_pcm_hw_params *params,
202			      struct snd_soc_dai *dai)
203{
204	struct hdac_stream *hstream = substream->runtime->private_data;
205	struct hdac_bus *bus = hstream->bus;
206	struct hdac_ext_stream *link_dev;
207	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
208	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
209	struct sof_intel_hda_stream *hda_stream;
210	struct hda_pipe_params p_params = {0};
211	struct hdac_ext_link *link;
212	int stream_tag;
213	int ret;
214
215	link = snd_hdac_ext_bus_get_link(bus, codec_dai->component->name);
216	if (!link)
217		return -EINVAL;
218
219	/* get stored dma data if resuming from system suspend */
220	link_dev = snd_soc_dai_get_dma_data(dai, substream);
221	if (!link_dev) {
222		link_dev = hda_link_stream_assign(bus, substream);
223		if (!link_dev)
224			return -EBUSY;
225
226		snd_soc_dai_set_dma_data(dai, substream, (void *)link_dev);
227	}
228
229	stream_tag = hdac_stream(link_dev)->stream_tag;
230
231	hda_stream = hstream_to_sof_hda_stream(link_dev);
232
233	/* update the DSP with the new tag */
234	ret = hda_link_config_ipc(hda_stream, dai->name, stream_tag - 1,
235				  substream->stream);
236	if (ret < 0)
237		return ret;
238
239	/* set the hdac_stream in the codec dai */
240	snd_soc_dai_set_stream(codec_dai, hdac_stream(link_dev), substream->stream);
241
242	p_params.s_fmt = snd_pcm_format_width(params_format(params));
243	p_params.ch = params_channels(params);
244	p_params.s_freq = params_rate(params);
245	p_params.stream = substream->stream;
246	p_params.link_dma_id = stream_tag - 1;
247	p_params.link_index = link->index;
248	p_params.format = params_format(params);
249
250	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
251		p_params.link_bps = codec_dai->driver->playback.sig_bits;
252	else
253		p_params.link_bps = codec_dai->driver->capture.sig_bits;
254
255	return hda_link_dma_params(link_dev, &p_params);
256}
257
258static int hda_link_pcm_prepare(struct snd_pcm_substream *substream,
259				struct snd_soc_dai *dai)
260{
261	struct hdac_ext_stream *link_dev =
262				snd_soc_dai_get_dma_data(dai, substream);
263	struct snd_sof_dev *sdev =
264				snd_soc_component_get_drvdata(dai->component);
265	struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
266	int stream = substream->stream;
267
268	if (link_dev->link_prepared)
269		return 0;
270
271	dev_dbg(sdev->dev, "hda: prepare stream dir %d\n", substream->stream);
272
273	return hda_link_hw_params(substream, &rtd->dpcm[stream].hw_params,
274				  dai);
275}
276
277static int hda_link_pcm_trigger(struct snd_pcm_substream *substream,
278				int cmd, struct snd_soc_dai *dai)
279{
280	struct hdac_ext_stream *link_dev =
281				snd_soc_dai_get_dma_data(dai, substream);
282	struct sof_intel_hda_stream *hda_stream;
283	struct snd_soc_pcm_runtime *rtd;
284	struct hdac_ext_link *link;
285	struct hdac_stream *hstream;
286	struct hdac_bus *bus;
287	int stream_tag;
288	int ret;
289
290	hstream = substream->runtime->private_data;
291	bus = hstream->bus;
292	rtd = asoc_substream_to_rtd(substream);
293
294	link = snd_hdac_ext_bus_get_link(bus, asoc_rtd_to_codec(rtd, 0)->component->name);
295	if (!link)
296		return -EINVAL;
297
298	hda_stream = hstream_to_sof_hda_stream(link_dev);
299
300	dev_dbg(dai->dev, "In %s cmd=%d\n", __func__, cmd);
301	switch (cmd) {
302	case SNDRV_PCM_TRIGGER_RESUME:
303		/* set up hw_params */
304		ret = hda_link_pcm_prepare(substream, dai);
305		if (ret < 0) {
306			dev_err(dai->dev,
307				"error: setting up hw_params during resume\n");
308			return ret;
309		}
310
311		fallthrough;
312	case SNDRV_PCM_TRIGGER_START:
313	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
314		snd_hdac_ext_link_stream_start(link_dev);
315		break;
316	case SNDRV_PCM_TRIGGER_SUSPEND:
317	case SNDRV_PCM_TRIGGER_STOP:
318		/*
319		 * clear link DMA channel. It will be assigned when
320		 * hw_params is set up again after resume.
321		 */
322		ret = hda_link_config_ipc(hda_stream, dai->name,
323					  DMA_CHAN_INVALID, substream->stream);
324		if (ret < 0)
325			return ret;
326
327		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
328			stream_tag = hdac_stream(link_dev)->stream_tag;
329			snd_hdac_ext_link_clear_stream_id(link, stream_tag);
330		}
331
332		link_dev->link_prepared = 0;
333
334		fallthrough;
335	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
336		snd_hdac_ext_link_stream_clear(link_dev);
337		break;
338	default:
339		return -EINVAL;
340	}
341	return 0;
342}
343
344static int hda_link_hw_free(struct snd_pcm_substream *substream,
345			    struct snd_soc_dai *dai)
346{
347	unsigned int stream_tag;
348	struct sof_intel_hda_stream *hda_stream;
349	struct hdac_bus *bus;
350	struct hdac_ext_link *link;
351	struct hdac_stream *hstream;
352	struct snd_soc_pcm_runtime *rtd;
353	struct hdac_ext_stream *link_dev;
354	int ret;
355
356	hstream = substream->runtime->private_data;
357	bus = hstream->bus;
358	rtd = asoc_substream_to_rtd(substream);
359	link_dev = snd_soc_dai_get_dma_data(dai, substream);
360
361	if (!link_dev) {
362		dev_dbg(dai->dev,
363			"%s: link_dev is not assigned\n", __func__);
364		return -EINVAL;
365	}
366
367	hda_stream = hstream_to_sof_hda_stream(link_dev);
368
369	/* free the link DMA channel in the FW */
370	ret = hda_link_config_ipc(hda_stream, dai->name, DMA_CHAN_INVALID,
371				  substream->stream);
372	if (ret < 0)
373		return ret;
374
375	link = snd_hdac_ext_bus_get_link(bus, asoc_rtd_to_codec(rtd, 0)->component->name);
376	if (!link)
377		return -EINVAL;
378
379	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
380		stream_tag = hdac_stream(link_dev)->stream_tag;
381		snd_hdac_ext_link_clear_stream_id(link, stream_tag);
382	}
383
384	snd_soc_dai_set_dma_data(dai, substream, NULL);
385	snd_hdac_ext_stream_release(link_dev, HDAC_EXT_STREAM_TYPE_LINK);
386	link_dev->link_prepared = 0;
387
388	/* free the host DMA channel reserved by hostless streams */
389	hda_stream->host_reserved = 0;
390
391	return 0;
392}
393
394static const struct snd_soc_dai_ops hda_link_dai_ops = {
395	.hw_params = hda_link_hw_params,
396	.hw_free = hda_link_hw_free,
397	.trigger = hda_link_pcm_trigger,
398	.prepare = hda_link_pcm_prepare,
399};
400
401#if IS_ENABLED(CONFIG_SND_SOC_SOF_HDA_PROBES)
402#include "../compress.h"
403
404static struct snd_soc_cdai_ops sof_probe_compr_ops = {
405	.startup	= sof_probe_compr_open,
406	.shutdown	= sof_probe_compr_free,
407	.set_params	= sof_probe_compr_set_params,
408	.trigger	= sof_probe_compr_trigger,
409	.pointer	= sof_probe_compr_pointer,
410};
411
412#endif
413#endif
414
415/*
416 * common dai driver for skl+ platforms.
417 * some products who use this DAI array only physically have a subset of
418 * the DAIs, but no harm is done here by adding the whole set.
419 */
420struct snd_soc_dai_driver skl_dai[] = {
421{
422	.name = "SSP0 Pin",
423	.playback = {
424		.channels_min = 1,
425		.channels_max = 8,
426	},
427	.capture = {
428		.channels_min = 1,
429		.channels_max = 8,
430	},
431},
432{
433	.name = "SSP1 Pin",
434	.playback = {
435		.channels_min = 1,
436		.channels_max = 8,
437	},
438	.capture = {
439		.channels_min = 1,
440		.channels_max = 8,
441	},
442},
443{
444	.name = "SSP2 Pin",
445	.playback = {
446		.channels_min = 1,
447		.channels_max = 8,
448	},
449	.capture = {
450		.channels_min = 1,
451		.channels_max = 8,
452	},
453},
454{
455	.name = "SSP3 Pin",
456	.playback = {
457		.channels_min = 1,
458		.channels_max = 8,
459	},
460	.capture = {
461		.channels_min = 1,
462		.channels_max = 8,
463	},
464},
465{
466	.name = "SSP4 Pin",
467	.playback = {
468		.channels_min = 1,
469		.channels_max = 8,
470	},
471	.capture = {
472		.channels_min = 1,
473		.channels_max = 8,
474	},
475},
476{
477	.name = "SSP5 Pin",
478	.playback = {
479		.channels_min = 1,
480		.channels_max = 8,
481	},
482	.capture = {
483		.channels_min = 1,
484		.channels_max = 8,
485	},
486},
487{
488	.name = "DMIC01 Pin",
489	.capture = {
490		.channels_min = 1,
491		.channels_max = 4,
492	},
493},
494{
495	.name = "DMIC16k Pin",
496	.capture = {
497		.channels_min = 1,
498		.channels_max = 4,
499	},
500},
501#if IS_ENABLED(CONFIG_SND_SOC_SOF_HDA)
502{
503	.name = "iDisp1 Pin",
504	.ops = &hda_link_dai_ops,
505	.playback = {
506		.channels_min = 1,
507		.channels_max = 8,
508	},
509},
510{
511	.name = "iDisp2 Pin",
512	.ops = &hda_link_dai_ops,
513	.playback = {
514		.channels_min = 1,
515		.channels_max = 8,
516	},
517},
518{
519	.name = "iDisp3 Pin",
520	.ops = &hda_link_dai_ops,
521	.playback = {
522		.channels_min = 1,
523		.channels_max = 8,
524	},
525},
526{
527	.name = "iDisp4 Pin",
528	.ops = &hda_link_dai_ops,
529	.playback = {
530		.channels_min = 1,
531		.channels_max = 8,
532	},
533},
534{
535	.name = "Analog CPU DAI",
536	.ops = &hda_link_dai_ops,
537	.playback = {
538		.channels_min = 1,
539		.channels_max = 16,
540	},
541	.capture = {
542		.channels_min = 1,
543		.channels_max = 16,
544	},
545},
546{
547	.name = "Digital CPU DAI",
548	.ops = &hda_link_dai_ops,
549	.playback = {
550		.channels_min = 1,
551		.channels_max = 16,
552	},
553	.capture = {
554		.channels_min = 1,
555		.channels_max = 16,
556	},
557},
558{
559	.name = "Alt Analog CPU DAI",
560	.ops = &hda_link_dai_ops,
561	.playback = {
562		.channels_min = 1,
563		.channels_max = 16,
564	},
565	.capture = {
566		.channels_min = 1,
567		.channels_max = 16,
568	},
569},
570#if IS_ENABLED(CONFIG_SND_SOC_SOF_HDA_PROBES)
571{
572	.name = "Probe Extraction CPU DAI",
573	.compress_new = snd_soc_new_compress,
574	.cops = &sof_probe_compr_ops,
575	.capture = {
576		.stream_name = "Probe Extraction",
577		.channels_min = 1,
578		.channels_max = 8,
579		.rates = SNDRV_PCM_RATE_48000,
580		.rate_min = 48000,
581		.rate_max = 48000,
582	},
583},
584#endif
585#endif
586};
587