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