1 files changed, 187 insertions, 0 deletions
diff --git a/btif/src/btif_profile_queue.c b/btif/src/btif_profile_queue.c
new file mode 100644
index 0000000..4af3b53
--- /dev/null
+++ b/btif/src/btif_profile_queue.c
@@ -0,0 +1,187 @@
+/******************************************************************************
+ *
+ *  Copyright (C) 2009-2012 Broadcom Corporation
+ *
+ *  Licensed under the Apache License, Version 2.0 (the "License");
+ *  you may not use this file except in compliance with the License.
+ *  You may obtain a copy of the License at:
+ *
+ *  http://www.apache.org/licenses/LICENSE-2.0
+ *
+ *  Unless required by applicable law or agreed to in writing, software
+ *  distributed under the License is distributed on an "AS IS" BASIS,
+ *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ *  See the License for the specific language governing permissions and
+ *  limitations under the License.
+ *
+ ******************************************************************************/
+
+/*******************************************************************************
+ *
+ *  Filename:      btif_profile_queue.c
+ *
+ *  Description:   Bluetooth remote device connection queuing implementation.
+ *
+ ******************************************************************************/
+
+#include <hardware/bluetooth.h>
+
+#define LOG_TAG "BTIF_QUEUE"
+#include "btif_common.h"
+#include "btif_profile_queue.h"
+#include "gki.h"
+
+/*******************************************************************************
+**  Local type definitions
+*******************************************************************************/
+
+typedef enum {
+  BTIF_QUEUE_CONNECT_EVT,
+  BTIF_QUEUE_ADVANCE_EVT
+} btif_queue_event_t;
+
+typedef struct connect_node_tag
+{
+    bt_bdaddr_t bda;
+    uint16_t uuid;
+    uint16_t busy;
+    void *p_cb;
+    struct connect_node_tag *p_next;
+} __attribute__((packed))connect_node_t;
+
+
+/*******************************************************************************
+**  Static variables
+*******************************************************************************/
+
+static connect_node_t *connect_queue;
+
+
+/*******************************************************************************
+**  Queue helper functions
+*******************************************************************************/
+
+static void queue_int_add(connect_node_t *p_param)
+{
+    connect_node_t *p_list = connect_queue;
+    connect_node_t *p_node = GKI_getbuf(sizeof(connect_node_t));
+    ASSERTC(p_node != NULL, "Failed to allocate new list node", 0);
+
+    memcpy(p_node, p_param, sizeof(connect_node_t));
+
+    if (connect_queue == NULL)
+    {
+        connect_queue = p_node;
+        return;
+    }
+
+    while (p_list->p_next)
+        p_list = p_list->p_next;
+    p_list->p_next = p_node;
+}
+
+static void queue_int_advance()
+{
+    connect_node_t *p_head = connect_queue;
+    if (connect_queue == NULL)
+        return;
+
+    connect_queue = connect_queue->p_next;
+    GKI_freebuf(p_head);
+}
+
+static bt_status_t queue_int_connect_next()
+{
+    connect_node_t* p_head = connect_queue;
+
+    if (p_head == NULL)
+        return BT_STATUS_FAIL;
+
+    /* If the queue is currently busy, we return  success anyway,
+     * since the connection has been queued... */
+    if (p_head->busy != FALSE)
+        return BT_STATUS_SUCCESS;
+
+    p_head->busy = TRUE;
+    return (*(btif_connect_cb_t*)p_head->p_cb)(&p_head->bda);
+}
+
+static void queue_int_handle_evt(UINT16 event, char *p_param)
+{
+    switch(event)
+    {
+        case BTIF_QUEUE_CONNECT_EVT:
+            queue_int_add((connect_node_t*)p_param);
+            break;
+
+        case BTIF_QUEUE_ADVANCE_EVT:
+            queue_int_advance();
+            break;
+    }
+
+    queue_int_connect_next();
+}
+
+/*******************************************************************************
+**
+** Function         btif_queue_connect
+**
+** Description      Add a new connection to the queue and trigger the next
+**                  scheduled connection.
+**
+** Returns          BT_STATUS_SUCCESS if successful
+**
+*******************************************************************************/
+bt_status_t btif_queue_connect(uint16_t uuid, const bt_bdaddr_t *bda,
+                        btif_connect_cb_t *connect_cb)
+{
+    connect_node_t node;
+    memset(&node, 0, sizeof(connect_node_t));
+    memcpy(&(node.bda), bda, sizeof(bt_bdaddr_t));
+    node.uuid = uuid;
+    node.p_cb = connect_cb;
+
+    return btif_transfer_context(queue_int_handle_evt, BTIF_QUEUE_CONNECT_EVT,
+                          (char*)&node, sizeof(connect_node_t), NULL);
+}
+
+/*******************************************************************************
+**
+** Function         btif_queue_advance
+**
+** Description      Clear the queue's busy status and advance to the next
+**                  scheduled connection.
+**
+** Returns          void
+**
+*******************************************************************************/
+void btif_queue_advance()
+{
+    btif_transfer_context(queue_int_handle_evt, BTIF_QUEUE_ADVANCE_EVT,
+                          NULL, 0, NULL);
+}
+
+
+/*******************************************************************************
+**
+** Function         btif_queue_release
+**
+** Description      Free up all the queue nodes and set the queue head to NULL
+**
+** Returns          void
+**
+*******************************************************************************/
+void btif_queue_release()
+{
+    connect_node_t *current = connect_queue;
+
+    while (current != NULL)
+    {
+         connect_node_t *next = current->p_next;
+         GKI_freebuf(current);
+         current = next;
+    }
+
+    connect_queue = NULL;
+}
+