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

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