Hi Gustavo,
On 18:10 Mon 09 Jul, Gustavo Padovan wrote:
> From: Gustavo Padovan <gustavo.padovan@xxxxxxxxxxxxxxx>
>
> ---
> .gitignore | 2 +-
> Makefile.tools | 6 +-
> mgmt/main.c | 1933 --------------------------------------------------------
> 3 files changed, 4 insertions(+), 1937 deletions(-)
> delete mode 100644 mgmt/main.c
It may be that I am missing something, but this doesn't look like a move.
>
> 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
Wouldn't it be just "tools/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 <config.h>
> -#endif
> -
> -#include <stdlib.h>
> -#include <stdio.h>
> -#include <unistd.h>
> -#include <errno.h>
> -#include <string.h>
> -#include <sys/types.h>
> -#include <sys/socket.h>
> -#include <poll.h>
> -#include <getopt.h>
> -#include <stdbool.h>
> -
> -#include <bluetooth/bluetooth.h>
> -#include <bluetooth/hci.h>
> -#include <bluetooth/hci_lib.h>
> -#include <bluetooth/sdp.h>
> -#include <bluetooth/sdp_lib.h>
> -#include <bluetooth/mgmt.h>
> -
> -#include <glib.h>
> -#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 <yes/no> [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 <major> <minor>\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 <address>\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 <name> [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] <remote address>\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 <remote address>\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] <remote address>\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] <remote address>\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 <source>:<vendor>:<product>:<version>\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> [command parameters]\n");
> -
> - printf("Options:\n"
> - "\t--index <id>\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 <command> --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
>
> --
> To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
> the body of a message to majordomo@xxxxxxxxxxxxxxx
> More majordomo info at http://vger.kernel.org/majordomo-info.html
Cheers,
--
Vinicius
--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
