mirror of
https://github.com/zephyrproject-rtos/zephyr
synced 2025-08-29 16:25:29 +00:00
Adds check for TTL max in the transport send functions, and moves setting of default TTL to transport. Fixes #29855. Signed-off-by: Trond Einar Snekvik <Trond.Einar.Snekvik@nordicsemi.no>
836 lines
21 KiB
C
836 lines
21 KiB
C
/* Bluetooth Mesh */
|
|
|
|
/*
|
|
* Copyright (c) 2017 Intel Corporation
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <zephyr.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <stdbool.h>
|
|
#include <sys/atomic.h>
|
|
#include <sys/util.h>
|
|
#include <sys/byteorder.h>
|
|
|
|
#include <net/buf.h>
|
|
#include <bluetooth/bluetooth.h>
|
|
#include <bluetooth/conn.h>
|
|
#include <bluetooth/mesh.h>
|
|
|
|
#define BT_DBG_ENABLED IS_ENABLED(CONFIG_BT_MESH_DEBUG_NET)
|
|
#define LOG_MODULE_NAME bt_mesh_net
|
|
#include "common/log.h"
|
|
|
|
#include "crypto.h"
|
|
#include "adv.h"
|
|
#include "mesh.h"
|
|
#include "net.h"
|
|
#include "rpl.h"
|
|
#include "lpn.h"
|
|
#include "friend.h"
|
|
#include "proxy.h"
|
|
#include "transport.h"
|
|
#include "access.h"
|
|
#include "foundation.h"
|
|
#include "beacon.h"
|
|
#include "settings.h"
|
|
#include "prov.h"
|
|
#include "cfg.h"
|
|
|
|
/* Minimum valid Mesh Network PDU length. The Network headers
|
|
* themselves take up 9 bytes. After that there is a minimum of 1 byte
|
|
* payload for both CTL=1 and CTL=0 PDUs (smallest OpCode is 1 byte). CTL=1
|
|
* PDUs must use a 64-bit (8 byte) NetMIC, whereas CTL=0 PDUs have at least
|
|
* a 32-bit (4 byte) NetMIC and AppMIC giving again a total of 8 bytes.
|
|
*/
|
|
#define BT_MESH_NET_MIN_PDU_LEN (BT_MESH_NET_HDR_LEN + 1 + 8)
|
|
|
|
#define LOOPBACK_MAX_PDU_LEN (BT_MESH_NET_HDR_LEN + 16)
|
|
#define LOOPBACK_USER_DATA_SIZE sizeof(struct bt_mesh_subnet *)
|
|
#define LOOPBACK_BUF_SUB(buf) (*(struct bt_mesh_subnet **)net_buf_user_data(buf))
|
|
|
|
/* Seq limit after IV Update is triggered */
|
|
#define IV_UPDATE_SEQ_LIMIT 8000000
|
|
|
|
#define IVI(pdu) ((pdu)[0] >> 7)
|
|
#define NID(pdu) ((pdu)[0] & 0x7f)
|
|
#define CTL(pdu) ((pdu)[1] >> 7)
|
|
#define TTL(pdu) ((pdu)[1] & 0x7f)
|
|
#define SEQ(pdu) (sys_get_be24(&pdu[2]))
|
|
#define SRC(pdu) (sys_get_be16(&(pdu)[5]))
|
|
#define DST(pdu) (sys_get_be16(&(pdu)[7]))
|
|
|
|
static struct {
|
|
uint32_t src : 15, /* MSb of source is always 0 */
|
|
seq : 17;
|
|
} msg_cache[CONFIG_BT_MESH_MSG_CACHE_SIZE];
|
|
static uint16_t msg_cache_next;
|
|
|
|
/* Singleton network context (the implementation only supports one) */
|
|
struct bt_mesh_net bt_mesh = {
|
|
.local_queue = SYS_SLIST_STATIC_INIT(&bt_mesh.local_queue),
|
|
};
|
|
|
|
NET_BUF_POOL_DEFINE(loopback_buf_pool, CONFIG_BT_MESH_LOOPBACK_BUFS,
|
|
LOOPBACK_MAX_PDU_LEN, LOOPBACK_USER_DATA_SIZE, NULL);
|
|
|
|
static uint32_t dup_cache[CONFIG_BT_MESH_MSG_CACHE_SIZE];
|
|
static int dup_cache_next;
|
|
|
|
static bool check_dup(struct net_buf_simple *data)
|
|
{
|
|
const uint8_t *tail = net_buf_simple_tail(data);
|
|
uint32_t val;
|
|
int i;
|
|
|
|
val = sys_get_be32(tail - 4) ^ sys_get_be32(tail - 8);
|
|
|
|
for (i = 0; i < ARRAY_SIZE(dup_cache); i++) {
|
|
if (dup_cache[i] == val) {
|
|
return true;
|
|
}
|
|
}
|
|
|
|
dup_cache[dup_cache_next++] = val;
|
|
dup_cache_next %= ARRAY_SIZE(dup_cache);
|
|
|
|
return false;
|
|
}
|
|
|
|
static bool msg_cache_match(struct net_buf_simple *pdu)
|
|
{
|
|
uint16_t i;
|
|
|
|
for (i = 0U; i < ARRAY_SIZE(msg_cache); i++) {
|
|
if (msg_cache[i].src == SRC(pdu->data) &&
|
|
msg_cache[i].seq == (SEQ(pdu->data) & BIT_MASK(17))) {
|
|
return true;
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
static void msg_cache_add(struct bt_mesh_net_rx *rx)
|
|
{
|
|
rx->msg_cache_idx = msg_cache_next++;
|
|
msg_cache[rx->msg_cache_idx].src = rx->ctx.addr;
|
|
msg_cache[rx->msg_cache_idx].seq = rx->seq;
|
|
msg_cache_next %= ARRAY_SIZE(msg_cache);
|
|
}
|
|
|
|
int bt_mesh_net_create(uint16_t idx, uint8_t flags, const uint8_t key[16],
|
|
uint32_t iv_index)
|
|
{
|
|
int err;
|
|
|
|
BT_DBG("idx %u flags 0x%02x iv_index %u", idx, flags, iv_index);
|
|
|
|
BT_DBG("NetKey %s", bt_hex(key, 16));
|
|
|
|
if (BT_MESH_KEY_REFRESH(flags)) {
|
|
err = bt_mesh_subnet_set(idx, BT_MESH_KR_PHASE_2, NULL, key);
|
|
} else {
|
|
err = bt_mesh_subnet_set(idx, BT_MESH_KR_NORMAL, key, NULL);
|
|
}
|
|
|
|
if (err) {
|
|
BT_ERR("Failed creating subnet");
|
|
return err;
|
|
}
|
|
|
|
(void)memset(msg_cache, 0, sizeof(msg_cache));
|
|
msg_cache_next = 0U;
|
|
|
|
bt_mesh.iv_index = iv_index;
|
|
atomic_set_bit_to(bt_mesh.flags, BT_MESH_IVU_IN_PROGRESS,
|
|
BT_MESH_IV_UPDATE(flags));
|
|
|
|
/* Set minimum required hours, since the 96-hour minimum requirement
|
|
* doesn't apply straight after provisioning (since we can't know how
|
|
* long has actually passed since the network changed its state).
|
|
*/
|
|
bt_mesh.ivu_duration = BT_MESH_IVU_MIN_HOURS;
|
|
|
|
if (IS_ENABLED(CONFIG_BT_SETTINGS)) {
|
|
BT_DBG("Storing network information persistently");
|
|
bt_mesh_store_net();
|
|
bt_mesh_store_subnet(idx);
|
|
bt_mesh_store_iv(false);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#if defined(CONFIG_BT_MESH_IV_UPDATE_TEST)
|
|
void bt_mesh_iv_update_test(bool enable)
|
|
{
|
|
atomic_set_bit_to(bt_mesh.flags, BT_MESH_IVU_TEST, enable);
|
|
/* Reset the duration variable - needed for some PTS tests */
|
|
bt_mesh.ivu_duration = 0U;
|
|
}
|
|
|
|
bool bt_mesh_iv_update(void)
|
|
{
|
|
if (!bt_mesh_is_provisioned()) {
|
|
BT_ERR("Not yet provisioned");
|
|
return false;
|
|
}
|
|
|
|
if (atomic_test_bit(bt_mesh.flags, BT_MESH_IVU_IN_PROGRESS)) {
|
|
bt_mesh_net_iv_update(bt_mesh.iv_index, false);
|
|
} else {
|
|
bt_mesh_net_iv_update(bt_mesh.iv_index + 1, true);
|
|
}
|
|
|
|
return atomic_test_bit(bt_mesh.flags, BT_MESH_IVU_IN_PROGRESS);
|
|
}
|
|
#endif /* CONFIG_BT_MESH_IV_UPDATE_TEST */
|
|
|
|
bool bt_mesh_net_iv_update(uint32_t iv_index, bool iv_update)
|
|
{
|
|
if (atomic_test_bit(bt_mesh.flags, BT_MESH_IVU_IN_PROGRESS)) {
|
|
/* We're currently in IV Update mode */
|
|
|
|
if (iv_index != bt_mesh.iv_index) {
|
|
BT_WARN("IV Index mismatch: 0x%08x != 0x%08x",
|
|
iv_index, bt_mesh.iv_index);
|
|
return false;
|
|
}
|
|
|
|
if (iv_update) {
|
|
/* Nothing to do */
|
|
BT_DBG("Already in IV Update in Progress state");
|
|
return false;
|
|
}
|
|
} else {
|
|
/* We're currently in Normal mode */
|
|
|
|
if (iv_index == bt_mesh.iv_index) {
|
|
BT_DBG("Same IV Index in normal mode");
|
|
return false;
|
|
}
|
|
|
|
if (iv_index < bt_mesh.iv_index ||
|
|
iv_index > bt_mesh.iv_index + 42) {
|
|
BT_ERR("IV Index out of sync: 0x%08x != 0x%08x",
|
|
iv_index, bt_mesh.iv_index);
|
|
return false;
|
|
}
|
|
|
|
if (iv_index > bt_mesh.iv_index + 1) {
|
|
BT_WARN("Performing IV Index Recovery");
|
|
bt_mesh_rpl_clear();
|
|
bt_mesh.iv_index = iv_index;
|
|
bt_mesh.seq = 0U;
|
|
goto do_update;
|
|
}
|
|
|
|
if (iv_index == bt_mesh.iv_index + 1 && !iv_update) {
|
|
BT_WARN("Ignoring new index in normal mode");
|
|
return false;
|
|
}
|
|
|
|
if (!iv_update) {
|
|
/* Nothing to do */
|
|
BT_DBG("Already in Normal state");
|
|
return false;
|
|
}
|
|
}
|
|
|
|
if (!(IS_ENABLED(CONFIG_BT_MESH_IV_UPDATE_TEST) &&
|
|
atomic_test_bit(bt_mesh.flags, BT_MESH_IVU_TEST))) {
|
|
if (bt_mesh.ivu_duration < BT_MESH_IVU_MIN_HOURS) {
|
|
BT_WARN("IV Update before minimum duration");
|
|
return false;
|
|
}
|
|
}
|
|
|
|
/* Defer change to Normal Operation if there are pending acks */
|
|
if (!iv_update && bt_mesh_tx_in_progress()) {
|
|
BT_WARN("IV Update deferred because of pending transfer");
|
|
atomic_set_bit(bt_mesh.flags, BT_MESH_IVU_PENDING);
|
|
return false;
|
|
}
|
|
|
|
do_update:
|
|
atomic_set_bit_to(bt_mesh.flags, BT_MESH_IVU_IN_PROGRESS, iv_update);
|
|
bt_mesh.ivu_duration = 0U;
|
|
|
|
if (iv_update) {
|
|
bt_mesh.iv_index = iv_index;
|
|
BT_DBG("IV Update state entered. New index 0x%08x",
|
|
bt_mesh.iv_index);
|
|
|
|
bt_mesh_rpl_reset();
|
|
} else {
|
|
BT_DBG("Normal mode entered");
|
|
bt_mesh.seq = 0U;
|
|
}
|
|
|
|
k_delayed_work_submit(&bt_mesh.ivu_timer, BT_MESH_IVU_TIMEOUT);
|
|
|
|
/* Notify other modules */
|
|
if (IS_ENABLED(CONFIG_BT_MESH_FRIEND)) {
|
|
bt_mesh_friend_sec_update(BT_MESH_KEY_ANY);
|
|
}
|
|
|
|
if (IS_ENABLED(CONFIG_BT_MESH_GATT_PROXY) &&
|
|
bt_mesh_gatt_proxy_get() == BT_MESH_GATT_PROXY_ENABLED) {
|
|
bt_mesh_proxy_beacon_send(NULL);
|
|
}
|
|
|
|
bt_mesh_subnet_foreach(bt_mesh_beacon_update);
|
|
|
|
if (IS_ENABLED(CONFIG_BT_MESH_CDB)) {
|
|
bt_mesh_cdb_iv_update(iv_index, iv_update);
|
|
}
|
|
|
|
if (IS_ENABLED(CONFIG_BT_SETTINGS)) {
|
|
bt_mesh_store_iv(false);
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
uint32_t bt_mesh_next_seq(void)
|
|
{
|
|
uint32_t seq = bt_mesh.seq++;
|
|
|
|
if (IS_ENABLED(CONFIG_BT_SETTINGS)) {
|
|
bt_mesh_store_seq();
|
|
}
|
|
|
|
if (!atomic_test_bit(bt_mesh.flags, BT_MESH_IVU_IN_PROGRESS) &&
|
|
bt_mesh.seq > IV_UPDATE_SEQ_LIMIT &&
|
|
bt_mesh_subnet_get(BT_MESH_KEY_PRIMARY)) {
|
|
bt_mesh_beacon_ivu_initiator(true);
|
|
bt_mesh_net_iv_update(bt_mesh.iv_index + 1, true);
|
|
}
|
|
|
|
return seq;
|
|
}
|
|
|
|
static void bt_mesh_net_local(struct k_work *work)
|
|
{
|
|
struct net_buf *buf;
|
|
|
|
while ((buf = net_buf_slist_get(&bt_mesh.local_queue))) {
|
|
struct bt_mesh_subnet *sub = LOOPBACK_BUF_SUB(buf);
|
|
struct bt_mesh_net_rx rx = {
|
|
.ctx = {
|
|
.net_idx = sub->net_idx,
|
|
/* Initialize AppIdx to a sane value */
|
|
.app_idx = BT_MESH_KEY_UNUSED,
|
|
.recv_ttl = TTL(buf->data),
|
|
/* TTL=1 only goes to local IF */
|
|
.send_ttl = 1U,
|
|
.addr = SRC(buf->data),
|
|
.recv_dst = DST(buf->data),
|
|
.recv_rssi = 0,
|
|
},
|
|
.net_if = BT_MESH_NET_IF_LOCAL,
|
|
.sub = sub,
|
|
.old_iv = (IVI(buf->data) != (bt_mesh.iv_index & 0x01)),
|
|
.ctl = CTL(buf->data),
|
|
.seq = SEQ(buf->data),
|
|
.new_key = SUBNET_KEY_TX_IDX(sub),
|
|
.local_match = 1U,
|
|
.friend_match = 0U,
|
|
};
|
|
|
|
BT_DBG("src: 0x%04x dst: 0x%04x seq 0x%06x sub %p", rx.ctx.addr,
|
|
rx.ctx.addr, rx.seq, sub);
|
|
|
|
(void) bt_mesh_trans_recv(&buf->b, &rx);
|
|
net_buf_unref(buf);
|
|
}
|
|
}
|
|
|
|
static const struct bt_mesh_net_cred *net_tx_cred_get(struct bt_mesh_net_tx *tx)
|
|
{
|
|
#if defined(CONFIG_BT_MESH_LOW_POWER)
|
|
if (tx->friend_cred && bt_mesh_lpn_established()) {
|
|
return &bt_mesh.lpn.cred[SUBNET_KEY_TX_IDX(tx->sub)];
|
|
}
|
|
#endif
|
|
|
|
tx->friend_cred = 0U;
|
|
return &tx->sub->keys[SUBNET_KEY_TX_IDX(tx->sub)].msg;
|
|
}
|
|
|
|
static int net_header_encode(struct bt_mesh_net_tx *tx, uint8_t nid,
|
|
struct net_buf_simple *buf)
|
|
{
|
|
const bool ctl = (tx->ctx->app_idx == BT_MESH_KEY_UNUSED);
|
|
|
|
if (ctl && net_buf_simple_tailroom(buf) < 8) {
|
|
BT_ERR("Insufficient MIC space for CTL PDU");
|
|
return -EINVAL;
|
|
} else if (net_buf_simple_tailroom(buf) < 4) {
|
|
BT_ERR("Insufficient MIC space for PDU");
|
|
return -EINVAL;
|
|
}
|
|
|
|
BT_DBG("src 0x%04x dst 0x%04x ctl %u seq 0x%06x",
|
|
tx->src, tx->ctx->addr, ctl, bt_mesh.seq);
|
|
|
|
net_buf_simple_push_be16(buf, tx->ctx->addr);
|
|
net_buf_simple_push_be16(buf, tx->src);
|
|
net_buf_simple_push_be24(buf, bt_mesh_next_seq());
|
|
|
|
if (ctl) {
|
|
net_buf_simple_push_u8(buf, tx->ctx->send_ttl | 0x80);
|
|
} else {
|
|
net_buf_simple_push_u8(buf, tx->ctx->send_ttl);
|
|
}
|
|
|
|
net_buf_simple_push_u8(buf, (nid | (BT_MESH_NET_IVI_TX & 1) << 7));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int net_encrypt(struct net_buf_simple *buf,
|
|
const struct bt_mesh_net_cred *cred, uint32_t iv_index,
|
|
bool proxy)
|
|
{
|
|
int err;
|
|
|
|
err = bt_mesh_net_encrypt(cred->enc, buf, iv_index, proxy);
|
|
if (err) {
|
|
return err;
|
|
}
|
|
|
|
return bt_mesh_net_obfuscate(buf->data, iv_index, cred->privacy);
|
|
}
|
|
|
|
int bt_mesh_net_encode(struct bt_mesh_net_tx *tx, struct net_buf_simple *buf,
|
|
bool proxy)
|
|
{
|
|
const struct bt_mesh_net_cred *cred;
|
|
int err;
|
|
|
|
cred = net_tx_cred_get(tx);
|
|
err = net_header_encode(tx, cred->nid, buf);
|
|
if (err) {
|
|
return err;
|
|
}
|
|
|
|
return net_encrypt(buf, cred, BT_MESH_NET_IVI_TX, proxy);
|
|
}
|
|
|
|
static int loopback(const struct bt_mesh_net_tx *tx, const uint8_t *data,
|
|
size_t len)
|
|
{
|
|
struct net_buf *buf;
|
|
|
|
buf = net_buf_alloc(&loopback_buf_pool, K_NO_WAIT);
|
|
if (!buf) {
|
|
BT_WARN("Unable to allocate loopback");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
BT_DBG("");
|
|
|
|
LOOPBACK_BUF_SUB(buf) = tx->sub;
|
|
|
|
net_buf_add_mem(buf, data, len);
|
|
|
|
net_buf_slist_put(&bt_mesh.local_queue, buf);
|
|
|
|
k_work_submit(&bt_mesh.local_work);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int bt_mesh_net_send(struct bt_mesh_net_tx *tx, struct net_buf *buf,
|
|
const struct bt_mesh_send_cb *cb, void *cb_data)
|
|
{
|
|
const struct bt_mesh_net_cred *cred;
|
|
int err;
|
|
|
|
BT_DBG("src 0x%04x dst 0x%04x len %u headroom %zu tailroom %zu",
|
|
tx->src, tx->ctx->addr, buf->len, net_buf_headroom(buf),
|
|
net_buf_tailroom(buf));
|
|
BT_DBG("Payload len %u: %s", buf->len, bt_hex(buf->data, buf->len));
|
|
BT_DBG("Seq 0x%06x", bt_mesh.seq);
|
|
|
|
cred = net_tx_cred_get(tx);
|
|
err = net_header_encode(tx, cred->nid, &buf->b);
|
|
if (err) {
|
|
goto done;
|
|
}
|
|
|
|
/* Deliver to local network interface if necessary */
|
|
if (bt_mesh_fixed_group_match(tx->ctx->addr) ||
|
|
bt_mesh_elem_find(tx->ctx->addr)) {
|
|
err = loopback(tx, buf->data, buf->len);
|
|
|
|
/* Local unicast messages should not go out to network */
|
|
if (BT_MESH_ADDR_IS_UNICAST(tx->ctx->addr) ||
|
|
tx->ctx->send_ttl == 1U) {
|
|
if (!err) {
|
|
send_cb_finalize(cb, cb_data);
|
|
}
|
|
|
|
goto done;
|
|
}
|
|
}
|
|
|
|
/* Mesh spec 3.4.5.2: "The output filter of the interface connected to
|
|
* advertising or GATT bearers shall drop all messages with TTL value
|
|
* set to 1." If a TTL=1 packet wasn't for a local interface, it is
|
|
* invalid.
|
|
*/
|
|
if (tx->ctx->send_ttl == 1U) {
|
|
err = -EINVAL;
|
|
goto done;
|
|
}
|
|
|
|
err = net_encrypt(&buf->b, cred, BT_MESH_NET_IVI_TX, false);
|
|
if (err) {
|
|
goto done;
|
|
}
|
|
|
|
/* Deliver to GATT Proxy Clients if necessary. */
|
|
if (IS_ENABLED(CONFIG_BT_MESH_GATT_PROXY) &&
|
|
bt_mesh_proxy_relay(&buf->b, tx->ctx->addr) &&
|
|
BT_MESH_ADDR_IS_UNICAST(tx->ctx->addr)) {
|
|
/* Notify completion if this only went through the Mesh Proxy */
|
|
send_cb_finalize(cb, cb_data);
|
|
|
|
err = 0;
|
|
goto done;
|
|
}
|
|
|
|
bt_mesh_adv_send(buf, cb, cb_data);
|
|
|
|
done:
|
|
net_buf_unref(buf);
|
|
return err;
|
|
}
|
|
|
|
void bt_mesh_net_loopback_clear(uint16_t net_idx)
|
|
{
|
|
sys_slist_t new_list;
|
|
struct net_buf *buf;
|
|
|
|
BT_DBG("0x%04x", net_idx);
|
|
|
|
sys_slist_init(&new_list);
|
|
|
|
while ((buf = net_buf_slist_get(&bt_mesh.local_queue))) {
|
|
struct bt_mesh_subnet *sub = LOOPBACK_BUF_SUB(buf);
|
|
|
|
if (net_idx == BT_MESH_KEY_ANY || net_idx == sub->net_idx) {
|
|
BT_DBG("Dropped 0x%06x", SEQ(buf->data));
|
|
net_buf_unref(buf);
|
|
} else {
|
|
net_buf_slist_put(&new_list, buf);
|
|
}
|
|
}
|
|
|
|
bt_mesh.local_queue = new_list;
|
|
}
|
|
|
|
static bool net_decrypt(struct bt_mesh_net_rx *rx, struct net_buf_simple *in,
|
|
struct net_buf_simple *out,
|
|
const struct bt_mesh_net_cred *cred)
|
|
{
|
|
bool proxy = (rx->net_if == BT_MESH_NET_IF_PROXY_CFG);
|
|
|
|
if (NID(in->data) != cred->nid) {
|
|
return false;
|
|
}
|
|
|
|
BT_DBG("NID 0x%02x", NID(in->data));
|
|
BT_DBG("IVI %u net->iv_index 0x%08x", IVI(in->data), bt_mesh.iv_index);
|
|
|
|
rx->old_iv = (IVI(in->data) != (bt_mesh.iv_index & 0x01));
|
|
|
|
net_buf_simple_reset(out);
|
|
net_buf_simple_add_mem(out, in->data, in->len);
|
|
|
|
if (bt_mesh_net_obfuscate(out->data, BT_MESH_NET_IVI_RX(rx),
|
|
cred->privacy)) {
|
|
return false;
|
|
}
|
|
|
|
rx->ctx.addr = SRC(out->data);
|
|
if (!BT_MESH_ADDR_IS_UNICAST(rx->ctx.addr)) {
|
|
BT_DBG("Ignoring non-unicast src addr 0x%04x", rx->ctx.addr);
|
|
return false;
|
|
}
|
|
|
|
if (bt_mesh_elem_find(rx->ctx.addr)) {
|
|
BT_DBG("Dropping locally originated packet");
|
|
return false;
|
|
}
|
|
|
|
if (rx->net_if == BT_MESH_NET_IF_ADV && msg_cache_match(out)) {
|
|
BT_DBG("Duplicate found in Network Message Cache");
|
|
return false;
|
|
}
|
|
|
|
BT_DBG("src 0x%04x", rx->ctx.addr);
|
|
|
|
return bt_mesh_net_decrypt(cred->enc, out, BT_MESH_NET_IVI_RX(rx),
|
|
proxy) == 0;
|
|
}
|
|
|
|
/* Relaying from advertising to the advertising bearer should only happen
|
|
* if the Relay state is set to enabled. Locally originated packets always
|
|
* get sent to the advertising bearer. If the packet came in through GATT,
|
|
* then we should only relay it if the GATT Proxy state is enabled.
|
|
*/
|
|
static bool relay_to_adv(enum bt_mesh_net_if net_if)
|
|
{
|
|
switch (net_if) {
|
|
case BT_MESH_NET_IF_ADV:
|
|
return (bt_mesh_relay_get() == BT_MESH_RELAY_ENABLED);
|
|
case BT_MESH_NET_IF_PROXY:
|
|
return (bt_mesh_gatt_proxy_get() == BT_MESH_GATT_PROXY_ENABLED);
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static void bt_mesh_net_relay(struct net_buf_simple *sbuf,
|
|
struct bt_mesh_net_rx *rx)
|
|
{
|
|
const struct bt_mesh_net_cred *cred;
|
|
struct net_buf *buf;
|
|
uint8_t transmit;
|
|
|
|
if (rx->ctx.recv_ttl <= 1U) {
|
|
return;
|
|
}
|
|
|
|
if (rx->net_if == BT_MESH_NET_IF_ADV &&
|
|
!rx->friend_cred &&
|
|
bt_mesh_relay_get() != BT_MESH_RELAY_ENABLED &&
|
|
bt_mesh_gatt_proxy_get() != BT_MESH_GATT_PROXY_ENABLED) {
|
|
return;
|
|
}
|
|
|
|
BT_DBG("TTL %u CTL %u dst 0x%04x", rx->ctx.recv_ttl, rx->ctl,
|
|
rx->ctx.recv_dst);
|
|
|
|
/* The Relay Retransmit state is only applied to adv-adv relaying.
|
|
* Anything else (like GATT to adv, or locally originated packets)
|
|
* use the Network Transmit state.
|
|
*/
|
|
if (rx->net_if == BT_MESH_NET_IF_ADV && !rx->friend_cred) {
|
|
transmit = bt_mesh_relay_retransmit_get();
|
|
} else {
|
|
transmit = bt_mesh_net_transmit_get();
|
|
}
|
|
|
|
buf = bt_mesh_adv_create(BT_MESH_ADV_DATA, transmit, K_NO_WAIT);
|
|
if (!buf) {
|
|
BT_ERR("Out of relay buffers");
|
|
return;
|
|
}
|
|
|
|
/* Leave CTL bit intact */
|
|
sbuf->data[1] &= 0x80;
|
|
sbuf->data[1] |= rx->ctx.recv_ttl - 1U;
|
|
|
|
net_buf_add_mem(buf, sbuf->data, sbuf->len);
|
|
|
|
cred = &rx->sub->keys[SUBNET_KEY_TX_IDX(rx->sub)].msg;
|
|
|
|
BT_DBG("Relaying packet. TTL is now %u", TTL(buf->data));
|
|
|
|
/* Update NID if RX or RX was with friend credentials */
|
|
if (rx->friend_cred) {
|
|
buf->data[0] &= 0x80; /* Clear everything except IVI */
|
|
buf->data[0] |= cred->nid;
|
|
}
|
|
|
|
/* We re-encrypt and obfuscate using the received IVI rather than
|
|
* the normal TX IVI (which may be different) since the transport
|
|
* layer nonce includes the IVI.
|
|
*/
|
|
if (net_encrypt(&buf->b, cred, BT_MESH_NET_IVI_RX(rx), false)) {
|
|
BT_ERR("Re-encrypting failed");
|
|
goto done;
|
|
}
|
|
|
|
/* When the Friend node relays message for lpn, the message will be
|
|
* retransmitted using the managed master security credentials and
|
|
* the Network PDU shall be retransmitted to all network interfaces.
|
|
*/
|
|
if (IS_ENABLED(CONFIG_BT_MESH_GATT_PROXY) &&
|
|
(rx->friend_cred ||
|
|
bt_mesh_gatt_proxy_get() == BT_MESH_GATT_PROXY_ENABLED)) {
|
|
bt_mesh_proxy_relay(&buf->b, rx->ctx.recv_dst);
|
|
}
|
|
|
|
if (relay_to_adv(rx->net_if) || rx->friend_cred) {
|
|
bt_mesh_adv_send(buf, NULL, NULL);
|
|
}
|
|
|
|
done:
|
|
net_buf_unref(buf);
|
|
}
|
|
|
|
void bt_mesh_net_header_parse(struct net_buf_simple *buf,
|
|
struct bt_mesh_net_rx *rx)
|
|
{
|
|
rx->old_iv = (IVI(buf->data) != (bt_mesh.iv_index & 0x01));
|
|
rx->ctl = CTL(buf->data);
|
|
rx->ctx.recv_ttl = TTL(buf->data);
|
|
rx->seq = SEQ(buf->data);
|
|
rx->ctx.addr = SRC(buf->data);
|
|
rx->ctx.recv_dst = DST(buf->data);
|
|
}
|
|
|
|
int bt_mesh_net_decode(struct net_buf_simple *in, enum bt_mesh_net_if net_if,
|
|
struct bt_mesh_net_rx *rx, struct net_buf_simple *out)
|
|
{
|
|
if (in->len < BT_MESH_NET_MIN_PDU_LEN) {
|
|
BT_WARN("Dropping too short mesh packet (len %u)", in->len);
|
|
BT_WARN("%s", bt_hex(in->data, in->len));
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (net_if == BT_MESH_NET_IF_ADV && check_dup(in)) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
BT_DBG("%u bytes: %s", in->len, bt_hex(in->data, in->len));
|
|
|
|
rx->net_if = net_if;
|
|
|
|
if (!bt_mesh_net_cred_find(rx, in, out, net_decrypt)) {
|
|
BT_DBG("Unable to find matching net for packet");
|
|
return -ENOENT;
|
|
}
|
|
|
|
/* Initialize AppIdx to a sane value */
|
|
rx->ctx.app_idx = BT_MESH_KEY_UNUSED;
|
|
|
|
rx->ctx.recv_ttl = TTL(out->data);
|
|
|
|
/* Default to responding with TTL 0 for non-routed messages */
|
|
if (rx->ctx.recv_ttl == 0U) {
|
|
rx->ctx.send_ttl = 0U;
|
|
} else {
|
|
rx->ctx.send_ttl = BT_MESH_TTL_DEFAULT;
|
|
}
|
|
|
|
rx->ctl = CTL(out->data);
|
|
rx->seq = SEQ(out->data);
|
|
rx->ctx.recv_dst = DST(out->data);
|
|
|
|
BT_DBG("Decryption successful. Payload len %u", out->len);
|
|
|
|
if (net_if != BT_MESH_NET_IF_PROXY_CFG &&
|
|
rx->ctx.recv_dst == BT_MESH_ADDR_UNASSIGNED) {
|
|
BT_ERR("Destination address is unassigned; dropping packet");
|
|
return -EBADMSG;
|
|
}
|
|
|
|
BT_DBG("src 0x%04x dst 0x%04x ttl %u", rx->ctx.addr, rx->ctx.recv_dst,
|
|
rx->ctx.recv_ttl);
|
|
BT_DBG("PDU: %s", bt_hex(out->data, out->len));
|
|
|
|
msg_cache_add(rx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void bt_mesh_net_recv(struct net_buf_simple *data, int8_t rssi,
|
|
enum bt_mesh_net_if net_if)
|
|
{
|
|
NET_BUF_SIMPLE_DEFINE(buf, 29);
|
|
struct bt_mesh_net_rx rx = { .ctx.recv_rssi = rssi };
|
|
struct net_buf_simple_state state;
|
|
|
|
BT_DBG("rssi %d net_if %u", rssi, net_if);
|
|
|
|
if (!bt_mesh_is_provisioned()) {
|
|
return;
|
|
}
|
|
|
|
if (bt_mesh_net_decode(data, net_if, &rx, &buf)) {
|
|
return;
|
|
}
|
|
|
|
/* Save the state so the buffer can later be relayed */
|
|
net_buf_simple_save(&buf, &state);
|
|
|
|
rx.local_match = (bt_mesh_fixed_group_match(rx.ctx.recv_dst) ||
|
|
bt_mesh_elem_find(rx.ctx.recv_dst));
|
|
|
|
if (IS_ENABLED(CONFIG_BT_MESH_GATT_PROXY) &&
|
|
net_if == BT_MESH_NET_IF_PROXY) {
|
|
bt_mesh_proxy_addr_add(data, rx.ctx.addr);
|
|
|
|
if (bt_mesh_gatt_proxy_get() == BT_MESH_GATT_PROXY_DISABLED &&
|
|
!rx.local_match) {
|
|
BT_INFO("Proxy is disabled; ignoring message");
|
|
return;
|
|
}
|
|
}
|
|
|
|
/* The transport layer has indicated that it has rejected the message,
|
|
* but would like to see it again if it is received in the future.
|
|
* This can happen if a message is received when the device is in
|
|
* Low Power mode, but the message was not encrypted with the friend
|
|
* credentials. Remove it from the message cache so that we accept
|
|
* it again in the future.
|
|
*/
|
|
if (bt_mesh_trans_recv(&buf, &rx) == -EAGAIN) {
|
|
BT_WARN("Removing rejected message from Network Message Cache");
|
|
msg_cache[rx.msg_cache_idx].src = BT_MESH_ADDR_UNASSIGNED;
|
|
/* Rewind the next index now that we're not using this entry */
|
|
msg_cache_next = rx.msg_cache_idx;
|
|
}
|
|
|
|
/* Relay if this was a group/virtual address, or if the destination
|
|
* was neither a local element nor an LPN we're Friends for.
|
|
*/
|
|
if (!BT_MESH_ADDR_IS_UNICAST(rx.ctx.recv_dst) ||
|
|
(!rx.local_match && !rx.friend_match)) {
|
|
net_buf_simple_restore(&buf, &state);
|
|
bt_mesh_net_relay(&buf, &rx);
|
|
}
|
|
}
|
|
|
|
static void ivu_refresh(struct k_work *work)
|
|
{
|
|
bt_mesh.ivu_duration += BT_MESH_IVU_HOURS;
|
|
|
|
BT_DBG("%s for %u hour%s",
|
|
atomic_test_bit(bt_mesh.flags, BT_MESH_IVU_IN_PROGRESS) ?
|
|
"IVU in Progress" : "IVU Normal mode",
|
|
bt_mesh.ivu_duration, bt_mesh.ivu_duration == 1U ? "" : "s");
|
|
|
|
if (bt_mesh.ivu_duration < BT_MESH_IVU_MIN_HOURS) {
|
|
if (IS_ENABLED(CONFIG_BT_SETTINGS)) {
|
|
bt_mesh_store_iv(true);
|
|
}
|
|
|
|
k_delayed_work_submit(&bt_mesh.ivu_timer, BT_MESH_IVU_TIMEOUT);
|
|
return;
|
|
}
|
|
|
|
if (atomic_test_bit(bt_mesh.flags, BT_MESH_IVU_IN_PROGRESS)) {
|
|
bt_mesh_beacon_ivu_initiator(true);
|
|
bt_mesh_net_iv_update(bt_mesh.iv_index, false);
|
|
} else if (IS_ENABLED(CONFIG_BT_SETTINGS)) {
|
|
bt_mesh_store_iv(true);
|
|
}
|
|
}
|
|
|
|
void bt_mesh_net_init(void)
|
|
{
|
|
k_delayed_work_init(&bt_mesh.ivu_timer, ivu_refresh);
|
|
|
|
k_work_init(&bt_mesh.local_work, bt_mesh_net_local);
|
|
}
|