sven
/
can-utils
mirror of https://github.com/linux-can/can-utils.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

cansequence: print out dropped packages by socket counter 

Signed-off-by: Marc Kleine-Budde <mkl@pengutronix.de>
pull/254/head^2
Marc Kleine-Budde 2015-05-10 22:48:36 +02:00
parent 985121aaad
commit 9567230494
1 changed files with 35 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

38
cansequence.c
View File

@ -78,10 +78,26 @@ static void sigterm(int signo)
static void do_receive() static void do_receive()
{ {
uint8_t ctrlmsg[CMSG_SPACE(sizeof(struct timeval)) + CMSG_SPACE(sizeof(__u32))];
struct iovec iov = {
.iov_base = &frame,
};
struct msghdr msg = {
.msg_iov = &iov,
.msg_iovlen = 1,
.msg_control = &ctrlmsg,
};
struct cmsghdr *cmsg;
const int dropmonitor_on = 1;
unsigned int seq_wrap = 0; unsigned int seq_wrap = 0;
uint8_t sequence = 0; uint8_t sequence = 0;
ssize_t nbytes; ssize_t nbytes;
if (setsockopt(s, SOL_SOCKET, SO_RXQ_OVFL,
&dropmonitor_on, sizeof(dropmonitor_on)) < 0) {
perror("setsockopt() SO_RXQ_OVFL not supported by your Linux Kernel");
}
/* enable recv. now */ /* enable recv. now */
if (setsockopt(s, SOL_CAN_RAW, CAN_RAW_FILTER, filter, sizeof(filter))) { if (setsockopt(s, SOL_CAN_RAW, CAN_RAW_FILTER, filter, sizeof(filter))) {
perror("setsockopt()"); perror("setsockopt()");
@ -89,7 +105,11 @@ static void do_receive()
} }
while ((infinite || loopcount--) && running) { while ((infinite || loopcount--) && running) {
nbytes = read(s, &frame, sizeof(struct can_frame)); msg.msg_iov[0].iov_len = sizeof(frame);
msg.msg_controllen = sizeof(ctrlmsg);
msg.msg_flags = 0;
nbytes = recvmsg(s, &msg, 0);
if (nbytes < 0) { if (nbytes < 0) {
perror("read()"); perror("read()");
exit(EXIT_FAILURE); exit(EXIT_FAILURE);
@ -104,8 +124,20 @@ static void do_receive()
printf("received frame. sequence number: %d\n", frame.data[0]); printf("received frame. sequence number: %d\n", frame.data[0]);
if (frame.data[0] != sequence) { if (frame.data[0] != sequence) {
printf("received wrong sequence count. expected: %d, got: %d\n", uint32_t overflows = 0;
sequence, frame.data[0]);
for (cmsg = CMSG_FIRSTHDR(&msg);
cmsg && (cmsg->cmsg_level == SOL_SOCKET);
cmsg = CMSG_NXTHDR(&msg,cmsg)) {
if (cmsg->cmsg_type == SO_RXQ_OVFL) {
memcpy(&overflows, CMSG_DATA(cmsg), sizeof(overflows));
break;
}
}
fprintf(stderr, "received wrong sequence count. expected: %d, got: %d, socket overflows: %u\n",
sequence, frame.data[0], overflows);
if (quit) if (quit)
exit(EXIT_FAILURE); exit(EXIT_FAILURE);