/* Bluetooth Mesh */ /* * Copyright (c) 2017 Intel Corporation * * SPDX-License-Identifier: Apache-2.0 */ #include "syscfg/syscfg.h" #define MESH_LOG_MODULE BLE_MESH_PROXY_LOG #if MYNEWT_VAL(BLE_MESH_PROXY) #include "mesh/mesh.h" #include "host/ble_att.h" #include "services/gatt/ble_svc_gatt.h" #include "../../host/src/ble_hs_priv.h" #include "mesh_priv.h" #include "adv.h" #include "net.h" #include "rpl.h" #include "prov.h" #include "beacon.h" #include "foundation.h" #include "access.h" #include "proxy.h" #define PDU_TYPE(data) (data[0] & BIT_MASK(6)) #define PDU_SAR(data) (data[0] >> 6) #define BT_UUID_16_ENCODE(w16) \ (((w16) >> 0) & 0xFF), \ (((w16) >> 8) & 0xFF) /* Mesh Profile 1.0 Section 6.6: * "The timeout for the SAR transfer is 20 seconds. When the timeout * expires, the Proxy Server shall disconnect." */ #define PROXY_SAR_TIMEOUT K_SECONDS(20) #define SAR_COMPLETE 0x00 #define SAR_FIRST 0x01 #define SAR_CONT 0x02 #define SAR_LAST 0x03 #define CFG_FILTER_SET 0x00 #define CFG_FILTER_ADD 0x01 #define CFG_FILTER_REMOVE 0x02 #define CFG_FILTER_STATUS 0x03 /** @def BT_UUID_MESH_PROV * @brief Mesh Provisioning Service */ ble_uuid16_t BT_UUID_MESH_PROV = BLE_UUID16_INIT(0x1827); #define BT_UUID_MESH_PROV_VAL 0x1827 /** @def BT_UUID_MESH_PROXY * @brief Mesh Proxy Service */ ble_uuid16_t BT_UUID_MESH_PROXY = BLE_UUID16_INIT(0x1828); #define BT_UUID_MESH_PROXY_VAL 0x1828 /** @def BT_UUID_GATT_CCC * @brief GATT Client Characteristic Configuration */ ble_uuid16_t BT_UUID_GATT_CCC = BLE_UUID16_INIT(0x2902); #define BT_UUID_GATT_CCC_VAL 0x2902 /** @def BT_UUID_MESH_PROV_DATA_IN * @brief Mesh Provisioning Data In */ ble_uuid16_t BT_UUID_MESH_PROV_DATA_IN = BLE_UUID16_INIT(0x2adb); #define BT_UUID_MESH_PROV_DATA_IN_VAL 0x2adb /** @def BT_UUID_MESH_PROV_DATA_OUT * @brief Mesh Provisioning Data Out */ ble_uuid16_t BT_UUID_MESH_PROV_DATA_OUT = BLE_UUID16_INIT(0x2adc); #define BT_UUID_MESH_PROV_DATA_OUT_VAL 0x2adc /** @def BT_UUID_MESH_PROXY_DATA_IN * @brief Mesh Proxy Data In */ ble_uuid16_t BT_UUID_MESH_PROXY_DATA_IN = BLE_UUID16_INIT(0x2add); #define BT_UUID_MESH_PROXY_DATA_IN_VAL 0x2add /** @def BT_UUID_MESH_PROXY_DATA_OUT * @brief Mesh Proxy Data Out */ ble_uuid16_t BT_UUID_MESH_PROXY_DATA_OUT = BLE_UUID16_INIT(0x2ade); #define BT_UUID_MESH_PROXY_DATA_OUT_VAL 0x2ade #define PDU_HDR(sar, type) (sar << 6 | (type & BIT_MASK(6))) #define CLIENT_BUF_SIZE 68 static const struct ble_gap_adv_params slow_adv_param = { .conn_mode = (BLE_GAP_CONN_MODE_UND), .disc_mode = (BLE_GAP_DISC_MODE_GEN), .itvl_min = BT_GAP_ADV_SLOW_INT_MIN, .itvl_max = BT_GAP_ADV_SLOW_INT_MAX, }; static const struct ble_gap_adv_params fast_adv_param = { .conn_mode = (BLE_GAP_CONN_MODE_UND), .disc_mode = (BLE_GAP_DISC_MODE_GEN), .itvl_min = BT_GAP_ADV_FAST_INT_MIN_2, .itvl_max = BT_GAP_ADV_FAST_INT_MAX_2, }; static bool proxy_adv_enabled; #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) static void proxy_send_beacons(struct ble_npl_event *work); #endif #if (MYNEWT_VAL(BLE_MESH_PB_GATT)) static bool prov_fast_adv; #endif static struct bt_mesh_proxy_client { uint16_t conn_handle; uint16_t filter[MYNEWT_VAL(BLE_MESH_PROXY_FILTER_SIZE)]; enum __packed { NONE, WHITELIST, BLACKLIST, PROV, } filter_type; uint8_t msg_type; #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) struct ble_npl_callout send_beacons; #endif struct k_delayed_work sar_timer; struct os_mbuf *buf; } clients[MYNEWT_VAL(BLE_MAX_CONNECTIONS)] = { [0 ... (MYNEWT_VAL(BLE_MAX_CONNECTIONS) - 1)] = { 0 }, }; static sys_slist_t idle_waiters; static atomic_t pending_notifications; /* Track which service is enabled */ static enum { MESH_GATT_NONE, MESH_GATT_PROV, MESH_GATT_PROXY, } gatt_svc = MESH_GATT_NONE; static struct { uint16_t proxy_h; uint16_t proxy_data_out_h; uint16_t prov_h; uint16_t prov_data_in_h; uint16_t prov_data_out_h; } svc_handles; static void resolve_svc_handles(void) { int rc; /* Either all handles are already resolved, or none of them */ if (svc_handles.prov_data_out_h) { return; } /* * We assert if attribute is not found since at this stage all attributes * shall be already registered and thus shall be found. */ rc = ble_gatts_find_svc(BLE_UUID16_DECLARE(BT_UUID_MESH_PROXY_VAL), &svc_handles.proxy_h); assert(rc == 0); rc = ble_gatts_find_chr(BLE_UUID16_DECLARE(BT_UUID_MESH_PROXY_VAL), BLE_UUID16_DECLARE(BT_UUID_MESH_PROXY_DATA_OUT_VAL), NULL, &svc_handles.proxy_data_out_h); assert(rc == 0); rc = ble_gatts_find_svc(BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_VAL), &svc_handles.prov_h); assert(rc == 0); rc = ble_gatts_find_chr(BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_VAL), BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_DATA_IN_VAL), NULL, &svc_handles.prov_data_in_h); assert(rc == 0); rc = ble_gatts_find_chr(BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_VAL), BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_DATA_OUT_VAL), NULL, &svc_handles.prov_data_out_h); assert(rc == 0); } static struct bt_mesh_proxy_client *find_client(uint16_t conn_handle) { int i; for (i = 0; i < ARRAY_SIZE(clients); i++) { if (clients[i].conn_handle == conn_handle) { return &clients[i]; } } return NULL; } #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) /* Next subnet in queue to be advertised */ static struct bt_mesh_subnet *beacon_sub; static int proxy_segment_and_send(uint16_t conn_handle, uint8_t type, struct os_mbuf *msg); static int filter_set(struct bt_mesh_proxy_client *client, struct os_mbuf *buf) { uint8_t type; if (buf->om_len < 1) { BT_WARN("Too short Filter Set message"); return -EINVAL; } type = net_buf_simple_pull_u8(buf); BT_DBG("type 0x%02x", type); switch (type) { case 0x00: memset(client->filter, 0, sizeof(client->filter)); client->filter_type = WHITELIST; break; case 0x01: memset(client->filter, 0, sizeof(client->filter)); client->filter_type = BLACKLIST; break; default: BT_WARN("Prohibited Filter Type 0x%02x", type); return -EINVAL; } return 0; } static void filter_add(struct bt_mesh_proxy_client *client, uint16_t addr) { int i; BT_DBG("addr 0x%04x", addr); if (addr == BT_MESH_ADDR_UNASSIGNED) { return; } for (i = 0; i < ARRAY_SIZE(client->filter); i++) { if (client->filter[i] == addr) { return; } } for (i = 0; i < ARRAY_SIZE(client->filter); i++) { if (client->filter[i] == BT_MESH_ADDR_UNASSIGNED) { client->filter[i] = addr; return; } } } static void filter_remove(struct bt_mesh_proxy_client *client, uint16_t addr) { int i; BT_DBG("addr 0x%04x", addr); if (addr == BT_MESH_ADDR_UNASSIGNED) { return; } for (i = 0; i < ARRAY_SIZE(client->filter); i++) { if (client->filter[i] == addr) { client->filter[i] = BT_MESH_ADDR_UNASSIGNED; return; } } } static void send_filter_status(struct bt_mesh_proxy_client *client, struct bt_mesh_net_rx *rx, struct os_mbuf *buf) { struct bt_mesh_net_tx tx = { .sub = rx->sub, .ctx = &rx->ctx, .src = bt_mesh_primary_addr(), }; uint16_t filter_size; int i, err; /* Configuration messages always have dst unassigned */ tx.ctx->addr = BT_MESH_ADDR_UNASSIGNED; net_buf_simple_init(buf, 10); net_buf_simple_add_u8(buf, CFG_FILTER_STATUS); if (client->filter_type == WHITELIST) { net_buf_simple_add_u8(buf, 0x00); } else { net_buf_simple_add_u8(buf, 0x01); } for (filter_size = 0, i = 0; i < ARRAY_SIZE(client->filter); i++) { if (client->filter[i] != BT_MESH_ADDR_UNASSIGNED) { filter_size++; } } net_buf_simple_add_be16(buf, filter_size); BT_DBG("%u bytes: %s", buf->om_len, bt_hex(buf->om_data, buf->om_len)); err = bt_mesh_net_encode(&tx, buf, true); if (err) { BT_ERR("Encoding Proxy cfg message failed (err %d)", err); return; } err = proxy_segment_and_send(client->conn_handle, BT_MESH_PROXY_CONFIG, buf); if (err) { BT_ERR("Failed to send proxy cfg message (err %d)", err); } } static void proxy_cfg(struct bt_mesh_proxy_client *client) { struct os_mbuf *buf = NET_BUF_SIMPLE(29); struct bt_mesh_net_rx rx; uint8_t opcode; int err; err = bt_mesh_net_decode(client->buf, BT_MESH_NET_IF_PROXY_CFG, &rx, buf); if (err) { BT_ERR("Failed to decode Proxy Configuration (err %d)", err); goto done; } rx.local_match = 1U; if (bt_mesh_rpl_check(&rx, NULL)) { BT_WARN("Replay: src 0x%04x dst 0x%04x seq 0x%06x", rx.ctx.addr, rx.ctx.recv_dst, rx.seq); goto done; } /* Remove network headers */ net_buf_simple_pull_mem(buf, BT_MESH_NET_HDR_LEN); BT_DBG("%u bytes: %s", buf->om_len, bt_hex(buf->om_data, buf->om_len)); if (buf->om_len < 1) { BT_WARN("Too short proxy configuration PDU"); goto done; } opcode = net_buf_simple_pull_u8(buf); switch (opcode) { case CFG_FILTER_SET: filter_set(client, buf); send_filter_status(client, &rx, buf); break; case CFG_FILTER_ADD: while (buf->om_len >= 2) { uint16_t addr; addr = net_buf_simple_pull_be16(buf); filter_add(client, addr); } send_filter_status(client, &rx, buf); break; case CFG_FILTER_REMOVE: while (buf->om_len >= 2) { uint16_t addr; addr = net_buf_simple_pull_be16(buf); filter_remove(client, addr); } send_filter_status(client, &rx, buf); break; default: BT_WARN("Unhandled configuration OpCode 0x%02x", opcode); break; } done: os_mbuf_free_chain(buf); } static int beacon_send(uint16_t conn_handle, struct bt_mesh_subnet *sub) { struct os_mbuf *buf = NET_BUF_SIMPLE(23); int rc; net_buf_simple_init(buf, 1); bt_mesh_beacon_create(sub, buf); rc = proxy_segment_and_send(conn_handle, BT_MESH_PROXY_BEACON, buf); os_mbuf_free_chain(buf); return rc; } static int send_beacon_cb(struct bt_mesh_subnet *sub, void *cb_data) { struct bt_mesh_proxy_client *client = cb_data; return beacon_send(client->conn_handle, sub); } static void proxy_send_beacons(struct ble_npl_event *work) { struct bt_mesh_proxy_client *client; client = ble_npl_event_get_arg(work); (void)bt_mesh_subnet_find(send_beacon_cb, client); } static void proxy_sar_timeout(struct ble_npl_event *work) { struct bt_mesh_proxy_client *client; int rc; BT_WARN("Proxy SAR timeout"); client = ble_npl_event_get_arg(work); assert(client != NULL); if ((client->conn_handle != BLE_HS_CONN_HANDLE_NONE)) { rc = ble_gap_terminate(client->conn_handle, BLE_ERR_REM_USER_CONN_TERM); assert(rc == 0); } } void bt_mesh_proxy_beacon_send(struct bt_mesh_subnet *sub) { int i; if (!sub) { /* NULL means we send on all subnets */ bt_mesh_subnet_foreach(bt_mesh_proxy_beacon_send); return; } for (i = 0; i < ARRAY_SIZE(clients); i++) { if (clients[i].conn_handle != BLE_HS_CONN_HANDLE_NONE) { beacon_send(clients[i].conn_handle, sub); } } } static void node_id_start(struct bt_mesh_subnet *sub) { sub->node_id = BT_MESH_NODE_IDENTITY_RUNNING; sub->node_id_start = k_uptime_get_32(); } void bt_mesh_proxy_identity_start(struct bt_mesh_subnet *sub) { node_id_start(sub); /* Prioritize the recently enabled subnet */ beacon_sub = sub; } void bt_mesh_proxy_identity_stop(struct bt_mesh_subnet *sub) { sub->node_id = BT_MESH_NODE_IDENTITY_STOPPED; sub->node_id_start = 0; } int bt_mesh_proxy_identity_enable(void) { BT_DBG(""); if (!bt_mesh_is_provisioned()) { return -EAGAIN; } if (bt_mesh_subnet_foreach(node_id_start)) { bt_mesh_adv_update(); } return 0; } #endif /* GATT_PROXY */ static void proxy_complete_pdu(struct bt_mesh_proxy_client *client) { switch (client->msg_type) { #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) case BT_MESH_PROXY_NET_PDU: BT_INFO("Mesh Network PDU"); bt_mesh_net_recv(client->buf, 0, BT_MESH_NET_IF_PROXY); break; case BT_MESH_PROXY_BEACON: BT_INFO("Mesh Beacon PDU"); bt_mesh_beacon_recv(client->buf); break; case BT_MESH_PROXY_CONFIG: BT_INFO("Mesh Configuration PDU"); proxy_cfg(client); break; #endif #if (MYNEWT_VAL(BLE_MESH_PB_GATT)) case BT_MESH_PROXY_PROV: BT_INFO("Mesh Provisioning PDU"); bt_mesh_pb_gatt_recv(client->conn_handle, client->buf); break; #endif default: BT_WARN("Unhandled Message Type 0x%02x", client->msg_type); break; } net_buf_simple_init(client->buf, 0); } static int proxy_recv(uint16_t conn_handle, uint16_t attr_handle, struct ble_gatt_access_ctxt *ctxt, void *arg) { struct bt_mesh_proxy_client *client = find_client(conn_handle); const uint8_t *data = ctxt->om->om_data; uint16_t len = ctxt->om->om_len; client = find_client(conn_handle); if (!client) { return -ENOTCONN; } if (len < 1) { BT_WARN("Too small Proxy PDU"); return -EINVAL; } if ((attr_handle == svc_handles.prov_data_in_h) != (PDU_TYPE(data) == BT_MESH_PROXY_PROV)) { BT_WARN("Proxy PDU type doesn't match GATT service"); return -EINVAL; } if (len - 1 > net_buf_simple_tailroom(client->buf)) { BT_WARN("Too big proxy PDU"); return -EINVAL; } switch (PDU_SAR(data)) { case SAR_COMPLETE: if (client->buf->om_len) { BT_WARN("Complete PDU while a pending incomplete one"); return -EINVAL; } client->msg_type = PDU_TYPE(data); net_buf_simple_add_mem(client->buf, data + 1, len - 1); proxy_complete_pdu(client); break; case SAR_FIRST: if (client->buf->om_len) { BT_WARN("First PDU while a pending incomplete one"); return -EINVAL; } k_delayed_work_submit(&client->sar_timer, PROXY_SAR_TIMEOUT); client->msg_type = PDU_TYPE(data); net_buf_simple_add_mem(client->buf, data + 1, len - 1); break; case SAR_CONT: if (!client->buf->om_len) { BT_WARN("Continuation with no prior data"); return -EINVAL; } if (client->msg_type != PDU_TYPE(data)) { BT_WARN("Unexpected message type in continuation"); return -EINVAL; } k_delayed_work_submit(&client->sar_timer, PROXY_SAR_TIMEOUT); net_buf_simple_add_mem(client->buf, data + 1, len - 1); break; case SAR_LAST: if (!client->buf->om_len) { BT_WARN("Last SAR PDU with no prior data"); return -EINVAL; } if (client->msg_type != PDU_TYPE(data)) { BT_WARN("Unexpected message type in last SAR PDU"); return -EINVAL; } k_delayed_work_cancel(&client->sar_timer); net_buf_simple_add_mem(client->buf, data + 1, len - 1); proxy_complete_pdu(client); break; } return len; } static int conn_count; static void proxy_connected(uint16_t conn_handle) { struct bt_mesh_proxy_client *client; int i; BT_INFO("conn_handle %d", conn_handle); conn_count++; /* Since we use ADV_OPT_ONE_TIME */ proxy_adv_enabled = false; /* Try to re-enable advertising in case it's possible */ if (conn_count < CONFIG_BT_MAX_CONN) { bt_mesh_adv_update(); } for (client = NULL, i = 0; i < ARRAY_SIZE(clients); i++) { if (clients[i].conn_handle == BLE_HS_CONN_HANDLE_NONE) { client = &clients[i]; break; } } if (!client) { BT_ERR("No free Proxy Client objects"); return; } client->conn_handle = conn_handle; client->filter_type = NONE; memset(client->filter, 0, sizeof(client->filter)); net_buf_simple_init(client->buf, 0); } static void proxy_disconnected(uint16_t conn_handle, int reason) { int i; BT_DBG("conn handle %u reason 0x%02x", conn_handle, reason); conn_count--; for (i = 0; i < ARRAY_SIZE(clients); i++) { struct bt_mesh_proxy_client *client = &clients[i]; if (client->conn_handle == conn_handle) { if ((MYNEWT_VAL(BLE_MESH_PB_GATT)) && client->filter_type == PROV) { bt_mesh_pb_gatt_close(conn_handle); } k_delayed_work_cancel(&client->sar_timer); client->conn_handle = BLE_HS_CONN_HANDLE_NONE; break; } } bt_mesh_adv_update(); } struct os_mbuf *bt_mesh_proxy_get_buf(void) { struct os_mbuf *buf = clients[0].buf; if (buf != NULL) { net_buf_simple_init(buf, 0); } return buf; } #if (MYNEWT_VAL(BLE_MESH_PB_GATT)) static void prov_ccc_write(uint16_t conn_handle) { struct bt_mesh_proxy_client *client; BT_DBG("conn_handle %d", conn_handle); /* If a connection exists there must be a client */ client = find_client(conn_handle); __ASSERT(client, "No client for connection"); if (client->filter_type == NONE) { client->filter_type = PROV; bt_mesh_pb_gatt_open(conn_handle); } } int bt_mesh_proxy_prov_enable(void) { uint16_t handle; int rc; int i; BT_DBG(""); if (gatt_svc == MESH_GATT_PROV) { return -EALREADY; } if (gatt_svc != MESH_GATT_NONE) { return -EBUSY; } rc = ble_gatts_find_svc(BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_VAL), &handle); assert(rc == 0); ble_gatts_svc_set_visibility(handle, 1); /* FIXME: figure out end handle */ ble_svc_gatt_changed(svc_handles.prov_h, 0xffff); gatt_svc = MESH_GATT_PROV; prov_fast_adv = true; for (i = 0; i < ARRAY_SIZE(clients); i++) { if (clients[i].conn_handle != BLE_HS_CONN_HANDLE_NONE) { clients[i].filter_type = PROV; } } return 0; } int bt_mesh_proxy_prov_disable(bool disconnect) { uint16_t handle; int rc; int i; BT_DBG(""); if (gatt_svc == MESH_GATT_NONE) { return -EALREADY; } if (gatt_svc != MESH_GATT_PROV) { return -EBUSY; } rc = ble_gatts_find_svc(BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_VAL), &handle); assert(rc == 0); ble_gatts_svc_set_visibility(handle, 0); /* FIXME: figure out end handle */ ble_svc_gatt_changed(svc_handles.prov_h, 0xffff); gatt_svc = MESH_GATT_NONE; for (i = 0; i < ARRAY_SIZE(clients); i++) { struct bt_mesh_proxy_client *client = &clients[i]; if ((client->conn_handle == BLE_HS_CONN_HANDLE_NONE) || (client->filter_type != PROV)) { continue; } if (disconnect) { rc = ble_gap_terminate(client->conn_handle, BLE_ERR_REM_USER_CONN_TERM); assert(rc == 0); } else { bt_mesh_pb_gatt_close(client->conn_handle); client->filter_type = NONE; } } bt_mesh_adv_update(); return 0; } #endif /* MYNEWT_VAL(BLE_MESH_PB_GATT) */ #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) static void proxy_ccc_write(uint16_t conn_handle) { struct bt_mesh_proxy_client *client; BT_DBG("conn_handle %d", conn_handle); client = find_client(conn_handle); __ASSERT(client, "No client for connection"); if (client->filter_type == NONE) { client->filter_type = WHITELIST; k_work_add_arg(&client->send_beacons, client); k_work_submit(&client->send_beacons); } } int bt_mesh_proxy_gatt_enable(void) { uint16_t handle; int rc; int i; BT_DBG(""); if (gatt_svc == MESH_GATT_PROXY) { return -EALREADY; } if (gatt_svc != MESH_GATT_NONE) { return -EBUSY; } rc = ble_gatts_find_svc(BLE_UUID16_DECLARE(BT_UUID_MESH_PROXY_VAL), &handle); assert(rc == 0); ble_gatts_svc_set_visibility(handle, 1); /* FIXME: figure out end handle */ ble_svc_gatt_changed(svc_handles.proxy_h, 0xffff); gatt_svc = MESH_GATT_PROXY; for (i = 0; i < ARRAY_SIZE(clients); i++) { if (clients[i].conn_handle != BLE_HS_CONN_HANDLE_NONE) { clients[i].filter_type = WHITELIST; } } return 0; } void bt_mesh_proxy_gatt_disconnect(void) { int rc; int i; BT_DBG(""); for (i = 0; i < ARRAY_SIZE(clients); i++) { struct bt_mesh_proxy_client *client = &clients[i]; if ((client->conn_handle != BLE_HS_CONN_HANDLE_NONE) && (client->filter_type == WHITELIST || client->filter_type == BLACKLIST)) { client->filter_type = NONE; rc = ble_gap_terminate(client->conn_handle, BLE_ERR_REM_USER_CONN_TERM); assert(rc == 0); } } } int bt_mesh_proxy_gatt_disable(void) { uint16_t handle; int rc; BT_DBG(""); if (gatt_svc == MESH_GATT_NONE) { return -EALREADY; } if (gatt_svc != MESH_GATT_PROXY) { return -EBUSY; } bt_mesh_proxy_gatt_disconnect(); rc = ble_gatts_find_svc(BLE_UUID16_DECLARE(BT_UUID_MESH_PROXY_VAL), &handle); assert(rc == 0); ble_gatts_svc_set_visibility(handle, 0); /* FIXME: figure out end handle */ ble_svc_gatt_changed(svc_handles.proxy_h, 0xffff); gatt_svc = MESH_GATT_NONE; return 0; } void bt_mesh_proxy_addr_add(struct os_mbuf *buf, uint16_t addr) { struct bt_mesh_proxy_client *client = NULL; int i; for (i = 0; i < ARRAY_SIZE(clients); i++) { client = &clients[i]; if (client->buf == buf) { break; } } assert(client); BT_DBG("filter_type %u addr 0x%04x", client->filter_type, addr); if (client->filter_type == WHITELIST) { filter_add(client, addr); } else if (client->filter_type == BLACKLIST) { filter_remove(client, addr); } } static bool client_filter_match(struct bt_mesh_proxy_client *client, uint16_t addr) { int i; BT_DBG("filter_type %u addr 0x%04x", client->filter_type, addr); if (client->filter_type == BLACKLIST) { for (i = 0; i < ARRAY_SIZE(client->filter); i++) { if (client->filter[i] == addr) { return false; } } return true; } if (addr == BT_MESH_ADDR_ALL_NODES) { return true; } if (client->filter_type == WHITELIST) { for (i = 0; i < ARRAY_SIZE(client->filter); i++) { if (client->filter[i] == addr) { return true; } } } return false; } bool bt_mesh_proxy_relay(struct os_mbuf *buf, uint16_t dst) { bool relayed = false; int i; BT_DBG("%u bytes to dst 0x%04x", buf->om_len, dst); for (i = 0; i < ARRAY_SIZE(clients); i++) { struct bt_mesh_proxy_client *client = &clients[i]; struct os_mbuf *msg; if (client->conn_handle == BLE_HS_CONN_HANDLE_NONE) { continue; } if (!client_filter_match(client, dst)) { continue; } /* Proxy PDU sending modifies the original buffer, * so we need to make a copy. */ msg = NET_BUF_SIMPLE(32); net_buf_simple_init(msg, 1); net_buf_simple_add_mem(msg, buf->om_data, buf->om_len); bt_mesh_proxy_send(client->conn_handle, BT_MESH_PROXY_NET_PDU, msg); os_mbuf_free_chain(msg); relayed = true; } return relayed; } #endif /* MYNEWT_VAL(BLE_MESH_GATT_PROXY) */ static void notify_complete(void) { sys_snode_t *n; if (atomic_dec(&pending_notifications) > 1) { return; } BT_DBG(""); while ((n = sys_slist_get(&idle_waiters))) { CONTAINER_OF(n, struct bt_mesh_proxy_idle_cb, n)->cb(); } } static int proxy_send(uint16_t conn_handle, const void *data, uint16_t len) { struct os_mbuf *om; int err = 0; BT_DBG("%u bytes: %s", len, bt_hex(data, len)); #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) if (gatt_svc == MESH_GATT_PROXY) { om = ble_hs_mbuf_from_flat(data, len); assert(om); err = ble_gattc_notify_custom(conn_handle, svc_handles.proxy_data_out_h, om); notify_complete(); } #endif #if (MYNEWT_VAL(BLE_MESH_PB_GATT)) if (gatt_svc == MESH_GATT_PROV) { om = ble_hs_mbuf_from_flat(data, len); assert(om); err = ble_gattc_notify_custom(conn_handle, svc_handles.prov_data_out_h, om); notify_complete(); } #endif if (!err) { atomic_inc(&pending_notifications); } return err; } static int proxy_segment_and_send(uint16_t conn_handle, uint8_t type, struct os_mbuf *msg) { uint16_t mtu; BT_DBG("conn_handle %d type 0x%02x len %u: %s", conn_handle, type, msg->om_len, bt_hex(msg->om_data, msg->om_len)); /* ATT_MTU - OpCode (1 byte) - Handle (2 bytes) */ mtu = ble_att_mtu(conn_handle) - 3; if (mtu > msg->om_len) { net_buf_simple_push_u8(msg, PDU_HDR(SAR_COMPLETE, type)); return proxy_send(conn_handle, msg->om_data, msg->om_len); } net_buf_simple_push_u8(msg, PDU_HDR(SAR_FIRST, type)); proxy_send(conn_handle, msg->om_data, mtu); net_buf_simple_pull_mem(msg, mtu); while (msg->om_len) { if (msg->om_len + 1 < mtu) { net_buf_simple_push_u8(msg, PDU_HDR(SAR_LAST, type)); proxy_send(conn_handle, msg->om_data, msg->om_len); break; } net_buf_simple_push_u8(msg, PDU_HDR(SAR_CONT, type)); proxy_send(conn_handle, msg->om_data, mtu); net_buf_simple_pull_mem(msg, mtu); } return 0; } int bt_mesh_proxy_send(uint16_t conn_handle, uint8_t type, struct os_mbuf *msg) { struct bt_mesh_proxy_client *client = find_client(conn_handle); if (!client) { BT_ERR("No Proxy Client found"); return -ENOTCONN; } if ((client->filter_type == PROV) != (type == BT_MESH_PROXY_PROV)) { BT_ERR("Invalid PDU type for Proxy Client"); return -EINVAL; } return proxy_segment_and_send(conn_handle, type, msg); } #if (MYNEWT_VAL(BLE_MESH_PB_GATT)) static uint8_t prov_svc_data[20] = { BT_UUID_16_ENCODE(BT_UUID_MESH_PROV_VAL), }; static const struct bt_data prov_ad[] = { BT_DATA_BYTES(BT_DATA_FLAGS, (BT_LE_AD_GENERAL | BT_LE_AD_NO_BREDR)), BT_DATA_BYTES(BT_DATA_UUID16_ALL, BT_UUID_16_ENCODE(BT_UUID_MESH_PROV_VAL)), BT_DATA(BT_DATA_SVC_DATA16, prov_svc_data, sizeof(prov_svc_data)), }; #endif /* PB_GATT */ #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) #define ID_TYPE_NET 0x00 #define ID_TYPE_NODE 0x01 #define NODE_ID_LEN 19 #define NET_ID_LEN 11 #define NODE_ID_TIMEOUT K_SECONDS(CONFIG_BT_MESH_NODE_ID_TIMEOUT) static uint8_t proxy_svc_data[NODE_ID_LEN] = { BT_UUID_16_ENCODE(BT_UUID_MESH_PROXY_VAL), }; static const struct bt_data node_id_ad[] = { BT_DATA_BYTES(BT_DATA_FLAGS, (BT_LE_AD_GENERAL | BT_LE_AD_NO_BREDR)), BT_DATA_BYTES(BT_DATA_UUID16_ALL, BT_UUID_16_ENCODE(BT_UUID_MESH_PROXY_VAL)), BT_DATA(BT_DATA_SVC_DATA16, proxy_svc_data, NODE_ID_LEN), }; static const struct bt_data net_id_ad[] = { BT_DATA_BYTES(BT_DATA_FLAGS, (BT_LE_AD_GENERAL | BT_LE_AD_NO_BREDR)), BT_DATA_BYTES(BT_DATA_UUID16_ALL, BT_UUID_16_ENCODE(BT_UUID_MESH_PROXY_VAL)), BT_DATA(BT_DATA_SVC_DATA16, proxy_svc_data, NET_ID_LEN), }; static int node_id_adv(struct bt_mesh_subnet *sub) { uint8_t tmp[16]; int err; BT_DBG(""); proxy_svc_data[2] = ID_TYPE_NODE; err = bt_rand(proxy_svc_data + 11, 8); if (err) { return err; } memset(tmp, 0, 6); memcpy(tmp + 6, proxy_svc_data + 11, 8); sys_put_be16(bt_mesh_primary_addr(), tmp + 14); err = bt_encrypt_be(sub->keys[SUBNET_KEY_TX_IDX(sub)].identity, tmp, tmp); if (err) { return err; } memcpy(proxy_svc_data + 3, tmp + 8, 8); err = bt_le_adv_start(&fast_adv_param, node_id_ad, ARRAY_SIZE(node_id_ad), NULL, 0); if (err) { BT_WARN("Failed to advertise using Node ID (err %d)", err); return err; } proxy_adv_enabled = true; return 0; } static int net_id_adv(struct bt_mesh_subnet *sub) { int err; BT_DBG(""); proxy_svc_data[2] = ID_TYPE_NET; BT_DBG("Advertising with NetId %s", bt_hex(sub->keys[SUBNET_KEY_TX_IDX(sub)].net_id, 8)); memcpy(proxy_svc_data + 3, sub->keys[SUBNET_KEY_TX_IDX(sub)].net_id, 8); err = bt_le_adv_start(&slow_adv_param, net_id_ad, ARRAY_SIZE(net_id_ad), NULL, 0); if (err) { BT_WARN("Failed to advertise using Network ID (err %d)", err); return err; } proxy_adv_enabled = true; return 0; } static bool advertise_subnet(struct bt_mesh_subnet *sub) { if (sub->net_idx == BT_MESH_KEY_UNUSED) { return false; } return (sub->node_id == BT_MESH_NODE_IDENTITY_RUNNING || bt_mesh_gatt_proxy_get() == BT_MESH_GATT_PROXY_ENABLED); } static struct bt_mesh_subnet *next_sub(void) { struct bt_mesh_subnet *sub = NULL; if (!beacon_sub) { beacon_sub = bt_mesh_subnet_next(NULL); if (!beacon_sub) { /* No valid subnets */ return NULL; } } sub = beacon_sub; do { if (advertise_subnet(sub)) { beacon_sub = sub; return sub; } sub = bt_mesh_subnet_next(sub); } while (sub != beacon_sub); /* No subnets to advertise on */ return NULL; } static int sub_count_cb(struct bt_mesh_subnet *sub, void *cb_data) { int *count = cb_data; if (advertise_subnet(sub)) { (*count)++; } return 0; } static int sub_count(void) { int count = 0; (void)bt_mesh_subnet_find(sub_count_cb, &count); return count; } static int32_t gatt_proxy_advertise(struct bt_mesh_subnet *sub) { int32_t remaining = K_FOREVER; int subnet_count; BT_DBG(""); if (conn_count == CONFIG_BT_MAX_CONN) { BT_DBG("Connectable advertising deferred (max connections %d)", conn_count); return -ENOMEM; } sub = beacon_sub ? beacon_sub : bt_mesh_subnet_next(beacon_sub); if (!sub) { BT_WARN("No subnets to advertise on"); return -ENOENT; } if (sub->node_id == BT_MESH_NODE_IDENTITY_RUNNING) { uint32_t active = k_uptime_get_32() - sub->node_id_start; if (active < NODE_ID_TIMEOUT) { remaining = NODE_ID_TIMEOUT - active; BT_DBG("Node ID active for %u ms, %d ms remaining", (unsigned) active, (int) remaining); node_id_adv(sub); } else { bt_mesh_proxy_identity_stop(sub); BT_DBG("Node ID stopped"); } } if (sub->node_id == BT_MESH_NODE_IDENTITY_STOPPED) { net_id_adv(sub); } subnet_count = sub_count(); BT_DBG("sub_count %u", subnet_count); if (subnet_count > 1) { int32_t max_timeout; /* We use NODE_ID_TIMEOUT as a starting point since it may * be less than 60 seconds. Divide this period into at least * 6 slices, but make sure that a slice is at least one * second long (to avoid excessive rotation). */ max_timeout = NODE_ID_TIMEOUT / max(subnet_count, 6); max_timeout = max(max_timeout, K_SECONDS(1)); if (remaining > max_timeout || remaining < 0) { remaining = max_timeout; } } BT_DBG("Advertising %d ms for net_idx 0x%04x", (int) remaining, sub->net_idx); beacon_sub = bt_mesh_subnet_next(beacon_sub); return remaining; } #endif /* GATT_PROXY */ #if (MYNEWT_VAL(BLE_MESH_PB_GATT)) static size_t gatt_prov_adv_create(struct bt_data prov_sd[2]) { const struct bt_mesh_prov *prov = bt_mesh_prov_get(); const char *name = CONFIG_BT_DEVICE_NAME; size_t name_len = strlen(name); size_t prov_sd_len = 0; size_t sd_space = 31; memcpy(prov_svc_data + 2, prov->uuid, 16); sys_put_be16(prov->oob_info, prov_svc_data + 18); if (prov->uri) { size_t uri_len = strlen(prov->uri); if (uri_len > 29) { /* There's no way to shorten an URI */ BT_WARN("Too long URI to fit advertising packet"); } else { prov_sd[0].type = BT_DATA_URI; prov_sd[0].data_len = uri_len; prov_sd[0].data = (void *)prov->uri; sd_space -= 2 + uri_len; prov_sd_len++; } } if (sd_space > 2 && name_len > 0) { sd_space -= 2; if (sd_space < name_len) { prov_sd[prov_sd_len].type = BT_DATA_NAME_SHORTENED; prov_sd[prov_sd_len].data_len = sd_space; } else { prov_sd[prov_sd_len].type = BT_DATA_NAME_COMPLETE; prov_sd[prov_sd_len].data_len = name_len; } prov_sd[prov_sd_len].data = (void *)name; prov_sd_len++; } return prov_sd_len; } #endif /* PB_GATT */ int32_t bt_mesh_proxy_adv_start(void) { BT_DBG(""); if (gatt_svc == MESH_GATT_NONE) { return K_FOREVER; } #if (MYNEWT_VAL(BLE_MESH_PB_GATT)) if (!bt_mesh_is_provisioned()) { const struct ble_gap_adv_params *param; struct bt_data prov_sd[2]; size_t prov_sd_len; if (prov_fast_adv) { param = &fast_adv_param; } else { param = &slow_adv_param; } prov_sd_len = gatt_prov_adv_create(prov_sd); if (bt_le_adv_start(param, prov_ad, ARRAY_SIZE(prov_ad), prov_sd, prov_sd_len) == 0) { proxy_adv_enabled = true; /* Advertise 60 seconds using fast interval */ if (prov_fast_adv) { prov_fast_adv = false; return K_SECONDS(60); } } } #endif /* PB_GATT */ #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) if (bt_mesh_is_provisioned()) { return gatt_proxy_advertise(next_sub()); } #endif /* GATT_PROXY */ return K_FOREVER; } void bt_mesh_proxy_adv_stop(void) { int err; BT_DBG("adv_enabled %u", proxy_adv_enabled); if (!proxy_adv_enabled) { return; } err = bt_le_adv_stop(true); if (err) { BT_ERR("Failed to stop advertising (err %d)", err); } else { proxy_adv_enabled = false; } } #if defined(CONFIG_BT_MESH_GATT_PROXY) static void subnet_evt(struct bt_mesh_subnet *sub, enum bt_mesh_key_evt evt) { if (evt == BT_MESH_KEY_DELETED) { if (sub == beacon_sub) { beacon_sub = NULL; } } else { bt_mesh_proxy_beacon_send(sub); } } #endif static void ble_mesh_handle_connect(struct ble_gap_event *event, void *arg) { #if MYNEWT_VAL(BLE_EXT_ADV) /* When EXT ADV is enabled then mesh proxy is connected * when proxy advertising instance is completed. * Therefore no need to handle BLE_GAP_EVENT_CONNECT */ if (event->type == BLE_GAP_EVENT_ADV_COMPLETE) { /* Reason 0 means advertising has been completed because * connection has been established */ if (event->adv_complete.reason != 0) { return; } if (event->adv_complete.instance != BT_MESH_ADV_GATT_INST) { return; } proxy_connected(event->adv_complete.conn_handle); } #else if (event->type == BLE_GAP_EVENT_CONNECT) { proxy_connected(event->connect.conn_handle); } #endif } int ble_mesh_proxy_gap_event(struct ble_gap_event *event, void *arg) { if ((event->type == BLE_GAP_EVENT_CONNECT) || (event->type == BLE_GAP_EVENT_ADV_COMPLETE)) { ble_mesh_handle_connect(event, arg); } else if (event->type == BLE_GAP_EVENT_DISCONNECT) { proxy_disconnected(event->disconnect.conn.conn_handle, event->disconnect.reason); } else if (event->type == BLE_GAP_EVENT_SUBSCRIBE) { if (event->subscribe.attr_handle == svc_handles.proxy_data_out_h) { #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) proxy_ccc_write(event->subscribe.conn_handle); #endif } else if (event->subscribe.attr_handle == svc_handles.prov_data_out_h) { #if (MYNEWT_VAL(BLE_MESH_PB_GATT)) prov_ccc_write(event->subscribe.conn_handle); #endif } } return 0; } static int dummy_access_cb(uint16_t conn_handle, uint16_t attr_handle, struct ble_gatt_access_ctxt *ctxt, void *arg) { /* * We should never never enter this callback - it's attached to notify-only * characteristic which are notified directly from mbuf. And we can't pass * NULL as access_cb because gatts will assert on init... */ BLE_HS_DBG_ASSERT(0); return 0; } static const struct ble_gatt_svc_def svc_defs [] = { { .type = BLE_GATT_SVC_TYPE_PRIMARY, .uuid = BLE_UUID16_DECLARE(BT_UUID_MESH_PROXY_VAL), .characteristics = (struct ble_gatt_chr_def[]) { { .uuid = BLE_UUID16_DECLARE(BT_UUID_MESH_PROXY_DATA_IN_VAL), .access_cb = proxy_recv, .flags = BLE_GATT_CHR_F_WRITE_NO_RSP, }, { .uuid = BLE_UUID16_DECLARE(BT_UUID_MESH_PROXY_DATA_OUT_VAL), .access_cb = dummy_access_cb, .flags = BLE_GATT_CHR_F_NOTIFY, }, { 0, /* No more characteristics in this service. */ } }, }, { .type = BLE_GATT_SVC_TYPE_PRIMARY, .uuid = BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_VAL), .characteristics = (struct ble_gatt_chr_def[]) { { .uuid = BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_DATA_IN_VAL), .access_cb = proxy_recv, .flags = BLE_GATT_CHR_F_WRITE_NO_RSP, }, { .uuid = BLE_UUID16_DECLARE(BT_UUID_MESH_PROV_DATA_OUT_VAL), .access_cb = dummy_access_cb, .flags = BLE_GATT_CHR_F_NOTIFY, }, { 0, /* No more characteristics in this service. */ } }, }, { 0, /* No more services. */ }, }; int bt_mesh_proxy_svcs_register(void) { int rc; rc = ble_gatts_count_cfg(svc_defs); assert(rc == 0); rc = ble_gatts_add_svcs(svc_defs); assert(rc == 0); return 0; } int bt_mesh_proxy_init(void) { int i; #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) if (!bt_mesh_subnet_cb_list[4]) { bt_mesh_subnet_cb_list[4] = subnet_evt; } #endif for (i = 0; i < MYNEWT_VAL(BLE_MAX_CONNECTIONS); ++i) { #if (MYNEWT_VAL(BLE_MESH_GATT_PROXY)) k_work_init(&clients[i].send_beacons, proxy_send_beacons); #endif clients[i].buf = NET_BUF_SIMPLE(CLIENT_BUF_SIZE); clients[i].conn_handle = BLE_HS_CONN_HANDLE_NONE; k_delayed_work_init(&clients[i].sar_timer, proxy_sar_timeout); k_delayed_work_add_arg(&clients[i].sar_timer, &clients[i]); } resolve_svc_handles(); ble_gatts_svc_set_visibility(svc_handles.proxy_h, 0); ble_gatts_svc_set_visibility(svc_handles.prov_h, 0); return 0; } void bt_mesh_proxy_on_idle(struct bt_mesh_proxy_idle_cb *cb) { if (!atomic_get(&pending_notifications)) { cb->cb(); return; } sys_slist_append(&idle_waiters, &cb->n); } #endif /* MYNEWT_VAL(BLE_MESH_PROXY) */