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