NUCLEO-F401RE + BlueNRG shield client test (TI Sensortag reading)
bluenrg/SimpleBlueNRG_HCI/hci/hci.c@0:aa1e012ec210, 2014-08-16 (annotated)
- Committer:
- ostapsky
- Date:
- Sat Aug 16 11:00:04 2014 +0000
- Revision:
- 0:aa1e012ec210
CLIENT mode first revision
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
ostapsky | 0:aa1e012ec210 | 1 | /******************** (C) COPYRIGHT 2013 STMicroelectronics ******************** |
ostapsky | 0:aa1e012ec210 | 2 | * File Name : bluenrg_hci.h |
ostapsky | 0:aa1e012ec210 | 3 | * Author : AMS - HEA&RF BU |
ostapsky | 0:aa1e012ec210 | 4 | * Version : V1.0.0 |
ostapsky | 0:aa1e012ec210 | 5 | * Date : 4-Oct-2013 |
ostapsky | 0:aa1e012ec210 | 6 | * Description : Function for managing HCI interface. Implementation of |
ostapsky | 0:aa1e012ec210 | 7 | * standard HCI commands. |
ostapsky | 0:aa1e012ec210 | 8 | ******************************************************************************** |
ostapsky | 0:aa1e012ec210 | 9 | * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS |
ostapsky | 0:aa1e012ec210 | 10 | * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME. |
ostapsky | 0:aa1e012ec210 | 11 | * AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT, |
ostapsky | 0:aa1e012ec210 | 12 | * INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE |
ostapsky | 0:aa1e012ec210 | 13 | * CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING |
ostapsky | 0:aa1e012ec210 | 14 | * INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS. |
ostapsky | 0:aa1e012ec210 | 15 | *******************************************************************************/ |
ostapsky | 0:aa1e012ec210 | 16 | |
ostapsky | 0:aa1e012ec210 | 17 | /** |
ostapsky | 0:aa1e012ec210 | 18 | ****************************************************************************** |
ostapsky | 0:aa1e012ec210 | 19 | * @file hci.c |
ostapsky | 0:aa1e012ec210 | 20 | * @author AMS/HESA Application Team |
ostapsky | 0:aa1e012ec210 | 21 | * @brief Function for managing HCI interface. |
ostapsky | 0:aa1e012ec210 | 22 | ****************************************************************************** |
ostapsky | 0:aa1e012ec210 | 23 | * @copy |
ostapsky | 0:aa1e012ec210 | 24 | * |
ostapsky | 0:aa1e012ec210 | 25 | * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS |
ostapsky | 0:aa1e012ec210 | 26 | * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE |
ostapsky | 0:aa1e012ec210 | 27 | * TIME. AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY |
ostapsky | 0:aa1e012ec210 | 28 | * DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING |
ostapsky | 0:aa1e012ec210 | 29 | * FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE |
ostapsky | 0:aa1e012ec210 | 30 | * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS. |
ostapsky | 0:aa1e012ec210 | 31 | * |
ostapsky | 0:aa1e012ec210 | 32 | * <h2><center>© COPYRIGHT 2013 STMicroelectronics</center></h2> |
ostapsky | 0:aa1e012ec210 | 33 | */ |
ostapsky | 0:aa1e012ec210 | 34 | |
ostapsky | 0:aa1e012ec210 | 35 | #include "hal_types.h" |
ostapsky | 0:aa1e012ec210 | 36 | #include "osal.h" |
ostapsky | 0:aa1e012ec210 | 37 | #include "ble_status.h" |
ostapsky | 0:aa1e012ec210 | 38 | #include "hal.h" |
ostapsky | 0:aa1e012ec210 | 39 | #include <hci_internal.h> |
ostapsky | 0:aa1e012ec210 | 40 | #include "gp_timer.h" |
ostapsky | 0:aa1e012ec210 | 41 | |
ostapsky | 0:aa1e012ec210 | 42 | #if BLE_CONFIG_DBG_ENABLE |
ostapsky | 0:aa1e012ec210 | 43 | #define PRINTF(...) printf(__VA_ARGS__) |
ostapsky | 0:aa1e012ec210 | 44 | #else |
ostapsky | 0:aa1e012ec210 | 45 | #define PRINTF(...) |
ostapsky | 0:aa1e012ec210 | 46 | #endif |
ostapsky | 0:aa1e012ec210 | 47 | |
ostapsky | 0:aa1e012ec210 | 48 | #define HCI_LOG_ON 0 |
ostapsky | 0:aa1e012ec210 | 49 | |
ostapsky | 0:aa1e012ec210 | 50 | #define HCI_READ_PACKET_NUM_MAX (5) |
ostapsky | 0:aa1e012ec210 | 51 | |
ostapsky | 0:aa1e012ec210 | 52 | #define MIN(a,b) ((a) < (b) )? (a) : (b) |
ostapsky | 0:aa1e012ec210 | 53 | #define MAX(a,b) ((a) > (b) )? (a) : (b) |
ostapsky | 0:aa1e012ec210 | 54 | |
ostapsky | 0:aa1e012ec210 | 55 | static void enqueue_packet(tHciDataPacket * hciReadPacket); |
ostapsky | 0:aa1e012ec210 | 56 | |
ostapsky | 0:aa1e012ec210 | 57 | tListNode hciReadPktPool; |
ostapsky | 0:aa1e012ec210 | 58 | tListNode hciReadPktRxQueue; |
ostapsky | 0:aa1e012ec210 | 59 | /* pool of hci read packets */ |
ostapsky | 0:aa1e012ec210 | 60 | static tHciDataPacket hciReadPacketBuffer[HCI_READ_PACKET_NUM_MAX]; |
ostapsky | 0:aa1e012ec210 | 61 | |
ostapsky | 0:aa1e012ec210 | 62 | static uint8_t *hci_buffer = NULL; |
ostapsky | 0:aa1e012ec210 | 63 | static volatile uint16_t hci_pckt_len; |
ostapsky | 0:aa1e012ec210 | 64 | |
ostapsky | 0:aa1e012ec210 | 65 | void HCI_Init(void) |
ostapsky | 0:aa1e012ec210 | 66 | { |
ostapsky | 0:aa1e012ec210 | 67 | uint8_t index; |
ostapsky | 0:aa1e012ec210 | 68 | |
ostapsky | 0:aa1e012ec210 | 69 | /* Initialize list heads of ready and free hci data packet queues */ |
ostapsky | 0:aa1e012ec210 | 70 | list_init_head (&hciReadPktPool); |
ostapsky | 0:aa1e012ec210 | 71 | list_init_head (&hciReadPktRxQueue); |
ostapsky | 0:aa1e012ec210 | 72 | |
ostapsky | 0:aa1e012ec210 | 73 | /* Initialize the queue of free hci data packets */ |
ostapsky | 0:aa1e012ec210 | 74 | for (index = 0; index < HCI_READ_PACKET_NUM_MAX; index++) |
ostapsky | 0:aa1e012ec210 | 75 | { |
ostapsky | 0:aa1e012ec210 | 76 | list_insert_tail(&hciReadPktPool, (tListNode *)&hciReadPacketBuffer[index]); |
ostapsky | 0:aa1e012ec210 | 77 | } |
ostapsky | 0:aa1e012ec210 | 78 | } |
ostapsky | 0:aa1e012ec210 | 79 | |
ostapsky | 0:aa1e012ec210 | 80 | static volatile hci_packet_complete_callback packet_complete_callback = NULL; |
ostapsky | 0:aa1e012ec210 | 81 | |
ostapsky | 0:aa1e012ec210 | 82 | static void hci_set_packet_complete_callback(hci_packet_complete_callback cb) |
ostapsky | 0:aa1e012ec210 | 83 | { |
ostapsky | 0:aa1e012ec210 | 84 | packet_complete_callback = cb; |
ostapsky | 0:aa1e012ec210 | 85 | } |
ostapsky | 0:aa1e012ec210 | 86 | |
ostapsky | 0:aa1e012ec210 | 87 | void HCI_Input(tHciDataPacket * hciReadPacket) |
ostapsky | 0:aa1e012ec210 | 88 | { |
ostapsky | 0:aa1e012ec210 | 89 | uint8_t byte; |
ostapsky | 0:aa1e012ec210 | 90 | hci_acl_hdr *acl_hdr; |
ostapsky | 0:aa1e012ec210 | 91 | |
ostapsky | 0:aa1e012ec210 | 92 | static hci_state state = WAITING_TYPE; |
ostapsky | 0:aa1e012ec210 | 93 | |
ostapsky | 0:aa1e012ec210 | 94 | tHalUint16 collected_payload_len = 0; |
ostapsky | 0:aa1e012ec210 | 95 | tHalUint16 payload_len; |
ostapsky | 0:aa1e012ec210 | 96 | |
ostapsky | 0:aa1e012ec210 | 97 | hci_buffer = hciReadPacket->dataBuff; |
ostapsky | 0:aa1e012ec210 | 98 | |
ostapsky | 0:aa1e012ec210 | 99 | while(hci_pckt_len < HCI_PACKET_SIZE){ |
ostapsky | 0:aa1e012ec210 | 100 | |
ostapsky | 0:aa1e012ec210 | 101 | if(state == WAITING_TYPE) |
ostapsky | 0:aa1e012ec210 | 102 | hci_pckt_len = 0; |
ostapsky | 0:aa1e012ec210 | 103 | |
ostapsky | 0:aa1e012ec210 | 104 | byte = hci_buffer[hci_pckt_len++]; |
ostapsky | 0:aa1e012ec210 | 105 | |
ostapsky | 0:aa1e012ec210 | 106 | if(state == WAITING_TYPE){ |
ostapsky | 0:aa1e012ec210 | 107 | /* Only ACL Data and Events packets are accepted. */ |
ostapsky | 0:aa1e012ec210 | 108 | if(byte == HCI_EVENT_PKT){ |
ostapsky | 0:aa1e012ec210 | 109 | state = WAITING_EVENT_CODE; |
ostapsky | 0:aa1e012ec210 | 110 | } |
ostapsky | 0:aa1e012ec210 | 111 | // else if(byte == HCI_ACLDATA_PKT){ |
ostapsky | 0:aa1e012ec210 | 112 | // state = WAITING_HANDLE; |
ostapsky | 0:aa1e012ec210 | 113 | // } |
ostapsky | 0:aa1e012ec210 | 114 | else{ |
ostapsky | 0:aa1e012ec210 | 115 | /* Incorrect type. Reset state machine. */ |
ostapsky | 0:aa1e012ec210 | 116 | state = WAITING_TYPE; |
ostapsky | 0:aa1e012ec210 | 117 | } |
ostapsky | 0:aa1e012ec210 | 118 | } |
ostapsky | 0:aa1e012ec210 | 119 | else if(state == WAITING_EVENT_CODE) |
ostapsky | 0:aa1e012ec210 | 120 | state = WAITING_PARAM_LEN; |
ostapsky | 0:aa1e012ec210 | 121 | else if(state == WAITING_HANDLE) |
ostapsky | 0:aa1e012ec210 | 122 | state = WAITING_HANDLE_FLAG; |
ostapsky | 0:aa1e012ec210 | 123 | else if(state == WAITING_HANDLE_FLAG) |
ostapsky | 0:aa1e012ec210 | 124 | state = WAITING_DATA_LEN1; |
ostapsky | 0:aa1e012ec210 | 125 | else if(state == WAITING_DATA_LEN1) |
ostapsky | 0:aa1e012ec210 | 126 | state = WAITING_DATA_LEN2; |
ostapsky | 0:aa1e012ec210 | 127 | |
ostapsky | 0:aa1e012ec210 | 128 | else if(state == WAITING_DATA_LEN2){ |
ostapsky | 0:aa1e012ec210 | 129 | acl_hdr = (void *)&hci_buffer[HCI_HDR_SIZE]; |
ostapsky | 0:aa1e012ec210 | 130 | payload_len = acl_hdr->dlen; |
ostapsky | 0:aa1e012ec210 | 131 | collected_payload_len = 0; |
ostapsky | 0:aa1e012ec210 | 132 | state = WAITING_PAYLOAD; |
ostapsky | 0:aa1e012ec210 | 133 | } |
ostapsky | 0:aa1e012ec210 | 134 | else if(state == WAITING_PARAM_LEN){ |
ostapsky | 0:aa1e012ec210 | 135 | payload_len = byte; |
ostapsky | 0:aa1e012ec210 | 136 | collected_payload_len = 0; |
ostapsky | 0:aa1e012ec210 | 137 | state = WAITING_PAYLOAD; |
ostapsky | 0:aa1e012ec210 | 138 | } |
ostapsky | 0:aa1e012ec210 | 139 | else if(state == WAITING_PAYLOAD){ |
ostapsky | 0:aa1e012ec210 | 140 | collected_payload_len += 1; |
ostapsky | 0:aa1e012ec210 | 141 | if(collected_payload_len >= payload_len){ |
ostapsky | 0:aa1e012ec210 | 142 | /* Reset state machine. */ |
ostapsky | 0:aa1e012ec210 | 143 | state = WAITING_TYPE; |
ostapsky | 0:aa1e012ec210 | 144 | enqueue_packet(hciReadPacket); |
ostapsky | 0:aa1e012ec210 | 145 | |
ostapsky | 0:aa1e012ec210 | 146 | if(packet_complete_callback){ |
ostapsky | 0:aa1e012ec210 | 147 | uint16_t len = hci_pckt_len; |
ostapsky | 0:aa1e012ec210 | 148 | packet_complete_callback(hci_buffer, len); |
ostapsky | 0:aa1e012ec210 | 149 | } |
ostapsky | 0:aa1e012ec210 | 150 | break; |
ostapsky | 0:aa1e012ec210 | 151 | } |
ostapsky | 0:aa1e012ec210 | 152 | } |
ostapsky | 0:aa1e012ec210 | 153 | |
ostapsky | 0:aa1e012ec210 | 154 | if(hci_pckt_len >= HCI_MAX_PACKET_SIZE){ |
ostapsky | 0:aa1e012ec210 | 155 | /* Packet too long for buffer. Reset state machine. */ |
ostapsky | 0:aa1e012ec210 | 156 | state = WAITING_TYPE; |
ostapsky | 0:aa1e012ec210 | 157 | } |
ostapsky | 0:aa1e012ec210 | 158 | |
ostapsky | 0:aa1e012ec210 | 159 | } |
ostapsky | 0:aa1e012ec210 | 160 | } |
ostapsky | 0:aa1e012ec210 | 161 | |
ostapsky | 0:aa1e012ec210 | 162 | void enqueue_packet(tHciDataPacket * hciReadPacket) |
ostapsky | 0:aa1e012ec210 | 163 | { |
ostapsky | 0:aa1e012ec210 | 164 | hci_uart_pckt *hci_pckt = (void*)hciReadPacket->dataBuff; |
ostapsky | 0:aa1e012ec210 | 165 | hci_event_pckt *event_pckt = (void*)hci_pckt->data; |
ostapsky | 0:aa1e012ec210 | 166 | |
ostapsky | 0:aa1e012ec210 | 167 | // Do not enqueue Command Complete or Command Status events |
ostapsky | 0:aa1e012ec210 | 168 | |
ostapsky | 0:aa1e012ec210 | 169 | if((hci_pckt->type != HCI_EVENT_PKT) || |
ostapsky | 0:aa1e012ec210 | 170 | event_pckt->evt == EVT_CMD_COMPLETE || |
ostapsky | 0:aa1e012ec210 | 171 | event_pckt->evt == EVT_CMD_STATUS){ |
ostapsky | 0:aa1e012ec210 | 172 | // Insert the packet back into the pool. |
ostapsky | 0:aa1e012ec210 | 173 | list_insert_tail(&hciReadPktPool, (tListNode *)hciReadPacket); |
ostapsky | 0:aa1e012ec210 | 174 | } |
ostapsky | 0:aa1e012ec210 | 175 | else { |
ostapsky | 0:aa1e012ec210 | 176 | // Insert the packet into the queue of events to be processed. |
ostapsky | 0:aa1e012ec210 | 177 | list_insert_tail(&hciReadPktRxQueue, (tListNode *)hciReadPacket); |
ostapsky | 0:aa1e012ec210 | 178 | } |
ostapsky | 0:aa1e012ec210 | 179 | } |
ostapsky | 0:aa1e012ec210 | 180 | |
ostapsky | 0:aa1e012ec210 | 181 | void HCI_Process(void) |
ostapsky | 0:aa1e012ec210 | 182 | { |
ostapsky | 0:aa1e012ec210 | 183 | tHciDataPacket * hciReadPacket = NULL; |
ostapsky | 0:aa1e012ec210 | 184 | |
ostapsky | 0:aa1e012ec210 | 185 | Disable_SPI_IRQ(); |
ostapsky | 0:aa1e012ec210 | 186 | tHalBool list_empty = list_is_empty(&hciReadPktRxQueue); |
ostapsky | 0:aa1e012ec210 | 187 | /* process any pending events read */ |
ostapsky | 0:aa1e012ec210 | 188 | while(list_empty == FALSE) |
ostapsky | 0:aa1e012ec210 | 189 | { |
ostapsky | 0:aa1e012ec210 | 190 | list_remove_head (&hciReadPktRxQueue, (tListNode **)&hciReadPacket); |
ostapsky | 0:aa1e012ec210 | 191 | Enable_SPI_IRQ(); |
ostapsky | 0:aa1e012ec210 | 192 | HCI_Event_CB(hciReadPacket->dataBuff); |
ostapsky | 0:aa1e012ec210 | 193 | Disable_SPI_IRQ(); |
ostapsky | 0:aa1e012ec210 | 194 | list_insert_tail(&hciReadPktPool, (tListNode *)hciReadPacket); |
ostapsky | 0:aa1e012ec210 | 195 | list_empty = list_is_empty(&hciReadPktRxQueue); |
ostapsky | 0:aa1e012ec210 | 196 | } |
ostapsky | 0:aa1e012ec210 | 197 | Enable_SPI_IRQ(); |
ostapsky | 0:aa1e012ec210 | 198 | } |
ostapsky | 0:aa1e012ec210 | 199 | |
ostapsky | 0:aa1e012ec210 | 200 | void hci_write(const void* data1, const void* data2, uint32_t n_bytes1, uint32_t n_bytes2){ |
ostapsky | 0:aa1e012ec210 | 201 | #if HCI_LOG_ON |
ostapsky | 0:aa1e012ec210 | 202 | PRINTF("HCI <- "); |
ostapsky | 0:aa1e012ec210 | 203 | for(int i=0; i < n_bytes1; i++) |
ostapsky | 0:aa1e012ec210 | 204 | PRINTF("%02X ", *((uint8_t*)data1 + i)); |
ostapsky | 0:aa1e012ec210 | 205 | for(int i=0; i < n_bytes2; i++) |
ostapsky | 0:aa1e012ec210 | 206 | PRINTF("%02X ", *((uint8_t*)data2 + i)); |
ostapsky | 0:aa1e012ec210 | 207 | PRINTF("\n"); |
ostapsky | 0:aa1e012ec210 | 208 | #endif |
ostapsky | 0:aa1e012ec210 | 209 | |
ostapsky | 0:aa1e012ec210 | 210 | Hal_Write_Serial(data1, data2, n_bytes1, n_bytes2); |
ostapsky | 0:aa1e012ec210 | 211 | } |
ostapsky | 0:aa1e012ec210 | 212 | |
ostapsky | 0:aa1e012ec210 | 213 | int hci_send_cmd(uint16_t ogf, uint16_t ocf, uint8_t plen, void *param) |
ostapsky | 0:aa1e012ec210 | 214 | { |
ostapsky | 0:aa1e012ec210 | 215 | hci_command_hdr hc; |
ostapsky | 0:aa1e012ec210 | 216 | |
ostapsky | 0:aa1e012ec210 | 217 | hc.opcode = htobs(cmd_opcode_pack(ogf, ocf)); |
ostapsky | 0:aa1e012ec210 | 218 | hc.plen= plen; |
ostapsky | 0:aa1e012ec210 | 219 | |
ostapsky | 0:aa1e012ec210 | 220 | uint8_t header[HCI_HDR_SIZE + HCI_COMMAND_HDR_SIZE]; |
ostapsky | 0:aa1e012ec210 | 221 | header[0] = HCI_COMMAND_PKT; |
ostapsky | 0:aa1e012ec210 | 222 | Osal_MemCpy(header+1, &hc, sizeof(hc)); |
ostapsky | 0:aa1e012ec210 | 223 | |
ostapsky | 0:aa1e012ec210 | 224 | hci_write(header, param, sizeof(header), plen); |
ostapsky | 0:aa1e012ec210 | 225 | |
ostapsky | 0:aa1e012ec210 | 226 | return 0; |
ostapsky | 0:aa1e012ec210 | 227 | } |
ostapsky | 0:aa1e012ec210 | 228 | |
ostapsky | 0:aa1e012ec210 | 229 | static tHalBool new_packet; |
ostapsky | 0:aa1e012ec210 | 230 | |
ostapsky | 0:aa1e012ec210 | 231 | void new_hci_event(void *pckt, tHalUint16 len) |
ostapsky | 0:aa1e012ec210 | 232 | { |
ostapsky | 0:aa1e012ec210 | 233 | Disable_SPI_IRQ(); /* Must be re-enabled after packet processing. */ |
ostapsky | 0:aa1e012ec210 | 234 | |
ostapsky | 0:aa1e012ec210 | 235 | new_packet = TRUE; |
ostapsky | 0:aa1e012ec210 | 236 | } |
ostapsky | 0:aa1e012ec210 | 237 | |
ostapsky | 0:aa1e012ec210 | 238 | /* 'to' is timeout in system clock ticks. */ |
ostapsky | 0:aa1e012ec210 | 239 | int hci_send_req(struct hci_request *r) |
ostapsky | 0:aa1e012ec210 | 240 | { |
ostapsky | 0:aa1e012ec210 | 241 | tHalUint8 *ptr; |
ostapsky | 0:aa1e012ec210 | 242 | tHalUint16 opcode = htobs(cmd_opcode_pack(r->ogf, r->ocf)); |
ostapsky | 0:aa1e012ec210 | 243 | hci_event_pckt *event_pckt; |
ostapsky | 0:aa1e012ec210 | 244 | hci_uart_pckt *hci_hdr; |
ostapsky | 0:aa1e012ec210 | 245 | int try; |
ostapsky | 0:aa1e012ec210 | 246 | int to = DEFAULT_TIMEOUT; |
ostapsky | 0:aa1e012ec210 | 247 | |
ostapsky | 0:aa1e012ec210 | 248 | new_packet = FALSE; |
ostapsky | 0:aa1e012ec210 | 249 | hci_set_packet_complete_callback(new_hci_event); |
ostapsky | 0:aa1e012ec210 | 250 | if (hci_send_cmd(r->ogf, r->ocf, r->clen, r->cparam) < 0) |
ostapsky | 0:aa1e012ec210 | 251 | goto failed; |
ostapsky | 0:aa1e012ec210 | 252 | |
ostapsky | 0:aa1e012ec210 | 253 | try = 10; |
ostapsky | 0:aa1e012ec210 | 254 | while (try--) { |
ostapsky | 0:aa1e012ec210 | 255 | evt_cmd_complete *cc; |
ostapsky | 0:aa1e012ec210 | 256 | evt_cmd_status *cs; |
ostapsky | 0:aa1e012ec210 | 257 | evt_le_meta_event *me; |
ostapsky | 0:aa1e012ec210 | 258 | int len; |
ostapsky | 0:aa1e012ec210 | 259 | |
ostapsky | 0:aa1e012ec210 | 260 | /* Minimum timeout is 1. */ |
ostapsky | 0:aa1e012ec210 | 261 | if(to == 0) |
ostapsky | 0:aa1e012ec210 | 262 | to = 1; |
ostapsky | 0:aa1e012ec210 | 263 | |
ostapsky | 0:aa1e012ec210 | 264 | if (to > 0) { |
ostapsky | 0:aa1e012ec210 | 265 | struct timer t; |
ostapsky | 0:aa1e012ec210 | 266 | |
ostapsky | 0:aa1e012ec210 | 267 | Timer_Set(&t, to); |
ostapsky | 0:aa1e012ec210 | 268 | |
ostapsky | 0:aa1e012ec210 | 269 | while(1){ |
ostapsky | 0:aa1e012ec210 | 270 | if(Timer_Expired(&t)){ |
ostapsky | 0:aa1e012ec210 | 271 | goto failed; |
ostapsky | 0:aa1e012ec210 | 272 | } |
ostapsky | 0:aa1e012ec210 | 273 | if(new_packet){ |
ostapsky | 0:aa1e012ec210 | 274 | break; |
ostapsky | 0:aa1e012ec210 | 275 | } |
ostapsky | 0:aa1e012ec210 | 276 | } |
ostapsky | 0:aa1e012ec210 | 277 | } |
ostapsky | 0:aa1e012ec210 | 278 | |
ostapsky | 0:aa1e012ec210 | 279 | hci_hdr = (void *)hci_buffer; |
ostapsky | 0:aa1e012ec210 | 280 | if(hci_hdr->type != HCI_EVENT_PKT){ |
ostapsky | 0:aa1e012ec210 | 281 | new_packet = FALSE; |
ostapsky | 0:aa1e012ec210 | 282 | Enable_SPI_IRQ(); |
ostapsky | 0:aa1e012ec210 | 283 | continue; |
ostapsky | 0:aa1e012ec210 | 284 | } |
ostapsky | 0:aa1e012ec210 | 285 | |
ostapsky | 0:aa1e012ec210 | 286 | event_pckt = (void *) (hci_hdr->data); |
ostapsky | 0:aa1e012ec210 | 287 | |
ostapsky | 0:aa1e012ec210 | 288 | ptr = hci_buffer + (1 + HCI_EVENT_HDR_SIZE); |
ostapsky | 0:aa1e012ec210 | 289 | len = hci_pckt_len - (1 + HCI_EVENT_HDR_SIZE); |
ostapsky | 0:aa1e012ec210 | 290 | |
ostapsky | 0:aa1e012ec210 | 291 | switch (event_pckt->evt) { |
ostapsky | 0:aa1e012ec210 | 292 | |
ostapsky | 0:aa1e012ec210 | 293 | case EVT_CMD_STATUS: |
ostapsky | 0:aa1e012ec210 | 294 | cs = (void *) ptr; |
ostapsky | 0:aa1e012ec210 | 295 | |
ostapsky | 0:aa1e012ec210 | 296 | if (cs->opcode != opcode) |
ostapsky | 0:aa1e012ec210 | 297 | break; |
ostapsky | 0:aa1e012ec210 | 298 | |
ostapsky | 0:aa1e012ec210 | 299 | if (r->event != EVT_CMD_STATUS) { |
ostapsky | 0:aa1e012ec210 | 300 | if (cs->status) { |
ostapsky | 0:aa1e012ec210 | 301 | goto failed; |
ostapsky | 0:aa1e012ec210 | 302 | } |
ostapsky | 0:aa1e012ec210 | 303 | break; |
ostapsky | 0:aa1e012ec210 | 304 | } |
ostapsky | 0:aa1e012ec210 | 305 | |
ostapsky | 0:aa1e012ec210 | 306 | r->rlen = MIN(len, r->rlen); |
ostapsky | 0:aa1e012ec210 | 307 | Osal_MemCpy(r->rparam, ptr, r->rlen); |
ostapsky | 0:aa1e012ec210 | 308 | goto done; |
ostapsky | 0:aa1e012ec210 | 309 | |
ostapsky | 0:aa1e012ec210 | 310 | case EVT_CMD_COMPLETE: |
ostapsky | 0:aa1e012ec210 | 311 | cc = (void *) ptr; |
ostapsky | 0:aa1e012ec210 | 312 | |
ostapsky | 0:aa1e012ec210 | 313 | if (cc->opcode != opcode) |
ostapsky | 0:aa1e012ec210 | 314 | break; |
ostapsky | 0:aa1e012ec210 | 315 | |
ostapsky | 0:aa1e012ec210 | 316 | ptr += EVT_CMD_COMPLETE_SIZE; |
ostapsky | 0:aa1e012ec210 | 317 | len -= EVT_CMD_COMPLETE_SIZE; |
ostapsky | 0:aa1e012ec210 | 318 | |
ostapsky | 0:aa1e012ec210 | 319 | r->rlen = MIN(len, r->rlen); |
ostapsky | 0:aa1e012ec210 | 320 | Osal_MemCpy(r->rparam, ptr, r->rlen); |
ostapsky | 0:aa1e012ec210 | 321 | goto done; |
ostapsky | 0:aa1e012ec210 | 322 | |
ostapsky | 0:aa1e012ec210 | 323 | case EVT_LE_META_EVENT: |
ostapsky | 0:aa1e012ec210 | 324 | me = (void *) ptr; |
ostapsky | 0:aa1e012ec210 | 325 | |
ostapsky | 0:aa1e012ec210 | 326 | if (me->subevent != r->event) |
ostapsky | 0:aa1e012ec210 | 327 | break; |
ostapsky | 0:aa1e012ec210 | 328 | |
ostapsky | 0:aa1e012ec210 | 329 | len -= 1; |
ostapsky | 0:aa1e012ec210 | 330 | r->rlen = MIN(len, r->rlen); |
ostapsky | 0:aa1e012ec210 | 331 | Osal_MemCpy(r->rparam, me->data, r->rlen); |
ostapsky | 0:aa1e012ec210 | 332 | goto done; |
ostapsky | 0:aa1e012ec210 | 333 | |
ostapsky | 0:aa1e012ec210 | 334 | case EVT_HARDWARE_ERROR: |
ostapsky | 0:aa1e012ec210 | 335 | goto failed; |
ostapsky | 0:aa1e012ec210 | 336 | |
ostapsky | 0:aa1e012ec210 | 337 | default: |
ostapsky | 0:aa1e012ec210 | 338 | break; // In the meantime there could be other events from the controller. |
ostapsky | 0:aa1e012ec210 | 339 | } |
ostapsky | 0:aa1e012ec210 | 340 | |
ostapsky | 0:aa1e012ec210 | 341 | new_packet = FALSE; |
ostapsky | 0:aa1e012ec210 | 342 | Enable_SPI_IRQ(); |
ostapsky | 0:aa1e012ec210 | 343 | |
ostapsky | 0:aa1e012ec210 | 344 | } |
ostapsky | 0:aa1e012ec210 | 345 | |
ostapsky | 0:aa1e012ec210 | 346 | failed: |
ostapsky | 0:aa1e012ec210 | 347 | hci_set_packet_complete_callback(NULL); |
ostapsky | 0:aa1e012ec210 | 348 | Enable_SPI_IRQ(); |
ostapsky | 0:aa1e012ec210 | 349 | return -1; |
ostapsky | 0:aa1e012ec210 | 350 | |
ostapsky | 0:aa1e012ec210 | 351 | done: |
ostapsky | 0:aa1e012ec210 | 352 | hci_set_packet_complete_callback(NULL); |
ostapsky | 0:aa1e012ec210 | 353 | Enable_SPI_IRQ(); |
ostapsky | 0:aa1e012ec210 | 354 | return 0; |
ostapsky | 0:aa1e012ec210 | 355 | } |
ostapsky | 0:aa1e012ec210 | 356 | |
ostapsky | 0:aa1e012ec210 | 357 | int hci_reset() |
ostapsky | 0:aa1e012ec210 | 358 | { |
ostapsky | 0:aa1e012ec210 | 359 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 360 | tHalUint8 status; |
ostapsky | 0:aa1e012ec210 | 361 | |
ostapsky | 0:aa1e012ec210 | 362 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 363 | rq.ogf = OGF_HOST_CTL; |
ostapsky | 0:aa1e012ec210 | 364 | rq.ocf = OCF_RESET; |
ostapsky | 0:aa1e012ec210 | 365 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 366 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 367 | |
ostapsky | 0:aa1e012ec210 | 368 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 369 | return -1; |
ostapsky | 0:aa1e012ec210 | 370 | |
ostapsky | 0:aa1e012ec210 | 371 | if (status) { |
ostapsky | 0:aa1e012ec210 | 372 | return -1; |
ostapsky | 0:aa1e012ec210 | 373 | } |
ostapsky | 0:aa1e012ec210 | 374 | |
ostapsky | 0:aa1e012ec210 | 375 | return 0; |
ostapsky | 0:aa1e012ec210 | 376 | } |
ostapsky | 0:aa1e012ec210 | 377 | |
ostapsky | 0:aa1e012ec210 | 378 | int hci_disconnect(uint16_t handle, uint8_t reason) |
ostapsky | 0:aa1e012ec210 | 379 | { |
ostapsky | 0:aa1e012ec210 | 380 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 381 | disconnect_cp cp; |
ostapsky | 0:aa1e012ec210 | 382 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 383 | |
ostapsky | 0:aa1e012ec210 | 384 | cp.handle = handle; |
ostapsky | 0:aa1e012ec210 | 385 | cp.reason = reason; |
ostapsky | 0:aa1e012ec210 | 386 | |
ostapsky | 0:aa1e012ec210 | 387 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 388 | rq.ogf = OGF_LINK_CTL; |
ostapsky | 0:aa1e012ec210 | 389 | rq.ocf = OCF_DISCONNECT; |
ostapsky | 0:aa1e012ec210 | 390 | rq.cparam = &cp; |
ostapsky | 0:aa1e012ec210 | 391 | rq.clen = DISCONNECT_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 392 | rq.event = EVT_CMD_STATUS; |
ostapsky | 0:aa1e012ec210 | 393 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 394 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 395 | |
ostapsky | 0:aa1e012ec210 | 396 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 397 | return -1; |
ostapsky | 0:aa1e012ec210 | 398 | |
ostapsky | 0:aa1e012ec210 | 399 | if (status) { |
ostapsky | 0:aa1e012ec210 | 400 | return -1; |
ostapsky | 0:aa1e012ec210 | 401 | } |
ostapsky | 0:aa1e012ec210 | 402 | |
ostapsky | 0:aa1e012ec210 | 403 | return 0; |
ostapsky | 0:aa1e012ec210 | 404 | } |
ostapsky | 0:aa1e012ec210 | 405 | |
ostapsky | 0:aa1e012ec210 | 406 | int hci_le_read_local_version(/* TODO: insert parameters */) |
ostapsky | 0:aa1e012ec210 | 407 | { |
ostapsky | 0:aa1e012ec210 | 408 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 409 | read_local_version_rp resp; |
ostapsky | 0:aa1e012ec210 | 410 | |
ostapsky | 0:aa1e012ec210 | 411 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 412 | |
ostapsky | 0:aa1e012ec210 | 413 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 414 | rq.ogf = OGF_INFO_PARAM; |
ostapsky | 0:aa1e012ec210 | 415 | rq.ocf = OCF_READ_LOCAL_VERSION; |
ostapsky | 0:aa1e012ec210 | 416 | rq.cparam = NULL; |
ostapsky | 0:aa1e012ec210 | 417 | rq.clen = 0; |
ostapsky | 0:aa1e012ec210 | 418 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 419 | rq.rlen = READ_LOCAL_VERSION_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 420 | |
ostapsky | 0:aa1e012ec210 | 421 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 422 | return -1; |
ostapsky | 0:aa1e012ec210 | 423 | |
ostapsky | 0:aa1e012ec210 | 424 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 425 | return -1; |
ostapsky | 0:aa1e012ec210 | 426 | } |
ostapsky | 0:aa1e012ec210 | 427 | |
ostapsky | 0:aa1e012ec210 | 428 | return 0; |
ostapsky | 0:aa1e012ec210 | 429 | } |
ostapsky | 0:aa1e012ec210 | 430 | |
ostapsky | 0:aa1e012ec210 | 431 | int hci_le_read_buffer_size(uint16_t *pkt_len, uint8_t *max_pkt) |
ostapsky | 0:aa1e012ec210 | 432 | { |
ostapsky | 0:aa1e012ec210 | 433 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 434 | le_read_buffer_size_rp resp; |
ostapsky | 0:aa1e012ec210 | 435 | |
ostapsky | 0:aa1e012ec210 | 436 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 437 | |
ostapsky | 0:aa1e012ec210 | 438 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 439 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 440 | rq.ocf = OCF_LE_READ_BUFFER_SIZE; |
ostapsky | 0:aa1e012ec210 | 441 | rq.cparam = NULL; |
ostapsky | 0:aa1e012ec210 | 442 | rq.clen = 0; |
ostapsky | 0:aa1e012ec210 | 443 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 444 | rq.rlen = LE_READ_BUFFER_SIZE_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 445 | |
ostapsky | 0:aa1e012ec210 | 446 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 447 | return -1; |
ostapsky | 0:aa1e012ec210 | 448 | |
ostapsky | 0:aa1e012ec210 | 449 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 450 | return -1; |
ostapsky | 0:aa1e012ec210 | 451 | } |
ostapsky | 0:aa1e012ec210 | 452 | |
ostapsky | 0:aa1e012ec210 | 453 | *pkt_len = resp.pkt_len; |
ostapsky | 0:aa1e012ec210 | 454 | *max_pkt = resp.max_pkt; |
ostapsky | 0:aa1e012ec210 | 455 | |
ostapsky | 0:aa1e012ec210 | 456 | return 0; |
ostapsky | 0:aa1e012ec210 | 457 | } |
ostapsky | 0:aa1e012ec210 | 458 | |
ostapsky | 0:aa1e012ec210 | 459 | int hci_le_set_advertising_parameters(uint16_t min_interval, uint16_t max_interval, uint8_t advtype, |
ostapsky | 0:aa1e012ec210 | 460 | uint8_t own_bdaddr_type, uint8_t direct_bdaddr_type, tBDAddr direct_bdaddr, uint8_t chan_map, |
ostapsky | 0:aa1e012ec210 | 461 | uint8_t filter) |
ostapsky | 0:aa1e012ec210 | 462 | { |
ostapsky | 0:aa1e012ec210 | 463 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 464 | le_set_adv_parameters_cp adv_cp; |
ostapsky | 0:aa1e012ec210 | 465 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 466 | |
ostapsky | 0:aa1e012ec210 | 467 | Osal_MemSet(&adv_cp, 0, sizeof(adv_cp)); |
ostapsky | 0:aa1e012ec210 | 468 | adv_cp.min_interval = min_interval; |
ostapsky | 0:aa1e012ec210 | 469 | adv_cp.max_interval = max_interval; |
ostapsky | 0:aa1e012ec210 | 470 | adv_cp.advtype = advtype; |
ostapsky | 0:aa1e012ec210 | 471 | adv_cp.own_bdaddr_type = own_bdaddr_type; |
ostapsky | 0:aa1e012ec210 | 472 | adv_cp.direct_bdaddr_type = direct_bdaddr_type; |
ostapsky | 0:aa1e012ec210 | 473 | Osal_MemCpy(adv_cp.direct_bdaddr,direct_bdaddr,sizeof(adv_cp.direct_bdaddr)); |
ostapsky | 0:aa1e012ec210 | 474 | adv_cp.chan_map = chan_map; |
ostapsky | 0:aa1e012ec210 | 475 | adv_cp.filter = filter; |
ostapsky | 0:aa1e012ec210 | 476 | |
ostapsky | 0:aa1e012ec210 | 477 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 478 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 479 | rq.ocf = OCF_LE_SET_ADV_PARAMETERS; |
ostapsky | 0:aa1e012ec210 | 480 | rq.cparam = &adv_cp; |
ostapsky | 0:aa1e012ec210 | 481 | rq.clen = LE_SET_ADV_PARAMETERS_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 482 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 483 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 484 | |
ostapsky | 0:aa1e012ec210 | 485 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 486 | return -1; |
ostapsky | 0:aa1e012ec210 | 487 | |
ostapsky | 0:aa1e012ec210 | 488 | if (status) { |
ostapsky | 0:aa1e012ec210 | 489 | return -1; |
ostapsky | 0:aa1e012ec210 | 490 | } |
ostapsky | 0:aa1e012ec210 | 491 | |
ostapsky | 0:aa1e012ec210 | 492 | return 0; |
ostapsky | 0:aa1e012ec210 | 493 | } |
ostapsky | 0:aa1e012ec210 | 494 | |
ostapsky | 0:aa1e012ec210 | 495 | int hci_le_set_advertising_data(uint8_t length, const uint8_t data[]) |
ostapsky | 0:aa1e012ec210 | 496 | { |
ostapsky | 0:aa1e012ec210 | 497 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 498 | le_set_adv_data_cp adv_cp; |
ostapsky | 0:aa1e012ec210 | 499 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 500 | |
ostapsky | 0:aa1e012ec210 | 501 | Osal_MemSet(&adv_cp, 0, sizeof(adv_cp)); |
ostapsky | 0:aa1e012ec210 | 502 | adv_cp.length = length; |
ostapsky | 0:aa1e012ec210 | 503 | Osal_MemCpy(adv_cp.data, data, MIN(31,length)); |
ostapsky | 0:aa1e012ec210 | 504 | |
ostapsky | 0:aa1e012ec210 | 505 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 506 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 507 | rq.ocf = OCF_LE_SET_ADV_DATA; |
ostapsky | 0:aa1e012ec210 | 508 | rq.cparam = &adv_cp; |
ostapsky | 0:aa1e012ec210 | 509 | rq.clen = LE_SET_ADV_DATA_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 510 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 511 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 512 | |
ostapsky | 0:aa1e012ec210 | 513 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 514 | return -1; |
ostapsky | 0:aa1e012ec210 | 515 | |
ostapsky | 0:aa1e012ec210 | 516 | if (status) { |
ostapsky | 0:aa1e012ec210 | 517 | return -1; |
ostapsky | 0:aa1e012ec210 | 518 | } |
ostapsky | 0:aa1e012ec210 | 519 | |
ostapsky | 0:aa1e012ec210 | 520 | return 0; |
ostapsky | 0:aa1e012ec210 | 521 | } |
ostapsky | 0:aa1e012ec210 | 522 | |
ostapsky | 0:aa1e012ec210 | 523 | int hci_le_set_advertise_enable(tHalUint8 enable) |
ostapsky | 0:aa1e012ec210 | 524 | { |
ostapsky | 0:aa1e012ec210 | 525 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 526 | le_set_advertise_enable_cp adv_cp; |
ostapsky | 0:aa1e012ec210 | 527 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 528 | |
ostapsky | 0:aa1e012ec210 | 529 | Osal_MemSet(&adv_cp, 0, sizeof(adv_cp)); |
ostapsky | 0:aa1e012ec210 | 530 | adv_cp.enable = enable?1:0; |
ostapsky | 0:aa1e012ec210 | 531 | |
ostapsky | 0:aa1e012ec210 | 532 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 533 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 534 | rq.ocf = OCF_LE_SET_ADVERTISE_ENABLE; |
ostapsky | 0:aa1e012ec210 | 535 | rq.cparam = &adv_cp; |
ostapsky | 0:aa1e012ec210 | 536 | rq.clen = LE_SET_ADVERTISE_ENABLE_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 537 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 538 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 539 | |
ostapsky | 0:aa1e012ec210 | 540 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 541 | return -1; |
ostapsky | 0:aa1e012ec210 | 542 | |
ostapsky | 0:aa1e012ec210 | 543 | if (status) { |
ostapsky | 0:aa1e012ec210 | 544 | return -1; |
ostapsky | 0:aa1e012ec210 | 545 | } |
ostapsky | 0:aa1e012ec210 | 546 | |
ostapsky | 0:aa1e012ec210 | 547 | return 0; |
ostapsky | 0:aa1e012ec210 | 548 | } |
ostapsky | 0:aa1e012ec210 | 549 | |
ostapsky | 0:aa1e012ec210 | 550 | int hci_le_rand(uint8_t random_number[8]) |
ostapsky | 0:aa1e012ec210 | 551 | { |
ostapsky | 0:aa1e012ec210 | 552 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 553 | le_rand_rp resp; |
ostapsky | 0:aa1e012ec210 | 554 | |
ostapsky | 0:aa1e012ec210 | 555 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 556 | |
ostapsky | 0:aa1e012ec210 | 557 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 558 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 559 | rq.ocf = OCF_LE_RAND; |
ostapsky | 0:aa1e012ec210 | 560 | rq.cparam = NULL; |
ostapsky | 0:aa1e012ec210 | 561 | rq.clen = 0; |
ostapsky | 0:aa1e012ec210 | 562 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 563 | rq.rlen = LE_RAND_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 564 | |
ostapsky | 0:aa1e012ec210 | 565 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 566 | return -1; |
ostapsky | 0:aa1e012ec210 | 567 | |
ostapsky | 0:aa1e012ec210 | 568 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 569 | return -1; |
ostapsky | 0:aa1e012ec210 | 570 | } |
ostapsky | 0:aa1e012ec210 | 571 | |
ostapsky | 0:aa1e012ec210 | 572 | Osal_MemCpy(random_number, resp.random, 8); |
ostapsky | 0:aa1e012ec210 | 573 | |
ostapsky | 0:aa1e012ec210 | 574 | return 0; |
ostapsky | 0:aa1e012ec210 | 575 | } |
ostapsky | 0:aa1e012ec210 | 576 | |
ostapsky | 0:aa1e012ec210 | 577 | int hci_le_set_scan_resp_data(uint8_t length, const uint8_t data[]) |
ostapsky | 0:aa1e012ec210 | 578 | { |
ostapsky | 0:aa1e012ec210 | 579 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 580 | le_set_scan_response_data_cp scan_resp_cp; |
ostapsky | 0:aa1e012ec210 | 581 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 582 | |
ostapsky | 0:aa1e012ec210 | 583 | Osal_MemSet(&scan_resp_cp, 0, sizeof(scan_resp_cp)); |
ostapsky | 0:aa1e012ec210 | 584 | scan_resp_cp.length = length; |
ostapsky | 0:aa1e012ec210 | 585 | Osal_MemCpy(scan_resp_cp.data, data, MIN(31,length)); |
ostapsky | 0:aa1e012ec210 | 586 | |
ostapsky | 0:aa1e012ec210 | 587 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 588 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 589 | rq.ocf = OCF_LE_SET_SCAN_RESPONSE_DATA; |
ostapsky | 0:aa1e012ec210 | 590 | rq.cparam = &scan_resp_cp; |
ostapsky | 0:aa1e012ec210 | 591 | rq.clen = LE_SET_SCAN_RESPONSE_DATA_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 592 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 593 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 594 | |
ostapsky | 0:aa1e012ec210 | 595 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 596 | return -1; |
ostapsky | 0:aa1e012ec210 | 597 | |
ostapsky | 0:aa1e012ec210 | 598 | if (status) { |
ostapsky | 0:aa1e012ec210 | 599 | return -1; |
ostapsky | 0:aa1e012ec210 | 600 | } |
ostapsky | 0:aa1e012ec210 | 601 | |
ostapsky | 0:aa1e012ec210 | 602 | return 0; |
ostapsky | 0:aa1e012ec210 | 603 | } |
ostapsky | 0:aa1e012ec210 | 604 | |
ostapsky | 0:aa1e012ec210 | 605 | int hci_le_read_advertising_channel_tx_power(int8_t *tx_power_level) |
ostapsky | 0:aa1e012ec210 | 606 | { |
ostapsky | 0:aa1e012ec210 | 607 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 608 | le_read_adv_channel_tx_power_rp resp; |
ostapsky | 0:aa1e012ec210 | 609 | |
ostapsky | 0:aa1e012ec210 | 610 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 611 | |
ostapsky | 0:aa1e012ec210 | 612 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 613 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 614 | rq.ocf = OCF_LE_READ_ADV_CHANNEL_TX_POWER; |
ostapsky | 0:aa1e012ec210 | 615 | rq.cparam = NULL; |
ostapsky | 0:aa1e012ec210 | 616 | rq.clen = 0; |
ostapsky | 0:aa1e012ec210 | 617 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 618 | rq.rlen = LE_RAND_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 619 | |
ostapsky | 0:aa1e012ec210 | 620 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 621 | return -1; |
ostapsky | 0:aa1e012ec210 | 622 | |
ostapsky | 0:aa1e012ec210 | 623 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 624 | return -1; |
ostapsky | 0:aa1e012ec210 | 625 | } |
ostapsky | 0:aa1e012ec210 | 626 | |
ostapsky | 0:aa1e012ec210 | 627 | *tx_power_level = resp.level; |
ostapsky | 0:aa1e012ec210 | 628 | |
ostapsky | 0:aa1e012ec210 | 629 | return 0; |
ostapsky | 0:aa1e012ec210 | 630 | } |
ostapsky | 0:aa1e012ec210 | 631 | |
ostapsky | 0:aa1e012ec210 | 632 | int hci_le_set_random_address(tBDAddr bdaddr) |
ostapsky | 0:aa1e012ec210 | 633 | { |
ostapsky | 0:aa1e012ec210 | 634 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 635 | le_set_random_address_cp set_rand_addr_cp; |
ostapsky | 0:aa1e012ec210 | 636 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 637 | |
ostapsky | 0:aa1e012ec210 | 638 | Osal_MemSet(&set_rand_addr_cp, 0, sizeof(set_rand_addr_cp)); |
ostapsky | 0:aa1e012ec210 | 639 | Osal_MemCpy(set_rand_addr_cp.bdaddr, bdaddr, sizeof(tBDAddr)); |
ostapsky | 0:aa1e012ec210 | 640 | |
ostapsky | 0:aa1e012ec210 | 641 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 642 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 643 | rq.ocf = OCF_LE_SET_RANDOM_ADDRESS; |
ostapsky | 0:aa1e012ec210 | 644 | rq.cparam = &set_rand_addr_cp; |
ostapsky | 0:aa1e012ec210 | 645 | rq.clen = LE_SET_RANDOM_ADDRESS_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 646 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 647 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 648 | |
ostapsky | 0:aa1e012ec210 | 649 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 650 | return -1; |
ostapsky | 0:aa1e012ec210 | 651 | |
ostapsky | 0:aa1e012ec210 | 652 | if (status) { |
ostapsky | 0:aa1e012ec210 | 653 | return -1; |
ostapsky | 0:aa1e012ec210 | 654 | } |
ostapsky | 0:aa1e012ec210 | 655 | |
ostapsky | 0:aa1e012ec210 | 656 | return 0; |
ostapsky | 0:aa1e012ec210 | 657 | } |
ostapsky | 0:aa1e012ec210 | 658 | |
ostapsky | 0:aa1e012ec210 | 659 | int hci_read_bd_addr(tBDAddr bdaddr) |
ostapsky | 0:aa1e012ec210 | 660 | { |
ostapsky | 0:aa1e012ec210 | 661 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 662 | read_bd_addr_rp resp; |
ostapsky | 0:aa1e012ec210 | 663 | |
ostapsky | 0:aa1e012ec210 | 664 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 665 | |
ostapsky | 0:aa1e012ec210 | 666 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 667 | rq.ogf = OGF_INFO_PARAM; |
ostapsky | 0:aa1e012ec210 | 668 | rq.ocf = OCF_READ_BD_ADDR; |
ostapsky | 0:aa1e012ec210 | 669 | rq.cparam = NULL; |
ostapsky | 0:aa1e012ec210 | 670 | rq.clen = 0; |
ostapsky | 0:aa1e012ec210 | 671 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 672 | rq.rlen = READ_BD_ADDR_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 673 | |
ostapsky | 0:aa1e012ec210 | 674 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 675 | return -1; |
ostapsky | 0:aa1e012ec210 | 676 | |
ostapsky | 0:aa1e012ec210 | 677 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 678 | return -1; |
ostapsky | 0:aa1e012ec210 | 679 | } |
ostapsky | 0:aa1e012ec210 | 680 | Osal_MemCpy(bdaddr, resp.bdaddr, sizeof(tBDAddr)); |
ostapsky | 0:aa1e012ec210 | 681 | |
ostapsky | 0:aa1e012ec210 | 682 | return 0; |
ostapsky | 0:aa1e012ec210 | 683 | } |
ostapsky | 0:aa1e012ec210 | 684 | |
ostapsky | 0:aa1e012ec210 | 685 | int hci_le_create_connection(uint16_t interval, uint16_t window, uint8_t initiator_filter, uint8_t peer_bdaddr_type, |
ostapsky | 0:aa1e012ec210 | 686 | const tBDAddr peer_bdaddr, uint8_t own_bdaddr_type, uint16_t min_interval, uint16_t max_interval, |
ostapsky | 0:aa1e012ec210 | 687 | uint16_t latency, uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length) |
ostapsky | 0:aa1e012ec210 | 688 | { |
ostapsky | 0:aa1e012ec210 | 689 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 690 | le_create_connection_cp create_cp; |
ostapsky | 0:aa1e012ec210 | 691 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 692 | |
ostapsky | 0:aa1e012ec210 | 693 | Osal_MemSet(&create_cp, 0, sizeof(create_cp)); |
ostapsky | 0:aa1e012ec210 | 694 | create_cp.interval = interval; |
ostapsky | 0:aa1e012ec210 | 695 | create_cp.window = window; |
ostapsky | 0:aa1e012ec210 | 696 | create_cp.initiator_filter = initiator_filter; |
ostapsky | 0:aa1e012ec210 | 697 | create_cp.peer_bdaddr_type = peer_bdaddr_type; |
ostapsky | 0:aa1e012ec210 | 698 | Osal_MemCpy(create_cp.peer_bdaddr, peer_bdaddr, sizeof(tBDAddr)); |
ostapsky | 0:aa1e012ec210 | 699 | create_cp.own_bdaddr_type = own_bdaddr_type; |
ostapsky | 0:aa1e012ec210 | 700 | create_cp.min_interval=min_interval; |
ostapsky | 0:aa1e012ec210 | 701 | create_cp.max_interval=max_interval; |
ostapsky | 0:aa1e012ec210 | 702 | create_cp.latency = latency; |
ostapsky | 0:aa1e012ec210 | 703 | create_cp.supervision_timeout=supervision_timeout; |
ostapsky | 0:aa1e012ec210 | 704 | create_cp.min_ce_length=min_ce_length; |
ostapsky | 0:aa1e012ec210 | 705 | create_cp.max_ce_length=max_ce_length; |
ostapsky | 0:aa1e012ec210 | 706 | |
ostapsky | 0:aa1e012ec210 | 707 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 708 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 709 | rq.ocf = OCF_LE_CREATE_CONN; |
ostapsky | 0:aa1e012ec210 | 710 | rq.cparam = &create_cp; |
ostapsky | 0:aa1e012ec210 | 711 | rq.clen = LE_CREATE_CONN_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 712 | rq.event = EVT_CMD_STATUS; |
ostapsky | 0:aa1e012ec210 | 713 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 714 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 715 | |
ostapsky | 0:aa1e012ec210 | 716 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 717 | return -1; |
ostapsky | 0:aa1e012ec210 | 718 | |
ostapsky | 0:aa1e012ec210 | 719 | if (status) { |
ostapsky | 0:aa1e012ec210 | 720 | return -1; |
ostapsky | 0:aa1e012ec210 | 721 | } |
ostapsky | 0:aa1e012ec210 | 722 | |
ostapsky | 0:aa1e012ec210 | 723 | return 0; |
ostapsky | 0:aa1e012ec210 | 724 | } |
ostapsky | 0:aa1e012ec210 | 725 | |
ostapsky | 0:aa1e012ec210 | 726 | int hci_le_encrypt(uint8_t key[16], uint8_t plaintextData[16], uint8_t encryptedData[16]) |
ostapsky | 0:aa1e012ec210 | 727 | { |
ostapsky | 0:aa1e012ec210 | 728 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 729 | le_encrypt_cp params; |
ostapsky | 0:aa1e012ec210 | 730 | le_encrypt_rp resp; |
ostapsky | 0:aa1e012ec210 | 731 | |
ostapsky | 0:aa1e012ec210 | 732 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 733 | |
ostapsky | 0:aa1e012ec210 | 734 | Osal_MemCpy(params.key, key, 16); |
ostapsky | 0:aa1e012ec210 | 735 | Osal_MemCpy(params.plaintext, plaintextData, 16); |
ostapsky | 0:aa1e012ec210 | 736 | |
ostapsky | 0:aa1e012ec210 | 737 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 738 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 739 | rq.ocf = OCF_LE_ENCRYPT; |
ostapsky | 0:aa1e012ec210 | 740 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 741 | rq.clen = LE_ENCRYPT_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 742 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 743 | rq.rlen = LE_ENCRYPT_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 744 | |
ostapsky | 0:aa1e012ec210 | 745 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 746 | return -1; |
ostapsky | 0:aa1e012ec210 | 747 | } |
ostapsky | 0:aa1e012ec210 | 748 | |
ostapsky | 0:aa1e012ec210 | 749 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 750 | return -1; |
ostapsky | 0:aa1e012ec210 | 751 | } |
ostapsky | 0:aa1e012ec210 | 752 | |
ostapsky | 0:aa1e012ec210 | 753 | Osal_MemCpy(encryptedData, resp.encdata, 16); |
ostapsky | 0:aa1e012ec210 | 754 | |
ostapsky | 0:aa1e012ec210 | 755 | return 0; |
ostapsky | 0:aa1e012ec210 | 756 | } |
ostapsky | 0:aa1e012ec210 | 757 | |
ostapsky | 0:aa1e012ec210 | 758 | int hci_le_ltk_request_reply(uint8_t key[16]) |
ostapsky | 0:aa1e012ec210 | 759 | { |
ostapsky | 0:aa1e012ec210 | 760 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 761 | le_ltk_reply_cp params; |
ostapsky | 0:aa1e012ec210 | 762 | le_ltk_reply_rp resp; |
ostapsky | 0:aa1e012ec210 | 763 | |
ostapsky | 0:aa1e012ec210 | 764 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 765 | |
ostapsky | 0:aa1e012ec210 | 766 | params.handle = 1; |
ostapsky | 0:aa1e012ec210 | 767 | Osal_MemCpy(params.key, key, 16); |
ostapsky | 0:aa1e012ec210 | 768 | |
ostapsky | 0:aa1e012ec210 | 769 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 770 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 771 | rq.ocf = OCF_LE_LTK_REPLY; |
ostapsky | 0:aa1e012ec210 | 772 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 773 | rq.clen = LE_LTK_REPLY_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 774 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 775 | rq.rlen = LE_LTK_REPLY_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 776 | |
ostapsky | 0:aa1e012ec210 | 777 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 778 | return -1; |
ostapsky | 0:aa1e012ec210 | 779 | |
ostapsky | 0:aa1e012ec210 | 780 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 781 | return -1; |
ostapsky | 0:aa1e012ec210 | 782 | } |
ostapsky | 0:aa1e012ec210 | 783 | |
ostapsky | 0:aa1e012ec210 | 784 | return 0; |
ostapsky | 0:aa1e012ec210 | 785 | } |
ostapsky | 0:aa1e012ec210 | 786 | |
ostapsky | 0:aa1e012ec210 | 787 | int hci_le_ltk_request_neg_reply() |
ostapsky | 0:aa1e012ec210 | 788 | { |
ostapsky | 0:aa1e012ec210 | 789 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 790 | le_ltk_neg_reply_cp params; |
ostapsky | 0:aa1e012ec210 | 791 | le_ltk_neg_reply_rp resp; |
ostapsky | 0:aa1e012ec210 | 792 | |
ostapsky | 0:aa1e012ec210 | 793 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 794 | |
ostapsky | 0:aa1e012ec210 | 795 | params.handle = 1; |
ostapsky | 0:aa1e012ec210 | 796 | |
ostapsky | 0:aa1e012ec210 | 797 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 798 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 799 | rq.ocf = OCF_LE_LTK_NEG_REPLY; |
ostapsky | 0:aa1e012ec210 | 800 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 801 | rq.clen = LE_LTK_NEG_REPLY_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 802 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 803 | rq.rlen = LE_LTK_NEG_REPLY_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 804 | |
ostapsky | 0:aa1e012ec210 | 805 | if (hci_send_req(&rq) < 0) |
ostapsky | 0:aa1e012ec210 | 806 | return -1; |
ostapsky | 0:aa1e012ec210 | 807 | |
ostapsky | 0:aa1e012ec210 | 808 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 809 | return -1; |
ostapsky | 0:aa1e012ec210 | 810 | } |
ostapsky | 0:aa1e012ec210 | 811 | |
ostapsky | 0:aa1e012ec210 | 812 | return 0; |
ostapsky | 0:aa1e012ec210 | 813 | } |
ostapsky | 0:aa1e012ec210 | 814 | |
ostapsky | 0:aa1e012ec210 | 815 | int hci_le_read_white_list_size(uint8_t *size) |
ostapsky | 0:aa1e012ec210 | 816 | { |
ostapsky | 0:aa1e012ec210 | 817 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 818 | le_read_white_list_size_rp resp; |
ostapsky | 0:aa1e012ec210 | 819 | |
ostapsky | 0:aa1e012ec210 | 820 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 821 | |
ostapsky | 0:aa1e012ec210 | 822 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 823 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 824 | rq.ocf = OCF_LE_READ_WHITE_LIST_SIZE; |
ostapsky | 0:aa1e012ec210 | 825 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 826 | rq.rlen = LE_READ_WHITE_LIST_SIZE_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 827 | |
ostapsky | 0:aa1e012ec210 | 828 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 829 | return -1; |
ostapsky | 0:aa1e012ec210 | 830 | } |
ostapsky | 0:aa1e012ec210 | 831 | |
ostapsky | 0:aa1e012ec210 | 832 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 833 | return -1; |
ostapsky | 0:aa1e012ec210 | 834 | } |
ostapsky | 0:aa1e012ec210 | 835 | |
ostapsky | 0:aa1e012ec210 | 836 | *size = resp.size; |
ostapsky | 0:aa1e012ec210 | 837 | |
ostapsky | 0:aa1e012ec210 | 838 | return 0; |
ostapsky | 0:aa1e012ec210 | 839 | } |
ostapsky | 0:aa1e012ec210 | 840 | |
ostapsky | 0:aa1e012ec210 | 841 | int hci_le_clear_white_list() |
ostapsky | 0:aa1e012ec210 | 842 | { |
ostapsky | 0:aa1e012ec210 | 843 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 844 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 845 | |
ostapsky | 0:aa1e012ec210 | 846 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 847 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 848 | rq.ocf = OCF_LE_CLEAR_WHITE_LIST; |
ostapsky | 0:aa1e012ec210 | 849 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 850 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 851 | |
ostapsky | 0:aa1e012ec210 | 852 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 853 | return -1; |
ostapsky | 0:aa1e012ec210 | 854 | } |
ostapsky | 0:aa1e012ec210 | 855 | |
ostapsky | 0:aa1e012ec210 | 856 | if (status) { |
ostapsky | 0:aa1e012ec210 | 857 | return -1; |
ostapsky | 0:aa1e012ec210 | 858 | } |
ostapsky | 0:aa1e012ec210 | 859 | |
ostapsky | 0:aa1e012ec210 | 860 | return 0; |
ostapsky | 0:aa1e012ec210 | 861 | } |
ostapsky | 0:aa1e012ec210 | 862 | |
ostapsky | 0:aa1e012ec210 | 863 | int hci_le_add_device_to_white_list(uint8_t bdaddr_type, tBDAddr bdaddr) |
ostapsky | 0:aa1e012ec210 | 864 | { |
ostapsky | 0:aa1e012ec210 | 865 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 866 | le_add_device_to_white_list_cp params; |
ostapsky | 0:aa1e012ec210 | 867 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 868 | |
ostapsky | 0:aa1e012ec210 | 869 | params.bdaddr_type = bdaddr_type; |
ostapsky | 0:aa1e012ec210 | 870 | Osal_MemCpy(params.bdaddr, bdaddr, 6); |
ostapsky | 0:aa1e012ec210 | 871 | |
ostapsky | 0:aa1e012ec210 | 872 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 873 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 874 | rq.ocf = OCF_LE_ADD_DEVICE_TO_WHITE_LIST; |
ostapsky | 0:aa1e012ec210 | 875 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 876 | rq.clen = LE_ADD_DEVICE_TO_WHITE_LIST_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 877 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 878 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 879 | |
ostapsky | 0:aa1e012ec210 | 880 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 881 | return -1; |
ostapsky | 0:aa1e012ec210 | 882 | } |
ostapsky | 0:aa1e012ec210 | 883 | |
ostapsky | 0:aa1e012ec210 | 884 | if (status) { |
ostapsky | 0:aa1e012ec210 | 885 | return -1; |
ostapsky | 0:aa1e012ec210 | 886 | } |
ostapsky | 0:aa1e012ec210 | 887 | |
ostapsky | 0:aa1e012ec210 | 888 | return 0; |
ostapsky | 0:aa1e012ec210 | 889 | } |
ostapsky | 0:aa1e012ec210 | 890 | |
ostapsky | 0:aa1e012ec210 | 891 | int hci_le_remove_device_from_white_list(uint8_t bdaddr_type, tBDAddr bdaddr) |
ostapsky | 0:aa1e012ec210 | 892 | { |
ostapsky | 0:aa1e012ec210 | 893 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 894 | le_remove_device_from_white_list_cp params; |
ostapsky | 0:aa1e012ec210 | 895 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 896 | |
ostapsky | 0:aa1e012ec210 | 897 | params.bdaddr_type = bdaddr_type; |
ostapsky | 0:aa1e012ec210 | 898 | Osal_MemCpy(params.bdaddr, bdaddr, 6); |
ostapsky | 0:aa1e012ec210 | 899 | |
ostapsky | 0:aa1e012ec210 | 900 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 901 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 902 | rq.ocf = OCF_LE_REMOVE_DEVICE_FROM_WHITE_LIST; |
ostapsky | 0:aa1e012ec210 | 903 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 904 | rq.clen = LE_REMOVE_DEVICE_FROM_WHITE_LIST_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 905 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 906 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 907 | |
ostapsky | 0:aa1e012ec210 | 908 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 909 | return -1; |
ostapsky | 0:aa1e012ec210 | 910 | } |
ostapsky | 0:aa1e012ec210 | 911 | |
ostapsky | 0:aa1e012ec210 | 912 | if (status) { |
ostapsky | 0:aa1e012ec210 | 913 | return -1; |
ostapsky | 0:aa1e012ec210 | 914 | } |
ostapsky | 0:aa1e012ec210 | 915 | |
ostapsky | 0:aa1e012ec210 | 916 | return 0; |
ostapsky | 0:aa1e012ec210 | 917 | } |
ostapsky | 0:aa1e012ec210 | 918 | |
ostapsky | 0:aa1e012ec210 | 919 | int hci_read_transmit_power_level(uint16_t *conn_handle, uint8_t type, int8_t * tx_level) |
ostapsky | 0:aa1e012ec210 | 920 | { |
ostapsky | 0:aa1e012ec210 | 921 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 922 | read_transmit_power_level_cp params; |
ostapsky | 0:aa1e012ec210 | 923 | read_transmit_power_level_rp resp; |
ostapsky | 0:aa1e012ec210 | 924 | |
ostapsky | 0:aa1e012ec210 | 925 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 926 | |
ostapsky | 0:aa1e012ec210 | 927 | params.handle = *conn_handle; |
ostapsky | 0:aa1e012ec210 | 928 | params.type = type; |
ostapsky | 0:aa1e012ec210 | 929 | |
ostapsky | 0:aa1e012ec210 | 930 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 931 | rq.ogf = OGF_HOST_CTL; |
ostapsky | 0:aa1e012ec210 | 932 | rq.ocf = OCF_READ_TRANSMIT_POWER_LEVEL; |
ostapsky | 0:aa1e012ec210 | 933 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 934 | rq.clen = READ_TRANSMIT_POWER_LEVEL_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 935 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 936 | rq.rlen = READ_TRANSMIT_POWER_LEVEL_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 937 | |
ostapsky | 0:aa1e012ec210 | 938 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 939 | return -1; |
ostapsky | 0:aa1e012ec210 | 940 | } |
ostapsky | 0:aa1e012ec210 | 941 | |
ostapsky | 0:aa1e012ec210 | 942 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 943 | return -1; |
ostapsky | 0:aa1e012ec210 | 944 | } |
ostapsky | 0:aa1e012ec210 | 945 | |
ostapsky | 0:aa1e012ec210 | 946 | *conn_handle = resp.handle; |
ostapsky | 0:aa1e012ec210 | 947 | *tx_level = resp.handle; |
ostapsky | 0:aa1e012ec210 | 948 | |
ostapsky | 0:aa1e012ec210 | 949 | return 0; |
ostapsky | 0:aa1e012ec210 | 950 | } |
ostapsky | 0:aa1e012ec210 | 951 | |
ostapsky | 0:aa1e012ec210 | 952 | int hci_read_rssi(uint16_t *conn_handle, int8_t * rssi) |
ostapsky | 0:aa1e012ec210 | 953 | { |
ostapsky | 0:aa1e012ec210 | 954 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 955 | read_rssi_cp params; |
ostapsky | 0:aa1e012ec210 | 956 | read_rssi_rp resp; |
ostapsky | 0:aa1e012ec210 | 957 | |
ostapsky | 0:aa1e012ec210 | 958 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 959 | |
ostapsky | 0:aa1e012ec210 | 960 | params.handle = *conn_handle; |
ostapsky | 0:aa1e012ec210 | 961 | |
ostapsky | 0:aa1e012ec210 | 962 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 963 | rq.ogf = OGF_STATUS_PARAM; |
ostapsky | 0:aa1e012ec210 | 964 | rq.ocf = OCF_READ_RSSI; |
ostapsky | 0:aa1e012ec210 | 965 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 966 | rq.clen = READ_RSSI_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 967 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 968 | rq.rlen = READ_RSSI_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 969 | |
ostapsky | 0:aa1e012ec210 | 970 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 971 | return -1; |
ostapsky | 0:aa1e012ec210 | 972 | } |
ostapsky | 0:aa1e012ec210 | 973 | |
ostapsky | 0:aa1e012ec210 | 974 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 975 | return -1; |
ostapsky | 0:aa1e012ec210 | 976 | } |
ostapsky | 0:aa1e012ec210 | 977 | |
ostapsky | 0:aa1e012ec210 | 978 | *conn_handle = resp.handle; |
ostapsky | 0:aa1e012ec210 | 979 | *rssi = resp.rssi; |
ostapsky | 0:aa1e012ec210 | 980 | |
ostapsky | 0:aa1e012ec210 | 981 | return 0; |
ostapsky | 0:aa1e012ec210 | 982 | } |
ostapsky | 0:aa1e012ec210 | 983 | |
ostapsky | 0:aa1e012ec210 | 984 | int hci_le_read_local_supported_features(uint8_t *features) |
ostapsky | 0:aa1e012ec210 | 985 | { |
ostapsky | 0:aa1e012ec210 | 986 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 987 | le_read_local_supported_features_rp resp; |
ostapsky | 0:aa1e012ec210 | 988 | |
ostapsky | 0:aa1e012ec210 | 989 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 990 | |
ostapsky | 0:aa1e012ec210 | 991 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 992 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 993 | rq.ocf = OCF_LE_READ_LOCAL_SUPPORTED_FEATURES; |
ostapsky | 0:aa1e012ec210 | 994 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 995 | rq.rlen = LE_READ_LOCAL_SUPPORTED_FEATURES_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 996 | |
ostapsky | 0:aa1e012ec210 | 997 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 998 | return -1; |
ostapsky | 0:aa1e012ec210 | 999 | } |
ostapsky | 0:aa1e012ec210 | 1000 | |
ostapsky | 0:aa1e012ec210 | 1001 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 1002 | return -1; |
ostapsky | 0:aa1e012ec210 | 1003 | } |
ostapsky | 0:aa1e012ec210 | 1004 | |
ostapsky | 0:aa1e012ec210 | 1005 | Osal_MemCpy(features, resp.features, sizeof(resp.features)); |
ostapsky | 0:aa1e012ec210 | 1006 | |
ostapsky | 0:aa1e012ec210 | 1007 | return 0; |
ostapsky | 0:aa1e012ec210 | 1008 | } |
ostapsky | 0:aa1e012ec210 | 1009 | |
ostapsky | 0:aa1e012ec210 | 1010 | int hci_le_read_channel_map(uint16_t conn_handle, uint8_t ch_map[5]) |
ostapsky | 0:aa1e012ec210 | 1011 | { |
ostapsky | 0:aa1e012ec210 | 1012 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 1013 | le_read_channel_map_cp params; |
ostapsky | 0:aa1e012ec210 | 1014 | le_read_channel_map_rp resp; |
ostapsky | 0:aa1e012ec210 | 1015 | |
ostapsky | 0:aa1e012ec210 | 1016 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 1017 | |
ostapsky | 0:aa1e012ec210 | 1018 | params.handle = conn_handle; |
ostapsky | 0:aa1e012ec210 | 1019 | |
ostapsky | 0:aa1e012ec210 | 1020 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 1021 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 1022 | rq.ocf = OCF_LE_READ_CHANNEL_MAP; |
ostapsky | 0:aa1e012ec210 | 1023 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 1024 | rq.clen = LE_READ_CHANNEL_MAP_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 1025 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 1026 | rq.rlen = LE_READ_CHANNEL_MAP_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 1027 | |
ostapsky | 0:aa1e012ec210 | 1028 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 1029 | return -1; |
ostapsky | 0:aa1e012ec210 | 1030 | } |
ostapsky | 0:aa1e012ec210 | 1031 | |
ostapsky | 0:aa1e012ec210 | 1032 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 1033 | return -1; |
ostapsky | 0:aa1e012ec210 | 1034 | } |
ostapsky | 0:aa1e012ec210 | 1035 | |
ostapsky | 0:aa1e012ec210 | 1036 | Osal_MemCpy(ch_map, resp.map, 5); |
ostapsky | 0:aa1e012ec210 | 1037 | |
ostapsky | 0:aa1e012ec210 | 1038 | return 0; |
ostapsky | 0:aa1e012ec210 | 1039 | } |
ostapsky | 0:aa1e012ec210 | 1040 | |
ostapsky | 0:aa1e012ec210 | 1041 | int hci_le_read_supported_states(uint8_t states[8]) |
ostapsky | 0:aa1e012ec210 | 1042 | { |
ostapsky | 0:aa1e012ec210 | 1043 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 1044 | le_read_supported_states_rp resp; |
ostapsky | 0:aa1e012ec210 | 1045 | |
ostapsky | 0:aa1e012ec210 | 1046 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 1047 | |
ostapsky | 0:aa1e012ec210 | 1048 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 1049 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 1050 | rq.ocf = OCF_LE_READ_SUPPORTED_STATES; |
ostapsky | 0:aa1e012ec210 | 1051 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 1052 | rq.rlen = LE_READ_SUPPORTED_STATES_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 1053 | |
ostapsky | 0:aa1e012ec210 | 1054 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 1055 | return -1; |
ostapsky | 0:aa1e012ec210 | 1056 | } |
ostapsky | 0:aa1e012ec210 | 1057 | |
ostapsky | 0:aa1e012ec210 | 1058 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 1059 | return -1; |
ostapsky | 0:aa1e012ec210 | 1060 | } |
ostapsky | 0:aa1e012ec210 | 1061 | |
ostapsky | 0:aa1e012ec210 | 1062 | Osal_MemCpy(states, resp.states, 8); |
ostapsky | 0:aa1e012ec210 | 1063 | |
ostapsky | 0:aa1e012ec210 | 1064 | return 0; |
ostapsky | 0:aa1e012ec210 | 1065 | } |
ostapsky | 0:aa1e012ec210 | 1066 | |
ostapsky | 0:aa1e012ec210 | 1067 | int hci_le_receiver_test(uint8_t frequency) |
ostapsky | 0:aa1e012ec210 | 1068 | { |
ostapsky | 0:aa1e012ec210 | 1069 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 1070 | le_receiver_test_cp params; |
ostapsky | 0:aa1e012ec210 | 1071 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 1072 | |
ostapsky | 0:aa1e012ec210 | 1073 | params.frequency = frequency; |
ostapsky | 0:aa1e012ec210 | 1074 | |
ostapsky | 0:aa1e012ec210 | 1075 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 1076 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 1077 | rq.ocf = OCF_LE_RECEIVER_TEST; |
ostapsky | 0:aa1e012ec210 | 1078 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 1079 | rq.clen = LE_RECEIVER_TEST_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 1080 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 1081 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 1082 | |
ostapsky | 0:aa1e012ec210 | 1083 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 1084 | return -1; |
ostapsky | 0:aa1e012ec210 | 1085 | } |
ostapsky | 0:aa1e012ec210 | 1086 | |
ostapsky | 0:aa1e012ec210 | 1087 | if (status) { |
ostapsky | 0:aa1e012ec210 | 1088 | return -1; |
ostapsky | 0:aa1e012ec210 | 1089 | } |
ostapsky | 0:aa1e012ec210 | 1090 | |
ostapsky | 0:aa1e012ec210 | 1091 | return 0; |
ostapsky | 0:aa1e012ec210 | 1092 | } |
ostapsky | 0:aa1e012ec210 | 1093 | |
ostapsky | 0:aa1e012ec210 | 1094 | int hci_le_transmitter_test(uint8_t frequency, uint8_t length, uint8_t payload) |
ostapsky | 0:aa1e012ec210 | 1095 | { |
ostapsky | 0:aa1e012ec210 | 1096 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 1097 | le_transmitter_test_cp params; |
ostapsky | 0:aa1e012ec210 | 1098 | uint8_t status; |
ostapsky | 0:aa1e012ec210 | 1099 | |
ostapsky | 0:aa1e012ec210 | 1100 | params.frequency = frequency; |
ostapsky | 0:aa1e012ec210 | 1101 | params.length = length; |
ostapsky | 0:aa1e012ec210 | 1102 | params.payload = payload; |
ostapsky | 0:aa1e012ec210 | 1103 | |
ostapsky | 0:aa1e012ec210 | 1104 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 1105 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 1106 | rq.ocf = OCF_LE_TRANSMITTER_TEST; |
ostapsky | 0:aa1e012ec210 | 1107 | rq.cparam = ¶ms; |
ostapsky | 0:aa1e012ec210 | 1108 | rq.clen = LE_TRANSMITTER_TEST_CP_SIZE; |
ostapsky | 0:aa1e012ec210 | 1109 | rq.rparam = &status; |
ostapsky | 0:aa1e012ec210 | 1110 | rq.rlen = 1; |
ostapsky | 0:aa1e012ec210 | 1111 | |
ostapsky | 0:aa1e012ec210 | 1112 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 1113 | return -1; |
ostapsky | 0:aa1e012ec210 | 1114 | } |
ostapsky | 0:aa1e012ec210 | 1115 | |
ostapsky | 0:aa1e012ec210 | 1116 | if (status) { |
ostapsky | 0:aa1e012ec210 | 1117 | return -1; |
ostapsky | 0:aa1e012ec210 | 1118 | } |
ostapsky | 0:aa1e012ec210 | 1119 | |
ostapsky | 0:aa1e012ec210 | 1120 | return 0; |
ostapsky | 0:aa1e012ec210 | 1121 | } |
ostapsky | 0:aa1e012ec210 | 1122 | |
ostapsky | 0:aa1e012ec210 | 1123 | int hci_le_test_end(uint16_t *num_pkts) |
ostapsky | 0:aa1e012ec210 | 1124 | { |
ostapsky | 0:aa1e012ec210 | 1125 | struct hci_request rq; |
ostapsky | 0:aa1e012ec210 | 1126 | le_test_end_rp resp; |
ostapsky | 0:aa1e012ec210 | 1127 | |
ostapsky | 0:aa1e012ec210 | 1128 | Osal_MemSet(&resp, 0, sizeof(resp)); |
ostapsky | 0:aa1e012ec210 | 1129 | |
ostapsky | 0:aa1e012ec210 | 1130 | Osal_MemSet(&rq, 0, sizeof(rq)); |
ostapsky | 0:aa1e012ec210 | 1131 | rq.ogf = OGF_LE_CTL; |
ostapsky | 0:aa1e012ec210 | 1132 | rq.ocf = OCF_LE_TEST_END; |
ostapsky | 0:aa1e012ec210 | 1133 | rq.rparam = &resp; |
ostapsky | 0:aa1e012ec210 | 1134 | rq.rlen = LE_TEST_END_RP_SIZE; |
ostapsky | 0:aa1e012ec210 | 1135 | |
ostapsky | 0:aa1e012ec210 | 1136 | if (hci_send_req(&rq) < 0){ |
ostapsky | 0:aa1e012ec210 | 1137 | return -1; |
ostapsky | 0:aa1e012ec210 | 1138 | } |
ostapsky | 0:aa1e012ec210 | 1139 | |
ostapsky | 0:aa1e012ec210 | 1140 | if (resp.status) { |
ostapsky | 0:aa1e012ec210 | 1141 | return -1; |
ostapsky | 0:aa1e012ec210 | 1142 | } |
ostapsky | 0:aa1e012ec210 | 1143 | |
ostapsky | 0:aa1e012ec210 | 1144 | *num_pkts = resp.num_pkts; |
ostapsky | 0:aa1e012ec210 | 1145 | |
ostapsky | 0:aa1e012ec210 | 1146 | return 0; |
ostapsky | 0:aa1e012ec210 | 1147 | } |
ostapsky | 0:aa1e012ec210 | 1148 |