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 30e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 31e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 32e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_init_free_queue 33e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 34e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Internal function called at startup to initialize a free 35e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** queue. It is called once for each free queue. 36e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 37e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 38e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 39e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoistatic void gki_init_free_queue(uint8_t id, uint16_t size, uint16_t total, 416fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi void* p_mem) { 426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint16_t i; 436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint16_t act_size; 446fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* hdr; 456fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* hdr1 = NULL; 466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint32_t* magic; 476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi int32_t tempsize = size; 486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 496fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Ensure an even number of longwords */ 516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tempsize = (int32_t)ALIGN_POOL(size); 526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi act_size = (uint16_t)(tempsize + BUFFER_PADDING_SIZE); 536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Remember pool start and end addresses */ 556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_mem) { 566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_start[id] = (uint8_t*)p_mem; 576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_end[id] = (uint8_t*)p_mem + (act_size * total); 586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_size[id] = act_size; 616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].size = (uint16_t)tempsize; 636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].total = total; 646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].cur_cnt = 0; 656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].max_cnt = 0; 66e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Initialize index table */ 686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_mem) { 696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr = (BUFFER_HDR_T*)p_mem; 706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[id].p_first = hdr; 716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < total; i++) { 726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr->task_id = GKI_INVALID_TASK; 736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr->q_id = id; 746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr->status = BUF_STATUS_FREE; 756fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi magic = (uint32_t*)((uint8_t*)hdr + BUFFER_HDR_SIZE + tempsize); 766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi *magic = MAGIC_NO; 776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr1 = hdr; 786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr = (BUFFER_HDR_T*)((uint8_t*)hdr + act_size); 796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi hdr1->p_next = hdr; 80e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 818915fdb70fb1ddb04bf9213b75d2e3f50d4da95bRuchi Kandoi if (hdr1 != NULL) hdr = hdr1; 828915fdb70fb1ddb04bf9213b75d2e3f50d4da95bRuchi Kandoi hdr->p_next = NULL; 838915fdb70fb1ddb04bf9213b75d2e3f50d4da95bRuchi Kandoi p_cb->freeq[id].p_last = hdr; 846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 86e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 87e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoistatic bool gki_alloc_free_queue(uint8_t id) { 896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 906fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 916fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &p_cb->freeq[p_cb->pool_list[id]]; 936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0) { 956fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi void* p_mem = GKI_os_malloc((Q->size + BUFFER_PADDING_SIZE) * Q->total); 966fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_mem) { 976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi// re-initialize the queue with allocated memory 986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(id, Q->size, Q->total, p_mem); 996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return true; 100e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 1016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_SIZE_TOOBIG, 1026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi "gki_alloc_free_queue: Not enough memory"); 1036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return false; 105e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 106e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 107e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 108e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 109e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_buffer_init 110e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 111e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called once internally by GKI at startup to initialize all 112e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** buffers and free buffer pools. 113e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 114e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 115e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 116e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 1176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid gki_buffer_init(void) { 1186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t i, tt, mb; 1196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 1206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 1216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Initialize mailboxes */ 1226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (tt = 0; tt < GKI_MAX_TASKS; tt++) { 1236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (mb = 0; mb < NUM_TASK_MBOX; mb++) { 1246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQFirst[tt][mb] = NULL; 1256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[tt][mb] = NULL; 126e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 1276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 128e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (tt = 0; tt < GKI_NUM_TOTAL_BUF_POOLS; tt++) { 1306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_start[tt] = NULL; 1316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_end[tt] = NULL; 1326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_size[tt] = 0; 133e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].p_first = 0; 1356fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].p_last = 0; 1366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].size = 0; 1376fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].total = 0; 1386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].cur_cnt = 0; 1396fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->freeq[tt].max_cnt = 0; 1406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 141e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Use default from target.h */ 1436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_access_mask = GKI_DEF_BUFPOOL_PERM_MASK; 1446fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 145e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 0) 1466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(0, GKI_BUF0_SIZE, GKI_BUF0_MAX, p_cb->bufpool0); 147e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 148e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 149e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 1) 1506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(1, GKI_BUF1_SIZE, GKI_BUF1_MAX, p_cb->bufpool1); 151e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 152e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 153e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 2) 1546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(2, GKI_BUF2_SIZE, GKI_BUF2_MAX, p_cb->bufpool2); 155e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 156e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 157e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 3) 1586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(3, GKI_BUF3_SIZE, GKI_BUF3_MAX, p_cb->bufpool3); 159e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 160e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 161e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 4) 1626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(4, GKI_BUF4_SIZE, GKI_BUF4_MAX, p_cb->bufpool4); 163e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 164e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 165e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 5) 1666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(5, GKI_BUF5_SIZE, GKI_BUF5_MAX, p_cb->bufpool5); 167e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 168e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 169e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 6) 1706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(6, GKI_BUF6_SIZE, GKI_BUF6_MAX, p_cb->bufpool6); 171e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 172e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 173e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 7) 1746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(7, GKI_BUF7_SIZE, GKI_BUF7_MAX, p_cb->bufpool7); 175e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 176e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 177e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 8) 1786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(8, GKI_BUF8_SIZE, GKI_BUF8_MAX, p_cb->bufpool8); 179e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 180e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 181e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 9) 1826fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(9, GKI_BUF9_SIZE, GKI_BUF9_MAX, p_cb->bufpool9); 183e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 184e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 185e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 10) 1866fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(10, GKI_BUF10_SIZE, GKI_BUF10_MAX, p_cb->bufpool10); 187e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 188e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 189e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 11) 1906fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(11, GKI_BUF11_SIZE, GKI_BUF11_MAX, p_cb->bufpool11); 191e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 192e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 193e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 12) 1946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(12, GKI_BUF12_SIZE, GKI_BUF12_MAX, p_cb->bufpool12); 195e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 196e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 197e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 13) 1986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(13, GKI_BUF13_SIZE, GKI_BUF13_MAX, p_cb->bufpool13); 199e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 200e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 201e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 14) 2026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(14, GKI_BUF14_SIZE, GKI_BUF14_MAX, p_cb->bufpool14); 203e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 204e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 205e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_NUM_FIXED_BUF_POOLS > 15) 2066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(15, GKI_BUF15_SIZE, GKI_BUF15_MAX, p_cb->bufpool15); 207e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 208e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 2096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* add pools to the pool_list which is arranged in the order of size */ 2106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < GKI_NUM_FIXED_BUF_POOLS; i++) { 2116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_list[i] = i; 2126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 213e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 2146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->curr_total_no_of_pools = GKI_NUM_FIXED_BUF_POOLS; 215e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 2166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 217e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 218e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 219e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 220e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 221e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_init_q 222e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 223e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to initialize a buffer queue. 224e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 225e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 226e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 227e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 2286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_init_q(BUFFER_Q* p_q) { 2296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = p_q->p_last = NULL; 2306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count = 0; 231e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 2326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 233e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 234e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 235e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 236e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 237e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getbuf 238e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 239e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get a free buffer which 240e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** is of size greater or equal to the requested size. 241e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 242e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Note: This routine only takes buffers from public pools. 243e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** It will not use any buffers from pools 244e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** marked GKI_RESTRICTED_POOL. 245e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 246e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters size - (input) number of bytes needed. 247e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 248e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns A pointer to the buffer, or NULL if none available 249e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 250e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 2516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getbuf(uint16_t size) 252e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{ 2536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t i; 2546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 2556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 2566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 257e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 2586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (size == 0) { 2596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_SIZE_ZERO, "getbuf: Size is zero"); 2606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 2616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 262e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 2636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Find the first buffer pool that is public that can hold the desired size */ 2646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < p_cb->curr_total_no_of_pools; i++) { 2656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (size <= p_cb->freeq[p_cb->pool_list[i]].size) break; 2666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 267e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 2686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (i == p_cb->curr_total_no_of_pools) { 2696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_SIZE_TOOBIG, "getbuf: Size is too big"); 2706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 2716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 2726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 2736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Make sure the buffers aren't disturbed til finished with allocation */ 2746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 275e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 2766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* search the public buffer pools that are big enough to hold the size 2776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi * until a free buffer is found */ 2786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (; i < p_cb->curr_total_no_of_pools; i++) { 2796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Only look at PUBLIC buffer pools (bypass RESTRICTED pools) */ 2806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (((uint16_t)1 << p_cb->pool_list[i]) & p_cb->pool_access_mask) continue; 2816fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 2826fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &p_cb->freeq[p_cb->pool_list[i]]; 2836fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->cur_cnt < Q->total) { 2846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0 && gki_alloc_free_queue(i) != true) { 2856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_TRACE_ERROR_0("GKI_getbuf() out of buffer"); 2866fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 2876fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return NULL; 2886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 2896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 2906fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0) { 2916fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* gki_alloc_free_queue() failed to alloc memory */ 2926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_TRACE_ERROR_0("GKI_getbuf() fail alloc free queue"); 2936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 2946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return NULL; 2956fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 2966fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 2976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = Q->p_first; 2986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = p_hdr->p_next; 2996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 3006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!Q->p_first) Q->p_last = NULL; 3016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 3026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (++Q->cur_cnt > Q->max_cnt) Q->max_cnt = Q->cur_cnt; 3036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 3046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 3056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 3066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = GKI_get_taskid(); 3076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 3086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 3096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 3106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->Type = 0; 3116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((void*)((uint8_t*)p_hdr + BUFFER_HDR_SIZE)); 312e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 3136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 314e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_TRACE_ERROR_0("GKI_getbuf() unable to allocate buffer!!!!!"); 316e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 318e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 320e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 321e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 322e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 323e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 324e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getpoolbuf 325e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 326e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get a free buffer from 327e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** a specific buffer pool. 328e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 329e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Note: If there are no more buffers available from the pool, 330552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** the public buffers are searched for an available 331552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** buffer. 332e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 333e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get a buffer out of. 334e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 335e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns A pointer to the buffer, or NULL if none available 336e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 337e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 3386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getpoolbuf(uint8_t pool_id) 339e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{ 3406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 3416fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 3426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 343e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3446fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (NULL); 345e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Make sure the buffers aren't disturbed til finished with allocation */ 3476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 348e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3496fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &p_cb->freeq[pool_id]; 3506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->cur_cnt < Q->total) { 3516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0 && gki_alloc_free_queue(pool_id) != true) return NULL; 3525c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen 3536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_first == 0) { 3546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* gki_alloc_free_queue() failed to alloc memory */ 3556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_TRACE_ERROR_0("GKI_getpoolbuf() fail alloc free queue"); 3566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return NULL; 3576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 3585c65c3a0f42e174e47fecd4e569606003217ff4eMartijn Coenen 3596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = Q->p_first; 3606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = p_hdr->p_next; 361e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!Q->p_first) Q->p_last = NULL; 363e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (++Q->cur_cnt > Q->max_cnt) Q->max_cnt = Q->cur_cnt; 365e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 367e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = GKI_get_taskid(); 369e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 3716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 3726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->Type = 0; 373e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((void*)((uint8_t*)p_hdr + BUFFER_HDR_SIZE)); 3756fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 376e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If here, no buffers in the specified pool */ 3786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 379e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 3806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* try for free buffers in public pools */ 3816fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_getbuf(p_cb->freeq[pool_id].size)); 382e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 383e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 384e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 385e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 386e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_freebuf 387e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 388552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Description Called by an application to return a buffer to the free 389552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** pool. 390e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 391e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters p_buf - (input) address of the beginning of a buffer. 392e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 393e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 394e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 395e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 3966fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_freebuf(void* p_buf) { 3976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 3986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 399e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 400e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 4016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!p_buf || gki_chk_buf_damage(p_buf)) { 4026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Free - Buf Corrupted"); 4036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 4046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 405e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 406e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 408e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 4106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_FREEBUF_BUF_LINKED, "Freeing Linked Buf"); 4116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 4126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 413e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->q_id >= GKI_NUM_TOTAL_BUF_POOLS) { 4156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_FREEBUF_BAD_QID, "Bad Buf QId"); 4166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 4176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 418e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 420e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* 4226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi ** Release the buffer 4236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi */ 4246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &gki_cb.com.freeq[p_hdr->q_id]; 4256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->p_last) 4266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_last->p_next = p_hdr; 4276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else 4286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = p_hdr; 429e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_last = p_hdr; 4316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 4326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_FREE; 4336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = GKI_INVALID_TASK; 4346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->cur_cnt > 0) Q->cur_cnt--; 435e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 437e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 439e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 440e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 441e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 442e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 443e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_get_buf_size 444e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 445e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get the size of a buffer. 446e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 447e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters p_buf - (input) address of the beginning of a buffer. 448e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 449e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the size of the buffer 450e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 451e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 4526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_get_buf_size(void* p_buf) { 4536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 454e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 456e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((uint32_t)p_hdr & 1) return (0); 458e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->q_id < GKI_NUM_TOTAL_BUF_POOLS) { 4606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (gki_cb.com.freeq[p_hdr->q_id].size); 4616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 462e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (0); 464e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 465e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 466e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 467e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 468e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_chk_buf_damage 469e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 470e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called internally by OSS to check for buffer corruption. 471e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 472e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns TRUE if there is a problem, else FALSE 473e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 474e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 4756fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoibool gki_chk_buf_damage(void* p_buf) { 476e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 477e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint32_t* magic; 4796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi magic = (uint32_t*)((uint8_t*)p_buf + GKI_get_buf_size(p_buf)); 480e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4816fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((uint32_t)magic & 1) return true; 482e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4836fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (*magic == MAGIC_NO) return false; 484e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return true; 486e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 487e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#else 488e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 4896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return false; 490e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 491e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 492e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 493e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 494e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 495e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 496e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_send_msg 497e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 498e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by applications to send a buffer to a task 499e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 500e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns Nothing 501e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 502e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 5036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_send_msg(uint8_t task_id, uint8_t mbox, void* msg) { 5046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 5056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 5066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 5076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If task non-existant or not started, drop buffer */ 5086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((task_id >= GKI_MAX_TASKS) || (mbox >= NUM_TASK_MBOX) || 5096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (p_cb->OSRdyTbl[task_id] == TASK_DEAD)) { 5106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_SEND_MSG_BAD_DEST, "Sending to unknown dest"); 5116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_freebuf(msg); 5126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 5136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 514e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 515e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 5166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_damage(msg)) { 5176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Send - Buffer corrupted"); 5186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 5196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 520e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 521e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)msg - BUFFER_HDR_SIZE); 523e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 5256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_SEND_MSG_BUF_LINKED, "Send - buffer linked"); 5266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 5276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 528e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 530e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_cb->OSTaskQFirst[task_id][mbox]) 5326fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[task_id][mbox]->p_next = p_hdr; 5336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else 5346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQFirst[task_id][mbox] = p_hdr; 535e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[task_id][mbox] = p_hdr; 537e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 5396fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_QUEUED; 5406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = task_id; 541e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 543e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5446fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_send_event(task_id, (uint16_t)EVENT_MASK(mbox)); 545e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 547e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 548e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 549e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 550e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 551e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_read_mbox 552e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 553e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by applications to read a buffer from one of 554e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** the task mailboxes. A task can only read its own mailbox. 555e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 556e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: mbox - (input) mailbox ID to read (0, 1, 2, or 3) 557e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 558e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if the mailbox was empty, else the address of a buffer 559e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 560e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 5616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_read_mbox(uint8_t mbox) { 5626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t task_id = GKI_get_taskid(); 5636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi void* p_buf = NULL; 5646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 565e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((task_id >= GKI_MAX_TASKS) || (mbox >= NUM_TASK_MBOX)) return (NULL); 567e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 569e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_cb.com.OSTaskQFirst[task_id][mbox]) { 5716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = gki_cb.com.OSTaskQFirst[task_id][mbox]; 5726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_cb.com.OSTaskQFirst[task_id][mbox] = p_hdr->p_next; 573e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 5756fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 576e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_buf = (uint8_t*)p_hdr + BUFFER_HDR_SIZE; 5786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 579e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 581e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 5826fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (p_buf); 583e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 584e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 585e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 586e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 587e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_enqueue 588e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 589e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Enqueue a buffer at the tail of the queue 590e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 591e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 592e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** p_buf - (input) address of the buffer to enqueue 593e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 594e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 595e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 596e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 5976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_enqueue(BUFFER_Q* p_q, void* p_buf) { 5986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 599e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 600e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 6016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_damage(p_buf)) { 6026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Enqueue - Buffer corrupted"); 6036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 6046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 605e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 606e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 608e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 6106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_ENQUEUE_BUF_LINKED, "Eneueue - buf already linked"); 6116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 6126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 613e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 615e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Since the queue is exposed (C vs C++), keep the pointers in exposed format 6176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi */ 6186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_q->p_first) { 6196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_last_hdr = 6206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (BUFFER_HDR_T*)((uint8_t*)p_q->p_last - BUFFER_HDR_SIZE); 6216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_last_hdr->p_next = p_hdr; 6226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else 6236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = p_buf; 624e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_last = p_buf; 6266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count++; 627e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 6296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_QUEUED; 630e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 632e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 634e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 635e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 636e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 637e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 638e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_enqueue_head 639e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 640e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Enqueue a buffer at the head of the queue 641e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 642e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 643e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** p_buf - (input) address of the buffer to enqueue 644e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 645e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 646e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 647e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 6486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_enqueue_head(BUFFER_Q* p_q, void* p_buf) { 6496fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 650e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 651e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 6526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_damage(p_buf)) { 6536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Enqueue - Buffer corrupted"); 6546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 6556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 656e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 657e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 659e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 6616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_ENQUEUE_BUF_LINKED, 6626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi "Eneueue head - buf already linked"); 6636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 6646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 665e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 667e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_q->p_first) { 6696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = (BUFFER_HDR_T*)((uint8_t*)p_q->p_first - BUFFER_HDR_SIZE); 6706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = p_buf; 6716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else { 6726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = p_buf; 6736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_last = p_buf; 6746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 6756fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 6766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count++; 677e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_QUEUED; 679e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 681e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6826fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 683e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 684e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 685e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 686e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 687e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_dequeue 688e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 689e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Dequeues a buffer from the head of a queue 690e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 691e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 692e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 693e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if queue is empty, else buffer 694e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 695e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 6966fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_dequeue(BUFFER_Q* p_q) { 6976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 698e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 6996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 700e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!p_q || !p_q->count) { 7026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 7036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 7046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 705e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_q->p_first - BUFFER_HDR_SIZE); 707e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Keep buffers such that GKI header is invisible 7096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi */ 7106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->p_next) 7116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = ((uint8_t*)p_hdr->p_next + BUFFER_HDR_SIZE); 7126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else { 7136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_first = NULL; 7146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->p_last = NULL; 7156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 716e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count--; 718e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 7206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 721e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 723e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((uint8_t*)p_hdr + BUFFER_HDR_SIZE); 725e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 726e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 727e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 728e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 729e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_remove_from_queue 730e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 731e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Dequeue a buffer from the middle of the queue 732e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 733e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 734e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** p_buf - (input) address of the buffer to enqueue 735e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 736e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if queue is empty, else buffer 737e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 738e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 7396fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_remove_from_queue(BUFFER_Q* p_q, void* p_buf) { 7406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_prev; 7416fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_buf_hdr; 742e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 744e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7456fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_buf == p_q->p_first) { 7466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 7476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_dequeue(p_q)); 7486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 749e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_buf_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 7516fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_prev = (BUFFER_HDR_T*)((uint8_t*)p_q->p_first - BUFFER_HDR_SIZE); 752e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (; p_prev; p_prev = p_prev->p_next) { 7546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If the previous points to this one, move the pointers around */ 7556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_prev->p_next == p_buf_hdr) { 7566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_prev->p_next = p_buf_hdr->p_next; 757e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If we are removing the last guy in the queue, update p_last */ 7596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_buf == p_q->p_last) p_q->p_last = p_prev + 1; 760e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* One less in the queue */ 7626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_q->count--; 763e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* The buffer is now unlinked */ 7656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_buf_hdr->p_next = NULL; 7666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_buf_hdr->status = BUF_STATUS_UNLINKED; 767e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 7696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (p_buf); 770e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 7716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 772e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 7736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 7746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 775e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 776e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 777e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 778e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 779e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getfirst 780e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 781e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Return a pointer to the first buffer in a queue 782e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 783e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 784e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 785e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if queue is empty, else buffer address 786e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 787e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 7886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getfirst(BUFFER_Q* p_q) { return (p_q->p_first); } 789e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 790e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 791e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 792e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getlast 793e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 794e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Return a pointer to the last buffer in a queue 795e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 796e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 797e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 798e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns NULL if queue is empty, else buffer address 799e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 800e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 8016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getlast(BUFFER_Q* p_q) { return (p_q->p_last); } 802e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 803e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 804e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 805e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_getnext 806e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 807e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Return a pointer to the next buffer in a queue 808e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 809552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Parameters: p_buf - (input) pointer to the buffer to find the next one 810552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** from. 811e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 812552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Returns NULL if no more buffers in the queue, else next buffer 813552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** address 814e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 815e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 8166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_getnext(void* p_buf) { 8176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 818e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 820e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->p_next) 8226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((uint8_t*)p_hdr->p_next + BUFFER_HDR_SIZE); 8236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else 8246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 825e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 826e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 827e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 828e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 829e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_queue_is_empty 830e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 831e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Check the status of a queue. 832e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 833e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_q - (input) pointer to a queue. 834e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 835e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns TRUE if queue is empty, else FALSE 836e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 837e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 8386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoibool GKI_queue_is_empty(BUFFER_Q* p_q) { return ((bool)(p_q->count == 0)); } 839e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 840e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 841e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 842e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_find_buf_start 843e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 844e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description This function is called with an address inside a buffer, 845e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** and returns the start address ofthe buffer. 846e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 847e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** The buffer should be one allocated from one of GKI's pools. 848e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 849e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_user_area - (input) address of anywhere in a GKI buffer. 850e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 851552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Returns void * - Address of the beginning of the specified buffer if 852552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** successful, otherwise NULL if unsuccessful 853e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 854e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 8556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_find_buf_start(void* p_user_area) { 8566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint16_t xx, size; 8576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint32_t yy; 8586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 8596fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t* p_ua = (uint8_t*)p_user_area; 860e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (xx = 0; xx < GKI_NUM_TOTAL_BUF_POOLS; xx++) { 8626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((p_ua > p_cb->pool_start[xx]) && (p_ua < p_cb->pool_end[xx])) { 8636fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi yy = (uint32_t)(p_ua - p_cb->pool_start[xx]); 864e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi size = p_cb->pool_size[xx]; 866e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi yy = (yy / size) * size; 868e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((void*)(p_cb->pool_start[xx] + yy + sizeof(BUFFER_HDR_T))); 870e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 8716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 872e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If here, invalid address - not in one of our buffers */ 8746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_SIZE_ZERO, "GKI_get_buf_start:: bad addr"); 875e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 8766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 877e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 878e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 879e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************** 880e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project* The following functions are not needed for light stack 881e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*********************************************************/ 882303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#ifndef BTU_STACK_LITE_ENABLED 883303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#define BTU_STACK_LITE_ENABLED FALSE 884303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#endif 885303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi 886303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (BTU_STACK_LITE_ENABLED == FALSE) 887e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 888e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 889e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 890e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_set_pool_permission 891e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 892e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description This function is called to set or change the permissions for 893e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** the specified pool ID. 894e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 895552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Parameters pool_id - (input) pool ID to be set or changed 896552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** permission - (input) GKI_PUBLIC_POOL or GKI_RESTRICTED_POOL 897e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 898e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns GKI_SUCCESS if successful 899e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** GKI_INVALID_POOL if unsuccessful 900e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 901e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 9026fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint8_t GKI_set_pool_permission(uint8_t pool_id, uint8_t permission) { 9036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 904e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id < GKI_NUM_TOTAL_BUF_POOLS) { 9066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (permission == GKI_RESTRICTED_POOL) 9076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_access_mask = 9086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (uint16_t)(p_cb->pool_access_mask | (1 << pool_id)); 909e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else /* mark the pool as public */ 9116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_access_mask = 9126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (uint16_t)(p_cb->pool_access_mask & ~(1 << pool_id)); 913e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_SUCCESS); 9156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else 9166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_INVALID_POOL); 917e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 918e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 919e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 920e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 921e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_add_to_pool_list 922e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 923e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Adds pool to the pool list which is arranged in the 924e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** order of size 925e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 926e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 927e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 928e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 9296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoistatic void gki_add_to_pool_list(uint8_t pool_id) { 9306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi int32_t i, j; 9316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 932e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Find the position where the specified pool should be inserted into the list 9346fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi */ 9356fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < p_cb->curr_total_no_of_pools; i++) { 9366fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_cb->freeq[pool_id].size <= p_cb->freeq[p_cb->pool_list[i]].size) 9376fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi break; 9386fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 939e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9406fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Insert the new buffer pool ID into the list of pools */ 9416fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (j = p_cb->curr_total_no_of_pools; j > i; j--) { 9426fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_list[j] = p_cb->pool_list[j - 1]; 9436fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 944e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9456fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_list[i] = pool_id; 946e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9476fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 948e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 949e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 950e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 951e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 952e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function gki_remove_from_pool_list 953e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 954552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Description Removes pool from the pool list. Called when a pool is 955552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** deleted 956e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 957e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 958e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 959e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 9606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoistatic void gki_remove_from_pool_list(uint8_t pool_id) { 9616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 9626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t i; 963e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (i = 0; i < p_cb->curr_total_no_of_pools; i++) { 9656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id == p_cb->pool_list[i]) break; 9666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 967e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi while (i < (p_cb->curr_total_no_of_pools - 1)) { 9696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_list[i] = p_cb->pool_list[i + 1]; 9706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi i++; 9716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 972e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9736fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 974e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 975e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 976e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 977e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 978e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_igetpoolbuf 979e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 980552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Description Called by an interrupt service routine to get a free buffer 981552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** from a specific buffer pool. 982e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 983e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get a buffer out of. 984e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 985e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns A pointer to the buffer, or NULL if none available 986e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 987e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 9886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid* GKI_igetpoolbuf(uint8_t pool_id) { 9896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 9906fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 991e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (NULL); 993e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &gki_cb.com.freeq[pool_id]; 9956fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->cur_cnt < Q->total) { 9966fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = Q->p_first; 9976fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = p_hdr->p_next; 998e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 9996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!Q->p_first) Q->p_last = NULL; 1000e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (++Q->cur_cnt > Q->max_cnt) Q->max_cnt = Q->cur_cnt; 1002e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10036fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = GKI_get_taskid(); 1004e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_UNLINKED; 10066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 10076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->Type = 0; 1008e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((void*)((uint8_t*)p_hdr + BUFFER_HDR_SIZE)); 10106fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1011e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (NULL); 1013e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1014e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1015e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1016e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1017e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_poolcount 1018e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1019e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get the total number of buffers 1020e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** in the specified buffer pool. 1021e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1022e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get the free count of. 1023e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1024e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the total number of buffers in the pool 1025e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1026e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 10276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_poolcount(uint8_t pool_id) { 10286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (0); 1029e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (gki_cb.com.freeq[pool_id].total); 1031e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1032e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1033e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1034e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1035e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_poolfreecount 1036e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1037e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get the number of free buffers 1038e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** in the specified buffer pool. 1039e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1040e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get the free count of. 1041e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1042e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the number of free buffers in the pool 1043e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1044e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 10456fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_poolfreecount(uint8_t pool_id) { 10466fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 1047e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10486fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (0); 1049e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10506fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &gki_cb.com.freeq[pool_id]; 1051e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((uint16_t)(Q->total - Q->cur_cnt)); 1053e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1054e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1055e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1056e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1057e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_change_buf_owner 1058e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1059e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called to change the task ownership of a buffer. 1060e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1061e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: p_buf - (input) pointer to the buffer 1062e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** task_id - (input) task id to change ownership to 1063e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1064e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 1065e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1066e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 10676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_change_buf_owner(void* p_buf, uint8_t task_id) { 10686fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr = (BUFFER_HDR_T*)((uint8_t*)p_buf - BUFFER_HDR_SIZE); 1069e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10706fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = task_id; 1071e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 10726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1073e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1074e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1075303fec1d79b7ac30a09713e5db9fff299f7227fbRuchi Kandoi#if (GKI_SEND_MSG_FROM_ISR == TRUE) 1076e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1077e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1078e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_isend_msg 1079e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1080e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called from interrupt context to send a buffer to a task 1081e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1082e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns Nothing 1083e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1084e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 10856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_isend_msg(uint8_t task_id, uint8_t mbox, void* msg) { 10866fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi BUFFER_HDR_T* p_hdr; 10876fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 10886fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 10896fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* If task non-existant or not started, drop buffer */ 10906fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((task_id >= GKI_MAX_TASKS) || (mbox >= NUM_TASK_MBOX) || 10916fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (p_cb->OSRdyTbl[task_id] == TASK_DEAD)) { 10926fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_SEND_MSG_BAD_DEST, "Sending to unknown dest"); 10936fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_freebuf(msg); 10946fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 10956fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1096e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1097e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_BUF_CORRUPTION_CHECK == TRUE) 10986fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_damage(msg)) { 10996fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_BUF_CORRUPTED, "Send - Buffer corrupted"); 11006fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 11016fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1102e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 1103e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1104e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#if (GKI_ENABLE_OWNER_CHECK == TRUE) 11056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (gki_chk_buf_owner(msg)) { 11066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_NOT_BUF_OWNER, "Send by non-owner"); 11076fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 11086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1109e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 1110e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr = (BUFFER_HDR_T*)((uint8_t*)msg - BUFFER_HDR_SIZE); 1112e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11136fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_hdr->status != BUF_STATUS_UNLINKED) { 11146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_SEND_MSG_BUF_LINKED, "Send - buffer linked"); 11156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 11166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1117e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_cb->OSTaskQFirst[task_id][mbox]) 11196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[task_id][mbox]->p_next = p_hdr; 11206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi else 11216fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQFirst[task_id][mbox] = p_hdr; 1122e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11236fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->OSTaskQLast[task_id][mbox] = p_hdr; 1124e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->p_next = NULL; 11266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->status = BUF_STATUS_QUEUED; 11276fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_hdr->task_id = task_id; 1128e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_isend_event(task_id, (uint16_t)EVENT_MASK(mbox)); 1130e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1132e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1133e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif 1134e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1135e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1136e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1137e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_create_pool 1138e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1139e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by applications to create a buffer pool. 1140e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1141552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Parameters: size - (input) length (in bytes) of each buffer in the pool 1142552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** count - (input) number of buffers to allocate for the pool 1143552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** permission - (input) restricted or public access? 1144552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** (GKI_PUBLIC_POOL or GKI_RESTRICTED_POOL) 1145552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** p_mem_pool - (input) pointer to an OS memory pool, NULL if 1146552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** not provided 1147e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1148e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the buffer pool ID, which should be used in calls to 1149e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** GKI_getpoolbuf(). If a pool could not be created, this 1150e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** function returns 0xff. 1151e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1152e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 11536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint8_t GKI_create_pool(uint16_t size, uint16_t count, uint8_t permission, 11546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi void* p_mem_pool) { 11556fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint8_t xx; 11566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi uint32_t mem_needed; 11576fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi int32_t tempsize = size; 11586fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 1159e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11606fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* First make sure the size of each pool has a valid size with room for the 11616fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi * header info */ 11626fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (size > MAX_USER_BUF_SIZE) return (GKI_INVALID_POOL); 1163e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11646fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* First, look for an unused pool */ 11656fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi for (xx = 0; xx < GKI_NUM_TOTAL_BUF_POOLS; xx++) { 11666fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!p_cb->pool_start[xx]) break; 11676fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } 1168e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11696fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (xx == GKI_NUM_TOTAL_BUF_POOLS) return (GKI_INVALID_POOL); 1170e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Ensure an even number of longwords */ 11726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tempsize = (int32_t)ALIGN_POOL(size); 1173e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi mem_needed = (tempsize + BUFFER_PADDING_SIZE) * count; 1175e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 11766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!p_mem_pool) p_mem_pool = GKI_os_malloc(mem_needed); 11776fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 11786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (p_mem_pool) { 11796fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi /* Initialize the new pool */ 11806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_init_free_queue(xx, size, count, p_mem_pool); 11816fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_add_to_pool_list(xx); 11826fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi (void)GKI_set_pool_permission(xx, permission); 11836fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->curr_total_no_of_pools++; 11846fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi 11856fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (xx); 11866fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else 11876fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (GKI_INVALID_POOL); 1188e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1189e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1190e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1191e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1192e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_delete_pool 1193e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1194552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Description Called by applications to delete a buffer pool. The 1195552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** function calls the operating specific function to free the 1196552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** actual memory. An exception is generated if an error is 1197552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** detected. 1198e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1199e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters: pool_id - (input) Id of the poll being deleted. 1200e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1201e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns void 1202e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1203e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 12046fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoivoid GKI_delete_pool(uint8_t pool_id) { 12056fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 12066fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi tGKI_COM_CB* p_cb = &gki_cb.com; 1207e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12086fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if ((pool_id >= GKI_NUM_TOTAL_BUF_POOLS) || (!p_cb->pool_start[pool_id])) 12096fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1210e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12116fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_disable(); 12126fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &p_cb->freeq[pool_id]; 1213e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12146fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (!Q->cur_cnt) { 12156fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->size = 0; 12166fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->total = 0; 12176fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->cur_cnt = 0; 12186fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->max_cnt = 0; 12196fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_first = NULL; 12206fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q->p_last = NULL; 1221e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12226fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_os_free(p_cb->pool_start[pool_id]); 1223e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12246fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_start[pool_id] = NULL; 12256fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_end[pool_id] = NULL; 12266fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->pool_size[pool_id] = 0; 1227e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12286fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi gki_remove_from_pool_list(pool_id); 12296fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi p_cb->curr_total_no_of_pools--; 12306fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi } else 12316fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_exception(GKI_ERROR_DELETE_POOL_BAD_QID, "Deleting bad pool"); 1232e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12336fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi GKI_enable(); 1234e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12356fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return; 1236e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1237e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1238e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#endif /* BTU_STACK_LITE_ENABLED == FALSE */ 1239e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1240e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1241e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1242e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_get_pool_bufsize 1243e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1244552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** Description Called by an application to get the size of buffers in a 1245552f2b745deddd35d9b75da9c9c09bd2f3f573a8Ruchi Kandoi** pool 1246e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1247e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters Pool ID. 1248e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1249e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns the size of buffers in the pool 1250e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1251e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 12526fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_get_pool_bufsize(uint8_t pool_id) { 12536fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id < GKI_NUM_TOTAL_BUF_POOLS) 12546fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (gki_cb.com.freeq[pool_id].size); 1255e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12566fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return (0); 1257e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1258e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1259e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 1260e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1261e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function GKI_poolutilization 1262e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1263e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description Called by an application to get the buffer utilization 1264e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** in the specified buffer pool. 1265e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1266e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Parameters pool_id - (input) pool ID to get the free count of. 1267e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1268e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns % of buffers used from 0 to 100 1269e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 1270e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 12716fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoiuint16_t GKI_poolutilization(uint8_t pool_id) { 12726fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi FREE_QUEUE_T* Q; 1273e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12746fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (pool_id >= GKI_NUM_TOTAL_BUF_POOLS) return (100); 1275e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12766fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi Q = &gki_cb.com.freeq[pool_id]; 1277e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12786fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi if (Q->total == 0) return (100); 1279e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 12806fca02d5010de7bd31d83b853c32138021da5f29Ruchi Kandoi return ((Q->cur_cnt * 100) / Q->total); 1281e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 1282