coresight: etb10: adjust read pointer only when needed

[firefly-linux-kernel-4.4.55.git] / drivers / hwtracing / coresight / coresight-etb10.c

diff --git a/drivers/hwtracing/coresight/coresight-etb10.c b/drivers/hwtracing/coresight/coresight-etb10.c
index 92f942321e1e86f7f271d8c66d979a740e2f4577..4d20b0be0c0b6a337cdec7cbbfd17f8ce94e2a63 100644 (file)
--- a/drivers/hwtracing/coresight/coresight-etb10.c
+++ b/drivers/hwtracing/coresight/coresight-etb10.c
@@ -428,7 +428,8 @@ static void etb_update_buffer(struct coresight_device *csdev,
                read_ptr = (write_ptr + drvdata->buffer_depth) -
                                        to_read / ETB_FRAME_SIZE_WORDS;
                /* Wrap around if need be*/
-               read_ptr &= ~(drvdata->buffer_depth - 1);
+               if (read_ptr > (drvdata->buffer_depth - 1))
+                       read_ptr -= drvdata->buffer_depth;
                /* let the decoder know we've skipped ahead */
                local_inc(&buf->lost);
        }