The Tcpdump Group git mirrors - tcpdump/blob - print-zep.c

   1 /*
   2  * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994, 1995, 1996, 1997
   3  *      The Regents of the University of California.  All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that: (1) source code distributions
   7  * retain the above copyright notice and this paragraph in its entirety, (2)
   8  * distributions including binary code include the above copyright notice and
   9  * this paragraph in its entirety in the documentation or other materials
  10  * provided with the distribution, and (3) all advertising materials mentioning
  11  * features or use of this software display the following acknowledgement:
  12  * ``This product includes software developed by the University of California,
  13  * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
  14  * the University nor the names of its contributors may be used to endorse
  15  * or promote products derived from this software without specific prior
  16  * written permission.
  17  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
  18  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
  19  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  20  */
  21
  22 /* \summary: ZigBee Encapsulation Protocol (ZEP) printer */
  23
  24 #ifdef HAVE_CONFIG_H
  25 #include <config.h>
  26 #endif
  27
  28 #include "netdissect-stdinc.h"
  29
  30 #include "netdissect.h"
  31
  32 #include "extract.h"
  33
  34 /* From wireshark packet-zep.c:
  35  *
  36  ***********************************************************************
  37  *
  38  * ZEP Packets must be received in the following format:
  39  *
  40  * |UDP Header|  ZEP Header |IEEE 802.15.4 Packet|
  41  * | 8 bytes  | 16/32 bytes |    <= 127 bytes    |
  42  *
  43  ***********************************************************************
  44  *
  45  * ZEP v1 Header will have the following format:
  46  * |Preamble|Version|Channel ID|Device ID|CRC/LQI Mode|LQI Val|Reserved|Length|
  47  * |2 bytes |1 byte |  1 byte  | 2 bytes |   1 byte   |1 byte |7 bytes |1 byte|
  48  *
  49  * ZEP v2 Header will have the following format (if type=1/Data):
  50  * |Prmbl|Ver  |Type |ChnlID|DevID|C/L Mode|LQI|NTP TS|Seq#|Res |Len|
  51  * | 2   | 1   | 1   | 1    | 2   | 1      | 1 | 8    | 4  | 10 | 1 |
  52  *
  53  * ZEP v2 Header will have the following format (if type=2/Ack):
  54  * |Preamble|Version| Type |Sequence#|
  55  * |2 bytes |1 byte |1 byte| 4 bytes |
  56  *------------------------------------------------------------
  57  */
  58
  59 #define     JAN_1970        2208988800U
  60
  61 /* Print timestamp */
  62 static void zep_print_ts(netdissect_options *ndo, const u_char *p)
  63 {
  64         int32_t i;
  65         uint32_t uf;
  66         uint32_t f;
  67         float ff;
  68
  69         i = GET_BE_U_4(p);
  70         uf = GET_BE_U_4(p + 4);
  71         ff = (float) uf;
  72         if (ff < 0.0)           /* some compilers are buggy */
  73                 ff += FMAXINT;
  74         ff = (float) (ff / FMAXINT); /* shift radix point by 32 bits */
  75         f = (uint32_t) (ff * 1000000000.0);  /* treat fraction as parts per
  76                                                 billion */
  77         ND_PRINT("%u.%09d", i, f);
  78
  79 #ifdef HAVE_STRFTIME
  80         /*
  81          * print the time in human-readable format.
  82          */
  83         if (i) {
  84                 time_t seconds = i - JAN_1970;
  85                 struct tm *tm;
  86                 char time_buf[128];
  87
  88                 tm = localtime(&seconds);
  89                 strftime(time_buf, sizeof (time_buf), "%Y/%m/%d %H:%M:%S", tm);
  90                 ND_PRINT(" (%s)", time_buf);
  91         }
  92 #endif
  93 }
  94
  95 /*
  96  * Main function to print packets.
  97  */
  98
  99 void
 100 zep_print(netdissect_options *ndo,
 101           const u_char *bp, u_int len)
 102 {
 103         uint8_t version, inner_len;
 104         uint32_t seq_no;
 105
 106         ndo->ndo_protocol = "zep";
 107
 108         nd_print_protocol_caps(ndo);
 109
 110         ND_TCHECK_LEN(bp, 8);
 111
 112         /* Preamble Code (must be "EX") */
 113         if (GET_U_1(bp) != 'E' || GET_U_1(bp + 1) != 'X') {
 114                 ND_PRINT(" [Preamble Code: ");
 115                 fn_print_char(ndo, GET_U_1(bp));
 116                 fn_print_char(ndo, GET_U_1(bp + 1));
 117                 ND_PRINT("]");
 118                 nd_print_invalid(ndo);
 119                 return;
 120         }
 121
 122         version = GET_U_1(bp + 2);
 123         ND_PRINT("v%u ", version);
 124
 125         if (version == 1) {
 126                 /* ZEP v1 packet. */
 127                 ND_TCHECK_LEN(bp, 16);
 128                 ND_PRINT("Channel ID %u, Device ID 0x%04x, ",
 129                          GET_U_1(bp + 3), GET_BE_U_2(bp + 4));
 130                 if (GET_U_1(bp + 6))
 131                         ND_PRINT("CRC, ");
 132                 else
 133                         ND_PRINT("LQI %u, ", GET_U_1(bp + 7));
 134                 inner_len = GET_U_1(bp + 15);
 135                 ND_PRINT("inner len = %u", inner_len);
 136
 137                 bp += 16;
 138                 len -= 16;
 139         } else {
 140                 /* ZEP v2 packet. */
 141                 if (GET_U_1(bp + 3) == 2) {
 142                         /* ZEP v2 ack. */
 143                         seq_no = GET_BE_U_4(bp + 4);
 144                         ND_PRINT("ACK, seq# = %u", seq_no);
 145                         inner_len = 0;
 146                         bp += 8;
 147                         len -= 8;
 148                 } else {
 149                         /* ZEP v2 data, or some other. */
 150                         ND_TCHECK_LEN(bp, 32);
 151
 152                         ND_PRINT("Type %u, Channel ID %u, Device ID 0x%04x, ",
 153                                  GET_U_1(bp + 3), GET_U_1(bp + 4),
 154                                  GET_BE_U_2(bp + 5));
 155                         if (GET_U_1(bp + 7))
 156                                 ND_PRINT("CRC, ");
 157                         else
 158                                 ND_PRINT("LQI %u, ", GET_U_1(bp + 8));
 159
 160                         zep_print_ts(ndo, bp + 9);
 161                         seq_no = GET_BE_U_4(bp + 17);
 162                         inner_len = GET_U_1(bp + 31);
 163                         ND_PRINT(", seq# = %u, inner len = %u",
 164                                  seq_no, inner_len);
 165                         bp += 32;
 166                         len -= 32;
 167                 }
 168         }
 169
 170         if (inner_len != 0) {
 171                 /* Call 802.15.4 dissector. */
 172                 ND_PRINT("\n\t");
 173                 if (ieee802_15_4_print(ndo, bp, inner_len)) {
 174                         bp += len;
 175                         len = 0;
 176                 }
 177         }
 178
 179         if (!ndo->ndo_suppress_default_print)
 180                 ND_DEFAULTPRINT(bp, len);
 181
 182         return;
 183  trunc:
 184         nd_print_trunc(ndo);
 185 }