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> 13598dfb56SLibin 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 52598dfb56SLibin Yang trace_snd_hdac_stream_start(bus, azx_dev); 53598dfb56SLibin 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 { 88598dfb56SLibin Yang trace_snd_hdac_stream_stop(azx_dev->bus, azx_dev); 89598dfb56SLibin 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; 1424214c534STakashi Iwai struct snd_pcm_runtime *runtime; 14314752412STakashi Iwai unsigned int val; 14414752412STakashi Iwai 1454214c534STakashi Iwai if (azx_dev->substream) 1464214c534STakashi Iwai runtime = azx_dev->substream->runtime; 1474214c534STakashi Iwai else 1484214c534STakashi Iwai runtime = NULL; 14914752412STakashi Iwai /* make sure the run bit is zero for SD */ 15014752412STakashi Iwai snd_hdac_stream_clear(azx_dev); 15114752412STakashi Iwai /* program the stream_tag */ 15214752412STakashi Iwai val = snd_hdac_stream_readl(azx_dev, SD_CTL); 15314752412STakashi Iwai val = (val & ~SD_CTL_STREAM_TAG_MASK) | 15414752412STakashi Iwai (azx_dev->stream_tag << SD_CTL_STREAM_TAG_SHIFT); 15514752412STakashi Iwai if (!bus->snoop) 15614752412STakashi Iwai val |= SD_CTL_TRAFFIC_PRIO; 15714752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_CTL, val); 15814752412STakashi Iwai 15914752412STakashi Iwai /* program the length of samples in cyclic buffer */ 16014752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_CBL, azx_dev->bufsize); 16114752412STakashi Iwai 16214752412STakashi Iwai /* program the stream format */ 16314752412STakashi Iwai /* this value needs to be the same as the one programmed */ 16414752412STakashi Iwai snd_hdac_stream_writew(azx_dev, SD_FORMAT, azx_dev->format_val); 16514752412STakashi Iwai 16614752412STakashi Iwai /* program the stream LVI (last valid index) of the BDL */ 16714752412STakashi Iwai snd_hdac_stream_writew(azx_dev, SD_LVI, azx_dev->frags - 1); 16814752412STakashi Iwai 16914752412STakashi Iwai /* program the BDL address */ 17014752412STakashi Iwai /* lower BDL address */ 17114752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, (u32)azx_dev->bdl.addr); 17214752412STakashi Iwai /* upper BDL address */ 17314752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 17414752412STakashi Iwai upper_32_bits(azx_dev->bdl.addr)); 17514752412STakashi Iwai 17614752412STakashi Iwai /* enable the position buffer */ 17714752412STakashi Iwai if (bus->use_posbuf && bus->posbuf.addr) { 17814752412STakashi Iwai if (!(snd_hdac_chip_readl(bus, DPLBASE) & AZX_DPLBASE_ENABLE)) 17914752412STakashi Iwai snd_hdac_chip_writel(bus, DPLBASE, 18014752412STakashi Iwai (u32)bus->posbuf.addr | AZX_DPLBASE_ENABLE); 18114752412STakashi Iwai } 18214752412STakashi Iwai 18314752412STakashi Iwai /* set the interrupt enable bits in the descriptor control register */ 18414752412STakashi Iwai snd_hdac_stream_updatel(azx_dev, SD_CTL, 0, SD_INT_MASK); 18514752412STakashi Iwai 18614752412STakashi Iwai if (azx_dev->direction == SNDRV_PCM_STREAM_PLAYBACK) 18714752412STakashi Iwai azx_dev->fifo_size = 18814752412STakashi Iwai snd_hdac_stream_readw(azx_dev, SD_FIFOSIZE) + 1; 18914752412STakashi Iwai else 19014752412STakashi Iwai azx_dev->fifo_size = 0; 19114752412STakashi Iwai 19214752412STakashi Iwai /* when LPIB delay correction gives a small negative value, 19314752412STakashi Iwai * we ignore it; currently set the threshold statically to 19414752412STakashi Iwai * 64 frames 19514752412STakashi Iwai */ 1964214c534STakashi Iwai if (runtime && runtime->period_size > 64) 19714752412STakashi Iwai azx_dev->delay_negative_threshold = 19814752412STakashi Iwai -frames_to_bytes(runtime, 64); 19914752412STakashi Iwai else 20014752412STakashi Iwai azx_dev->delay_negative_threshold = 0; 20114752412STakashi Iwai 20214752412STakashi Iwai /* wallclk has 24Mhz clock source */ 2034214c534STakashi Iwai if (runtime) 20414752412STakashi Iwai azx_dev->period_wallclk = (((runtime->period_size * 24000) / 20514752412STakashi Iwai runtime->rate) * 1000); 20614752412STakashi Iwai 20714752412STakashi Iwai return 0; 20814752412STakashi Iwai } 20914752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_setup); 21014752412STakashi Iwai 21114752412STakashi Iwai /** 21214752412STakashi Iwai * snd_hdac_stream_cleanup - cleanup a stream 21314752412STakashi Iwai * @azx_dev: HD-audio core stream to clean up 21414752412STakashi Iwai */ 21514752412STakashi Iwai void snd_hdac_stream_cleanup(struct hdac_stream *azx_dev) 21614752412STakashi Iwai { 21714752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, 0); 21814752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 0); 21914752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_CTL, 0); 22014752412STakashi Iwai azx_dev->bufsize = 0; 22114752412STakashi Iwai azx_dev->period_bytes = 0; 22214752412STakashi Iwai azx_dev->format_val = 0; 22314752412STakashi Iwai } 22414752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_cleanup); 22514752412STakashi Iwai 22614752412STakashi Iwai /** 22714752412STakashi Iwai * snd_hdac_stream_assign - assign a stream for the PCM 22814752412STakashi Iwai * @bus: HD-audio core bus 22914752412STakashi Iwai * @substream: PCM substream to assign 23014752412STakashi Iwai * 23114752412STakashi Iwai * Look for an unused stream for the given PCM substream, assign it 23214752412STakashi Iwai * and return the stream object. If no stream is free, returns NULL. 23314752412STakashi Iwai * The function tries to keep using the same stream object when it's used 23414752412STakashi Iwai * beforehand. Also, when bus->reverse_assign flag is set, the last free 23514752412STakashi Iwai * or matching entry is returned. This is needed for some strange codecs. 23614752412STakashi Iwai */ 23714752412STakashi Iwai struct hdac_stream *snd_hdac_stream_assign(struct hdac_bus *bus, 23814752412STakashi Iwai struct snd_pcm_substream *substream) 23914752412STakashi Iwai { 24014752412STakashi Iwai struct hdac_stream *azx_dev; 24114752412STakashi Iwai struct hdac_stream *res = NULL; 24214752412STakashi Iwai 24314752412STakashi Iwai /* make a non-zero unique key for the substream */ 24414752412STakashi Iwai int key = (substream->pcm->device << 16) | (substream->number << 2) | 24514752412STakashi Iwai (substream->stream + 1); 24614752412STakashi Iwai 24714752412STakashi Iwai list_for_each_entry(azx_dev, &bus->stream_list, list) { 24814752412STakashi Iwai if (azx_dev->direction != substream->stream) 24914752412STakashi Iwai continue; 25014752412STakashi Iwai if (azx_dev->opened) 25114752412STakashi Iwai continue; 25214752412STakashi Iwai if (azx_dev->assigned_key == key) { 25314752412STakashi Iwai res = azx_dev; 25414752412STakashi Iwai break; 25514752412STakashi Iwai } 25614752412STakashi Iwai if (!res || bus->reverse_assign) 25714752412STakashi Iwai res = azx_dev; 25814752412STakashi Iwai } 25914752412STakashi Iwai if (res) { 26014752412STakashi Iwai spin_lock_irq(&bus->reg_lock); 26114752412STakashi Iwai res->opened = 1; 26214752412STakashi Iwai res->running = 0; 26314752412STakashi Iwai res->assigned_key = key; 26414752412STakashi Iwai res->substream = substream; 26514752412STakashi Iwai spin_unlock_irq(&bus->reg_lock); 26614752412STakashi Iwai } 26714752412STakashi Iwai return res; 26814752412STakashi Iwai } 26914752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_assign); 27014752412STakashi Iwai 27114752412STakashi Iwai /** 27214752412STakashi Iwai * snd_hdac_stream_release - release the assigned stream 27314752412STakashi Iwai * @azx_dev: HD-audio core stream to release 27414752412STakashi Iwai * 27514752412STakashi Iwai * Release the stream that has been assigned by snd_hdac_stream_assign(). 27614752412STakashi Iwai */ 27714752412STakashi Iwai void snd_hdac_stream_release(struct hdac_stream *azx_dev) 27814752412STakashi Iwai { 27914752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 28014752412STakashi Iwai 28114752412STakashi Iwai spin_lock_irq(&bus->reg_lock); 28214752412STakashi Iwai azx_dev->opened = 0; 28314752412STakashi Iwai azx_dev->running = 0; 28414752412STakashi Iwai azx_dev->substream = NULL; 28514752412STakashi Iwai spin_unlock_irq(&bus->reg_lock); 28614752412STakashi Iwai } 28714752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_release); 28814752412STakashi Iwai 2894308c9b0SJeeja KP /** 2904308c9b0SJeeja KP * snd_hdac_get_stream - return hdac_stream based on stream_tag and 2914308c9b0SJeeja KP * direction 2924308c9b0SJeeja KP * 2934308c9b0SJeeja KP * @bus: HD-audio core bus 2944308c9b0SJeeja KP * @dir: direction for the stream to be found 2954308c9b0SJeeja KP * @stream_tag: stream tag for stream to be found 2964308c9b0SJeeja KP */ 2974308c9b0SJeeja KP struct hdac_stream *snd_hdac_get_stream(struct hdac_bus *bus, 2984308c9b0SJeeja KP int dir, int stream_tag) 2994308c9b0SJeeja KP { 3004308c9b0SJeeja KP struct hdac_stream *s; 3014308c9b0SJeeja KP 3024308c9b0SJeeja KP list_for_each_entry(s, &bus->stream_list, list) { 3034308c9b0SJeeja KP if (s->direction == dir && s->stream_tag == stream_tag) 3044308c9b0SJeeja KP return s; 3054308c9b0SJeeja KP } 3064308c9b0SJeeja KP 3074308c9b0SJeeja KP return NULL; 3084308c9b0SJeeja KP } 3094308c9b0SJeeja KP EXPORT_SYMBOL_GPL(snd_hdac_get_stream); 3104308c9b0SJeeja KP 31114752412STakashi Iwai /* 31214752412STakashi Iwai * set up a BDL entry 31314752412STakashi Iwai */ 31414752412STakashi Iwai static int setup_bdle(struct hdac_bus *bus, 31514752412STakashi Iwai struct snd_dma_buffer *dmab, 31614752412STakashi Iwai struct hdac_stream *azx_dev, __le32 **bdlp, 31714752412STakashi Iwai int ofs, int size, int with_ioc) 31814752412STakashi Iwai { 31914752412STakashi Iwai __le32 *bdl = *bdlp; 32014752412STakashi Iwai 32114752412STakashi Iwai while (size > 0) { 32214752412STakashi Iwai dma_addr_t addr; 32314752412STakashi Iwai int chunk; 32414752412STakashi Iwai 32514752412STakashi Iwai if (azx_dev->frags >= AZX_MAX_BDL_ENTRIES) 32614752412STakashi Iwai return -EINVAL; 32714752412STakashi Iwai 32814752412STakashi Iwai addr = snd_sgbuf_get_addr(dmab, ofs); 32914752412STakashi Iwai /* program the address field of the BDL entry */ 33014752412STakashi Iwai bdl[0] = cpu_to_le32((u32)addr); 33114752412STakashi Iwai bdl[1] = cpu_to_le32(upper_32_bits(addr)); 33214752412STakashi Iwai /* program the size field of the BDL entry */ 33314752412STakashi Iwai chunk = snd_sgbuf_get_chunk_size(dmab, ofs, size); 33414752412STakashi Iwai /* one BDLE cannot cross 4K boundary on CTHDA chips */ 33514752412STakashi Iwai if (bus->align_bdle_4k) { 33614752412STakashi Iwai u32 remain = 0x1000 - (ofs & 0xfff); 33714752412STakashi Iwai 33814752412STakashi Iwai if (chunk > remain) 33914752412STakashi Iwai chunk = remain; 34014752412STakashi Iwai } 34114752412STakashi Iwai bdl[2] = cpu_to_le32(chunk); 34214752412STakashi Iwai /* program the IOC to enable interrupt 34314752412STakashi Iwai * only when the whole fragment is processed 34414752412STakashi Iwai */ 34514752412STakashi Iwai size -= chunk; 34614752412STakashi Iwai bdl[3] = (size || !with_ioc) ? 0 : cpu_to_le32(0x01); 34714752412STakashi Iwai bdl += 4; 34814752412STakashi Iwai azx_dev->frags++; 34914752412STakashi Iwai ofs += chunk; 35014752412STakashi Iwai } 35114752412STakashi Iwai *bdlp = bdl; 35214752412STakashi Iwai return ofs; 35314752412STakashi Iwai } 35414752412STakashi Iwai 35514752412STakashi Iwai /** 35614752412STakashi Iwai * snd_hdac_stream_setup_periods - set up BDL entries 35714752412STakashi Iwai * @azx_dev: HD-audio core stream to set up 35814752412STakashi Iwai * 35914752412STakashi Iwai * Set up the buffer descriptor table of the given stream based on the 36014752412STakashi Iwai * period and buffer sizes of the assigned PCM substream. 36114752412STakashi Iwai */ 36214752412STakashi Iwai int snd_hdac_stream_setup_periods(struct hdac_stream *azx_dev) 36314752412STakashi Iwai { 36414752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 36514752412STakashi Iwai struct snd_pcm_substream *substream = azx_dev->substream; 36614752412STakashi Iwai struct snd_pcm_runtime *runtime = substream->runtime; 36714752412STakashi Iwai __le32 *bdl; 36814752412STakashi Iwai int i, ofs, periods, period_bytes; 36914752412STakashi Iwai int pos_adj, pos_align; 37014752412STakashi Iwai 37114752412STakashi Iwai /* reset BDL address */ 37214752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, 0); 37314752412STakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 0); 37414752412STakashi Iwai 37514752412STakashi Iwai period_bytes = azx_dev->period_bytes; 37614752412STakashi Iwai periods = azx_dev->bufsize / period_bytes; 37714752412STakashi Iwai 37814752412STakashi Iwai /* program the initial BDL entries */ 37914752412STakashi Iwai bdl = (__le32 *)azx_dev->bdl.area; 38014752412STakashi Iwai ofs = 0; 38114752412STakashi Iwai azx_dev->frags = 0; 38214752412STakashi Iwai 38314752412STakashi Iwai pos_adj = bus->bdl_pos_adj; 38414752412STakashi Iwai if (!azx_dev->no_period_wakeup && pos_adj > 0) { 38514752412STakashi Iwai pos_align = pos_adj; 38614752412STakashi Iwai pos_adj = (pos_adj * runtime->rate + 47999) / 48000; 38714752412STakashi Iwai if (!pos_adj) 38814752412STakashi Iwai pos_adj = pos_align; 38914752412STakashi Iwai else 39014752412STakashi Iwai pos_adj = ((pos_adj + pos_align - 1) / pos_align) * 39114752412STakashi Iwai pos_align; 39214752412STakashi Iwai pos_adj = frames_to_bytes(runtime, pos_adj); 39314752412STakashi Iwai if (pos_adj >= period_bytes) { 39414752412STakashi Iwai dev_warn(bus->dev, "Too big adjustment %d\n", 39514752412STakashi Iwai pos_adj); 39614752412STakashi Iwai pos_adj = 0; 39714752412STakashi Iwai } else { 39814752412STakashi Iwai ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), 39914752412STakashi Iwai azx_dev, 40014752412STakashi Iwai &bdl, ofs, pos_adj, true); 40114752412STakashi Iwai if (ofs < 0) 40214752412STakashi Iwai goto error; 40314752412STakashi Iwai } 40414752412STakashi Iwai } else 40514752412STakashi Iwai pos_adj = 0; 40614752412STakashi Iwai 40714752412STakashi Iwai for (i = 0; i < periods; i++) { 40814752412STakashi Iwai if (i == periods - 1 && pos_adj) 40914752412STakashi Iwai ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), 41014752412STakashi Iwai azx_dev, &bdl, ofs, 41114752412STakashi Iwai period_bytes - pos_adj, 0); 41214752412STakashi Iwai else 41314752412STakashi Iwai ofs = setup_bdle(bus, snd_pcm_get_dma_buf(substream), 41414752412STakashi Iwai azx_dev, &bdl, ofs, 41514752412STakashi Iwai period_bytes, 41614752412STakashi Iwai !azx_dev->no_period_wakeup); 41714752412STakashi Iwai if (ofs < 0) 41814752412STakashi Iwai goto error; 41914752412STakashi Iwai } 42014752412STakashi Iwai return 0; 42114752412STakashi Iwai 42214752412STakashi Iwai error: 42314752412STakashi Iwai dev_err(bus->dev, "Too many BDL entries: buffer=%d, period=%d\n", 42414752412STakashi Iwai azx_dev->bufsize, period_bytes); 42514752412STakashi Iwai return -EINVAL; 42614752412STakashi Iwai } 42714752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_setup_periods); 42814752412STakashi Iwai 42978dd5e21STakashi Iwai /** 43078dd5e21STakashi Iwai * snd_hdac_stream_set_params - set stream parameters 43186f6501bSJeeja KP * @azx_dev: HD-audio core stream for which parameters are to be set 43286f6501bSJeeja KP * @format_val: format value parameter 43386f6501bSJeeja KP * 43486f6501bSJeeja KP * Setup the HD-audio core stream parameters from substream of the stream 43586f6501bSJeeja KP * and passed format value 43686f6501bSJeeja KP */ 43786f6501bSJeeja KP int snd_hdac_stream_set_params(struct hdac_stream *azx_dev, 43886f6501bSJeeja KP unsigned int format_val) 43986f6501bSJeeja KP { 44086f6501bSJeeja KP 44186f6501bSJeeja KP unsigned int bufsize, period_bytes; 44286f6501bSJeeja KP struct snd_pcm_substream *substream = azx_dev->substream; 44386f6501bSJeeja KP struct snd_pcm_runtime *runtime; 44486f6501bSJeeja KP int err; 44586f6501bSJeeja KP 44686f6501bSJeeja KP if (!substream) 44786f6501bSJeeja KP return -EINVAL; 44886f6501bSJeeja KP runtime = substream->runtime; 44986f6501bSJeeja KP bufsize = snd_pcm_lib_buffer_bytes(substream); 45086f6501bSJeeja KP period_bytes = snd_pcm_lib_period_bytes(substream); 45186f6501bSJeeja KP 45286f6501bSJeeja KP if (bufsize != azx_dev->bufsize || 45386f6501bSJeeja KP period_bytes != azx_dev->period_bytes || 45486f6501bSJeeja KP format_val != azx_dev->format_val || 45586f6501bSJeeja KP runtime->no_period_wakeup != azx_dev->no_period_wakeup) { 45686f6501bSJeeja KP azx_dev->bufsize = bufsize; 45786f6501bSJeeja KP azx_dev->period_bytes = period_bytes; 45886f6501bSJeeja KP azx_dev->format_val = format_val; 45986f6501bSJeeja KP azx_dev->no_period_wakeup = runtime->no_period_wakeup; 46086f6501bSJeeja KP err = snd_hdac_stream_setup_periods(azx_dev); 46186f6501bSJeeja KP if (err < 0) 46286f6501bSJeeja KP return err; 46386f6501bSJeeja KP } 46486f6501bSJeeja KP return 0; 46586f6501bSJeeja KP } 46686f6501bSJeeja KP EXPORT_SYMBOL_GPL(snd_hdac_stream_set_params); 46786f6501bSJeeja KP 468a5a1d1c2SThomas Gleixner static u64 azx_cc_read(const struct cyclecounter *cc) 46914752412STakashi Iwai { 47014752412STakashi Iwai struct hdac_stream *azx_dev = container_of(cc, struct hdac_stream, cc); 47114752412STakashi Iwai 47214752412STakashi Iwai return snd_hdac_chip_readl(azx_dev->bus, WALLCLK); 47314752412STakashi Iwai } 47414752412STakashi Iwai 47514752412STakashi Iwai static void azx_timecounter_init(struct hdac_stream *azx_dev, 476a5a1d1c2SThomas Gleixner bool force, u64 last) 47714752412STakashi Iwai { 47814752412STakashi Iwai struct timecounter *tc = &azx_dev->tc; 47914752412STakashi Iwai struct cyclecounter *cc = &azx_dev->cc; 48014752412STakashi Iwai u64 nsec; 48114752412STakashi Iwai 48214752412STakashi Iwai cc->read = azx_cc_read; 48314752412STakashi Iwai cc->mask = CLOCKSOURCE_MASK(32); 48414752412STakashi Iwai 48514752412STakashi Iwai /* 48614752412STakashi Iwai * Converting from 24 MHz to ns means applying a 125/3 factor. 48714752412STakashi Iwai * To avoid any saturation issues in intermediate operations, 48814752412STakashi Iwai * the 125 factor is applied first. The division is applied 48914752412STakashi Iwai * last after reading the timecounter value. 49014752412STakashi Iwai * Applying the 1/3 factor as part of the multiplication 49114752412STakashi Iwai * requires at least 20 bits for a decent precision, however 49214752412STakashi Iwai * overflows occur after about 4 hours or less, not a option. 49314752412STakashi Iwai */ 49414752412STakashi Iwai 49514752412STakashi Iwai cc->mult = 125; /* saturation after 195 years */ 49614752412STakashi Iwai cc->shift = 0; 49714752412STakashi Iwai 49814752412STakashi Iwai nsec = 0; /* audio time is elapsed time since trigger */ 49914752412STakashi Iwai timecounter_init(tc, cc, nsec); 50014752412STakashi Iwai if (force) { 50114752412STakashi Iwai /* 50214752412STakashi Iwai * force timecounter to use predefined value, 50314752412STakashi Iwai * used for synchronized starts 50414752412STakashi Iwai */ 50514752412STakashi Iwai tc->cycle_last = last; 50614752412STakashi Iwai } 50714752412STakashi Iwai } 50814752412STakashi Iwai 50914752412STakashi Iwai /** 51014752412STakashi Iwai * snd_hdac_stream_timecounter_init - initialize time counter 51114752412STakashi Iwai * @azx_dev: HD-audio core stream (master stream) 51214752412STakashi Iwai * @streams: bit flags of streams to set up 51314752412STakashi Iwai * 51414752412STakashi Iwai * Initializes the time counter of streams marked by the bit flags (each 51514752412STakashi Iwai * bit corresponds to the stream index). 51614752412STakashi Iwai * The trigger timestamp of PCM substream assigned to the given stream is 51714752412STakashi Iwai * updated accordingly, too. 51814752412STakashi Iwai */ 51914752412STakashi Iwai void snd_hdac_stream_timecounter_init(struct hdac_stream *azx_dev, 52014752412STakashi Iwai unsigned int streams) 52114752412STakashi Iwai { 52214752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 52314752412STakashi Iwai struct snd_pcm_runtime *runtime = azx_dev->substream->runtime; 52414752412STakashi Iwai struct hdac_stream *s; 52514752412STakashi Iwai bool inited = false; 526a5a1d1c2SThomas Gleixner u64 cycle_last = 0; 52714752412STakashi Iwai int i = 0; 52814752412STakashi Iwai 52914752412STakashi Iwai list_for_each_entry(s, &bus->stream_list, list) { 53014752412STakashi Iwai if (streams & (1 << i)) { 53114752412STakashi Iwai azx_timecounter_init(s, inited, cycle_last); 53214752412STakashi Iwai if (!inited) { 53314752412STakashi Iwai inited = true; 53414752412STakashi Iwai cycle_last = s->tc.cycle_last; 53514752412STakashi Iwai } 53614752412STakashi Iwai } 53714752412STakashi Iwai i++; 53814752412STakashi Iwai } 53914752412STakashi Iwai 54014752412STakashi Iwai snd_pcm_gettime(runtime, &runtime->trigger_tstamp); 54114752412STakashi Iwai runtime->trigger_tstamp_latched = true; 54214752412STakashi Iwai } 54314752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_timecounter_init); 54414752412STakashi Iwai 54514752412STakashi Iwai /** 54614752412STakashi Iwai * snd_hdac_stream_sync_trigger - turn on/off stream sync register 54714752412STakashi Iwai * @azx_dev: HD-audio core stream (master stream) 54814752412STakashi Iwai * @streams: bit flags of streams to sync 54914752412STakashi Iwai */ 55014752412STakashi Iwai void snd_hdac_stream_sync_trigger(struct hdac_stream *azx_dev, bool set, 55114752412STakashi Iwai unsigned int streams, unsigned int reg) 55214752412STakashi Iwai { 55314752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 55414752412STakashi Iwai unsigned int val; 55514752412STakashi Iwai 55614752412STakashi Iwai if (!reg) 55714752412STakashi Iwai reg = AZX_REG_SSYNC; 5582c1f8138STakashi Iwai val = _snd_hdac_chip_readl(bus, reg); 55914752412STakashi Iwai if (set) 56014752412STakashi Iwai val |= streams; 56114752412STakashi Iwai else 56214752412STakashi Iwai val &= ~streams; 5632c1f8138STakashi Iwai _snd_hdac_chip_writel(bus, reg, val); 56414752412STakashi Iwai } 56514752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_sync_trigger); 56614752412STakashi Iwai 56714752412STakashi Iwai /** 56814752412STakashi Iwai * snd_hdac_stream_sync - sync with start/strop trigger operation 56914752412STakashi Iwai * @azx_dev: HD-audio core stream (master stream) 57014752412STakashi Iwai * @start: true = start, false = stop 57114752412STakashi Iwai * @streams: bit flags of streams to sync 57214752412STakashi Iwai * 57314752412STakashi Iwai * For @start = true, wait until all FIFOs get ready. 57414752412STakashi Iwai * For @start = false, wait until all RUN bits are cleared. 57514752412STakashi Iwai */ 57614752412STakashi Iwai void snd_hdac_stream_sync(struct hdac_stream *azx_dev, bool start, 57714752412STakashi Iwai unsigned int streams) 57814752412STakashi Iwai { 57914752412STakashi Iwai struct hdac_bus *bus = azx_dev->bus; 58014752412STakashi Iwai int i, nwait, timeout; 58114752412STakashi Iwai struct hdac_stream *s; 58214752412STakashi Iwai 58314752412STakashi Iwai for (timeout = 5000; timeout; timeout--) { 58414752412STakashi Iwai nwait = 0; 58514752412STakashi Iwai i = 0; 58614752412STakashi Iwai list_for_each_entry(s, &bus->stream_list, list) { 58714752412STakashi Iwai if (streams & (1 << i)) { 58814752412STakashi Iwai if (start) { 58914752412STakashi Iwai /* check FIFO gets ready */ 59014752412STakashi Iwai if (!(snd_hdac_stream_readb(s, SD_STS) & 59114752412STakashi Iwai SD_STS_FIFO_READY)) 59214752412STakashi Iwai nwait++; 59314752412STakashi Iwai } else { 59414752412STakashi Iwai /* check RUN bit is cleared */ 59514752412STakashi Iwai if (snd_hdac_stream_readb(s, SD_CTL) & 59614752412STakashi Iwai SD_CTL_DMA_START) 59714752412STakashi Iwai nwait++; 59814752412STakashi Iwai } 59914752412STakashi Iwai } 60014752412STakashi Iwai i++; 60114752412STakashi Iwai } 60214752412STakashi Iwai if (!nwait) 60314752412STakashi Iwai break; 60414752412STakashi Iwai cpu_relax(); 60514752412STakashi Iwai } 60614752412STakashi Iwai } 60714752412STakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_stream_sync); 6088f3f600bSTakashi Iwai 6098f3f600bSTakashi Iwai #ifdef CONFIG_SND_HDA_DSP_LOADER 6108f3f600bSTakashi Iwai /** 6118f3f600bSTakashi Iwai * snd_hdac_dsp_prepare - prepare for DSP loading 6128f3f600bSTakashi Iwai * @azx_dev: HD-audio core stream used for DSP loading 6138f3f600bSTakashi Iwai * @format: HD-audio stream format 6148f3f600bSTakashi Iwai * @byte_size: data chunk byte size 6158f3f600bSTakashi Iwai * @bufp: allocated buffer 6168f3f600bSTakashi Iwai * 6178f3f600bSTakashi Iwai * Allocate the buffer for the given size and set up the given stream for 6188f3f600bSTakashi Iwai * DSP loading. Returns the stream tag (>= 0), or a negative error code. 6198f3f600bSTakashi Iwai */ 6208f3f600bSTakashi Iwai int snd_hdac_dsp_prepare(struct hdac_stream *azx_dev, unsigned int format, 6218f3f600bSTakashi Iwai unsigned int byte_size, struct snd_dma_buffer *bufp) 6228f3f600bSTakashi Iwai { 6238f3f600bSTakashi Iwai struct hdac_bus *bus = azx_dev->bus; 624*7362b0fcSTakashi Iwai __le32 *bdl; 6258f3f600bSTakashi Iwai int err; 6268f3f600bSTakashi Iwai 6278f3f600bSTakashi Iwai snd_hdac_dsp_lock(azx_dev); 6288f3f600bSTakashi Iwai spin_lock_irq(&bus->reg_lock); 6298f3f600bSTakashi Iwai if (azx_dev->running || azx_dev->locked) { 6308f3f600bSTakashi Iwai spin_unlock_irq(&bus->reg_lock); 6318f3f600bSTakashi Iwai err = -EBUSY; 6328f3f600bSTakashi Iwai goto unlock; 6338f3f600bSTakashi Iwai } 6348f3f600bSTakashi Iwai azx_dev->locked = true; 6358f3f600bSTakashi Iwai spin_unlock_irq(&bus->reg_lock); 6368f3f600bSTakashi Iwai 6378f3f600bSTakashi Iwai err = bus->io_ops->dma_alloc_pages(bus, SNDRV_DMA_TYPE_DEV_SG, 6388f3f600bSTakashi Iwai byte_size, bufp); 6398f3f600bSTakashi Iwai if (err < 0) 6408f3f600bSTakashi Iwai goto err_alloc; 6418f3f600bSTakashi Iwai 6424214c534STakashi Iwai azx_dev->substream = NULL; 6438f3f600bSTakashi Iwai azx_dev->bufsize = byte_size; 6448f3f600bSTakashi Iwai azx_dev->period_bytes = byte_size; 6458f3f600bSTakashi Iwai azx_dev->format_val = format; 6468f3f600bSTakashi Iwai 6478f3f600bSTakashi Iwai snd_hdac_stream_reset(azx_dev); 6488f3f600bSTakashi Iwai 6498f3f600bSTakashi Iwai /* reset BDL address */ 6508f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, 0); 6518f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 0); 6528f3f600bSTakashi Iwai 6538f3f600bSTakashi Iwai azx_dev->frags = 0; 654*7362b0fcSTakashi Iwai bdl = (__le32 *)azx_dev->bdl.area; 6558f3f600bSTakashi Iwai err = setup_bdle(bus, bufp, azx_dev, &bdl, 0, byte_size, 0); 6568f3f600bSTakashi Iwai if (err < 0) 6578f3f600bSTakashi Iwai goto error; 6588f3f600bSTakashi Iwai 6598f3f600bSTakashi Iwai snd_hdac_stream_setup(azx_dev); 6608f3f600bSTakashi Iwai snd_hdac_dsp_unlock(azx_dev); 6618f3f600bSTakashi Iwai return azx_dev->stream_tag; 6628f3f600bSTakashi Iwai 6638f3f600bSTakashi Iwai error: 6648f3f600bSTakashi Iwai bus->io_ops->dma_free_pages(bus, bufp); 6658f3f600bSTakashi Iwai err_alloc: 6668f3f600bSTakashi Iwai spin_lock_irq(&bus->reg_lock); 6678f3f600bSTakashi Iwai azx_dev->locked = false; 6688f3f600bSTakashi Iwai spin_unlock_irq(&bus->reg_lock); 6698f3f600bSTakashi Iwai unlock: 6708f3f600bSTakashi Iwai snd_hdac_dsp_unlock(azx_dev); 6718f3f600bSTakashi Iwai return err; 6728f3f600bSTakashi Iwai } 6738f3f600bSTakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_dsp_prepare); 6748f3f600bSTakashi Iwai 6758f3f600bSTakashi Iwai /** 6768f3f600bSTakashi Iwai * snd_hdac_dsp_trigger - start / stop DSP loading 6778f3f600bSTakashi Iwai * @azx_dev: HD-audio core stream used for DSP loading 6788f3f600bSTakashi Iwai * @start: trigger start or stop 6798f3f600bSTakashi Iwai */ 6808f3f600bSTakashi Iwai void snd_hdac_dsp_trigger(struct hdac_stream *azx_dev, bool start) 6818f3f600bSTakashi Iwai { 6828f3f600bSTakashi Iwai if (start) 6838f3f600bSTakashi Iwai snd_hdac_stream_start(azx_dev, true); 6848f3f600bSTakashi Iwai else 6858f3f600bSTakashi Iwai snd_hdac_stream_stop(azx_dev); 6868f3f600bSTakashi Iwai } 6878f3f600bSTakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_dsp_trigger); 6888f3f600bSTakashi Iwai 6898f3f600bSTakashi Iwai /** 6908f3f600bSTakashi Iwai * snd_hdac_dsp_cleanup - clean up the stream from DSP loading to normal 6918f3f600bSTakashi Iwai * @azx_dev: HD-audio core stream used for DSP loading 6928f3f600bSTakashi Iwai * @dmab: buffer used by DSP loading 6938f3f600bSTakashi Iwai */ 6948f3f600bSTakashi Iwai void snd_hdac_dsp_cleanup(struct hdac_stream *azx_dev, 6958f3f600bSTakashi Iwai struct snd_dma_buffer *dmab) 6968f3f600bSTakashi Iwai { 6978f3f600bSTakashi Iwai struct hdac_bus *bus = azx_dev->bus; 6988f3f600bSTakashi Iwai 6998f3f600bSTakashi Iwai if (!dmab->area || !azx_dev->locked) 7008f3f600bSTakashi Iwai return; 7018f3f600bSTakashi Iwai 7028f3f600bSTakashi Iwai snd_hdac_dsp_lock(azx_dev); 7038f3f600bSTakashi Iwai /* reset BDL address */ 7048f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPL, 0); 7058f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_BDLPU, 0); 7068f3f600bSTakashi Iwai snd_hdac_stream_writel(azx_dev, SD_CTL, 0); 7078f3f600bSTakashi Iwai azx_dev->bufsize = 0; 7088f3f600bSTakashi Iwai azx_dev->period_bytes = 0; 7098f3f600bSTakashi Iwai azx_dev->format_val = 0; 7108f3f600bSTakashi Iwai 7118f3f600bSTakashi Iwai bus->io_ops->dma_free_pages(bus, dmab); 7128f3f600bSTakashi Iwai dmab->area = NULL; 7138f3f600bSTakashi Iwai 7148f3f600bSTakashi Iwai spin_lock_irq(&bus->reg_lock); 7158f3f600bSTakashi Iwai azx_dev->locked = false; 7168f3f600bSTakashi Iwai spin_unlock_irq(&bus->reg_lock); 7178f3f600bSTakashi Iwai snd_hdac_dsp_unlock(azx_dev); 7188f3f600bSTakashi Iwai } 7198f3f600bSTakashi Iwai EXPORT_SYMBOL_GPL(snd_hdac_dsp_cleanup); 7208f3f600bSTakashi Iwai #endif /* CONFIG_SND_HDA_DSP_LOADER */ 721