109 lines
2.2 KiB
C
109 lines
2.2 KiB
C
|
#include <stdio.h>
|
||
|
#include <stdlib.h>
|
||
|
#include <string.h>
|
||
|
#include <stdarg.h>
|
||
|
#include <inttypes.h>
|
||
|
#include <fcntl.h>
|
||
|
|
||
|
#include <hexagram/can.h>
|
||
|
#include <hexagram/capture.h>
|
||
|
|
||
|
#include "can2dump.h"
|
||
|
|
||
|
char *hexagram_arglist_can2dump(void) {
|
||
|
return "ifname [file.can] [candump.txt]";
|
||
|
}
|
||
|
|
||
|
static void usage(int argc, char **argv, const char *message, ...) {
|
||
|
if (message) {
|
||
|
va_list args;
|
||
|
|
||
|
va_start(args, message);
|
||
|
vfprintf(stderr, message, args);
|
||
|
va_end(args);
|
||
|
}
|
||
|
|
||
|
fprintf(stderr, "usage: hexagram %s %s\n", argv[0], hexagram_arglist_can2dump());
|
||
|
|
||
|
exit(1);
|
||
|
}
|
||
|
|
||
|
static int convert(hexagram_capture *capture, const char *file, const char *ifname) {
|
||
|
struct timeval timestamp;
|
||
|
struct can_frame frame;
|
||
|
|
||
|
FILE *fh;
|
||
|
|
||
|
if ((fh = fopen(file, "w")) == NULL) {
|
||
|
goto error_fopen;
|
||
|
}
|
||
|
|
||
|
while (hexagram_capture_read(capture, ×tamp, &frame) >= 0) {
|
||
|
|
||
|
}
|
||
|
|
||
|
fclose(fh);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
error_fopen:
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
int hexagram_main_can2dump(int argc, char **argv) {
|
||
|
hexagram_can_if *can_if;
|
||
|
hexagram_capture *capture;
|
||
|
|
||
|
if (argc == 2) {
|
||
|
if ((capture = hexagram_capture_open_fd(fileno(stdin), O_RDONLY)) == NULL) {
|
||
|
perror("hexagram_capture_open_fd()");
|
||
|
|
||
|
goto error_capture_open;
|
||
|
}
|
||
|
} else if (argc == 3) {
|
||
|
if ((capture = hexagram_capture_open_file(argv[2], O_RDONLY)) == NULL) {
|
||
|
perror("hexagram_capture_open_file()");
|
||
|
|
||
|
goto error_capture_open;
|
||
|
}
|
||
|
} else {
|
||
|
usage(argc, argv, NULL);
|
||
|
exit(1);
|
||
|
}
|
||
|
|
||
|
if ((can_if = hexagram_can_if_open(argv[1])) == NULL) {
|
||
|
perror("hexagram_can_if_open()");
|
||
|
|
||
|
goto error_can_if_open;
|
||
|
}
|
||
|
|
||
|
if (hexagram_capture_can2dump(capture, can_if, 1.0) < 0) {
|
||
|
perror("hexagram_capture_can2dump()");
|
||
|
|
||
|
goto error_capture_can2dump;
|
||
|
}
|
||
|
|
||
|
hexagram_can_if_close(can_if);
|
||
|
|
||
|
if (argc == 3) {
|
||
|
hexagram_capture_close(capture);
|
||
|
} else {
|
||
|
hexagram_capture_destroy(capture);
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
error_capture_can2dump:
|
||
|
hexagram_can_if_close(can_if);
|
||
|
|
||
|
error_can_if_open:
|
||
|
if (argc == 3) {
|
||
|
hexagram_capture_close(capture);
|
||
|
} else {
|
||
|
hexagram_capture_destroy(capture);
|
||
|
}
|
||
|
|
||
|
error_capture_open:
|
||
|
return 1;
|
||
|
}
|