Junichi Katsu / Mbed 2 deprecated BLE_RCBController

iOSのBLEコントローラアプリ「RCBController」と接続し、コントローラの操作を取得するサンプルプログラムです。 mbed HRM1017で動作を確認しています。

Dependencies:   BLE_API_Native_IRC BLE_API mbed

nRF51822/nordic/app_common/hci_mem_pool.c@2:dd85fdc18224, 2014-08-20 (annotated)

Committer:
jksoft
Date:
Wed Aug 20 13:30:11 2014 +0000
Revision:
2:dd85fdc18224
Parent:
1:48f6e08a3ac2 
???

Who changed what in which revision?

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