return 0;
 }
 
+static int cs_etm__decode_data_block(struct cs_etm_queue *etmq)
+{
+       int ret = 0;
+       size_t processed = 0;
+
+       /*
+        * Packets are decoded and added to the decoder's packet queue
+        * until the decoder packet processing callback has requested that
+        * processing stops or there is nothing left in the buffer.  Normal
+        * operations that stop processing are a timestamp packet or a full
+        * decoder buffer queue.
+        */
+       ret = cs_etm_decoder__process_data_block(etmq->decoder,
+                                                etmq->offset,
+                                                &etmq->buf[etmq->buf_used],
+                                                etmq->buf_len,
+                                                &processed);
+       if (ret)
+               goto out;
+
+       etmq->offset += processed;
+       etmq->buf_used += processed;
+       etmq->buf_len -= processed;
+
+out:
+       return ret;
+}
+
 static int cs_etm__run_decoder(struct cs_etm_queue *etmq)
 {
-       size_t processed;
        int err = 0;
 
        /* Go through each buffer in the queue and decode them one by one */
 
                /* Run trace decoder until buffer consumed or end of trace */
                do {
-                       processed = 0;
-                       err = cs_etm_decoder__process_data_block(
-                               etmq->decoder,
-                               etmq->offset,
-                               &etmq->buf[etmq->buf_used],
-                               etmq->buf_len,
-                               &processed);
+                       err = cs_etm__decode_data_block(etmq);
                        if (err)
                                return err;
 
-                       etmq->offset += processed;
-                       etmq->buf_used += processed;
-                       etmq->buf_len -= processed;
-
                        /* Process each packet in this chunk */
                        while (1) {
                                err = cs_etm_decoder__get_packet(etmq->decoder,