bluez/emulator/main.c
Luiz Augusto von Dentz 4a00535fa3 emulator: Add support for vendor commands
This adds support for vendor commands reserving a single opcode (0xfc10)
so it can be extended using subcommands, similar to how MSFT works.

The first subcommand (0x00) enables the emulator to generate arbitrary
events using the commands parameters:

> tools/hcitool cmd 3f 10 00 22 24 d0 d0 d0 d0 d0 d0 ff ff
< HCI Command: Vendor (0x3f|0x0010) plen 11
        00 22 24 d0 d0 d0 d0 d0 d0 ff ff
	."$........
Bluetooth: hci0: Malformed HCI Event: 0x22
> HCI Event: Inquiry Result with R.. (0x22) plen 9
        Num responses: 36
        Page scan repetition mode: Reserved (0xff)
        Page period mode: Reserved (0xff)
        Class: 0xffffd0
          Major class: Uncategorized, specific device code not specified
          Minor class: 0x34
          Limited Discoverable Mode
          invalid service class
        Clock offset: 0x6368
        RSSI: 105 dBm (0x69)
> HCI Event: Command Complete (0x0e) plen 4
      Vendor (0x3f|0x0010) ncmd 1
        Status: Success (0x00)
2022-01-05 15:06:40 -08:00

237 lines
5.2 KiB
C

// SPDX-License-Identifier: LGPL-2.1-or-later
/*
*
* BlueZ - Bluetooth protocol stack for Linux
*
* Copyright (C) 2011-2014 Intel Corporation
* Copyright (C) 2004-2010 Marcel Holtmann <marcel@holtmann.org>
*
*
*/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#include <stdio.h>
#include <stdlib.h>
#include <stdbool.h>
#include <getopt.h>
#include <sys/uio.h>
#include "src/shared/mainloop.h"
#include "src/shared/util.h"
#include "serial.h"
#include "server.h"
#include "btdev.h"
#include "vhci.h"
#include "amp.h"
#include "le.h"
static void signal_callback(int signum, void *user_data)
{
switch (signum) {
case SIGINT:
case SIGTERM:
mainloop_quit();
break;
}
}
static void usage(void)
{
printf("btvirt - Bluetooth emulator\n"
"Usage:\n");
printf("\tbtvirt [options]\n");
printf("options:\n"
"\t-d Enable debug\n"
"\t-S Create local serial port\n"
"\t-s Create local server sockets\n"
"\t-l[num] Number of local controllers\n"
"\t-L Create LE only controller\n"
"\t-U[num] Number of test LE controllers\n"
"\t-B Create BR/EDR only controller\n"
"\t-A Create AMP controller\n"
"\t-T[num] Number of test AMP controllers\n"
"\t-h, --help Show help options\n");
}
static const struct option main_options[] = {
{ "debug", no_argument, NULL, 'd' },
{ "serial", no_argument, NULL, 'S' },
{ "server", no_argument, NULL, 's' },
{ "local", optional_argument, NULL, 'l' },
{ "le", no_argument, NULL, 'L' },
{ "bredr", no_argument, NULL, 'B' },
{ "amp", no_argument, NULL, 'A' },
{ "letest", optional_argument, NULL, 'U' },
{ "amptest", optional_argument, NULL, 'T' },
{ "version", no_argument, NULL, 'v' },
{ "help", no_argument, NULL, 'h' },
{ }
};
static void vhci_debug(const char *str, void *user_data)
{
int i = PTR_TO_UINT(user_data);
printf("vhci%u: %s\n", i, str);
}
int main(int argc, char *argv[])
{
struct server *server1;
struct server *server2;
struct server *server3;
struct server *server4;
struct server *server5;
bool debug_enabled = false;
bool server_enabled = false;
bool serial_enabled = false;
int letest_count = 0;
int amptest_count = 0;
int vhci_count = 0;
enum btdev_type type = BTDEV_TYPE_BREDRLE52;
int i;
mainloop_init();
for (;;) {
int opt;
opt = getopt_long(argc, argv, "dSsl::LBAU::T::vh",
main_options, NULL);
if (opt < 0)
break;
switch (opt) {
case 'd':
debug_enabled = true;
break;
case 'S':
serial_enabled = true;
break;
case 's':
server_enabled = true;
break;
case 'l':
if (optarg)
vhci_count = atoi(optarg);
else
vhci_count = 1;
break;
case 'L':
type = BTDEV_TYPE_LE;
break;
case 'B':
type = BTDEV_TYPE_BREDR;
break;
case 'A':
type = BTDEV_TYPE_AMP;
break;
case 'U':
if (optarg)
letest_count = atoi(optarg);
else
letest_count = 1;
break;
case 'T':
if (optarg)
amptest_count = atoi(optarg);
else
amptest_count = 1;
break;
case 'v':
printf("%s\n", VERSION);
return EXIT_SUCCESS;
case 'h':
usage();
return EXIT_SUCCESS;
default:
return EXIT_FAILURE;
}
}
if (letest_count < 1 && amptest_count < 1 &&
vhci_count < 1 && !server_enabled && !serial_enabled) {
fprintf(stderr, "No emulator specified\n");
return EXIT_FAILURE;
}
printf("Bluetooth emulator ver %s\n", VERSION);
for (i = 0; i < letest_count; i++) {
struct bt_le *le;
le = bt_le_new();
if (!le) {
fprintf(stderr, "Failed to create LE controller\n");
return EXIT_FAILURE;
}
}
for (i = 0; i < amptest_count; i++) {
struct bt_amp *amp;
amp = bt_amp_new();
if (!amp) {
fprintf(stderr, "Failed to create AMP controller\n");
return EXIT_FAILURE;
}
}
for (i = 0; i < vhci_count; i++) {
struct vhci *vhci;
vhci = vhci_open(type);
if (!vhci) {
fprintf(stderr, "Failed to open Virtual HCI device\n");
return EXIT_FAILURE;
}
if (debug_enabled)
vhci_set_debug(vhci, vhci_debug, UINT_TO_PTR(i), NULL);
vhci_set_emu_opcode(vhci, 0xfc10);
vhci_set_msft_opcode(vhci, 0xfc1e);
}
if (serial_enabled) {
struct serial *serial;
serial = serial_open(SERIAL_TYPE_BREDRLE);
if (!serial)
fprintf(stderr, "Failed to open serial emulation\n");
}
if (server_enabled) {
server1 = server_open_unix(SERVER_TYPE_BREDRLE,
"/tmp/bt-server-bredrle");
if (!server1)
fprintf(stderr, "Failed to open BR/EDR/LE server\n");
server2 = server_open_unix(SERVER_TYPE_BREDR,
"/tmp/bt-server-bredr");
if (!server2)
fprintf(stderr, "Failed to open BR/EDR server\n");
server3 = server_open_unix(SERVER_TYPE_AMP,
"/tmp/bt-server-amp");
if (!server3)
fprintf(stderr, "Failed to open AMP server\n");
server4 = server_open_unix(SERVER_TYPE_LE,
"/tmp/bt-server-le");
if (!server4)
fprintf(stderr, "Failed to open LE server\n");
server5 = server_open_unix(SERVER_TYPE_MONITOR,
"/tmp/bt-server-mon");
if (!server5)
fprintf(stderr, "Failed to open monitor server\n");
}
return mainloop_run_with_signal(signal_callback, NULL);
}