bluez/monitor/main.c

267 lines
6.6 KiB
C

/*
*
* BlueZ - Bluetooth protocol stack for Linux
*
* Copyright (C) 2011-2014 Intel Corporation
* Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
*
*
* This library is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation; either
* version 2.1 of the License, or (at your option) any later version.
*
* This library is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public
* License along with this library; if not, write to the Free Software
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
*
*/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#include <stdio.h>
#include <ctype.h>
#include <stdlib.h>
#include <string.h>
#include <getopt.h>
#include <sys/un.h>
#include "src/shared/mainloop.h"
#include "src/shared/tty.h"
#include "packet.h"
#include "lmp.h"
#include "keys.h"
#include "analyze.h"
#include "ellisys.h"
#include "control.h"
static void signal_callback(int signum, void *user_data)
{
switch (signum) {
case SIGINT:
case SIGTERM:
mainloop_quit();
break;
}
}
static void usage(void)
{
printf("btmon - Bluetooth monitor\n"
"Usage:\n");
printf("\tbtmon [options]\n");
printf("options:\n"
"\t-r, --read <file> Read traces in btsnoop format\n"
"\t-w, --write <file> Save traces in btsnoop format\n"
"\t-a, --analyze <file> Analyze traces in btsnoop format\n"
"\t-s, --server <socket> Start monitor server socket\n"
"\t-p, --priority <level> Show only priority or lower\n"
"\t-i, --index <num> Show only specified controller\n"
"\t-d, --tty <tty> Read data from TTY\n"
"\t-B, --tty-speed <rate> Set TTY speed (default 115200)\n"
"\t-V, --vendor <compid> Set default company identifier\n"
"\t-t, --time Show time instead of time offset\n"
"\t-T, --date Show time and date information\n"
"\t-S, --sco Dump SCO traffic\n"
"\t-A, --a2dp Dump A2DP stream traffic\n"
"\t-E, --ellisys [ip] Send Ellisys HCI Injection\n"
"\t-P, --no-pager Disable pager usage\n"
"\t-h, --help Show help options\n");
}
static const struct option main_options[] = {
{ "read", required_argument, NULL, 'r' },
{ "write", required_argument, NULL, 'w' },
{ "analyze", required_argument, NULL, 'a' },
{ "server", required_argument, NULL, 's' },
{ "priority", required_argument, NULL, 'p' },
{ "index", required_argument, NULL, 'i' },
{ "tty", required_argument, NULL, 'd' },
{ "tty-speed", required_argument, NULL, 'B' },
{ "vendor", required_argument, NULL, 'V' },
{ "time", no_argument, NULL, 't' },
{ "date", no_argument, NULL, 'T' },
{ "sco", no_argument, NULL, 'S' },
{ "a2dp", no_argument, NULL, 'A' },
{ "ellisys", required_argument, NULL, 'E' },
{ "no-pager", no_argument, NULL, 'P' },
{ "todo", no_argument, NULL, '#' },
{ "version", no_argument, NULL, 'v' },
{ "help", no_argument, NULL, 'h' },
{ }
};
int main(int argc, char *argv[])
{
unsigned long filter_mask = 0;
bool use_pager = true;
const char *reader_path = NULL;
const char *writer_path = NULL;
const char *analyze_path = NULL;
const char *ellisys_server = NULL;
const char *tty = NULL;
unsigned int tty_speed = B115200;
unsigned short ellisys_port = 0;
const char *str;
int exit_status;
sigset_t mask;
mainloop_init();
filter_mask |= PACKET_FILTER_SHOW_TIME_OFFSET;
for (;;) {
int opt;
struct sockaddr_un addr;
opt = getopt_long(argc, argv, "r:w:a:s:p:i:d:B:V:tTSAEPvh",
main_options, NULL);
if (opt < 0)
break;
switch (opt) {
case 'r':
reader_path = optarg;
break;
case 'w':
writer_path = optarg;
break;
case 'a':
analyze_path = optarg;
break;
case 's':
if (strlen(optarg) > sizeof(addr.sun_path) - 1) {
fprintf(stderr, "Socket name too long\n");
return EXIT_FAILURE;
}
control_server(optarg);
break;
case 'p':
packet_set_priority(optarg);
break;
case 'i':
if (strlen(optarg) > 3 && !strncmp(optarg, "hci", 3))
str = optarg + 3;
else
str = optarg;
if (!isdigit(*str)) {
usage();
return EXIT_FAILURE;
}
packet_select_index(atoi(str));
break;
case 'd':
tty = optarg;
break;
case 'B':
tty_speed = tty_get_speed(atoi(optarg));
if (!tty_speed) {
fprintf(stderr, "Unknown speed: %s\n", optarg);
return EXIT_FAILURE;
}
break;
case 'V':
str = optarg;
packet_set_fallback_manufacturer(atoi(str));
break;
case 't':
filter_mask &= ~PACKET_FILTER_SHOW_TIME_OFFSET;
filter_mask |= PACKET_FILTER_SHOW_TIME;
break;
case 'T':
filter_mask &= ~PACKET_FILTER_SHOW_TIME_OFFSET;
filter_mask |= PACKET_FILTER_SHOW_TIME;
filter_mask |= PACKET_FILTER_SHOW_DATE;
break;
case 'S':
filter_mask |= PACKET_FILTER_SHOW_SCO_DATA;
break;
case 'A':
filter_mask |= PACKET_FILTER_SHOW_A2DP_STREAM;
break;
case 'E':
ellisys_server = optarg;
ellisys_port = 24352;
break;
case 'P':
use_pager = false;
break;
case '#':
packet_todo();
lmp_todo();
return EXIT_SUCCESS;
case 'v':
printf("%s\n", VERSION);
return EXIT_SUCCESS;
case 'h':
usage();
return EXIT_SUCCESS;
default:
return EXIT_FAILURE;
}
}
if (argc - optind > 0) {
fprintf(stderr, "Invalid command line parameters\n");
return EXIT_FAILURE;
}
if (reader_path && analyze_path) {
fprintf(stderr, "Display and analyze can't be combined\n");
return EXIT_FAILURE;
}
sigemptyset(&mask);
sigaddset(&mask, SIGINT);
sigaddset(&mask, SIGTERM);
mainloop_set_signal(&mask, signal_callback, NULL, NULL);
printf("Bluetooth monitor ver %s\n", VERSION);
keys_setup();
packet_set_filter(filter_mask);
if (analyze_path) {
analyze_trace(analyze_path);
return EXIT_SUCCESS;
}
if (reader_path) {
if (ellisys_server)
ellisys_enable(ellisys_server, ellisys_port);
control_reader(reader_path, use_pager);
return EXIT_SUCCESS;
}
if (writer_path && !control_writer(writer_path)) {
printf("Failed to open '%s'\n", writer_path);
return EXIT_FAILURE;
}
if (ellisys_server)
ellisys_enable(ellisys_server, ellisys_port);
if (!tty && control_tracing() < 0)
return EXIT_FAILURE;
if (tty && control_tty(tty, tty_speed) < 0)
return EXIT_FAILURE;
exit_status = mainloop_run();
keys_cleanup();
return exit_status;
}