diff --git a/tools/btmgmt.c b/tools/btmgmt.c
index 4c393ce..a0c29c1 100644
--- a/tools/btmgmt.c
+++ b/tools/btmgmt.c
}
}
+static void set_io_cap_rsp(uint8_t status, uint16_t len, const void *param,
+ void *user_data)
+{
+ if (status != 0)
+ fprintf(stderr, "Could not set IO Capability with "
+ "status 0x%02x (%s)\n",
+ status, mgmt_errstr(status));
+ else
+ printf("IO Capabilities successfully set\n");
+
+ mainloop_quit();
+}
+
+static void set_io_cap_usage(void)
+{
+ printf("Usage: btmgmt [cap]\n");
+}
+
+static void cmd_set_io_cap(struct mgmt *mgmt, uint16_t index,
+ int argc, char **argv)
+{
+ struct mgmt_cp_set_io_capability cp;
+ uint8_t cap;
+
+ if (argc < 2) {
+ set_io_cap_usage();
+ exit(EXIT_FAILURE);
+ }
+
+ if (index == MGMT_INDEX_NONE)
+ index = 0;
+
+ cap = strtol(argv[1], NULL, 0);
+ memset(&cp, 0, sizeof(cp));
+ cp.io_capability = cap;
+
+ if (mgmt_send(mgmt, MGMT_OP_SET_IO_CAPABILITY, index, sizeof(cp), &cp,
+ set_io_cap_rsp, NULL, NULL) == 0) {
+ fprintf(stderr, "Unable to send set-io-cap cmd\n");
+ exit(EXIT_FAILURE);
+ }
+}
+
static struct {
char *cmd;
void (*func)(struct mgmt *mgmt, uint16_t index, int argc, char **argv);
{ "static-addr",cmd_static_addr,"Set static address" },
{ "debug-keys", cmd_debug_keys, "Toogle debug keys" },
{ "conn-info", cmd_conn_info, "Get connection information" },
+ { "set-io-cap", cmd_set_io_cap, "Set IO Capability" },
{ }
};