More nd_ification of structures.

[tcpdump] / print-ntp.c

diff --git a/print-ntp.c b/print-ntp.c
index 5de5a875f968c4dc1f6e9188a845db803abaaa9a..f2fbd1aa0d17a3651096701f57694591eb676b6e 100644 (file)
--- a/print-ntp.c
+++ b/print-ntp.c
@@ -18,249 +18,569 @@
  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  *
  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  *

- * Format and print ntp packets.

  *     By Jeffrey Mogul/DECWRL
  *     loosely based on print-bootp.c
  */
 
  *     By Jeffrey Mogul/DECWRL
  *     loosely based on print-bootp.c
  */
 

+/* \summary: Network Time Protocol (NTP) printer */
+
+/*
+ * specification:
+ *
+ * RFC 1119 - NTPv2
+ * RFC 1305 - NTPv3
+ * RFC 5905 - NTPv4
+ */

 
 #ifdef HAVE_CONFIG_H
 #include "config.h"
 #endif
 
 
 #ifdef HAVE_CONFIG_H
 #include "config.h"
 #endif
 

-#include <tcpdump-stdinc.h>
+#include <netdissect-stdinc.h>

 
 

-#include <stdio.h>
-#include <string.h>

 #ifdef HAVE_STRFTIME
 #include <time.h>
 #endif
 
 #ifdef HAVE_STRFTIME
 #include <time.h>
 #endif
 

-#include "interface.h"
+#include "netdissect.h"

 #include "addrtoname.h"
 #include "extract.h"
 #include "addrtoname.h"
 #include "extract.h"

-#ifdef MODEMASK
-#ifndef lint
-static const char rcsid[] _U_ =
-    "@(#) $Header: /tcpdump/master/tcpdump/print-ntp.c,v 1.38 2003-11-15 00:39:33 guy Exp $ (LBL)";
-#endif
-#undef MODEMASK                                        /* Solaris sucks */
-#endif
-#include "ntp.h"

 
 

-static void p_sfix(const struct s_fixedpt *);
-static void p_ntp_time(const struct l_fixedpt *);
-static void p_ntp_delta(const struct l_fixedpt *, const struct l_fixedpt *);
+static const char tstr[] = " [|ntp]";

 
 /*
 
 /*

- * Print ntp requests
+ * Based on ntp.h from the U of MD implementation
+ *     This file is based on Version 2 of the NTP spec (RFC1119).

  */
  */

-void
-ntp_print(register const u_char *cp, u_int length)
-{
-       register const struct ntpdata *bp;
-       int mode, version, leapind;
-
-       bp = (struct ntpdata *)cp;
-       /* Note funny sized packets */
-       if (length != sizeof(struct ntpdata))
-               (void)printf(" [len=%d]", length);
-
-       TCHECK(bp->status);
-
-       version = (int)(bp->status & VERSIONMASK) >> 3;
-       printf("NTPv%d", version);
-
-       leapind = bp->status & LEAPMASK;
-       switch (leapind) {
-
-       case NO_WARNING:
-               break;
-
-       case PLUS_SEC:
-               fputs(" +1s", stdout);
-               break;
-
-       case MINUS_SEC:
-               fputs(" -1s", stdout);
-               break;
-       }
-
-       mode = bp->status & MODEMASK;
-       switch (mode) {
-
-       case MODE_UNSPEC:       /* unspecified */
-               fputs(" unspec", stdout);
-               break;

 
 

-       case MODE_SYM_ACT:      /* symmetric active */
-               fputs(" sym_act", stdout);
-               break;
+/*
+ *  Definitions for the masses
+ */
+#define        JAN_1970        INT64_T_CONSTANT(2208988800)    /* 1970 - 1900 in seconds */

 
 

-       case MODE_SYM_PAS:      /* symmetric passive */
-               fputs(" sym_pas", stdout);
-               break;
+/*
+ * Structure definitions for NTP fixed point values
+ *
+ *    0                          1                   2                   3
+ *    0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *   |                        Integer Part                          |
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *   |                        Fraction Part                         |
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *
+ *    0                          1                   2                   3
+ *    0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *   |           Integer Part       |     Fraction Part             |
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+*/
+struct l_fixedpt {
+       nd_uint32_t int_part;
+       nd_uint32_t fraction;
+};
+
+struct s_fixedpt {
+       nd_uint16_t int_part;
+       nd_uint16_t fraction;
+};
+
+/* rfc2030
+ *                      1                   2                   3
+ *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |LI | VN  |Mode |    Stratum    |     Poll      |   Precision   |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                          Root Delay                           |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                       Root Dispersion                         |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                     Reference Identifier                      |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                                                               |
+ * |                   Reference Timestamp (64)                    |
+ * |                                                               |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                                                               |
+ * |                   Originate Timestamp (64)                    |
+ * |                                                               |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                                                               |
+ * |                    Receive Timestamp (64)                     |
+ * |                                                               |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                                                               |
+ * |                    Transmit Timestamp (64)                    |
+ * |                                                               |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                 Key Identifier (optional) (32)                |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                                                               |
+ * |                                                               |
+ * |                 Message Digest (optional) (128)               |
+ * |                                                               |
+ * |                                                               |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ */

 
 

-       case MODE_CLIENT:       /* client */
-               fputs(" client", stdout);
-               break;
+/* Length of the NTP data message with the mandatory fields ("the header")
+ * and without any optional fields (extension, Key Identifier,
+ * Message Digest).
+ */
+#define NTP_TIMEMSG_MINLEN 48U
+
+struct ntp_time_data {
+       nd_uint8_t status;              /* status of local clock and leap info */
+       nd_uint8_t stratum;             /* Stratum level */
+       nd_int8_t ppoll;                /* poll value */
+       nd_int8_t precision;
+       struct s_fixedpt root_delay;
+       struct s_fixedpt root_dispersion;
+       nd_uint32_t refid;
+       struct l_fixedpt ref_timestamp;
+       struct l_fixedpt org_timestamp;
+       struct l_fixedpt rec_timestamp;
+       struct l_fixedpt xmt_timestamp;
+       nd_uint32_t key_id;
+       nd_uint8_t  message_digest[20];
+};
+/*
+ *     Leap Second Codes (high order two bits)
+ */
+#define        NO_WARNING      0x00    /* no warning */
+#define        PLUS_SEC        0x40    /* add a second (61 seconds) */
+#define        MINUS_SEC       0x80    /* minus a second (59 seconds) */
+#define        ALARM           0xc0    /* alarm condition (clock unsynchronized) */

 
 

-       case MODE_SERVER:       /* server */
-               fputs(" server", stdout);
-               break;
+/*
+ *     Clock Status Bits that Encode Version
+ */
+#define        NTPVERSION_1    0x08
+#define        VERSIONMASK     0x38
+#define        VERSIONSHIFT    3
+#define LEAPMASK       0xc0
+#define LEAPSHIFT      6
+#ifdef MODEMASK
+#undef MODEMASK                                        /* Solaris sucks */
+#endif
+#define        MODEMASK        0x07
+#define        MODESHIFT       0

 
 

-       case MODE_BROADCAST:    /* broadcast */
-               fputs(" bcast", stdout);
-               break;
+/*
+ *     Code values
+ */
+#define        MODE_UNSPEC     0       /* unspecified */
+#define        MODE_SYM_ACT    1       /* symmetric active */
+#define        MODE_SYM_PAS    2       /* symmetric passive */
+#define        MODE_CLIENT     3       /* client */
+#define        MODE_SERVER     4       /* server */
+#define        MODE_BROADCAST  5       /* broadcast */
+#define        MODE_CONTROL    6       /* control message */
+#define        MODE_RES2       7       /* reserved */

 
 

-       case MODE_RES1:         /* reserved */
-               fputs(" res1", stdout);
-               break;
+/*
+ *     Stratum Definitions
+ */
+#define        UNSPECIFIED     0
+#define        PRIM_REF        1       /* radio clock */
+#define        INFO_QUERY      62      /* **** THIS implementation dependent **** */
+#define        INFO_REPLY      63      /* **** THIS implementation dependent **** */
+
+static void p_sfix(netdissect_options *ndo, const struct s_fixedpt *);
+static void p_ntp_time(netdissect_options *, const struct l_fixedpt *);
+static void p_ntp_delta(netdissect_options *, const struct l_fixedpt *, const struct l_fixedpt *);
+static void p_poll(netdissect_options *, register const int);
+
+static const struct tok ntp_mode_values[] = {
+    { MODE_UNSPEC,    "unspecified" },
+    { MODE_SYM_ACT,   "symmetric active" },
+    { MODE_SYM_PAS,   "symmetric passive" },
+    { MODE_CLIENT,    "Client" },
+    { MODE_SERVER,    "Server" },
+    { MODE_BROADCAST, "Broadcast" },
+    { MODE_CONTROL,   "Control Message" },
+    { MODE_RES2,      "Reserved" },
+    { 0, NULL }
+};
+
+static const struct tok ntp_leapind_values[] = {
+    { NO_WARNING,     "" },
+    { PLUS_SEC,       "+1s" },
+    { MINUS_SEC,      "-1s" },
+    { ALARM,          "clock unsynchronized" },
+    { 0, NULL }
+};
+
+static const struct tok ntp_stratum_values[] = {
+       { UNSPECIFIED,  "unspecified" },
+       { PRIM_REF,     "primary reference" },
+       { 0, NULL }
+};
+
+/* draft-ietf-ntp-mode-6-cmds-02
+ *  0                   1                   2                   3
+ *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |LI |  VN |Mode |R|E|M| OpCode  |       Sequence Number         |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |            Status             |       Association ID          |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |            Offset             |            Count              |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                                                               |
+ * /                    Data (up to 468 bytes)                     /
+ * |                                                               |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                    Padding (optional)                         |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * |                                                               |
+ * /              Authenticator (optional, 96 bytes)               /
+ * |                                                               |
+ * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *
+ *               Figure 1: NTP Control Message Header
+ */

 
 

-       case MODE_RES2:         /* reserved */
-               fputs(" res2", stdout);
-               break;
+/* Length of the NTP control message with the mandatory fields ("the header")
+ * and without any optional fields (Data, Padding, Authenticator).
+ */
+#define NTP_CTRLMSG_MINLEN 12U
+
+struct ntp_control_data {
+       nd_uint8_t      magic;          /* LI, VN, Mode */
+       nd_uint8_t      control;        /* R, E, M, OpCode */
+       nd_uint16_t     sequence;       /* Sequence Number */
+       nd_uint16_t     status;         /* Status */
+       nd_uint16_t     assoc;          /* Association ID */
+       nd_uint16_t     offset;         /* Offset */
+       nd_uint16_t     count;          /* Count */
+       nd_uint8_t      data[564];      /* Data, [Padding, [Authenticator]] */
+};

 
 

-       }
+/*
+ * Print NTP time requests and responses
+ */
+static void
+ntp_time_print(netdissect_options *ndo,
+              register const struct ntp_time_data *bp, u_int length)
+{
+       uint8_t stratum;

 
 

-       TCHECK(bp->stratum);
-       printf(", strat %d", bp->stratum);
+       if (length < NTP_TIMEMSG_MINLEN)
+               goto invalid;

 
 

-       TCHECK(bp->ppoll);
-       printf(", poll %d", bp->ppoll);
+       ND_TCHECK_1(bp->stratum);
+       stratum = EXTRACT_U_1(bp->stratum);
+       ND_PRINT((ndo, ", Stratum %u (%s)",
+               stratum,
+               tok2str(ntp_stratum_values, (stratum >=2 && stratum<=15) ? "secondary reference" : "reserved", stratum)));

 
 

-       /* Can't TCHECK bp->precision bitfield so bp->distance + 0 instead */
-       TCHECK2(bp->distance, 0);
-       printf(", prec %d", bp->precision);
+       ND_TCHECK_1(bp->ppoll);
+       ND_PRINT((ndo, ", poll %d", EXTRACT_S_1(bp->ppoll)));
+       p_poll(ndo, EXTRACT_U_1(bp->ppoll));

 
 

-       if (!vflag)
-               return;
+       ND_TCHECK_1(bp->precision);
+       ND_PRINT((ndo, ", precision %d", EXTRACT_S_1(bp->precision)));

 
 

-       TCHECK(bp->distance);
-       fputs(" dist ", stdout);
-       p_sfix(&bp->distance);
+       ND_TCHECK(bp->root_delay);
+       ND_PRINT((ndo, "\n\tRoot Delay: "));
+       p_sfix(ndo, &bp->root_delay);

 
 

-       TCHECK(bp->dispersion);
-       fputs(", disp ", stdout);
-       p_sfix(&bp->dispersion);
+       ND_TCHECK(bp->root_dispersion);
+       ND_PRINT((ndo, ", Root dispersion: "));
+       p_sfix(ndo, &bp->root_dispersion);

 
 

-       TCHECK(bp->refid);
-       fputs(", ref ", stdout);
+       ND_TCHECK(bp->refid);
+       ND_PRINT((ndo, ", Reference-ID: "));

        /* Interpretation depends on stratum */
        /* Interpretation depends on stratum */

-       switch (bp->stratum) {
+       switch (stratum) {

 
        case UNSPECIFIED:
 
        case UNSPECIFIED:

-               printf("(unspec)");
+               ND_PRINT((ndo, "(unspec)"));

                break;
 
        case PRIM_REF:
                break;
 
        case PRIM_REF:

-               fn_printn((u_char *)&(bp->refid), 4, NULL);
+               if (fn_printn(ndo, (const u_char *)&(bp->refid), 4, ndo->ndo_snapend))
+                       goto trunc;

                break;
 
        case INFO_QUERY:
                break;
 
        case INFO_QUERY:

-               printf("%s INFO_QUERY", ipaddr_string(&(bp->refid)));
+               ND_PRINT((ndo, "%s INFO_QUERY", ipaddr_string(ndo, &(bp->refid))));

                /* this doesn't have more content */
                return;
 
        case INFO_REPLY:
                /* this doesn't have more content */
                return;
 
        case INFO_REPLY:

-               printf("%s INFO_REPLY", ipaddr_string(&(bp->refid)));
+               ND_PRINT((ndo, "%s INFO_REPLY", ipaddr_string(ndo, &(bp->refid))));

                /* this is too complex to be worth printing */
                return;
 
        default:
                /* this is too complex to be worth printing */
                return;
 
        default:

-               printf("%s", ipaddr_string(&(bp->refid)));
+               /* In NTPv4 (RFC 5905) refid is an IPv4 address or first 32 bits of
+                  MD5 sum of IPv6 address */
+               ND_PRINT((ndo, "0x%08x", EXTRACT_BE_U_4(&bp->refid)));

                break;
        }
 
                break;
        }
 

-       TCHECK(bp->reftime);
-       putchar('@');
-       p_ntp_time(&(bp->reftime));
+       ND_TCHECK(bp->ref_timestamp);
+       ND_PRINT((ndo, "\n\t  Reference Timestamp:  "));
+       p_ntp_time(ndo, &(bp->ref_timestamp));
+
+       ND_TCHECK(bp->org_timestamp);
+       ND_PRINT((ndo, "\n\t  Originator Timestamp: "));
+       p_ntp_time(ndo, &(bp->org_timestamp));
+
+       ND_TCHECK(bp->rec_timestamp);
+       ND_PRINT((ndo, "\n\t  Receive Timestamp:    "));
+       p_ntp_time(ndo, &(bp->rec_timestamp));
+
+       ND_TCHECK(bp->xmt_timestamp);
+       ND_PRINT((ndo, "\n\t  Transmit Timestamp:   "));
+       p_ntp_time(ndo, &(bp->xmt_timestamp));
+
+       ND_PRINT((ndo, "\n\t    Originator - Receive Timestamp:  "));
+       p_ntp_delta(ndo, &(bp->org_timestamp), &(bp->rec_timestamp));
+
+       ND_PRINT((ndo, "\n\t    Originator - Transmit Timestamp: "));
+       p_ntp_delta(ndo, &(bp->org_timestamp), &(bp->xmt_timestamp));
+
+       /* FIXME: this code is not aware of any extension fields */
+       if (length == NTP_TIMEMSG_MINLEN + 4) {         /* Optional: key-id (crypto-NAK) */
+               ND_TCHECK_4(bp->key_id);
+               ND_PRINT((ndo, "\n\tKey id: %u", EXTRACT_BE_U_4(bp->key_id)));
+       } else if (length == NTP_TIMEMSG_MINLEN + 4 + 16) {     /* Optional: key-id + 128-bit digest */
+               ND_TCHECK_4(bp->key_id);
+               ND_PRINT((ndo, "\n\tKey id: %u", EXTRACT_BE_U_4(bp->key_id)));
+               ND_TCHECK2(bp->message_digest, 16);
+                ND_PRINT((ndo, "\n\tAuthentication: %08x%08x%08x%08x",
+                              EXTRACT_BE_U_4(bp->message_digest),
+                              EXTRACT_BE_U_4(bp->message_digest + 4),
+                              EXTRACT_BE_U_4(bp->message_digest + 8),
+                              EXTRACT_BE_U_4(bp->message_digest + 12)));
+       } else if (length == NTP_TIMEMSG_MINLEN + 4 + 20) {     /* Optional: key-id + 160-bit digest */
+               ND_TCHECK_4(bp->key_id);
+               ND_PRINT((ndo, "\n\tKey id: %u", EXTRACT_BE_U_4(bp->key_id)));
+               ND_TCHECK2(bp->message_digest, 20);
+               ND_PRINT((ndo, "\n\tAuthentication: %08x%08x%08x%08x%08x",
+                              EXTRACT_BE_U_4(bp->message_digest),
+                              EXTRACT_BE_U_4(bp->message_digest + 4),
+                              EXTRACT_BE_U_4(bp->message_digest + 8),
+                              EXTRACT_BE_U_4(bp->message_digest + 12),
+                              EXTRACT_BE_U_4(bp->message_digest + 16)));
+       } else if (length > NTP_TIMEMSG_MINLEN) {
+               ND_PRINT((ndo, "\n\t(%u more bytes after the header)", length - NTP_TIMEMSG_MINLEN));
+       }
+       return;

 
 

-       TCHECK(bp->org);
-       fputs(" orig ", stdout);
-       p_ntp_time(&(bp->org));
+invalid:
+       ND_PRINT((ndo, " %s", istr));
+       ND_TCHECK2(*bp, length);
+       return;

 
 

-       TCHECK(bp->rec);
-       fputs(" rec ", stdout);
-       p_ntp_delta(&(bp->org), &(bp->rec));
+trunc:
+       ND_PRINT((ndo, " %s", tstr));
+}

 
 

-       TCHECK(bp->xmt);
-       fputs(" xmt ", stdout);
-       p_ntp_delta(&(bp->org), &(bp->xmt));
+/*
+ * Print NTP control message requests and responses
+ */
+static void
+ntp_control_print(netdissect_options *ndo,
+                 register const struct ntp_control_data *cd, u_int length)
+{
+       u_int8_t control, R, E, M, opcode;
+       uint16_t sequence, status, assoc, offset, count;
+
+       if (length < NTP_CTRLMSG_MINLEN)
+               goto invalid;
+
+       ND_TCHECK_1(cd->control);
+       control = EXTRACT_U_1(cd->control);
+       R = (control & 0x80) != 0;
+       E = (control & 0x40) != 0;
+       M = (control & 0x20) != 0;
+       opcode = control & 0x1f;
+       ND_PRINT((ndo, ", %s, %s, %s, OpCode=%u\n",
+                 R ? "Response" : "Request", E ? "Error" : "OK",
+                 M ? "More" : "Last", opcode));
+
+       ND_TCHECK_2(cd->sequence);
+       sequence = EXTRACT_BE_U_2(cd->sequence);
+       ND_PRINT((ndo, "\tSequence=%hu", sequence));
+
+       ND_TCHECK_2(cd->status);
+       status = EXTRACT_BE_U_2(cd->status);
+       ND_PRINT((ndo, ", Status=%#hx", status));
+
+       ND_TCHECK_2(cd->assoc);
+       assoc = EXTRACT_BE_U_2(cd->assoc);
+       ND_PRINT((ndo, ", Assoc.=%hu", assoc));
+
+       ND_TCHECK_2(cd->offset);
+       offset = EXTRACT_BE_U_2(cd->offset);
+       ND_PRINT((ndo, ", Offset=%hu", offset));
+
+       ND_TCHECK_2(cd->count);
+       count = EXTRACT_BE_U_2(cd->count);
+       ND_PRINT((ndo, ", Count=%hu", count));
+
+       if (NTP_CTRLMSG_MINLEN + count > length)
+               goto invalid;
+       if (count != 0) {
+               ND_TCHECK2(cd->data, count);
+               ND_PRINT((ndo, "\n\tTO-BE-DONE: data not interpreted"));
+       }
+       return;

 
 

+invalid:
+       ND_PRINT((ndo, " %s", istr));
+       ND_TCHECK2(*cd, length);

        return;
 
 trunc:
        return;
 
 trunc:

-       fputs(" [|ntp]", stdout);
+       ND_PRINT((ndo, " %s", tstr));
+}
+
+union ntpdata {
+       struct ntp_time_data    td;
+       struct ntp_control_data cd;
+};
+
+/*
+ * Print NTP requests, handling the common VN, LI, and Mode
+ */
+void
+ntp_print(netdissect_options *ndo,
+          register const u_char *cp, u_int length)
+{
+       register const union ntpdata *bp = (const union ntpdata *)cp;
+       int mode, version, leapind;
+       uint8_t status;
+
+       ND_TCHECK(bp->td.status);
+       status = EXTRACT_U_1(bp->td.status);
+
+       version = (status & VERSIONMASK) >> VERSIONSHIFT;
+       ND_PRINT((ndo, "NTPv%d", version));
+
+       mode = (status & MODEMASK) >> MODESHIFT;
+       if (!ndo->ndo_vflag) {
+               ND_PRINT((ndo, ", %s, length %u",
+                         tok2str(ntp_mode_values, "Unknown mode", mode),
+                         length));
+               return;
+       }
+
+       ND_PRINT((ndo, ", %s, length %u\n",
+                 tok2str(ntp_mode_values, "Unknown mode", mode), length));
+
+       /* leapind = (status & LEAPMASK) >> LEAPSHIFT; */
+       leapind = (status & LEAPMASK);
+       ND_PRINT((ndo, "\tLeap indicator: %s (%u)",
+                 tok2str(ntp_leapind_values, "Unknown", leapind),
+                 leapind));
+
+       if (mode >= MODE_UNSPEC && mode <= MODE_BROADCAST)
+               ntp_time_print(ndo, &bp->td, length);
+       else if (mode == MODE_CONTROL)
+               ntp_control_print(ndo, &bp->cd, length);
+       else
+               {;}                     /* XXX: not implemented! */
+       return;
+
+trunc:
+       ND_PRINT((ndo, " %s", tstr));

 }
 
 static void
 }
 
 static void

-p_sfix(register const struct s_fixedpt *sfp)
+p_sfix(netdissect_options *ndo,
+       register const struct s_fixedpt *sfp)

 {
        register int i;
        register int f;
 {
        register int i;
        register int f;

-       register float ff;
+       register double ff;

 
 

-       i = EXTRACT_16BITS(&sfp->int_part);
-       f = EXTRACT_16BITS(&sfp->fraction);
-       ff = f / 65536.0;       /* shift radix point by 16 bits */
-       f = ff * 1000000.0;     /* Treat fraction as parts per million */
-       printf("%d.%06d", i, f);
+       i = EXTRACT_BE_U_2(&sfp->int_part);
+       f = EXTRACT_BE_U_2(&sfp->fraction);
+       ff = f / 65536.0;               /* shift radix point by 16 bits */
+       f = (int)(ff * 1000000.0);      /* Treat fraction as parts per million */
+       ND_PRINT((ndo, "%d.%06d", i, f));

 }
 
 #define        FMAXINT (4294967296.0)  /* floating point rep. of MAXINT */
 
 static void
 }
 
 #define        FMAXINT (4294967296.0)  /* floating point rep. of MAXINT */
 
 static void

-p_ntp_time(register const struct l_fixedpt *lfp)
+p_ntp_time(netdissect_options *ndo,
+           register const struct l_fixedpt *lfp)

 {
 {

-       register int32_t i;
-       register u_int32_t uf;
-       register u_int32_t f;
-       register float ff;
+       register uint32_t i;
+       register uint32_t uf;
+       register uint32_t f;
+       register double ff;

 
 

-       i = EXTRACT_32BITS(&lfp->int_part);
-       uf = EXTRACT_32BITS(&lfp->fraction);
+       i = EXTRACT_BE_U_4(&lfp->int_part);
+       uf = EXTRACT_BE_U_4(&lfp->fraction);

        ff = uf;
        if (ff < 0.0)           /* some compilers are buggy */
                ff += FMAXINT;
        ff = uf;
        if (ff < 0.0)           /* some compilers are buggy */
                ff += FMAXINT;

-       ff = ff / FMAXINT;      /* shift radix point by 32 bits */
-       f = ff * 1000000000.0;  /* treat fraction as parts per billion */
-       printf("%u.%09d", i, f);
+       ff = ff / FMAXINT;                      /* shift radix point by 32 bits */
+       f = (uint32_t)(ff * 1000000000.0);      /* treat fraction as parts per billion */
+       ND_PRINT((ndo, "%u.%09d", i, f));

 
 #ifdef HAVE_STRFTIME
        /*
 
 #ifdef HAVE_STRFTIME
        /*

-        * For extra verbosity, print the time in human-readable format.
+        * print the UTC time in human-readable format.

         */
         */

-       if (vflag > 1 && i) {
-           time_t seconds = i - JAN_1970;
+       if (i) {
+           int64_t seconds_64bit = (int64_t)i - JAN_1970;
+           time_t seconds;

            struct tm *tm;
            char time_buf[128];
 
            struct tm *tm;
            char time_buf[128];
 

-           tm = localtime(&seconds);
-           strftime(time_buf, sizeof (time_buf), "%Y/%m/%d %H:%M:%S", tm);
-           printf (" (%s)", time_buf);
+           seconds = (time_t)seconds_64bit;
+           if (seconds != seconds_64bit) {
+               /*
+                * It doesn't fit into a time_t, so we can't hand it
+                * to gmtime.
+                */
+               ND_PRINT((ndo, " (unrepresentable)"));
+           } else {
+               tm = gmtime(&seconds);
+               if (tm == NULL) {
+                   /*
+                    * gmtime() can't handle it.
+                    * (Yes, that might happen with some version of
+                    * Microsoft's C library.)
+                    */
+                   ND_PRINT((ndo, " (unrepresentable)"));
+               } else {
+                   /* use ISO 8601 (RFC3339) format */
+                   strftime(time_buf, sizeof (time_buf), "%Y-%m-%dT%H:%M:%S", tm);
+                   ND_PRINT((ndo, " (%s)", time_buf));
+               }
+           }

        }
 #endif
 }
 
 /* Prints time difference between *lfp and *olfp */
 static void
        }
 #endif
 }
 
 /* Prints time difference between *lfp and *olfp */
 static void

-p_ntp_delta(register const struct l_fixedpt *olfp,
-           register const struct l_fixedpt *lfp)
+p_ntp_delta(netdissect_options *ndo,
+            register const struct l_fixedpt *olfp,
+            register const struct l_fixedpt *lfp)

 {
        register int32_t i;
 {
        register int32_t i;

-       register u_int32_t u, uf;
-       register u_int32_t ou, ouf;
-       register u_int32_t f;
-       register float ff;
+       register uint32_t u, uf;
+       register uint32_t ou, ouf;
+       register uint32_t f;
+       register double ff;

        int signbit;
 
        int signbit;
 

-       u = EXTRACT_32BITS(&lfp->int_part);
-       ou = EXTRACT_32BITS(&olfp->int_part);
-       uf = EXTRACT_32BITS(&lfp->fraction);
-       ouf = EXTRACT_32BITS(&olfp->fraction);
+       u = EXTRACT_BE_U_4(&lfp->int_part);
+       ou = EXTRACT_BE_U_4(&olfp->int_part);
+       uf = EXTRACT_BE_U_4(&lfp->fraction);
+       ouf = EXTRACT_BE_U_4(&olfp->fraction);

        if (ou == 0 && ouf == 0) {
        if (ou == 0 && ouf == 0) {

-               p_ntp_time(lfp);
+               p_ntp_time(ndo, lfp);

                return;
        }
 
                return;
        }
 


@@ -290,12 +610,22 @@ p_ntp_delta(register const struct l_fixedpt *olfp,
        ff = f;
        if (ff < 0.0)           /* some compilers are buggy */
                ff += FMAXINT;
        ff = f;
        if (ff < 0.0)           /* some compilers are buggy */
                ff += FMAXINT;

-       ff = ff / FMAXINT;      /* shift radix point by 32 bits */
-       f = ff * 1000000000.0;  /* treat fraction as parts per billion */
-       if (signbit)
-               putchar('-');
+       ff = ff / FMAXINT;                      /* shift radix point by 32 bits */
+       f = (uint32_t)(ff * 1000000000.0);      /* treat fraction as parts per billion */
+       ND_PRINT((ndo, "%s%d.%09d", signbit ? "-" : "+", i, f));
+}
+
+/* Prints polling interval in log2 as seconds or fraction of second */
+static void
+p_poll(netdissect_options *ndo,
+       register const int poll_interval)
+{
+       if (poll_interval <= -32 || poll_interval >= 32)
+               return;
+
+       if (poll_interval >= 0)
+               ND_PRINT((ndo, " (%us)", 1U << poll_interval));

        else
        else

-               putchar('+');
-       printf("%d.%09d", i, f);
+               ND_PRINT((ndo, " (1/%us)", 1U << -poll_interval));

 }
 
 }