From: Mikel Astiz <[email protected]>
Extend the management API with the disconnect reason, as now reported
by the Kernel in MGMT_EV_DEVICE_DISCONNECTED.
---
doc/mgmt-api.txt | 5 +++++
lib/mgmt.h | 1 +
monitor/control.c | 19 +++++++++++++++----
src/mgmt.c | 13 ++++++++-----
4 files changed, 29 insertions(+), 9 deletions(-)
diff --git a/doc/mgmt-api.txt b/doc/mgmt-api.txt
index 51c9b46..c8a5ab9 100644
--- a/doc/mgmt-api.txt
+++ b/doc/mgmt-api.txt
@@ -973,12 +973,17 @@ Event Code 0x000C
Controller Index: <controller id>
Event Parameters Address (6 Octets)
Address_Type (1 Octet)
+ Reason (1 Octet)
Possible values for the Address_Type parameter:
0 BR/EDR
1 LE Public
2 LE Random
+ Possible values for the Reason parameter:
+ 0 Unspecified
+ 1 Connection timeout
+
Connect Failed Event
====================
diff --git a/lib/mgmt.h b/lib/mgmt.h
index a58915b..24d5992 100644
--- a/lib/mgmt.h
+++ b/lib/mgmt.h
@@ -372,6 +372,7 @@ struct mgmt_ev_device_connected {
#define MGMT_EV_DEVICE_DISCONNECTED 0x000C
struct mgmt_ev_device_disconnected {
struct mgmt_addr_info addr;
+ uint8_t reason;
} __packed;
#define MGMT_EV_CONNECT_FAILED 0x000D
diff --git a/monitor/control.c b/monitor/control.c
index 159ba9d..80a4231 100644
--- a/monitor/control.c
+++ b/monitor/control.c
@@ -226,18 +226,29 @@ static void mgmt_device_disconnected(uint16_t len, const void *buf)
{
const struct mgmt_ev_device_disconnected *ev = buf;
char str[18];
+ uint8_t reason;
+ uint16_t l;
- if (len < sizeof(*ev)) {
+ if (len < sizeof(struct mgmt_addr_info)) {
printf("* Malformed Device Disconnected control\n");
return;
}
+ if (len < sizeof(*ev)) {
+ reason = 0;
+ l = len;
+ } else {
+ reason = ev->reason;
+ l = sizeof(*ev);
+ }
+
ba2str(&ev->addr.bdaddr, str);
- printf("@ Device Disconnected: %s (%d)\n", str, ev->addr.type);
+ printf("@ Device Disconnected: %s (%d) reason %u\n", str, ev->addr.type,
+ reason);
- buf += sizeof(*ev);
- len -= sizeof(*ev);
+ buf += l;
+ len -= l;
packet_hexdump(buf, len);
}
diff --git a/src/mgmt.c b/src/mgmt.c
index c55b1a8..52c2d64 100644
--- a/src/mgmt.c
+++ b/src/mgmt.c
@@ -510,18 +510,21 @@ static void mgmt_device_connected(int sk, uint16_t index, void *buf, size_t len)
static void mgmt_device_disconnected(int sk, uint16_t index, void *buf,
size_t len)
{
- struct mgmt_addr_info *ev = buf;
+ struct mgmt_ev_device_disconnected *ev = buf;
struct controller_info *info;
char addr[18];
- if (len < sizeof(*ev)) {
+ if (len < sizeof(struct mgmt_addr_info)) {
error("Too small device_disconnected event");
return;
}
- ba2str(&ev->bdaddr, addr);
+ if (len < sizeof(*ev))
+ memset((char *) buf + len, 0, sizeof(*ev) - len);
+
+ ba2str(&ev->addr.bdaddr, addr);
- DBG("hci%u device %s disconnected", index, addr);
+ DBG("hci%u device %s disconnected reason %u", index, addr, ev->reason);
if (index > max_index) {
error("Unexpected index %u in device_disconnected event", index);
@@ -530,7 +533,7 @@ static void mgmt_device_disconnected(int sk, uint16_t index, void *buf,
info = &controllers[index];
- btd_event_disconn_complete(&info->bdaddr, &ev->bdaddr);
+ btd_event_disconn_complete(&info->bdaddr, &ev->addr.bdaddr);
}
static void mgmt_connect_failed(int sk, uint16_t index, void *buf, size_t len)
--
1.7.7.6