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