114752412STakashi Iwai /* 214752412STakashi Iwai * HD-audio stream operations 314752412STakashi Iwai */ 414752412STakashi Iwai 514752412STakashi Iwai #include <linux/kernel.h> 614752412STakashi Iwai #include <linux/delay.h> 714752412STakashi Iwai #include <linux/export.h> 85f26faceSTakashi Iwai #include <linux/clocksource.h> 914752412STakashi Iwai #include <sound/core.h> 1014752412STakashi Iwai #include <sound/pcm.h> 1114752412STakashi Iwai #include <sound/hdaudio.h> 1214752412STakashi Iwai #include <sound/hda_register.h> 1314752412STakashi Iwai 1414752412STakashi Iwai /** 1514752412STakashi Iwai * snd_hdac_stream_init - initialize each stream (aka device) 1614752412STakashi Iwai * @bus: HD-audio core bus 1714752412STakashi Iwai * @azx_dev: HD-audio core stream object to initialize 1814752412STakashi Iwai * @idx: stream index number 1914752412STakashi Iwai * @direction: stream direction (SNDRV_PCM_STREAM_PLAYBACK or SNDRV_PCM_STREAM_CAPTURE) 2014752412STakashi Iwai * @tag: the tag id to assign 2114752412STakashi Iwai * 2214752412STakashi Iwai * Assign the starting bdl address to each stream (device) and initialize. 2314752412STakashi Iwai */ 2414752412STakashi Iwai void snd_hdac_stream_init(struct hdac_bus *bus, struct hdac_stream *azx_dev, 2514752412STakashi Iwai int idx, int direction, int tag) 2614752412STakashi Iwai { 2714752412STakashi Iwai azx_dev->bus = bus; 2814752412STakashi Iwai /* offset: SDI0=0x80, SDI1=0xa0, ... SDO3=0x160 */ 2914752412STakashi Iwai azx_dev->sd_addr = bus->remap_addr + (0x20 * idx + 0x80); 3014752412STakashi Iwai /* int mask: SDI0=0x01, SDI1=0x02, ... SDO3=0x80 */ 3114752412STakashi Iwai azx_dev->sd_int_sta_mask = 1 << idx; 3214752412STakashi Iwai azx_dev->index = idx; 3314752412STakashi Iwai azx_dev->direction = direction; 3414752412STakashi Iwai azx_dev->stream_tag = tag; 358f3f600bSTakashi Iwai snd_hdac_dsp_lock_init(azx_dev); 3614752412STakashi Iwai list_add_tail(&azx_dev->list, &bus->stream_list); 3714752412STakashi Iwai } 3814752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_init); 3914752412STakashi Iwai 4014752412STakashi Iwai /** 4114752412STakashi Iwai * snd_hdac_stream_start - start a stream 4214752412STakashi Iwai * @azx_dev: HD-audio core stream to start 4314752412STakashi Iwai * @fresh_start: false = wallclock timestamp relative to period wallclock 4414752412STakashi Iwai * 4514752412STakashi Iwai * Start a stream, set start_wallclk and set the running flag. 4614752412STakashi Iwai */ 4714752412STakashi Iwai void snd_hdac_stream_start(struct hdac_stream *azx_dev, bool fresh_start) 4814752412STakashi Iwai { 4914752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 5014752412STakashi Iwai 5114752412STakashi Iwai azx_dev->start_wallclk = snd_hdac_chip_readl(bus, WALLCLK); 5214752412STakashi Iwai if (!fresh_start) 5314752412STakashi Iwai azx_dev->start_wallclk -= azx_dev->period_wallclk; 5414752412STakashi Iwai 5514752412STakashi Iwai /* enable SIE */ 5614752412STakashi Iwai snd_hdac_chip_updatel(bus, INTCTL, 0, 1 << azx_dev->index); 5714752412STakashi Iwai /* set DMA start and interrupt mask */ 5814752412STakashi Iwai snd_hdac_stream_updateb(azx_dev, SD_CTL, 5914752412STakashi Iwai 0, SD_CTL_DMA_START | SD_INT_MASK); 6014752412STakashi Iwai azx_dev->running = true; 6114752412STakashi Iwai } 6214752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_start); 6314752412STakashi Iwai 6414752412STakashi Iwai /** 6514752412STakashi Iwai * snd_hdac_stream_clear - stop a stream DMA 6614752412STakashi Iwai * @azx_dev: HD-audio core stream to stop 6714752412STakashi Iwai */ 6814752412STakashi Iwai void snd_hdac_stream_clear(struct hdac_stream *azx_dev) 6914752412STakashi Iwai { 7014752412STakashi Iwai snd_hdac_stream_updateb(azx_dev, SD_CTL, 7114752412STakashi Iwai SD_CTL_DMA_START | SD_INT_MASK, 0); 7214752412STakashi Iwai snd_hdac_stream_writeb(azx_dev, SD_STS, SD_INT_MASK); /* to be sure */ 7314752412STakashi Iwai azx_dev->running = false; 7414752412STakashi Iwai } 7514752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_clear); 7614752412STakashi Iwai 7714752412STakashi Iwai /** 7814752412STakashi Iwai * snd_hdac_stream_stop - stop a stream 7914752412STakashi Iwai * @azx_dev: HD-audio core stream to stop 8014752412STakashi Iwai * 8114752412STakashi Iwai * Stop a stream DMA and disable stream interrupt 8214752412STakashi Iwai */ 8314752412STakashi Iwai void snd_hdac_stream_stop(struct hdac_stream *azx_dev) 8414752412STakashi Iwai { 8514752412STakashi Iwai snd_hdac_stream_clear(azx_dev); 8614752412STakashi Iwai /* disable SIE */ 8714752412STakashi Iwai snd_hdac_chip_updatel(azx_dev->bus, INTCTL, 1 << azx_dev->index, 0); 8814752412STakashi Iwai } 8914752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_stop); 9014752412STakashi Iwai 9114752412STakashi Iwai /** 9214752412STakashi Iwai * snd_hdac_stream_reset - reset a stream 9314752412STakashi Iwai * @azx_dev: HD-audio core stream to reset 9414752412STakashi Iwai */ 9514752412STakashi Iwai void snd_hdac_stream_reset(struct hdac_stream *azx_dev) 9614752412STakashi Iwai { 9714752412STakashi Iwai unsigned char val; 9814752412STakashi Iwai int timeout; 9914752412STakashi Iwai 10014752412STakashi Iwai snd_hdac_stream_clear(azx_dev); 10114752412STakashi Iwai 10214752412STakashi Iwai snd_hdac_stream_updateb(azx_dev, SD_CTL, 0, SD_CTL_STREAM_RESET); 10314752412STakashi Iwai udelay(3); 10414752412STakashi Iwai timeout = 300; 10514752412STakashi Iwai do { 10614752412STakashi Iwai val = snd_hdac_stream_readb(azx_dev, SD_CTL) & 10714752412STakashi Iwai SD_CTL_STREAM_RESET; 10814752412STakashi Iwai if (val) 10914752412STakashi Iwai break; 11014752412STakashi Iwai } while (--timeout); 11114752412STakashi Iwai val &= ~SD_CTL_STREAM_RESET; 11214752412STakashi Iwai snd_hdac_stream_writeb(azx_dev, SD_CTL, val); 11314752412STakashi Iwai udelay(3); 11414752412STakashi Iwai 11514752412STakashi Iwai timeout = 300; 11614752412STakashi Iwai /* waiting for hardware to report that the stream is out of reset */ 11714752412STakashi Iwai do { 11814752412STakashi Iwai val = snd_hdac_stream_readb(azx_dev, SD_CTL) & 11914752412STakashi Iwai SD_CTL_STREAM_RESET; 12014752412STakashi Iwai if (!val) 12114752412STakashi Iwai break; 12214752412STakashi Iwai } while (--timeout); 12314752412STakashi Iwai 12414752412STakashi Iwai /* reset first position - may not be synced with hw at this time */ 12514752412STakashi Iwai if (azx_dev->posbuf) 12614752412STakashi Iwai *azx_dev->posbuf = 0; 12714752412STakashi Iwai } 12814752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_reset); 12914752412STakashi Iwai 13014752412STakashi Iwai /** 13114752412STakashi Iwai * snd_hdac_stream_setup - set up the SD for streaming 13214752412STakashi Iwai * @azx_dev: HD-audio core stream to set up 13314752412STakashi Iwai */ 13414752412STakashi Iwai int snd_hdac_stream_setup(struct hdac_stream *azx_dev) 13514752412STakashi Iwai { 13614752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 13714752412STakashi Iwai struct snd_pcm_runtime *runtime = azx_dev->substream->runtime; 13814752412STakashi Iwai unsigned int val; 13914752412STakashi Iwai 14014752412STakashi Iwai /* make sure the run bit is zero for SD */ 14114752412STakashi Iwai snd_hdac_stream_clear(azx_dev); 14214752412STakashi Iwai /* program the stream_tag */ 14314752412STakashi Iwai val = snd_hdac_stream_readl(azx_dev, SD_CTL); 14414752412STakashi Iwai val = (val & ~SD_CTL_STREAM_TAG_MASK) | 14514752412STakashi Iwai (azx_dev->stream_tag << SD_CTL_STREAM_TAG_SHIFT); 14614752412STakashi Iwai if (!bus->snoop) 14714752412STakashi Iwai val |= SD_CTL_TRAFFIC_PRIO; 14814752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_CTL, val); 14914752412STakashi Iwai 15014752412STakashi Iwai /* program the length of samples in cyclic buffer */ 15114752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_CBL, azx_dev->bufsize); 15214752412STakashi Iwai 15314752412STakashi Iwai /* program the stream format */ 15414752412STakashi Iwai /* this value needs to be the same as the one programmed */ 15514752412STakashi Iwai snd_hdac_stream_writew(azx_dev, SD_FORMAT, azx_dev->format_val); 15614752412STakashi Iwai 15714752412STakashi Iwai /* program the stream LVI (last valid index) of the BDL */ 15814752412STakashi Iwai snd_hdac_stream_writew(azx_dev, SD_LVI, azx_dev->frags - 1); 15914752412STakashi Iwai 16014752412STakashi Iwai /* program the BDL address */ 16114752412STakashi Iwai /* lower BDL address */ 16214752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, (u32)azx_dev->bdl.addr); 16314752412STakashi Iwai /* upper BDL address */ 16414752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 16514752412STakashi Iwai upper_32_bits(azx_dev->bdl.addr)); 16614752412STakashi Iwai 16714752412STakashi Iwai /* enable the position buffer */ 16814752412STakashi Iwai if (bus->use_posbuf && bus->posbuf.addr) { 16914752412STakashi Iwai if (!(snd_hdac_chip_readl(bus, DPLBASE) & AZX_DPLBASE_ENABLE)) 17014752412STakashi Iwai snd_hdac_chip_writel(bus, DPLBASE, 17114752412STakashi Iwai (u32)bus->posbuf.addr | AZX_DPLBASE_ENABLE); 17214752412STakashi Iwai } 17314752412STakashi Iwai 17414752412STakashi Iwai /* set the interrupt enable bits in the descriptor control register */ 17514752412STakashi Iwai snd_hdac_stream_updatel(azx_dev, SD_CTL, 0, SD_INT_MASK); 17614752412STakashi Iwai 17714752412STakashi Iwai if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) 17814752412STakashi Iwai azx_dev->fifo_size = 17914752412STakashi Iwai snd_hdac_stream_readw(azx_dev, SD_FIFOSIZE) + 1; 18014752412STakashi Iwai else 18114752412STakashi Iwai azx_dev->fifo_size = 0; 18214752412STakashi Iwai 18314752412STakashi Iwai /* when LPIB delay correction gives a small negative value, 18414752412STakashi Iwai * we ignore it; currently set the threshold statically to 18514752412STakashi Iwai * 64 frames 18614752412STakashi Iwai */ 18714752412STakashi Iwai if (runtime->period_size > 64) 18814752412STakashi Iwai azx_dev->delay_negative_threshold = 18914752412STakashi Iwai -frames_to_bytes(runtime, 64); 19014752412STakashi Iwai else 19114752412STakashi Iwai azx_dev->delay_negative_threshold = 0; 19214752412STakashi Iwai 19314752412STakashi Iwai /* wallclk has 24Mhz clock source */ 19414752412STakashi Iwai azx_dev->period_wallclk = (((runtime->period_size * 24000) / 19514752412STakashi Iwai runtime->rate) * 1000); 19614752412STakashi Iwai 19714752412STakashi Iwai return 0; 19814752412STakashi Iwai } 19914752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_setup); 20014752412STakashi Iwai 20114752412STakashi Iwai /** 20214752412STakashi Iwai * snd_hdac_stream_cleanup - cleanup a stream 20314752412STakashi Iwai * @azx_dev: HD-audio core stream to clean up 20414752412STakashi Iwai */ 20514752412STakashi Iwai void snd_hdac_stream_cleanup(struct hdac_stream *azx_dev) 20614752412STakashi Iwai { 20714752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, 0); 20814752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 0); 20914752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_CTL, 0); 21014752412STakashi Iwai azx_dev->bufsize = 0; 21114752412STakashi Iwai azx_dev->period_bytes = 0; 21214752412STakashi Iwai azx_dev->format_val = 0; 21314752412STakashi Iwai } 21414752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_cleanup); 21514752412STakashi Iwai 21614752412STakashi Iwai /** 21714752412STakashi Iwai * snd_hdac_stream_assign - assign a stream for the PCM 21814752412STakashi Iwai * @bus: HD-audio core bus 21914752412STakashi Iwai * @substream: PCM substream to assign 22014752412STakashi Iwai * 22114752412STakashi Iwai * Look for an unused stream for the given PCM substream, assign it 22214752412STakashi Iwai * and return the stream object. If no stream is free, returns NULL. 22314752412STakashi Iwai * The function tries to keep using the same stream object when it's used 22414752412STakashi Iwai * beforehand. Also, when bus->reverse_assign flag is set, the last free 22514752412STakashi Iwai * or matching entry is returned. This is needed for some strange codecs. 22614752412STakashi Iwai */ 22714752412STakashi Iwai struct hdac_stream *snd_hdac_stream_assign(struct hdac_bus *bus, 22814752412STakashi Iwai struct snd_pcm_substream *substream) 22914752412STakashi Iwai { 23014752412STakashi Iwai struct hdac_stream *azx_dev; 23114752412STakashi Iwai struct hdac_stream *res = NULL; 23214752412STakashi Iwai 23314752412STakashi Iwai /* make a non-zero unique key for the substream */ 23414752412STakashi Iwai int key = (substream->pcm->device << 16) | (substream->number << 2) | 23514752412STakashi Iwai (substream->stream + 1); 23614752412STakashi Iwai 23714752412STakashi Iwai list_for_each_entry(azx_dev, &bus->stream_list, list) { 23814752412STakashi Iwai if (azx_dev->direction != substream->stream) 23914752412STakashi Iwai continue; 24014752412STakashi Iwai if (azx_dev->opened) 24114752412STakashi Iwai continue; 24214752412STakashi Iwai if (azx_dev->assigned_key == key) { 24314752412STakashi Iwai res = azx_dev; 24414752412STakashi Iwai break; 24514752412STakashi Iwai } 24614752412STakashi Iwai if (!res || bus->reverse_assign) 24714752412STakashi Iwai res = azx_dev; 24814752412STakashi Iwai } 24914752412STakashi Iwai if (res) { 25014752412STakashi Iwai spin_lock_irq(&bus->reg_lock); 25114752412STakashi Iwai res->opened = 1; 25214752412STakashi Iwai res->running = 0; 25314752412STakashi Iwai res->assigned_key = key; 25414752412STakashi Iwai res->substream = substream; 25514752412STakashi Iwai spin_unlock_irq(&bus->reg_lock); 25614752412STakashi Iwai } 25714752412STakashi Iwai return res; 25814752412STakashi Iwai } 25914752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_assign); 26014752412STakashi Iwai 26114752412STakashi Iwai /** 26214752412STakashi Iwai * snd_hdac_stream_release - release the assigned stream 26314752412STakashi Iwai * @azx_dev: HD-audio core stream to release 26414752412STakashi Iwai * 26514752412STakashi Iwai * Release the stream that has been assigned by snd_hdac_stream_assign(). 26614752412STakashi Iwai */ 26714752412STakashi Iwai void snd_hdac_stream_release(struct hdac_stream *azx_dev) 26814752412STakashi Iwai { 26914752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 27014752412STakashi Iwai 27114752412STakashi Iwai spin_lock_irq(&bus->reg_lock); 27214752412STakashi Iwai azx_dev->opened = 0; 27314752412STakashi Iwai azx_dev->running = 0; 27414752412STakashi Iwai azx_dev->substream = NULL; 27514752412STakashi Iwai spin_unlock_irq(&bus->reg_lock); 27614752412STakashi Iwai } 27714752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_release); 27814752412STakashi Iwai 27914752412STakashi Iwai /* 28014752412STakashi Iwai * set up a BDL entry 28114752412STakashi Iwai */ 28214752412STakashi Iwai static int setup_bdle(struct hdac_bus *bus, 28314752412STakashi Iwai struct snd_dma_buffer *dmab, 28414752412STakashi Iwai struct hdac_stream *azx_dev, __le32 **bdlp, 28514752412STakashi Iwai int ofs, int size, int with_ioc) 28614752412STakashi Iwai { 28714752412STakashi Iwai __le32 *bdl = *bdlp; 28814752412STakashi Iwai 28914752412STakashi Iwai while (size > 0) { 29014752412STakashi Iwai dma_addr_t addr; 29114752412STakashi Iwai int chunk; 29214752412STakashi Iwai 29314752412STakashi Iwai if (azx_dev->frags >= AZX_MAX_BDL_ENTRIES) 29414752412STakashi Iwai return -EINVAL; 29514752412STakashi Iwai 29614752412STakashi Iwai addr = snd_sgbuf_get_addr(dmab, ofs); 29714752412STakashi Iwai /* program the address field of the BDL entry */ 29814752412STakashi Iwai bdl[0] = cpu_to_le32((u32)addr); 29914752412STakashi Iwai bdl[1] = cpu_to_le32(upper_32_bits(addr)); 30014752412STakashi Iwai /* program the size field of the BDL entry */ 30114752412STakashi Iwai chunk = snd_sgbuf_get_chunk_size(dmab, ofs, size); 30214752412STakashi Iwai /* one BDLE cannot cross 4K boundary on CTHDA chips */ 30314752412STakashi Iwai if (bus->align_bdle_4k) { 30414752412STakashi Iwai u32 remain = 0x1000 - (ofs & 0xfff); 30514752412STakashi Iwai 30614752412STakashi Iwai if (chunk > remain) 30714752412STakashi Iwai chunk = remain; 30814752412STakashi Iwai } 30914752412STakashi Iwai bdl[2] = cpu_to_le32(chunk); 31014752412STakashi Iwai /* program the IOC to enable interrupt 31114752412STakashi Iwai * only when the whole fragment is processed 31214752412STakashi Iwai */ 31314752412STakashi Iwai size -= chunk; 31414752412STakashi Iwai bdl[3] = (size || !with_ioc) ? 0 : cpu_to_le32(0x01); 31514752412STakashi Iwai bdl += 4; 31614752412STakashi Iwai azx_dev->frags++; 31714752412STakashi Iwai ofs += chunk; 31814752412STakashi Iwai } 31914752412STakashi Iwai *bdlp = bdl; 32014752412STakashi Iwai return ofs; 32114752412STakashi Iwai } 32214752412STakashi Iwai 32314752412STakashi Iwai /** 32414752412STakashi Iwai * snd_hdac_stream_setup_periods - set up BDL entries 32514752412STakashi Iwai * @azx_dev: HD-audio core stream to set up 32614752412STakashi Iwai * 32714752412STakashi Iwai * Set up the buffer descriptor table of the given stream based on the 32814752412STakashi Iwai * period and buffer sizes of the assigned PCM substream. 32914752412STakashi Iwai */ 33014752412STakashi Iwai int snd_hdac_stream_setup_periods(struct hdac_stream *azx_dev) 33114752412STakashi Iwai { 33214752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 33314752412STakashi Iwai struct snd_pcm_substream *substream = azx_dev->substream; 33414752412STakashi Iwai struct snd_pcm_runtime *runtime = substream->runtime; 33514752412STakashi Iwai __le32 *bdl; 33614752412STakashi Iwai int i, ofs, periods, period_bytes; 33714752412STakashi Iwai int pos_adj, pos_align; 33814752412STakashi Iwai 33914752412STakashi Iwai /* reset BDL address */ 34014752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, 0); 34114752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 0); 34214752412STakashi Iwai 34314752412STakashi Iwai period_bytes = azx_dev->period_bytes; 34414752412STakashi Iwai periods = azx_dev->bufsize / period_bytes; 34514752412STakashi Iwai 34614752412STakashi Iwai /* program the initial BDL entries */ 34714752412STakashi Iwai bdl = (__le32 *)azx_dev->bdl.area; 34814752412STakashi Iwai ofs = 0; 34914752412STakashi Iwai azx_dev->frags = 0; 35014752412STakashi Iwai 35114752412STakashi Iwai pos_adj = bus->bdl_pos_adj; 35214752412STakashi Iwai if (!azx_dev->no_period_wakeup && pos_adj > 0) { 35314752412STakashi Iwai pos_align = pos_adj; 35414752412STakashi Iwai pos_adj = (pos_adj * runtime->rate + 47999) / 48000; 35514752412STakashi Iwai if (!pos_adj) 35614752412STakashi Iwai pos_adj = pos_align; 35714752412STakashi Iwai else 35814752412STakashi Iwai pos_adj = ((pos_adj + pos_align - 1) / pos_align) * 35914752412STakashi Iwai pos_align; 36014752412STakashi Iwai pos_adj = frames_to_bytes(runtime, pos_adj); 36114752412STakashi Iwai if (pos_adj >= period_bytes) { 36214752412STakashi Iwai dev_warn(bus->dev, "Too big adjustment %d\n", 36314752412STakashi Iwai pos_adj); 36414752412STakashi Iwai pos_adj = 0; 36514752412STakashi Iwai } else { 36614752412STakashi Iwai ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), 36714752412STakashi Iwai azx_dev, 36814752412STakashi Iwai &bdl, ofs, pos_adj, true); 36914752412STakashi Iwai if (ofs < 0) 37014752412STakashi Iwai goto error; 37114752412STakashi Iwai } 37214752412STakashi Iwai } else 37314752412STakashi Iwai pos_adj = 0; 37414752412STakashi Iwai 37514752412STakashi Iwai for (i = 0; i < periods; i++) { 37614752412STakashi Iwai if (i == periods - 1 && pos_adj) 37714752412STakashi Iwai ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), 37814752412STakashi Iwai azx_dev, &bdl, ofs, 37914752412STakashi Iwai period_bytes - pos_adj, 0); 38014752412STakashi Iwai else 38114752412STakashi Iwai ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), 38214752412STakashi Iwai azx_dev, &bdl, ofs, 38314752412STakashi Iwai period_bytes, 38414752412STakashi Iwai !azx_dev->no_period_wakeup); 38514752412STakashi Iwai if (ofs < 0) 38614752412STakashi Iwai goto error; 38714752412STakashi Iwai } 38814752412STakashi Iwai return 0; 38914752412STakashi Iwai 39014752412STakashi Iwai error: 39114752412STakashi Iwai dev_err(bus->dev, "Too many BDL entries: buffer=%d, period=%d\n", 39214752412STakashi Iwai azx_dev->bufsize, period_bytes); 39314752412STakashi Iwai return -EINVAL; 39414752412STakashi Iwai } 39514752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_setup_periods); 39614752412STakashi Iwai 397*86f6501bSJeeja KP /* snd_hdac_stream_set_params - set stream parameters 398*86f6501bSJeeja KP * @azx_dev: HD-audio core stream for which parameters are to be set 399*86f6501bSJeeja KP * @format_val: format value parameter 400*86f6501bSJeeja KP * 401*86f6501bSJeeja KP * Setup the HD-audio core stream parameters from substream of the stream 402*86f6501bSJeeja KP * and passed format value 403*86f6501bSJeeja KP */ 404*86f6501bSJeeja KP int snd_hdac_stream_set_params(struct hdac_stream *azx_dev, 405*86f6501bSJeeja KP unsigned int format_val) 406*86f6501bSJeeja KP { 407*86f6501bSJeeja KP 408*86f6501bSJeeja KP unsigned int bufsize, period_bytes; 409*86f6501bSJeeja KP struct snd_pcm_substream *substream = azx_dev->substream; 410*86f6501bSJeeja KP struct snd_pcm_runtime *runtime; 411*86f6501bSJeeja KP int err; 412*86f6501bSJeeja KP 413*86f6501bSJeeja KP if (!substream) 414*86f6501bSJeeja KP return -EINVAL; 415*86f6501bSJeeja KP runtime = substream->runtime; 416*86f6501bSJeeja KP bufsize = snd_pcm_lib_buffer_bytes(substream); 417*86f6501bSJeeja KP period_bytes = snd_pcm_lib_period_bytes(substream); 418*86f6501bSJeeja KP 419*86f6501bSJeeja KP if (bufsize != azx_dev->bufsize || 420*86f6501bSJeeja KP period_bytes != azx_dev->period_bytes || 421*86f6501bSJeeja KP format_val != azx_dev->format_val || 422*86f6501bSJeeja KP runtime->no_period_wakeup != azx_dev->no_period_wakeup) { 423*86f6501bSJeeja KP azx_dev->bufsize = bufsize; 424*86f6501bSJeeja KP azx_dev->period_bytes = period_bytes; 425*86f6501bSJeeja KP azx_dev->format_val = format_val; 426*86f6501bSJeeja KP azx_dev->no_period_wakeup = runtime->no_period_wakeup; 427*86f6501bSJeeja KP err = snd_hdac_stream_setup_periods(azx_dev); 428*86f6501bSJeeja KP if (err < 0) 429*86f6501bSJeeja KP return err; 430*86f6501bSJeeja KP } 431*86f6501bSJeeja KP return 0; 432*86f6501bSJeeja KP } 433*86f6501bSJeeja KP EXPORT_SYMBOL_GPL(snd_hdac_stream_set_params); 434*86f6501bSJeeja KP 43514752412STakashi Iwai static cycle_t azx_cc_read(const struct cyclecounter *cc) 43614752412STakashi Iwai { 43714752412STakashi Iwai struct hdac_stream *azx_dev = container_of(cc, struct hdac_stream, cc); 43814752412STakashi Iwai 43914752412STakashi Iwai return snd_hdac_chip_readl(azx_dev->bus, WALLCLK); 44014752412STakashi Iwai } 44114752412STakashi Iwai 44214752412STakashi Iwai static void azx_timecounter_init(struct hdac_stream *azx_dev, 44314752412STakashi Iwai bool force, cycle_t last) 44414752412STakashi Iwai { 44514752412STakashi Iwai struct timecounter *tc = &azx_dev->tc; 44614752412STakashi Iwai struct cyclecounter *cc = &azx_dev->cc; 44714752412STakashi Iwai u64 nsec; 44814752412STakashi Iwai 44914752412STakashi Iwai cc->read = azx_cc_read; 45014752412STakashi Iwai cc->mask = CLOCKSOURCE_MASK(32); 45114752412STakashi Iwai 45214752412STakashi Iwai /* 45314752412STakashi Iwai * Converting from 24 MHz to ns means applying a 125/3 factor. 45414752412STakashi Iwai * To avoid any saturation issues in intermediate operations, 45514752412STakashi Iwai * the 125 factor is applied first. The division is applied 45614752412STakashi Iwai * last after reading the timecounter value. 45714752412STakashi Iwai * Applying the 1/3 factor as part of the multiplication 45814752412STakashi Iwai * requires at least 20 bits for a decent precision, however 45914752412STakashi Iwai * overflows occur after about 4 hours or less, not a option. 46014752412STakashi Iwai */ 46114752412STakashi Iwai 46214752412STakashi Iwai cc->mult = 125; /* saturation after 195 years */ 46314752412STakashi Iwai cc->shift = 0; 46414752412STakashi Iwai 46514752412STakashi Iwai nsec = 0; /* audio time is elapsed time since trigger */ 46614752412STakashi Iwai timecounter_init(tc, cc, nsec); 46714752412STakashi Iwai if (force) { 46814752412STakashi Iwai /* 46914752412STakashi Iwai * force timecounter to use predefined value, 47014752412STakashi Iwai * used for synchronized starts 47114752412STakashi Iwai */ 47214752412STakashi Iwai tc->cycle_last = last; 47314752412STakashi Iwai } 47414752412STakashi Iwai } 47514752412STakashi Iwai 47614752412STakashi Iwai /** 47714752412STakashi Iwai * snd_hdac_stream_timecounter_init - initialize time counter 47814752412STakashi Iwai * @azx_dev: HD-audio core stream (master stream) 47914752412STakashi Iwai * @streams: bit flags of streams to set up 48014752412STakashi Iwai * 48114752412STakashi Iwai * Initializes the time counter of streams marked by the bit flags (each 48214752412STakashi Iwai * bit corresponds to the stream index). 48314752412STakashi Iwai * The trigger timestamp of PCM substream assigned to the given stream is 48414752412STakashi Iwai * updated accordingly, too. 48514752412STakashi Iwai */ 48614752412STakashi Iwai void snd_hdac_stream_timecounter_init(struct hdac_stream *azx_dev, 48714752412STakashi Iwai unsigned int streams) 48814752412STakashi Iwai { 48914752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 49014752412STakashi Iwai struct snd_pcm_runtime *runtime = azx_dev->substream->runtime; 49114752412STakashi Iwai struct hdac_stream *s; 49214752412STakashi Iwai bool inited = false; 49314752412STakashi Iwai cycle_t cycle_last = 0; 49414752412STakashi Iwai int i = 0; 49514752412STakashi Iwai 49614752412STakashi Iwai list_for_each_entry(s, &bus->stream_list, list) { 49714752412STakashi Iwai if (streams & (1 << i)) { 49814752412STakashi Iwai azx_timecounter_init(s, inited, cycle_last); 49914752412STakashi Iwai if (!inited) { 50014752412STakashi Iwai inited = true; 50114752412STakashi Iwai cycle_last = s->tc.cycle_last; 50214752412STakashi Iwai } 50314752412STakashi Iwai } 50414752412STakashi Iwai i++; 50514752412STakashi Iwai } 50614752412STakashi Iwai 50714752412STakashi Iwai snd_pcm_gettime(runtime, &runtime->trigger_tstamp); 50814752412STakashi Iwai runtime->trigger_tstamp_latched = true; 50914752412STakashi Iwai } 51014752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_timecounter_init); 51114752412STakashi Iwai 51214752412STakashi Iwai /** 51314752412STakashi Iwai * snd_hdac_stream_sync_trigger - turn on/off stream sync register 51414752412STakashi Iwai * @azx_dev: HD-audio core stream (master stream) 51514752412STakashi Iwai * @streams: bit flags of streams to sync 51614752412STakashi Iwai */ 51714752412STakashi Iwai void snd_hdac_stream_sync_trigger(struct hdac_stream *azx_dev, bool set, 51814752412STakashi Iwai unsigned int streams, unsigned int reg) 51914752412STakashi Iwai { 52014752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 52114752412STakashi Iwai unsigned int val; 52214752412STakashi Iwai 52314752412STakashi Iwai if (!reg) 52414752412STakashi Iwai reg = AZX_REG_SSYNC; 52514752412STakashi Iwai val = _snd_hdac_chip_read(l, bus, reg); 52614752412STakashi Iwai if (set) 52714752412STakashi Iwai val |= streams; 52814752412STakashi Iwai else 52914752412STakashi Iwai val &= ~streams; 53014752412STakashi Iwai _snd_hdac_chip_write(l, bus, reg, val); 53114752412STakashi Iwai } 53214752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_sync_trigger); 53314752412STakashi Iwai 53414752412STakashi Iwai /** 53514752412STakashi Iwai * snd_hdac_stream_sync - sync with start/strop trigger operation 53614752412STakashi Iwai * @azx_dev: HD-audio core stream (master stream) 53714752412STakashi Iwai * @start: true = start, false = stop 53814752412STakashi Iwai * @streams: bit flags of streams to sync 53914752412STakashi Iwai * 54014752412STakashi Iwai * For @start = true, wait until all FIFOs get ready. 54114752412STakashi Iwai * For @start = false, wait until all RUN bits are cleared. 54214752412STakashi Iwai */ 54314752412STakashi Iwai void snd_hdac_stream_sync(struct hdac_stream *azx_dev, bool start, 54414752412STakashi Iwai unsigned int streams) 54514752412STakashi Iwai { 54614752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 54714752412STakashi Iwai int i, nwait, timeout; 54814752412STakashi Iwai struct hdac_stream *s; 54914752412STakashi Iwai 55014752412STakashi Iwai for (timeout = 5000; timeout; timeout--) { 55114752412STakashi Iwai nwait = 0; 55214752412STakashi Iwai i = 0; 55314752412STakashi Iwai list_for_each_entry(s, &bus->stream_list, list) { 55414752412STakashi Iwai if (streams & (1 << i)) { 55514752412STakashi Iwai if (start) { 55614752412STakashi Iwai /* check FIFO gets ready */ 55714752412STakashi Iwai if (!(snd_hdac_stream_readb(s, SD_STS) & 55814752412STakashi Iwai SD_STS_FIFO_READY)) 55914752412STakashi Iwai nwait++; 56014752412STakashi Iwai } else { 56114752412STakashi Iwai /* check RUN bit is cleared */ 56214752412STakashi Iwai if (snd_hdac_stream_readb(s, SD_CTL) & 56314752412STakashi Iwai SD_CTL_DMA_START) 56414752412STakashi Iwai nwait++; 56514752412STakashi Iwai } 56614752412STakashi Iwai } 56714752412STakashi Iwai i++; 56814752412STakashi Iwai } 56914752412STakashi Iwai if (!nwait) 57014752412STakashi Iwai break; 57114752412STakashi Iwai cpu_relax(); 57214752412STakashi Iwai } 57314752412STakashi Iwai } 57414752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_sync); 5758f3f600bSTakashi Iwai 5768f3f600bSTakashi Iwai #ifdef CONFIG_SND_HDA_DSP_LOADER 5778f3f600bSTakashi Iwai /** 5788f3f600bSTakashi Iwai * snd_hdac_dsp_prepare - prepare for DSP loading 5798f3f600bSTakashi Iwai * @azx_dev: HD-audio core stream used for DSP loading 5808f3f600bSTakashi Iwai * @format: HD-audio stream format 5818f3f600bSTakashi Iwai * @byte_size: data chunk byte size 5828f3f600bSTakashi Iwai * @bufp: allocated buffer 5838f3f600bSTakashi Iwai * 5848f3f600bSTakashi Iwai * Allocate the buffer for the given size and set up the given stream for 5858f3f600bSTakashi Iwai * DSP loading. Returns the stream tag (>= 0), or a negative error code. 5868f3f600bSTakashi Iwai */ 5878f3f600bSTakashi Iwai int snd_hdac_dsp_prepare(struct hdac_stream *azx_dev, unsigned int format, 5888f3f600bSTakashi Iwai unsigned int byte_size, struct snd_dma_buffer *bufp) 5898f3f600bSTakashi Iwai { 5908f3f600bSTakashi Iwai struct hdac_bus *bus = azx_dev->bus; 5918f3f600bSTakashi Iwai u32 *bdl; 5928f3f600bSTakashi Iwai int err; 5938f3f600bSTakashi Iwai 5948f3f600bSTakashi Iwai snd_hdac_dsp_lock(azx_dev); 5958f3f600bSTakashi Iwai spin_lock_irq(&bus->reg_lock); 5968f3f600bSTakashi Iwai if (azx_dev->running || azx_dev->locked) { 5978f3f600bSTakashi Iwai spin_unlock_irq(&bus->reg_lock); 5988f3f600bSTakashi Iwai err = -EBUSY; 5998f3f600bSTakashi Iwai goto unlock; 6008f3f600bSTakashi Iwai } 6018f3f600bSTakashi Iwai azx_dev->locked = true; 6028f3f600bSTakashi Iwai spin_unlock_irq(&bus->reg_lock); 6038f3f600bSTakashi Iwai 6048f3f600bSTakashi Iwai err = bus->io_ops->dma_alloc_pages(bus, SNDRV_DMA_TYPE_DEV_SG, 6058f3f600bSTakashi Iwai byte_size, bufp); 6068f3f600bSTakashi Iwai if (err < 0) 6078f3f600bSTakashi Iwai goto err_alloc; 6088f3f600bSTakashi Iwai 6098f3f600bSTakashi Iwai azx_dev->bufsize = byte_size; 6108f3f600bSTakashi Iwai azx_dev->period_bytes = byte_size; 6118f3f600bSTakashi Iwai azx_dev->format_val = format; 6128f3f600bSTakashi Iwai 6138f3f600bSTakashi Iwai snd_hdac_stream_reset(azx_dev); 6148f3f600bSTakashi Iwai 6158f3f600bSTakashi Iwai /* reset BDL address */ 6168f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, 0); 6178f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 0); 6188f3f600bSTakashi Iwai 6198f3f600bSTakashi Iwai azx_dev->frags = 0; 6208f3f600bSTakashi Iwai bdl = (u32 *)azx_dev->bdl.area; 6218f3f600bSTakashi Iwai err = setup_bdle(bus, bufp, azx_dev, &bdl, 0, byte_size, 0); 6228f3f600bSTakashi Iwai if (err < 0) 6238f3f600bSTakashi Iwai goto error; 6248f3f600bSTakashi Iwai 6258f3f600bSTakashi Iwai snd_hdac_stream_setup(azx_dev); 6268f3f600bSTakashi Iwai snd_hdac_dsp_unlock(azx_dev); 6278f3f600bSTakashi Iwai return azx_dev->stream_tag; 6288f3f600bSTakashi Iwai 6298f3f600bSTakashi Iwai error: 6308f3f600bSTakashi Iwai bus->io_ops->dma_free_pages(bus, bufp); 6318f3f600bSTakashi Iwai err_alloc: 6328f3f600bSTakashi Iwai spin_lock_irq(&bus->reg_lock); 6338f3f600bSTakashi Iwai azx_dev->locked = false; 6348f3f600bSTakashi Iwai spin_unlock_irq(&bus->reg_lock); 6358f3f600bSTakashi Iwai unlock: 6368f3f600bSTakashi Iwai snd_hdac_dsp_unlock(azx_dev); 6378f3f600bSTakashi Iwai return err; 6388f3f600bSTakashi Iwai } 6398f3f600bSTakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_dsp_prepare); 6408f3f600bSTakashi Iwai 6418f3f600bSTakashi Iwai /** 6428f3f600bSTakashi Iwai * snd_hdac_dsp_trigger - start / stop DSP loading 6438f3f600bSTakashi Iwai * @azx_dev: HD-audio core stream used for DSP loading 6448f3f600bSTakashi Iwai * @start: trigger start or stop 6458f3f600bSTakashi Iwai */ 6468f3f600bSTakashi Iwai void snd_hdac_dsp_trigger(struct hdac_stream *azx_dev, bool start) 6478f3f600bSTakashi Iwai { 6488f3f600bSTakashi Iwai if (start) 6498f3f600bSTakashi Iwai snd_hdac_stream_start(azx_dev, true); 6508f3f600bSTakashi Iwai else 6518f3f600bSTakashi Iwai snd_hdac_stream_stop(azx_dev); 6528f3f600bSTakashi Iwai } 6538f3f600bSTakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_dsp_trigger); 6548f3f600bSTakashi Iwai 6558f3f600bSTakashi Iwai /** 6568f3f600bSTakashi Iwai * snd_hdac_dsp_cleanup - clean up the stream from DSP loading to normal 6578f3f600bSTakashi Iwai * @azx_dev: HD-audio core stream used for DSP loading 6588f3f600bSTakashi Iwai * @dmab: buffer used by DSP loading 6598f3f600bSTakashi Iwai */ 6608f3f600bSTakashi Iwai void snd_hdac_dsp_cleanup(struct hdac_stream *azx_dev, 6618f3f600bSTakashi Iwai struct snd_dma_buffer *dmab) 6628f3f600bSTakashi Iwai { 6638f3f600bSTakashi Iwai struct hdac_bus *bus = azx_dev->bus; 6648f3f600bSTakashi Iwai 6658f3f600bSTakashi Iwai if (!dmab->area || !azx_dev->locked) 6668f3f600bSTakashi Iwai return; 6678f3f600bSTakashi Iwai 6688f3f600bSTakashi Iwai snd_hdac_dsp_lock(azx_dev); 6698f3f600bSTakashi Iwai /* reset BDL address */ 6708f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, 0); 6718f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 0); 6728f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_CTL, 0); 6738f3f600bSTakashi Iwai azx_dev->bufsize = 0; 6748f3f600bSTakashi Iwai azx_dev->period_bytes = 0; 6758f3f600bSTakashi Iwai azx_dev->format_val = 0; 6768f3f600bSTakashi Iwai 6778f3f600bSTakashi Iwai bus->io_ops->dma_free_pages(bus, dmab); 6788f3f600bSTakashi Iwai dmab->area = NULL; 6798f3f600bSTakashi Iwai 6808f3f600bSTakashi Iwai spin_lock_irq(&bus->reg_lock); 6818f3f600bSTakashi Iwai azx_dev->locked = false; 6828f3f600bSTakashi Iwai spin_unlock_irq(&bus->reg_lock); 6838f3f600bSTakashi Iwai snd_hdac_dsp_unlock(azx_dev); 6848f3f600bSTakashi Iwai } 6858f3f600bSTakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_dsp_cleanup); 6868f3f600bSTakashi Iwai #endif /* CONFIG_SND_HDA_DSP_LOADER */ 687