hcidump/src/csrsniff.c

   1 /*
   2  *
   3  *  BlueZ - Bluetooth protocol stack for Linux
   4  *
   5  *  Copyright (C) 2004-2007  Marcel Holtmann <marcel@holtmann.org>
   6  *
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; either version 2 of the License, or
  11  *  (at your option) any later version.
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  21  *
  22  */
  23
  24 #ifdef HAVE_CONFIG_H
  25 #include <config.h>
  26 #endif
  27
  28 #include <stdio.h>
  29 #include <errno.h>
  30 #include <unistd.h>
  31 #include <stdlib.h>
  32 #include <getopt.h>
  33 #include <signal.h>
  34 #include <sys/ioctl.h>
  35 #include <sys/socket.h>
  36
  37 #include <bluetooth/bluetooth.h>
  38 #include <bluetooth/hci.h>
  39 #include <bluetooth/hci_lib.h>
  40
  41 static volatile sig_atomic_t __io_canceled = 0;
  42
  43 static void sig_hup(int sig)
  44 {
  45 }
  46
  47 static void sig_term(int sig)
  48 {
  49         __io_canceled = 1;
  50 }
  51
  52 static struct {
  53         uint16_t id;
  54         uint16_t ver;
  55         char *date;
  56 } firmware_map[] = {
  57         {  195,  1, "2001-11-27"        },
  58         {  220,  2, "2002-01-03"        },
  59         {  269,  3, "2002-02-22"        },
  60         {  270,  4, "2002-02-26"        },
  61         {  284,  5, "2002-03-12"        },
  62         {  292,  6, "2002-03-20"        },
  63         {  305,  7, "2002-04-12"        },
  64         {  306,  8, "2002-04-12"        },
  65         {  343,  9, "2002-05-02"        },
  66         {  346, 10, "2002-05-03"        },
  67         {  355, 11, "2002-05-16"        },
  68         {  256, 11, "2002-05-16"        },
  69         {  390, 12, "2002-06-26"        },
  70         {  450, 13, "2002-08-16"        },
  71         {  451, 13, "2002-08-16"        },
  72         {  533, 14, "2002-10-11"        },
  73         {  580, 15, "2002-11-14"        },
  74         {  623, 16, "2002-12-12"        },
  75         {  678, 17, "2003-01-29"        },
  76         {  847, 18, "2003-04-17"        },
  77         {  876, 19, "2003-06-10"        },
  78         {  997, 22, "2003-09-05"        },
  79         { 1027, 23, "2003-10-03"        },
  80         { 1029, 24, "2003-10-03"        },
  81         { 1112, 25, "2003-12-03"        },
  82         { 1113, 25, "2003-12-03"        },
  83         { 1133, 26, "2003-12-18"        },
  84         { 1134, 26, "2003-12-18"        },
  85         { 1223, 27, "2004-03-08"        },
  86         { 1224, 27, "2004-03-08"        },
  87         { 1319, 31, "2004-04-22"        },
  88         { 1320, 31, "2004-04-22"        },
  89         { 1427, 34, "2004-06-16"        },
  90         { 1508, 35, "2004-07-19"        },
  91         { 1509, 35, "2004-07-19"        },
  92         { 1587, 36, "2004-08-18"        },
  93         { 1588, 36, "2004-08-18"        },
  94         { 1641, 37, "2004-09-16"        },
  95         { 1642, 37, "2004-09-16"        },
  96         { 1699, 38, "2004-10-07"        },
  97         { 1700, 38, "2004-10-07"        },
  98         { 1752, 39, "2004-11-02"        },
  99         { 1753, 39, "2004-11-02"        },
 100         { 1759, 40, "2004-11-03"        },
 101         { 1760, 40, "2004-11-03"        },
 102         { 1761, 40, "2004-11-03"        },
 103         { 2009, 41, "2005-04-06"        },
 104         { 2010, 41, "2005-04-06"        },
 105         { 2011, 41, "2005-04-06"        },
 106         { 2016, 42, "2005-04-11"        },
 107         { 2017, 42, "2005-04-11"        },
 108         { 2018, 42, "2005-04-11"        },
 109         { 2023, 43, "2005-04-14"        },
 110         { 2024, 43, "2005-04-14"        },
 111         { 2025, 43, "2005-04-14"        },
 112         { 2032, 44, "2005-04-18"        },
 113         { 2033, 44, "2005-04-18"        },
 114         { 2034, 44, "2005-04-18"        },
 115         { 2288, 45, "2005-07-08"        },
 116         { 2289, 45, "2005-07-08"        },
 117         { 2290, 45, "2005-07-08"        },
 118         { 2388, 46, "2005-08-17"        },
 119         { 2389, 46, "2005-08-17"        },
 120         { 2390, 46, "2005-08-17"        },
 121         { 2869, 47, "2006-02-15"        },
 122         { 2870, 47, "2006-02-15"        },
 123         { 2871, 47, "2006-02-15"        },
 124         { 3214, 48, "2006-02-16"        },
 125         { 3215, 48, "2006-02-16"        },
 126         { 3216, 48, "2006-02-16"        },
 127         {    0, }
 128 };
 129
 130 static int id2ver(uint16_t id)
 131 {
 132         int i;
 133
 134         for (i = 0; firmware_map[i].id; i++)
 135                 if (firmware_map[i].id == id)
 136                         return firmware_map[i].ver;
 137
 138         return -1;
 139 }
 140
 141 static void usage(void)
 142 {
 143         printf("csrsniff - Utility for the CSR BlueCore sniffers\n\n");
 144         printf("Usage:\n"
 145                 "\tcsrsniff [-i <dev>] <master-bdaddr> [slave-bdaddr]\n");
 146 }
 147
 148 static struct option main_options[] = {
 149         { "help",       0, 0, 'h' },
 150         { "device",     1, 0, 'i' },
 151         { 0, 0, 0, 0}
 152 };
 153
 154 int main(int argc, char *argv[])
 155 {
 156         struct sigaction sa;
 157         struct hci_dev_info di;
 158         struct hci_version ver;
 159         struct hci_filter flt;
 160         bdaddr_t bdaddr, master, slave;
 161         int need_raw;
 162         int dd, opt, dev = 0;
 163
 164         bacpy(&slave, BDADDR_ANY);
 165
 166         while ((opt=getopt_long(argc, argv, "+i:h", main_options, NULL)) != -1) {
 167                 switch (opt) {
 168                 case 'i':
 169                         dev = hci_devid(optarg);
 170                         if (dev < 0) {
 171                                 perror("Invalid device");
 172                                 exit(1);
 173                         }
 174                         break;
 175
 176                 case 'h':
 177                 default:
 178                         usage();
 179                         exit(0);
 180                 }
 181         }
 182
 183         argc -= optind;
 184         argv += optind;
 185         optind = 0;
 186
 187         if (argc < 1) {
 188                 usage();
 189                 exit(1);
 190         }
 191
 192         str2ba(argv[0], &master);
 193
 194         if (argc > 1)
 195                 str2ba(argv[1], &slave);
 196
 197         dd = hci_open_dev(dev);
 198         if (dd < 0) {
 199                 fprintf(stderr, "Can't open device hci%d: %s (%d)\n",
 200                                                 dev, strerror(errno), errno);
 201                 exit(1);
 202         }
 203
 204         if (hci_devinfo(dev, &di) < 0) {
 205                 fprintf(stderr, "Can't get device info for hci%d: %s (%d)\n",
 206                                                 dev, strerror(errno), errno);
 207                 hci_close_dev(dd);
 208                 exit(1);
 209         }
 210
 211         if (hci_read_local_version(dd, &ver, 1000) < 0) {
 212                 fprintf(stderr, "Can't read version for hci%d: %s (%d)\n",
 213                                                 dev, strerror(errno), errno);
 214                 hci_close_dev(dd);
 215                 exit(1);
 216         }
 217
 218         if (ver.manufacturer != 10 || id2ver(ver.hci_rev) < 0) {
 219                 fprintf(stderr, "Can't find sniffer at hci%d: %s (%d)\n",
 220                                                 dev, strerror(ENOSYS), ENOSYS);
 221                 hci_close_dev(dd);
 222                 exit(1);
 223         }
 224
 225         if (!bacmp(&di.bdaddr, BDADDR_ANY)) {
 226                 if (hci_read_bd_addr(dd, &bdaddr, 1000) < 0) {
 227                         fprintf(stderr, "Can't read address for hci%d: %s (%d)\n",
 228                                                 dev, strerror(errno), errno);
 229                         hci_close_dev(dd);
 230                         exit(1);
 231                 }
 232         } else
 233                 bacpy(&bdaddr, &di.bdaddr);
 234
 235         need_raw = !hci_test_bit(HCI_RAW, &di.flags);
 236
 237         hci_filter_clear(&flt);
 238         hci_filter_set_ptype(HCI_ACLDATA_PKT, &flt);
 239         hci_filter_set_ptype(HCI_EVENT_PKT, &flt);
 240         hci_filter_set_event(EVT_VENDOR, &flt);
 241
 242         if (setsockopt(dd, SOL_HCI, HCI_FILTER, &flt, sizeof(flt)) < 0) {
 243                 fprintf(stderr, "Can't set filter for hci%d: %s (%d)\n",
 244                                                 dev, strerror(errno), errno);
 245                 hci_close_dev(dd);
 246                 exit(1);
 247         }
 248
 249         memset(&sa, 0, sizeof(sa));
 250         sa.sa_flags   = SA_NOCLDSTOP;
 251         sa.sa_handler = SIG_IGN;
 252         sigaction(SIGCHLD, &sa, NULL);
 253         sigaction(SIGPIPE, &sa, NULL);
 254
 255         sa.sa_handler = sig_term;
 256         sigaction(SIGTERM, &sa, NULL);
 257         sigaction(SIGINT,  &sa, NULL);
 258
 259         sa.sa_handler = sig_hup;
 260         sigaction(SIGHUP, &sa, NULL);
 261
 262         if (need_raw) {
 263                 if (ioctl(dd, HCISETRAW, 1) < 0) {
 264                         fprintf(stderr, "Can't set raw mode on hci%d: %s (%d)\n",
 265                                                 dev, strerror(errno), errno);
 266                         hci_close_dev(dd);
 267                         exit(1);
 268                 }
 269         }
 270
 271         printf("CSR sniffer - Bluetooth packet analyzer ver %s\n", VERSION);
 272
 273         if (need_raw) {
 274                 if (ioctl(dd, HCISETRAW, 0) < 0)
 275                         fprintf(stderr, "Can't clear raw mode on hci%d: %s (%d)\n",
 276                                                 dev, strerror(errno), errno);
 277         }
 278
 279         hci_close_dev(dd);
 280
 281         return 0;
 282 }