Maiko Matsumoto / Mbed 2 deprecated BLE_WallbotBLE_Challenge2_2

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

Fork of BLE_WallbotBLE_Challenge2 by Maiko Matsumoto

nRF51822/nordic/app_common/hci_mem_pool.c@0:76dfa9657d9d, 2014-11-12 (annotated)

Committer:
jksoft
Date:
Wed Nov 12 02:40:34 2014 +0000
Revision:
0:76dfa9657d9d
????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jksoft 0:76dfa9657d9d 1 /* Copyright (c) 2013 Nordic Semiconductor. All Rights Reserved.
jksoft 0:76dfa9657d9d 2 *
jksoft 0:76dfa9657d9d 3 * The information contained herein is property of Nordic Semiconductor ASA.
jksoft 0:76dfa9657d9d 4 * Terms and conditions of usage are described in detail in NORDIC
jksoft 0:76dfa9657d9d 5 * SEMICONDUCTOR STANDARD SOFTWARE LICENSE AGREEMENT.
jksoft 0:76dfa9657d9d 6 *
jksoft 0:76dfa9657d9d 7 * Licensees are granted free, non-transferable use of the information. NO
jksoft 0:76dfa9657d9d 8 * WARRANTY of ANY KIND is provided. This heading must NOT be removed from
jksoft 0:76dfa9657d9d 9 * the file.
jksoft 0:76dfa9657d9d 10 *
jksoft 0:76dfa9657d9d 11 */
jksoft 0:76dfa9657d9d 12
jksoft 0:76dfa9657d9d 13 #include "hci_mem_pool.h"
jksoft 0:76dfa9657d9d 14 #include "hci_mem_pool_internal.h"
jksoft 0:76dfa9657d9d 15 #include <stdbool.h>
jksoft 0:76dfa9657d9d 16 #include <stdio.h>
jksoft 0:76dfa9657d9d 17
jksoft 0:76dfa9657d9d 18 /**@brief RX buffer element instance structure.
jksoft 0:76dfa9657d9d 19 */
jksoft 0:76dfa9657d9d 20 typedef struct
jksoft 0:76dfa9657d9d 21 {
jksoft 0:76dfa9657d9d 22 uint8_t rx_buffer[RX_BUF_SIZE]; /**< RX buffer memory array. */
jksoft 0:76dfa9657d9d 23 uint32_t length; /**< Length of the RX buffer memory array. */
jksoft 0:76dfa9657d9d 24 } rx_buffer_elem_t;
jksoft 0:76dfa9657d9d 25
jksoft 0:76dfa9657d9d 26 /**@brief RX buffer queue element instance structure.
jksoft 0:76dfa9657d9d 27 */
jksoft 0:76dfa9657d9d 28 typedef struct
jksoft 0:76dfa9657d9d 29 {
jksoft 0:76dfa9657d9d 30 rx_buffer_elem_t * p_buffer; /**< Pointer to RX buffer element. */
jksoft 0:76dfa9657d9d 31 uint32_t free_window_count; /**< Free space element count. */
jksoft 0:76dfa9657d9d 32 uint32_t free_available_count; /**< Free area element count. */
jksoft 0:76dfa9657d9d 33 uint32_t read_available_count; /**< Read area element count. */
jksoft 0:76dfa9657d9d 34 uint32_t write_index; /**< Write position index. */
jksoft 0:76dfa9657d9d 35 uint32_t read_index; /**< Read position index. */
jksoft 0:76dfa9657d9d 36 uint32_t free_index; /**< Free position index. */
jksoft 0:76dfa9657d9d 37 } rx_buffer_queue_t;
jksoft 0:76dfa9657d9d 38
jksoft 0:76dfa9657d9d 39 static bool m_is_tx_allocated; /**< Boolean value to determine if the TX buffer is allocated. */
jksoft 0:76dfa9657d9d 40 static rx_buffer_elem_t m_rx_buffer_elem_queue[RX_BUF_QUEUE_SIZE]; /**< RX buffer element instances. */
jksoft 0:76dfa9657d9d 41 static rx_buffer_queue_t m_rx_buffer_queue; /**< RX buffer queue element instance. */
jksoft 0:76dfa9657d9d 42
jksoft 0:76dfa9657d9d 43
jksoft 0:76dfa9657d9d 44 uint32_t hci_mem_pool_open(void)
jksoft 0:76dfa9657d9d 45 {
jksoft 0:76dfa9657d9d 46 m_is_tx_allocated = false;
jksoft 0:76dfa9657d9d 47 m_rx_buffer_queue.p_buffer = m_rx_buffer_elem_queue;
jksoft 0:76dfa9657d9d 48 m_rx_buffer_queue.free_window_count = RX_BUF_QUEUE_SIZE;
jksoft 0:76dfa9657d9d 49 m_rx_buffer_queue.free_available_count = 0;
jksoft 0:76dfa9657d9d 50 m_rx_buffer_queue.read_available_count = 0;
jksoft 0:76dfa9657d9d 51 m_rx_buffer_queue.write_index = 0;
jksoft 0:76dfa9657d9d 52 m_rx_buffer_queue.read_index = 0;
jksoft 0:76dfa9657d9d 53 m_rx_buffer_queue.free_index = 0;
jksoft 0:76dfa9657d9d 54
jksoft 0:76dfa9657d9d 55 return NRF_SUCCESS;
jksoft 0:76dfa9657d9d 56 }
jksoft 0:76dfa9657d9d 57
jksoft 0:76dfa9657d9d 58
jksoft 0:76dfa9657d9d 59 uint32_t hci_mem_pool_close(void)
jksoft 0:76dfa9657d9d 60 {
jksoft 0:76dfa9657d9d 61 return NRF_SUCCESS;
jksoft 0:76dfa9657d9d 62 }
jksoft 0:76dfa9657d9d 63
jksoft 0:76dfa9657d9d 64
jksoft 0:76dfa9657d9d 65 uint32_t hci_mem_pool_tx_alloc(void ** pp_buffer)
jksoft 0:76dfa9657d9d 66 {
jksoft 0:76dfa9657d9d 67 static uint8_t tx_buffer[TX_BUF_SIZE];
jksoft 0:76dfa9657d9d 68
jksoft 0:76dfa9657d9d 69 uint32_t err_code;
jksoft 0:76dfa9657d9d 70
jksoft 0:76dfa9657d9d 71 if (pp_buffer == NULL)
jksoft 0:76dfa9657d9d 72 {
jksoft 0:76dfa9657d9d 73 return NRF_ERROR_NULL;
jksoft 0:76dfa9657d9d 74 }
jksoft 0:76dfa9657d9d 75
jksoft 0:76dfa9657d9d 76 if (!m_is_tx_allocated)
jksoft 0:76dfa9657d9d 77 {
jksoft 0:76dfa9657d9d 78 m_is_tx_allocated = true;
jksoft 0:76dfa9657d9d 79 *pp_buffer = tx_buffer;
jksoft 0:76dfa9657d9d 80 err_code = NRF_SUCCESS;
jksoft 0:76dfa9657d9d 81 }
jksoft 0:76dfa9657d9d 82 else
jksoft 0:76dfa9657d9d 83 {
jksoft 0:76dfa9657d9d 84 err_code = NRF_ERROR_NO_MEM;
jksoft 0:76dfa9657d9d 85 }
jksoft 0:76dfa9657d9d 86
jksoft 0:76dfa9657d9d 87 return err_code;
jksoft 0:76dfa9657d9d 88 }
jksoft 0:76dfa9657d9d 89
jksoft 0:76dfa9657d9d 90
jksoft 0:76dfa9657d9d 91 uint32_t hci_mem_pool_tx_free(void)
jksoft 0:76dfa9657d9d 92 {
jksoft 0:76dfa9657d9d 93 m_is_tx_allocated = false;
jksoft 0:76dfa9657d9d 94
jksoft 0:76dfa9657d9d 95 return NRF_SUCCESS;
jksoft 0:76dfa9657d9d 96 }
jksoft 0:76dfa9657d9d 97
jksoft 0:76dfa9657d9d 98
jksoft 0:76dfa9657d9d 99 uint32_t hci_mem_pool_rx_produce(uint32_t length, void ** pp_buffer)
jksoft 0:76dfa9657d9d 100 {
jksoft 0:76dfa9657d9d 101 uint32_t err_code;
jksoft 0:76dfa9657d9d 102
jksoft 0:76dfa9657d9d 103 if (pp_buffer == NULL)
jksoft 0:76dfa9657d9d 104 {
jksoft 0:76dfa9657d9d 105 return NRF_ERROR_NULL;
jksoft 0:76dfa9657d9d 106 }
jksoft 0:76dfa9657d9d 107 *pp_buffer = NULL;
jksoft 0:76dfa9657d9d 108
jksoft 0:76dfa9657d9d 109 if (m_rx_buffer_queue.free_window_count != 0)
jksoft 0:76dfa9657d9d 110 {
jksoft 0:76dfa9657d9d 111 if (length <= RX_BUF_SIZE)
jksoft 0:76dfa9657d9d 112 {
jksoft 0:76dfa9657d9d 113 --(m_rx_buffer_queue.free_window_count);
jksoft 0:76dfa9657d9d 114 ++(m_rx_buffer_queue.read_available_count);
jksoft 0:76dfa9657d9d 115
jksoft 0:76dfa9657d9d 116 *pp_buffer =
jksoft 0:76dfa9657d9d 117 m_rx_buffer_queue.p_buffer[m_rx_buffer_queue.write_index].rx_buffer;
jksoft 0:76dfa9657d9d 118
jksoft 0:76dfa9657d9d 119 m_rx_buffer_queue.free_index |= (1u << m_rx_buffer_queue.write_index);
jksoft 0:76dfa9657d9d 120
jksoft 0:76dfa9657d9d 121 // @note: Adjust the write_index making use of the fact that the buffer size is of
jksoft 0:76dfa9657d9d 122 // power of two and two's complement arithmetic. For details refer example to book
jksoft 0:76dfa9657d9d 123 // "Making embedded systems: Elicia White".
jksoft 0:76dfa9657d9d 124 m_rx_buffer_queue.write_index =
jksoft 0:76dfa9657d9d 125 (m_rx_buffer_queue.write_index + 1u) & (RX_BUF_QUEUE_SIZE - 1u);
jksoft 0:76dfa9657d9d 126
jksoft 0:76dfa9657d9d 127 err_code = NRF_SUCCESS;
jksoft 0:76dfa9657d9d 128 }
jksoft 0:76dfa9657d9d 129 else
jksoft 0:76dfa9657d9d 130 {
jksoft 0:76dfa9657d9d 131 err_code = NRF_ERROR_DATA_SIZE;
jksoft 0:76dfa9657d9d 132 }
jksoft 0:76dfa9657d9d 133 }
jksoft 0:76dfa9657d9d 134 else
jksoft 0:76dfa9657d9d 135 {
jksoft 0:76dfa9657d9d 136 err_code = NRF_ERROR_NO_MEM;
jksoft 0:76dfa9657d9d 137 }
jksoft 0:76dfa9657d9d 138
jksoft 0:76dfa9657d9d 139 return err_code;
jksoft 0:76dfa9657d9d 140 }
jksoft 0:76dfa9657d9d 141
jksoft 0:76dfa9657d9d 142
jksoft 0:76dfa9657d9d 143 uint32_t hci_mem_pool_rx_consume(uint8_t * p_buffer)
jksoft 0:76dfa9657d9d 144 {
jksoft 0:76dfa9657d9d 145 uint32_t err_code;
jksoft 0:76dfa9657d9d 146 uint32_t consume_index;
jksoft 0:76dfa9657d9d 147 uint32_t start_index;
jksoft 0:76dfa9657d9d 148
jksoft 0:76dfa9657d9d 149 if (m_rx_buffer_queue.free_available_count != 0)
jksoft 0:76dfa9657d9d 150 {
jksoft 0:76dfa9657d9d 151 // Find the buffer that has been freed -
jksoft 0:76dfa9657d9d 152 // Start at read_index minus free_available_count and then increment until read index.
jksoft 0:76dfa9657d9d 153 err_code = NRF_ERROR_INVALID_ADDR;
jksoft 0:76dfa9657d9d 154 consume_index = (m_rx_buffer_queue.read_index - m_rx_buffer_queue.free_available_count) &
jksoft 0:76dfa9657d9d 155 (RX_BUF_QUEUE_SIZE - 1u);
jksoft 0:76dfa9657d9d 156 start_index = consume_index;
jksoft 0:76dfa9657d9d 157
jksoft 0:76dfa9657d9d 158 do
jksoft 0:76dfa9657d9d 159 {
jksoft 0:76dfa9657d9d 160 if (m_rx_buffer_queue.p_buffer[consume_index].rx_buffer == p_buffer)
jksoft 0:76dfa9657d9d 161 {
jksoft 0:76dfa9657d9d 162 m_rx_buffer_queue.free_index ^= (1u << consume_index);
jksoft 0:76dfa9657d9d 163 err_code = NRF_SUCCESS;
jksoft 0:76dfa9657d9d 164 break;
jksoft 0:76dfa9657d9d 165 }
jksoft 0:76dfa9657d9d 166 else
jksoft 0:76dfa9657d9d 167 {
jksoft 0:76dfa9657d9d 168 consume_index = (consume_index + 1u) & (RX_BUF_QUEUE_SIZE - 1u);
jksoft 0:76dfa9657d9d 169 }
jksoft 0:76dfa9657d9d 170 }
jksoft 0:76dfa9657d9d 171 while (consume_index != m_rx_buffer_queue.read_index);
jksoft 0:76dfa9657d9d 172
jksoft 0:76dfa9657d9d 173 while (!(m_rx_buffer_queue.free_index & (1 << start_index)) &&
jksoft 0:76dfa9657d9d 174 (m_rx_buffer_queue.free_available_count != 0))
jksoft 0:76dfa9657d9d 175 {
jksoft 0:76dfa9657d9d 176 --(m_rx_buffer_queue.free_available_count);
jksoft 0:76dfa9657d9d 177 ++(m_rx_buffer_queue.free_window_count);
jksoft 0:76dfa9657d9d 178 start_index = (consume_index + 1u) & (RX_BUF_QUEUE_SIZE - 1u);
jksoft 0:76dfa9657d9d 179 }
jksoft 0:76dfa9657d9d 180 }
jksoft 0:76dfa9657d9d 181 else
jksoft 0:76dfa9657d9d 182 {
jksoft 0:76dfa9657d9d 183 err_code = NRF_ERROR_NO_MEM;
jksoft 0:76dfa9657d9d 184 }
jksoft 0:76dfa9657d9d 185
jksoft 0:76dfa9657d9d 186 return err_code;
jksoft 0:76dfa9657d9d 187 }
jksoft 0:76dfa9657d9d 188
jksoft 0:76dfa9657d9d 189
jksoft 0:76dfa9657d9d 190 uint32_t hci_mem_pool_rx_data_size_set(uint32_t length)
jksoft 0:76dfa9657d9d 191 {
jksoft 0:76dfa9657d9d 192 // @note: Adjust the write_index making use of the fact that the buffer size is of power
jksoft 0:76dfa9657d9d 193 // of two and two's complement arithmetic. For details refer example to book
jksoft 0:76dfa9657d9d 194 // "Making embedded systems: Elicia White".
jksoft 0:76dfa9657d9d 195 const uint32_t index = (m_rx_buffer_queue.write_index - 1u) & (RX_BUF_QUEUE_SIZE - 1u);
jksoft 0:76dfa9657d9d 196 m_rx_buffer_queue.p_buffer[index].length = length;
jksoft 0:76dfa9657d9d 197
jksoft 0:76dfa9657d9d 198 return NRF_SUCCESS;
jksoft 0:76dfa9657d9d 199 }
jksoft 0:76dfa9657d9d 200
jksoft 0:76dfa9657d9d 201
jksoft 0:76dfa9657d9d 202 uint32_t hci_mem_pool_rx_extract(uint8_t ** pp_buffer, uint32_t * p_length)
jksoft 0:76dfa9657d9d 203 {
jksoft 0:76dfa9657d9d 204 uint32_t err_code;
jksoft 0:76dfa9657d9d 205
jksoft 0:76dfa9657d9d 206 if ((pp_buffer == NULL) || (p_length == NULL))
jksoft 0:76dfa9657d9d 207 {
jksoft 0:76dfa9657d9d 208 return NRF_ERROR_NULL;
jksoft 0:76dfa9657d9d 209 }
jksoft 0:76dfa9657d9d 210
jksoft 0:76dfa9657d9d 211 if (m_rx_buffer_queue.read_available_count != 0)
jksoft 0:76dfa9657d9d 212 {
jksoft 0:76dfa9657d9d 213 --(m_rx_buffer_queue.read_available_count);
jksoft 0:76dfa9657d9d 214 ++(m_rx_buffer_queue.free_available_count);
jksoft 0:76dfa9657d9d 215
jksoft 0:76dfa9657d9d 216 *pp_buffer =
jksoft 0:76dfa9657d9d 217 m_rx_buffer_queue.p_buffer[m_rx_buffer_queue.read_index].rx_buffer;
jksoft 0:76dfa9657d9d 218 *p_length =
jksoft 0:76dfa9657d9d 219 m_rx_buffer_queue.p_buffer[m_rx_buffer_queue.read_index].length;
jksoft 0:76dfa9657d9d 220
jksoft 0:76dfa9657d9d 221 // @note: Adjust the write_index making use of the fact that the buffer size is of power
jksoft 0:76dfa9657d9d 222 // of two and two's complement arithmetic. For details refer example to book
jksoft 0:76dfa9657d9d 223 // "Making embedded systems: Elicia White".
jksoft 0:76dfa9657d9d 224 m_rx_buffer_queue.read_index =
jksoft 0:76dfa9657d9d 225 (m_rx_buffer_queue.read_index + 1u) & (RX_BUF_QUEUE_SIZE - 1u);
jksoft 0:76dfa9657d9d 226
jksoft 0:76dfa9657d9d 227 err_code = NRF_SUCCESS;
jksoft 0:76dfa9657d9d 228 }
jksoft 0:76dfa9657d9d 229 else
jksoft 0:76dfa9657d9d 230 {
jksoft 0:76dfa9657d9d 231 err_code = NRF_ERROR_NO_MEM;
jksoft 0:76dfa9657d9d 232 }
jksoft 0:76dfa9657d9d 233
jksoft 0:76dfa9657d9d 234 return err_code;
jksoft 0:76dfa9657d9d 235 }