From: Andrei Emeltchenko <andrei.emeltchenko@xxxxxxxxx>
Implementing amp pending HCI function to deal with executing AMP
HCI commands from A2MP protocol.
Code copied from mgmt interface.
---
include/net/bluetooth/hci_core.h | 1 +
net/bluetooth/amp.c | 79 ++++++++++++++++++++++++++++++++++++++
2 files changed, 80 insertions(+), 0 deletions(-)
create mode 100644 net/bluetooth/amp.c
diff --git a/include/net/bluetooth/hci_core.h b/include/net/bluetooth/hci_core.h
index 6f2397e..1e53444 100644
--- a/include/net/bluetooth/hci_core.h
+++ b/include/net/bluetooth/hci_core.h
@@ -225,6 +225,7 @@ struct hci_dev {
__u16 init_last_cmd;
struct list_head mgmt_pending;
+ struct list_head amp_pending;
struct inquiry_cache inq_cache;
struct hci_conn_hash conn_hash;
diff --git a/net/bluetooth/amp.c b/net/bluetooth/amp.c
new file mode 100644
index 0000000..d5c48b6
--- /dev/null
+++ b/net/bluetooth/amp.c
@@ -0,0 +1,79 @@
+#include <net/bluetooth/bluetooth.h>
+#include <net/bluetooth/hci.h>
+#include <net/bluetooth/hci_core.h>
+#include <net/bluetooth/a2mp.h>
+#include <linux/workqueue.h>
+
+struct pending_amp {
+ struct list_head list;
+ u16 opcode;
+ int index;
+ void *param;
+ struct sock *sk;
+ void *user_data;
+ struct amp_mgr *mgr;
+};
+
+static struct pending_amp *amp_pending_find(u16 opcode, struct hci_dev *hdev)
+{
+ struct pending_amp *cmd;
+
+ list_for_each_entry(cmd, &hdev->amp_pending, list)
+ if (cmd->opcode == opcode)
+ return cmd;
+
+ return NULL;
+}
+
+static struct pending_amp *amp_pending_add(struct amp_mgr *mgr, u16 opcode,
+ struct hci_dev *hdev, void *data, u16 len)
+{
+ struct pending_amp *cmd;
+
+ cmd = kmalloc(sizeof(*cmd), GFP_ATOMIC);
+ if (!cmd)
+ return NULL;
+
+ cmd->opcode = opcode;
+ cmd->index = hdev->id;
+
+ cmd->param = kmalloc(len, GFP_ATOMIC);
+ if (!cmd->param) {
+ kfree(cmd);
+ return NULL;
+ }
+
+ if (data)
+ memcpy(cmd->param, data, len);
+
+ amp_mgr_get(mgr);
+ cmd->mgr = mgr;
+ cmd->sk = mgr->a2mp_sock->sk;
+ sock_hold(cmd->sk);
+
+ list_add(&cmd->list, &hdev->amp_pending);
+
+ return cmd;
+}
+
+static void amp_pending_free(struct pending_amp *cmd)
+{
+ sock_put(cmd->sk);
+ amp_mgr_put(cmd->mgr);
+ kfree(cmd->param);
+ kfree(cmd);
+}
+
+static void amp_pending_remove(struct pending_amp *cmd)
+{
+ list_del(&cmd->list);
+ amp_pending_free(cmd);
+}
+
+void amp_pending_remove_all(struct hci_dev *hdev)
+{
+ struct pending_amp *cmd;
+
+ list_for_each_entry(cmd, &hdev->amp_pending, list)
+ amp_pending_remove(cmd);
+}
--
1.7.4.1
--
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
