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(const struct pcap_pkthdr *h, const u_char *p)
  91 {
  92         u_int caplen = h->caplen;
  93         u_int hdrlen;
  94         u_int16_t fc;
  95         u_int8_t seq;
  96
  97         if (caplen < 3) {
  98                 printf("[|802.15.4] %x", caplen);
  99                 return caplen;
 100         }
 101
 102         fc = EXTRACT_LE_16BITS(p);
 103         hdrlen = extract_header_length(fc);
 104
 105         seq = EXTRACT_LE_8BITS(p + 2);
 106
 107         p += 3;
 108         caplen -= 3;
 109
 110         printf("IEEE 802.15.4 %s packet ", ftypes[fc & 0x7]);
 111         if (vflag)
 112                 printf("seq %02x ", seq);
 113         if (hdrlen == -1) {
 114                 printf("malformed! ");
 115                 return caplen;
 116         }
 117
 118
 119         if (!vflag) {
 120                 p+= hdrlen;
 121                 caplen -= hdrlen;
 122         } else {
 123                 u_int16_t panid;
 124
 125                 switch ((fc >> 10) & 0x3) {
 126                 case 0x00:
 127                         printf("none ");
 128                         break;
 129                 case 0x02:
 130                         panid = EXTRACT_LE_16BITS(p);
 131                         p += 2;
 132                         printf("%04x:%04x ", panid, EXTRACT_LE_16BITS(p));
 133                         p += 2;
 134                         break;
 135                 case 0x03:
 136                         panid = EXTRACT_LE_16BITS(p);
 137                         p += 2;
 138                         printf("%04x:%s ", panid, le64addr_string(p));
 139                         p += 8;
 140                         break;
 141                 }
 142                 printf("< ");
 143
 144                 switch ((fc >> 14) & 0x3) {
 145                 case 0x00:
 146                         printf("none ");
 147                         break;
 148                 case 0x02:
 149                         if (!(fc & (1 << 6))) {
 150                                 panid = EXTRACT_LE_16BITS(p);
 151                                 p += 2;
 152                         }
 153                         printf("%04x:%04x ", panid, EXTRACT_LE_16BITS(p));
 154                         p += 2;
 155                         break;
 156                 case 0x03:
 157                         if (!(fc & (1 << 6))) {
 158                                 panid = EXTRACT_LE_16BITS(p);
 159                                 p += 2;
 160                         }
 161                         printf("%04x:%s ", panid, le64addr_string(p));
 162                         p += 8;
 163                         break;
 164                 }
 165
 166                 caplen -= hdrlen;
 167         }
 168
 169         if (!suppress_default_print)
 170                 default_print(p, caplen);
 171
 172         return 0;
 173 }