1*b636d99dSDavid van Moolenbroek /*
2*b636d99dSDavid van Moolenbroek * Copyright (c) 2009
3*b636d99dSDavid van Moolenbroek * Siemens AG, All rights reserved.
4*b636d99dSDavid van Moolenbroek * Dmitry Eremin-Solenikov (dbaryshkov@gmail.com)
5*b636d99dSDavid van Moolenbroek *
6*b636d99dSDavid van Moolenbroek * Redistribution and use in source and binary forms, with or without
7*b636d99dSDavid van Moolenbroek * modification, are permitted provided that: (1) source code distributions
8*b636d99dSDavid van Moolenbroek * retain the above copyright notice and this paragraph in its entirety, (2)
9*b636d99dSDavid van Moolenbroek * distributions including binary code include the above copyright notice and
10*b636d99dSDavid van Moolenbroek * this paragraph in its entirety in the documentation or other materials
11*b636d99dSDavid van Moolenbroek * provided with the distribution, and (3) all advertising materials mentioning
12*b636d99dSDavid van Moolenbroek * features or use of this software display the following acknowledgement:
13*b636d99dSDavid van Moolenbroek * ``This product includes software developed by the University of California,
14*b636d99dSDavid van Moolenbroek * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
15*b636d99dSDavid van Moolenbroek * the University nor the names of its contributors may be used to endorse
16*b636d99dSDavid van Moolenbroek * or promote products derived from this software without specific prior
17*b636d99dSDavid van Moolenbroek * written permission.
18*b636d99dSDavid van Moolenbroek * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
19*b636d99dSDavid van Moolenbroek * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
20*b636d99dSDavid van Moolenbroek * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
21*b636d99dSDavid van Moolenbroek */
22*b636d99dSDavid van Moolenbroek
23*b636d99dSDavid van Moolenbroek #define NETDISSECT_REWORKED
24*b636d99dSDavid van Moolenbroek #ifdef HAVE_CONFIG_H
25*b636d99dSDavid van Moolenbroek #include "config.h"
26*b636d99dSDavid van Moolenbroek #endif
27*b636d99dSDavid van Moolenbroek
28*b636d99dSDavid van Moolenbroek #include <tcpdump-stdinc.h>
29*b636d99dSDavid van Moolenbroek
30*b636d99dSDavid van Moolenbroek #include "interface.h"
31*b636d99dSDavid van Moolenbroek #include "addrtoname.h"
32*b636d99dSDavid van Moolenbroek
33*b636d99dSDavid van Moolenbroek #include "extract.h"
34*b636d99dSDavid van Moolenbroek
35*b636d99dSDavid van Moolenbroek static const char *ftypes[] = {
36*b636d99dSDavid van Moolenbroek "Beacon", /* 0 */
37*b636d99dSDavid van Moolenbroek "Data", /* 1 */
38*b636d99dSDavid van Moolenbroek "ACK", /* 2 */
39*b636d99dSDavid van Moolenbroek "Command", /* 3 */
40*b636d99dSDavid van Moolenbroek "Reserved", /* 4 */
41*b636d99dSDavid van Moolenbroek "Reserved", /* 5 */
42*b636d99dSDavid van Moolenbroek "Reserved", /* 6 */
43*b636d99dSDavid van Moolenbroek "Reserved", /* 7 */
44*b636d99dSDavid van Moolenbroek };
45*b636d99dSDavid van Moolenbroek
46*b636d99dSDavid van Moolenbroek static int
extract_header_length(uint16_t fc)47*b636d99dSDavid van Moolenbroek extract_header_length(uint16_t fc)
48*b636d99dSDavid van Moolenbroek {
49*b636d99dSDavid van Moolenbroek int len = 0;
50*b636d99dSDavid van Moolenbroek
51*b636d99dSDavid van Moolenbroek switch ((fc >> 10) & 0x3) {
52*b636d99dSDavid van Moolenbroek case 0x00:
53*b636d99dSDavid van Moolenbroek if (fc & (1 << 6)) /* intra-PAN with none dest addr */
54*b636d99dSDavid van Moolenbroek return -1;
55*b636d99dSDavid van Moolenbroek break;
56*b636d99dSDavid van Moolenbroek case 0x01:
57*b636d99dSDavid van Moolenbroek return -1;
58*b636d99dSDavid van Moolenbroek case 0x02:
59*b636d99dSDavid van Moolenbroek len += 4;
60*b636d99dSDavid van Moolenbroek break;
61*b636d99dSDavid van Moolenbroek case 0x03:
62*b636d99dSDavid van Moolenbroek len += 10;
63*b636d99dSDavid van Moolenbroek break;
64*b636d99dSDavid van Moolenbroek }
65*b636d99dSDavid van Moolenbroek
66*b636d99dSDavid van Moolenbroek switch ((fc >> 14) & 0x3) {
67*b636d99dSDavid van Moolenbroek case 0x00:
68*b636d99dSDavid van Moolenbroek break;
69*b636d99dSDavid van Moolenbroek case 0x01:
70*b636d99dSDavid van Moolenbroek return -1;
71*b636d99dSDavid van Moolenbroek case 0x02:
72*b636d99dSDavid van Moolenbroek len += 4;
73*b636d99dSDavid van Moolenbroek break;
74*b636d99dSDavid van Moolenbroek case 0x03:
75*b636d99dSDavid van Moolenbroek len += 10;
76*b636d99dSDavid van Moolenbroek break;
77*b636d99dSDavid van Moolenbroek }
78*b636d99dSDavid van Moolenbroek
79*b636d99dSDavid van Moolenbroek if (fc & (1 << 6)) {
80*b636d99dSDavid van Moolenbroek if (len < 2)
81*b636d99dSDavid van Moolenbroek return -1;
82*b636d99dSDavid van Moolenbroek len -= 2;
83*b636d99dSDavid van Moolenbroek }
84*b636d99dSDavid van Moolenbroek
85*b636d99dSDavid van Moolenbroek return len;
86*b636d99dSDavid van Moolenbroek }
87*b636d99dSDavid van Moolenbroek
88*b636d99dSDavid van Moolenbroek
89*b636d99dSDavid van Moolenbroek u_int
ieee802_15_4_if_print(netdissect_options * ndo,const struct pcap_pkthdr * h,const u_char * p)90*b636d99dSDavid van Moolenbroek ieee802_15_4_if_print(netdissect_options *ndo,
91*b636d99dSDavid van Moolenbroek const struct pcap_pkthdr *h, const u_char *p)
92*b636d99dSDavid van Moolenbroek {
93*b636d99dSDavid van Moolenbroek u_int caplen = h->caplen;
94*b636d99dSDavid van Moolenbroek int hdrlen;
95*b636d99dSDavid van Moolenbroek uint16_t fc;
96*b636d99dSDavid van Moolenbroek uint8_t seq;
97*b636d99dSDavid van Moolenbroek
98*b636d99dSDavid van Moolenbroek if (caplen < 3) {
99*b636d99dSDavid van Moolenbroek ND_PRINT((ndo, "[|802.15.4] %x", caplen));
100*b636d99dSDavid van Moolenbroek return caplen;
101*b636d99dSDavid van Moolenbroek }
102*b636d99dSDavid van Moolenbroek
103*b636d99dSDavid van Moolenbroek fc = EXTRACT_LE_16BITS(p);
104*b636d99dSDavid van Moolenbroek hdrlen = extract_header_length(fc);
105*b636d99dSDavid van Moolenbroek
106*b636d99dSDavid van Moolenbroek seq = EXTRACT_LE_8BITS(p + 2);
107*b636d99dSDavid van Moolenbroek
108*b636d99dSDavid van Moolenbroek p += 3;
109*b636d99dSDavid van Moolenbroek caplen -= 3;
110*b636d99dSDavid van Moolenbroek
111*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"IEEE 802.15.4 %s packet ", ftypes[fc & 0x7]));
112*b636d99dSDavid van Moolenbroek if (ndo->ndo_vflag)
113*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"seq %02x ", seq));
114*b636d99dSDavid van Moolenbroek if (hdrlen == -1) {
115*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"malformed! "));
116*b636d99dSDavid van Moolenbroek return caplen;
117*b636d99dSDavid van Moolenbroek }
118*b636d99dSDavid van Moolenbroek
119*b636d99dSDavid van Moolenbroek
120*b636d99dSDavid van Moolenbroek if (!ndo->ndo_vflag) {
121*b636d99dSDavid van Moolenbroek p+= hdrlen;
122*b636d99dSDavid van Moolenbroek caplen -= hdrlen;
123*b636d99dSDavid van Moolenbroek } else {
124*b636d99dSDavid van Moolenbroek uint16_t panid = 0;
125*b636d99dSDavid van Moolenbroek
126*b636d99dSDavid van Moolenbroek switch ((fc >> 10) & 0x3) {
127*b636d99dSDavid van Moolenbroek case 0x00:
128*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"none "));
129*b636d99dSDavid van Moolenbroek break;
130*b636d99dSDavid van Moolenbroek case 0x01:
131*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"reserved destination addressing mode"));
132*b636d99dSDavid van Moolenbroek return 0;
133*b636d99dSDavid van Moolenbroek case 0x02:
134*b636d99dSDavid van Moolenbroek panid = EXTRACT_LE_16BITS(p);
135*b636d99dSDavid van Moolenbroek p += 2;
136*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"%04x:%04x ", panid, EXTRACT_LE_16BITS(p)));
137*b636d99dSDavid van Moolenbroek p += 2;
138*b636d99dSDavid van Moolenbroek break;
139*b636d99dSDavid van Moolenbroek case 0x03:
140*b636d99dSDavid van Moolenbroek panid = EXTRACT_LE_16BITS(p);
141*b636d99dSDavid van Moolenbroek p += 2;
142*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"%04x:%s ", panid, le64addr_string(p)));
143*b636d99dSDavid van Moolenbroek p += 8;
144*b636d99dSDavid van Moolenbroek break;
145*b636d99dSDavid van Moolenbroek }
146*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"< "));
147*b636d99dSDavid van Moolenbroek
148*b636d99dSDavid van Moolenbroek switch ((fc >> 14) & 0x3) {
149*b636d99dSDavid van Moolenbroek case 0x00:
150*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"none "));
151*b636d99dSDavid van Moolenbroek break;
152*b636d99dSDavid van Moolenbroek case 0x01:
153*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"reserved source addressing mode"));
154*b636d99dSDavid van Moolenbroek return 0;
155*b636d99dSDavid van Moolenbroek case 0x02:
156*b636d99dSDavid van Moolenbroek if (!(fc & (1 << 6))) {
157*b636d99dSDavid van Moolenbroek panid = EXTRACT_LE_16BITS(p);
158*b636d99dSDavid van Moolenbroek p += 2;
159*b636d99dSDavid van Moolenbroek }
160*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"%04x:%04x ", panid, EXTRACT_LE_16BITS(p)));
161*b636d99dSDavid van Moolenbroek p += 2;
162*b636d99dSDavid van Moolenbroek break;
163*b636d99dSDavid van Moolenbroek case 0x03:
164*b636d99dSDavid van Moolenbroek if (!(fc & (1 << 6))) {
165*b636d99dSDavid van Moolenbroek panid = EXTRACT_LE_16BITS(p);
166*b636d99dSDavid van Moolenbroek p += 2;
167*b636d99dSDavid van Moolenbroek }
168*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"%04x:%s ", panid, le64addr_string(p)));
169*b636d99dSDavid van Moolenbroek p += 8;
170*b636d99dSDavid van Moolenbroek break;
171*b636d99dSDavid van Moolenbroek }
172*b636d99dSDavid van Moolenbroek
173*b636d99dSDavid van Moolenbroek caplen -= hdrlen;
174*b636d99dSDavid van Moolenbroek }
175*b636d99dSDavid van Moolenbroek
176*b636d99dSDavid van Moolenbroek if (!ndo->ndo_suppress_default_print)
177*b636d99dSDavid van Moolenbroek ND_DEFAULTPRINT(p, caplen);
178*b636d99dSDavid van Moolenbroek
179*b636d99dSDavid van Moolenbroek return 0;
180*b636d99dSDavid van Moolenbroek }
181