Previous version which works for my stm32f401 Nucleo board

Fork of X_NUCLEO_IDB0XA1 by ST

Revision:
103:12684d94c3a6
Parent:
102:a6f233cb1fed
Child:
105:332f93cd06b7
--- a/BlueNRG_HCI/hci/hci.c	Mon Jul 27 11:16:16 2015 +0200
+++ b/BlueNRG_HCI/hci/hci.c	Mon Jul 27 11:39:32 2015 +0200
@@ -1,6 +1,6 @@
 /**
   ******************************************************************************
-  * @file    hci.c 
+  * @file    hci.c
   * @author  AMS/HESA Application Team
   * @brief   Function for managing HCI interface.
   ******************************************************************************
@@ -14,7 +14,7 @@
   * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
   *
   * <h2><center>&copy; COPYRIGHT 2013 STMicroelectronics</center></h2>
-  */ 
+  */
 
 #include "hal_types.h"
 #include "osal.h"
@@ -50,23 +50,23 @@
 
 void hci_timeout_callback(void)
 {
-  hci_timeout = 1;
-  return;
+    hci_timeout = 1;
+    return;
 }
 
 void HCI_Init(void)
 {
-  uint8_t index;
-  
-  /* Initialize list heads of ready and free hci data packet queues */
-  list_init_head (&hciReadPktPool);
-  list_init_head (&hciReadPktRxQueue);
-  
-  /* Initialize the queue of free hci data packets */
-  for (index = 0; index < HCI_READ_PACKET_NUM_MAX; index++)
-  {
-    list_insert_tail(&hciReadPktPool, (tListNode *)&hciReadPacketBuffer[index]);
-  }
+    uint8_t index;
+
+    /* Initialize list heads of ready and free hci data packet queues */
+    list_init_head (&hciReadPktPool);
+    list_init_head (&hciReadPktRxQueue);
+
+    /* Initialize the queue of free hci data packets */
+    for (index = 0; index < HCI_READ_PACKET_NUM_MAX; index++)
+    {
+        list_insert_tail(&hciReadPktPool, (tListNode *)&hciReadPacketBuffer[index]);
+    }
 }
 
 #define HCI_PCK_TYPE_OFFSET                 0
@@ -80,1068 +80,1068 @@
  */
 int HCI_verify(const tHciDataPacket * hciReadPacket)
 {
-  const uint8_t *hci_pckt = hciReadPacket->dataBuff;
-  
-  if(hci_pckt[HCI_PCK_TYPE_OFFSET] != HCI_EVENT_PKT)
-    return 1;  /* Incorrect type. */
-  
-  if(hci_pckt[EVENT_PARAMETER_TOT_LEN_OFFSET] != hciReadPacket->data_len - (1+HCI_EVENT_HDR_SIZE))
-    return 2; /* Wrong length (packet truncated or too long). */
-  
-  return 0;      
+    const uint8_t *hci_pckt = hciReadPacket->dataBuff;
+
+    if(hci_pckt[HCI_PCK_TYPE_OFFSET] != HCI_EVENT_PKT)
+        return 1;  /* Incorrect type. */
+
+    if(hci_pckt[EVENT_PARAMETER_TOT_LEN_OFFSET] != hciReadPacket->data_len - (1+HCI_EVENT_HDR_SIZE))
+        return 2; /* Wrong length (packet truncated or too long). */
+
+    return 0;
 }
 
 void HCI_Process(void)
 {
-  uint8_t data_len;
-  uint8_t buffer[HCI_READ_PACKET_SIZE];
-  tHciDataPacket * hciReadPacket = NULL;
-  
-  Disable_SPI_IRQ();
-  uint8_t list_empty = list_is_empty(&hciReadPktRxQueue);        
-  /* process any pending events read */
-  while(list_empty == FALSE)
-  {
-    list_remove_head (&hciReadPktRxQueue, (tListNode **)&hciReadPacket);
-    Enable_SPI_IRQ();
-    HCI_Event_CB(hciReadPacket->dataBuff);
+    uint8_t data_len;
+    uint8_t buffer[HCI_READ_PACKET_SIZE];
+    tHciDataPacket * hciReadPacket = NULL;
+
     Disable_SPI_IRQ();
-    list_insert_tail(&hciReadPktPool, (tListNode *)hciReadPacket);
-    list_empty = list_is_empty(&hciReadPktRxQueue);
-  }
-  if (readPacketListFull) {
-    while(BlueNRG_DataPresent()) {
-      data_len = BlueNRG_SPI_Read_All(buffer, HCI_READ_PACKET_SIZE);
-      if(data_len > 0)
-        HCI_Event_CB(buffer);
+    uint8_t list_empty = list_is_empty(&hciReadPktRxQueue);
+    /* process any pending events read */
+    while(list_empty == FALSE)
+    {
+        list_remove_head (&hciReadPktRxQueue, (tListNode **)&hciReadPacket);
+        Enable_SPI_IRQ();
+        HCI_Event_CB(hciReadPacket->dataBuff);
+        Disable_SPI_IRQ();
+        list_insert_tail(&hciReadPktPool, (tListNode *)hciReadPacket);
+        list_empty = list_is_empty(&hciReadPktRxQueue);
     }
-    readPacketListFull = FALSE;
-  }
-  
-  Enable_SPI_IRQ();    
+    if (readPacketListFull) {
+        while(BlueNRG_DataPresent()) {
+            data_len = BlueNRG_SPI_Read_All(buffer, HCI_READ_PACKET_SIZE);
+            if(data_len > 0)
+                HCI_Event_CB(buffer);
+        }
+        readPacketListFull = FALSE;
+    }
+
+    Enable_SPI_IRQ();
 }
 
 BOOL HCI_Queue_Empty(void)
 {
-  return list_is_empty(&hciReadPktRxQueue);
+    return list_is_empty(&hciReadPktRxQueue);
 }
 
 void HCI_Isr(void)
 {
-  tHciDataPacket * hciReadPacket = NULL;
-  uint8_t data_len;
-  
-  Clear_SPI_EXTI_Flag();
-  while(BlueNRG_DataPresent()){        
-    if (list_is_empty (&hciReadPktPool) == FALSE){
-      
-      /* enqueueing a packet for read */
-      list_remove_head (&hciReadPktPool, (tListNode **)&hciReadPacket);
-      
-      data_len = BlueNRG_SPI_Read_All(hciReadPacket->dataBuff, HCI_READ_PACKET_SIZE);
-      if(data_len > 0){                    
-        hciReadPacket->data_len = data_len;
-        if(HCI_verify(hciReadPacket) == 0)
-          list_insert_tail(&hciReadPktRxQueue, (tListNode *)hciReadPacket);
-        else
-          list_insert_head(&hciReadPktPool, (tListNode *)hciReadPacket);          
-      }
-      else {
-        // Insert the packet back into the pool.
-        list_insert_head(&hciReadPktPool, (tListNode *)hciReadPacket);
-      }
-      
+    tHciDataPacket * hciReadPacket = NULL;
+    uint8_t data_len;
+
+    Clear_SPI_EXTI_Flag();
+    while(BlueNRG_DataPresent()){
+        if (list_is_empty (&hciReadPktPool) == FALSE){
+
+            /* enqueueing a packet for read */
+            list_remove_head (&hciReadPktPool, (tListNode **)&hciReadPacket);
+
+            data_len = BlueNRG_SPI_Read_All(hciReadPacket->dataBuff, HCI_READ_PACKET_SIZE);
+            if(data_len > 0){
+                hciReadPacket->data_len = data_len;
+                if(HCI_verify(hciReadPacket) == 0)
+                    list_insert_tail(&hciReadPktRxQueue, (tListNode *)hciReadPacket);
+                else
+                    list_insert_head(&hciReadPktPool, (tListNode *)hciReadPacket);
+            }
+            else {
+                // Insert the packet back into the pool.
+                list_insert_head(&hciReadPktPool, (tListNode *)hciReadPacket);
+            }
+
+        }
+        else{
+            // HCI Read Packet Pool is empty, wait for a free packet.
+            readPacketListFull = TRUE;
+            Clear_SPI_EXTI_Flag();
+            return;
+        }
+
+        Clear_SPI_EXTI_Flag();
     }
-    else{
-      // HCI Read Packet Pool is empty, wait for a free packet.
-      readPacketListFull = TRUE;
-      Clear_SPI_EXTI_Flag();
-      return;
-    }
-    
-    Clear_SPI_EXTI_Flag();
-  }
 }
 
 void hci_write(const void* data1, const void* data2, uint8_t n_bytes1, uint8_t n_bytes2){
 #if  HCI_LOG_ON
-  PRINTF("HCI <- ");
-  for(int i=0; i < n_bytes1; i++)
-    PRINTF("%02X ", *((uint8_t*)data1 + i));
-  for(int i=0; i < n_bytes2; i++)
-    PRINTF("%02X ", *((uint8_t*)data2 + i));
-  PRINTF("\n");    
+    PRINTF("HCI <- ");
+    for(int i=0; i < n_bytes1; i++)
+        PRINTF("%02X ", *((uint8_t*)data1 + i));
+    for(int i=0; i < n_bytes2; i++)
+        PRINTF("%02X ", *((uint8_t*)data2 + i));
+    PRINTF("\n");
 #endif
-  
-  Hal_Write_Serial(data1, data2, n_bytes1, n_bytes2);
+
+    Hal_Write_Serial(data1, data2, n_bytes1, n_bytes2);
 }
 
 void hci_send_cmd(uint16_t ogf, uint16_t ocf, uint8_t plen, void *param)
 {
-  hci_command_hdr hc;
-  
-  hc.opcode = htobs(cmd_opcode_pack(ogf, ocf));
-  hc.plen= plen;
-  
-  uint8_t header[HCI_HDR_SIZE + HCI_COMMAND_HDR_SIZE];
-  header[0] = HCI_COMMAND_PKT;
-  Osal_MemCpy(header+1, &hc, sizeof(hc));
-  
-  hci_write(header, param, sizeof(header), plen);
+    hci_command_hdr hc;
+
+    hc.opcode = htobs(cmd_opcode_pack(ogf, ocf));
+    hc.plen= plen;
+
+    uint8_t header[HCI_HDR_SIZE + HCI_COMMAND_HDR_SIZE];
+    header[0] = HCI_COMMAND_PKT;
+    Osal_MemCpy(header+1, &hc, sizeof(hc));
+
+    hci_write(header, param, sizeof(header), plen);
 }
 
 static void move_list(tListNode * dest_list, tListNode * src_list)
 {
-  pListNode tmp_node;
-  
-  while(!list_is_empty(src_list)){
-    list_remove_head(src_list, &tmp_node);
-    list_insert_tail(dest_list, tmp_node);
-  }
+    pListNode tmp_node;
+
+    while(!list_is_empty(src_list)){
+        list_remove_head(src_list, &tmp_node);
+        list_insert_tail(dest_list, tmp_node);
+    }
 }
 
 int hci_send_req(struct hci_request *r, BOOL async)
 {
-  uint8_t *ptr;
-  uint16_t opcode = htobs(cmd_opcode_pack(r->ogf, r->ocf));
-  hci_event_pckt *event_pckt;
-  hci_uart_pckt *hci_hdr;
-  int to = DEFAULT_TIMEOUT;
-  struct timer t;
-  tHciDataPacket * hciReadPacket = NULL;
-  tListNode hciTempQueue;
-  
-  list_init_head(&hciTempQueue);
-  
-  hci_send_cmd(r->ogf, r->ocf, r->clen, r->cparam);
-  
-  if(async){
-    goto done;
-  }
-  
-  /* Minimum timeout is 1. */
-  if(to == 0)
-    to = 1;
-  
-  Timer_Set(&t, to);
-  
-  while(1) {
-    evt_cmd_complete *cc;
-    evt_cmd_status *cs;
-    evt_le_meta_event *me;
-    int len;
-      
+    uint8_t *ptr;
+    uint16_t opcode = htobs(cmd_opcode_pack(r->ogf, r->ocf));
+    hci_event_pckt *event_pckt;
+    hci_uart_pckt *hci_hdr;
+    int to = DEFAULT_TIMEOUT;
+    struct timer t;
+    tHciDataPacket * hciReadPacket = NULL;
+    tListNode hciTempQueue;
+
+    list_init_head(&hciTempQueue);
+
+    hci_send_cmd(r->ogf, r->ocf, r->clen, r->cparam);
+
+    if(async){
+        goto done;
+    }
+
+    /* Minimum timeout is 1. */
+    if(to == 0)
+        to = 1;
+
+    Timer_Set(&t, to);
+
+    while(1) {
+        evt_cmd_complete *cc;
+        evt_cmd_status *cs;
+        evt_le_meta_event *me;
+        int len;
+
 #if ENABLE_MICRO_SLEEP    
-    while(1){
-      ATOMIC_SECTION_BEGIN();
-      if(Timer_Expired(&t)){
-        ATOMIC_SECTION_END();
-        goto failed;
-      }
-      if(!HCI_Queue_Empty()){
-        ATOMIC_SECTION_END();
-        break;
-      }
-      Enter_Sleep_Mode();
-      ATOMIC_SECTION_END();
-    }
+        while(1){
+            ATOMIC_SECTION_BEGIN();
+            if(Timer_Expired(&t)){
+                ATOMIC_SECTION_END();
+                goto failed;
+            }
+            if(!HCI_Queue_Empty()){
+                ATOMIC_SECTION_END();
+                break;
+            }
+            Enter_Sleep_Mode();
+            ATOMIC_SECTION_END();
+        }
 #else
-    while(1){
-      if(Timer_Expired(&t)){
-        goto failed;
-      }
-      if(!HCI_Queue_Empty()){
-        break;
-      }
-    }
+        while(1){
+            if(Timer_Expired(&t)){
+                goto failed;
+            }
+            if(!HCI_Queue_Empty()){
+                break;
+            }
+        }
 #endif
-    
-    /* Extract packet from HCI event queue. */
-    Disable_SPI_IRQ();
-    list_remove_head(&hciReadPktRxQueue, (tListNode **)&hciReadPacket);    
-    
-    hci_hdr = (void *)hciReadPacket->dataBuff;
-    if(hci_hdr->type != HCI_EVENT_PKT){
-      list_insert_tail(&hciTempQueue, (tListNode *)hciReadPacket); // See comment below
-      Enable_SPI_IRQ();
-      continue;
-    }
-    
-    event_pckt = (void *) (hci_hdr->data);
-    
-    ptr = hciReadPacket->dataBuff + (1 + HCI_EVENT_HDR_SIZE);
-    len = hciReadPacket->data_len - (1 + HCI_EVENT_HDR_SIZE);
-    
-    switch (event_pckt->evt) {
-      
-    case EVT_CMD_STATUS:
-      cs = (void *) ptr;
-      
-      if (cs->opcode != opcode)
-        goto failed;
-      
-      if (r->event != EVT_CMD_STATUS) {
-        if (cs->status) {
-          goto failed;
+
+        /* Extract packet from HCI event queue. */
+        Disable_SPI_IRQ();
+        list_remove_head(&hciReadPktRxQueue, (tListNode **)&hciReadPacket);
+
+        hci_hdr = (void *)hciReadPacket->dataBuff;
+        if(hci_hdr->type != HCI_EVENT_PKT){
+            list_insert_tail(&hciTempQueue, (tListNode *)hciReadPacket); // See comment below
+            Enable_SPI_IRQ();
+            continue;
         }
-        break;
-      }
-      
-      r->rlen = MIN(len, r->rlen);
-      Osal_MemCpy(r->rparam, ptr, r->rlen);
-      goto done;
-      
-    case EVT_CMD_COMPLETE:
-      cc = (void *) ptr;
-      
-      if (cc->opcode != opcode)
-        goto failed;
-      
-      ptr += EVT_CMD_COMPLETE_SIZE;
-      len -= EVT_CMD_COMPLETE_SIZE;
-      
-      r->rlen = MIN(len, r->rlen);
-      Osal_MemCpy(r->rparam, ptr, r->rlen);
-      goto done;
-      
-    case EVT_LE_META_EVENT:
-      me = (void *) ptr;
-      
-      if (me->subevent != r->event)
-        break;
-      
-      len -= 1;
-      r->rlen = MIN(len, r->rlen);
-      Osal_MemCpy(r->rparam, me->data, r->rlen);
-      goto done;
-      
-    case EVT_HARDWARE_ERROR:            
-      goto failed;
-      
-    default:      
-      break;
-    }
-    
-    /* In the meantime there could be other events from the controller.
+
+        event_pckt = (void *) (hci_hdr->data);
+
+        ptr = hciReadPacket->dataBuff + (1 + HCI_EVENT_HDR_SIZE);
+        len = hciReadPacket->data_len - (1 + HCI_EVENT_HDR_SIZE);
+
+        switch (event_pckt->evt) {
+
+        case EVT_CMD_STATUS:
+            cs = (void *) ptr;
+
+            if (cs->opcode != opcode)
+                goto failed;
+
+            if (r->event != EVT_CMD_STATUS) {
+                if (cs->status) {
+                    goto failed;
+                }
+                break;
+            }
+
+            r->rlen = MIN(len, r->rlen);
+            Osal_MemCpy(r->rparam, ptr, r->rlen);
+            goto done;
+
+        case EVT_CMD_COMPLETE:
+            cc = (void *) ptr;
+
+            if (cc->opcode != opcode)
+                goto failed;
+
+            ptr += EVT_CMD_COMPLETE_SIZE;
+            len -= EVT_CMD_COMPLETE_SIZE;
+
+            r->rlen = MIN(len, r->rlen);
+            Osal_MemCpy(r->rparam, ptr, r->rlen);
+            goto done;
+
+        case EVT_LE_META_EVENT:
+            me = (void *) ptr;
+
+            if (me->subevent != r->event)
+                break;
+
+            len -= 1;
+            r->rlen = MIN(len, r->rlen);
+            Osal_MemCpy(r->rparam, me->data, r->rlen);
+            goto done;
+
+        case EVT_HARDWARE_ERROR:
+            goto failed;
+
+        default:
+            break;
+        }
+
+        /* In the meantime there could be other events from the controller.
     In this case, insert the packet in a different queue. These packets will be
     inserted back in the main queue just before exiting from send_req().
     */
-    list_insert_tail(&hciTempQueue, (tListNode *)hciReadPacket);
-    /* Be sure there is at list one packet in the pool to process the expected event. */
-    if(list_is_empty(&hciReadPktPool)){
-      pListNode tmp_node;      
-      list_remove_head(&hciReadPktRxQueue, &tmp_node);
-      list_insert_tail(&hciReadPktPool, tmp_node);      
+        list_insert_tail(&hciTempQueue, (tListNode *)hciReadPacket);
+        /* Be sure there is at list one packet in the pool to process the expected event. */
+        if(list_is_empty(&hciReadPktPool)){
+            pListNode tmp_node;
+            list_remove_head(&hciReadPktRxQueue, &tmp_node);
+            list_insert_tail(&hciReadPktPool, tmp_node);
+        }
+
+        Enable_SPI_IRQ();
+
     }
-    
+
+failed: 
+    move_list(&hciReadPktRxQueue, &hciTempQueue);
     Enable_SPI_IRQ();
-    
-  }
-  
-failed: 
-  move_list(&hciReadPktRxQueue, &hciTempQueue);  
-  Enable_SPI_IRQ();
-  return -1;
-  
+    return -1;
+
 done:
-  // Insert the packet back into the pool.
-  list_insert_head(&hciReadPktPool, (tListNode *)hciReadPacket); 
-  move_list(&hciReadPktRxQueue, &hciTempQueue);
-  
-  Enable_SPI_IRQ();
-  return 0;
+    // Insert the packet back into the pool.
+    list_insert_head(&hciReadPktPool, (tListNode *)hciReadPacket);
+    move_list(&hciReadPktRxQueue, &hciTempQueue);
+
+    Enable_SPI_IRQ();
+    return 0;
 }
 
 int hci_reset()
 {
-  struct hci_request rq;
-  uint8_t status;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_HOST_CTL;
-  rq.ocf = OCF_RESET;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;  
+    struct hci_request rq;
+    uint8_t status;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_HOST_CTL;
+    rq.ocf = OCF_RESET;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_disconnect(uint16_t	handle, uint8_t reason)
 {
-  struct hci_request rq;
-  disconnect_cp cp;
-  uint8_t status;
-  
-  cp.handle = handle;
-  cp.reason = reason;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LINK_CTL;
-  rq.ocf = OCF_DISCONNECT;
-  rq.cparam = &cp;
-  rq.clen = DISCONNECT_CP_SIZE;
-  rq.event = EVT_CMD_STATUS;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;  
+    struct hci_request rq;
+    disconnect_cp cp;
+    uint8_t status;
+
+    cp.handle = handle;
+    cp.reason = reason;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LINK_CTL;
+    rq.ocf = OCF_DISCONNECT;
+    rq.cparam = &cp;
+    rq.clen = DISCONNECT_CP_SIZE;
+    rq.event = EVT_CMD_STATUS;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_le_read_local_version(uint8_t *hci_version, uint16_t *hci_revision, uint8_t *lmp_pal_version, 
                               uint16_t *manufacturer_name, uint16_t *lmp_pal_subversion)
 {
-  struct hci_request rq;
-  read_local_version_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_INFO_PARAM;
-  rq.ocf = OCF_READ_LOCAL_VERSION;
-  rq.cparam = NULL;
-  rq.clen = 0;
-  rq.rparam = &resp;
-  rq.rlen = READ_LOCAL_VERSION_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  
-  *hci_version = resp.hci_version;
-  *hci_revision =  btohs(resp.hci_revision);
-  *lmp_pal_version = resp.lmp_pal_version;
-  *manufacturer_name = btohs(resp.manufacturer_name);
-  *lmp_pal_subversion = btohs(resp.lmp_pal_subversion);
-  
-  return 0;
+    struct hci_request rq;
+    read_local_version_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_INFO_PARAM;
+    rq.ocf = OCF_READ_LOCAL_VERSION;
+    rq.cparam = NULL;
+    rq.clen = 0;
+    rq.rparam = &resp;
+    rq.rlen = READ_LOCAL_VERSION_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+
+    *hci_version = resp.hci_version;
+    *hci_revision =  btohs(resp.hci_revision);
+    *lmp_pal_version = resp.lmp_pal_version;
+    *manufacturer_name = btohs(resp.manufacturer_name);
+    *lmp_pal_subversion = btohs(resp.lmp_pal_subversion);
+
+    return 0;
 }
 
 int hci_le_read_buffer_size(uint16_t *pkt_len, uint8_t *max_pkt)
 {
-  struct hci_request rq;
-  le_read_buffer_size_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_READ_BUFFER_SIZE;
-  rq.cparam = NULL;
-  rq.clen = 0;
-  rq.rparam = &resp;
-  rq.rlen = LE_READ_BUFFER_SIZE_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  *pkt_len = resp.pkt_len;
-  *max_pkt = resp.max_pkt;
-  
-  return 0;
+    struct hci_request rq;
+    le_read_buffer_size_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_READ_BUFFER_SIZE;
+    rq.cparam = NULL;
+    rq.clen = 0;
+    rq.rparam = &resp;
+    rq.rlen = LE_READ_BUFFER_SIZE_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    *pkt_len = resp.pkt_len;
+    *max_pkt = resp.max_pkt;
+
+    return 0;
 }
 
 int hci_le_set_advertising_parameters(uint16_t min_interval, uint16_t max_interval, uint8_t advtype,
                                       uint8_t own_bdaddr_type, uint8_t direct_bdaddr_type, const tBDAddr direct_bdaddr, uint8_t chan_map,
                                       uint8_t filter)
 {
-  struct hci_request rq;
-  le_set_adv_parameters_cp adv_cp;
-  uint8_t status;
-  
-  Osal_MemSet(&adv_cp, 0, sizeof(adv_cp));
-  adv_cp.min_interval = min_interval;
-  adv_cp.max_interval = max_interval;
-  adv_cp.advtype = advtype;
-  adv_cp.own_bdaddr_type = own_bdaddr_type;
-  adv_cp.direct_bdaddr_type = direct_bdaddr_type;
-  Osal_MemCpy(adv_cp.direct_bdaddr,direct_bdaddr,sizeof(adv_cp.direct_bdaddr));
-  adv_cp.chan_map = chan_map;
-  adv_cp.filter = filter;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_SET_ADV_PARAMETERS;
-  rq.cparam = &adv_cp;
-  rq.clen = LE_SET_ADV_PARAMETERS_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;
+    struct hci_request rq;
+    le_set_adv_parameters_cp adv_cp;
+    uint8_t status;
+
+    Osal_MemSet(&adv_cp, 0, sizeof(adv_cp));
+    adv_cp.min_interval = min_interval;
+    adv_cp.max_interval = max_interval;
+    adv_cp.advtype = advtype;
+    adv_cp.own_bdaddr_type = own_bdaddr_type;
+    adv_cp.direct_bdaddr_type = direct_bdaddr_type;
+    Osal_MemCpy(adv_cp.direct_bdaddr,direct_bdaddr,sizeof(adv_cp.direct_bdaddr));
+    adv_cp.chan_map = chan_map;
+    adv_cp.filter = filter;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_SET_ADV_PARAMETERS;
+    rq.cparam = &adv_cp;
+    rq.clen = LE_SET_ADV_PARAMETERS_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_le_set_advertising_data(uint8_t length, const uint8_t data[])
 {
-  struct hci_request rq;
-  le_set_adv_data_cp adv_cp;
-  uint8_t status;
-  
-  Osal_MemSet(&adv_cp, 0, sizeof(adv_cp));
-  adv_cp.length = length;
-  Osal_MemCpy(adv_cp.data, data, MIN(31,length));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_SET_ADV_DATA;
-  rq.cparam = &adv_cp;
-  rq.clen = LE_SET_ADV_DATA_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;
+    struct hci_request rq;
+    le_set_adv_data_cp adv_cp;
+    uint8_t status;
+
+    Osal_MemSet(&adv_cp, 0, sizeof(adv_cp));
+    adv_cp.length = length;
+    Osal_MemCpy(adv_cp.data, data, MIN(31,length));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_SET_ADV_DATA;
+    rq.cparam = &adv_cp;
+    rq.clen = LE_SET_ADV_DATA_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_le_set_advertise_enable(uint8_t enable)
 {
-  struct hci_request rq;
-  le_set_advertise_enable_cp adv_cp;
-  uint8_t status;
-  
-  Osal_MemSet(&adv_cp, 0, sizeof(adv_cp));
-  adv_cp.enable = enable?1:0;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_SET_ADVERTISE_ENABLE;
-  rq.cparam = &adv_cp;
-  rq.clen = LE_SET_ADVERTISE_ENABLE_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;
+    struct hci_request rq;
+    le_set_advertise_enable_cp adv_cp;
+    uint8_t status;
+
+    Osal_MemSet(&adv_cp, 0, sizeof(adv_cp));
+    adv_cp.enable = enable?1:0;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_SET_ADVERTISE_ENABLE;
+    rq.cparam = &adv_cp;
+    rq.clen = LE_SET_ADVERTISE_ENABLE_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_le_set_scan_parameters(uint8_t	type, uint16_t interval,
                                uint16_t window, uint8_t own_bdaddr_type,
                                uint8_t	filter)
 {
-  struct hci_request rq;
-  le_set_scan_parameters_cp scan_cp;
-  uint8_t status;
-  
-  Osal_MemSet(&scan_cp, 0, sizeof(scan_cp));
-  scan_cp.type = type;
-  scan_cp.interval = interval;
-  scan_cp.window = window;
-  scan_cp.own_bdaddr_type = own_bdaddr_type;
-  scan_cp.filter = filter;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_SET_SCAN_PARAMETERS;
-  rq.cparam = &scan_cp;
-  rq.clen = LE_SET_SCAN_PARAMETERS_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;
+    struct hci_request rq;
+    le_set_scan_parameters_cp scan_cp;
+    uint8_t status;
+
+    Osal_MemSet(&scan_cp, 0, sizeof(scan_cp));
+    scan_cp.type = type;
+    scan_cp.interval = interval;
+    scan_cp.window = window;
+    scan_cp.own_bdaddr_type = own_bdaddr_type;
+    scan_cp.filter = filter;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_SET_SCAN_PARAMETERS;
+    rq.cparam = &scan_cp;
+    rq.clen = LE_SET_SCAN_PARAMETERS_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_le_set_scan_enable(uint8_t enable, uint8_t filter_dup)
 {
-  struct hci_request rq;
-  le_set_scan_enable_cp scan_cp;
-  uint8_t status;
-  
-  Osal_MemSet(&scan_cp, 0, sizeof(scan_cp));
-  scan_cp.enable = enable?1:0;
-  scan_cp.filter_dup = filter_dup;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_SET_SCAN_ENABLE;
-  rq.cparam = &scan_cp;
-  rq.clen = LE_SET_SCAN_ENABLE_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;
+    struct hci_request rq;
+    le_set_scan_enable_cp scan_cp;
+    uint8_t status;
+
+    Osal_MemSet(&scan_cp, 0, sizeof(scan_cp));
+    scan_cp.enable = enable?1:0;
+    scan_cp.filter_dup = filter_dup;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_SET_SCAN_ENABLE;
+    rq.cparam = &scan_cp;
+    rq.clen = LE_SET_SCAN_ENABLE_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_le_rand(uint8_t random_number[8])
 {
-  struct hci_request rq;
-  le_rand_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_RAND;
-  rq.cparam = NULL;
-  rq.clen = 0;
-  rq.rparam = &resp;
-  rq.rlen = LE_RAND_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  Osal_MemCpy(random_number, resp.random, 8);
-  
-  return 0;
+    struct hci_request rq;
+    le_rand_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_RAND;
+    rq.cparam = NULL;
+    rq.clen = 0;
+    rq.rparam = &resp;
+    rq.rlen = LE_RAND_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    Osal_MemCpy(random_number, resp.random, 8);
+
+    return 0;
 }
 
 int hci_le_set_scan_resp_data(uint8_t length, const uint8_t data[])
 {
-  struct hci_request rq;
-  le_set_scan_response_data_cp scan_resp_cp;
-  uint8_t status;
-  
-  Osal_MemSet(&scan_resp_cp, 0, sizeof(scan_resp_cp));
-  scan_resp_cp.length = length;
-  Osal_MemCpy(scan_resp_cp.data, data, MIN(31,length));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_SET_SCAN_RESPONSE_DATA;
-  rq.cparam = &scan_resp_cp;
-  rq.clen = LE_SET_SCAN_RESPONSE_DATA_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;
+    struct hci_request rq;
+    le_set_scan_response_data_cp scan_resp_cp;
+    uint8_t status;
+
+    Osal_MemSet(&scan_resp_cp, 0, sizeof(scan_resp_cp));
+    scan_resp_cp.length = length;
+    Osal_MemCpy(scan_resp_cp.data, data, MIN(31,length));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_SET_SCAN_RESPONSE_DATA;
+    rq.cparam = &scan_resp_cp;
+    rq.clen = LE_SET_SCAN_RESPONSE_DATA_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_le_read_advertising_channel_tx_power(int8_t *tx_power_level)
 {
-  struct hci_request rq;
-  le_read_adv_channel_tx_power_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_READ_ADV_CHANNEL_TX_POWER;
-  rq.cparam = NULL;
-  rq.clen = 0;
-  rq.rparam = &resp;
-  rq.rlen = LE_RAND_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  *tx_power_level = resp.level;
-  
-  return 0;
+    struct hci_request rq;
+    le_read_adv_channel_tx_power_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_READ_ADV_CHANNEL_TX_POWER;
+    rq.cparam = NULL;
+    rq.clen = 0;
+    rq.rparam = &resp;
+    rq.rlen = LE_RAND_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    *tx_power_level = resp.level;
+
+    return 0;
 }
 
 int hci_le_set_random_address(tBDAddr bdaddr)
 {
-  struct hci_request rq;
-  le_set_random_address_cp set_rand_addr_cp;
-  uint8_t status;
-  
-  Osal_MemSet(&set_rand_addr_cp, 0, sizeof(set_rand_addr_cp));
-  Osal_MemCpy(set_rand_addr_cp.bdaddr, bdaddr, sizeof(tBDAddr));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_SET_RANDOM_ADDRESS;
-  rq.cparam = &set_rand_addr_cp;
-  rq.clen = LE_SET_RANDOM_ADDRESS_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;
+    struct hci_request rq;
+    le_set_random_address_cp set_rand_addr_cp;
+    uint8_t status;
+
+    Osal_MemSet(&set_rand_addr_cp, 0, sizeof(set_rand_addr_cp));
+    Osal_MemCpy(set_rand_addr_cp.bdaddr, bdaddr, sizeof(tBDAddr));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_SET_RANDOM_ADDRESS;
+    rq.cparam = &set_rand_addr_cp;
+    rq.clen = LE_SET_RANDOM_ADDRESS_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_read_bd_addr(tBDAddr bdaddr)
 {
-  struct hci_request rq;
-  read_bd_addr_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_INFO_PARAM;
-  rq.ocf = OCF_READ_BD_ADDR;
-  rq.cparam = NULL;
-  rq.clen = 0;
-  rq.rparam = &resp;
-  rq.rlen = READ_BD_ADDR_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  Osal_MemCpy(bdaddr, resp.bdaddr, sizeof(tBDAddr));
-  
-  return 0;
+    struct hci_request rq;
+    read_bd_addr_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_INFO_PARAM;
+    rq.ocf = OCF_READ_BD_ADDR;
+    rq.cparam = NULL;
+    rq.clen = 0;
+    rq.rparam = &resp;
+    rq.rlen = READ_BD_ADDR_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    if (resp.status) {
+        return resp.status;
+    }
+    Osal_MemCpy(bdaddr, resp.bdaddr, sizeof(tBDAddr));
+
+    return 0;
 }
 
 int hci_le_create_connection(uint16_t interval,	uint16_t window, uint8_t initiator_filter, uint8_t peer_bdaddr_type,
                              const tBDAddr peer_bdaddr,	uint8_t	own_bdaddr_type, uint16_t min_interval,	uint16_t max_interval,
                              uint16_t latency,	uint16_t supervision_timeout, uint16_t min_ce_length, uint16_t max_ce_length)
 {
-  struct hci_request rq;
-  le_create_connection_cp create_cp;
-  uint8_t status;
-  
-  Osal_MemSet(&create_cp, 0, sizeof(create_cp));
-  create_cp.interval = interval;
-  create_cp.window =  window;
-  create_cp.initiator_filter = initiator_filter;
-  create_cp.peer_bdaddr_type = peer_bdaddr_type;
-  Osal_MemCpy(create_cp.peer_bdaddr, peer_bdaddr, sizeof(tBDAddr));
-  create_cp.own_bdaddr_type = own_bdaddr_type;
-  create_cp.min_interval=min_interval;
-  create_cp.max_interval=max_interval;
-  create_cp.latency = latency;
-  create_cp.supervision_timeout=supervision_timeout;
-  create_cp.min_ce_length=min_ce_length;
-  create_cp.max_ce_length=max_ce_length;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_CREATE_CONN;
-  rq.cparam = &create_cp;
-  rq.clen = LE_CREATE_CONN_CP_SIZE;
-  rq.event = EVT_CMD_STATUS;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return status;
+    struct hci_request rq;
+    le_create_connection_cp create_cp;
+    uint8_t status;
+
+    Osal_MemSet(&create_cp, 0, sizeof(create_cp));
+    create_cp.interval = interval;
+    create_cp.window =  window;
+    create_cp.initiator_filter = initiator_filter;
+    create_cp.peer_bdaddr_type = peer_bdaddr_type;
+    Osal_MemCpy(create_cp.peer_bdaddr, peer_bdaddr, sizeof(tBDAddr));
+    create_cp.own_bdaddr_type = own_bdaddr_type;
+    create_cp.min_interval=min_interval;
+    create_cp.max_interval=max_interval;
+    create_cp.latency = latency;
+    create_cp.supervision_timeout=supervision_timeout;
+    create_cp.min_ce_length=min_ce_length;
+    create_cp.max_ce_length=max_ce_length;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_CREATE_CONN;
+    rq.cparam = &create_cp;
+    rq.clen = LE_CREATE_CONN_CP_SIZE;
+    rq.event = EVT_CMD_STATUS;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return status;
 }
 
 int hci_le_encrypt(uint8_t key[16], uint8_t plaintextData[16], uint8_t encryptedData[16])
 {
-  struct hci_request rq;
-  le_encrypt_cp params;
-  le_encrypt_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemCpy(params.key, key, 16);
-  Osal_MemCpy(params.plaintext, plaintextData, 16);
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_ENCRYPT;
-  rq.cparam = &params;
-  rq.clen = LE_ENCRYPT_CP_SIZE;
-  rq.rparam = &resp;
-  rq.rlen = LE_ENCRYPT_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  Osal_MemCpy(encryptedData, resp.encdata, 16);
-  
-  return 0;
+    struct hci_request rq;
+    le_encrypt_cp params;
+    le_encrypt_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemCpy(params.key, key, 16);
+    Osal_MemCpy(params.plaintext, plaintextData, 16);
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_ENCRYPT;
+    rq.cparam = &params;
+    rq.clen = LE_ENCRYPT_CP_SIZE;
+    rq.rparam = &resp;
+    rq.rlen = LE_ENCRYPT_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    Osal_MemCpy(encryptedData, resp.encdata, 16);
+
+    return 0;
 }
 
 int hci_le_ltk_request_reply(uint8_t key[16])
 {
-  struct hci_request rq;
-  le_ltk_reply_cp params;
-  le_ltk_reply_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  params.handle = 1;
-  Osal_MemCpy(params.key, key, 16);
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_LTK_REPLY;
-  rq.cparam = &params;
-  rq.clen = LE_LTK_REPLY_CP_SIZE;
-  rq.rparam = &resp;
-  rq.rlen = LE_LTK_REPLY_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return resp.status;
+    struct hci_request rq;
+    le_ltk_reply_cp params;
+    le_ltk_reply_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    params.handle = 1;
+    Osal_MemCpy(params.key, key, 16);
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_LTK_REPLY;
+    rq.cparam = &params;
+    rq.clen = LE_LTK_REPLY_CP_SIZE;
+    rq.rparam = &resp;
+    rq.rlen = LE_LTK_REPLY_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return resp.status;
 }
 
 int hci_le_ltk_request_neg_reply()
 {
-  struct hci_request rq;
-  le_ltk_neg_reply_cp params;
-  le_ltk_neg_reply_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  params.handle = 1;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_LTK_NEG_REPLY;
-  rq.cparam = &params;
-  rq.clen = LE_LTK_NEG_REPLY_CP_SIZE;
-  rq.rparam = &resp;
-  rq.rlen = LE_LTK_NEG_REPLY_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0)
-    return BLE_STATUS_TIMEOUT;
-  
-  return resp.status;
+    struct hci_request rq;
+    le_ltk_neg_reply_cp params;
+    le_ltk_neg_reply_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    params.handle = 1;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_LTK_NEG_REPLY;
+    rq.cparam = &params;
+    rq.clen = LE_LTK_NEG_REPLY_CP_SIZE;
+    rq.rparam = &resp;
+    rq.rlen = LE_LTK_NEG_REPLY_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0)
+        return BLE_STATUS_TIMEOUT;
+
+    return resp.status;
 }
 
 int hci_le_read_white_list_size(uint8_t *size)
 {
-  struct hci_request rq;
-  le_read_white_list_size_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_READ_WHITE_LIST_SIZE;
-  rq.rparam = &resp;
-  rq.rlen = LE_READ_WHITE_LIST_SIZE_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  *size = resp.size;
-  
-  return 0;
+    struct hci_request rq;
+    le_read_white_list_size_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_READ_WHITE_LIST_SIZE;
+    rq.rparam = &resp;
+    rq.rlen = LE_READ_WHITE_LIST_SIZE_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    *size = resp.size;
+
+    return 0;
 }
 
 int hci_le_clear_white_list()
 {
-  struct hci_request rq;
-  uint8_t status;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_CLEAR_WHITE_LIST;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  return status;
+    struct hci_request rq;
+    uint8_t status;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_CLEAR_WHITE_LIST;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    return status;
 }
 
 int hci_le_add_device_to_white_list(uint8_t	bdaddr_type, tBDAddr bdaddr)
 {
-  struct hci_request rq;
-  le_add_device_to_white_list_cp params;
-  uint8_t status;
-  
-  params.bdaddr_type = bdaddr_type;
-  Osal_MemCpy(params.bdaddr, bdaddr, 6);
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_ADD_DEVICE_TO_WHITE_LIST;
-  rq.cparam = &params;
-  rq.clen = LE_ADD_DEVICE_TO_WHITE_LIST_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  return status;
+    struct hci_request rq;
+    le_add_device_to_white_list_cp params;
+    uint8_t status;
+
+    params.bdaddr_type = bdaddr_type;
+    Osal_MemCpy(params.bdaddr, bdaddr, 6);
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_ADD_DEVICE_TO_WHITE_LIST;
+    rq.cparam = &params;
+    rq.clen = LE_ADD_DEVICE_TO_WHITE_LIST_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    return status;
 }
 
 int hci_le_remove_device_from_white_list(uint8_t bdaddr_type, tBDAddr bdaddr)
 {
-  struct hci_request rq;
-  le_remove_device_from_white_list_cp params;
-  uint8_t status;
-  
-  params.bdaddr_type = bdaddr_type;
-  Osal_MemCpy(params.bdaddr, bdaddr, 6);
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_REMOVE_DEVICE_FROM_WHITE_LIST;
-  rq.cparam = &params;
-  rq.clen = LE_REMOVE_DEVICE_FROM_WHITE_LIST_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  return status;
+    struct hci_request rq;
+    le_remove_device_from_white_list_cp params;
+    uint8_t status;
+
+    params.bdaddr_type = bdaddr_type;
+    Osal_MemCpy(params.bdaddr, bdaddr, 6);
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_REMOVE_DEVICE_FROM_WHITE_LIST;
+    rq.cparam = &params;
+    rq.clen = LE_REMOVE_DEVICE_FROM_WHITE_LIST_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    return status;
 }
 
 int hci_read_transmit_power_level(uint16_t *conn_handle, uint8_t type, int8_t * tx_level)
 {
-  struct hci_request rq;
-  read_transmit_power_level_cp params;
-  read_transmit_power_level_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  params.handle = *conn_handle;
-  params.type = type;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_HOST_CTL;
-  rq.ocf = OCF_READ_TRANSMIT_POWER_LEVEL;
-  rq.cparam = &params;
-  rq.clen = READ_TRANSMIT_POWER_LEVEL_CP_SIZE;
-  rq.rparam = &resp;
-  rq.rlen = READ_TRANSMIT_POWER_LEVEL_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  *conn_handle = resp.handle;
-  *tx_level = resp.level;
-  
-  return 0;
+    struct hci_request rq;
+    read_transmit_power_level_cp params;
+    read_transmit_power_level_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    params.handle = *conn_handle;
+    params.type = type;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_HOST_CTL;
+    rq.ocf = OCF_READ_TRANSMIT_POWER_LEVEL;
+    rq.cparam = &params;
+    rq.clen = READ_TRANSMIT_POWER_LEVEL_CP_SIZE;
+    rq.rparam = &resp;
+    rq.rlen = READ_TRANSMIT_POWER_LEVEL_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    *conn_handle = resp.handle;
+    *tx_level = resp.level;
+
+    return 0;
 }
 
 int hci_read_rssi(uint16_t *conn_handle, int8_t * rssi)
 {
-  struct hci_request rq;
-  read_rssi_cp params;
-  read_rssi_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  params.handle = *conn_handle;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_STATUS_PARAM;
-  rq.ocf = OCF_READ_RSSI;
-  rq.cparam = &params;
-  rq.clen = READ_RSSI_CP_SIZE;
-  rq.rparam = &resp;
-  rq.rlen = READ_RSSI_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  *conn_handle = resp.handle;
-  *rssi = resp.rssi;
-  
-  return 0;
+    struct hci_request rq;
+    read_rssi_cp params;
+    read_rssi_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    params.handle = *conn_handle;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_STATUS_PARAM;
+    rq.ocf = OCF_READ_RSSI;
+    rq.cparam = &params;
+    rq.clen = READ_RSSI_CP_SIZE;
+    rq.rparam = &resp;
+    rq.rlen = READ_RSSI_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    *conn_handle = resp.handle;
+    *rssi = resp.rssi;
+
+    return 0;
 }
 
 int hci_le_read_local_supported_features(uint8_t *features)
 {
-  struct hci_request rq;
-  le_read_local_supported_features_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_READ_LOCAL_SUPPORTED_FEATURES;
-  rq.rparam = &resp;
-  rq.rlen = LE_READ_LOCAL_SUPPORTED_FEATURES_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  Osal_MemCpy(features, resp.features, sizeof(resp.features));
-  
-  return 0;
+    struct hci_request rq;
+    le_read_local_supported_features_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_READ_LOCAL_SUPPORTED_FEATURES;
+    rq.rparam = &resp;
+    rq.rlen = LE_READ_LOCAL_SUPPORTED_FEATURES_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    Osal_MemCpy(features, resp.features, sizeof(resp.features));
+
+    return 0;
 }
 
 int hci_le_read_channel_map(uint16_t conn_handle, uint8_t ch_map[5])
 {
-  struct hci_request rq;
-  le_read_channel_map_cp params;
-  le_read_channel_map_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  params.handle = conn_handle;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_READ_CHANNEL_MAP;
-  rq.cparam = &params;
-  rq.clen = LE_READ_CHANNEL_MAP_CP_SIZE;
-  rq.rparam = &resp;
-  rq.rlen = LE_READ_CHANNEL_MAP_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  Osal_MemCpy(ch_map, resp.map, 5);
-  
-  return 0;
+    struct hci_request rq;
+    le_read_channel_map_cp params;
+    le_read_channel_map_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    params.handle = conn_handle;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_READ_CHANNEL_MAP;
+    rq.cparam = &params;
+    rq.clen = LE_READ_CHANNEL_MAP_CP_SIZE;
+    rq.rparam = &resp;
+    rq.rlen = LE_READ_CHANNEL_MAP_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    Osal_MemCpy(ch_map, resp.map, 5);
+
+    return 0;
 }
 
 int hci_le_read_supported_states(uint8_t states[8])
 {
-  struct hci_request rq;
-  le_read_supported_states_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_READ_SUPPORTED_STATES;
-  rq.rparam = &resp;
-  rq.rlen = LE_READ_SUPPORTED_STATES_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  Osal_MemCpy(states, resp.states, 8);
-  
-  return 0;
+    struct hci_request rq;
+    le_read_supported_states_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_READ_SUPPORTED_STATES;
+    rq.rparam = &resp;
+    rq.rlen = LE_READ_SUPPORTED_STATES_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    Osal_MemCpy(states, resp.states, 8);
+
+    return 0;
 }
 
 int hci_le_receiver_test(uint8_t frequency)
 {
-  struct hci_request rq;
-  le_receiver_test_cp params;
-  uint8_t status;
-  
-  params.frequency = frequency;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_RECEIVER_TEST;
-  rq.cparam = &params;
-  rq.clen = LE_RECEIVER_TEST_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  return status;
+    struct hci_request rq;
+    le_receiver_test_cp params;
+    uint8_t status;
+
+    params.frequency = frequency;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_RECEIVER_TEST;
+    rq.cparam = &params;
+    rq.clen = LE_RECEIVER_TEST_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    return status;
 }
 
 int hci_le_transmitter_test(uint8_t frequency, uint8_t length, uint8_t payload)
 {
-  struct hci_request rq;
-  le_transmitter_test_cp params;
-  uint8_t status;
-  
-  params.frequency = frequency;
-  params.length = length;
-  params.payload = payload;
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_TRANSMITTER_TEST;
-  rq.cparam = &params;
-  rq.clen = LE_TRANSMITTER_TEST_CP_SIZE;
-  rq.rparam = &status;
-  rq.rlen = 1;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  return status;
+    struct hci_request rq;
+    le_transmitter_test_cp params;
+    uint8_t status;
+
+    params.frequency = frequency;
+    params.length = length;
+    params.payload = payload;
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_TRANSMITTER_TEST;
+    rq.cparam = &params;
+    rq.clen = LE_TRANSMITTER_TEST_CP_SIZE;
+    rq.rparam = &status;
+    rq.rlen = 1;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    return status;
 }
 
 int hci_le_test_end(uint16_t *num_pkts)
 {
-  struct hci_request rq;
-  le_test_end_rp resp;
-  
-  Osal_MemSet(&resp, 0, sizeof(resp));
-  
-  Osal_MemSet(&rq, 0, sizeof(rq));
-  rq.ogf = OGF_LE_CTL;
-  rq.ocf = OCF_LE_TEST_END;
-  rq.rparam = &resp;
-  rq.rlen = LE_TEST_END_RP_SIZE;
-  
-  if (hci_send_req(&rq, FALSE) < 0){
-    return BLE_STATUS_TIMEOUT;
-  }
-  
-  if (resp.status) {
-    return resp.status;
-  }
-  
-  *num_pkts = resp.num_pkts;
-  
-  return 0;
+    struct hci_request rq;
+    le_test_end_rp resp;
+
+    Osal_MemSet(&resp, 0, sizeof(resp));
+
+    Osal_MemSet(&rq, 0, sizeof(rq));
+    rq.ogf = OGF_LE_CTL;
+    rq.ocf = OCF_LE_TEST_END;
+    rq.rparam = &resp;
+    rq.rlen = LE_TEST_END_RP_SIZE;
+
+    if (hci_send_req(&rq, FALSE) < 0){
+        return BLE_STATUS_TIMEOUT;
+    }
+
+    if (resp.status) {
+        return resp.status;
+    }
+
+    *num_pkts = resp.num_pkts;
+
+    return 0;
 }