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 <stdio.h> 196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#include "gki_int.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 25303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (BTU_STACK_LITE_ENABLED == FALSE) 26512ee63c7cc8feb016863e507a5d33cd0f4242bfRuchi Kandoistatic void gki_add_to_pool_list(uint8_t pool_id); 27512ee63c7cc8feb016863e507a5d33cd0f4242bfRuchi Kandoistatic void gki_remove_from_pool_list(uint8_t pool_id); 28e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif /* BTU_STACK_LITE_ENABLED == FALSE */ 29e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 30303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 31e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#define LOG_TAG "GKI_DEBUG" 325c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen#include <android/log.h> 335c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen#include <cutils/log.h> 346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#define LOGD(format, ...) \ 356fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LogMsg(TRACE_CTRL_GENERAL | TRACE_LAYER_GKI | TRACE_ORG_GKI | \ 366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi TRACE_TYPE_GENERIC, \ 376fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi format, ##__VA_ARGS__) 38e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 39e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 40e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 41e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_init_free_queue 42e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 43e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Internal function called at startup to initialize a free 44e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** queue. It is called once for each free queue. 45e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 46e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 47e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 48e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 496fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoistatic void gki_init_free_queue(uint8_t id, uint16_t size, uint16_t total, 506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi void* p_mem) { 516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint16_t i; 526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint16_t act_size; 536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* hdr; 546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* hdr1 = NULL; 556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint32_t* magic; 566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi int32_t tempsize = size; 576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Ensure an even number of longwords */ 606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tempsize = (int32_t)ALIGN_POOL(size); 616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi act_size = (uint16_t)(tempsize + BUFFER_PADDING_SIZE); 626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Remember pool start and end addresses */ 646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_mem) { 656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_start[id] = (uint8_t*)p_mem; 666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_end[id] = (uint8_t*)p_mem + (act_size * total); 676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_size[id] = act_size; 706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].size = (uint16_t)tempsize; 726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].total = total; 736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].cur_cnt = 0; 746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].max_cnt = 0; 75e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 76303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD( 786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi "gki_init_free_queue() init pool=%d, size=%d (aligned=%d) total=%d " 796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi "start=%p", 806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi id, size, tempsize, total, p_mem); 81e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 82e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 836fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Initialize index table */ 846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_mem) { 856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr = (BUFFER_HDR_T*)p_mem; 866fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].p_first = hdr; 876fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < total; i++) { 886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr->task_id = GKI_INVALID_TASK; 896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr->q_id = id; 906fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr->status = BUF_STATUS_FREE; 916fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi magic = (uint32_t*)((uint8_t*)hdr + BUFFER_HDR_SIZE + tempsize); 926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi *magic = MAGIC_NO; 936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr1 = hdr; 946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr = (BUFFER_HDR_T*)((uint8_t*)hdr + act_size); 956fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr1->p_next = hdr; 96e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr1->p_next = NULL; 986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].p_last = hdr1; 996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 101e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 102e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 103303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_USE_DEFERED_ALLOC_BUF_POOLS == TRUE) 1046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoistatic bool gki_alloc_free_queue(uint8_t id) { 1056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 1066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 1076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#if GKI_BUFFER_DEBUG 1086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi ALOGD("\ngki_alloc_free_queue in, id:%d \n", id); 1096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#endif 1106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 1116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &p_cb->freeq[p_cb->pool_list[id]]; 1126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 1136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0) { 1146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi void* p_mem = GKI_os_malloc((Q->size + BUFFER_PADDING_SIZE) * Q->total); 1156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_mem) { 1166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi// re-initialize the queue with allocated memory 1176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#if GKI_BUFFER_DEBUG 1186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi ALOGD( 1196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi "\ngki_alloc_free_queue calling gki_init_free_queue, id:%d " 1206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi "size:%d, totol:%d\n", 1216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi id, Q->size, Q->total); 1226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#endif 1236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(id, Q->size, Q->total, p_mem); 1246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#if GKI_BUFFER_DEBUG 1256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi ALOGD("\ngki_alloc_free_queue ret OK, id:%d size:%d, totol:%d\n", id, 1266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->size, Q->total); 1276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#endif 1286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return true; 129e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 1306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_SIZE_TOOBIG, 1316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi "gki_alloc_free_queue: Not enough memory"); 1326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#if GKI_BUFFER_DEBUG 1346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi ALOGD("\ngki_alloc_free_queue out failed, id:%d\n", id); 1356fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#endif 1366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return false; 137e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 138e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 139e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 140e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 141e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 142e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_buffer_init 143e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 144e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called once internally by GKI at startup to initialize all 145e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** buffers and free buffer pools. 146e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 147e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 148e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 149e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 1506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid gki_buffer_init(void) { 1516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t i, tt, mb; 1526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 1536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 1546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Initialize mailboxes */ 1556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (tt = 0; tt < GKI_MAX_TASKS; tt++) { 1566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (mb = 0; mb < NUM_TASK_MBOX; mb++) { 1576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQFirst[tt][mb] = NULL; 1586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[tt][mb] = NULL; 159e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 1606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 161e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (tt = 0; tt < GKI_NUM_TOTAL_BUF_POOLS; tt++) { 1636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_start[tt] = NULL; 1646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_end[tt] = NULL; 1656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_size[tt] = 0; 166e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].p_first = 0; 1686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].p_last = 0; 1696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].size = 0; 1706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].total = 0; 1716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].cur_cnt = 0; 1726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].max_cnt = 0; 1736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 174e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1756fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Use default from target.h */ 1766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_access_mask = GKI_DEF_BUFPOOL_PERM_MASK; 1776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 1786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#if (GKI_USE_DEFERED_ALLOC_BUF_POOLS == FALSE && \ 1796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_USE_DYNAMIC_BUFFERS == TRUE) 180e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 181e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 0) 1826fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool0 = (uint8_t*)GKI_os_malloc( 1836fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF0_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF0_MAX); 184e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 185e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 186e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 1) 1876fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool1 = (uint8_t*)GKI_os_malloc( 1886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF1_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF1_MAX); 189e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 190e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 191e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 2) 1926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool2 = (uint8_t*)GKI_os_malloc( 1936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF2_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF2_MAX); 194e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 195e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 196e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 3) 1976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool3 = (uint8_t*)GKI_os_malloc( 1986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF3_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF3_MAX); 199e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 200e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 201e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 4) 2026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool4 = (uint8_t*)GKI_os_malloc( 2036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF4_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF4_MAX); 204e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 205e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 206e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 5) 2076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool5 = (uint8_t*)GKI_os_malloc( 2086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF5_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF5_MAX); 209e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 210e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 211e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 6) 2126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool6 = (uint8_t*)GKI_os_malloc( 2136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF6_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF6_MAX); 214e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 215e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 216e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 7) 2176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool7 = (uint8_t*)GKI_os_malloc( 2186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF7_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF7_MAX); 219e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 220e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 221e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 8) 2226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool8 = (uint8_t*)GKI_os_malloc( 2236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF8_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF8_MAX); 224e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 225e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 226e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 9) 2276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool9 = (uint8_t*)GKI_os_malloc( 2286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF9_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF9_MAX); 229e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 230e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 231e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 10) 2326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool10 = (uint8_t*)GKI_os_malloc( 2336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF10_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF10_MAX); 234e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 235e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 236e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 11) 2376fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool11 = (uint8_t*)GKI_os_malloc( 2386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF11_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF11_MAX); 239e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 240e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 241e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 12) 2426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool12 = (uint8_t*)GKI_os_malloc( 2436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF12_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF12_MAX); 244e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 245e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 246e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 13) 2476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool13 = (uint8_t*)GKI_os_malloc( 2486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF13_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF13_MAX); 249e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 250e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 251e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 14) 2526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool14 = (uint8_t*)GKI_os_malloc( 2536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF14_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF14_MAX); 254e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 255e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 256e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 15) 2576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->bufpool15 = (uint8_t*)GKI_os_malloc( 2586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (GKI_BUF15_SIZE + BUFFER_PADDING_SIZE) * GKI_BUF15_MAX); 259e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 260e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 261e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 262e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 263e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 0) 2646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(0, GKI_BUF0_SIZE, GKI_BUF0_MAX, p_cb->bufpool0); 265e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 266e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 267e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 1) 2686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(1, GKI_BUF1_SIZE, GKI_BUF1_MAX, p_cb->bufpool1); 269e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 270e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 271e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 2) 2726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(2, GKI_BUF2_SIZE, GKI_BUF2_MAX, p_cb->bufpool2); 273e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 274e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 275e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 3) 2766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(3, GKI_BUF3_SIZE, GKI_BUF3_MAX, p_cb->bufpool3); 277e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 278e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 279e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 4) 2806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(4, GKI_BUF4_SIZE, GKI_BUF4_MAX, p_cb->bufpool4); 281e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 282e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 283e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 5) 2846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(5, GKI_BUF5_SIZE, GKI_BUF5_MAX, p_cb->bufpool5); 285e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 286e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 287e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 6) 2886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(6, GKI_BUF6_SIZE, GKI_BUF6_MAX, p_cb->bufpool6); 289e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 290e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 291e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 7) 2926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(7, GKI_BUF7_SIZE, GKI_BUF7_MAX, p_cb->bufpool7); 293e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 294e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 295e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 8) 2966fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(8, GKI_BUF8_SIZE, GKI_BUF8_MAX, p_cb->bufpool8); 297e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 298e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 299e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 9) 3006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(9, GKI_BUF9_SIZE, GKI_BUF9_MAX, p_cb->bufpool9); 301e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 302e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 303e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 10) 3046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(10, GKI_BUF10_SIZE, GKI_BUF10_MAX, p_cb->bufpool10); 305e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 306e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 307e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 11) 3086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(11, GKI_BUF11_SIZE, GKI_BUF11_MAX, p_cb->bufpool11); 309e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 310e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 311e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 12) 3126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(12, GKI_BUF12_SIZE, GKI_BUF12_MAX, p_cb->bufpool12); 313e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 314e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 315e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 13) 3166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(13, GKI_BUF13_SIZE, GKI_BUF13_MAX, p_cb->bufpool13); 317e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 318e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 319e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 14) 3206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(14, GKI_BUF14_SIZE, GKI_BUF14_MAX, p_cb->bufpool14); 321e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 322e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 323e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 15) 3246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(15, GKI_BUF15_SIZE, GKI_BUF15_MAX, p_cb->bufpool15); 325e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 326e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* add pools to the pool_list which is arranged in the order of size */ 3286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < GKI_NUM_FIXED_BUF_POOLS; i++) { 3296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_list[i] = i; 3306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 331e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->curr_total_no_of_pools = GKI_NUM_FIXED_BUF_POOLS; 333e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 335e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 336e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 337e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 338e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 339e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_init_q 340e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 341e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to initialize a buffer queue. 342e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 343e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 344e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 345e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 3466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_init_q(BUFFER_Q* p_q) { 3476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = p_q->p_last = NULL; 3486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count = 0; 349e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 351e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 352e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 353e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 354e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 355e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getbuf 356e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 357e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get a free buffer which 358e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** is of size greater or equal to the requested size. 359e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 360e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Note: This routine only takes buffers from public pools. 361e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** It will not use any buffers from pools 362e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** marked GKI_RESTRICTED_POOL. 363e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 364e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters size - (input) number of bytes needed. 365e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 366e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns A pointer to the buffer, or NULL if none available 367e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 368e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 369303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 3706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getbuf_debug(uint16_t size, const char* _function_, int _line_) 371e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#else 3726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getbuf(uint16_t size) 373e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 374e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{ 3756fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t i; 3766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 3776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 3786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 379303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 3806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t x; 381e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 382e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3836fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (size == 0) { 3846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_SIZE_ZERO, "getbuf: Size is zero"); 3856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 3866fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 387e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 388303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 3896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("GKI_getbuf() requesting %d func:%s(line=%d)", size, _function_, _line_); 390e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 3916fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Find the first buffer pool that is public that can hold the desired size */ 3926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < p_cb->curr_total_no_of_pools; i++) { 3936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (size <= p_cb->freeq[p_cb->pool_list[i]].size) break; 3946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 395e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3966fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (i == p_cb->curr_total_no_of_pools) { 3976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_SIZE_TOOBIG, "getbuf: Size is too big"); 3986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 3996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 4006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 4016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Make sure the buffers aren't disturbed til finished with allocation */ 4026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 403e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* search the public buffer pools that are big enough to hold the size 4056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi * until a free buffer is found */ 4066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (; i < p_cb->curr_total_no_of_pools; i++) { 4076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Only look at PUBLIC buffer pools (bypass RESTRICTED pools) */ 4086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (((uint16_t)1 << p_cb->pool_list[i]) & p_cb->pool_access_mask) continue; 4096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 4106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &p_cb->freeq[p_cb->pool_list[i]]; 4116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->cur_cnt < Q->total) { 4126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#if (GKI_USE_DEFERED_ALLOC_BUF_POOLS == TRUE) 4136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0 && gki_alloc_free_queue(i) != true) { 4146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_TRACE_ERROR_0("GKI_getbuf() out of buffer"); 4156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 4166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return NULL; 4176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 4186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi#endif 4196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 4206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0) { 4216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* gki_alloc_free_queue() failed to alloc memory */ 4226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_TRACE_ERROR_0("GKI_getbuf() fail alloc free queue"); 4236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 4246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return NULL; 4256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 4266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 4276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = Q->p_first; 4286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = p_hdr->p_next; 4296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 4306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!Q->p_first) Q->p_last = NULL; 4316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 4326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (++Q->cur_cnt > Q->max_cnt) Q->max_cnt = Q->cur_cnt; 4336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 4346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 4356fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 4366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = GKI_get_taskid(); 4376fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 4386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 4396fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 4406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->Type = 0; 441303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 4426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("GKI_getbuf() allocated, %x, %x (%d of %d used) %d", 4436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (uint8_t*)p_hdr + BUFFER_HDR_SIZE, p_hdr, Q->cur_cnt, Q->total, 4446fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[i].total); 445e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi strncpy(p_hdr->_function, _function_, _GKI_MAX_FUNCTION_NAME_LEN); 4476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->_function[_GKI_MAX_FUNCTION_NAME_LEN] = '\0'; 4486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->_line = _line_; 449e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 4506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((void*)((uint8_t*)p_hdr + BUFFER_HDR_SIZE)); 451e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 4526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 453e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_TRACE_ERROR_0("GKI_getbuf() unable to allocate buffer!!!!!"); 455303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 4566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("GKI_getbuf() unable to allocate buffer!!!!!"); 4576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("******************** GKI Memory Pool Dump ********************"); 458e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb = &gki_cb.com; 460e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("Dumping total of %d buffer pools", p_cb->curr_total_no_of_pools); 462e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < p_cb->curr_total_no_of_pools; i++) { 4646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)p_cb->pool_start[i]; 465e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("pool %d has a total of %d buffers (start=%p)", i, 4676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[i].total, p_hdr); 468e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (x = 0; p_hdr && x < p_cb->freeq[i].total; x++) { 4706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_FREE) { 4716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("pool:%d, buf[%d]:%x, hdr:%x status=%d func:%s(line=%d)", i, x, 4726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (uint8_t*)p_hdr + BUFFER_HDR_SIZE, p_hdr, p_hdr->status, 4736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->_function, p_hdr->_line); 4746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 475e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_hdr + p_cb->pool_size[i]); 477e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 4786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 4796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("**************************************************************"); 480e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 481e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4826fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_TRACE_ERROR_0("Failed to allocate GKI buffer"); 483e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 485e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4866fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 487e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 488e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 489e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 490e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 491e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getpoolbuf 492e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 493e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get a free buffer from 494e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** a specific buffer pool. 495e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 496e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Note: If there are no more buffers available from the pool, 4976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** the public buffers are searched for an available 4986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*buffer. 499e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 500e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get a buffer out of. 501e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 502e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns A pointer to the buffer, or NULL if none available 503e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 504e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 505303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 5066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getpoolbuf_debug(uint8_t pool_id, const char* _function_, int _line_) 507e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#else 5086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getpoolbuf(uint8_t pool_id) 509e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 510e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{ 5116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 5126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 5136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 514e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (NULL); 516e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 517303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 5186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("GKI_getpoolbuf() requesting from %d func:%s(line=%d)", pool_id, 5196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi _function_, _line_); 520e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 5216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Make sure the buffers aren't disturbed til finished with allocation */ 5226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 523e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &p_cb->freeq[pool_id]; 5256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->cur_cnt < Q->total) { 526303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_USE_DEFERED_ALLOC_BUF_POOLS == TRUE) 5276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0 && gki_alloc_free_queue(pool_id) != true) return NULL; 528e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 5295c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen 5306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0) { 5316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* gki_alloc_free_queue() failed to alloc memory */ 5326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_TRACE_ERROR_0("GKI_getpoolbuf() fail alloc free queue"); 5336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return NULL; 5346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 5355c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen 5366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = Q->p_first; 5376fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = p_hdr->p_next; 538e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5396fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!Q->p_first) Q->p_last = NULL; 540e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5416fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (++Q->cur_cnt > Q->max_cnt) Q->max_cnt = Q->cur_cnt; 542e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 544e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5456fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = GKI_get_taskid(); 546e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 5486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 5496fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->Type = 0; 550e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 551303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 5526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("GKI_getpoolbuf() allocated, %x, %x (%d of %d used) %d", 5536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (uint8_t*)p_hdr + BUFFER_HDR_SIZE, p_hdr, Q->cur_cnt, Q->total, 5546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[pool_id].total); 555e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi strncpy(p_hdr->_function, _function_, _GKI_MAX_FUNCTION_NAME_LEN); 5576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->_function[_GKI_MAX_FUNCTION_NAME_LEN] = '\0'; 5586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->_line = _line_; 559e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 5606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((void*)((uint8_t*)p_hdr + BUFFER_HDR_SIZE)); 5616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 562e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If here, no buffers in the specified pool */ 5646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 565e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 566303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 5676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* try for free buffers in public pools */ 5686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_getbuf_debug(p_cb->freeq[pool_id].size, _function_, _line_)); 569e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#else 5706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* try for free buffers in public pools */ 5716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 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** 5796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** Description Called by an application to return a buffer to the free 5806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*pool. 581e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 582e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters p_buf - (input) address of the beginning of a buffer. 583e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 584e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 585e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 586e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 5876fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_freebuf(void* p_buf) { 5886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 5896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 590e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 591e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 5926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!p_buf || gki_chk_buf_damage(p_buf)) { 5936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Free - Buf Corrupted"); 5946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 5956fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 596e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 597e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 599e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 600303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_BUFFER_DEBUG == TRUE) 6016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi LOGD("GKI_freebuf() freeing, %x, %x, func:%s(line=%d)", p_buf, p_hdr, 6026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->_function, p_hdr->_line); 603e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 604e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 6066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_FREEBUF_BUF_LINKED, "Freeing Linked Buf"); 6076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 6086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 609e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->q_id >= GKI_NUM_TOTAL_BUF_POOLS) { 6116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_FREEBUF_BAD_QID, "Bad Buf QId"); 6126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 6136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 614e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 616e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* 6186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi ** Release the buffer 6196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi */ 6206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &gki_cb.com.freeq[p_hdr->q_id]; 6216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_last) 6226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_last->p_next = p_hdr; 6236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else 6246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = p_hdr; 625e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_last = p_hdr; 6276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 6286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_FREE; 6296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = GKI_INVALID_TASK; 6306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->cur_cnt > 0) Q->cur_cnt--; 631e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 633e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 635e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 636e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 637e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 638e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 639e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_get_buf_size 640e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 641e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get the size of a buffer. 642e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 643e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters p_buf - (input) address of the beginning of a buffer. 644e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 645e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the size of the buffer 646e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 647e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 6486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_get_buf_size(void* p_buf) { 6496fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 650e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 652e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((uint32_t)p_hdr & 1) return (0); 654e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->q_id < GKI_NUM_TOTAL_BUF_POOLS) { 6566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (gki_cb.com.freeq[p_hdr->q_id].size); 6576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 658e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (0); 660e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 661e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 662e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 663e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 664e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_chk_buf_damage 665e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 666e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called internally by OSS to check for buffer corruption. 667e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 668e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns TRUE if there is a problem, else FALSE 669e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 670e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 6716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoibool gki_chk_buf_damage(void* p_buf) { 672e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 673e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint32_t* magic; 6756fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi magic = (uint32_t*)((uint8_t*)p_buf + GKI_get_buf_size(p_buf)); 676e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((uint32_t)magic & 1) return true; 678e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (*magic == MAGIC_NO) return false; 680e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6816fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return true; 682e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 683e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#else 684e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return false; 686e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 687e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 688e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 689e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 690e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 691e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 692e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_send_msg 693e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 694e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by applications to send a buffer to a task 695e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 696e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns Nothing 697e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 698e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 6996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_send_msg(uint8_t task_id, uint8_t mbox, void* msg) { 7006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 7016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 7026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 7036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If task non-existant or not started, drop buffer */ 7046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((task_id >= GKI_MAX_TASKS) || (mbox >= NUM_TASK_MBOX) || 7056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (p_cb->OSRdyTbl[task_id] == TASK_DEAD)) { 7066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_SEND_MSG_BAD_DEST, "Sending to unknown dest"); 7076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_freebuf(msg); 7086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 7096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 710e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 711e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 7126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_damage(msg)) { 7136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Send - Buffer corrupted"); 7146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 7156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 716e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 717e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)msg - BUFFER_HDR_SIZE); 719e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 7216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_SEND_MSG_BUF_LINKED, "Send - buffer linked"); 7226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 7236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 724e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 726e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_cb->OSTaskQFirst[task_id][mbox]) 7286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[task_id][mbox]->p_next = p_hdr; 7296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else 7306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQFirst[task_id][mbox] = p_hdr; 731e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[task_id][mbox] = p_hdr; 733e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 7356fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_QUEUED; 7366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = task_id; 737e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 739e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_send_event(task_id, (uint16_t)EVENT_MASK(mbox)); 741e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 743e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 744e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 745e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 746e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 747e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_read_mbox 748e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 749e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by applications to read a buffer from one of 750e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** the task mailboxes. A task can only read its own mailbox. 751e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 752e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: mbox - (input) mailbox ID to read (0, 1, 2, or 3) 753e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 754e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if the mailbox was empty, else the address of a buffer 755e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 756e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 7576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_read_mbox(uint8_t mbox) { 7586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t task_id = GKI_get_taskid(); 7596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi void* p_buf = NULL; 7606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 761e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((task_id >= GKI_MAX_TASKS) || (mbox >= NUM_TASK_MBOX)) return (NULL); 763e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 765e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_cb.com.OSTaskQFirst[task_id][mbox]) { 7676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = gki_cb.com.OSTaskQFirst[task_id][mbox]; 7686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_cb.com.OSTaskQFirst[task_id][mbox] = p_hdr->p_next; 769e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 7716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 772e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_buf = (uint8_t*)p_hdr + BUFFER_HDR_SIZE; 7746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 775e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 777e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (p_buf); 779e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 780e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 781e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 782e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 783e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_enqueue 784e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 785e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Enqueue a buffer at the tail of the queue 786e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 787e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 788e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** p_buf - (input) address of the buffer to enqueue 789e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 790e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 791e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 792e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 7936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_enqueue(BUFFER_Q* p_q, void* p_buf) { 7946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 795e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 796e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 7976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_damage(p_buf)) { 7986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Enqueue - Buffer corrupted"); 7996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 8006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 801e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 802e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 804e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 8066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_ENQUEUE_BUF_LINKED, "Eneueue - buf already linked"); 8076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 8086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 809e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 811e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Since the queue is exposed (C vs C++), keep the pointers in exposed format 8136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi */ 8146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_q->p_first) { 8156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_last_hdr = 8166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (BUFFER_HDR_T*)((uint8_t*)p_q->p_last - BUFFER_HDR_SIZE); 8176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_last_hdr->p_next = p_hdr; 8186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else 8196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = p_buf; 820e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_last = p_buf; 8226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count++; 823e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 8256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_QUEUED; 826e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 828e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 830e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 831e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 832e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 833e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 834e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_enqueue_head 835e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 836e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Enqueue a buffer at the head of the queue 837e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 838e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 839e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** p_buf - (input) address of the buffer to enqueue 840e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 841e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 842e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 843e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 8446fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_enqueue_head(BUFFER_Q* p_q, void* p_buf) { 8456fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 846e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 847e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 8486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_damage(p_buf)) { 8496fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Enqueue - Buffer corrupted"); 8506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 8516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 852e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 853e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 855e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 8576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_ENQUEUE_BUF_LINKED, 8586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi "Eneueue head - buf already linked"); 8596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 8606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 861e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 863e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_q->p_first) { 8656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = (BUFFER_HDR_T*)((uint8_t*)p_q->p_first - BUFFER_HDR_SIZE); 8666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = p_buf; 8676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else { 8686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = p_buf; 8696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_last = p_buf; 8706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 8716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 8726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count++; 873e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_QUEUED; 875e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 877e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 879e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 880e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 881e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 882e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 883e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_dequeue 884e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 885e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Dequeues a buffer from the head of a queue 886e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 887e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 888e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 889e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if queue is empty, else buffer 890e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 891e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 8926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_dequeue(BUFFER_Q* p_q) { 8936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 894e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8956fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 896e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!p_q || !p_q->count) { 8986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 8996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 9006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 901e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_q->p_first - BUFFER_HDR_SIZE); 903e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Keep buffers such that GKI header is invisible 9056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi */ 9066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->p_next) 9076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = ((uint8_t*)p_hdr->p_next + BUFFER_HDR_SIZE); 9086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else { 9096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = NULL; 9106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_last = NULL; 9116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 912e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count--; 914e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 9166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 917e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 919e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((uint8_t*)p_hdr + BUFFER_HDR_SIZE); 921e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 922e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 923e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 924e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 925e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_remove_from_queue 926e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 927e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Dequeue a buffer from the middle of the queue 928e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 929e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 930e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** p_buf - (input) address of the buffer to enqueue 931e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 932e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if queue is empty, else buffer 933e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 934e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 9356fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_remove_from_queue(BUFFER_Q* p_q, void* p_buf) { 9366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_prev; 9376fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_buf_hdr; 938e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9396fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 940e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9416fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_buf == p_q->p_first) { 9426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 9436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_dequeue(p_q)); 9446fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 945e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_buf_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 9476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_prev = (BUFFER_HDR_T*)((uint8_t*)p_q->p_first - BUFFER_HDR_SIZE); 948e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9496fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (; p_prev; p_prev = p_prev->p_next) { 9506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If the previous points to this one, move the pointers around */ 9516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_prev->p_next == p_buf_hdr) { 9526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_prev->p_next = p_buf_hdr->p_next; 953e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If we are removing the last guy in the queue, update p_last */ 9556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_buf == p_q->p_last) p_q->p_last = p_prev + 1; 956e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* One less in the queue */ 9586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count--; 959e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* The buffer is now unlinked */ 9616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_buf_hdr->p_next = NULL; 9626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_buf_hdr->status = BUF_STATUS_UNLINKED; 963e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 9656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (p_buf); 966e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 9676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 968e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 9706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 971e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 972e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 973e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 974e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 975e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getfirst 976e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 977e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Return a pointer to the first buffer in a queue 978e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 979e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 980e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 981e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if queue is empty, else buffer address 982e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 983e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 9846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getfirst(BUFFER_Q* p_q) { return (p_q->p_first); } 985e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 986e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 987e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 988e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getlast 989e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 990e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Return a pointer to the last buffer in a queue 991e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 992e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 993e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 994e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if queue is empty, else buffer address 995e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 996e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 9976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getlast(BUFFER_Q* p_q) { return (p_q->p_last); } 998e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 999e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1000e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1001e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getnext 1002e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1003e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Return a pointer to the next buffer in a queue 1004e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 10056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** Parameters: p_buf - (input) pointer to the buffer to find the next one 10066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*from. 1007e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 10086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** Returns NULL if no more buffers in the queue, else next buffer 10096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*address 1010e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1011e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 10126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getnext(void* p_buf) { 10136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 1014e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 1016e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->p_next) 10186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((uint8_t*)p_hdr->p_next + BUFFER_HDR_SIZE); 10196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else 10206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 1021e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1022e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1023e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1024e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1025e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_queue_is_empty 1026e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1027e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Check the status of a queue. 1028e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1029e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 1030e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1031e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns TRUE if queue is empty, else FALSE 1032e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1033e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 10346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoibool GKI_queue_is_empty(BUFFER_Q* p_q) { return ((bool)(p_q->count == 0)); } 1035e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1036e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1037e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1038e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_find_buf_start 1039e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1040e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description This function is called with an address inside a buffer, 1041e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** and returns the start address ofthe buffer. 1042e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1043e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** The buffer should be one allocated from one of GKI's pools. 1044e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1045e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_user_area - (input) address of anywhere in a GKI buffer. 1046e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 10476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** Returns void * - Address of the beginning of the specified buffer if 10486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*successful, 1049e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** otherwise NULL if unsuccessful 1050e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1051e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 10526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_find_buf_start(void* p_user_area) { 10536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint16_t xx, size; 10546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint32_t yy; 10556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 10566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t* p_ua = (uint8_t*)p_user_area; 1057e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (xx = 0; xx < GKI_NUM_TOTAL_BUF_POOLS; xx++) { 10596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((p_ua > p_cb->pool_start[xx]) && (p_ua < p_cb->pool_end[xx])) { 10606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi yy = (uint32_t)(p_ua - p_cb->pool_start[xx]); 1061e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi size = p_cb->pool_size[xx]; 1063e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi yy = (yy / size) * size; 1065e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((void*)(p_cb->pool_start[xx] + yy + sizeof(BUFFER_HDR_T))); 1067e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 10686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1069e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If here, invalid address - not in one of our buffers */ 10716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_SIZE_ZERO, "GKI_get_buf_start:: bad addr"); 1072e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 1074e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1075e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1076e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************** 1077e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project* The following functions are not needed for light stack 1078e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*********************************************************/ 1079303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#ifndef BTU_STACK_LITE_ENABLED 1080303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#define BTU_STACK_LITE_ENABLED FALSE 1081303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#endif 1082303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi 1083303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (BTU_STACK_LITE_ENABLED == FALSE) 1084e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1085e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1086e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1087e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_set_pool_permission 1088e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1089e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description This function is called to set or change the permissions for 1090e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** the specified pool ID. 1091e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1092e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to be set or changed 10936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** permission - (input) GKI_PUBLIC_POOL or 10946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*GKI_RESTRICTED_POOL 1095e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1096e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns GKI_SUCCESS if successful 1097e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** GKI_INVALID_POOL if unsuccessful 1098e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1099e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 11006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint8_t GKI_set_pool_permission(uint8_t pool_id, uint8_t permission) { 11016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 1102e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id < GKI_NUM_TOTAL_BUF_POOLS) { 11046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (permission == GKI_RESTRICTED_POOL) 11056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_access_mask = 11066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (uint16_t)(p_cb->pool_access_mask | (1 << pool_id)); 1107e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else /* mark the pool as public */ 11096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_access_mask = 11106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (uint16_t)(p_cb->pool_access_mask & ~(1 << pool_id)); 1111e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_SUCCESS); 11136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else 11146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_INVALID_POOL); 1115e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1116e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1117e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1118e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1119e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_add_to_pool_list 1120e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1121e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Adds pool to the pool list which is arranged in the 1122e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** order of size 1123e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1124e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 1125e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1126e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 11276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoistatic void gki_add_to_pool_list(uint8_t pool_id) { 11286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi int32_t i, j; 11296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 1130e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Find the position where the specified pool should be inserted into the list 11326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi */ 11336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < p_cb->curr_total_no_of_pools; i++) { 11346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_cb->freeq[pool_id].size <= p_cb->freeq[p_cb->pool_list[i]].size) 11356fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi break; 11366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1137e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Insert the new buffer pool ID into the list of pools */ 11396fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (j = p_cb->curr_total_no_of_pools; j > i; j--) { 11406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_list[j] = p_cb->pool_list[j - 1]; 11416fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1142e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_list[i] = pool_id; 1144e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11456fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1146e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1147e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1148e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1149e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1150e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_remove_from_pool_list 1151e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 11526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** Description Removes pool from the pool list. Called when a pool is 11536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*deleted 1154e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1155e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 1156e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1157e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 11586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoistatic void gki_remove_from_pool_list(uint8_t pool_id) { 11596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 11606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t i; 1161e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < p_cb->curr_total_no_of_pools; i++) { 11636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id == p_cb->pool_list[i]) break; 11646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1165e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi while (i < (p_cb->curr_total_no_of_pools - 1)) { 11676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_list[i] = p_cb->pool_list[i + 1]; 11686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi i++; 11696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1170e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1172e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1173e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1174e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1175e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1176e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_igetpoolbuf 1177e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 11786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** Description Called by an interrupt service routine to get a free buffer 11796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*from 1180e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** a specific buffer pool. 1181e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1182e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get a buffer out of. 1183e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1184e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns A pointer to the buffer, or NULL if none available 1185e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1186e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 11876fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_igetpoolbuf(uint8_t pool_id) { 11886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 11896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 1190e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11916fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (NULL); 1192e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &gki_cb.com.freeq[pool_id]; 11946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->cur_cnt < Q->total) { 11956fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = Q->p_first; 11966fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = p_hdr->p_next; 1197e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!Q->p_first) Q->p_last = NULL; 1199e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (++Q->cur_cnt > Q->max_cnt) Q->max_cnt = Q->cur_cnt; 1201e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = GKI_get_taskid(); 1203e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 12056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 12066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->Type = 0; 1207e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((void*)((uint8_t*)p_hdr + BUFFER_HDR_SIZE)); 12096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1210e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 1212e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1213e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1214e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1215e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1216e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_poolcount 1217e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1218e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get the total number of buffers 1219e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** in the specified buffer pool. 1220e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1221e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get the free count of. 1222e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1223e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the total number of buffers in the pool 1224e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1225e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 12266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_poolcount(uint8_t pool_id) { 12276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (0); 1228e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (gki_cb.com.freeq[pool_id].total); 1230e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1231e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1232e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1233e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1234e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_poolfreecount 1235e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1236e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get the number of free buffers 1237e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** in the specified buffer pool. 1238e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1239e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get the free count of. 1240e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1241e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the number of free buffers in the pool 1242e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1243e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 12446fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_poolfreecount(uint8_t pool_id) { 12456fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 1246e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (0); 1248e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12496fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &gki_cb.com.freeq[pool_id]; 1250e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((uint16_t)(Q->total - Q->cur_cnt)); 1252e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1253e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1254e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1255e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1256e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_change_buf_owner 1257e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1258e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called to change the task ownership of a buffer. 1259e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1260e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_buf - (input) pointer to the buffer 1261e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** task_id - (input) task id to change ownership to 1262e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1263e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 1264e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1265e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 12666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_change_buf_owner(void* p_buf, uint8_t task_id) { 12676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 1268e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = task_id; 1270e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1272e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1273e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1274303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_SEND_MSG_FROM_ISR == TRUE) 1275e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1276e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1277e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_isend_msg 1278e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1279e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called from interrupt context to send a buffer to a task 1280e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1281e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns Nothing 1282e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1283e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 12846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_isend_msg(uint8_t task_id, uint8_t mbox, void* msg) { 12856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 12866fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 12876fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 12886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If task non-existant or not started, drop buffer */ 12896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((task_id >= GKI_MAX_TASKS) || (mbox >= NUM_TASK_MBOX) || 12906fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (p_cb->OSRdyTbl[task_id] == TASK_DEAD)) { 12916fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_SEND_MSG_BAD_DEST, "Sending to unknown dest"); 12926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_freebuf(msg); 12936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 12946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1295e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1296e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 12976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_damage(msg)) { 12986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Send - Buffer corrupted"); 12996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 13006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1301e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 1302e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1303e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_OWNER_CHECK == TRUE) 13046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_owner(msg)) { 13056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_NOT_BUF_OWNER, "Send by non-owner"); 13066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 13076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1308e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 1309e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)msg - BUFFER_HDR_SIZE); 1311e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 13136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_SEND_MSG_BUF_LINKED, "Send - buffer linked"); 13146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 13156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1316e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_cb->OSTaskQFirst[task_id][mbox]) 13186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[task_id][mbox]->p_next = p_hdr; 13196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else 13206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQFirst[task_id][mbox] = p_hdr; 1321e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[task_id][mbox] = p_hdr; 1323e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 13256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_QUEUED; 13266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = task_id; 1327e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_isend_event(task_id, (uint16_t)EVENT_MASK(mbox)); 1329e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1331e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1332e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 1333e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1334e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1335e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1336e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_create_pool 1337e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1338e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by applications to create a buffer pool. 1339e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 13406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** Parameters: size - (input) length (in bytes) of each buffer in 13416fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*the pool 13426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** count - (input) number of buffers to allocate for the 13436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*pool 1344e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** permission - (input) restricted or public access? 13456fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** (GKI_PUBLIC_POOL or 13466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*GKI_RESTRICTED_POOL) 13476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** p_mem_pool - (input) pointer to an OS memory pool, NULL if 13486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*not provided 1349e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1350e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the buffer pool ID, which should be used in calls to 1351e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** GKI_getpoolbuf(). If a pool could not be created, this 1352e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** function returns 0xff. 1353e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1354e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 13556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint8_t GKI_create_pool(uint16_t size, uint16_t count, uint8_t permission, 13566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi void* p_mem_pool) { 13576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t xx; 13586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint32_t mem_needed; 13596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi int32_t tempsize = size; 13606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 1361e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* First make sure the size of each pool has a valid size with room for the 13636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi * header info */ 13646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (size > MAX_USER_BUF_SIZE) return (GKI_INVALID_POOL); 1365e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* First, look for an unused pool */ 13676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (xx = 0; xx < GKI_NUM_TOTAL_BUF_POOLS; xx++) { 13686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!p_cb->pool_start[xx]) break; 13696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1370e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (xx == GKI_NUM_TOTAL_BUF_POOLS) return (GKI_INVALID_POOL); 1372e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Ensure an even number of longwords */ 13746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tempsize = (int32_t)ALIGN_POOL(size); 1375e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi mem_needed = (tempsize + BUFFER_PADDING_SIZE) * count; 1377e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 13786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!p_mem_pool) p_mem_pool = GKI_os_malloc(mem_needed); 13796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 13806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_mem_pool) { 13816fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Initialize the new pool */ 13826fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(xx, size, count, p_mem_pool); 13836fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_add_to_pool_list(xx); 13846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (void)GKI_set_pool_permission(xx, permission); 13856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->curr_total_no_of_pools++; 13866fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 13876fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (xx); 13886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else 13896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_INVALID_POOL); 1390e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1391e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1392e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1393e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1394e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_delete_pool 1395e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 13966fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** Description Called by applications to delete a buffer pool. The 13976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*function 13986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** calls the operating specific function to free the actual 13996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*memory. 1400e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** An exception is generated if an error is detected. 1401e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1402e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: pool_id - (input) Id of the poll being deleted. 1403e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1404e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 1405e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1406e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 14076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_delete_pool(uint8_t pool_id) { 14086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 14096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 1410e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((pool_id >= GKI_NUM_TOTAL_BUF_POOLS) || (!p_cb->pool_start[pool_id])) 14126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1413e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 14156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &p_cb->freeq[pool_id]; 1416e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!Q->cur_cnt) { 14186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->size = 0; 14196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->total = 0; 14206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->cur_cnt = 0; 14216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->max_cnt = 0; 14226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = NULL; 14236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_last = NULL; 1424e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_os_free(p_cb->pool_start[pool_id]); 1426e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_start[pool_id] = NULL; 14286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_end[pool_id] = NULL; 14296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_size[pool_id] = 0; 1430e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_remove_from_pool_list(pool_id); 14326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->curr_total_no_of_pools--; 14336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else 14346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_DELETE_POOL_BAD_QID, "Deleting bad pool"); 1435e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 1437e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1439e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1440e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1441e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif /* BTU_STACK_LITE_ENABLED == FALSE */ 1442e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1443e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1444e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1445e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_get_pool_bufsize 1446e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 14476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi** Description Called by an application to get the size of buffers in a 14486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi*pool 1449e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1450e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters Pool ID. 1451e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1452e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the size of buffers in the pool 1453e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1454e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 14556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_get_pool_bufsize(uint8_t pool_id) { 14566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id < GKI_NUM_TOTAL_BUF_POOLS) 14576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (gki_cb.com.freeq[pool_id].size); 1458e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (0); 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_poolutilization 1465e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1466e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get the buffer utilization 1467e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** in the specified buffer pool. 1468e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1469e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get the free count of. 1470e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1471e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns % of buffers used from 0 to 100 1472e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1473e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 14746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_poolutilization(uint8_t pool_id) { 14756fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 1476e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (100); 1478e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &gki_cb.com.freeq[pool_id]; 1480e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14816fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->total == 0) return (100); 1482e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 14836fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((Q->cur_cnt * 100) / Q->total); 1484e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1485