1 files changed, 28 insertions, 3 deletions

diff --git a/kernel/xpp/xframe_queue.c b/kernel/xpp/xframe_queue.c
index 5d11600..17632df 100644
--- a/kernel/xpp/xframe_queue.c
+++ b/kernel/xpp/xframe_queue.c
@@ -25,10 +25,34 @@ void xframe_queue_clearstats(struct xframe_queue *q)
 	q->worst_lag_usec = 0L;
 }
 
+static void __xframe_dump_queue(struct xframe_queue *q)
+{
+	xframe_t	*xframe;
+	int		i = 0;
+	char		prefix[30];
+	struct timeval	now;
+
+	do_gettimeofday(&now);
+	printk(KERN_DEBUG "%s: dump queue '%s' (first packet in each frame)\n",
+		THIS_MODULE->name,
+		q->name);
+	list_for_each_entry_reverse(xframe, &q->head, frame_list) {
+		xpacket_t	*pack = (xpacket_t *)&xframe->packets[0];
+		long		usec = usec_diff(&now, &xframe->tv_queued);
+		snprintf(prefix, ARRAY_SIZE(prefix), "  %3d> %5ld.%03ld msec",
+			i++, usec / 1000, usec % 1000);
+		dump_packet(prefix, pack, 1);
+	}
+}
+
 static bool __xframe_enqueue(struct xframe_queue *q, xframe_t *xframe)
 {
 	int			ret = 1;
 
+	if(unlikely(q->disabled)) {
+		ret = 0;
+		goto out;
+	}
 	if(q->count >= q->max_count) {
 		q->overflows++;
 		NOTICE("Overflow of %-15s: counts %3d, %3d, %3d worst %3d, overflows %3d worst_lag %02ld.%ld ms\n",
@@ -40,6 +64,7 @@ static bool __xframe_enqueue(struct xframe_queue *q, xframe_t *xframe)
 				q->overflows,
 				q->worst_lag_usec / 1000,
 				q->worst_lag_usec % 1000);
+		__xframe_dump_queue(q);
 		ret = 0;
 		goto out;
 	}
@@ -95,9 +120,9 @@ xframe_t *xframe_dequeue(struct xframe_queue *q)
 	spin_unlock_irqrestore(&q->lock, flags);
 	return frm;
 }
-void xframe_queue_disable(struct xframe_queue *q)
+void xframe_queue_disable(struct xframe_queue *q, bool disabled)
 {
-	q->max_count = 0;
+	q->disabled = disabled;
 }
 
 void xframe_queue_clear(struct xframe_queue *q)
@@ -106,7 +131,7 @@ void xframe_queue_clear(struct xframe_queue *q)
 	xbus_t		*xbus = q->priv;
 	int		i = 0;
 
-	xframe_queue_disable(q);
+	xframe_queue_disable(q, 1);
 	while((xframe = xframe_dequeue(q)) != NULL) {
 		transport_free_xframe(xbus, xframe);
 		i++;