12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253 |
- /****************************************************************************
- * wireless/bluetooth/bt_gatt.c
- * Generic Attribute Profile handling.
- *
- * Copyright (C) 2018 Gregory Nutt. All rights reserved.
- * Author: Gregory Nutt <gnutt@nuttx.org>
- *
- * Ported from the Intel/Zephyr arduino101_firmware_source-v1.tar package
- * where the code was released with a compatible 3-clause BSD license:
- *
- * Copyright (c) 2016, Intel Corporation
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions are
- * met:
- *
- * 1. Redistributions of source code must retain the above copyright notice,
- * this list of conditions and the following disclaimer.
- *
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- *
- * 3. Neither the name of the copyright holder nor the names of its
- * contributors may be used to endorse or promote products derived from
- * this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
- * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
- * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
- * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
- * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
- * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
- * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS
- * ; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
- * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
- * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
- * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *
- ****************************************************************************/
- /****************************************************************************
- * Included Files
- ****************************************************************************/
- #include <nuttx/config.h>
- #include <stdbool.h>
- #include <string.h>
- #include <errno.h>
- #include <debug.h>
- #include <nuttx/wireless/bluetooth/bt_hci.h>
- #include <nuttx/wireless/bluetooth/bt_core.h>
- #include <nuttx/wireless/bluetooth/bt_buf.h>
- #include <nuttx/wireless/bluetooth/bt_uuid.h>
- #include <nuttx/wireless/bluetooth/bt_gatt.h>
- #include "bt_hcicore.h"
- #include "bt_conn.h"
- #include "bt_keys.h"
- #include "bt_l2cap.h"
- #include "bt_att.h"
- /****************************************************************************
- * Private Types
- ****************************************************************************/
- begin_packed_struct struct gatt_incl_s
- {
- uint16_t start_handle;
- uint16_t end_handle;
- union
- {
- uint16_t uuid16;
- uint8_t uuid[16];
- } u;
- } end_packed_struct;
- begin_packed_struct struct gatt_chrc_s
- {
- uint8_t properties;
- uint16_t value_handle;
- union
- {
- uint16_t uuid16;
- uint8_t uuid[16];
- } u;
- } end_packed_struct;
- struct notify_data_s
- {
- FAR const void *data;
- size_t len;
- uint8_t handle;
- };
- /****************************************************************************
- * Private Data
- ****************************************************************************/
- static FAR const struct bt_gatt_attr_s *g_db = NULL;
- static size_t g_attr_count = 0;
- /****************************************************************************
- * Public Functions
- ****************************************************************************/
- void bt_gatt_register(FAR const struct bt_gatt_attr_s *attrs, size_t count)
- {
- g_db = attrs;
- g_attr_count = count;
- }
- int bt_gatt_attr_read(FAR struct bt_conn_s *conn,
- FAR const struct bt_gatt_attr_s *attr, FAR void *buf,
- uint8_t buf_len, uint16_t offset,
- FAR const void *value, uint8_t value_len)
- {
- uint8_t maxlen;
- uint8_t len;
- if (offset > value_len)
- {
- return -EINVAL;
- }
- len = buf_len;
- maxlen = value_len - offset;
- if (len > maxlen)
- {
- len = maxlen;
- }
- wlinfo("handle 0x%04x offset %u length %u\n", attr->handle, offset, len);
- memcpy(buf, value + offset, len);
- return len;
- }
- int bt_gatt_attr_read_service(FAR struct bt_conn_s *conn,
- FAR const struct bt_gatt_attr_s *attr,
- FAR void *buf, uint8_t len, uint16_t offset)
- {
- FAR struct bt_uuid_s *uuid = attr->user_data;
- if (uuid->type == BT_UUID_16)
- {
- uint16_t uuid16 = BT_HOST2LE16(uuid->u.u16);
- return bt_gatt_attr_read(conn, attr, buf, len, offset, &uuid16,
- sizeof(uuid16));
- }
- return bt_gatt_attr_read(conn, attr, buf, len, offset, uuid->u.u128,
- sizeof(uuid->u.u128));
- }
- int bt_gatt_attr_read_include(FAR struct bt_conn_s *conn,
- FAR const struct bt_gatt_attr_s *attr,
- FAR void *buf, uint8_t len, uint16_t offset)
- {
- FAR struct bt_gatt_include_s *incl = attr->user_data;
- struct gatt_incl_s pdu;
- uint8_t value_len;
- pdu.start_handle = BT_HOST2LE16(incl->start_handle);
- pdu.end_handle = BT_HOST2LE16(incl->end_handle);
- value_len = sizeof(pdu.start_handle) + sizeof(pdu.end_handle);
- if (incl->uuid->type == BT_UUID_16)
- {
- pdu.u.uuid16 = BT_HOST2LE16(incl->uuid->u.u16);
- value_len += sizeof(pdu.u.uuid16);
- }
- else
- {
- memcpy(pdu.u.uuid, incl->uuid->u.u128, sizeof(incl->uuid->u.u128));
- value_len += sizeof(incl->uuid->u.u128);
- }
- return bt_gatt_attr_read(conn, attr, buf, len, offset, &pdu, value_len);
- }
- int bt_gatt_attr_read_chrc(FAR struct bt_conn_s *conn,
- FAR const struct bt_gatt_attr_s *attr,
- FAR void *buf, uint8_t len, uint16_t offset)
- {
- FAR struct bt_gatt_chrc_s *chrc = attr->user_data;
- struct gatt_chrc_s pdu;
- uint8_t value_len;
- pdu.properties = chrc->properties;
- pdu.value_handle = BT_HOST2LE16(chrc->value_handle);
- value_len = sizeof(pdu.properties) + sizeof(pdu.value_handle);
- if (chrc->uuid->type == BT_UUID_16)
- {
- pdu.u.uuid16 = BT_HOST2LE16(chrc->uuid->u.u16);
- value_len += sizeof(pdu.u.uuid16);
- }
- else
- {
- memcpy(pdu.u.uuid, chrc->uuid->u.u128, sizeof(chrc->uuid->u.u128));
- value_len += sizeof(chrc->uuid->u.u128);
- }
- return bt_gatt_attr_read(conn, attr, buf, len, offset, &pdu, value_len);
- }
- void bt_gatt_foreach_attr(uint16_t start_handle, uint16_t end_handle,
- bt_gatt_attr_func_t func, FAR void *user_data)
- {
- size_t i;
- for (i = 0; i < g_attr_count; i++)
- {
- FAR const struct bt_gatt_attr_s *attr = &g_db[i];
- /* Check if attribute handle is within range */
- if (attr->handle < start_handle || attr->handle > end_handle)
- {
- continue;
- }
- if (func(attr, user_data) == BT_GATT_ITER_STOP)
- {
- break;
- }
- }
- }
- int bt_gatt_attr_read_ccc(FAR struct bt_conn_s *conn,
- FAR const struct bt_gatt_attr_s *attr,
- FAR void *buf, uint8_t len, uint16_t offset)
- {
- FAR struct _bt_gatt_ccc_s *ccc = attr->user_data;
- uint16_t value;
- size_t i;
- for (i = 0; i < ccc->cfg_len; i++)
- {
- if (bt_addr_le_cmp(&ccc->cfg[i].peer, &conn->dst))
- {
- continue;
- }
- value = BT_HOST2LE16(ccc->cfg[i].value);
- break;
- }
- /* Default to disable if there is no cfg for the peer */
- if (i == ccc->cfg_len)
- {
- value = 0x0000;
- }
- return bt_gatt_attr_read(conn, attr, buf, len, offset, &value,
- sizeof(value));
- }
- static void gatt_ccc_changed(FAR struct _bt_gatt_ccc_s *ccc)
- {
- uint16_t value = 0x0000;
- int i;
- for (i = 0; i < ccc->cfg_len; i++)
- {
- if (ccc->cfg[i].value > value)
- {
- value = ccc->cfg[i].value;
- }
- }
- wlinfo("ccc %p value 0x%04x\n", ccc, value);
- if (value != ccc->value)
- {
- ccc->value = value;
- ccc->cfg_changed(value);
- }
- }
- int bt_gatt_attr_write_ccc(FAR struct bt_conn_s *conn,
- FAR const struct bt_gatt_attr_s *attr,
- FAR const void *buf, uint8_t len,
- uint16_t offset)
- {
- FAR struct _bt_gatt_ccc_s *ccc = attr->user_data;
- FAR const uint16_t *data = buf;
- bool bonded;
- size_t i;
- if (len != sizeof(*data) || offset)
- {
- return -EINVAL;
- }
- if (bt_keys_get_addr(&conn->dst))
- {
- bonded = true;
- }
- else
- {
- bonded = false;
- }
- for (i = 0; i < ccc->cfg_len; i++)
- {
- /* Check for existing configuration */
- if (!bt_addr_le_cmp(&ccc->cfg[i].peer, &conn->dst))
- {
- break;
- }
- }
- if (i == ccc->cfg_len)
- {
- for (i = 0; i < ccc->cfg_len; i++)
- {
- /* Check for unused configuration */
- if (!ccc->cfg[i].valid)
- {
- bt_addr_le_copy(&ccc->cfg[i].peer, &conn->dst);
- /* Only set valid if bonded */
- ccc->cfg[i].valid = bonded;
- break;
- }
- }
- if (i == ccc->cfg_len)
- {
- wlwarn("No space to store CCC cfg\n");
- return -ENOMEM;
- }
- }
- ccc->cfg[i].value = BT_LE162HOST(*data);
- wlinfo("handle 0x%04x value %u\n", attr->handle, ccc->cfg[i].value);
- /* Update cfg if don't match */
- if (ccc->cfg[i].value != ccc->value)
- {
- gatt_ccc_changed(ccc);
- }
- return len;
- }
- int bt_gatt_attr_read_cep(FAR struct bt_conn_s *conn,
- FAR const struct bt_gatt_attr_s *attr,
- FAR void *buf, uint8_t len, uint16_t offset)
- {
- FAR struct bt_gatt_cep_s *value = attr->user_data;
- uint16_t props = BT_HOST2LE16(value->properties);
- return bt_gatt_attr_read(conn, attr, buf, len, offset, &props,
- sizeof(props));
- }
- static uint8_t notify_cb(FAR const struct bt_gatt_attr_s *attr,
- FAR void *user_data)
- {
- FAR struct notify_data_s *data = user_data;
- const struct bt_uuid_s uuid =
- {
- BT_UUID_16,
- {
- BT_UUID_GATT_CCC
- }
- };
- const struct bt_uuid_s chrc =
- {
- BT_UUID_16,
- {
- BT_UUID_GATT_CHRC
- }
- };
- FAR struct _bt_gatt_ccc_s *ccc;
- size_t i;
- if (bt_uuid_cmp(attr->uuid, &uuid))
- {
- /* Stop if we reach the next characteristic */
- if (!bt_uuid_cmp(attr->uuid, &chrc))
- {
- return BT_GATT_ITER_STOP;
- }
- return BT_GATT_ITER_CONTINUE;
- }
- /* Check attribute user_data must be of type struct _bt_gatt_ccc_s */
- if (attr->write != bt_gatt_attr_write_ccc)
- {
- return BT_GATT_ITER_CONTINUE;
- }
- ccc = attr->user_data;
- /* Notify all peers configured */
- for (i = 0; i < ccc->cfg_len; i++)
- {
- FAR struct bt_conn_s *conn;
- FAR struct bt_buf_s *buf;
- FAR struct bt_att_notify_s *nfy;
- /* TODO: Handle indications */
- if (ccc->value != BT_GATT_CCC_NOTIFY)
- {
- continue;
- }
- conn = bt_conn_lookup_addr_le(&ccc->cfg[i].peer);
- if (!conn || conn->state != BT_CONN_CONNECTED)
- {
- continue;
- }
- buf = bt_att_create_pdu(conn, BT_ATT_OP_NOTIFY,
- sizeof(*nfy) + data->len);
- if (!buf)
- {
- wlwarn("No buffer available to send notification");
- bt_conn_release(conn);
- return BT_GATT_ITER_STOP;
- }
- wlinfo("conn %p handle 0x%04x\n", conn, data->handle);
- nfy = bt_buf_extend(buf, sizeof(*nfy));
- nfy->handle = BT_HOST2LE16(data->handle);
- bt_buf_extend(buf, data->len);
- memcpy(nfy->value, data->data, data->len);
- bt_l2cap_send(conn, BT_L2CAP_CID_ATT, buf);
- bt_conn_release(conn);
- }
- return BT_GATT_ITER_CONTINUE;
- }
- void bt_gatt_notify(uint16_t handle, FAR const void *data, size_t len)
- {
- struct notify_data_s nfy;
- nfy.handle = handle;
- nfy.data = data;
- nfy.len = len;
- bt_gatt_foreach_attr(handle, 0xffff, notify_cb, &nfy);
- }
- static uint8_t connected_cb(FAR const struct bt_gatt_attr_s *attr,
- FAR void *user_data)
- {
- FAR struct bt_conn_s *conn = user_data;
- FAR struct _bt_gatt_ccc_s *ccc;
- size_t i;
- /* Check attribute user_data must be of type struct _bt_gatt_ccc_s */
- if (attr->write != bt_gatt_attr_write_ccc)
- {
- return BT_GATT_ITER_CONTINUE;
- }
- ccc = attr->user_data;
- /* If already enabled skip */
- if (ccc->value)
- {
- return BT_GATT_ITER_CONTINUE;
- }
- for (i = 0; i < ccc->cfg_len; i++)
- {
- /* Ignore configuration for different peer */
- if (bt_addr_le_cmp(&conn->dst, &ccc->cfg[i].peer))
- {
- continue;
- }
- if (ccc->cfg[i].value)
- {
- gatt_ccc_changed(ccc);
- return BT_GATT_ITER_CONTINUE;
- }
- }
- return BT_GATT_ITER_CONTINUE;
- }
- void bt_gatt_connected(FAR struct bt_conn_s *conn)
- {
- wlinfo("conn %p\n", conn);
- bt_gatt_foreach_attr(0x0001, 0xffff, connected_cb, conn);
- }
- static uint8_t disconnected_cb(FAR const struct bt_gatt_attr_s *attr,
- FAR void *user_data)
- {
- FAR struct bt_conn_s *conn = user_data;
- FAR struct _bt_gatt_ccc_s *ccc;
- size_t i;
- /* Check attribute user_data must be of type struct _bt_gatt_ccc_s */
- if (attr->write != bt_gatt_attr_write_ccc)
- {
- return BT_GATT_ITER_CONTINUE;
- }
- ccc = attr->user_data;
- /* If already disabled skip */
- if (!ccc->value)
- {
- return BT_GATT_ITER_CONTINUE;
- }
- for (i = 0; i < ccc->cfg_len; i++)
- {
- /* Ignore configurations with disabled value */
- if (!ccc->cfg[i].value)
- {
- continue;
- }
- if (bt_addr_le_cmp(&conn->dst, &ccc->cfg[i].peer))
- {
- FAR struct bt_conn_s *tmp;
- /* Skip if there is another peer connected */
- tmp = bt_conn_lookup_addr_le(&ccc->cfg[i].peer);
- if (tmp && tmp->state == BT_CONN_CONNECTED)
- {
- bt_conn_release(tmp);
- return BT_GATT_ITER_CONTINUE;
- }
- }
- }
- /* Reset value while disconnected */
- memset(&ccc->value, 0, sizeof(ccc->value));
- ccc->cfg_changed(ccc->value);
- wlinfo("ccc %p reset\n", ccc);
- return BT_GATT_ITER_CONTINUE;
- }
- void bt_gatt_disconnected(FAR struct bt_conn_s *conn)
- {
- wlinfo("conn %p\n", conn);
- bt_gatt_foreach_attr(0x0001, 0xffff, disconnected_cb, conn);
- }
- static void gatt_mtu_rsp(FAR struct bt_conn_s *conn, uint8_t err,
- FAR const void *pdu, uint16_t length,
- FAR void *user_data)
- {
- bt_gatt_rsp_func_t func = user_data;
- func(conn, err);
- }
- static int gatt_send(FAR struct bt_conn_s *conn, FAR struct bt_buf_s *buf,
- bt_att_func_t func, FAR void *user_data,
- bt_att_destroy_t destroy)
- {
- int err;
- err = bt_att_send(conn, buf, func, user_data, destroy);
- if (err)
- {
- wlerr("ERROR: Error sending ATT PDU: %d\n", err);
- bt_buf_release(buf);
- }
- return err;
- }
- int bt_gatt_exchange_mtu(FAR struct bt_conn_s *conn,
- bt_gatt_rsp_func_t func)
- {
- FAR struct bt_att_exchange_mtu_req_s *req;
- FAR struct bt_buf_s *buf;
- uint16_t mtu;
- if (!conn || !func)
- {
- return -EINVAL;
- }
- buf = bt_att_create_pdu(conn, BT_ATT_OP_MTU_REQ, sizeof(*req));
- if (!buf)
- {
- return -ENOMEM;
- }
- /* Select MTU based on the amount of room we have in bt_buf_s including one
- * extra byte for ATT header.
- */
- mtu = bt_buf_tailroom(buf) + 1;
- wlinfo("Client MTU %u\n", mtu);
- req = bt_buf_extend(buf, sizeof(*req));
- req->mtu = BT_HOST2LE16(mtu);
- return gatt_send(conn, buf, gatt_mtu_rsp, func, NULL);
- }
- static void att_find_type_rsp(FAR struct bt_conn_s *conn, uint8_t err,
- FAR const void *pdu, uint16_t length,
- FAR void *user_data)
- {
- FAR const struct bt_att_find_type_rsp_s *rsp = pdu;
- FAR struct bt_gatt_discover_params_s *params = user_data;
- uint16_t end_handle = 0;
- uint16_t start_handle;
- uint8_t i;
- wlinfo("err 0x%02x\n", err);
- if (err)
- {
- goto done;
- }
- /* Parse attributes found */
- for (i = 0; length >= sizeof(rsp->list[i]);
- i++, length -= sizeof(rsp->list[i]))
- {
- FAR const struct bt_gatt_attr_s *attr;
- start_handle = BT_LE162HOST(rsp->list[i].start_handle);
- end_handle = BT_LE162HOST(rsp->list[i].end_handle);
- wlinfo("start_handle 0x%04x end_handle 0x%04x\n", start_handle,
- end_handle);
- attr =
- (&(struct bt_gatt_attr_s)BT_GATT_PRIMARY_SERVICE
- (start_handle, params->uuid));
- if (params->func(attr, params) == BT_GATT_ITER_STOP)
- {
- goto done;
- }
- }
- /* Stop if could not parse the whole PDU */
- if (length > 0)
- {
- goto done;
- }
- /* Stop if over the range or the requests */
- if (end_handle >= params->end_handle)
- {
- goto done;
- }
- /* Continue for the last found handle */
- params->start_handle = end_handle;
- if (!bt_gatt_discover(conn, params))
- {
- return;
- }
- done:
- if (params->destroy)
- {
- params->destroy(params);
- }
- }
- /****************************************************************************
- * Name: bt_gatt_discover
- *
- * Description:
- * This function implements the SIOCBTDISCOVER ioctl command for the
- * GATT discovery.
- *
- ****************************************************************************/
- int bt_gatt_discover(FAR struct bt_conn_s *conn,
- FAR struct bt_gatt_discover_params_s *params)
- {
- FAR struct bt_buf_s *buf;
- FAR struct bt_att_find_type_req_s *req;
- FAR uint16_t *value;
- if (!conn || !params->uuid || !params->func || !params->start_handle ||
- !params->end_handle)
- {
- return -EINVAL;
- }
- buf = bt_att_create_pdu(conn, BT_ATT_OP_FIND_TYPE_REQ, sizeof(*req));
- if (!buf)
- {
- return -ENOMEM;
- }
- req = bt_buf_extend(buf, sizeof(*req));
- req->start_handle = BT_HOST2LE16(params->start_handle);
- req->end_handle = BT_HOST2LE16(params->end_handle);
- req->type = BT_HOST2LE16(BT_UUID_GATT_PRIMARY);
- wlinfo("uuid 0x%04x start_handle 0x%04x end_handle 0x%04x\n",
- params->uuid->u.u16, params->start_handle, params->end_handle);
- switch (params->uuid->type)
- {
- case BT_UUID_16:
- value = bt_buf_extend(buf, sizeof(*value));
- *value = BT_HOST2LE16(params->uuid->u.u16);
- break;
- case BT_UUID_128:
- bt_buf_extend(buf, sizeof(params->uuid->u.u128));
- memcpy(req->value,
- params->uuid->u.u128,
- sizeof(params->uuid->u.u128));
- break;
- default:
- wlerr("ERROR: Unknown UUID type %u\n", params->uuid->type);
- bt_buf_release(buf);
- return -EINVAL;
- }
- return gatt_send(conn, buf, att_find_type_rsp, params, NULL);
- }
- static void att_read_type_rsp(FAR struct bt_conn_s *conn, uint8_t err,
- FAR const void *pdu, uint16_t length,
- FAR void *user_data)
- {
- FAR const struct bt_att_read_type_rsp_s *rsp = pdu;
- FAR struct bt_gatt_discover_params_s *params = user_data;
- struct bt_uuid_s uuid;
- struct bt_gatt_chrc_s value;
- uint16_t handle = 0;
- wlinfo("err 0x%02x\n", err);
- if (err)
- {
- goto done;
- }
- /* Data can be either in UUID16 or UUID128 */
- switch (rsp->len)
- {
- case 7: /* UUID16 */
- uuid.type = BT_UUID_16;
- break;
- case 21: /* UUID128 */
- uuid.type = BT_UUID_128;
- break;
- default:
- wlerr("ERROR: Invalid data len %u\n", rsp->len);
- goto done;
- }
- /* Parse characteristics found */
- for (length--, pdu = rsp->data; length >= rsp->len;
- length -= rsp->len, pdu += rsp->len)
- {
- FAR const struct bt_gatt_attr_s *attr;
- FAR const struct bt_att_data_s *data = pdu;
- FAR struct gatt_chrc_s *chrc = (FAR void *)data->value;
- handle = BT_LE162HOST(data->handle);
- /* Handle 0 is invalid */
- if (!handle)
- {
- goto done;
- }
- /* Convert characteristic data, bt_gatt_chrc and gatt_chrc_s have
- * different formats so the conversion have to be done field by field.
- */
- value.properties = chrc->properties;
- value.value_handle = BT_LE162HOST(chrc->value_handle);
- value.uuid = &uuid;
- switch (uuid.type)
- {
- case BT_UUID_16:
- uuid.u.u16 = BT_LE162HOST(chrc->u.uuid16);
- break;
- case BT_UUID_128:
- memcpy(uuid.u.u128, chrc->u.uuid, sizeof(chrc->u.uuid));
- break;
- }
- wlinfo("handle 0x%04x properties 0x%02x value_handle 0x%04x\n",
- handle, value.properties, value.value_handle);
- /* Skip if UUID is set but doesn't match */
- if (params->uuid && bt_uuid_cmp(&uuid, params->uuid))
- {
- continue;
- }
- attr = (&(struct bt_gatt_attr_s)BT_GATT_CHARACTERISTIC(handle,
- &value));
- if (params->func(attr, params) == BT_GATT_ITER_STOP)
- {
- goto done;
- }
- }
- /* Stop if could not parse the whole PDU */
- if (length > 0)
- {
- goto done;
- }
- /* Next characteristic shall be after current value handle */
- params->start_handle = handle;
- if (params->start_handle < UINT16_MAX)
- {
- params->start_handle++;
- }
- /* Stop if over the requested range */
- if (params->start_handle >= params->end_handle)
- {
- goto done;
- }
- /* Continue to the next range */
- if (!bt_gatt_discover_characteristic(conn, params))
- {
- return;
- }
- done:
- if (params->destroy)
- {
- params->destroy(params);
- }
- }
- /****************************************************************************
- * Name: bt_gatt_discover_characteristic
- *
- * Description:
- * This function implements the SIOCBTDISCOVER ioctl command for the
- * GATT discover characteristics type.
- *
- ****************************************************************************/
- int bt_gatt_discover_characteristic(FAR struct bt_conn_s *conn,
- FAR struct bt_gatt_discover_params_s
- *params)
- {
- FAR struct bt_buf_s *buf;
- FAR struct bt_att_read_type_req_s *req;
- FAR uint16_t *value;
- if (!conn || !params->func || !params->start_handle || !params->end_handle)
- {
- return -EINVAL;
- }
- buf = bt_att_create_pdu(conn, BT_ATT_OP_READ_TYPE_REQ, sizeof(*req));
- if (!buf)
- {
- return -ENOMEM;
- }
- req = bt_buf_extend(buf, sizeof(*req));
- req->start_handle = BT_HOST2LE16(params->start_handle);
- req->end_handle = BT_HOST2LE16(params->end_handle);
- value = bt_buf_extend(buf, sizeof(*value));
- *value = BT_HOST2LE16(BT_UUID_GATT_CHRC);
- wlinfo("start_handle 0x%04x end_handle 0x%04x\n", params->start_handle,
- params->end_handle);
- return gatt_send(conn, buf, att_read_type_rsp, params, NULL);
- }
- static void att_find_info_rsp(FAR struct bt_conn_s *conn, uint8_t err,
- FAR const void *pdu, uint16_t length,
- FAR void *user_data)
- {
- FAR const struct bt_att_find_info_rsp_s *rsp = pdu;
- FAR struct bt_gatt_discover_params_s *params = user_data;
- struct bt_uuid_s uuid;
- uint16_t handle = 0;
- uint8_t len;
- union
- {
- FAR const struct bt_att_info_16_s *i16;
- FAR const struct bt_att_info_128_s *i128;
- } info;
- wlinfo("err 0x%02x\n", err);
- if (err)
- {
- goto done;
- }
- /* Data can be either in UUID16 or UUID128 */
- switch (rsp->format)
- {
- case BT_ATT_INFO_16:
- uuid.type = BT_UUID_16;
- len = sizeof(info.i16);
- break;
- case BT_ATT_INFO_128:
- uuid.type = BT_UUID_128;
- len = sizeof(info.i128);
- break;
- default:
- wlerr("ERROR: Invalid format %u\n", rsp->format);
- goto done;
- }
- /* Parse descriptors found */
- for (length--, pdu = rsp->info; length >= len; length -= len, pdu += len)
- {
- FAR const struct bt_gatt_attr_s *attr;
- info.i16 = pdu;
- handle = BT_LE162HOST(info.i16->handle);
- switch (uuid.type)
- {
- case BT_UUID_16:
- uuid.u.u16 = BT_LE162HOST(info.i16->uuid);
- break;
- case BT_UUID_128:
- memcpy(uuid.u.u128, info.i128->uuid, sizeof(uuid.u.u128));
- break;
- }
- wlinfo("handle 0x%04x\n", handle);
- /* Skip if UUID is set but doesn't match */
- if (params->uuid && bt_uuid_cmp(&uuid, params->uuid))
- {
- continue;
- }
- attr =
- (&(struct bt_gatt_attr_s)BT_GATT_DESCRIPTOR
- (handle, &uuid, 0, NULL, NULL, NULL));
- if (params->func(attr, params) == BT_GATT_ITER_STOP)
- {
- goto done;
- }
- }
- /* Stop if could not parse the whole PDU */
- if (length > 0)
- {
- goto done;
- }
- /* Next characteristic shall be after current value handle */
- params->start_handle = handle;
- if (params->start_handle < UINT16_MAX)
- {
- params->start_handle++;
- }
- /* Stop if over the requested range */
- if (params->start_handle >= params->end_handle)
- {
- goto done;
- }
- /* Continue to the next range */
- if (!bt_gatt_discover_descriptor(conn, params))
- {
- return;
- }
- done:
- if (params->destroy)
- {
- params->destroy(params);
- }
- }
- /****************************************************************************
- * Name: bt_gatt_discover_descriptor
- *
- * Description:
- * This function implements the SIOCBTDISCOVER ioctl command for the
- * GATT discover descriptor type.
- *
- ****************************************************************************/
- int bt_gatt_discover_descriptor(FAR struct bt_conn_s *conn,
- FAR struct bt_gatt_discover_params_s *params)
- {
- FAR struct bt_buf_s *buf;
- FAR struct bt_att_find_info_req_s *req;
- if (!conn || !params->func || !params->start_handle || !params->end_handle)
- {
- return -EINVAL;
- }
- buf = bt_att_create_pdu(conn, BT_ATT_OP_FIND_INFO_REQ, sizeof(*req));
- if (!buf)
- {
- return -ENOMEM;
- }
- req = bt_buf_extend(buf, sizeof(*req));
- req->start_handle = BT_HOST2LE16(params->start_handle);
- req->end_handle = BT_HOST2LE16(params->end_handle);
- wlinfo("start_handle 0x%04x end_handle 0x%04x\n", params->start_handle,
- params->end_handle);
- return gatt_send(conn, buf, att_find_info_rsp, params, NULL);
- }
- static void att_read_rsp(FAR struct bt_conn_s *conn, uint8_t err,
- FAR const void *pdu, uint16_t length,
- FAR void *user_data)
- {
- bt_gatt_read_func_t func = user_data;
- wlinfo("err 0x%02x\n", err);
- if (err)
- {
- func(conn, err, NULL, 0);
- return;
- }
- func(conn, 0, pdu, length);
- }
- static int gatt_read_blob(FAR struct bt_conn_s *conn, uint16_t handle,
- uint16_t offset, bt_gatt_read_func_t func)
- {
- FAR struct bt_buf_s *buf;
- FAR struct bt_att_read_blob_req_s *req;
- buf = bt_att_create_pdu(conn, BT_ATT_OP_READ_BLOB_REQ, sizeof(*req));
- if (!buf)
- {
- return -ENOMEM;
- }
- req = bt_buf_extend(buf, sizeof(*req));
- req->handle = BT_HOST2LE16(handle);
- req->offset = BT_HOST2LE16(offset);
- wlinfo("handle 0x%04x offset 0x%04x\n", handle, offset);
- return gatt_send(conn, buf, att_read_rsp, func, NULL);
- }
- int bt_gatt_read(FAR struct bt_conn_s *conn, uint16_t handle,
- uint16_t offset, bt_gatt_read_func_t func)
- {
- FAR struct bt_buf_s *buf;
- FAR struct bt_att_read_req_s *req;
- if (!conn || !handle || !func)
- {
- return -EINVAL;
- }
- if (offset)
- {
- return gatt_read_blob(conn, handle, offset, func);
- }
- buf = bt_att_create_pdu(conn, BT_ATT_OP_READ_REQ, sizeof(*req));
- if (!buf)
- {
- return -ENOMEM;
- }
- req = bt_buf_extend(buf, sizeof(*req));
- req->handle = BT_HOST2LE16(handle);
- wlinfo("handle 0x%04x\n", handle);
- return gatt_send(conn, buf, att_read_rsp, func, NULL);
- }
- static void att_write_rsp(FAR struct bt_conn_s *conn, uint8_t err,
- FAR const void *pdu, uint16_t length,
- FAR void *user_data)
- {
- bt_gatt_rsp_func_t func = user_data;
- wlinfo("err 0x%02x\n", err);
- func(conn, err);
- }
- static int gatt_write_cmd(FAR struct bt_conn_s *conn, uint16_t handle,
- FAR const void *data, uint16_t length)
- {
- FAR struct bt_buf_s *buf;
- FAR struct bt_att_write_cmd_s *cmd;
- buf = bt_att_create_pdu(conn, BT_ATT_OP_WRITE_CMD, sizeof(*cmd) + length);
- if (!buf)
- {
- return -ENOMEM;
- }
- cmd = bt_buf_extend(buf, sizeof(*cmd));
- cmd->handle = BT_HOST2LE16(handle);
- memcpy(cmd->value, data, length);
- bt_buf_extend(buf, length);
- wlinfo("handle 0x%04x length %u\n", handle, length);
- return gatt_send(conn, buf, NULL, NULL, NULL);
- }
- int bt_gatt_write(FAR struct bt_conn_s *conn, uint16_t handle,
- FAR const void *data, uint16_t length,
- bt_gatt_rsp_func_t func)
- {
- FAR struct bt_buf_s *buf;
- FAR struct bt_att_write_req_s *req;
- if (!conn || !handle)
- {
- return -EINVAL;
- }
- if (!func)
- {
- return gatt_write_cmd(conn, handle, data, length);
- }
- buf = bt_att_create_pdu(conn, BT_ATT_OP_WRITE_REQ, sizeof(*req) + length);
- if (!buf)
- {
- return -ENOMEM;
- }
- req = bt_buf_extend(buf, sizeof(*req));
- req->handle = BT_HOST2LE16(handle);
- memcpy(req->value, data, length);
- bt_buf_extend(buf, length);
- wlinfo("handle 0x%04x length %u\n", handle, length);
- return gatt_send(conn, buf, att_write_rsp, func, NULL);
- }
- void bt_gatt_cancel(FAR struct bt_conn_s *conn)
- {
- bt_att_cancel(conn);
- }
- int bt_gatt_read_multiple(FAR struct bt_conn_s *conn,
- FAR const uint16_t *handles, size_t count,
- bt_gatt_read_func_t func)
- {
- FAR struct bt_buf_s *buf;
- uint8_t i;
- if (!conn && conn->state != BT_CONN_CONNECTED)
- {
- return -ENOTCONN;
- }
- if (!handles || count < 2 || !func)
- {
- return -EINVAL;
- }
- buf = bt_att_create_pdu(conn, BT_ATT_OP_READ_MULT_REQ,
- count * sizeof(*handles));
- if (!buf)
- {
- return -ENOMEM;
- }
- for (i = 0; i < count; i++)
- {
- bt_buf_put_le16(buf, handles[i]);
- }
- return gatt_send(conn, buf, att_read_rsp, func, NULL);
- }
|