1 files changed, 35 insertions, 4 deletions

diff --git a/sound/pci/hda/hda_intel.c b/sound/pci/hda/hda_intel.c
index bcd40ee488e3..7b213d589ef6 100644
--- a/sound/pci/hda/hda_intel.c
+++ b/sound/pci/hda/hda_intel.c
@@ -1889,6 +1889,26 @@ static void azx_timecounter_init(struct snd_pcm_substream *substream,
                 tc->cycle_last = last;
 }
 
+static u64 azx_adjust_codec_delay(struct snd_pcm_substream *substream,
+                                u64 nsec)
+{
+        struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
+        struct hda_pcm_stream *hinfo = apcm->hinfo[substream->stream];
+        u64 codec_frames, codec_nsecs;
+
+        if (!hinfo->ops.get_delay)
+                return nsec;
+
+        codec_frames = hinfo->ops.get_delay(hinfo, apcm->codec, substream);
+        codec_nsecs = div_u64(codec_frames * 1000000000LL,
+                              substream->runtime->rate);
+
+        if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
+                return nsec + codec_nsecs;
+
+        return (nsec > codec_nsecs) ? nsec - codec_nsecs : 0;
+}
+
 static int azx_get_wallclock_tstamp(struct snd_pcm_substream *substream,
                                 struct timespec *ts)
 {
@@ -1897,6 +1917,7 @@ static int azx_get_wallclock_tstamp(struct snd_pcm_substream *substream,
 
         nsec = timecounter_read(&azx_dev->azx_tc);
         nsec = div_u64(nsec, 3); /* can be optimized */
+        nsec = azx_adjust_codec_delay(substream, nsec);
 
         *ts = ns_to_timespec(nsec);
 
@@ -2349,8 +2370,11 @@ static unsigned int azx_get_position(struct azx *chip,
                                      struct azx_dev *azx_dev,
                                      bool with_check)
 {
+        struct snd_pcm_substream *substream = azx_dev->substream;
+        struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
         unsigned int pos;
-        int stream = azx_dev->substream->stream;
+        int stream = substream->stream;
+        struct hda_pcm_stream *hinfo = apcm->hinfo[stream];
         int delay = 0;
 
         switch (chip->position_fix[stream]) {
@@ -2381,7 +2405,7 @@ static unsigned int azx_get_position(struct azx *chip,
                 pos = 0;
 
         /* calculate runtime delay from LPIB */
-        if (azx_dev->substream->runtime &&
+        if (substream->runtime &&
             chip->position_fix[stream] == POS_FIX_POSBUF &&
             (chip->driver_caps & AZX_DCAPS_COUNT_LPIB_DELAY)) {
                 unsigned int lpib_pos = azx_sd_readl(azx_dev, SD_LPIB);
@@ -2399,9 +2423,16 @@ static unsigned int azx_get_position(struct azx *chip,
                         delay = 0;
                         chip->driver_caps &= ~AZX_DCAPS_COUNT_LPIB_DELAY;
                 }
-                azx_dev->substream->runtime->delay =
-                        bytes_to_frames(azx_dev->substream->runtime, delay);
+                delay = bytes_to_frames(substream->runtime, delay);
         }
+
+        if (substream->runtime) {
+                if (hinfo->ops.get_delay)
+                        delay += hinfo->ops.get_delay(hinfo, apcm->codec,
+                                                      substream);
+                substream->runtime->delay = delay;
+        }
+
         trace_azx_get_position(chip, azx_dev, pos, delay);
         return pos;
 }