From d7f28a0ffe36f73fe08729202f9c49ca5cac1dd4 Mon Sep 17 00:00:00 2001
From: Marc Kleine-Budde <mkl@pengutronix.de>
Date: Mon, 22 Jun 2020 11:23:12 +0200
Subject: [PATCH] canfdtest: can_echo_dut(): check received frame for
 consistency

Signed-off-by: Marc Kleine-Budde <mkl@pengutronix.de>
---
 canfdtest.c | 29 +++++++++++++++++++++++++++++
 1 file changed, 29 insertions(+)

diff --git a/canfdtest.c b/canfdtest.c
index 1f68f67..ba5c239 100644
--- a/canfdtest.c
+++ b/canfdtest.c
@@ -197,6 +197,34 @@ static int send_frame(struct can_frame *frame)
 	return 0;
 }
 
+static int check_frame(const struct can_frame *frame)
+{
+	int err = 0;
+	int i;
+	
+	if (frame->can_id != CAN_MSG_ID) {
+		printf("unexpected Message ID 0x%04x!\n", frame->can_id);
+		err = -1;
+	}
+
+	if (frame->can_dlc != CAN_MSG_LEN) {
+		printf("unexpected Message length %d!\n", frame->can_dlc);
+		err = -1;
+	}
+	
+	for (i = 1; i < frame->can_dlc; i++) {
+		if (frame->data[i] != frame->data[i-1]) {
+			printf("Frame inconsistent!\n");
+			print_frame(frame, 0);
+			err = -1;
+			goto out;
+		}
+	}
+
+ out:
+	return err;
+}
+
 static void inc_frame(struct can_frame *frame)
 {
 	int i;
@@ -221,6 +249,7 @@ static int can_echo_dut(void)
 			print_frame(&frame, 0);
 		}
 
+		check_frame(&frame);
 		inc_frame(&frame);
 		if (send_frame(&frame))
 			return -1;