canfdtest: can_echo_dut(): move functionality to increment frame data into separate function

Signed-off-by: Marc Kleine-Budde <mkl@pengutronix.de>
pull/224/head
Marc Kleine-Budde 2020-06-22 11:13:43 +02:00
parent 645cd1b1ba
commit e393697112
1 changed files with 11 additions and 4 deletions

View File

@ -197,11 +197,19 @@ static int send_frame(struct can_frame *frame)
return 0; return 0;
} }
static void inc_frame(struct can_frame *frame)
{
int i;
frame->can_id++;
for (i = 0; i < frame->can_dlc; i++)
frame->data[i]++;
}
static int can_echo_dut(void) static int can_echo_dut(void)
{ {
unsigned int frame_count = 0; unsigned int frame_count = 0;
struct can_frame frame; struct can_frame frame;
int i;
while (running) { while (running) {
if (recv_frame(&frame)) if (recv_frame(&frame))
@ -212,9 +220,8 @@ static int can_echo_dut(void)
} else if (verbose > 1) { } else if (verbose > 1) {
print_frame(&frame, 0); print_frame(&frame, 0);
} }
frame.can_id++;
for (i = 0; i < frame.can_dlc; i++) inc_frame(&frame);
frame.data[i]++;
if (send_frame(&frame)) if (send_frame(&frame))
return -1; return -1;