1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  *  hdac-ext-stream.c - HD-audio extended stream operations.
4  *
5  *  Copyright (C) 2015 Intel Corp
6  *  Author: Jeeja KP <jeeja.kp@intel.com>
7  *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
8  *
9  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
10  */
11 
12 #include <linux/delay.h>
13 #include <linux/slab.h>
14 #include <sound/pcm.h>
15 #include <sound/hda_register.h>
16 #include <sound/hdaudio_ext.h>
17 
18 /**
19  * snd_hdac_ext_stream_init - initialize each stream (aka device)
20  * @bus: HD-audio core bus
21  * @hext_stream: HD-audio ext core stream object to initialize
22  * @idx: stream index number
23  * @direction: stream direction (SNDRV_PCM_STREAM_PLAYBACK or SNDRV_PCM_STREAM_CAPTURE)
24  * @tag: the tag id to assign
25  *
26  * initialize the stream, if ppcap is enabled then init those and then
27  * invoke hdac stream initialization routine
28  */
snd_hdac_ext_stream_init(struct hdac_bus * bus,struct hdac_ext_stream * hext_stream,int idx,int direction,int tag)29 void snd_hdac_ext_stream_init(struct hdac_bus *bus,
30 			      struct hdac_ext_stream *hext_stream,
31 			      int idx, int direction, int tag)
32 {
33 	if (bus->ppcap) {
34 		hext_stream->pphc_addr = bus->ppcap + AZX_PPHC_BASE +
35 				AZX_PPHC_INTERVAL * idx;
36 
37 		hext_stream->pplc_addr = bus->ppcap + AZX_PPLC_BASE +
38 				AZX_PPLC_MULTI * bus->num_streams +
39 				AZX_PPLC_INTERVAL * idx;
40 	}
41 
42 	if (bus->spbcap) {
43 		hext_stream->spib_addr = bus->spbcap + AZX_SPB_BASE +
44 					AZX_SPB_INTERVAL * idx +
45 					AZX_SPB_SPIB;
46 
47 		hext_stream->fifo_addr = bus->spbcap + AZX_SPB_BASE +
48 					AZX_SPB_INTERVAL * idx +
49 					AZX_SPB_MAXFIFO;
50 	}
51 
52 	if (bus->drsmcap)
53 		hext_stream->dpibr_addr = bus->drsmcap + AZX_DRSM_BASE +
54 					AZX_DRSM_INTERVAL * idx;
55 
56 	hext_stream->decoupled = false;
57 	snd_hdac_stream_init(bus, &hext_stream->hstream, idx, direction, tag);
58 }
59 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_init);
60 
61 /**
62  * snd_hdac_ext_stream_init_all - create and initialize the stream objects
63  *   for an extended hda bus
64  * @bus: HD-audio core bus
65  * @start_idx: start index for streams
66  * @num_stream: number of streams to initialize
67  * @dir: direction of streams
68  */
snd_hdac_ext_stream_init_all(struct hdac_bus * bus,int start_idx,int num_stream,int dir)69 int snd_hdac_ext_stream_init_all(struct hdac_bus *bus, int start_idx,
70 				 int num_stream, int dir)
71 {
72 	int stream_tag = 0;
73 	int i, tag, idx = start_idx;
74 
75 	for (i = 0; i < num_stream; i++) {
76 		struct hdac_ext_stream *hext_stream =
77 				kzalloc(sizeof(*hext_stream), GFP_KERNEL);
78 		if (!hext_stream)
79 			return -ENOMEM;
80 		tag = ++stream_tag;
81 		snd_hdac_ext_stream_init(bus, hext_stream, idx, dir, tag);
82 		idx++;
83 	}
84 
85 	return 0;
86 
87 }
88 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_init_all);
89 
90 /**
91  * snd_hdac_stream_free_all - free hdac extended stream objects
92  *
93  * @bus: HD-audio core bus
94  */
snd_hdac_stream_free_all(struct hdac_bus * bus)95 void snd_hdac_stream_free_all(struct hdac_bus *bus)
96 {
97 	struct hdac_stream *s, *_s;
98 	struct hdac_ext_stream *hext_stream;
99 
100 	list_for_each_entry_safe(s, _s, &bus->stream_list, list) {
101 		hext_stream = stream_to_hdac_ext_stream(s);
102 		snd_hdac_ext_stream_decouple(bus, hext_stream, false);
103 		list_del(&s->list);
104 		kfree(hext_stream);
105 	}
106 }
107 EXPORT_SYMBOL_GPL(snd_hdac_stream_free_all);
108 
snd_hdac_ext_stream_decouple_locked(struct hdac_bus * bus,struct hdac_ext_stream * hext_stream,bool decouple)109 void snd_hdac_ext_stream_decouple_locked(struct hdac_bus *bus,
110 					 struct hdac_ext_stream *hext_stream,
111 					 bool decouple)
112 {
113 	struct hdac_stream *hstream = &hext_stream->hstream;
114 	u32 val;
115 	int mask = AZX_PPCTL_PROCEN(hstream->index);
116 
117 	val = readw(bus->ppcap + AZX_REG_PP_PPCTL) & mask;
118 
119 	if (decouple && !val)
120 		snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, mask, mask);
121 	else if (!decouple && val)
122 		snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, mask, 0);
123 
124 	hext_stream->decoupled = decouple;
125 }
126 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_decouple_locked);
127 
128 /**
129  * snd_hdac_ext_stream_decouple - decouple the hdac stream
130  * @bus: HD-audio core bus
131  * @hext_stream: HD-audio ext core stream object to initialize
132  * @decouple: flag to decouple
133  */
snd_hdac_ext_stream_decouple(struct hdac_bus * bus,struct hdac_ext_stream * hext_stream,bool decouple)134 void snd_hdac_ext_stream_decouple(struct hdac_bus *bus,
135 				  struct hdac_ext_stream *hext_stream, bool decouple)
136 {
137 	spin_lock_irq(&bus->reg_lock);
138 	snd_hdac_ext_stream_decouple_locked(bus, hext_stream, decouple);
139 	spin_unlock_irq(&bus->reg_lock);
140 }
141 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_decouple);
142 
143 /**
144  * snd_hdac_ext_link_stream_start - start a stream
145  * @hext_stream: HD-audio ext core stream to start
146  */
snd_hdac_ext_link_stream_start(struct hdac_ext_stream * hext_stream)147 void snd_hdac_ext_link_stream_start(struct hdac_ext_stream *hext_stream)
148 {
149 	snd_hdac_updatel(hext_stream->pplc_addr, AZX_REG_PPLCCTL,
150 			 AZX_PPLCCTL_RUN, AZX_PPLCCTL_RUN);
151 }
152 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_stream_start);
153 
154 /**
155  * snd_hdac_ext_link_stream_clear - stop a stream DMA
156  * @hext_stream: HD-audio ext core stream to stop
157  */
snd_hdac_ext_link_stream_clear(struct hdac_ext_stream * hext_stream)158 void snd_hdac_ext_link_stream_clear(struct hdac_ext_stream *hext_stream)
159 {
160 	snd_hdac_updatel(hext_stream->pplc_addr, AZX_REG_PPLCCTL, AZX_PPLCCTL_RUN, 0);
161 }
162 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_stream_clear);
163 
164 /**
165  * snd_hdac_ext_link_stream_reset - reset a stream
166  * @hext_stream: HD-audio ext core stream to reset
167  */
snd_hdac_ext_link_stream_reset(struct hdac_ext_stream * hext_stream)168 void snd_hdac_ext_link_stream_reset(struct hdac_ext_stream *hext_stream)
169 {
170 	unsigned char val;
171 	int timeout;
172 
173 	snd_hdac_ext_link_stream_clear(hext_stream);
174 
175 	snd_hdac_updatel(hext_stream->pplc_addr, AZX_REG_PPLCCTL,
176 			 AZX_PPLCCTL_STRST, AZX_PPLCCTL_STRST);
177 	udelay(3);
178 	timeout = 50;
179 	do {
180 		val = readl(hext_stream->pplc_addr + AZX_REG_PPLCCTL) &
181 				AZX_PPLCCTL_STRST;
182 		if (val)
183 			break;
184 		udelay(3);
185 	} while (--timeout);
186 	val &= ~AZX_PPLCCTL_STRST;
187 	writel(val, hext_stream->pplc_addr + AZX_REG_PPLCCTL);
188 	udelay(3);
189 
190 	timeout = 50;
191 	/* waiting for hardware to report that the stream is out of reset */
192 	do {
193 		val = readl(hext_stream->pplc_addr + AZX_REG_PPLCCTL) & AZX_PPLCCTL_STRST;
194 		if (!val)
195 			break;
196 		udelay(3);
197 	} while (--timeout);
198 
199 }
200 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_stream_reset);
201 
202 /**
203  * snd_hdac_ext_link_stream_setup -  set up the SD for streaming
204  * @hext_stream: HD-audio ext core stream to set up
205  * @fmt: stream format
206  */
snd_hdac_ext_link_stream_setup(struct hdac_ext_stream * hext_stream,int fmt)207 int snd_hdac_ext_link_stream_setup(struct hdac_ext_stream *hext_stream, int fmt)
208 {
209 	struct hdac_stream *hstream = &hext_stream->hstream;
210 	unsigned int val;
211 
212 	/* make sure the run bit is zero for SD */
213 	snd_hdac_ext_link_stream_clear(hext_stream);
214 	/* program the stream_tag */
215 	val = readl(hext_stream->pplc_addr + AZX_REG_PPLCCTL);
216 	val = (val & ~AZX_PPLCCTL_STRM_MASK) |
217 		(hstream->stream_tag << AZX_PPLCCTL_STRM_SHIFT);
218 	writel(val, hext_stream->pplc_addr + AZX_REG_PPLCCTL);
219 
220 	/* program the stream format */
221 	writew(fmt, hext_stream->pplc_addr + AZX_REG_PPLCFMT);
222 
223 	return 0;
224 }
225 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_stream_setup);
226 
227 /**
228  * snd_hdac_ext_link_set_stream_id - maps stream id to link output
229  * @link: HD-audio ext link to set up
230  * @stream: stream id
231  */
snd_hdac_ext_link_set_stream_id(struct hdac_ext_link * link,int stream)232 void snd_hdac_ext_link_set_stream_id(struct hdac_ext_link *link,
233 				     int stream)
234 {
235 	snd_hdac_updatew(link->ml_addr, AZX_REG_ML_LOSIDV, (1 << stream), 1 << stream);
236 }
237 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_set_stream_id);
238 
239 /**
240  * snd_hdac_ext_link_clear_stream_id - maps stream id to link output
241  * @link: HD-audio ext link to set up
242  * @stream: stream id
243  */
snd_hdac_ext_link_clear_stream_id(struct hdac_ext_link * link,int stream)244 void snd_hdac_ext_link_clear_stream_id(struct hdac_ext_link *link,
245 				 int stream)
246 {
247 	snd_hdac_updatew(link->ml_addr, AZX_REG_ML_LOSIDV, (1 << stream), 0);
248 }
249 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_clear_stream_id);
250 
251 static struct hdac_ext_stream *
hdac_ext_link_stream_assign(struct hdac_bus * bus,struct snd_pcm_substream * substream)252 hdac_ext_link_stream_assign(struct hdac_bus *bus,
253 			    struct snd_pcm_substream *substream)
254 {
255 	struct hdac_ext_stream *res = NULL;
256 	struct hdac_stream *hstream = NULL;
257 
258 	if (!bus->ppcap) {
259 		dev_err(bus->dev, "stream type not supported\n");
260 		return NULL;
261 	}
262 
263 	spin_lock_irq(&bus->reg_lock);
264 	list_for_each_entry(hstream, &bus->stream_list, list) {
265 		struct hdac_ext_stream *hext_stream = container_of(hstream,
266 								 struct hdac_ext_stream,
267 								 hstream);
268 		if (hstream->direction != substream->stream)
269 			continue;
270 
271 		/* check if decoupled stream and not in use is available */
272 		if (hext_stream->decoupled && !hext_stream->link_locked) {
273 			res = hext_stream;
274 			break;
275 		}
276 
277 		if (!hext_stream->link_locked) {
278 			snd_hdac_ext_stream_decouple_locked(bus, hext_stream, true);
279 			res = hext_stream;
280 			break;
281 		}
282 	}
283 	if (res) {
284 		res->link_locked = 1;
285 		res->link_substream = substream;
286 	}
287 	spin_unlock_irq(&bus->reg_lock);
288 	return res;
289 }
290 
291 static struct hdac_ext_stream *
hdac_ext_host_stream_assign(struct hdac_bus * bus,struct snd_pcm_substream * substream)292 hdac_ext_host_stream_assign(struct hdac_bus *bus,
293 			    struct snd_pcm_substream *substream)
294 {
295 	struct hdac_ext_stream *res = NULL;
296 	struct hdac_stream *hstream = NULL;
297 
298 	if (!bus->ppcap) {
299 		dev_err(bus->dev, "stream type not supported\n");
300 		return NULL;
301 	}
302 
303 	spin_lock_irq(&bus->reg_lock);
304 	list_for_each_entry(hstream, &bus->stream_list, list) {
305 		struct hdac_ext_stream *hext_stream = container_of(hstream,
306 								 struct hdac_ext_stream,
307 								 hstream);
308 		if (hstream->direction != substream->stream)
309 			continue;
310 
311 		if (!hstream->opened) {
312 			if (!hext_stream->decoupled)
313 				snd_hdac_ext_stream_decouple_locked(bus, hext_stream, true);
314 			res = hext_stream;
315 			break;
316 		}
317 	}
318 	if (res) {
319 		res->hstream.opened = 1;
320 		res->hstream.running = 0;
321 		res->hstream.substream = substream;
322 	}
323 	spin_unlock_irq(&bus->reg_lock);
324 
325 	return res;
326 }
327 
328 /**
329  * snd_hdac_ext_stream_assign - assign a stream for the PCM
330  * @bus: HD-audio core bus
331  * @substream: PCM substream to assign
332  * @type: type of stream (coupled, host or link stream)
333  *
334  * This assigns the stream based on the type (coupled/host/link), for the
335  * given PCM substream, assigns it and returns the stream object
336  *
337  * coupled: Looks for an unused stream
338  * host: Looks for an unused decoupled host stream
339  * link: Looks for an unused decoupled link stream
340  *
341  * If no stream is free, returns NULL. The function tries to keep using
342  * the same stream object when it's used beforehand.  when a stream is
343  * decoupled, it becomes a host stream and link stream.
344  */
snd_hdac_ext_stream_assign(struct hdac_bus * bus,struct snd_pcm_substream * substream,int type)345 struct hdac_ext_stream *snd_hdac_ext_stream_assign(struct hdac_bus *bus,
346 					   struct snd_pcm_substream *substream,
347 					   int type)
348 {
349 	struct hdac_ext_stream *hext_stream = NULL;
350 	struct hdac_stream *hstream = NULL;
351 
352 	switch (type) {
353 	case HDAC_EXT_STREAM_TYPE_COUPLED:
354 		hstream = snd_hdac_stream_assign(bus, substream);
355 		if (hstream)
356 			hext_stream = container_of(hstream,
357 						   struct hdac_ext_stream,
358 						   hstream);
359 		return hext_stream;
360 
361 	case HDAC_EXT_STREAM_TYPE_HOST:
362 		return hdac_ext_host_stream_assign(bus, substream);
363 
364 	case HDAC_EXT_STREAM_TYPE_LINK:
365 		return hdac_ext_link_stream_assign(bus, substream);
366 
367 	default:
368 		return NULL;
369 	}
370 }
371 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_assign);
372 
373 /**
374  * snd_hdac_ext_stream_release - release the assigned stream
375  * @hext_stream: HD-audio ext core stream to release
376  * @type: type of stream (coupled, host or link stream)
377  *
378  * Release the stream that has been assigned by snd_hdac_ext_stream_assign().
379  */
snd_hdac_ext_stream_release(struct hdac_ext_stream * hext_stream,int type)380 void snd_hdac_ext_stream_release(struct hdac_ext_stream *hext_stream, int type)
381 {
382 	struct hdac_bus *bus = hext_stream->hstream.bus;
383 
384 	switch (type) {
385 	case HDAC_EXT_STREAM_TYPE_COUPLED:
386 		snd_hdac_stream_release(&hext_stream->hstream);
387 		break;
388 
389 	case HDAC_EXT_STREAM_TYPE_HOST:
390 		spin_lock_irq(&bus->reg_lock);
391 		if (hext_stream->decoupled && !hext_stream->link_locked)
392 			snd_hdac_ext_stream_decouple_locked(bus, hext_stream, false);
393 		spin_unlock_irq(&bus->reg_lock);
394 		snd_hdac_stream_release(&hext_stream->hstream);
395 		break;
396 
397 	case HDAC_EXT_STREAM_TYPE_LINK:
398 		spin_lock_irq(&bus->reg_lock);
399 		if (hext_stream->decoupled && !hext_stream->hstream.opened)
400 			snd_hdac_ext_stream_decouple_locked(bus, hext_stream, false);
401 		hext_stream->link_locked = 0;
402 		hext_stream->link_substream = NULL;
403 		spin_unlock_irq(&bus->reg_lock);
404 		break;
405 
406 	default:
407 		dev_dbg(bus->dev, "Invalid type %d\n", type);
408 	}
409 
410 }
411 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_release);
412 
413 /**
414  * snd_hdac_ext_stream_spbcap_enable - enable SPIB for a stream
415  * @bus: HD-audio core bus
416  * @enable: flag to enable/disable SPIB
417  * @index: stream index for which SPIB need to be enabled
418  */
snd_hdac_ext_stream_spbcap_enable(struct hdac_bus * bus,bool enable,int index)419 void snd_hdac_ext_stream_spbcap_enable(struct hdac_bus *bus,
420 				 bool enable, int index)
421 {
422 	u32 mask = 0;
423 
424 	if (!bus->spbcap) {
425 		dev_err(bus->dev, "Address of SPB capability is NULL\n");
426 		return;
427 	}
428 
429 	mask |= (1 << index);
430 
431 	if (enable)
432 		snd_hdac_updatel(bus->spbcap, AZX_REG_SPB_SPBFCCTL, mask, mask);
433 	else
434 		snd_hdac_updatel(bus->spbcap, AZX_REG_SPB_SPBFCCTL, mask, 0);
435 }
436 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_spbcap_enable);
437 
438 /**
439  * snd_hdac_ext_stream_set_spib - sets the spib value of a stream
440  * @bus: HD-audio core bus
441  * @hext_stream: hdac_ext_stream
442  * @value: spib value to set
443  */
snd_hdac_ext_stream_set_spib(struct hdac_bus * bus,struct hdac_ext_stream * hext_stream,u32 value)444 int snd_hdac_ext_stream_set_spib(struct hdac_bus *bus,
445 				 struct hdac_ext_stream *hext_stream, u32 value)
446 {
447 
448 	if (!bus->spbcap) {
449 		dev_err(bus->dev, "Address of SPB capability is NULL\n");
450 		return -EINVAL;
451 	}
452 
453 	writel(value, hext_stream->spib_addr);
454 
455 	return 0;
456 }
457 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_set_spib);
458 
459 /**
460  * snd_hdac_ext_stream_get_spbmaxfifo - gets the spib value of a stream
461  * @bus: HD-audio core bus
462  * @hext_stream: hdac_ext_stream
463  *
464  * Return maxfifo for the stream
465  */
snd_hdac_ext_stream_get_spbmaxfifo(struct hdac_bus * bus,struct hdac_ext_stream * hext_stream)466 int snd_hdac_ext_stream_get_spbmaxfifo(struct hdac_bus *bus,
467 				 struct hdac_ext_stream *hext_stream)
468 {
469 
470 	if (!bus->spbcap) {
471 		dev_err(bus->dev, "Address of SPB capability is NULL\n");
472 		return -EINVAL;
473 	}
474 
475 	return readl(hext_stream->fifo_addr);
476 }
477 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_get_spbmaxfifo);
478 
479 /**
480  * snd_hdac_ext_stream_drsm_enable - enable DMA resume for a stream
481  * @bus: HD-audio core bus
482  * @enable: flag to enable/disable DRSM
483  * @index: stream index for which DRSM need to be enabled
484  */
snd_hdac_ext_stream_drsm_enable(struct hdac_bus * bus,bool enable,int index)485 void snd_hdac_ext_stream_drsm_enable(struct hdac_bus *bus,
486 				bool enable, int index)
487 {
488 	u32 mask = 0;
489 
490 	if (!bus->drsmcap) {
491 		dev_err(bus->dev, "Address of DRSM capability is NULL\n");
492 		return;
493 	}
494 
495 	mask |= (1 << index);
496 
497 	if (enable)
498 		snd_hdac_updatel(bus->drsmcap, AZX_REG_DRSM_CTL, mask, mask);
499 	else
500 		snd_hdac_updatel(bus->drsmcap, AZX_REG_DRSM_CTL, mask, 0);
501 }
502 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_drsm_enable);
503 
504 /**
505  * snd_hdac_ext_stream_set_dpibr - sets the dpibr value of a stream
506  * @bus: HD-audio core bus
507  * @hext_stream: hdac_ext_stream
508  * @value: dpib value to set
509  */
snd_hdac_ext_stream_set_dpibr(struct hdac_bus * bus,struct hdac_ext_stream * hext_stream,u32 value)510 int snd_hdac_ext_stream_set_dpibr(struct hdac_bus *bus,
511 				  struct hdac_ext_stream *hext_stream, u32 value)
512 {
513 
514 	if (!bus->drsmcap) {
515 		dev_err(bus->dev, "Address of DRSM capability is NULL\n");
516 		return -EINVAL;
517 	}
518 
519 	writel(value, hext_stream->dpibr_addr);
520 
521 	return 0;
522 }
523 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_set_dpibr);
524 
525 /**
526  * snd_hdac_ext_stream_set_lpib - sets the lpib value of a stream
527  * @hext_stream: hdac_ext_stream
528  * @value: lpib value to set
529  */
snd_hdac_ext_stream_set_lpib(struct hdac_ext_stream * hext_stream,u32 value)530 int snd_hdac_ext_stream_set_lpib(struct hdac_ext_stream *hext_stream, u32 value)
531 {
532 	snd_hdac_stream_writel(&hext_stream->hstream, SD_LPIB, value);
533 
534 	return 0;
535 }
536 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_set_lpib);
537