net: kalmia: fix memory leaks
[linux/fpc-iii.git] / sound / hda / hdac_controller.c
blob00c6af2ae1c295975336d7f35f299f26c9b943db
1 /*
2 * HD-audio controller helpers
3 */
5 #include <linux/kernel.h>
6 #include <linux/delay.h>
7 #include <linux/export.h>
8 #include <sound/core.h>
9 #include <sound/hdaudio.h>
10 #include <sound/hda_register.h>
12 /* clear CORB read pointer properly */
13 static void azx_clear_corbrp(struct hdac_bus *bus)
15 int timeout;
17 for (timeout = 1000; timeout > 0; timeout--) {
18 if (snd_hdac_chip_readw(bus, CORBRP) & AZX_CORBRP_RST)
19 break;
20 udelay(1);
22 if (timeout <= 0)
23 dev_err(bus->dev, "CORB reset timeout#1, CORBRP = %d\n",
24 snd_hdac_chip_readw(bus, CORBRP));
26 snd_hdac_chip_writew(bus, CORBRP, 0);
27 for (timeout = 1000; timeout > 0; timeout--) {
28 if (snd_hdac_chip_readw(bus, CORBRP) == 0)
29 break;
30 udelay(1);
32 if (timeout <= 0)
33 dev_err(bus->dev, "CORB reset timeout#2, CORBRP = %d\n",
34 snd_hdac_chip_readw(bus, CORBRP));
37 /**
38 * snd_hdac_bus_init_cmd_io - set up CORB/RIRB buffers
39 * @bus: HD-audio core bus
41 void snd_hdac_bus_init_cmd_io(struct hdac_bus *bus)
43 WARN_ON_ONCE(!bus->rb.area);
45 spin_lock_irq(&bus->reg_lock);
46 /* CORB set up */
47 bus->corb.addr = bus->rb.addr;
48 bus->corb.buf = (__le32 *)bus->rb.area;
49 snd_hdac_chip_writel(bus, CORBLBASE, (u32)bus->corb.addr);
50 snd_hdac_chip_writel(bus, CORBUBASE, upper_32_bits(bus->corb.addr));
52 /* set the corb size to 256 entries (ULI requires explicitly) */
53 snd_hdac_chip_writeb(bus, CORBSIZE, 0x02);
54 /* set the corb write pointer to 0 */
55 snd_hdac_chip_writew(bus, CORBWP, 0);
57 /* reset the corb hw read pointer */
58 snd_hdac_chip_writew(bus, CORBRP, AZX_CORBRP_RST);
59 if (!bus->corbrp_self_clear)
60 azx_clear_corbrp(bus);
62 /* enable corb dma */
63 snd_hdac_chip_writeb(bus, CORBCTL, AZX_CORBCTL_RUN);
65 /* RIRB set up */
66 bus->rirb.addr = bus->rb.addr + 2048;
67 bus->rirb.buf = (__le32 *)(bus->rb.area + 2048);
68 bus->rirb.wp = bus->rirb.rp = 0;
69 memset(bus->rirb.cmds, 0, sizeof(bus->rirb.cmds));
70 snd_hdac_chip_writel(bus, RIRBLBASE, (u32)bus->rirb.addr);
71 snd_hdac_chip_writel(bus, RIRBUBASE, upper_32_bits(bus->rirb.addr));
73 /* set the rirb size to 256 entries (ULI requires explicitly) */
74 snd_hdac_chip_writeb(bus, RIRBSIZE, 0x02);
75 /* reset the rirb hw write pointer */
76 snd_hdac_chip_writew(bus, RIRBWP, AZX_RIRBWP_RST);
77 /* set N=1, get RIRB response interrupt for new entry */
78 snd_hdac_chip_writew(bus, RINTCNT, 1);
79 /* enable rirb dma and response irq */
80 snd_hdac_chip_writeb(bus, RIRBCTL, AZX_RBCTL_DMA_EN | AZX_RBCTL_IRQ_EN);
81 spin_unlock_irq(&bus->reg_lock);
83 EXPORT_SYMBOL_GPL(snd_hdac_bus_init_cmd_io);
85 /* wait for cmd dmas till they are stopped */
86 static void hdac_wait_for_cmd_dmas(struct hdac_bus *bus)
88 unsigned long timeout;
90 timeout = jiffies + msecs_to_jiffies(100);
91 while ((snd_hdac_chip_readb(bus, RIRBCTL) & AZX_RBCTL_DMA_EN)
92 && time_before(jiffies, timeout))
93 udelay(10);
95 timeout = jiffies + msecs_to_jiffies(100);
96 while ((snd_hdac_chip_readb(bus, CORBCTL) & AZX_CORBCTL_RUN)
97 && time_before(jiffies, timeout))
98 udelay(10);
102 * snd_hdac_bus_stop_cmd_io - clean up CORB/RIRB buffers
103 * @bus: HD-audio core bus
105 void snd_hdac_bus_stop_cmd_io(struct hdac_bus *bus)
107 spin_lock_irq(&bus->reg_lock);
108 /* disable ringbuffer DMAs */
109 snd_hdac_chip_writeb(bus, RIRBCTL, 0);
110 snd_hdac_chip_writeb(bus, CORBCTL, 0);
111 spin_unlock_irq(&bus->reg_lock);
113 hdac_wait_for_cmd_dmas(bus);
115 spin_lock_irq(&bus->reg_lock);
116 /* disable unsolicited responses */
117 snd_hdac_chip_updatel(bus, GCTL, AZX_GCTL_UNSOL, 0);
118 spin_unlock_irq(&bus->reg_lock);
120 EXPORT_SYMBOL_GPL(snd_hdac_bus_stop_cmd_io);
122 static unsigned int azx_command_addr(u32 cmd)
124 unsigned int addr = cmd >> 28;
126 if (snd_BUG_ON(addr >= HDA_MAX_CODECS))
127 addr = 0;
128 return addr;
132 * snd_hdac_bus_send_cmd - send a command verb via CORB
133 * @bus: HD-audio core bus
134 * @val: encoded verb value to send
136 * Returns zero for success or a negative error code.
138 int snd_hdac_bus_send_cmd(struct hdac_bus *bus, unsigned int val)
140 unsigned int addr = azx_command_addr(val);
141 unsigned int wp, rp;
143 spin_lock_irq(&bus->reg_lock);
145 bus->last_cmd[azx_command_addr(val)] = val;
147 /* add command to corb */
148 wp = snd_hdac_chip_readw(bus, CORBWP);
149 if (wp == 0xffff) {
150 /* something wrong, controller likely turned to D3 */
151 spin_unlock_irq(&bus->reg_lock);
152 return -EIO;
154 wp++;
155 wp %= AZX_MAX_CORB_ENTRIES;
157 rp = snd_hdac_chip_readw(bus, CORBRP);
158 if (wp == rp) {
159 /* oops, it's full */
160 spin_unlock_irq(&bus->reg_lock);
161 return -EAGAIN;
164 bus->rirb.cmds[addr]++;
165 bus->corb.buf[wp] = cpu_to_le32(val);
166 snd_hdac_chip_writew(bus, CORBWP, wp);
168 spin_unlock_irq(&bus->reg_lock);
170 return 0;
172 EXPORT_SYMBOL_GPL(snd_hdac_bus_send_cmd);
174 #define AZX_RIRB_EX_UNSOL_EV (1<<4)
177 * snd_hdac_bus_update_rirb - retrieve RIRB entries
178 * @bus: HD-audio core bus
180 * Usually called from interrupt handler.
182 void snd_hdac_bus_update_rirb(struct hdac_bus *bus)
184 unsigned int rp, wp;
185 unsigned int addr;
186 u32 res, res_ex;
188 wp = snd_hdac_chip_readw(bus, RIRBWP);
189 if (wp == 0xffff) {
190 /* something wrong, controller likely turned to D3 */
191 return;
194 if (wp == bus->rirb.wp)
195 return;
196 bus->rirb.wp = wp;
198 while (bus->rirb.rp != wp) {
199 bus->rirb.rp++;
200 bus->rirb.rp %= AZX_MAX_RIRB_ENTRIES;
202 rp = bus->rirb.rp << 1; /* an RIRB entry is 8-bytes */
203 res_ex = le32_to_cpu(bus->rirb.buf[rp + 1]);
204 res = le32_to_cpu(bus->rirb.buf[rp]);
205 addr = res_ex & 0xf;
206 if (addr >= HDA_MAX_CODECS) {
207 dev_err(bus->dev,
208 "spurious response %#x:%#x, rp = %d, wp = %d",
209 res, res_ex, bus->rirb.rp, wp);
210 snd_BUG();
211 } else if (res_ex & AZX_RIRB_EX_UNSOL_EV)
212 snd_hdac_bus_queue_event(bus, res, res_ex);
213 else if (bus->rirb.cmds[addr]) {
214 bus->rirb.res[addr] = res;
215 bus->rirb.cmds[addr]--;
216 } else {
217 dev_err_ratelimited(bus->dev,
218 "spurious response %#x:%#x, last cmd=%#08x\n",
219 res, res_ex, bus->last_cmd[addr]);
223 EXPORT_SYMBOL_GPL(snd_hdac_bus_update_rirb);
226 * snd_hdac_bus_get_response - receive a response via RIRB
227 * @bus: HD-audio core bus
228 * @addr: codec address
229 * @res: pointer to store the value, NULL when not needed
231 * Returns zero if a value is read, or a negative error code.
233 int snd_hdac_bus_get_response(struct hdac_bus *bus, unsigned int addr,
234 unsigned int *res)
236 unsigned long timeout;
237 unsigned long loopcounter;
239 timeout = jiffies + msecs_to_jiffies(1000);
241 for (loopcounter = 0;; loopcounter++) {
242 spin_lock_irq(&bus->reg_lock);
243 if (!bus->rirb.cmds[addr]) {
244 if (res)
245 *res = bus->rirb.res[addr]; /* the last value */
246 spin_unlock_irq(&bus->reg_lock);
247 return 0;
249 spin_unlock_irq(&bus->reg_lock);
250 if (time_after(jiffies, timeout))
251 break;
252 if (loopcounter > 3000)
253 msleep(2); /* temporary workaround */
254 else {
255 udelay(10);
256 cond_resched();
260 return -EIO;
262 EXPORT_SYMBOL_GPL(snd_hdac_bus_get_response);
264 #define HDAC_MAX_CAPS 10
266 * snd_hdac_bus_parse_capabilities - parse capability structure
267 * @bus: the pointer to bus object
269 * Returns 0 if successful, or a negative error code.
271 int snd_hdac_bus_parse_capabilities(struct hdac_bus *bus)
273 unsigned int cur_cap;
274 unsigned int offset;
275 unsigned int counter = 0;
277 offset = snd_hdac_chip_readl(bus, LLCH);
279 /* Lets walk the linked capabilities list */
280 do {
281 cur_cap = _snd_hdac_chip_read(l, bus, offset);
283 dev_dbg(bus->dev, "Capability version: 0x%x\n",
284 (cur_cap & AZX_CAP_HDR_VER_MASK) >> AZX_CAP_HDR_VER_OFF);
286 dev_dbg(bus->dev, "HDA capability ID: 0x%x\n",
287 (cur_cap & AZX_CAP_HDR_ID_MASK) >> AZX_CAP_HDR_ID_OFF);
289 if (cur_cap == -1) {
290 dev_dbg(bus->dev, "Invalid capability reg read\n");
291 break;
294 switch ((cur_cap & AZX_CAP_HDR_ID_MASK) >> AZX_CAP_HDR_ID_OFF) {
295 case AZX_ML_CAP_ID:
296 dev_dbg(bus->dev, "Found ML capability\n");
297 bus->mlcap = bus->remap_addr + offset;
298 break;
300 case AZX_GTS_CAP_ID:
301 dev_dbg(bus->dev, "Found GTS capability offset=%x\n", offset);
302 bus->gtscap = bus->remap_addr + offset;
303 break;
305 case AZX_PP_CAP_ID:
306 /* PP capability found, the Audio DSP is present */
307 dev_dbg(bus->dev, "Found PP capability offset=%x\n", offset);
308 bus->ppcap = bus->remap_addr + offset;
309 break;
311 case AZX_SPB_CAP_ID:
312 /* SPIB capability found, handler function */
313 dev_dbg(bus->dev, "Found SPB capability\n");
314 bus->spbcap = bus->remap_addr + offset;
315 break;
317 case AZX_DRSM_CAP_ID:
318 /* DMA resume capability found, handler function */
319 dev_dbg(bus->dev, "Found DRSM capability\n");
320 bus->drsmcap = bus->remap_addr + offset;
321 break;
323 default:
324 dev_dbg(bus->dev, "Unknown capability %d\n", cur_cap);
325 break;
328 counter++;
330 if (counter > HDAC_MAX_CAPS) {
331 dev_err(bus->dev, "We exceeded HDAC capabilities!!!\n");
332 break;
335 /* read the offset of next capability */
336 offset = cur_cap & AZX_CAP_HDR_NXT_PTR_MASK;
338 } while (offset);
340 return 0;
342 EXPORT_SYMBOL_GPL(snd_hdac_bus_parse_capabilities);
345 * Lowlevel interface
349 * snd_hdac_bus_enter_link_reset - enter link reset
350 * @bus: HD-audio core bus
352 * Enter to the link reset state.
354 void snd_hdac_bus_enter_link_reset(struct hdac_bus *bus)
356 unsigned long timeout;
358 /* reset controller */
359 snd_hdac_chip_updatel(bus, GCTL, AZX_GCTL_RESET, 0);
361 timeout = jiffies + msecs_to_jiffies(100);
362 while ((snd_hdac_chip_readb(bus, GCTL) & AZX_GCTL_RESET) &&
363 time_before(jiffies, timeout))
364 usleep_range(500, 1000);
366 EXPORT_SYMBOL_GPL(snd_hdac_bus_enter_link_reset);
369 * snd_hdac_bus_exit_link_reset - exit link reset
370 * @bus: HD-audio core bus
372 * Exit from the link reset state.
374 void snd_hdac_bus_exit_link_reset(struct hdac_bus *bus)
376 unsigned long timeout;
378 snd_hdac_chip_updateb(bus, GCTL, 0, AZX_GCTL_RESET);
380 timeout = jiffies + msecs_to_jiffies(100);
381 while (!snd_hdac_chip_readb(bus, GCTL) && time_before(jiffies, timeout))
382 usleep_range(500, 1000);
384 EXPORT_SYMBOL_GPL(snd_hdac_bus_exit_link_reset);
386 /* reset codec link */
387 static int azx_reset(struct hdac_bus *bus, bool full_reset)
389 if (!full_reset)
390 goto skip_reset;
392 /* clear STATESTS */
393 snd_hdac_chip_writew(bus, STATESTS, STATESTS_INT_MASK);
395 /* reset controller */
396 snd_hdac_bus_enter_link_reset(bus);
398 /* delay for >= 100us for codec PLL to settle per spec
399 * Rev 0.9 section 5.5.1
401 usleep_range(500, 1000);
403 /* Bring controller out of reset */
404 snd_hdac_bus_exit_link_reset(bus);
406 /* Brent Chartrand said to wait >= 540us for codecs to initialize */
407 usleep_range(1000, 1200);
409 skip_reset:
410 /* check to see if controller is ready */
411 if (!snd_hdac_chip_readb(bus, GCTL)) {
412 dev_dbg(bus->dev, "azx_reset: controller not ready!\n");
413 return -EBUSY;
416 /* Accept unsolicited responses */
417 snd_hdac_chip_updatel(bus, GCTL, 0, AZX_GCTL_UNSOL);
419 /* detect codecs */
420 if (!bus->codec_mask) {
421 bus->codec_mask = snd_hdac_chip_readw(bus, STATESTS);
422 dev_dbg(bus->dev, "codec_mask = 0x%lx\n", bus->codec_mask);
425 return 0;
428 /* enable interrupts */
429 static void azx_int_enable(struct hdac_bus *bus)
431 /* enable controller CIE and GIE */
432 snd_hdac_chip_updatel(bus, INTCTL, 0, AZX_INT_CTRL_EN | AZX_INT_GLOBAL_EN);
435 /* disable interrupts */
436 static void azx_int_disable(struct hdac_bus *bus)
438 struct hdac_stream *azx_dev;
440 /* disable interrupts in stream descriptor */
441 list_for_each_entry(azx_dev, &bus->stream_list, list)
442 snd_hdac_stream_updateb(azx_dev, SD_CTL, SD_INT_MASK, 0);
444 /* disable SIE for all streams */
445 snd_hdac_chip_writeb(bus, INTCTL, 0);
447 /* disable controller CIE and GIE */
448 snd_hdac_chip_updatel(bus, INTCTL, AZX_INT_CTRL_EN | AZX_INT_GLOBAL_EN, 0);
451 /* clear interrupts */
452 static void azx_int_clear(struct hdac_bus *bus)
454 struct hdac_stream *azx_dev;
456 /* clear stream status */
457 list_for_each_entry(azx_dev, &bus->stream_list, list)
458 snd_hdac_stream_writeb(azx_dev, SD_STS, SD_INT_MASK);
460 /* clear STATESTS */
461 snd_hdac_chip_writew(bus, STATESTS, STATESTS_INT_MASK);
463 /* clear rirb status */
464 snd_hdac_chip_writeb(bus, RIRBSTS, RIRB_INT_MASK);
466 /* clear int status */
467 snd_hdac_chip_writel(bus, INTSTS, AZX_INT_CTRL_EN | AZX_INT_ALL_STREAM);
471 * snd_hdac_bus_init_chip - reset and start the controller registers
472 * @bus: HD-audio core bus
473 * @full_reset: Do full reset
475 bool snd_hdac_bus_init_chip(struct hdac_bus *bus, bool full_reset)
477 if (bus->chip_init)
478 return false;
480 /* reset controller */
481 azx_reset(bus, full_reset);
483 /* clear interrupts */
484 azx_int_clear(bus);
486 /* initialize the codec command I/O */
487 snd_hdac_bus_init_cmd_io(bus);
489 /* enable interrupts after CORB/RIRB buffers are initialized above */
490 azx_int_enable(bus);
492 /* program the position buffer */
493 if (bus->use_posbuf && bus->posbuf.addr) {
494 snd_hdac_chip_writel(bus, DPLBASE, (u32)bus->posbuf.addr);
495 snd_hdac_chip_writel(bus, DPUBASE, upper_32_bits(bus->posbuf.addr));
498 bus->chip_init = true;
499 return true;
501 EXPORT_SYMBOL_GPL(snd_hdac_bus_init_chip);
504 * snd_hdac_bus_stop_chip - disable the whole IRQ and I/Os
505 * @bus: HD-audio core bus
507 void snd_hdac_bus_stop_chip(struct hdac_bus *bus)
509 if (!bus->chip_init)
510 return;
512 /* disable interrupts */
513 azx_int_disable(bus);
514 azx_int_clear(bus);
516 /* disable CORB/RIRB */
517 snd_hdac_bus_stop_cmd_io(bus);
519 /* disable position buffer */
520 if (bus->posbuf.addr) {
521 snd_hdac_chip_writel(bus, DPLBASE, 0);
522 snd_hdac_chip_writel(bus, DPUBASE, 0);
525 bus->chip_init = false;
527 EXPORT_SYMBOL_GPL(snd_hdac_bus_stop_chip);
530 * snd_hdac_bus_handle_stream_irq - interrupt handler for streams
531 * @bus: HD-audio core bus
532 * @status: INTSTS register value
533 * @ask: callback to be called for woken streams
535 * Returns the bits of handled streams, or zero if no stream is handled.
537 int snd_hdac_bus_handle_stream_irq(struct hdac_bus *bus, unsigned int status,
538 void (*ack)(struct hdac_bus *,
539 struct hdac_stream *))
541 struct hdac_stream *azx_dev;
542 u8 sd_status;
543 int handled = 0;
545 list_for_each_entry(azx_dev, &bus->stream_list, list) {
546 if (status & azx_dev->sd_int_sta_mask) {
547 sd_status = snd_hdac_stream_readb(azx_dev, SD_STS);
548 snd_hdac_stream_writeb(azx_dev, SD_STS, SD_INT_MASK);
549 handled |= 1 << azx_dev->index;
550 if (!azx_dev->substream || !azx_dev->running ||
551 !(sd_status & SD_INT_COMPLETE))
552 continue;
553 if (ack)
554 ack(bus, azx_dev);
557 return handled;
559 EXPORT_SYMBOL_GPL(snd_hdac_bus_handle_stream_irq);
562 * snd_hdac_bus_alloc_stream_pages - allocate BDL and other buffers
563 * @bus: HD-audio core bus
565 * Call this after assigning the all streams.
566 * Returns zero for success, or a negative error code.
568 int snd_hdac_bus_alloc_stream_pages(struct hdac_bus *bus)
570 struct hdac_stream *s;
571 int num_streams = 0;
572 int err;
574 list_for_each_entry(s, &bus->stream_list, list) {
575 /* allocate memory for the BDL for each stream */
576 err = bus->io_ops->dma_alloc_pages(bus, SNDRV_DMA_TYPE_DEV,
577 BDL_SIZE, &s->bdl);
578 num_streams++;
579 if (err < 0)
580 return -ENOMEM;
583 if (WARN_ON(!num_streams))
584 return -EINVAL;
585 /* allocate memory for the position buffer */
586 err = bus->io_ops->dma_alloc_pages(bus, SNDRV_DMA_TYPE_DEV,
587 num_streams * 8, &bus->posbuf);
588 if (err < 0)
589 return -ENOMEM;
590 list_for_each_entry(s, &bus->stream_list, list)
591 s->posbuf = (__le32 *)(bus->posbuf.area + s->index * 8);
593 /* single page (at least 4096 bytes) must suffice for both ringbuffes */
594 return bus->io_ops->dma_alloc_pages(bus, SNDRV_DMA_TYPE_DEV,
595 PAGE_SIZE, &bus->rb);
597 EXPORT_SYMBOL_GPL(snd_hdac_bus_alloc_stream_pages);
600 * snd_hdac_bus_free_stream_pages - release BDL and other buffers
601 * @bus: HD-audio core bus
603 void snd_hdac_bus_free_stream_pages(struct hdac_bus *bus)
605 struct hdac_stream *s;
607 list_for_each_entry(s, &bus->stream_list, list) {
608 if (s->bdl.area)
609 bus->io_ops->dma_free_pages(bus, &s->bdl);
612 if (bus->rb.area)
613 bus->io_ops->dma_free_pages(bus, &bus->rb);
614 if (bus->posbuf.area)
615 bus->io_ops->dma_free_pages(bus, &bus->posbuf);
617 EXPORT_SYMBOL_GPL(snd_hdac_bus_free_stream_pages);