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

   1 /*
   2  * Copyright (c) 2007
   3  *      paolo.abeni@email.it  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 Paolo Abeni.''
  13  * The name of author may not be used to endorse or promote products derived
  14  * from this software without specific prior written permission.
  15  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
  16  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
  17  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  18  */
  19
  20 /* \summary: Bluetooth printer */
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25
  26 #include "netdissect-stdinc.h"
  27
  28 #include "netdissect.h"
  29 #include "extract.h"
  30
  31 #ifdef DLT_BLUETOOTH_HCI_H4_WITH_PHDR
  32
  33 /*
  34  * Header prepended by libpcap to each bluetooth h4 frame;
  35  * the direction field is in network byte order.
  36  */
  37 typedef struct _bluetooth_h4_header {
  38         nd_uint32_t direction; /* if first bit is set direction is incoming */
  39 } bluetooth_h4_header;
  40
  41 #define BT_HDRLEN sizeof(bluetooth_h4_header)
  42
  43 /*
  44  * This is the top level routine of the printer.  'p' points
  45  * to the bluetooth header of the packet, 'h->ts' is the timestamp,
  46  * 'h->len' is the length of the packet off the wire, and 'h->caplen'
  47  * is the number of bytes actually captured.
  48  */
  49 void
  50 bt_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
  51 {
  52         u_int length = h->len;
  53         u_int caplen = h->caplen;
  54         const bluetooth_h4_header* hdr = (const bluetooth_h4_header*)p;
  55
  56         ndo->ndo_protocol = "bluetooth";
  57         nd_print_protocol(ndo);
  58         if (caplen < BT_HDRLEN) {
  59                 ndo->ndo_ll_hdr_len += caplen;
  60                 nd_print_trunc(ndo);
  61                 return;
  62         }
  63         ndo->ndo_ll_hdr_len += BT_HDRLEN;
  64         caplen -= BT_HDRLEN;
  65         length -= BT_HDRLEN;
  66         p += BT_HDRLEN;
  67         if (ndo->ndo_eflag)
  68                 ND_PRINT(", hci length %u, direction %s", length,
  69                          (GET_BE_U_4(hdr->direction)&0x1) ? "in" : "out");
  70
  71         if (!ndo->ndo_suppress_default_print)
  72                 ND_DEFAULTPRINT(p, caplen);
  73 }
  74 #endif