PL286/system/bt/bta/gatt/bta_gatts_utils.cc

/******************************************************************************
 *
 *  Copyright (C) 2003-2012 Broadcom Corporation
 *
 *  Licensed under the Apache License, Version 2.0 (the "License");
 *  you may not use this file except in compliance with the License.
 *  You may obtain a copy of the License at:
 *
 *  http://www.apache.org/licenses/LICENSE-2.0
 *
 *  Unless required by applicable law or agreed to in writing, software
 *  distributed under the License is distributed on an "AS IS" BASIS,
 *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 *  See the License for the specific language governing permissions and
 *  limitations under the License.
 *
 ******************************************************************************/

/******************************************************************************
 *
 *  This file contains the GATT client utility function.
 *
 ******************************************************************************/

#include "bt_target.h"

#include <string.h>

#include "bt_common.h"
#include "bta_gatts_int.h"
#include "bta_sys.h"
#include "utl.h"

static const uint8_t base_uuid[LEN_UUID_128] = {
    0xFB, 0x34, 0x9B, 0x5F, 0x80, 0x00, 0x00, 0x80,
    0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};

/*******************************************************************************
 *
 * Function         bta_gatt_convert_uuid16_to_uuid128
 *
 * Description      Convert a 16 bits UUID to be an standard 128 bits one.
 *
 * Returns          true if two uuid match; false otherwise.
 *
 ******************************************************************************/
static void bta_gatt_convert_uuid16_to_uuid128(uint8_t uuid_128[LEN_UUID_128],
                                               uint16_t uuid_16) {
  uint8_t* p = &uuid_128[LEN_UUID_128 - 4];

  memcpy(uuid_128, base_uuid, LEN_UUID_128);

  UINT16_TO_STREAM(p, uuid_16);
}
/*******************************************************************************
 *
 * Function         bta_gatts_alloc_srvc_cb
 *
 * Description      allocate a service control block.
 *
 * Returns          pointer to the control block, or otherwise NULL when failed.
 *
 ******************************************************************************/
uint8_t bta_gatts_alloc_srvc_cb(tBTA_GATTS_CB* p_cb, uint8_t rcb_idx) {
  uint8_t i;

  for (i = 0; i < BTA_GATTS_MAX_SRVC_NUM; i++) {
    if (!p_cb->srvc_cb[i].in_use) {
      p_cb->srvc_cb[i].in_use = true;
      p_cb->srvc_cb[i].rcb_idx = rcb_idx;
      return i;
    }
  }
  return BTA_GATTS_INVALID_APP;
}

/*******************************************************************************
 *
 * Function         bta_gatts_find_app_rcb_by_app_if
 *
 * Description      find the index of the application control block by app ID.
 *
 * Returns          pointer to the control block if success, otherwise NULL
 *
 ******************************************************************************/
tBTA_GATTS_RCB* bta_gatts_find_app_rcb_by_app_if(tBTA_GATTS_IF server_if) {
  uint8_t i;
  tBTA_GATTS_RCB* p_reg;

  for (i = 0, p_reg = bta_gatts_cb.rcb; i < BTA_GATTS_MAX_APP_NUM;
       i++, p_reg++) {
    if (p_reg->in_use && p_reg->gatt_if == server_if) return p_reg;
  }
  return NULL;
}

/*******************************************************************************
 *
 * Function         bta_gatts_find_app_rcb_idx_by_app_if
 *
 * Description      find the index of the application control block by app ID.
 *
 * Returns          index of the control block, or BTA_GATTS_INVALID_APP if
 *                  failed.
 *
 ******************************************************************************/

uint8_t bta_gatts_find_app_rcb_idx_by_app_if(tBTA_GATTS_CB* p_cb,
                                             tBTA_GATTS_IF server_if) {
  uint8_t i;

  for (i = 0; i < BTA_GATTS_MAX_APP_NUM; i++) {
    if (p_cb->rcb[i].in_use && p_cb->rcb[i].gatt_if == server_if) return i;
  }
  return BTA_GATTS_INVALID_APP;
}
/*******************************************************************************
 *
 * Function         bta_gatts_find_srvc_cb_by_srvc_id
 *
 * Description      find the service control block by service ID.
 *
 * Returns          pointer to the rcb.
 *
 ******************************************************************************/
tBTA_GATTS_SRVC_CB* bta_gatts_find_srvc_cb_by_srvc_id(tBTA_GATTS_CB* p_cb,
                                                      uint16_t service_id) {
  uint8_t i;
  APPL_TRACE_DEBUG("bta_gatts_find_srvc_cb_by_srvc_id  service_id=%d",
                   service_id);
  for (i = 0; i < BTA_GATTS_MAX_SRVC_NUM; i++) {
    if (p_cb->srvc_cb[i].in_use && p_cb->srvc_cb[i].service_id == service_id) {
      APPL_TRACE_DEBUG(
          "bta_gatts_find_srvc_cb_by_srvc_id  found service cb index =%d", i);
      return &p_cb->srvc_cb[i];
    }
  }
  return NULL;
}
/*******************************************************************************
 *
 * Function         bta_gatts_find_srvc_cb_by_attr_id
 *
 * Description      find the service control block by attribute ID.
 *
 * Returns          pointer to the rcb.
 *
 ******************************************************************************/
tBTA_GATTS_SRVC_CB* bta_gatts_find_srvc_cb_by_attr_id(tBTA_GATTS_CB* p_cb,
                                                      uint16_t attr_id) {
  uint8_t i;

  for (i = 0; i < (BTA_GATTS_MAX_SRVC_NUM); i++) {
    if (/* middle service */
        (i < (BTA_GATTS_MAX_SRVC_NUM - 1) && p_cb->srvc_cb[i].in_use &&
         p_cb->srvc_cb[i + 1].in_use &&
         attr_id >= p_cb->srvc_cb[i].service_id &&
         attr_id < p_cb->srvc_cb[i + 1].service_id) ||
        /* last active service */
        (i < (BTA_GATTS_MAX_SRVC_NUM - 1) && p_cb->srvc_cb[i].in_use &&
         !p_cb->srvc_cb[i + 1].in_use &&
         attr_id >= p_cb->srvc_cb[i].service_id) ||
        /* last service incb */
        (i == (BTA_GATTS_MAX_SRVC_NUM - 1) &&
         attr_id >= p_cb->srvc_cb[i].service_id)) {
      return &p_cb->srvc_cb[i];
    }
  }
  return NULL;
}
/*******************************************************************************
 *
 * Function         bta_gatts_uuid_compare
 *
 * Description      Compare two UUID to see if they are the same.
 *
 * Returns          true if two uuid match; false otherwise.
 *
 ******************************************************************************/
bool bta_gatts_uuid_compare(tBT_UUID tar, tBT_UUID src) {
  uint8_t su[LEN_UUID_128], tu[LEN_UUID_128];
  uint8_t *ps, *pt;

  /* any of the UUID is unspecified */
  if (src.len == 0 || tar.len == 0) {
    return true;
  }

  /* If both are 16-bit, we can do a simple compare */
  if (src.len == 2 && tar.len == 2) {
    return src.uu.uuid16 == tar.uu.uuid16;
  }

  /* One or both of the UUIDs is 128-bit */
  if (src.len == LEN_UUID_16) {
    /* convert a 16 bits UUID to 128 bits value */
    bta_gatt_convert_uuid16_to_uuid128(su, src.uu.uuid16);
    ps = su;
  } else
    ps = src.uu.uuid128;

  if (tar.len == LEN_UUID_16) {
    /* convert a 16 bits UUID to 128 bits value */
    bta_gatt_convert_uuid16_to_uuid128(tu, tar.uu.uuid16);
    pt = tu;
  } else
    pt = tar.uu.uuid128;

  return (memcmp(ps, pt, LEN_UUID_128) == 0);
}