Return-Path: From: Gustavo Padovan To: linux-bluetooth@vger.kernel.org Cc: Gustavo Padovan Subject: [PATCH 03/14] btmgmt: move to tools folder Date: Mon, 9 Jul 2012 18:10:25 -0300 Message-Id: <1341868236-9704-3-git-send-email-gustavo@padovan.org> In-Reply-To: <1341868236-9704-1-git-send-email-gustavo@padovan.org> References: <1341868236-9704-1-git-send-email-gustavo@padovan.org> Sender: linux-bluetooth-owner@vger.kernel.org List-ID: From: Gustavo Padovan --- .gitignore | 2 +- Makefile.tools | 6 +- mgmt/main.c | 1933 -------------------------------------------------------- 3 files changed, 4 insertions(+), 1937 deletions(-) delete mode 100644 mgmt/main.c diff --git a/.gitignore b/.gitignore index c7d079e..bc65dcf 100644 --- a/.gitignore +++ b/.gitignore @@ -86,7 +86,7 @@ compat/dund compat/hidd compat/pand unit/test-eir -mgmt/btmgmt +tools/mgmt/btmgmt monitor/btmon emulator/btvirt diff --git a/Makefile.tools b/Makefile.tools index 3cb105c..56839b7 100644 --- a/Makefile.tools +++ b/Makefile.tools @@ -50,10 +50,10 @@ tools_ppporc_LDADD = lib/libbluetooth-private.la tools_hcieventmask_LDADD = lib/libbluetooth-private.la -noinst_PROGRAMS += mgmt/btmgmt monitor/btmon emulator/btvirt +noinst_PROGRAMS += tools/btmgmt monitor/btmon emulator/btvirt -mgmt_btmgmt_SOURCES = mgmt/main.c src/glib-helper.c -mgmt_btmgmt_LDADD = lib/libbluetooth-private.la @GLIB_LIBS@ +tools_btmgmt_SOURCES = tools/btmgmt.c src/glib-helper.c +tools_btmgmt_LDADD = lib/libbluetooth-private.la @GLIB_LIBS@ monitor_btmon_SOURCES = monitor/main.c monitor/bt.h \ monitor/mainloop.h monitor/mainloop.c \ diff --git a/mgmt/main.c b/mgmt/main.c deleted file mode 100644 index b2d6c3c..0000000 --- a/mgmt/main.c +++ /dev/null @@ -1,1933 +0,0 @@ -/* - * BlueZ - Bluetooth protocol stack for Linux - * - * Copyright (C) 2011 Intel Corporation. All rights reserved. - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or - * (at your option) any later version. - * - * This program 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 General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA - * - */ - -#ifdef HAVE_CONFIG_H -#include -#endif - -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#include -#include -#include -#include -#include -#include - -#include -#include "glib-helper.h" - -static bool monitor = false; -static bool discovery = false; -static bool resolve_names = true; - -typedef void (*cmd_cb)(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data); - -static struct pending_cmd { - uint16_t op; - uint16_t id; - cmd_cb cb; - void *user_data; - struct pending_cmd *next; -} *pending = NULL; - -static int mgmt_send_cmd(int mgmt_sk, uint16_t op, uint16_t id, void *data, - size_t len, cmd_cb func, void *user_data) -{ - char buf[1024]; - struct pending_cmd *cmd; - struct mgmt_hdr *hdr = (void *) buf; - - if (len + MGMT_HDR_SIZE > sizeof(buf)) - return -EINVAL; - - cmd = calloc(1, sizeof(struct pending_cmd)); - if (cmd == NULL) - return -errno; - - cmd->op = op; - cmd->id = id; - cmd->cb = func; - cmd->user_data = user_data; - - memset(buf, 0, sizeof(buf)); - hdr->opcode = htobs(op); - hdr->index = htobs(id); - hdr->len = htobs(len); - memcpy(buf + MGMT_HDR_SIZE, data, len); - - if (write(mgmt_sk, buf, MGMT_HDR_SIZE + len) < 0) { - fprintf(stderr, "Unable to write to socket: %s\n", - strerror(errno)); - free(cmd); - return -1; - } - - cmd->next = pending; - pending = cmd; - - return 0; -} - -static int mgmt_open(void) -{ - struct sockaddr_hci addr; - int sk; - - sk = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI); - if (sk < 0) { - fprintf(stderr, "socket: %s\n", strerror(errno)); - return sk; - } - - memset(&addr, 0, sizeof(addr)); - addr.hci_family = AF_BLUETOOTH; - addr.hci_dev = HCI_DEV_NONE; - addr.hci_channel = HCI_CHANNEL_CONTROL; - - if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) { - fprintf(stderr, "bind: %s\n", strerror(errno)); - close(sk); - return -1; - } - - return sk; -} - -static void mgmt_check_pending(int mgmt_sk, uint16_t op, uint16_t index, - uint16_t status, void *data, uint16_t len) -{ - struct pending_cmd *c, *prev; - - for (c = pending, prev = NULL; c != NULL; prev = c, c = c->next) { - if (c->op != op) - continue; - if (c->id != index) - continue; - - if (c == pending) - pending = c->next; - else - prev->next = c->next; - - c->cb(mgmt_sk, op, index, status, data, len, c->user_data); - - free(c); - break; - } -} - -static int mgmt_cmd_complete(int mgmt_sk, uint16_t index, - struct mgmt_ev_cmd_complete *ev, uint16_t len) -{ - uint16_t op; - - if (len < sizeof(*ev)) { - fprintf(stderr, "Too short (%u bytes) cmd complete event\n", - len); - return -EINVAL; - } - - op = bt_get_le16(&ev->opcode); - - len -= sizeof(*ev); - - if (monitor) - printf("%s complete, opcode 0x%04x len %u\n", mgmt_opstr(op), - op, len); - - mgmt_check_pending(mgmt_sk, op, index, ev->status, ev->data, len); - - return 0; -} - -static int mgmt_cmd_status(int mgmt_sk, uint16_t index, - struct mgmt_ev_cmd_status *ev, uint16_t len) -{ - uint16_t opcode; - - if (len < sizeof(*ev)) { - fprintf(stderr, "Too short (%u bytes) cmd status event\n", - len); - return -EINVAL; - } - - opcode = bt_get_le16(&ev->opcode); - - if (monitor) - printf("cmd status, opcode 0x%04x status 0x%02x (%s)\n", - opcode, ev->status, mgmt_errstr(ev->status)); - - if (ev->status != 0) - mgmt_check_pending(mgmt_sk, opcode, index, ev->status, - NULL, 0); - - return 0; -} - -static int mgmt_controller_error(uint16_t index, - struct mgmt_ev_controller_error *ev, - uint16_t len) -{ - if (len < sizeof(*ev)) { - fprintf(stderr, - "Too short (%u bytes) controller error event\n", len); - return -EINVAL; - } - - if (monitor) - printf("hci%u error 0x%02x\n", index, ev->error_code); - - return 0; -} - -static int mgmt_index_added(int mgmt_sk, uint16_t index) -{ - if (monitor) - printf("hci%u added\n", index); - return 0; -} - -static int mgmt_index_removed(int mgmt_sk, uint16_t index) -{ - if (monitor) - printf("hci%u removed\n", index); - return 0; -} - -static const char *settings_str[] = { - "powered", - "connectable", - "fast-connectable", - "discoverable", - "pairable", - "link-security", - "ssp", - "br/edr", - "hs", - "le" , -}; - -static void print_settings(uint32_t settings) -{ - unsigned i; - - for (i = 0; i < NELEM(settings_str); i++) { - if ((settings & (1 << i)) != 0) - printf("%s ", settings_str[i]); - } -} - -static int mgmt_new_settings(int mgmt_sk, uint16_t index, - uint32_t *ev, uint16_t len) -{ - if (len < sizeof(*ev)) { - fprintf(stderr, "Too short new_settings event (%u)\n", len); - return -EINVAL; - } - - if (monitor) { - printf("hci%u new_settings: ", index); - print_settings(bt_get_le32(ev)); - printf("\n"); - } - - return 0; -} - -static int mgmt_discovering(int mgmt_sk, uint16_t index, - struct mgmt_ev_discovering *ev, uint16_t len) -{ - if (len < sizeof(*ev)) { - fprintf(stderr, "Too short (%u bytes) discovering event\n", - len); - return -EINVAL; - } - - if (ev->discovering == 0 && discovery) - exit(EXIT_SUCCESS); - - if (monitor) - printf("hci%u type %u discovering %s\n", index, - ev->type, ev->discovering ? "on" : "off"); - - return 0; -} - -static int mgmt_new_link_key(int mgmt_sk, uint16_t index, - struct mgmt_ev_new_link_key *ev, uint16_t len) -{ - - if (len != sizeof(*ev)) { - fprintf(stderr, "Invalid new_link_key length (%u bytes)\n", - len); - return -EINVAL; - } - - if (monitor) { - char addr[18]; - ba2str(&ev->key.addr.bdaddr, addr); - printf("hci%u new_link_key %s type 0x%02x pin_len %d " - "store_hint %u\n", index, addr, ev->key.type, - ev->key.pin_len, ev->store_hint); - } - - return 0; -} - -static const char *typestr(uint8_t type) -{ - const char *str[] = { "BR/EDR", "LE Public", "LE Random" }; - - if (type <= BDADDR_LE_RANDOM) - return str[type]; - - return "(unknown)"; -} - -static int mgmt_connected(int mgmt_sk, uint16_t index, - struct mgmt_ev_device_connected *ev, - uint16_t len) -{ - uint16_t eir_len; - - if (len < sizeof(*ev)) { - fprintf(stderr, - "Invalid connected event length (%u bytes)\n", len); - return -EINVAL; - } - - eir_len = bt_get_le16(&ev->eir_len); - if (len != sizeof(*ev) + eir_len) { - fprintf(stderr, "Invalid connected event length " - "(%u bytes, eir_len %u bytes)\n", len, eir_len); - return -EINVAL; - } - - if (monitor) { - char addr[18]; - ba2str(&ev->addr.bdaddr, addr); - printf("hci%u %s type %s connected eir_len %u\n", index, addr, - typestr(ev->addr.type), eir_len); - } - - return 0; -} - -static int mgmt_disconnected(int mgmt_sk, uint16_t index, - struct mgmt_addr_info *ev, uint16_t len) -{ - if (len != sizeof(*ev)) { - fprintf(stderr, - "Invalid disconnected event length (%u bytes)\n", len); - return -EINVAL; - } - - if (monitor) { - char addr[18]; - ba2str(&ev->bdaddr, addr); - printf("hci%u %s type %s disconnected\n", index, addr, - typestr(ev->type)); - } - - return 0; -} - -static int mgmt_conn_failed(int mgmt_sk, uint16_t index, - struct mgmt_ev_connect_failed *ev, - uint16_t len) -{ - if (len != sizeof(*ev)) { - fprintf(stderr, - "Invalid connect_failed event length (%u bytes)\n", len); - return -EINVAL; - } - - if (monitor) { - char addr[18]; - ba2str(&ev->addr.bdaddr, addr); - printf("hci%u %s type %s connect failed (status 0x%02x, %s)\n", - index, addr, typestr(ev->addr.type), ev->status, - mgmt_errstr(ev->status)); - } - - return 0; -} - -static int mgmt_auth_failed(int mgmt_sk, uint16_t index, - struct mgmt_ev_auth_failed *ev, - uint16_t len) -{ - if (len != sizeof(*ev)) { - fprintf(stderr, - "Invalid auth_failed event length (%u bytes)\n", len); - return -EINVAL; - } - - if (monitor) { - char addr[18]; - ba2str(&ev->addr.bdaddr, addr); - printf("hci%u %s auth failed with status 0x%02x (%s)\n", - index, addr, ev->status, mgmt_errstr(ev->status)); - } - - return 0; -} - -static int mgmt_name_changed(int mgmt_sk, uint16_t index, - struct mgmt_ev_local_name_changed *ev, - uint16_t len) -{ - if (len != sizeof(*ev)) { - fprintf(stderr, - "Invalid local_name_changed length (%u bytes)\n", len); - return -EINVAL; - } - - if (monitor) - printf("hci%u name changed: %s\n", index, ev->name); - - return 0; -} - -static void confirm_name_rsp(int mgmt_sk, uint16_t op, uint16_t id, - uint8_t status, void *rsp, uint16_t len, - void *user_data) -{ - struct mgmt_rp_confirm_name *rp = rsp; - char addr[18]; - - if (len == 0 && status != 0) { - fprintf(stderr, - "hci%u confirm_name failed with status 0x%02x (%s)\n", - id, status, mgmt_errstr(status)); - return; - } - - if (len != sizeof(*rp)) { - fprintf(stderr, - "hci%u confirm_name rsp length %u instead of %zu\n", - id, len, sizeof(*rp)); - return; - } - - ba2str(&rp->addr.bdaddr, addr); - - if (status != 0) - fprintf(stderr, - "hci%u confirm_name for %s failed: 0x%02x (%s)\n", - id, addr, status, mgmt_errstr(status)); - else - printf("hci%u confirm_name succeeded for %s\n", id, addr); -} - -static int mgmt_device_found(int mgmt_sk, uint16_t index, - struct mgmt_ev_device_found *ev, uint16_t len) -{ - uint32_t flags; - uint16_t eir_len; - - if (len < sizeof(*ev)) { - fprintf(stderr, - "Too short device_found length (%u bytes)\n", len); - return -EINVAL; - } - - flags = btohs(ev->flags); - - eir_len = bt_get_le16(&ev->eir_len); - if (len != sizeof(*ev) + eir_len) { - fprintf(stderr, "dev_found: expected %zu bytes, got %u bytes", - sizeof(*ev) + eir_len, len); - return -EINVAL; - } - - if (monitor || discovery) { - char addr[18]; - ba2str(&ev->addr.bdaddr, addr); - printf("hci%u dev_found: %s type %s rssi %d " - "flags 0x%04x eir_len %u\n", index, addr, - typestr(ev->addr.type), ev->rssi, flags, eir_len); - } - - if (discovery && (flags & MGMT_DEV_FOUND_CONFIRM_NAME)) { - struct mgmt_cp_confirm_name cp; - - memset(&cp, 0, sizeof(cp)); - memcpy(&cp.addr, &ev->addr, sizeof(cp.addr)); - if (resolve_names) - cp.name_known = 0; - else - cp.name_known = 1; - - mgmt_send_cmd(mgmt_sk, MGMT_OP_CONFIRM_NAME, index, - &cp, sizeof(cp), confirm_name_rsp, - NULL); - } - - return 0; -} - -static void pin_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - if (status != 0) { - fprintf(stderr, - "hci%u PIN Code reply failed with status 0x%02x (%s)", - id, status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("hci%u PIN Reply successful\n", id); -} - -static int mgmt_pin_reply(int mgmt_sk, uint16_t index, - struct mgmt_addr_info *addr, - const char *pin, size_t len) -{ - struct mgmt_cp_pin_code_reply cp; - - memset(&cp, 0, sizeof(cp)); - memcpy(&cp.addr, addr, sizeof(cp.addr)); - cp.pin_len = len; - memcpy(cp.pin_code, pin, len); - - return mgmt_send_cmd(mgmt_sk, MGMT_OP_PIN_CODE_REPLY, index, - &cp, sizeof(cp), pin_rsp, NULL); -} - -static void pin_neg_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - if (status != 0) { - fprintf(stderr, - "hci%u PIN Neg reply failed with status 0x%02x (%s)", - id, status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("hci%u PIN Negative Reply successful\n", id); -} - -static int mgmt_pin_neg_reply(int mgmt_sk, uint16_t index, - struct mgmt_addr_info *addr) -{ - struct mgmt_cp_pin_code_neg_reply cp; - - memset(&cp, 0, sizeof(cp)); - memcpy(&cp.addr, addr, sizeof(cp.addr)); - - return mgmt_send_cmd(mgmt_sk, MGMT_OP_PIN_CODE_NEG_REPLY, index, - &cp, sizeof(cp), pin_neg_rsp, NULL); -} - -static int mgmt_request_pin(int mgmt_sk, uint16_t index, - struct mgmt_ev_pin_code_request *ev, - uint16_t len) -{ - char pin[18]; - size_t pin_len; - - if (len != sizeof(*ev)) { - fprintf(stderr, - "Invalid pin_code request length (%u bytes)\n", len); - return -EINVAL; - } - - if (monitor) { - char addr[18]; - ba2str(&ev->addr.bdaddr, addr); - printf("hci%u %s request PIN\n", index, addr); - } - - printf("PIN Request (press enter to reject) >> "); - fflush(stdout); - - memset(pin, 0, sizeof(pin)); - - if (fgets(pin, sizeof(pin), stdin) == NULL || pin[0] == '\n') - return mgmt_pin_neg_reply(mgmt_sk, index, &ev->addr); - - pin_len = strlen(pin); - if (pin[pin_len - 1] == '\n') { - pin[pin_len - 1] = '\0'; - pin_len--; - } - - return mgmt_pin_reply(mgmt_sk, index, &ev->addr, pin, pin_len); -} - -static void confirm_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - if (status != 0) { - fprintf(stderr, - "hci%u User Confirm reply failed. status 0x%02x (%s)", - id, status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("hci%u User Confirm Reply successful\n", id); -} - -static int mgmt_confirm_reply(int mgmt_sk, uint16_t index, bdaddr_t *bdaddr) -{ - struct mgmt_cp_user_confirm_reply cp; - - memset(&cp, 0, sizeof(cp)); - bacpy(&cp.addr.bdaddr, bdaddr); - - return mgmt_send_cmd(mgmt_sk, MGMT_OP_USER_CONFIRM_REPLY, index, - &cp, sizeof(cp), confirm_rsp, NULL); -} - -static void confirm_neg_rsp(int mgmt_sk, uint16_t op, uint16_t id, - uint8_t status, void *rsp, uint16_t len, - void *user_data) -{ - if (status != 0) { - fprintf(stderr, - "hci%u Confirm Neg reply failed. status 0x%02x (%s)", - id, status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("hci%u User Confirm Negative Reply successful\n", id); -} - -static int mgmt_confirm_neg_reply(int mgmt_sk, uint16_t index, - bdaddr_t *bdaddr) -{ - struct mgmt_cp_user_confirm_reply cp; - - memset(&cp, 0, sizeof(cp)); - bacpy(&cp.addr.bdaddr, bdaddr); - - return mgmt_send_cmd(mgmt_sk, MGMT_OP_USER_CONFIRM_NEG_REPLY, index, - &cp, sizeof(cp), confirm_neg_rsp, NULL); -} - - -static int mgmt_user_confirm(int mgmt_sk, uint16_t index, - struct mgmt_ev_user_confirm_request *ev, - uint16_t len) -{ - char rsp[5]; - size_t rsp_len; - uint32_t val; - char addr[18]; - - if (len != sizeof(*ev)) { - fprintf(stderr, - "Invalid user_confirm request length (%u)\n", len); - return -EINVAL; - } - - ba2str(&ev->addr.bdaddr, addr); - val = bt_get_le32(&ev->value); - - if (monitor) - printf("hci%u %s User Confirm %06u hint %u\n", index, addr, - val, ev->confirm_hint); - - if (ev->confirm_hint) - printf("Accept pairing with %s (yes/no) >> ", addr); - else - printf("Confirm value %06u for %s (yes/no) >> ", val, addr); - - fflush(stdout); - - memset(rsp, 0, sizeof(rsp)); - - if (fgets(rsp, sizeof(rsp), stdin) == NULL || rsp[0] == '\n') - return mgmt_confirm_neg_reply(mgmt_sk, index, &ev->addr.bdaddr); - - rsp_len = strlen(rsp); - if (rsp[rsp_len - 1] == '\n') { - rsp[rsp_len - 1] = '\0'; - rsp_len--; - } - - if (rsp[0] == 'y' || rsp[0] == 'Y') - return mgmt_confirm_reply(mgmt_sk, index, &ev->addr.bdaddr); - else - return mgmt_confirm_neg_reply(mgmt_sk, index, &ev->addr.bdaddr); -} - -static int mgmt_handle_event(int mgmt_sk, uint16_t ev, uint16_t index, - void *data, uint16_t len) -{ - if (monitor) - printf("event: %s\n", mgmt_evstr(ev)); - - switch (ev) { - case MGMT_EV_CMD_COMPLETE: - return mgmt_cmd_complete(mgmt_sk, index, data, len); - case MGMT_EV_CMD_STATUS: - return mgmt_cmd_status(mgmt_sk, index, data, len); - case MGMT_EV_CONTROLLER_ERROR: - return mgmt_controller_error(index, data, len); - case MGMT_EV_INDEX_ADDED: - return mgmt_index_added(mgmt_sk, index); - case MGMT_EV_INDEX_REMOVED: - return mgmt_index_removed(mgmt_sk, index); - case MGMT_EV_NEW_SETTINGS: - return mgmt_new_settings(mgmt_sk, index, data, len); - case MGMT_EV_DISCOVERING: - return mgmt_discovering(mgmt_sk, index, data, len); - case MGMT_EV_NEW_LINK_KEY: - return mgmt_new_link_key(mgmt_sk, index, data, len); - case MGMT_EV_DEVICE_CONNECTED: - return mgmt_connected(mgmt_sk, index, data, len); - case MGMT_EV_DEVICE_DISCONNECTED: - return mgmt_disconnected(mgmt_sk, index, data, len); - case MGMT_EV_CONNECT_FAILED: - return mgmt_conn_failed(mgmt_sk, index, data, len); - case MGMT_EV_AUTH_FAILED: - return mgmt_auth_failed(mgmt_sk, index, data, len); - case MGMT_EV_LOCAL_NAME_CHANGED: - return mgmt_name_changed(mgmt_sk, index, data, len); - case MGMT_EV_DEVICE_FOUND: - return mgmt_device_found(mgmt_sk, index, data, len); - case MGMT_EV_PIN_CODE_REQUEST: - return mgmt_request_pin(mgmt_sk, index, data, len); - case MGMT_EV_USER_CONFIRM_REQUEST: - return mgmt_user_confirm(mgmt_sk, index, data, len); - default: - if (monitor) - printf("Unhandled event 0x%04x (%s)\n", ev, mgmt_evstr(ev)); - return 0; - } -} - -static int mgmt_process_data(int mgmt_sk) -{ - char buf[1024]; - struct mgmt_hdr *hdr = (void *) buf; - uint16_t len, ev, index; - ssize_t ret; - - ret = read(mgmt_sk, buf, sizeof(buf)); - if (ret < 0) { - fprintf(stderr, "read: %s\n", strerror(errno)); - return ret; - } - - if (ret < MGMT_HDR_SIZE) { - fprintf(stderr, "Too small mgmt packet (%zd bytes)\n", ret); - return 0; - } - - ev = bt_get_le16(&hdr->opcode); - index = bt_get_le16(&hdr->index); - len = bt_get_le16(&hdr->len); - - if (monitor) - printf("event 0x%04x len 0x%04x index 0x%04x\n", ev, len, index); - - if (ret != MGMT_HDR_SIZE + len) { - fprintf(stderr, "Packet length mismatch. ret %zd len %u", - ret, len); - return 0; - } - - mgmt_handle_event(mgmt_sk, ev, index, buf + MGMT_HDR_SIZE, len); - - return 0; -} - -static void cmd_monitor(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - printf("Monitoring mgmt events...\n"); - monitor = true; -} - -static void version_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - struct mgmt_rp_read_version *rp = rsp; - - if (status != 0) { - fprintf(stderr, "Reading mgmt version failed with status" - " 0x%02x (%s)\n", status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len < sizeof(*rp)) { - fprintf(stderr, "Too small version reply (%u bytes)\n", len); - exit(EXIT_FAILURE); - } - - printf("MGMT Version %u, revision %u\n", rp->version, - bt_get_le16(&rp->revision)); - - exit(EXIT_SUCCESS); -} - -static void cmd_version(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_READ_VERSION, MGMT_INDEX_NONE, - NULL, 0, version_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send read_version cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void commands_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - struct mgmt_rp_read_commands *rp = rsp; - uint16_t num_commands, num_events, *opcode; - size_t expected_len; - int i; - - if (status != 0) { - fprintf(stderr, "Reading supported commands failed with status" - " 0x%02x (%s)\n", status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len < sizeof(*rp)) { - fprintf(stderr, "Too small commands reply (%u bytes)\n", len); - exit(EXIT_FAILURE); - } - - num_commands = bt_get_le16(&rp->num_commands); - num_events = bt_get_le16(&rp->num_events); - - expected_len = sizeof(*rp) + num_commands * sizeof(uint16_t) + - num_events * sizeof(uint16_t); - - if (len < expected_len) { - fprintf(stderr, "Too small commands reply (%u != %zu)\n", - len, expected_len); - exit(EXIT_FAILURE); - } - - opcode = rp->opcodes; - - printf("%u commands:\n", num_commands); - for (i = 0; i < num_commands; i++) { - uint16_t op = bt_get_le16(opcode++); - printf("\t%s (0x%04x)\n", mgmt_opstr(op), op); - } - - printf("%u events:\n", num_events); - for (i = 0; i < num_events; i++) { - uint16_t ev = bt_get_le16(opcode++); - printf("\t%s (0x%04x)\n", mgmt_evstr(ev), ev); - } - - exit(EXIT_SUCCESS); -} - -static void cmd_commands(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_READ_COMMANDS, MGMT_INDEX_NONE, - NULL, 0, commands_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send read_commands cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void info_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - struct mgmt_rp_read_info *rp = rsp; - char addr[18]; - - if (status != 0) { - fprintf(stderr, - "Reading hci%u info failed with status 0x%02x (%s)\n", - id, status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len < sizeof(*rp)) { - fprintf(stderr, "Too small info reply (%u bytes)\n", len); - exit(EXIT_FAILURE); - } - - ba2str(&rp->bdaddr, addr); - printf("hci%u:\taddr %s version %u manufacturer %u" - " class 0x%02x%02x%02x\n", - id, addr, rp->version, bt_get_le16(&rp->manufacturer), - rp->dev_class[2], rp->dev_class[1], rp->dev_class[0]); - - printf("\tsupported settings: "); - print_settings(bt_get_le32(&rp->supported_settings)); - - printf("\n\tcurrent settings: "); - print_settings(bt_get_le32(&rp->current_settings)); - - printf("\n\tname %s\n", rp->name); - printf("\tshort name %s\n", rp->short_name); - - if (pending == NULL) - exit(EXIT_SUCCESS); -} - -static void index_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - struct mgmt_rp_read_index_list *rp = rsp; - uint16_t count; - unsigned int i; - - if (status != 0) { - fprintf(stderr, - "Reading index list failed with status 0x%02x (%s)\n", - status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len < sizeof(*rp)) { - fprintf(stderr, "Too small index list reply (%u bytes)\n", - len); - exit(EXIT_FAILURE); - } - - count = bt_get_le16(&rp->num_controllers); - - if (len < sizeof(*rp) + count * sizeof(uint16_t)) { - fprintf(stderr, - "Index count (%u) doesn't match reply length (%u)\n", - count, len); - exit(EXIT_FAILURE); - } - - if (monitor) - printf("Index list with %u item%s\n", - count, count > 1 ? "s" : ""); - - if (count == 0) - exit(EXIT_SUCCESS); - - if (monitor && count > 0) - printf("\t"); - - for (i = 0; i < count; i++) { - uint16_t index; - - index = bt_get_le16(&rp->index[i]); - - if (monitor) - printf("hci%u ", index); - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_READ_INFO, index, NULL, - 0, info_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send read_info cmd\n"); - exit(EXIT_FAILURE); - } - } - - if (monitor && count > 0) - printf("\n"); -} - -static void cmd_info(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - if (index == MGMT_INDEX_NONE) { - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_READ_INDEX_LIST, - MGMT_INDEX_NONE, NULL, 0, - index_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send index_list cmd\n"); - exit(EXIT_FAILURE); - } - - return; - } - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_READ_INFO, index, NULL, - 0, info_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send read_info cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void setting_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - uint32_t *rp = rsp; - - if (status != 0) { - fprintf(stderr, - "%s for hci%u failed with status 0x%02x (%s)\n", - mgmt_opstr(op), id, status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len < sizeof(*rp)) { - fprintf(stderr, "Too small %s response (%u bytes)\n", - mgmt_opstr(op), len); - exit(EXIT_FAILURE); - } - - printf("hci%u %s complete, settings: ", id, mgmt_opstr(op)); - print_settings(bt_get_le32(rp)); - printf("\n"); - - exit(EXIT_SUCCESS); -} - -static void cmd_setting(int mgmt_sk, uint16_t index, uint16_t op, - int argc, char **argv) -{ - uint8_t val; - - if (argc < 2) { - printf("Specify \"on\" or \"off\"\n"); - exit(EXIT_FAILURE); - } - - if (strcasecmp(argv[1], "on") == 0 || strcasecmp(argv[1], "yes") == 0) - val = 1; - else if (strcasecmp(argv[1], "off") == 0) - val = 0; - else - val = atoi(argv[1]); - - if (index == MGMT_INDEX_NONE) - index = 0; - - if (mgmt_send_cmd(mgmt_sk, op, index, &val, sizeof(val), - setting_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send %s cmd\n", mgmt_opstr(op)); - exit(EXIT_FAILURE); - } -} - -static void cmd_power(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - cmd_setting(mgmt_sk, index, MGMT_OP_SET_POWERED, argc, argv); -} - -static void cmd_discov(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_set_discoverable cp; - - if (argc < 2) { - printf("Usage: btmgmt %s [timeout]\n", argv[0]); - exit(EXIT_FAILURE); - } - - memset(&cp, 0, sizeof(cp)); - - if (strcasecmp(argv[1], "on") == 0 || strcasecmp(argv[1], "yes") == 0) - cp.val = 1; - else if (strcasecmp(argv[1], "off") == 0) - cp.val = 0; - else - cp.val = atoi(argv[1]); - - if (argc > 2) - cp.timeout = htobs(atoi(argv[2])); - - if (index == MGMT_INDEX_NONE) - index = 0; - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_SET_DISCOVERABLE, index, - &cp, sizeof(cp), setting_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send set_discoverable cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void cmd_connectable(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - cmd_setting(mgmt_sk, index, MGMT_OP_SET_CONNECTABLE, argc, argv); -} - -static void cmd_pairable(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - cmd_setting(mgmt_sk, index, MGMT_OP_SET_PAIRABLE, argc, argv); -} - -static void cmd_linksec(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - cmd_setting(mgmt_sk, index, MGMT_OP_SET_LINK_SECURITY, argc, argv); -} - -static void cmd_ssp(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - cmd_setting(mgmt_sk, index, MGMT_OP_SET_SSP, argc, argv); -} - -static void cmd_hs(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - cmd_setting(mgmt_sk, index, MGMT_OP_SET_HS, argc, argv); -} - -static void cmd_le(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - cmd_setting(mgmt_sk, index, MGMT_OP_SET_LE, argc, argv); -} - -static void class_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - struct mgmt_ev_class_of_dev_changed *rp = rsp; - - if (len == 0 && status != 0) { - fprintf(stderr, "%s failed, status 0x%02x (%s)\n", - mgmt_opstr(op), status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len != sizeof(*rp)) { - fprintf(stderr, "Unexpected %s len %u\n", mgmt_opstr(op), len); - exit(EXIT_FAILURE); - } - - printf("%s succeeded. Class 0x%02x%02x%02x\n", mgmt_opstr(op), - rp->class_of_dev[2], rp->class_of_dev[1], rp->class_of_dev[0]); - - exit(EXIT_SUCCESS); -} - -static void cmd_class(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - uint8_t class[2]; - - if (argc < 3) { - printf("Usage: btmgmt %s \n", argv[0]); - exit(EXIT_FAILURE); - } - - class[0] = atoi(argv[1]); - class[1] = atoi(argv[2]); - - if (index == MGMT_INDEX_NONE) - index = 0; - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_SET_DEV_CLASS, index, - class, sizeof(class), class_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send set_dev_class cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void disconnect_rsp(int mgmt_sk, uint16_t op, uint16_t id, - uint8_t status, void *rsp, uint16_t len, - void *user_data) -{ - struct mgmt_rp_disconnect *rp = rsp; - char addr[18]; - - if (len == 0 && status != 0) { - fprintf(stderr, "Disconnect failed with status 0x%02x (%s)\n", - status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len != sizeof(*rp)) { - fprintf(stderr, "Invalid disconnect response length (%u)\n", - len); - exit(EXIT_FAILURE); - } - - ba2str(&rp->addr.bdaddr, addr); - - if (status == 0) { - printf("%s disconnected\n", addr); - exit(EXIT_SUCCESS); - } else { - fprintf(stderr, - "Disconnecting %s failed with status 0x%02x (%s)\n", - addr, status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } -} - -static void cmd_disconnect(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_disconnect cp; - - if (argc < 2) { - printf("Usage: btmgmt %s
\n", argv[0]); - exit(EXIT_FAILURE); - } - - str2ba(argv[1], &cp.addr.bdaddr); - - if (index == MGMT_INDEX_NONE) - index = 0; - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_DISCONNECT, index, - &cp, sizeof(cp), disconnect_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send disconnect cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void con_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - struct mgmt_rp_get_connections *rp = rsp; - uint16_t count, i; - - if (len < sizeof(*rp)) { - fprintf(stderr, "Too small (%u bytes) get_connections rsp\n", - len); - exit(EXIT_FAILURE); - } - - count = bt_get_le16(&rp->conn_count); - if (len != sizeof(*rp) + count * sizeof(struct mgmt_addr_info)) { - fprintf(stderr, "Invalid get_connections length " - " (count=%u, len=%u)\n", count, len); - exit(EXIT_FAILURE); - } - - for (i = 0; i < count; i++) { - char addr[18]; - - ba2str(&rp->addr[i].bdaddr, addr); - - printf("%s type %s\n", addr, typestr(rp->addr[i].type)); - } - - exit(EXIT_SUCCESS); -} - -static void cmd_con(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - if (index == MGMT_INDEX_NONE) - index = 0; - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_GET_CONNECTIONS, index, NULL, 0, - con_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send get_connections cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void find_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - if (status != 0) { - fprintf(stderr, - "Unable to start discovery. status 0x%02x (%s)\n", - status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("Discovery started\n"); - discovery = true; -} - -static void find_usage(void) -{ - printf("Usage: btmgmt find [-l|-b]>\n"); -} - -static struct option find_options[] = { - { "help", 0, 0, 'h' }, - { "le-only", 1, 0, 'l' }, - { "bredr-only", 1, 0, 'b' }, - { 0, 0, 0, 0 } -}; - -static void cmd_find(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_start_discovery cp; - uint8_t type; - int opt; - - if (index == MGMT_INDEX_NONE) - index = 0; - - type = 0; - hci_set_bit(BDADDR_BREDR, &type); - hci_set_bit(BDADDR_LE_PUBLIC, &type); - hci_set_bit(BDADDR_LE_RANDOM, &type); - - while ((opt = getopt_long(argc, argv, "+lbh", find_options, - NULL)) != -1) { - switch (opt) { - case 'l': - hci_clear_bit(BDADDR_BREDR, &type); - hci_set_bit(BDADDR_LE_PUBLIC, &type); - hci_set_bit(BDADDR_LE_RANDOM, &type); - break; - case 'b': - hci_set_bit(BDADDR_BREDR, &type); - hci_clear_bit(BDADDR_LE_PUBLIC, &type); - hci_clear_bit(BDADDR_LE_RANDOM, &type); - break; - case 'h': - default: - find_usage(); - exit(EXIT_SUCCESS); - } - } - - argc -= optind; - argv += optind; - optind = 0; - - memset(&cp, 0, sizeof(cp)); - cp.type = type; - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_START_DISCOVERY, index, - &cp, sizeof(cp), find_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send start_discovery cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void name_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - if (status != 0) { - fprintf(stderr, "Unable to set local name. status 0x%02x (%s)", - status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - exit(EXIT_SUCCESS); -} - -static void cmd_name(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_set_local_name cp; - - if (argc < 2) { - printf("Usage: btmgmt %s [shortname]\n", argv[0]); - exit(EXIT_FAILURE); - } - - if (index == MGMT_INDEX_NONE) - index = 0; - - memset(&cp, 0, sizeof(cp)); - strncpy((char *) cp.name, argv[1], HCI_MAX_NAME_LENGTH); - if (argc > 2) - strncpy((char *) cp.short_name, argv[2], - MGMT_MAX_SHORT_NAME_LENGTH); - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_SET_LOCAL_NAME, index, - &cp, sizeof(cp), name_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send set_name cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void pair_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - struct mgmt_rp_pair_device *rp = rsp; - char addr[18]; - - if (len == 0 && status != 0) { - fprintf(stderr, "Pairing failed with status 0x%02x (%s)\n", - status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len != sizeof(*rp)) { - fprintf(stderr, "Unexpected pair_rsp len %u\n", len); - exit(EXIT_FAILURE); - } - - ba2str(&rp->addr.bdaddr, addr); - - if (status != 0) { - fprintf(stderr, - "Pairing with %s (%s) failed. status 0x%02x (%s)\n", - addr, typestr(rp->addr.type), status, - mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("Paired with %s\n", addr); - - exit(EXIT_SUCCESS); -} - -static void pair_usage(void) -{ - printf("Usage: btmgmt pair [-c cap] [-t type] \n"); -} - -static struct option pair_options[] = { - { "help", 0, 0, 'h' }, - { "capability", 1, 0, 'c' }, - { "type", 1, 0, 't' }, - { 0, 0, 0, 0 } -}; - -static void cmd_pair(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_pair_device cp; - uint8_t cap = 0x01; - uint8_t type = BDADDR_BREDR; - int opt; - - while ((opt = getopt_long(argc, argv, "+c:t:h", pair_options, - NULL)) != -1) { - switch (opt) { - case 'c': - cap = strtol(optarg, NULL, 0); - break; - case 't': - type = strtol(optarg, NULL, 0); - break; - case 'h': - default: - pair_usage(); - exit(EXIT_SUCCESS); - } - } - - argc -= optind; - argv += optind; - optind = 0; - - if (argc < 1) { - pair_usage(); - exit(EXIT_FAILURE); - } - - if (index == MGMT_INDEX_NONE) - index = 0; - - memset(&cp, 0, sizeof(cp)); - str2ba(argv[0], &cp.addr.bdaddr); - cp.addr.type = type; - cp.io_cap = cap; - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_PAIR_DEVICE, index, &cp, sizeof(cp), - pair_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send pair_device cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void unpair_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - struct mgmt_rp_unpair_device *rp = rsp; - char addr[18]; - - if (len == 0 && status != 0) { - fprintf(stderr, "Unpair device failed. status 0x%02x (%s)\n", - status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len != sizeof(*rp)) { - fprintf(stderr, "Unexpected unpair_device_rsp len %u\n", len); - exit(EXIT_FAILURE); - } - - ba2str(&rp->addr.bdaddr, addr); - - if (status != 0) { - fprintf(stderr, - "Unpairing %s failed. status 0x%02x (%s)\n", - addr, status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("%s unpaired\n", addr); - - exit(EXIT_SUCCESS); -} - -static void cmd_unpair(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_unpair_device cp; - - if (argc < 2) { - printf("Usage: btmgmt %s \n", argv[0]); - exit(EXIT_FAILURE); - } - - if (index == MGMT_INDEX_NONE) - index = 0; - - memset(&cp, 0, sizeof(cp)); - str2ba(argv[1], &cp.addr.bdaddr); - cp.disconnect = 1; - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_UNPAIR_DEVICE, index, &cp, - sizeof(cp), unpair_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send unpair_device cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void keys_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - if (status != 0) { - fprintf(stderr, "Load keys failed with status 0x%02x (%s)\n", - status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("Keys successfully loaded\n"); - - exit(EXIT_SUCCESS); -} - -static void cmd_keys(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_load_link_keys cp; - - if (index == MGMT_INDEX_NONE) - index = 0; - - memset(&cp, 0, sizeof(cp)); - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_LOAD_LINK_KEYS, index, - &cp, sizeof(cp), keys_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send load_keys cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void block_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - struct mgmt_addr_info *rp = rsp; - char addr[18]; - - if (len == 0 && status != 0) { - fprintf(stderr, "%s failed, status 0x%02x (%s)\n", - mgmt_opstr(op), status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - if (len != sizeof(*rp)) { - fprintf(stderr, "Unexpected %s len %u\n", mgmt_opstr(op), len); - exit(EXIT_FAILURE); - } - - ba2str(&rp->bdaddr, addr); - - if (status != 0) { - fprintf(stderr, "%s %s (%s) failed. status 0x%02x (%s)\n", - mgmt_opstr(op), addr, typestr(rp->type), - status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("%s %s succeeded\n", mgmt_opstr(op), addr); - - exit(EXIT_SUCCESS); -} - -static void block_usage(void) -{ - printf("Usage: btmgmt block [-t type] \n"); -} - -static struct option block_options[] = { - { "help", 0, 0, 'h' }, - { "type", 1, 0, 't' }, - { 0, 0, 0, 0 } -}; - -static void cmd_block(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_block_device cp; - uint8_t type = BDADDR_BREDR; - int opt; - - while ((opt = getopt_long(argc, argv, "+t:h", block_options, - NULL)) != -1) { - switch (opt) { - case 't': - type = strtol(optarg, NULL, 0); - break; - case 'h': - default: - block_usage(); - exit(EXIT_SUCCESS); - } - } - - argc -= optind; - argv += optind; - optind = 0; - - if (argc < 1) { - block_usage(); - exit(EXIT_FAILURE); - } - - if (index == MGMT_INDEX_NONE) - index = 0; - - memset(&cp, 0, sizeof(cp)); - str2ba(argv[0], &cp.addr.bdaddr); - cp.addr.type = type; - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_BLOCK_DEVICE, index, - &cp, sizeof(cp), block_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send block_device cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void unblock_usage(void) -{ - printf("Usage: btmgmt unblock [-t type] \n"); -} - -static void cmd_unblock(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_unblock_device cp; - uint8_t type = BDADDR_BREDR; - int opt; - - while ((opt = getopt_long(argc, argv, "+t:h", block_options, - NULL)) != -1) { - switch (opt) { - case 't': - type = strtol(optarg, NULL, 0); - break; - case 'h': - default: - unblock_usage(); - exit(EXIT_SUCCESS); - } - } - - argc -= optind; - argv += optind; - optind = 0; - - if (argc < 1) { - unblock_usage(); - exit(EXIT_FAILURE); - } - - if (index == MGMT_INDEX_NONE) - index = 0; - - memset(&cp, 0, sizeof(cp)); - str2ba(argv[0], &cp.addr.bdaddr); - cp.addr.type = type; - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_UNBLOCK_DEVICE, index, - &cp, sizeof(cp), block_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send unblock_device cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void uuid_to_uuid128(uuid_t *uuid128, const uuid_t *uuid) -{ - if (uuid->type == SDP_UUID16) - sdp_uuid16_to_uuid128(uuid128, uuid); - else if (uuid->type == SDP_UUID32) - sdp_uuid32_to_uuid128(uuid128, uuid); - else - memcpy(uuid128, uuid, sizeof(*uuid)); -} - -static void cmd_add_uuid(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_add_uuid cp; - uint128_t uint128; - uuid_t uuid, uuid128; - - if (argc < 3) { - printf("UUID and service hint needed\n"); - exit(EXIT_FAILURE); - } - - if (index == MGMT_INDEX_NONE) - index = 0; - - if (bt_string2uuid(&uuid, argv[1]) < 0) { - printf("Invalid UUID: %s\n", argv[1]); - exit(EXIT_FAILURE); - } - - memset(&cp, 0, sizeof(cp)); - - uuid_to_uuid128(&uuid128, &uuid); - ntoh128((uint128_t *) uuid128.value.uuid128.data, &uint128); - htob128(&uint128, (uint128_t *) cp.uuid); - - cp.svc_hint = atoi(argv[2]); - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_ADD_UUID, index, - &cp, sizeof(cp), class_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send add_uuid cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void cmd_remove_uuid(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_remove_uuid cp; - uint128_t uint128; - uuid_t uuid, uuid128; - - if (argc < 2) { - printf("UUID needed\n"); - exit(EXIT_FAILURE); - } - - if (index == MGMT_INDEX_NONE) - index = 0; - - if (bt_string2uuid(&uuid, argv[1]) < 0) { - printf("Invalid UUID: %s\n", argv[1]); - exit(EXIT_FAILURE); - } - - memset(&cp, 0, sizeof(cp)); - - uuid_to_uuid128(&uuid128, &uuid); - ntoh128((uint128_t *) uuid128.value.uuid128.data, &uint128); - htob128(&uint128, (uint128_t *) cp.uuid); - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_REMOVE_UUID, index, - &cp, sizeof(cp), class_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send remove_uuid cmd\n"); - exit(EXIT_FAILURE); - } -} - -static void cmd_clr_uuids(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - char *uuid_any = "00000000-0000-0000-0000-000000000000"; - char *rm_argv[] = { "rm-uuid", uuid_any, NULL }; - - cmd_remove_uuid(mgmt_sk, index, 2, rm_argv); -} - -static void did_rsp(int mgmt_sk, uint16_t op, uint16_t id, uint8_t status, - void *rsp, uint16_t len, void *user_data) -{ - if (status != 0) { - fprintf(stderr, "Set Device ID failed with status 0x%02x (%s)\n", - status, mgmt_errstr(status)); - exit(EXIT_FAILURE); - } - - printf("Device ID successfully set\n"); - - exit(EXIT_SUCCESS); -} - -static void did_usage(void) -{ - printf("Usage: btmgmt did :::\n"); - printf(" possible source values: bluetooth, usb\n"); -} - -static void cmd_did(int mgmt_sk, uint16_t index, int argc, char **argv) -{ - struct mgmt_cp_set_device_id cp; - uint16_t vendor, product, version , source; - int result; - - if (argc < 2) { - did_usage(); - exit(EXIT_FAILURE); - } - - result = sscanf(argv[1], "bluetooth:%4hx:%4hx:%4hx", &vendor, &product, - &version); - if (result == 3) { - source = 0x0001; - goto done; - } - - result = sscanf(argv[1], "usb:%4hx:%4hx:%4hx", &vendor, &product, - &version); - if (result == 3) { - source = 0x0002; - goto done; - } - - did_usage(); - exit(EXIT_FAILURE); - -done: - if (index == MGMT_INDEX_NONE) - index = 0; - - cp.source = htobs(source); - cp.vendor = htobs(vendor); - cp.product = htobs(product); - cp.version = htobs(version); - - if (mgmt_send_cmd(mgmt_sk, MGMT_OP_SET_DEVICE_ID, index, - &cp, sizeof(cp), did_rsp, NULL) < 0) { - fprintf(stderr, "Unable to send set_dev_class cmd\n"); - exit(EXIT_FAILURE); - } -} - -static struct { - char *cmd; - void (*func)(int mgmt_sk, uint16_t index, int argc, char **argv); - char *doc; -} command[] = { - { "monitor", cmd_monitor, "Monitor events" }, - { "version", cmd_version, "Get the MGMT Version" }, - { "commands", cmd_commands, "List supported commands" }, - { "info", cmd_info, "Show controller info" }, - { "power", cmd_power, "Toggle powered state" }, - { "discov", cmd_discov, "Toggle discoverable state" }, - { "connectable",cmd_connectable,"Toggle connectable state" }, - { "pairable", cmd_pairable, "Toggle pairable state" }, - { "linksec", cmd_linksec, "Toggle link level security" }, - { "ssp", cmd_ssp, "Toggle SSP mode" }, - { "hs", cmd_hs, "Toggle HS Support" }, - { "le", cmd_le, "Toggle LE Support" }, - { "class", cmd_class, "Set device major/minor class" }, - { "disconnect", cmd_disconnect, "Disconnect device" }, - { "con", cmd_con, "List connections" }, - { "find", cmd_find, "Discover nearby devices" }, - { "name", cmd_name, "Set local name" }, - { "pair", cmd_pair, "Pair with a remote device" }, - { "unpair", cmd_unpair, "Unpair device" }, - { "keys", cmd_keys, "Load Keys" }, - { "block", cmd_block, "Block Device" }, - { "unblock", cmd_unblock, "Unblock Device" }, - { "add-uuid", cmd_add_uuid, "Add UUID" }, - { "rm-uuid", cmd_add_uuid, "Remove UUID" }, - { "clr-uuids", cmd_clr_uuids, "Clear UUIDs", }, - { "did", cmd_did, "Set Device ID", }, - { NULL, NULL, 0 } -}; - -static void usage(void) -{ - int i; - - printf("btmgmt ver %s\n", VERSION); - printf("Usage:\n" - "\tbtmgmt [options] [command parameters]\n"); - - printf("Options:\n" - "\t--index \tSpecify adapter index\n" - "\t--verbose\tEnable extra logging\n" - "\t--help\tDisplay help\n"); - - printf("Commands:\n"); - for (i = 0; command[i].cmd; i++) - printf("\t%-15s\t%s\n", command[i].cmd, command[i].doc); - - printf("\n" - "For more information on the usage of each command use:\n" - "\tbtmgmt --help\n" ); -} - -static struct option main_options[] = { - { "index", 1, 0, 'i' }, - { "verbose", 0, 0, 'v' }, - { "help", 0, 0, 'h' }, - { 0, 0, 0, 0 } -}; - -int main(int argc, char *argv[]) -{ - int opt, i, mgmt_sk; - uint16_t index = MGMT_INDEX_NONE; - struct pollfd pollfd; - - while ((opt = getopt_long(argc, argv, "+hvi:", - main_options, NULL)) != -1) { - switch (opt) { - case 'i': - if (strlen(optarg) > 3 && - strncasecmp(optarg, "hci", 3) == 0) - index = atoi(&optarg[4]); - else - index = atoi(optarg); - break; - case 'v': - monitor = true; - break; - case 'h': - default: - usage(); - return 0; - } - } - - argc -= optind; - argv += optind; - optind = 0; - - if (argc < 1) { - usage(); - return 0; - } - - mgmt_sk = mgmt_open(); - if (mgmt_sk < 0) { - fprintf(stderr, "Unable to open mgmt socket\n"); - return -1; - } - - for (i = 0; command[i].cmd; i++) { - if (strcmp(command[i].cmd, argv[0]) != 0) - continue; - - command[i].func(mgmt_sk, index, argc, argv); - break; - } - - if (command[i].cmd == NULL) { - fprintf(stderr, "Unknown command: %s\n", argv[0]); - close(mgmt_sk); - return -1; - } - - pollfd.fd = mgmt_sk; - pollfd.events = POLLIN; - pollfd.revents = 0; - - while (poll(&pollfd, 1, -1) >= 0) { - if (pollfd.revents & (POLLHUP | POLLERR | POLLNVAL)) - break; - - if (pollfd.revents & POLLIN) - mgmt_process_data(mgmt_sk); - - pollfd.revents = 0; - } - - close(mgmt_sk); - - return 0; -} -- 1.7.10.2