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 #include <config.h>
  23
  24 #include "netdissect-stdinc.h"
  25
  26 #define ND_LONGJMP_FROM_TCHECK
  27 #include "netdissect.h"
  28 #include "extract.h"
  29
  30 #ifdef DLT_BLUETOOTH_HCI_H4_WITH_PHDR
  31
  32 /*
  33  * Header prepended by libpcap to each bluetooth h4 frame;
  34  * the direction field is in network byte order.
  35  */
  36 typedef struct _bluetooth_h4_header {
  37         nd_uint32_t direction; /* if first bit is set direction is incoming */
  38 } bluetooth_h4_header;
  39
  40 #define BT_HDRLEN sizeof(bluetooth_h4_header)
  41
  42 /*
  43  * This is the top level routine of the printer.  'p' points
  44  * to the bluetooth header of the packet, 'h->ts' is the timestamp,
  45  * 'h->len' is the length of the packet off the wire, and 'h->caplen'
  46  * is the number of bytes actually captured.
  47  */
  48 void
  49 bt_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
  50 {
  51         u_int length = h->len;
  52         u_int caplen = h->caplen;
  53         const bluetooth_h4_header *hdr = (const bluetooth_h4_header *)p;
  54
  55         ndo->ndo_protocol = "bluetooth";
  56         nd_print_protocol(ndo);
  57         ND_TCHECK_LEN(p, BT_HDRLEN);
  58         ndo->ndo_ll_hdr_len += BT_HDRLEN;
  59         caplen -= BT_HDRLEN;
  60         length -= BT_HDRLEN;
  61         p += BT_HDRLEN;
  62         if (ndo->ndo_eflag)
  63                 ND_PRINT(", hci length %u, direction %s", length,
  64                          (GET_BE_U_4(hdr->direction)&0x1) ? "in" : "out");
  65
  66         if (!ndo->ndo_suppress_default_print)
  67                 ND_DEFAULTPRINT(p, caplen);
  68 }
  69 #endif