candump: Enable HW timestamping before using it

[can-utils.git] / canplayer.c

diff --git a/canplayer.c b/canplayer.c
index 9494a6d44cf10efdd75f0e408267ea0baceeb9a7..437ed4bc8aef4c9cc3fc75de6952086de6de8034 100644 (file)
--- a/canplayer.c
+++ b/canplayer.c
@@ -1,7 +1,3 @@
-/*
- *  $Id$
- */
-
 /*
  * canplayer.c - replay a compact CAN frame logfile to CAN devices
  *
@@ -41,7 +37,7 @@
  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
  * DAMAGE.
  *
- * Send feedback to <socketcan-users@lists.berlios.de>
+ * Send feedback to <linux-can@vger.kernel.org>
  *
  */
 
@@ -53,6 +49,7 @@
 #include <unistd.h>
 
 #include <net/if.h>
+#include <sys/socket.h>
 #include <sys/ioctl.h>
 #include <sys/time.h>
 #include <linux/can.h>
@@ -63,7 +60,8 @@
 #define DEFAULT_GAP    1       /* ms */
 #define DEFAULT_LOOPS  1       /* only one replay */
 #define CHANNELS       20      /* anyone using more than 20 CAN interfaces at a time? */
-#define BUFSZ          400     /* for one line in the logfile */
+#define COMMENTSZ 200
+#define BUFSZ (sizeof("(1345212884.318850)") + IFNAMSIZ + 4 + CL_CFSZ + COMMENTSZ) /* for one line in the logfile */
 #define STDOUTIDX      65536   /* interface index for printing on stdout - bigger than max uint16 */
 
 struct assignment {
@@ -72,6 +70,7 @@ struct assignment {
        char rxif[IFNAMSIZ];
 };
 static struct assignment asgn[CHANNELS];
+const int canfd_on = 1;
 
 extern int optind, opterr, optopt;
 
@@ -87,7 +86,7 @@ void print_usage(char *prg)
                "send frames immediately)\n");
        fprintf(stderr, "                      -g <ms>      (gap in milli "
                "seconds - default: %d ms)\n", DEFAULT_GAP);
-       fprintf(stderr, "                      -s <s>      (skip gaps in "
+       fprintf(stderr, "                      -s <s>       (skip gaps in "
                "timestamps > 's' seconds)\n");
        fprintf(stderr, "                      -x           (disable local "
                "loopback of sent CAN frames)\n");
@@ -235,20 +234,21 @@ int main(int argc, char **argv)
 {
        static char buf[BUFSZ], device[BUFSZ], ascframe[BUFSZ];
        struct sockaddr_can addr;
-       static struct can_frame frame;
+       static struct canfd_frame frame;
        static struct timeval today_tv, log_tv, last_log_tv, diff_tv;
        struct timespec sleep_ts;
        int s; /* CAN_RAW socket */
        FILE *infile = stdin;
        unsigned long gap = DEFAULT_GAP; 
        int use_timestamps = 1;
-       static int verbose, opt, delay_loops, skipgap;
+       static int verbose, opt, delay_loops;
+       static unsigned long skipgap;
        static int loopback_disable = 0;
        static int infinite_loops = 0;
        static int loops = DEFAULT_LOOPS;
        int assignments; /* assignments defined on the commandline */
        int txidx;       /* sendto() interface index */
-       int eof, nbytes, i, j;
+       int eof, txmtu, i, j;
        char *fret;
 
        while ((opt = getopt(argc, argv, "I:l:tg:s:xv?")) != -1) {
@@ -310,11 +310,12 @@ int main(int argc, char **argv)
                loops = 1;
        }
 
-       if (verbose > 1) /* use -v -v to see this */
+       if (verbose > 1) { /* use -v -v to see this */
                if (infinite_loops)
                        printf("infinite_loops\n");
                else
                        printf("%d loops\n", loops);
+       }
 
        sleep_ts.tv_sec  =  gap / 1000;
        sleep_ts.tv_nsec = (gap % 1000) * 1000000;
@@ -331,6 +332,9 @@ int main(int argc, char **argv)
        /* disable unneeded default receive filter on this RAW socket */
        setsockopt(s, SOL_CAN_RAW, CAN_RAW_FILTER, NULL, 0);
 
+       /* try to switch the socket into CAN FD mode */
+       setsockopt(s, SOL_CAN_RAW, CAN_RAW_FD_FRAMES, &canfd_on, sizeof(canfd_on));
+
        if (loopback_disable) {
                int loopback = 0;
 
@@ -430,7 +434,8 @@ int main(int argc, char **argv)
 
                                } else if (txidx > 0) { /* only send to valid CAN devices */
 
-                                       if (parse_canframe(ascframe, &frame)) {
+                                       txmtu = parse_canframe(ascframe, &frame);
+                                       if (!txmtu) {
                                                fprintf(stderr, "wrong CAN frame format: '%s'!", ascframe);
                                                return 1;
                                        }
@@ -438,17 +443,18 @@ int main(int argc, char **argv)
                                        addr.can_family  = AF_CAN;
                                        addr.can_ifindex = txidx; /* send via this interface */
  
-                                       nbytes = sendto(s, &frame, sizeof(struct can_frame), 0,
-                                                       (struct sockaddr*)&addr, sizeof(addr));
-
-                                       if (nbytes != sizeof(struct can_frame)) {
+                                       if (sendto(s, &frame, txmtu, 0, (struct sockaddr*)&addr, sizeof(addr)) != txmtu) {
                                                perror("sendto");
                                                return 1;
                                        }
 
                                        if (verbose) {
                                                printf("%s (%s) ", get_txname(device), device);
-                                               fprint_long_canframe(stdout, &frame, "\n", 1);
+
+                                               if (txmtu == CAN_MTU)
+                                                       fprint_long_canframe(stdout, &frame, "\n", CANLIB_VIEW_INDENT_SFF, CAN_MAX_DLEN);
+                                               else
+                                                       fprint_long_canframe(stdout, &frame, "\n", CANLIB_VIEW_INDENT_SFF, CANFD_MAX_DLEN);
                                        }
                                }
 
@@ -477,7 +483,7 @@ int main(int argc, char **argv)
                                        /* test for logfile timestamps jumping backwards OR      */
                                        /* if the user likes to skip long gaps in the timestamps */
                                        if ((last_log_tv.tv_sec > log_tv.tv_sec) ||
-                                           (skipgap && abs(last_log_tv.tv_sec - log_tv.tv_sec) > skipgap))
+                                           (skipgap && labs(last_log_tv.tv_sec - log_tv.tv_sec) > skipgap))
                                                create_diff_tv(&today_tv, &diff_tv, &log_tv);
 
                                        last_log_tv = log_tv;