2 * hdac-ext-stream.c - HD-audio extended stream operations.
4 * Copyright (C) 2015 Intel Corp
5 * Author: Jeeja KP <jeeja.kp@intel.com>
6 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; version 2 of the License.
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
17 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
20 #include <linux/delay.h>
21 #include <linux/slab.h>
22 #include <sound/pcm.h>
23 #include <sound/hda_register.h>
24 #include <sound/hdaudio_ext.h>
27 * snd_hdac_ext_stream_init - initialize each stream (aka device)
28 * @ebus: HD-audio ext core bus
29 * @stream: HD-audio ext core stream object to initialize
30 * @idx: stream index number
31 * @direction: stream direction (SNDRV_PCM_STREAM_PLAYBACK or SNDRV_PCM_STREAM_CAPTURE)
32 * @tag: the tag id to assign
34 * initialize the stream, if ppcap is enabled then init those and then
35 * invoke hdac stream initialization routine
37 void snd_hdac_ext_stream_init(struct hdac_ext_bus *ebus,
38 struct hdac_ext_stream *stream,
39 int idx, int direction, int tag)
41 struct hdac_bus *bus = &ebus->bus;
44 stream->pphc_addr = bus->ppcap + AZX_PPHC_BASE +
45 AZX_PPHC_INTERVAL * idx;
47 stream->pplc_addr = bus->ppcap + AZX_PPLC_BASE +
48 AZX_PPLC_MULTI * ebus->num_streams +
49 AZX_PPLC_INTERVAL * idx;
53 stream->spib_addr = bus->spbcap + AZX_SPB_BASE +
54 AZX_SPB_INTERVAL * idx +
57 stream->fifo_addr = bus->spbcap + AZX_SPB_BASE +
58 AZX_SPB_INTERVAL * idx +
63 stream->dpibr_addr = bus->drsmcap + AZX_DRSM_BASE +
64 AZX_DRSM_INTERVAL * idx;
66 stream->decoupled = false;
67 snd_hdac_stream_init(bus, &stream->hstream, idx, direction, tag);
69 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_init);
72 * snd_hdac_ext_stream_init_all - create and initialize the stream objects
73 * for an extended hda bus
74 * @ebus: HD-audio ext core bus
75 * @start_idx: start index for streams
76 * @num_stream: number of streams to initialize
77 * @dir: direction of streams
79 int snd_hdac_ext_stream_init_all(struct hdac_ext_bus *ebus, int start_idx,
80 int num_stream, int dir)
83 int i, tag, idx = start_idx;
85 for (i = 0; i < num_stream; i++) {
86 struct hdac_ext_stream *stream =
87 kzalloc(sizeof(*stream), GFP_KERNEL);
91 snd_hdac_ext_stream_init(ebus, stream, idx, dir, tag);
98 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_init_all);
101 * snd_hdac_stream_free_all - free hdac extended stream objects
103 * @ebus: HD-audio ext core bus
105 void snd_hdac_stream_free_all(struct hdac_ext_bus *ebus)
107 struct hdac_stream *s, *_s;
108 struct hdac_ext_stream *stream;
109 struct hdac_bus *bus = ebus_to_hbus(ebus);
111 list_for_each_entry_safe(s, _s, &bus->stream_list, list) {
112 stream = stream_to_hdac_ext_stream(s);
113 snd_hdac_ext_stream_decouple(ebus, stream, false);
118 EXPORT_SYMBOL_GPL(snd_hdac_stream_free_all);
121 * snd_hdac_ext_stream_decouple - decouple the hdac stream
122 * @ebus: HD-audio ext core bus
123 * @stream: HD-audio ext core stream object to initialize
124 * @decouple: flag to decouple
126 void snd_hdac_ext_stream_decouple(struct hdac_ext_bus *ebus,
127 struct hdac_ext_stream *stream, bool decouple)
129 struct hdac_stream *hstream = &stream->hstream;
130 struct hdac_bus *bus = &ebus->bus;
132 int mask = AZX_PPCTL_PROCEN(hstream->index);
134 spin_lock_irq(&bus->reg_lock);
135 val = readw(bus->ppcap + AZX_REG_PP_PPCTL) & mask;
137 if (decouple && !val)
138 snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, mask, mask);
139 else if (!decouple && val)
140 snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, mask, 0);
142 stream->decoupled = decouple;
143 spin_unlock_irq(&bus->reg_lock);
145 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_decouple);
148 * snd_hdac_ext_linkstream_start - start a stream
149 * @stream: HD-audio ext core stream to start
151 void snd_hdac_ext_link_stream_start(struct hdac_ext_stream *stream)
153 snd_hdac_updatel(stream->pplc_addr, AZX_REG_PPLCCTL, 0, AZX_PPLCCTL_RUN);
155 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_stream_start);
158 * snd_hdac_ext_link_stream_clear - stop a stream DMA
159 * @stream: HD-audio ext core stream to stop
161 void snd_hdac_ext_link_stream_clear(struct hdac_ext_stream *stream)
163 snd_hdac_updatel(stream->pplc_addr, AZX_REG_PPLCCTL, AZX_PPLCCTL_RUN, 0);
165 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_stream_clear);
168 * snd_hdac_ext_link_stream_reset - reset a stream
169 * @stream: HD-audio ext core stream to reset
171 void snd_hdac_ext_link_stream_reset(struct hdac_ext_stream *stream)
176 snd_hdac_ext_link_stream_clear(stream);
178 snd_hdac_updatel(stream->pplc_addr, AZX_REG_PPLCCTL, 0, AZX_PPLCCTL_STRST);
182 val = readl(stream->pplc_addr + AZX_REG_PPLCCTL) &
188 val &= ~AZX_PPLCCTL_STRST;
189 writel(val, stream->pplc_addr + AZX_REG_PPLCCTL);
193 /* waiting for hardware to report that the stream is out of reset */
195 val = readl(stream->pplc_addr + AZX_REG_PPLCCTL) & AZX_PPLCCTL_STRST;
202 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_stream_reset);
205 * snd_hdac_ext_link_stream_setup - set up the SD for streaming
206 * @stream: HD-audio ext core stream to set up
207 * @fmt: stream format
209 int snd_hdac_ext_link_stream_setup(struct hdac_ext_stream *stream, int fmt)
211 struct hdac_stream *hstream = &stream->hstream;
214 /* make sure the run bit is zero for SD */
215 snd_hdac_ext_link_stream_clear(stream);
216 /* program the stream_tag */
217 val = readl(stream->pplc_addr + AZX_REG_PPLCCTL);
218 val = (val & ~AZX_PPLCCTL_STRM_MASK) |
219 (hstream->stream_tag << AZX_PPLCCTL_STRM_SHIFT);
220 writel(val, stream->pplc_addr + AZX_REG_PPLCCTL);
222 /* program the stream format */
223 writew(fmt, stream->pplc_addr + AZX_REG_PPLCFMT);
227 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_stream_setup);
230 * snd_hdac_ext_link_set_stream_id - maps stream id to link output
231 * @link: HD-audio ext link to set up
234 void snd_hdac_ext_link_set_stream_id(struct hdac_ext_link *link,
237 snd_hdac_updatew(link->ml_addr, AZX_REG_ML_LOSIDV, (1 << stream), 1 << stream);
239 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_set_stream_id);
242 * snd_hdac_ext_link_clear_stream_id - maps stream id to link output
243 * @link: HD-audio ext link to set up
246 void snd_hdac_ext_link_clear_stream_id(struct hdac_ext_link *link,
249 snd_hdac_updatew(link->ml_addr, AZX_REG_ML_LOSIDV, 0, (1 << stream));
251 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_clear_stream_id);
253 static struct hdac_ext_stream *
254 hdac_ext_link_stream_assign(struct hdac_ext_bus *ebus,
255 struct snd_pcm_substream *substream)
257 struct hdac_ext_stream *res = NULL;
258 struct hdac_stream *stream = NULL;
259 struct hdac_bus *hbus = &ebus->bus;
262 dev_err(hbus->dev, "stream type not supported\n");
266 list_for_each_entry(stream, &hbus->stream_list, list) {
267 struct hdac_ext_stream *hstream = container_of(stream,
268 struct hdac_ext_stream,
270 if (stream->direction != substream->stream)
273 /* check if decoupled stream and not in use is available */
274 if (hstream->decoupled && !hstream->link_locked) {
279 if (!hstream->link_locked) {
280 snd_hdac_ext_stream_decouple(ebus, hstream, true);
286 spin_lock_irq(&hbus->reg_lock);
287 res->link_locked = 1;
288 res->link_substream = substream;
289 spin_unlock_irq(&hbus->reg_lock);
294 static struct hdac_ext_stream *
295 hdac_ext_host_stream_assign(struct hdac_ext_bus *ebus,
296 struct snd_pcm_substream *substream)
298 struct hdac_ext_stream *res = NULL;
299 struct hdac_stream *stream = NULL;
300 struct hdac_bus *hbus = &ebus->bus;
303 dev_err(hbus->dev, "stream type not supported\n");
307 list_for_each_entry(stream, &hbus->stream_list, list) {
308 struct hdac_ext_stream *hstream = container_of(stream,
309 struct hdac_ext_stream,
311 if (stream->direction != substream->stream)
314 if (!stream->opened) {
315 if (!hstream->decoupled)
316 snd_hdac_ext_stream_decouple(ebus, hstream, true);
322 spin_lock_irq(&hbus->reg_lock);
323 res->hstream.opened = 1;
324 res->hstream.running = 0;
325 res->hstream.substream = substream;
326 spin_unlock_irq(&hbus->reg_lock);
333 * snd_hdac_ext_stream_assign - assign a stream for the PCM
334 * @ebus: HD-audio ext core bus
335 * @substream: PCM substream to assign
336 * @type: type of stream (coupled, host or link stream)
338 * This assigns the stream based on the type (coupled/host/link), for the
339 * given PCM substream, assigns it and returns the stream object
341 * coupled: Looks for an unused stream
342 * host: Looks for an unused decoupled host stream
343 * link: Looks for an unused decoupled link stream
345 * If no stream is free, returns NULL. The function tries to keep using
346 * the same stream object when it's used beforehand. when a stream is
347 * decoupled, it becomes a host stream and link stream.
349 struct hdac_ext_stream *snd_hdac_ext_stream_assign(struct hdac_ext_bus *ebus,
350 struct snd_pcm_substream *substream,
353 struct hdac_ext_stream *hstream = NULL;
354 struct hdac_stream *stream = NULL;
355 struct hdac_bus *hbus = &ebus->bus;
358 case HDAC_EXT_STREAM_TYPE_COUPLED:
359 stream = snd_hdac_stream_assign(hbus, substream);
361 hstream = container_of(stream,
362 struct hdac_ext_stream, hstream);
365 case HDAC_EXT_STREAM_TYPE_HOST:
366 return hdac_ext_host_stream_assign(ebus, substream);
368 case HDAC_EXT_STREAM_TYPE_LINK:
369 return hdac_ext_link_stream_assign(ebus, substream);
375 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_assign);
378 * snd_hdac_ext_stream_release - release the assigned stream
379 * @stream: HD-audio ext core stream to release
380 * @type: type of stream (coupled, host or link stream)
382 * Release the stream that has been assigned by snd_hdac_ext_stream_assign().
384 void snd_hdac_ext_stream_release(struct hdac_ext_stream *stream, int type)
386 struct hdac_bus *bus = stream->hstream.bus;
387 struct hdac_ext_bus *ebus = hbus_to_ebus(bus);
390 case HDAC_EXT_STREAM_TYPE_COUPLED:
391 snd_hdac_stream_release(&stream->hstream);
394 case HDAC_EXT_STREAM_TYPE_HOST:
395 if (stream->decoupled && !stream->link_locked)
396 snd_hdac_ext_stream_decouple(ebus, stream, false);
397 snd_hdac_stream_release(&stream->hstream);
400 case HDAC_EXT_STREAM_TYPE_LINK:
401 if (stream->decoupled && !stream->hstream.opened)
402 snd_hdac_ext_stream_decouple(ebus, stream, false);
403 spin_lock_irq(&bus->reg_lock);
404 stream->link_locked = 0;
405 stream->link_substream = NULL;
406 spin_unlock_irq(&bus->reg_lock);
410 dev_dbg(bus->dev, "Invalid type %d\n", type);
414 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_release);
417 * snd_hdac_ext_stream_spbcap_enable - enable SPIB for a stream
418 * @ebus: HD-audio ext core bus
419 * @enable: flag to enable/disable SPIB
420 * @index: stream index for which SPIB need to be enabled
422 void snd_hdac_ext_stream_spbcap_enable(struct hdac_ext_bus *ebus,
423 bool enable, int index)
426 u32 register_mask = 0;
427 struct hdac_bus *bus = &ebus->bus;
430 dev_err(bus->dev, "Address of SPB capability is NULL\n");
434 mask |= (1 << index);
436 register_mask = readl(bus->spbcap + AZX_REG_SPB_SPBFCCTL);
438 mask |= register_mask;
441 snd_hdac_updatel(bus->spbcap, AZX_REG_SPB_SPBFCCTL, 0, mask);
443 snd_hdac_updatel(bus->spbcap, AZX_REG_SPB_SPBFCCTL, mask, 0);
445 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_spbcap_enable);
448 * snd_hdac_ext_stream_set_spib - sets the spib value of a stream
449 * @ebus: HD-audio ext core bus
450 * @stream: hdac_ext_stream
451 * @value: spib value to set
453 int snd_hdac_ext_stream_set_spib(struct hdac_ext_bus *ebus,
454 struct hdac_ext_stream *stream, u32 value)
456 struct hdac_bus *bus = &ebus->bus;
459 dev_err(bus->dev, "Address of SPB capability is NULL\n");
463 writel(value, stream->spib_addr);
467 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_set_spib);
470 * snd_hdac_ext_stream_get_spbmaxfifo - gets the spib value of a stream
471 * @ebus: HD-audio ext core bus
472 * @stream: hdac_ext_stream
474 * Return maxfifo for the stream
476 int snd_hdac_ext_stream_get_spbmaxfifo(struct hdac_ext_bus *ebus,
477 struct hdac_ext_stream *stream)
479 struct hdac_bus *bus = &ebus->bus;
482 dev_err(bus->dev, "Address of SPB capability is NULL\n");
486 return readl(stream->fifo_addr);
488 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_get_spbmaxfifo);
492 * snd_hdac_ext_stop_streams - stop all stream if running
493 * @ebus: HD-audio ext core bus
495 void snd_hdac_ext_stop_streams(struct hdac_ext_bus *ebus)
497 struct hdac_bus *bus = ebus_to_hbus(ebus);
498 struct hdac_stream *stream;
500 if (bus->chip_init) {
501 list_for_each_entry(stream, &bus->stream_list, list)
502 snd_hdac_stream_stop(stream);
503 snd_hdac_bus_stop_chip(bus);
506 EXPORT_SYMBOL_GPL(snd_hdac_ext_stop_streams);
509 * snd_hdac_ext_stream_drsm_enable - enable DMA resume for a stream
510 * @ebus: HD-audio ext core bus
511 * @enable: flag to enable/disable DRSM
512 * @index: stream index for which DRSM need to be enabled
514 void snd_hdac_ext_stream_drsm_enable(struct hdac_ext_bus *ebus,
515 bool enable, int index)
518 u32 register_mask = 0;
519 struct hdac_bus *bus = &ebus->bus;
522 dev_err(bus->dev, "Address of DRSM capability is NULL\n");
526 mask |= (1 << index);
528 register_mask = readl(bus->drsmcap + AZX_REG_SPB_SPBFCCTL);
530 mask |= register_mask;
533 snd_hdac_updatel(bus->drsmcap, AZX_REG_DRSM_CTL, 0, mask);
535 snd_hdac_updatel(bus->drsmcap, AZX_REG_DRSM_CTL, mask, 0);
537 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_drsm_enable);
540 * snd_hdac_ext_stream_set_dpibr - sets the dpibr value of a stream
541 * @ebus: HD-audio ext core bus
542 * @stream: hdac_ext_stream
543 * @value: dpib value to set
545 int snd_hdac_ext_stream_set_dpibr(struct hdac_ext_bus *ebus,
546 struct hdac_ext_stream *stream, u32 value)
548 struct hdac_bus *bus = &ebus->bus;
551 dev_err(bus->dev, "Address of DRSM capability is NULL\n");
555 writel(value, stream->dpibr_addr);
559 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_set_dpibr);
562 * snd_hdac_ext_stream_set_lpib - sets the lpib value of a stream
563 * @ebus: HD-audio ext core bus
564 * @stream: hdac_ext_stream
565 * @value: lpib value to set
567 int snd_hdac_ext_stream_set_lpib(struct hdac_ext_stream *stream, u32 value)
569 snd_hdac_stream_writel(&stream->hstream, SD_LPIB, value);
573 EXPORT_SYMBOL_GPL(snd_hdac_ext_stream_set_lpib);