#include <stdio.h>
#include <signal.h>
#include <errno.h>
#include <unistd.h>
#define ALARM_INTERVAL_IN_S (1)
#define READ_WAIT_INFINITE (unsigned long)(-1)
static unsigned int msgCounter = 0;
static unsigned int std = 0, ext = 0, rtr = 0, err = 0, over = 0;
{
char buf[50];
buf[0] = '\0';
printf("%s: failed, stat=%d (%s)\n", id, (int)stat, buf);
}
}
static void sighand(int sig)
{
static unsigned int last;
switch (sig) {
case SIGINT:
break;
case SIGALRM:
if (msgCounter - last) {
printf("msg/s = %d, total=%u, std=%u, ext=%u, err=%u, over=%u\n",
(msgCounter - last) / ALARM_INTERVAL_IN_S, msgCounter, std, ext, err, over);
}
last = msgCounter;
alarm(ALARM_INTERVAL_IN_S);
break;
}
}
static void printUsageAndExit(char *prgName)
{
printf("Usage: '%s <channel>'\n", prgName);
exit(1);
}
int main(int argc, char *argv[])
{
int channel;
if (argc != 2) {
printUsageAndExit(argv[0]);
}
{
char *endPtr = NULL;
errno = 0;
channel = strtol(argv[1], &endPtr, 10);
if ( (errno != 0) || ((channel == 0) && (endPtr == argv[1])) ) {
printUsageAndExit(argv[0]);
}
}
signal(SIGALRM, sighand);
signal(SIGINT, sighand);
siginterrupt(SIGINT, 1);
printf("Counting messages on channel %d\n", channel);
if (hnd < 0) {
printf("canOpenChannel %d", channel);
check("", hnd);
return -1;
}
check("canSetBusParams", stat);
goto ErrorExit;
}
check("canBusOn", stat);
goto ErrorExit;
}
alarm(ALARM_INTERVAL_IN_S);
do {
long id;
unsigned char msg[8];
unsigned int dlc;
unsigned int flag;
unsigned long time;
stat =
canReadWait(hnd, &
id, &msg, &dlc, &flag, &time, READ_WAIT_INFINITE);
err++;
} else {
}
msgCounter++;
}
else {
if (errno == 0) {
check("\ncanReadWait", stat);
}
else {
perror("\ncanReadWait error");
}
}
sighand(SIGALRM);
ErrorExit:
alarm(0);
check("canBusOff", stat);
check("canClose", stat);
check("canUnloadLibrary", stat);
return 0;
}