1e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************
2e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *
3e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  Copyright (C) 1999-2012 Broadcom Corporation
4e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *
5e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  Licensed under the Apache License, Version 2.0 (the "License");
6e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  you may not use this file except in compliance with the License.
7e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  You may obtain a copy of the License at:
8e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *
9e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  http://www.apache.org/licenses/LICENSE-2.0
10e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *
11e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  Unless required by applicable law or agreed to in writing, software
12e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  distributed under the License is distributed on an "AS IS" BASIS,
13e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  See the License for the specific language governing permissions and
15e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *  limitations under the License.
16e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project *
17e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project ******************************************************************************/
18e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#include "gki_int.h"
19e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#include <stdio.h>
20e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
21e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_TOTAL_BUF_POOLS > 16)
22e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#error Number of pools out of range (16 Max)!
23e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
24e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
25e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (!defined(BTU_STACK_LITE_ENABLED) || BTU_STACK_LITE_ENABLED == FALSE)
26e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectstatic void gki_add_to_pool_list(UINT8 pool_id);
27e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectstatic void gki_remove_from_pool_list(UINT8 pool_id);
28e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif /*  BTU_STACK_LITE_ENABLED == FALSE */
29e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
30e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
31e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#define LOG_TAG "GKI_DEBUG"
325c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen#include <android/log.h>
335c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen#include <cutils/log.h>
34e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#define LOGD(format, ...)  LogMsg (TRACE_CTRL_GENERAL | TRACE_LAYER_GKI | TRACE_ORG_GKI | TRACE_TYPE_GENERIC, format, ## __VA_ARGS__)
35e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
36e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
37e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
38e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         gki_init_free_queue
39e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
40e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Internal function called at startup to initialize a free
41e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  queue. It is called once for each free queue.
42e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
43e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
44e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
45e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
46e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectstatic void gki_init_free_queue (UINT8 id, UINT16 size, UINT16 total, void *p_mem)
47e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
48e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT16           i;
49e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT16           act_size;
50e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *hdr;
51e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *hdr1 = NULL;
52e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT32          *magic;
53e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    INT32            tempsize = size;
54e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB     *p_cb = &gki_cb.com;
55e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
56e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Ensure an even number of longwords */
57e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tempsize = (INT32)ALIGN_POOL(size);
58e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    act_size = (UINT16)(tempsize + BUFFER_PADDING_SIZE);
59e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
60e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Remember pool start and end addresses */
61e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if(p_mem)
62e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
63e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_start[id] = (UINT8 *)p_mem;
64e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_end[id]   = (UINT8 *)p_mem + (act_size * total);
65e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
66e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
67e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->pool_size[id]  = act_size;
68e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
69e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->freeq[id].size      = (UINT16) tempsize;
70e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->freeq[id].total     = total;
71e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->freeq[id].cur_cnt   = 0;
72e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->freeq[id].max_cnt   = 0;
73e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
74e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
75e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    LOGD("gki_init_free_queue() init pool=%d, size=%d (aligned=%d) total=%d start=%p", id, size, tempsize, total, p_mem);
76e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
77e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
78e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Initialize  index table */
79e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if(p_mem)
80e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
81e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        hdr = (BUFFER_HDR_T *)p_mem;
82e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->freeq[id].p_first = hdr;
83e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        for (i = 0; i < total; i++)
84e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        {
85e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            hdr->task_id = GKI_INVALID_TASK;
86e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            hdr->q_id    = id;
87e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            hdr->status  = BUF_STATUS_FREE;
88e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            magic        = (UINT32 *)((UINT8 *)hdr + BUFFER_HDR_SIZE + tempsize);
89e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            *magic       = MAGIC_NO;
90e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            hdr1         = hdr;
91e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            hdr          = (BUFFER_HDR_T *)((UINT8 *)hdr + act_size);
92e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            hdr1->p_next = hdr;
93e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        }
94e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        hdr1->p_next = NULL;
95e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->freeq[id].p_last = hdr1;
96e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
97e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
98e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
99e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
100e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#ifdef GKI_USE_DEFERED_ALLOC_BUF_POOLS
101e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectstatic BOOLEAN gki_alloc_free_queue(UINT8 id)
102e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
103e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    FREE_QUEUE_T  *Q;
104e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
1055c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen    #if GKI_BUFFER_DEBUG
1065c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen        ALOGD("\ngki_alloc_free_queue in, id:%d \n", id);
1075c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen    #endif
108e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
109e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    Q = &p_cb->freeq[p_cb->pool_list[id]];
110e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
111e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if(Q->p_first == 0)
112e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
113e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        void* p_mem = GKI_os_malloc((Q->size + BUFFER_PADDING_SIZE) * Q->total);
114e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if(p_mem)
115e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        {
116e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            //re-initialize the queue with allocated memory
1175c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            #if GKI_BUFFER_DEBUG
1185c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen                ALOGD("\ngki_alloc_free_queue calling  gki_init_free_queue, id:%d  size:%d, totol:%d\n", id, Q->size, Q->total);
1195c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            #endif
120e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            gki_init_free_queue(id, Q->size, Q->total, p_mem);
1215c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            #if GKI_BUFFER_DEBUG
1225c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen                ALOGD("\ngki_alloc_free_queue ret OK, id:%d  size:%d, totol:%d\n", id, Q->size, Q->total);
1235c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            #endif
124e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            return TRUE;
125e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        }
126e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception (GKI_ERROR_BUF_SIZE_TOOBIG, "gki_alloc_free_queue: Not enough memory");
127e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1285c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen    #if GKI_BUFFER_DEBUG
1295c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen        ALOGD("\ngki_alloc_free_queue out failed, id:%d\n", id);
1305c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen    #endif
131e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return FALSE;
132e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
133e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
134e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
135e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
136e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
137e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         gki_buffer_init
138e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
139e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called once internally by GKI at startup to initialize all
140e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  buffers and free buffer pools.
141e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
142e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
143e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
144e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
145e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid gki_buffer_init(void)
146e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
147e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT8   i, tt, mb;
148e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
149e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
150e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Initialize mailboxes */
151e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for (tt = 0; tt < GKI_MAX_TASKS; tt++)
152e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
153e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        for (mb = 0; mb < NUM_TASK_MBOX; mb++)
154e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        {
155e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_cb->OSTaskQFirst[tt][mb] = NULL;
156e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_cb->OSTaskQLast [tt][mb] = NULL;
157e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        }
158e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
159e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
160e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for (tt = 0; tt < GKI_NUM_TOTAL_BUF_POOLS; tt++)
161e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
162e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_start[tt] = NULL;
163e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_end[tt]   = NULL;
164e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_size[tt]  = 0;
165e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
166e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->freeq[tt].p_first = 0;
167e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->freeq[tt].p_last  = 0;
168e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->freeq[tt].size    = 0;
169e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->freeq[tt].total   = 0;
170e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->freeq[tt].cur_cnt = 0;
171e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->freeq[tt].max_cnt = 0;
172e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
173e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
174e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Use default from target.h */
175e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->pool_access_mask = GKI_DEF_BUFPOOL_PERM_MASK;
176e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
177e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (!defined GKI_USE_DEFERED_ALLOC_BUF_POOLS && (GKI_USE_DYNAMIC_BUFFERS == TRUE))
178e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
179e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 0)
180e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool0 = (UINT8 *)GKI_os_malloc ((GKI_BUF0_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF0_MAX);
181e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
182e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
183e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 1)
184e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool1 = (UINT8 *)GKI_os_malloc ((GKI_BUF1_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF1_MAX);
185e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
186e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
187e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 2)
188e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool2 = (UINT8 *)GKI_os_malloc ((GKI_BUF2_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF2_MAX);
189e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
190e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
191e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 3)
192e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool3 = (UINT8 *)GKI_os_malloc ((GKI_BUF3_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF3_MAX);
193e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
194e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
195e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 4)
196e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool4 = (UINT8 *)GKI_os_malloc ((GKI_BUF4_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF4_MAX);
197e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
198e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
199e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 5)
200e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool5 = (UINT8 *)GKI_os_malloc ((GKI_BUF5_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF5_MAX);
201e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
202e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
203e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 6)
204e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool6 = (UINT8 *)GKI_os_malloc ((GKI_BUF6_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF6_MAX);
205e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
206e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
207e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 7)
208e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool7 = (UINT8 *)GKI_os_malloc ((GKI_BUF7_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF7_MAX);
209e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
210e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
211e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 8)
212e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool8 = (UINT8 *)GKI_os_malloc ((GKI_BUF8_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF8_MAX);
213e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
214e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
215e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 9)
216e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool9 = (UINT8 *)GKI_os_malloc ((GKI_BUF9_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF9_MAX);
217e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
218e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
219e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 10)
220e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool10 = (UINT8 *)GKI_os_malloc ((GKI_BUF10_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF10_MAX);
221e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
222e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
223e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 11)
224e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool11 = (UINT8 *)GKI_os_malloc ((GKI_BUF11_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF11_MAX);
225e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
226e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
227e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 12)
228e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool12 = (UINT8 *)GKI_os_malloc ((GKI_BUF12_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF12_MAX);
229e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
230e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
231e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 13)
232e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool13 = (UINT8 *)GKI_os_malloc ((GKI_BUF13_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF13_MAX);
233e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
234e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
235e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 14)
236e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool14 = (UINT8 *)GKI_os_malloc ((GKI_BUF14_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF14_MAX);
237e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
238e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
239e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 15)
240e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->bufpool15 = (UINT8 *)GKI_os_malloc ((GKI_BUF15_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF15_MAX);
241e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
242e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
243e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
244e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
245e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
246e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 0)
247e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(0, GKI_BUF0_SIZE, GKI_BUF0_MAX, p_cb->bufpool0);
248e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
249e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
250e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 1)
251e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(1, GKI_BUF1_SIZE, GKI_BUF1_MAX, p_cb->bufpool1);
252e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
253e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
254e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 2)
255e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(2, GKI_BUF2_SIZE, GKI_BUF2_MAX, p_cb->bufpool2);
256e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
257e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
258e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 3)
259e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(3, GKI_BUF3_SIZE, GKI_BUF3_MAX, p_cb->bufpool3);
260e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
261e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
262e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 4)
263e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(4, GKI_BUF4_SIZE, GKI_BUF4_MAX, p_cb->bufpool4);
264e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
265e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
266e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 5)
267e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(5, GKI_BUF5_SIZE, GKI_BUF5_MAX, p_cb->bufpool5);
268e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
269e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
270e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 6)
271e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(6, GKI_BUF6_SIZE, GKI_BUF6_MAX, p_cb->bufpool6);
272e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
273e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
274e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 7)
275e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(7, GKI_BUF7_SIZE, GKI_BUF7_MAX, p_cb->bufpool7);
276e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
277e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
278e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 8)
279e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(8, GKI_BUF8_SIZE, GKI_BUF8_MAX, p_cb->bufpool8);
280e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
281e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
282e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 9)
283e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(9, GKI_BUF9_SIZE, GKI_BUF9_MAX, p_cb->bufpool9);
284e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
285e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
286e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 10)
287e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(10, GKI_BUF10_SIZE, GKI_BUF10_MAX, p_cb->bufpool10);
288e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
289e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
290e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 11)
291e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(11, GKI_BUF11_SIZE, GKI_BUF11_MAX, p_cb->bufpool11);
292e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
293e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
294e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 12)
295e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(12, GKI_BUF12_SIZE, GKI_BUF12_MAX, p_cb->bufpool12);
296e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
297e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
298e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 13)
299e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(13, GKI_BUF13_SIZE, GKI_BUF13_MAX, p_cb->bufpool13);
300e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
301e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
302e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 14)
303e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(14, GKI_BUF14_SIZE, GKI_BUF14_MAX, p_cb->bufpool14);
304e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
305e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
306e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 15)
307e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    gki_init_free_queue(15, GKI_BUF15_SIZE, GKI_BUF15_MAX, p_cb->bufpool15);
308e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
309e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
310e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* add pools to the pool_list which is arranged in the order of size */
311e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for(i=0; i < GKI_NUM_FIXED_BUF_POOLS ; i++)
312e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
313e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_list[i] = i;
314e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
315e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
316e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->curr_total_no_of_pools = GKI_NUM_FIXED_BUF_POOLS;
317e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
318e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
319e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
320e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
321e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
322e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
323e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
324e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_init_q
325e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
326e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an application to initialize a buffer queue.
327e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
328e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
329e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
330e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
331e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid GKI_init_q (BUFFER_Q *p_q)
332e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
333e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_q->p_first = p_q->p_last = NULL;
334e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_q->count = 0;
335e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
336e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
337e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
338e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
339e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
340e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
341e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
342e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_getbuf
343e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
344e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an application to get a free buffer which
345e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  is of size greater or equal to the requested size.
346e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
347e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  Note: This routine only takes buffers from public pools.
348e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                        It will not use any buffers from pools
349e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                        marked GKI_RESTRICTED_POOL.
350e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
351e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       size - (input) number of bytes needed.
352e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
353e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          A pointer to the buffer, or NULL if none available
354e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
355e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
356e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
357e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_getbuf_debug (UINT16 size, const char * _function_, int _line_)
358e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#else
359e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_getbuf (UINT16 size)
360e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
361e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
362e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT8         i;
363e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    FREE_QUEUE_T  *Q;
364e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T  *p_hdr;
365e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
366e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
367e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT8         x;
368e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
369e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
370e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (size == 0)
371e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
372e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception (GKI_ERROR_BUF_SIZE_ZERO, "getbuf: Size is zero");
373e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (NULL);
374e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
375e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
376e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
377e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    LOGD("GKI_getbuf() requesting %d func:%s(line=%d)", size, _function_, _line_);
378e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
379e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Find the first buffer pool that is public that can hold the desired size */
380e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for (i=0; i < p_cb->curr_total_no_of_pools; i++)
381e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
382e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if ( size <= p_cb->freeq[p_cb->pool_list[i]].size )
383e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            break;
384e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
385e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
386e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if(i == p_cb->curr_total_no_of_pools)
387e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
388e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception (GKI_ERROR_BUF_SIZE_TOOBIG, "getbuf: Size is too big");
389e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (NULL);
390e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
391e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
392e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Make sure the buffers aren't disturbed til finished with allocation */
393e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
394e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
395e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* search the public buffer pools that are big enough to hold the size
396e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project     * until a free buffer is found */
397e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for ( ; i < p_cb->curr_total_no_of_pools; i++)
398e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
399e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        /* Only look at PUBLIC buffer pools (bypass RESTRICTED pools) */
400e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if (((UINT16)1 << p_cb->pool_list[i]) & p_cb->pool_access_mask)
401e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            continue;
402e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
403e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q = &p_cb->freeq[p_cb->pool_list[i]];
404e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if(Q->cur_cnt < Q->total)
405e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        {
406e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        #ifdef GKI_USE_DEFERED_ALLOC_BUF_POOLS
407e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            if(Q->p_first == 0 && gki_alloc_free_queue(i) != TRUE)
408e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            {
409e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project                GKI_TRACE_ERROR_0("GKI_getbuf() out of buffer");
410c2eeefe7d48a7809b0e2c1aa7b4c6f78605159b9Evan Chu                GKI_enable();
411e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project                return NULL;
412e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            }
413e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        #endif
4145c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen
4155c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            if(Q->p_first == 0)
4165c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            {
4175c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen                /* gki_alloc_free_queue() failed to alloc memory */
4185c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen                GKI_TRACE_ERROR_0("GKI_getbuf() fail alloc free queue");
419c2eeefe7d48a7809b0e2c1aa7b4c6f78605159b9Evan Chu                GKI_enable();
4205c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen                return NULL;
4215c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            }
4225c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen
423e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_hdr = Q->p_first;
424e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            Q->p_first = p_hdr->p_next;
425e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
426e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            if (!Q->p_first)
427e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project                Q->p_last = NULL;
428e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
429e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            if(++Q->cur_cnt > Q->max_cnt)
430e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project                Q->max_cnt = Q->cur_cnt;
431e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
432e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            GKI_enable();
433e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
434e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_hdr->task_id = GKI_get_taskid();
435e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
436e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_hdr->status  = BUF_STATUS_UNLINKED;
437e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_hdr->p_next  = NULL;
438e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_hdr->Type    = 0;
439e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
440e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            LOGD("GKI_getbuf() allocated, %x, %x (%d of %d used) %d", (UINT8*)p_hdr + BUFFER_HDR_SIZE, p_hdr, Q->cur_cnt, Q->total, p_cb->freeq[i].total);
441e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
442e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            strncpy(p_hdr->_function, _function_, _GKI_MAX_FUNCTION_NAME_LEN);
443e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_hdr->_function[_GKI_MAX_FUNCTION_NAME_LEN] = '\0';
444e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_hdr->_line = _line_;
445e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
446e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            return ((void *) ((UINT8 *)p_hdr + BUFFER_HDR_SIZE));
447e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        }
448e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
449e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
450e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_TRACE_ERROR_0("GKI_getbuf() unable to allocate buffer!!!!!");
451e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
452e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    LOGD("GKI_getbuf() unable to allocate buffer!!!!!");
453e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    LOGD("******************** GKI Memory Pool Dump ********************");
454e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
455e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb = &gki_cb.com;
456e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
457e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    LOGD("Dumping total of %d buffer pools", p_cb->curr_total_no_of_pools);
458e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
459e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for (i=0 ; i < p_cb->curr_total_no_of_pools; i++)
460e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
461e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr = (BUFFER_HDR_T *)p_cb->pool_start[i];
462e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
463e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        LOGD("pool %d has a total of %d buffers (start=%p)", i, p_cb->freeq[i].total, p_hdr);
464e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
465e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        for (x=0; p_hdr && x < p_cb->freeq[i].total; x++)
466e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        {
467e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            if (p_hdr->status != BUF_STATUS_FREE)
468e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            {
469e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project                LOGD("pool:%d, buf[%d]:%x, hdr:%x status=%d func:%s(line=%d)", i, x, (UINT8*)p_hdr + BUFFER_HDR_SIZE, p_hdr, p_hdr->status, p_hdr->_function, p_hdr->_line);
470e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            }
471e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
472e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_hdr = (BUFFER_HDR_T *)((UINT8 *)p_hdr + p_cb->pool_size[i]);
473e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        }
474e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
475e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    LOGD("**************************************************************");
476e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
477e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
478e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_TRACE_ERROR_0("Failed to allocate GKI buffer");
479e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
480e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
481e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
482e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (NULL);
483e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
484e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
485e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
486e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
487e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
488e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_getpoolbuf
489e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
490e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an application to get a free buffer from
491e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  a specific buffer pool.
492e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
493e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  Note: If there are no more buffers available from the pool,
494e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                        the public buffers are searched for an available buffer.
495e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
496e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       pool_id - (input) pool ID to get a buffer out of.
497e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
498e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          A pointer to the buffer, or NULL if none available
499e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
500e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
501e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
502e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_getpoolbuf_debug (UINT8 pool_id, const char * _function_, int _line_)
503e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#else
504e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_getpoolbuf (UINT8 pool_id)
505e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
506e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
507e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    FREE_QUEUE_T  *Q;
508e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T  *p_hdr;
509e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
510e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
511e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS)
512e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (NULL);
513e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
514e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
515e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    LOGD("GKI_getpoolbuf() requesting from %d func:%s(line=%d)", pool_id, _function_, _line_);
516e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
517e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Make sure the buffers aren't disturbed til finished with allocation */
518e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
519e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
520e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    Q = &p_cb->freeq[pool_id];
521e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if(Q->cur_cnt < Q->total)
522e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
523e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#ifdef GKI_USE_DEFERED_ALLOC_BUF_POOLS
524e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if(Q->p_first == 0 && gki_alloc_free_queue(pool_id) != TRUE)
525e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            return NULL;
526e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
5275c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen
5285c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen        if(Q->p_first == 0)
5295c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen        {
5305c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            /* gki_alloc_free_queue() failed to alloc memory */
5315c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            GKI_TRACE_ERROR_0("GKI_getpoolbuf() fail alloc free queue");
5325c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen            return NULL;
5335c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen        }
5345c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen
535e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr = Q->p_first;
536e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->p_first = p_hdr->p_next;
537e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
538e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if (!Q->p_first)
539e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            Q->p_last = NULL;
540e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
541e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if(++Q->cur_cnt > Q->max_cnt)
542e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            Q->max_cnt = Q->cur_cnt;
543e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
544e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_enable();
545e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
546e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
547e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->task_id = GKI_get_taskid();
548e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
549e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->status  = BUF_STATUS_UNLINKED;
550e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->p_next  = NULL;
551e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->Type    = 0;
552e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
553e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
554e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        LOGD("GKI_getpoolbuf() allocated, %x, %x (%d of %d used) %d", (UINT8*)p_hdr + BUFFER_HDR_SIZE, p_hdr, Q->cur_cnt, Q->total, p_cb->freeq[pool_id].total);
555e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
556e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        strncpy(p_hdr->_function, _function_, _GKI_MAX_FUNCTION_NAME_LEN);
557e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->_function[_GKI_MAX_FUNCTION_NAME_LEN] = '\0';
558e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->_line = _line_;
559e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
560e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return ((void *) ((UINT8 *)p_hdr + BUFFER_HDR_SIZE));
561e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
562e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
563e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* If here, no buffers in the specified pool */
564e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
565e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
566e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
567e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* try for free buffers in public pools */
568e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (GKI_getbuf_debug(p_cb->freeq[pool_id].size, _function_, _line_));
569e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#else
570e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* try for free buffers in public pools */
571e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (GKI_getbuf(p_cb->freeq[pool_id].size));
572e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
573e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
574e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
575e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
576e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
577e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_freebuf
578e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
579e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an application to return a buffer to the free pool.
580e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
581e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       p_buf - (input) address of the beginning of a buffer.
582e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
583e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
584e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
585e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
586e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid GKI_freebuf (void *p_buf)
587e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
588e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    FREE_QUEUE_T    *Q;
589e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr;
590e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
591e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE)
592e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (!p_buf || gki_chk_buf_damage(p_buf))
593e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
594e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Free - Buf Corrupted");
595e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
596e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
597e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
598e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
599e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr = (BUFFER_HDR_T *) ((UINT8 *)p_buf - BUFFER_HDR_SIZE);
600e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
601e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if GKI_BUFFER_DEBUG
602e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    LOGD("GKI_freebuf() freeing, %x, %x, func:%s(line=%d)", p_buf, p_hdr, p_hdr->_function, p_hdr->_line);
603e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
604e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
605e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_hdr->status != BUF_STATUS_UNLINKED)
606e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
607e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_FREEBUF_BUF_LINKED, "Freeing Linked Buf");
608e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
609e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
610e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
611e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_hdr->q_id >= GKI_NUM_TOTAL_BUF_POOLS)
612e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
613e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_FREEBUF_BAD_QID, "Bad Buf QId");
614e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
615e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
616e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
617e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
618e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
619e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /*
620e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    ** Release the buffer
621e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    */
622e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    Q  = &gki_cb.com.freeq[p_hdr->q_id];
623e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (Q->p_last)
624e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->p_last->p_next = p_hdr;
625e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
626e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->p_first = p_hdr;
627e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
628e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    Q->p_last      = p_hdr;
629e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->p_next  = NULL;
630e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->status  = BUF_STATUS_FREE;
631e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->task_id = GKI_INVALID_TASK;
632e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (Q->cur_cnt > 0)
633e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->cur_cnt--;
634e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
635e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
636e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
637e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
638e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
639e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
640e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
641e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
642e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
643e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_get_buf_size
644e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
645e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an application to get the size of a buffer.
646e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
647e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       p_buf - (input) address of the beginning of a buffer.
648e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
649e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          the size of the buffer
650e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
651e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
652e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectUINT16 GKI_get_buf_size (void *p_buf)
653e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
654e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr;
655e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
656e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr = (BUFFER_HDR_T *)((UINT8 *) p_buf - BUFFER_HDR_SIZE);
657e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
658e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if ((UINT32)p_hdr & 1)
659e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (0);
660e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
661e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_hdr->q_id < GKI_NUM_TOTAL_BUF_POOLS)
662e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
663e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (gki_cb.com.freeq[p_hdr->q_id].size);
664e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
665e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
666e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (0);
667e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
668e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
669e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
670e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
671e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         gki_chk_buf_damage
672e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
673e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called internally by OSS to check for buffer corruption.
674e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
675e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          TRUE if there is a problem, else FALSE
676e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
677e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
678e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectBOOLEAN gki_chk_buf_damage(void *p_buf)
679e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
680e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE)
681e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
682e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT32 *magic;
683e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    magic  = (UINT32 *)((UINT8 *) p_buf + GKI_get_buf_size(p_buf));
684e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
685e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if ((UINT32)magic & 1)
686e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (TRUE);
687e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
688e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (*magic == MAGIC_NO)
689e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (FALSE);
690e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
691e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (TRUE);
692e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
693e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#else
694e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
695e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (FALSE);
696e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
697e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
698e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
699e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
700e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
701e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
702e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_send_msg
703e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
704e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by applications to send a buffer to a task
705e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
706e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          Nothing
707e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
708e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
709e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid GKI_send_msg (UINT8 task_id, UINT8 mbox, void *msg)
710e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
711e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr;
712e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
713e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
714e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* If task non-existant or not started, drop buffer */
715e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if ((task_id >= GKI_MAX_TASKS) || (mbox >= NUM_TASK_MBOX) || (p_cb->OSRdyTbl[task_id] == TASK_DEAD))
716e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
717e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_SEND_MSG_BAD_DEST, "Sending to unknown dest");
718e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_freebuf (msg);
719e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
720e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
721e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
722e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE)
723e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (gki_chk_buf_damage(msg))
724e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
725e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Send - Buffer corrupted");
726e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
727e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
728e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
729e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
730e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr = (BUFFER_HDR_T *) ((UINT8 *) msg - BUFFER_HDR_SIZE);
731e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
732e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_hdr->status != BUF_STATUS_UNLINKED)
733e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
734e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_SEND_MSG_BUF_LINKED, "Send - buffer linked");
735e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
736e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
737e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
738e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
739e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
740e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_cb->OSTaskQFirst[task_id][mbox])
741e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->OSTaskQLast[task_id][mbox]->p_next = p_hdr;
742e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
743e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->OSTaskQFirst[task_id][mbox] = p_hdr;
744e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
745e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->OSTaskQLast[task_id][mbox] = p_hdr;
746e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
747e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->p_next = NULL;
748e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->status = BUF_STATUS_QUEUED;
749e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->task_id = task_id;
750e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
751e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
752e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
753e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
754e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_send_event(task_id, (UINT16)EVENT_MASK(mbox));
755e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
756e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
757e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
758e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
759e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
760e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
761e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_read_mbox
762e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
763e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by applications to read a buffer from one of
764e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  the task mailboxes.  A task can only read its own mailbox.
765e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
766e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      mbox  - (input) mailbox ID to read (0, 1, 2, or 3)
767e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
768e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          NULL if the mailbox was empty, else the address of a buffer
769e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
770e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
771e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_read_mbox (UINT8 mbox)
772e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
773e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT8           task_id = GKI_get_taskid();
774e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    void            *p_buf = NULL;
775e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr;
776e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
777e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if ((task_id >= GKI_MAX_TASKS) || (mbox >= NUM_TASK_MBOX))
778e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (NULL);
779e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
780e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
781e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
782e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (gki_cb.com.OSTaskQFirst[task_id][mbox])
783e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
784e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr = gki_cb.com.OSTaskQFirst[task_id][mbox];
785e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        gki_cb.com.OSTaskQFirst[task_id][mbox] = p_hdr->p_next;
786e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
787e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->p_next = NULL;
788e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->status = BUF_STATUS_UNLINKED;
789e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
790e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_buf = (UINT8 *)p_hdr + BUFFER_HDR_SIZE;
791e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
792e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
793e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
794e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
795e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (p_buf);
796e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
797e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
798e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
799e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
800e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
801e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
802e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_enqueue
803e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
804e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Enqueue a buffer at the tail of the queue
805e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
806e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_q  -  (input) pointer to a queue.
807e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  p_buf - (input) address of the buffer to enqueue
808e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
809e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
810e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
811e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
812e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid GKI_enqueue (BUFFER_Q *p_q, void *p_buf)
813e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
814e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr;
815e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
816e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE)
817e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (gki_chk_buf_damage(p_buf))
818e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
819e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Enqueue - Buffer corrupted");
820e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
821e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
822e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
823e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
824e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr = (BUFFER_HDR_T *) ((UINT8 *) p_buf - BUFFER_HDR_SIZE);
825e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
826e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_hdr->status != BUF_STATUS_UNLINKED)
827e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
828e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_ENQUEUE_BUF_LINKED, "Eneueue - buf already linked");
829e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
830e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
831e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
832e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
833e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
834e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Since the queue is exposed (C vs C++), keep the pointers in exposed format */
835e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_q->p_first)
836e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
837e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        BUFFER_HDR_T *p_last_hdr = (BUFFER_HDR_T *)((UINT8 *)p_q->p_last - BUFFER_HDR_SIZE);
838e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_last_hdr->p_next = p_hdr;
839e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
840e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
841e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_q->p_first = p_buf;
842e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
843e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_q->p_last = p_buf;
844e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_q->count++;
845e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
846e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->p_next = NULL;
847e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->status = BUF_STATUS_QUEUED;
848e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
849e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
850e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
851e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
852e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
853e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
854e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
855e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
856e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
857e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_enqueue_head
858e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
859e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Enqueue a buffer at the head of the queue
860e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
861e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_q  -  (input) pointer to a queue.
862e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  p_buf - (input) address of the buffer to enqueue
863e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
864e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
865e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
866e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
867e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid GKI_enqueue_head (BUFFER_Q *p_q, void *p_buf)
868e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
869e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr;
870e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
871e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE)
872e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (gki_chk_buf_damage(p_buf))
873e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
874e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Enqueue - Buffer corrupted");
875e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
876e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
877e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
878e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
879e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr = (BUFFER_HDR_T *) ((UINT8 *) p_buf - BUFFER_HDR_SIZE);
880e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
881e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_hdr->status != BUF_STATUS_UNLINKED)
882e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
883e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_ENQUEUE_BUF_LINKED, "Eneueue head - buf already linked");
884e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
885e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
886e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
887e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
888e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
889e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_q->p_first)
890e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
891e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->p_next = (BUFFER_HDR_T *)((UINT8 *)p_q->p_first - BUFFER_HDR_SIZE);
892e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_q->p_first = p_buf;
893e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
894e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
895e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
896e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_q->p_first = p_buf;
897e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_q->p_last  = p_buf;
898e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->p_next = NULL;
899e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
900e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_q->count++;
901e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
902e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->status = BUF_STATUS_QUEUED;
903e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
904e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
905e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
906e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
907e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
908e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
909e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
910e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
911e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
912e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_dequeue
913e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
914e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Dequeues a buffer from the head of a queue
915e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
916e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_q  - (input) pointer to a queue.
917e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
918e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          NULL if queue is empty, else buffer
919e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
920e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
921e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_dequeue (BUFFER_Q *p_q)
922e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
923e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr;
924e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
925e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
926e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
927e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (!p_q || !p_q->count)
928e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
929e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_enable();
930e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (NULL);
931e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
932e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
933e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr = (BUFFER_HDR_T *)((UINT8 *)p_q->p_first - BUFFER_HDR_SIZE);
934e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
935e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Keep buffers such that GKI header is invisible
936e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    */
937e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_hdr->p_next)
938e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_q->p_first = ((UINT8 *)p_hdr->p_next + BUFFER_HDR_SIZE);
939e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
940e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
941e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_q->p_first = NULL;
942e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_q->p_last  = NULL;
943e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
944e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
945e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_q->count--;
946e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
947e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->p_next = NULL;
948e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->status = BUF_STATUS_UNLINKED;
949e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
950e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
951e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
952e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return ((UINT8 *)p_hdr + BUFFER_HDR_SIZE);
953e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
954e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
955e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
956e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
957e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
958e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_remove_from_queue
959e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
960e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Dequeue a buffer from the middle of the queue
961e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
962e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_q  - (input) pointer to a queue.
963e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  p_buf - (input) address of the buffer to enqueue
964e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
965e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          NULL if queue is empty, else buffer
966e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
967e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
968e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_remove_from_queue (BUFFER_Q *p_q, void *p_buf)
969e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
970e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_prev;
971e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_buf_hdr;
972e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
973e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
974e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
975e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_buf == p_q->p_first)
976e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
977e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_enable();
978e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (GKI_dequeue (p_q));
979e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
980e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
981e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_buf_hdr = (BUFFER_HDR_T *)((UINT8 *)p_buf - BUFFER_HDR_SIZE);
982e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_prev    = (BUFFER_HDR_T *)((UINT8 *)p_q->p_first - BUFFER_HDR_SIZE);
983e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
984e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for ( ; p_prev; p_prev = p_prev->p_next)
985e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
986e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        /* If the previous points to this one, move the pointers around */
987e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if (p_prev->p_next == p_buf_hdr)
988e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        {
989e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_prev->p_next = p_buf_hdr->p_next;
990e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
991e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            /* If we are removing the last guy in the queue, update p_last */
992e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            if (p_buf == p_q->p_last)
993e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project                p_q->p_last = p_prev + 1;
994e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
995e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            /* One less in the queue */
996e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_q->count--;
997e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
998e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            /* The buffer is now unlinked */
999e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_buf_hdr->p_next = NULL;
1000e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_buf_hdr->status = BUF_STATUS_UNLINKED;
1001e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1002e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            GKI_enable();
1003e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            return (p_buf);
1004e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        }
1005e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1006e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1007e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
1008e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (NULL);
1009e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1010e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1011e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1012e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1013e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_getfirst
1014e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1015e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Return a pointer to the first buffer in a queue
1016e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1017e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_q  - (input) pointer to a queue.
1018e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1019e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          NULL if queue is empty, else buffer address
1020e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1021e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1022e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_getfirst (BUFFER_Q *p_q)
1023e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1024e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (p_q->p_first);
1025e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1026e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1027e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1028e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1029e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_getlast
1030e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1031e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Return a pointer to the last buffer in a queue
1032e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1033e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_q  - (input) pointer to a queue.
1034e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1035e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          NULL if queue is empty, else buffer address
1036e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1037e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1038e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_getlast (BUFFER_Q *p_q)
1039e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1040e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (p_q->p_last);
1041e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1042e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1043e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1044e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1045e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_getnext
1046e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1047e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Return a pointer to the next buffer in a queue
1048e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1049e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_buf  - (input) pointer to the buffer to find the next one from.
1050e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1051e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          NULL if no more buffers in the queue, else next buffer address
1052e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1053e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1054e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_getnext (void *p_buf)
1055e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1056e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr;
1057e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1058e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr = (BUFFER_HDR_T *) ((UINT8 *) p_buf - BUFFER_HDR_SIZE);
1059e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1060e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_hdr->p_next)
1061e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return ((UINT8 *)p_hdr->p_next + BUFFER_HDR_SIZE);
1062e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
1063e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (NULL);
1064e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1065e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1066e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1067e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1068e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1069e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1070e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_queue_is_empty
1071e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1072e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Check the status of a queue.
1073e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1074e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_q  - (input) pointer to a queue.
1075e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1076e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          TRUE if queue is empty, else FALSE
1077e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1078e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1079e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectBOOLEAN GKI_queue_is_empty(BUFFER_Q *p_q)
1080e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1081e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return ((BOOLEAN) (p_q->count == 0));
1082e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1083e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1084e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1085e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1086e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_find_buf_start
1087e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1088e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      This function is called with an address inside a buffer,
1089e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  and returns the start address ofthe buffer.
1090e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1091e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  The buffer should be one allocated from one of GKI's pools.
1092e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1093e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_user_area - (input) address of anywhere in a GKI buffer.
1094e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1095e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void * - Address of the beginning of the specified buffer if successful,
1096e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                          otherwise NULL if unsuccessful
1097e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1098e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1099e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_find_buf_start (void *p_user_area)
1100e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1101e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT16       xx, size;
1102e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT32       yy;
1103e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
1104e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT8       *p_ua = (UINT8 *)p_user_area;
1105e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1106e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for (xx = 0; xx < GKI_NUM_TOTAL_BUF_POOLS; xx++)
1107e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1108e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if ((p_ua > p_cb->pool_start[xx]) && (p_ua < p_cb->pool_end[xx]))
1109e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        {
1110e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            yy = (UINT32)(p_ua - p_cb->pool_start[xx]);
1111e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1112e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            size = p_cb->pool_size[xx];
1113e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1114e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            yy = (yy / size) * size;
1115e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1116e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            return ((void *) (p_cb->pool_start[xx] + yy + sizeof(BUFFER_HDR_T)) );
1117e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        }
1118e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1119e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1120e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* If here, invalid address - not in one of our buffers */
1121e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_exception (GKI_ERROR_BUF_SIZE_ZERO, "GKI_get_buf_start:: bad addr");
1122e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1123e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (NULL);
1124e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1125e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1126e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1127e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/********************************************************
1128e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project* The following functions are not needed for light stack
1129e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*********************************************************/
1130e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (!defined(BTU_STACK_LITE_ENABLED) || BTU_STACK_LITE_ENABLED == FALSE)
1131e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1132e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1133e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1134e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_set_pool_permission
1135e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1136e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      This function is called to set or change the permissions for
1137e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  the specified pool ID.
1138e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1139e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       pool_id -       (input) pool ID to be set or changed
1140e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  permission -    (input) GKI_PUBLIC_POOL or GKI_RESTRICTED_POOL
1141e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1142e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          GKI_SUCCESS if successful
1143e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  GKI_INVALID_POOL if unsuccessful
1144e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1145e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1146e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectUINT8 GKI_set_pool_permission(UINT8 pool_id, UINT8 permission)
1147e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1148e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
1149e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1150e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (pool_id < GKI_NUM_TOTAL_BUF_POOLS)
1151e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1152e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if (permission == GKI_RESTRICTED_POOL)
1153e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_cb->pool_access_mask = (UINT16)(p_cb->pool_access_mask | (1 << pool_id));
1154e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1155e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        else    /* mark the pool as public */
1156e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            p_cb->pool_access_mask = (UINT16)(p_cb->pool_access_mask & ~(1 << pool_id));
1157e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1158e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (GKI_SUCCESS);
1159e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1160e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
1161e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (GKI_INVALID_POOL);
1162e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1163e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1164e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1165e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1166e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         gki_add_to_pool_list
1167e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1168e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Adds pool to the pool list which is arranged in the
1169e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  order of size
1170e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1171e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
1172e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1173e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1174e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectstatic void gki_add_to_pool_list(UINT8 pool_id)
1175e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1176e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1177e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    INT32 i, j;
1178e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
1179e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1180e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project     /* Find the position where the specified pool should be inserted into the list */
1181e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for(i=0; i < p_cb->curr_total_no_of_pools; i++)
1182e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1183e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1184e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if(p_cb->freeq[pool_id].size <= p_cb->freeq[ p_cb->pool_list[i] ].size)
1185e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            break;
1186e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1187e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1188e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Insert the new buffer pool ID into the list of pools */
1189e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for(j = p_cb->curr_total_no_of_pools; j > i; j--)
1190e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1191e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_list[j] = p_cb->pool_list[j-1];
1192e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1193e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1194e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->pool_list[i] = pool_id;
1195e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1196e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
1197e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1198e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1199e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1200e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1201e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         gki_remove_from_pool_list
1202e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1203e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Removes pool from the pool list. Called when a pool is deleted
1204e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1205e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
1206e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1207e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1208e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectstatic void gki_remove_from_pool_list(UINT8 pool_id)
1209e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1210e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
1211e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT8 i;
1212e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1213e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for(i=0; i < p_cb->curr_total_no_of_pools; i++)
1214e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1215e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if(pool_id == p_cb->pool_list[i])
1216e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            break;
1217e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1218e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1219e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    while (i < (p_cb->curr_total_no_of_pools - 1))
1220e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1221e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_list[i] = p_cb->pool_list[i+1];
1222e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        i++;
1223e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1224e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1225e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
1226e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1227e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1228e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1229e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1230e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_igetpoolbuf
1231e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1232e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an interrupt service routine to get a free buffer from
1233e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  a specific buffer pool.
1234e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1235e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       pool_id - (input) pool ID to get a buffer out of.
1236e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1237e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          A pointer to the buffer, or NULL if none available
1238e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1239e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1240e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid *GKI_igetpoolbuf (UINT8 pool_id)
1241e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1242e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    FREE_QUEUE_T  *Q;
1243e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T  *p_hdr;
1244e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1245e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS)
1246e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (NULL);
1247e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1248e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1249e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    Q = &gki_cb.com.freeq[pool_id];
1250e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if(Q->cur_cnt < Q->total)
1251e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1252e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr = Q->p_first;
1253e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->p_first = p_hdr->p_next;
1254e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1255e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if (!Q->p_first)
1256e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            Q->p_last = NULL;
1257e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1258e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if(++Q->cur_cnt > Q->max_cnt)
1259e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            Q->max_cnt = Q->cur_cnt;
1260e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1261e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->task_id = GKI_get_taskid();
1262e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1263e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->status  = BUF_STATUS_UNLINKED;
1264e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->p_next  = NULL;
1265e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_hdr->Type    = 0;
1266e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1267e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return ((void *) ((UINT8 *)p_hdr + BUFFER_HDR_SIZE));
1268e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1269e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1270e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (NULL);
1271e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1272e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1273e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1274e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1275e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_poolcount
1276e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1277e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an application to get the total number of buffers
1278e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  in the specified buffer pool.
1279e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1280e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       pool_id - (input) pool ID to get the free count of.
1281e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1282e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          the total number of buffers in the pool
1283e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1284e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1285e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectUINT16 GKI_poolcount (UINT8 pool_id)
1286e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1287e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS)
1288e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (0);
1289e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1290e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (gki_cb.com.freeq[pool_id].total);
1291e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1292e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1293e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1294e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1295e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_poolfreecount
1296e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1297e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an application to get the number of free buffers
1298e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  in the specified buffer pool.
1299e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1300e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       pool_id - (input) pool ID to get the free count of.
1301e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1302e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          the number of free buffers in the pool
1303e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1304e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1305e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectUINT16 GKI_poolfreecount (UINT8 pool_id)
1306e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1307e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    FREE_QUEUE_T  *Q;
1308e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1309e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS)
1310e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (0);
1311e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1312e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    Q  = &gki_cb.com.freeq[pool_id];
1313e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1314e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return ((UINT16)(Q->total - Q->cur_cnt));
1315e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1316e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1317e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1318e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1319e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_change_buf_owner
1320e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1321e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called to change the task ownership of a buffer.
1322e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1323e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      p_buf   - (input) pointer to the buffer
1324e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  task_id - (input) task id to change ownership to
1325e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1326e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
1327e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1328e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1329e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid GKI_change_buf_owner (void *p_buf, UINT8 task_id)
1330e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1331e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr = (BUFFER_HDR_T *) ((UINT8 *) p_buf - BUFFER_HDR_SIZE);
1332e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1333e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->task_id = task_id;
1334e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1335e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
1336e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1337e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1338e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (defined(GKI_SEND_MSG_FROM_ISR) &&  GKI_SEND_MSG_FROM_ISR == TRUE)
1339e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1340e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1341e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_isend_msg
1342e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1343e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called from interrupt context to send a buffer to a task
1344e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1345e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          Nothing
1346e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1347e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1348e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid GKI_isend_msg (UINT8 task_id, UINT8 mbox, void *msg)
1349e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1350e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    BUFFER_HDR_T    *p_hdr;
1351e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
1352e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1353e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* If task non-existant or not started, drop buffer */
1354e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if ((task_id >= GKI_MAX_TASKS) || (mbox >= NUM_TASK_MBOX) || (p_cb->OSRdyTbl[task_id] == TASK_DEAD))
1355e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1356e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_SEND_MSG_BAD_DEST, "Sending to unknown dest");
1357e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_freebuf (msg);
1358e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
1359e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1360e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1361e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE)
1362e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (gki_chk_buf_damage(msg))
1363e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1364e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Send - Buffer corrupted");
1365e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
1366e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1367e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
1368e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1369e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_OWNER_CHECK == TRUE)
1370e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (gki_chk_buf_owner(msg))
1371e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1372e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_NOT_BUF_OWNER, "Send by non-owner");
1373e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
1374e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1375e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
1376e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1377e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr = (BUFFER_HDR_T *) ((UINT8 *) msg - BUFFER_HDR_SIZE);
1378e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1379e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_hdr->status != BUF_STATUS_UNLINKED)
1380e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1381e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_SEND_MSG_BUF_LINKED, "Send - buffer linked");
1382e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
1383e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1384e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1385e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_cb->OSTaskQFirst[task_id][mbox])
1386e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->OSTaskQLast[task_id][mbox]->p_next = p_hdr;
1387e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
1388e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->OSTaskQFirst[task_id][mbox] = p_hdr;
1389e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1390e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_cb->OSTaskQLast[task_id][mbox] = p_hdr;
1391e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1392e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->p_next = NULL;
1393e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->status = BUF_STATUS_QUEUED;
1394e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    p_hdr->task_id = task_id;
1395e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1396e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_isend_event(task_id, (UINT16)EVENT_MASK(mbox));
1397e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1398e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
1399e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1400e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif
1401e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1402e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1403e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1404e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_create_pool
1405e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1406e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by applications to create a buffer pool.
1407e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1408e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      size        - (input) length (in bytes) of each buffer in the pool
1409e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  count       - (input) number of buffers to allocate for the pool
1410e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  permission  - (input) restricted or public access?
1411e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                                        (GKI_PUBLIC_POOL or GKI_RESTRICTED_POOL)
1412e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  p_mem_pool  - (input) pointer to an OS memory pool, NULL if not provided
1413e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1414e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          the buffer pool ID, which should be used in calls to
1415e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  GKI_getpoolbuf(). If a pool could not be created, this
1416e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  function returns 0xff.
1417e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1418e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1419e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectUINT8 GKI_create_pool (UINT16 size, UINT16 count, UINT8 permission, void *p_mem_pool)
1420e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1421e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT8        xx;
1422e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    UINT32       mem_needed;
1423e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    INT32        tempsize = size;
1424e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB *p_cb = &gki_cb.com;
1425e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1426e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* First make sure the size of each pool has a valid size with room for the header info */
1427e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (size > MAX_USER_BUF_SIZE)
1428e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (GKI_INVALID_POOL);
1429e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1430e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* First, look for an unused pool */
1431e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    for (xx = 0; xx < GKI_NUM_TOTAL_BUF_POOLS; xx++)
1432e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1433e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        if (!p_cb->pool_start[xx])
1434e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project            break;
1435e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1436e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1437e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (xx == GKI_NUM_TOTAL_BUF_POOLS)
1438e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (GKI_INVALID_POOL);
1439e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1440e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    /* Ensure an even number of longwords */
1441e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tempsize = (INT32)ALIGN_POOL(size);
1442e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1443e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    mem_needed = (tempsize + BUFFER_PADDING_SIZE) * count;
1444e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1445e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (!p_mem_pool)
1446e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_mem_pool = GKI_os_malloc(mem_needed);
1447e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1448e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (p_mem_pool)
1449e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1450e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        /* Initialize the new pool */
1451e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        gki_init_free_queue (xx, size, count, p_mem_pool);
1452e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        gki_add_to_pool_list(xx);
1453e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        (void) GKI_set_pool_permission (xx, permission);
1454e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->curr_total_no_of_pools++;
1455e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1456e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (xx);
1457e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1458e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
1459e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (GKI_INVALID_POOL);
1460e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1461e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1462e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1463e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1464e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_delete_pool
1465e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1466e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by applications to delete a buffer pool.  The function
1467e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  calls the operating specific function to free the actual memory.
1468e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  An exception is generated if an error is detected.
1469e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1470e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters:      pool_id - (input) Id of the poll being deleted.
1471e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1472e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          void
1473e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1474e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1475e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid GKI_delete_pool (UINT8 pool_id)
1476e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1477e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    FREE_QUEUE_T    *Q;
1478e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    tGKI_COM_CB     *p_cb = &gki_cb.com;
1479e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1480e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if ((pool_id >= GKI_NUM_TOTAL_BUF_POOLS) || (!p_cb->pool_start[pool_id]))
1481e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return;
1482e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1483e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_disable();
1484e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    Q  = &p_cb->freeq[pool_id];
1485e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1486e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (!Q->cur_cnt)
1487e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    {
1488e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->size      = 0;
1489e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->total     = 0;
1490e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->cur_cnt   = 0;
1491e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->max_cnt   = 0;
1492e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->p_first   = NULL;
1493e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        Q->p_last    = NULL;
1494e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1495e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_os_free (p_cb->pool_start[pool_id]);
1496e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1497e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_start[pool_id] = NULL;
1498e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_end[pool_id]   = NULL;
1499e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->pool_size[pool_id]  = 0;
1500e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1501e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        gki_remove_from_pool_list(pool_id);
1502e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        p_cb->curr_total_no_of_pools--;
1503e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    }
1504e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    else
1505e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        GKI_exception(GKI_ERROR_DELETE_POOL_BAD_QID, "Deleting bad pool");
1506e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1507e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    GKI_enable();
1508e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1509e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return;
1510e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1511e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1512e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif /*  BTU_STACK_LITE_ENABLED == FALSE */
1513e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1514e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1515e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1516e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_get_pool_bufsize
1517e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1518e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an application to get the size of buffers in a pool
1519e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1520e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       Pool ID.
1521e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1522e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          the size of buffers in the pool
1523e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1524e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1525e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectUINT16 GKI_get_pool_bufsize (UINT8 pool_id)
1526e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1527e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (pool_id < GKI_NUM_TOTAL_BUF_POOLS)
1528e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (gki_cb.com.freeq[pool_id].size);
1529e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1530e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return (0);
1531e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1532e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1533e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/*******************************************************************************
1534e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1535e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function         GKI_poolutilization
1536e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1537e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description      Called by an application to get the buffer utilization
1538e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**                  in the specified buffer pool.
1539e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1540e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters       pool_id - (input) pool ID to get the free count of.
1541e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1542e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns          % of buffers used from 0 to 100
1543e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project**
1544e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/
1545e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectUINT16 GKI_poolutilization (UINT8 pool_id)
1546e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{
1547e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    FREE_QUEUE_T  *Q;
1548e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1549e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS)
1550e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (100);
1551e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1552e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    Q  = &gki_cb.com.freeq[pool_id];
1553e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1554e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    if (Q->total == 0)
1555e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project        return (100);
1556e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1557e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project    return ((Q->cur_cnt * 100) / Q->total);
1558e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project}
1559e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project
1560