[PATCH 3/7] Bluetooth: Implement Disable RSSI Monitor
From: <hidden>
Date: 2011-08-09 20:29:38
Subsystem:
bluetooth subsystem, the rest · Maintainers:
Marcel Holtmann, Luiz Augusto von Dentz, Linus Torvalds
From: Anderson Briglia <redacted> This patch implements Disable RSSI Monitor command. It is used to remove elements from RSSI monitor list. Signed-off-by: Anderson Briglia <redacted> --- net/bluetooth/mgmt.c | 24 +++++++++++++++++++++++- 1 files changed, 23 insertions(+), 1 deletions(-)
diff --git a/net/bluetooth/mgmt.c b/net/bluetooth/mgmt.c
index 410f614..a4a2927 100644
--- a/net/bluetooth/mgmt.c
+++ b/net/bluetooth/mgmt.c@@ -1957,6 +1957,20 @@ static int rssi_monitor_add(u16 index, bdaddr_t *bdaddr, s8 low_trigger, return 0; } +static int rssi_monitor_remove(u16 index, bdaddr_t *bdaddr) +{ + struct rssi_monitor *rm; + + rm = rssi_monitor_find(index, bdaddr); + if (!rm) + return -EINVAL; + + list_del(&rm->list); + kfree(rm); + + return 0; +} + static int enable_rssi_monitor(struct sock *sk, u16 index, unsigned char *data, u16 len) {
@@ -1977,9 +1991,17 @@ static int enable_rssi_monitor(struct sock *sk, u16 index, static int disable_rssi_monitor(struct sock *sk, u16 index, unsigned char *data, u16 len) { + struct mgmt_cp_disable_rssi_monitor *cp; + BT_DBG("hci%u", index); - return -ENOSYS; + cp = (void *) data; + + if (len != sizeof(*cp)) + return cmd_status(sk, index, + MGMT_OP_DISABLE_RSSI_MONITOR, EINVAL); + + return rssi_monitor_remove(index, &cp->bdaddr); } int mgmt_control(struct sock *sk, struct msghdr *msg, size_t msglen)
--
1.7.4.1