blob: aa762e9b906a1e1eabb6d2141f2f9712d58d065d [file] [log] [blame]
/*
* Copyright (c) 2017 Intel Corporation
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <zephyr/kernel.h>
#include <string.h>
#include <errno.h>
#include <stdbool.h>
#include <zephyr/types.h>
#include <zephyr/sys/util.h>
#include <zephyr/sys/byteorder.h>
#include <zephyr/sys/check.h>
#include <zephyr/bluetooth/bluetooth.h>
#include <zephyr/bluetooth/conn.h>
#include <zephyr/bluetooth/mesh.h>
#include "common/bt_str.h"
#include "access.h"
#include "net.h"
#include "foundation.h"
#include "msg.h"
#define LOG_LEVEL CONFIG_BT_MESH_MODEL_LOG_LEVEL
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(bt_mesh_cfg_cli);
#define CID_NVAL 0xffff
/* 2 byte dummy opcode for getting compile time buffer sizes. */
#define DUMMY_2_BYTE_OP BT_MESH_MODEL_OP_2(0xff, 0xff)
#define COR_PRESENT(hdr) ((hdr) & BIT(0))
#define FMT(hdr) ((hdr) & BIT(1))
#define EXT_ITEM_CNT(hdr) ((hdr) >> 2)
#define OFFSET(item) (item & (uint8_t)BIT_MASK(5))
#define IDX(item) (item >> 3)
struct comp_data {
uint8_t *page;
struct net_buf_simple *comp;
};
static int32_t msg_timeout;
static struct bt_mesh_cfg_cli *cli;
static int comp_data_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct net_buf_simple_state state;
struct comp_data *param;
size_t to_copy;
uint8_t page;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
page = net_buf_simple_pull_u8(buf);
net_buf_simple_save(buf, &state);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_DEV_COMP_DATA_STATUS, ctx->addr,
(void **)&param)) {
if (param->page) {
*(param->page) = page;
}
if (param->comp) {
to_copy = MIN(net_buf_simple_tailroom(param->comp), buf->len);
net_buf_simple_add_mem(param->comp, buf->data, to_copy);
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
net_buf_simple_restore(buf, &state);
if (cli->cb && cli->cb->comp_data) {
cli->cb->comp_data(cli, ctx->addr, page, buf);
}
return 0;
}
static uint8_t state_status_u8(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf,
uint32_t expect_status)
{
uint8_t *param;
uint8_t status;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
status = net_buf_simple_pull_u8(buf);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, expect_status, ctx->addr,
(void **)&param)) {
if (param) {
*param = status;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
return status;
}
static int beacon_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
uint8_t status;
status = state_status_u8(model, ctx, buf, OP_BEACON_STATUS);
if (cli->cb && cli->cb->beacon_status) {
cli->cb->beacon_status(cli, ctx->addr, status);
}
return 0;
}
static int ttl_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
uint8_t status;
status = state_status_u8(model, ctx, buf, OP_DEFAULT_TTL_STATUS);
if (cli->cb && cli->cb->ttl_status) {
cli->cb->ttl_status(cli, ctx->addr, status);
}
return 0;
}
static int friend_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
uint8_t status;
status = state_status_u8(model, ctx, buf, OP_FRIEND_STATUS);
if (cli->cb && cli->cb->friend_status) {
cli->cb->friend_status(cli, ctx->addr, status);
}
return 0;
}
static int gatt_proxy_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
uint8_t status;
status = state_status_u8(model, ctx, buf, OP_GATT_PROXY_STATUS);
if (cli->cb && cli->cb->gatt_proxy_status) {
cli->cb->gatt_proxy_status(cli, ctx->addr, status);
}
return 0;
}
struct krp_param {
uint8_t *status;
uint16_t net_idx;
uint8_t *phase;
};
static int krp_status(const struct bt_mesh_model *model, struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
int err = 0;
struct krp_param *param;
uint16_t net_idx;
uint8_t status, phase;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
status = net_buf_simple_pull_u8(buf);
net_idx = net_buf_simple_pull_le16(buf) & 0xfff;
phase = net_buf_simple_pull_u8(buf);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_KRP_STATUS, ctx->addr, (void **)&param)) {
if (param->net_idx != net_idx) {
err = -ENOENT;
goto done;
}
if (param->status) {
*param->status = status;
}
if (param->phase) {
*param->phase = phase;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
done:
if (cli->cb && cli->cb->krp_status) {
cli->cb->krp_status(cli, ctx->addr, status, net_idx, phase);
}
return err;
}
struct relay_param {
uint8_t *status;
uint8_t *transmit;
};
static int relay_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct relay_param *param;
uint8_t status;
uint8_t transmit;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
status = net_buf_simple_pull_u8(buf);
transmit = net_buf_simple_pull_u8(buf);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_RELAY_STATUS, ctx->addr,
(void **)&param)) {
if (param->status) {
*param->status = status;
}
if (param->transmit) {
*param->transmit = transmit;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
if (cli->cb && cli->cb->relay_status) {
cli->cb->relay_status(cli, ctx->addr, status, transmit);
}
return 0;
}
static int net_transmit_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
uint8_t status;
status = state_status_u8(model, ctx, buf, OP_NET_TRANSMIT_STATUS);
if (cli->cb && cli->cb->network_transmit_status) {
cli->cb->network_transmit_status(cli, ctx->addr, status);
}
return 0;
}
struct net_key_param {
uint8_t *status;
uint16_t net_idx;
};
static int net_key_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct net_key_param *param;
uint16_t net_idx;
uint8_t status;
int err;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
status = net_buf_simple_pull_u8(buf);
net_idx = net_buf_simple_pull_le16(buf) & 0xfff;
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_NET_KEY_STATUS, ctx->addr,
(void **)&param)) {
if (param->net_idx != net_idx) {
LOG_WRN("Net Key Status key index does not match");
err = -ENOENT;
goto done;
}
if (param->status) {
*param->status = status;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
err = 0;
done:
if (cli->cb && cli->cb->net_key_status) {
cli->cb->net_key_status(cli, ctx->addr, status, net_idx);
}
return err;
}
struct net_key_list_param {
uint16_t *keys;
size_t *key_cnt;
};
int bt_mesh_key_idx_unpack_list(struct net_buf_simple *buf, uint16_t *dst_arr,
size_t *dst_cnt)
{
size_t i;
if (!dst_cnt) {
return 0;
}
for (i = 0; (i + 1) < *dst_cnt && buf->len >= 3; i += 2) {
key_idx_unpack_pair(buf, &dst_arr[i], &dst_arr[i + 1]);
}
if (i < *dst_cnt && buf->len >= 2) {
dst_arr[i++] = net_buf_simple_pull_le16(buf) & 0xfff;
}
*dst_cnt = i;
return buf->len > 0 ? -EMSGSIZE : 0;
}
static int net_key_list(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
int err = 0;
struct net_key_list_param *param;
struct net_buf_simple_state state;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
net_buf_simple_save(buf, &state);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_NET_KEY_LIST, ctx->addr, (void **)&param)) {
if (param->keys && param->key_cnt) {
err = bt_mesh_key_idx_unpack_list(buf, param->keys, param->key_cnt);
if (err) {
LOG_ERR("The message size for the application opcode is "
"incorrect.");
goto done;
}
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
done:
net_buf_simple_restore(buf, &state);
if (cli->cb && cli->cb->net_key_list) {
cli->cb->net_key_list(cli, ctx->addr, buf);
}
return err;
}
static int node_reset_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
bool *param = NULL;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x", ctx->net_idx, ctx->app_idx, ctx->addr);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_NODE_RESET_STATUS,
ctx->addr, (void **)&param)) {
if (param) {
*param = true;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
if (cli->cb && cli->cb->node_reset_status) {
cli->cb->node_reset_status(cli, ctx->addr);
}
return 0;
}
struct app_key_param {
uint8_t *status;
uint16_t net_idx;
uint16_t app_idx;
};
static int app_key_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct app_key_param *param;
uint16_t net_idx, app_idx;
uint8_t status;
int err;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
status = net_buf_simple_pull_u8(buf);
key_idx_unpack_pair(buf, &net_idx, &app_idx);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_APP_KEY_STATUS, ctx->addr,
(void **)&param)) {
if (param->net_idx != net_idx || param->app_idx != app_idx) {
LOG_WRN("App Key Status key indices did not match");
err = -ENOENT;
goto done;
}
if (param->status) {
*param->status = status;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
err = 0;
done:
if (cli->cb && cli->cb->app_key_status) {
cli->cb->app_key_status(cli, ctx->addr, status, net_idx,
app_idx);
}
return err;
}
struct app_key_list_param {
uint16_t net_idx;
uint8_t *status;
uint16_t *keys;
size_t *key_cnt;
};
static int app_key_list(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
int err = 0;
struct net_buf_simple_state state;
struct app_key_list_param *param;
uint16_t net_idx;
uint8_t status;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
status = net_buf_simple_pull_u8(buf);
net_idx = net_buf_simple_pull_le16(buf) & 0xfff;
net_buf_simple_save(buf, &state);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_APP_KEY_LIST, ctx->addr,
(void **)&param)) {
if (param->net_idx != net_idx) {
LOG_WRN("App Key List Net Key index did not match");
return -ENOENT;
}
if (param->keys && param->key_cnt) {
err = bt_mesh_key_idx_unpack_list(buf, param->keys, param->key_cnt);
if (err) {
LOG_ERR("The message size for the application opcode is "
"incorrect.");
goto done;
}
}
if (param->status) {
*param->status = status;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
done:
net_buf_simple_restore(buf, &state);
if (cli->cb && cli->cb->app_key_list) {
cli->cb->app_key_list(cli, ctx->addr, status, net_idx, buf);
}
return err;
}
struct mod_app_param {
uint8_t *status;
uint16_t elem_addr;
uint16_t mod_app_idx;
uint16_t mod_id;
uint16_t cid;
};
static int mod_app_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct mod_app_param *param;
uint16_t elem_addr, mod_app_idx, mod_id, cid;
uint8_t status;
int err;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
if ((buf->len != 7U) && (buf->len != 9U)) {
LOG_ERR("The message size for the application opcode is incorrect.");
return -EMSGSIZE;
}
status = net_buf_simple_pull_u8(buf);
elem_addr = net_buf_simple_pull_le16(buf);
mod_app_idx = net_buf_simple_pull_le16(buf);
if (buf->len >= 4U) {
cid = net_buf_simple_pull_le16(buf);
} else {
cid = CID_NVAL;
}
mod_id = net_buf_simple_pull_le16(buf);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_MOD_APP_STATUS, ctx->addr,
(void **)&param)) {
if (param->elem_addr != elem_addr ||
param->mod_app_idx != mod_app_idx ||
param->mod_id != mod_id || param->cid != cid) {
LOG_WRN("Model App Status parameters did not match");
err = -ENOENT;
goto done;
}
if (param->status) {
*param->status = status;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
err = 0;
done:
if (cli->cb && cli->cb->mod_app_status) {
cli->cb->mod_app_status(cli, ctx->addr, status, elem_addr,
mod_app_idx, (cid << 16) | mod_id);
}
return err;
}
struct mod_member_list_param {
uint8_t *status;
uint16_t elem_addr;
uint16_t mod_id;
uint16_t cid;
uint16_t *members;
size_t *member_cnt;
};
static int mod_sub_list_handle(struct bt_mesh_msg_ctx *ctx, struct net_buf_simple *buf, uint16_t op,
bool vnd)
{
int err = 0;
struct mod_member_list_param *param;
struct net_buf_simple_state state;
uint16_t elem_addr, mod_id, cid;
uint8_t status;
status = net_buf_simple_pull_u8(buf);
elem_addr = net_buf_simple_pull_le16(buf);
cid = vnd ? net_buf_simple_pull_le16(buf) : CID_NVAL;
mod_id = net_buf_simple_pull_le16(buf);
if (buf->len % 2) {
LOG_WRN("Model Member List invalid length");
return -EMSGSIZE;
}
net_buf_simple_save(buf, &state);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, op, ctx->addr, (void **)&param)) {
if (param->elem_addr != elem_addr || param->mod_id != mod_id ||
(vnd && param->cid != cid)) {
LOG_WRN("Model Member List parameters did not match");
err = -ENOENT;
goto done;
}
if (param->member_cnt && param->members) {
int i;
for (i = 0; i < *param->member_cnt && buf->len; i++) {
param->members[i] = net_buf_simple_pull_le16(buf);
}
*param->member_cnt = i;
}
if (param->status) {
*param->status = status;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
done:
net_buf_simple_restore(buf, &state);
if (cli->cb && cli->cb->mod_sub_list) {
cli->cb->mod_sub_list(cli, ctx->addr, status, elem_addr, mod_id, cid, buf);
}
return err;
}
static int mod_app_list_handle(struct bt_mesh_msg_ctx *ctx, struct net_buf_simple *buf, uint16_t op,
bool vnd)
{
int err = 0;
struct net_buf_simple_state state;
struct mod_member_list_param *param;
uint16_t elem_addr, mod_id, cid;
uint8_t status;
status = net_buf_simple_pull_u8(buf);
elem_addr = net_buf_simple_pull_le16(buf);
cid = vnd ? net_buf_simple_pull_le16(buf) : CID_NVAL;
mod_id = net_buf_simple_pull_le16(buf);
net_buf_simple_save(buf, &state);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, op, ctx->addr, (void **)&param)) {
if (param->elem_addr != elem_addr || param->mod_id != mod_id ||
(vnd && param->cid != cid)) {
LOG_WRN("Model Member List parameters did not match");
return -ENOENT;
}
if (param->member_cnt && param->members) {
err = bt_mesh_key_idx_unpack_list(buf, param->members, param->member_cnt);
if (err) {
LOG_ERR("The message size for the application opcode is "
"incorrect.");
goto done;
}
}
if (param->status) {
*param->status = status;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
done:
net_buf_simple_restore(buf, &state);
if (cli->cb && cli->cb->mod_app_list) {
cli->cb->mod_app_list(cli, ctx->addr, status, elem_addr, mod_id, cid, buf);
}
return err;
}
static int mod_app_list(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx, struct net_buf_simple *buf)
{
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
return mod_app_list_handle(ctx, buf, OP_SIG_MOD_APP_LIST, false);
}
static int mod_app_list_vnd(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
return mod_app_list_handle(ctx, buf, OP_VND_MOD_APP_LIST, true);
}
struct mod_pub_param {
uint16_t mod_id;
uint16_t cid;
uint16_t elem_addr;
uint8_t *status;
struct bt_mesh_cfg_cli_mod_pub *pub;
};
static int mod_pub_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
int err = 0;
struct mod_pub_param *param;
uint16_t mod_id, cid, elem_addr;
struct bt_mesh_cfg_cli_mod_pub pub;
uint8_t status;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
if ((buf->len != 12U) && (buf->len != 14U)) {
LOG_ERR("The message size for the application opcode is incorrect.");
return -EINVAL;
}
status = net_buf_simple_pull_u8(buf);
elem_addr = net_buf_simple_pull_le16(buf);
pub.addr = net_buf_simple_pull_le16(buf);
pub.app_idx = net_buf_simple_pull_le16(buf);
pub.cred_flag = (pub.app_idx & BIT(12));
pub.app_idx &= BIT_MASK(12);
pub.ttl = net_buf_simple_pull_u8(buf);
pub.period = net_buf_simple_pull_u8(buf);
pub.transmit = net_buf_simple_pull_u8(buf);
if (buf->len == 4U) {
cid = net_buf_simple_pull_le16(buf);
mod_id = net_buf_simple_pull_le16(buf);
} else {
cid = CID_NVAL;
mod_id = net_buf_simple_pull_le16(buf);
}
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_MOD_PUB_STATUS, ctx->addr,
(void **)&param)) {
if (mod_id != param->mod_id || cid != param->cid) {
LOG_WRN("Mod Pub Model ID or Company ID mismatch");
err = -ENOENT;
goto done;
}
if (elem_addr != param->elem_addr) {
LOG_WRN("Model Pub Status for unexpected element (0x%04x)", elem_addr);
err = -ENOENT;
goto done;
}
if (param->status) {
*param->status = status;
}
if (param->pub) {
param->pub->addr = pub.addr;
param->pub->app_idx = pub.app_idx;
param->pub->cred_flag = pub.cred_flag;
param->pub->ttl = pub.ttl;
param->pub->period = pub.period;
param->pub->transmit = pub.transmit;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
done:
if (cli->cb && cli->cb->mod_pub_status) {
cli->cb->mod_pub_status(cli, ctx->addr, status, elem_addr, mod_id, cid, &pub);
}
return err;
}
struct mod_sub_param {
uint8_t *status;
uint16_t elem_addr;
uint16_t *sub_addr;
uint16_t *expect_sub;
uint16_t mod_id;
uint16_t cid;
};
static int mod_sub_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct mod_sub_param *param;
uint16_t elem_addr, sub_addr, mod_id, cid;
uint8_t status;
int err = 0;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
if ((buf->len != 7U) && (buf->len != 9U)) {
LOG_ERR("The message size for the application opcode is incorrect.");
return -EINVAL;
}
status = net_buf_simple_pull_u8(buf);
elem_addr = net_buf_simple_pull_le16(buf);
sub_addr = net_buf_simple_pull_le16(buf);
if (buf->len >= 4U) {
cid = net_buf_simple_pull_le16(buf);
} else {
cid = CID_NVAL;
}
mod_id = net_buf_simple_pull_le16(buf);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_MOD_SUB_STATUS,
ctx->addr, (void **)&param)) {
if (param->elem_addr != elem_addr || param->mod_id != mod_id ||
(param->expect_sub && *param->expect_sub != sub_addr) ||
param->cid != cid) {
LOG_WRN("Model Subscription Status parameters did not match");
err = -ENOENT;
goto done;
}
if (param->sub_addr) {
*param->sub_addr = sub_addr;
}
if (param->status) {
*param->status = status;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
done:
if (cli->cb && cli->cb->mod_sub_status) {
cli->cb->mod_sub_status(cli, ctx->addr, status, elem_addr,
sub_addr, (cid << 16) | mod_id);
}
return err;
}
static int mod_sub_list(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx, struct net_buf_simple *buf)
{
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
return mod_sub_list_handle(ctx, buf, OP_MOD_SUB_LIST, false);
}
static int mod_sub_list_vnd(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
return mod_sub_list_handle(ctx, buf, OP_MOD_SUB_LIST_VND, true);
}
struct hb_sub_param {
uint8_t *status;
struct bt_mesh_cfg_cli_hb_sub *sub;
};
static int hb_sub_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct hb_sub_param *param;
struct bt_mesh_cfg_cli_hb_sub sub;
uint8_t status;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
status = net_buf_simple_pull_u8(buf);
sub.src = net_buf_simple_pull_le16(buf);
sub.dst = net_buf_simple_pull_le16(buf);
sub.period = net_buf_simple_pull_u8(buf);
sub.count = net_buf_simple_pull_u8(buf);
sub.min = net_buf_simple_pull_u8(buf);
sub.max = net_buf_simple_pull_u8(buf);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_HEARTBEAT_SUB_STATUS,
ctx->addr, (void **)&param)) {
if (param->status) {
*param->status = status;
}
if (param->sub) {
*param->sub = sub;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
if (cli->cb && cli->cb->hb_sub_status) {
cli->cb->hb_sub_status(cli, ctx->addr, status, &sub);
}
return 0;
}
struct hb_pub_param {
uint8_t *status;
struct bt_mesh_cfg_cli_hb_pub *pub;
};
static int hb_pub_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct hb_pub_param *param;
uint8_t status;
struct bt_mesh_cfg_cli_hb_pub pub;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
status = net_buf_simple_pull_u8(buf);
pub.dst = net_buf_simple_pull_le16(buf);
pub.count = net_buf_simple_pull_u8(buf);
pub.period = net_buf_simple_pull_u8(buf);
pub.ttl = net_buf_simple_pull_u8(buf);
pub.feat = net_buf_simple_pull_le16(buf);
pub.net_idx = net_buf_simple_pull_le16(buf) & 0xfff;
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_HEARTBEAT_PUB_STATUS,
ctx->addr, (void **)&param)) {
if (param->status) {
*param->status = status;
}
if (param->pub) {
*param->pub = pub;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
if (cli->cb && cli->cb->hb_pub_status) {
cli->cb->hb_pub_status(cli, ctx->addr, status, &pub);
}
return 0;
}
struct node_idt_param {
uint8_t *status;
uint16_t net_idx;
uint8_t *identity;
};
static int node_identity_status(const struct bt_mesh_model *model,
struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct node_idt_param *param;
uint16_t net_idx, identity;
uint8_t status;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
status = net_buf_simple_pull_u8(buf);
net_idx = net_buf_simple_pull_le16(buf) & 0xfff;
identity = net_buf_simple_pull_u8(buf);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_NODE_IDENTITY_STATUS, ctx->addr,
(void **)&param)) {
if (param && param->status) {
*param->status = status;
}
if (param && param->identity) {
*param->identity = identity;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
if (cli->cb && cli->cb->node_identity_status) {
cli->cb->node_identity_status(cli, ctx->addr, status,
net_idx, identity);
}
return 0;
}
struct lpn_timeout_param {
uint16_t unicast_addr;
int32_t *polltimeout;
};
static int lpn_timeout_status(const struct bt_mesh_model *model, struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
struct lpn_timeout_param *param;
uint16_t unicast_addr;
int32_t polltimeout;
int err;
LOG_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x len %u: %s", ctx->net_idx, ctx->app_idx,
ctx->addr, buf->len, bt_hex(buf->data, buf->len));
unicast_addr = net_buf_simple_pull_le16(buf);
polltimeout = net_buf_simple_pull_le24(buf);
if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_LPN_TIMEOUT_STATUS, ctx->addr,
(void **)&param)) {
if (param->unicast_addr != unicast_addr) {
err = -ENOENT;
goto done;
}
if (param->polltimeout) {
*param->polltimeout = polltimeout;
}
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
}
err = 0;
done:
if (cli->cb && cli->cb->lpn_timeout_status) {
cli->cb->lpn_timeout_status(cli, ctx->addr, unicast_addr,
polltimeout);
}
return err;
}
const struct bt_mesh_model_op bt_mesh_cfg_cli_op[] = {
{ OP_DEV_COMP_DATA_STATUS, BT_MESH_LEN_MIN(5), comp_data_status },
{ OP_BEACON_STATUS, BT_MESH_LEN_EXACT(1), beacon_status },
{ OP_DEFAULT_TTL_STATUS, BT_MESH_LEN_EXACT(1), ttl_status },
{ OP_FRIEND_STATUS, BT_MESH_LEN_EXACT(1), friend_status },
{ OP_GATT_PROXY_STATUS, BT_MESH_LEN_EXACT(1), gatt_proxy_status },
{ OP_RELAY_STATUS, BT_MESH_LEN_EXACT(2), relay_status },
{ OP_NET_TRANSMIT_STATUS, BT_MESH_LEN_EXACT(1), net_transmit_status },
{ OP_NET_KEY_STATUS, BT_MESH_LEN_EXACT(3), net_key_status },
{ OP_NET_KEY_LIST, BT_MESH_LEN_MIN(0), net_key_list },
{ OP_APP_KEY_STATUS, BT_MESH_LEN_EXACT(4), app_key_status },
{ OP_APP_KEY_LIST, BT_MESH_LEN_MIN(3), app_key_list },
{ OP_MOD_APP_STATUS, BT_MESH_LEN_MIN(7), mod_app_status },
{ OP_SIG_MOD_APP_LIST, BT_MESH_LEN_MIN(5), mod_app_list },
{ OP_VND_MOD_APP_LIST, BT_MESH_LEN_MIN(7), mod_app_list_vnd },
{ OP_MOD_PUB_STATUS, BT_MESH_LEN_MIN(12), mod_pub_status },
{ OP_MOD_SUB_STATUS, BT_MESH_LEN_MIN(7), mod_sub_status },
{ OP_MOD_SUB_LIST, BT_MESH_LEN_MIN(5), mod_sub_list },
{ OP_MOD_SUB_LIST_VND, BT_MESH_LEN_MIN(7), mod_sub_list_vnd },
{ OP_HEARTBEAT_SUB_STATUS, BT_MESH_LEN_EXACT(9), hb_sub_status },
{ OP_HEARTBEAT_PUB_STATUS, BT_MESH_LEN_EXACT(10), hb_pub_status },
{ OP_NODE_RESET_STATUS, BT_MESH_LEN_EXACT(0), node_reset_status },
{ OP_NODE_IDENTITY_STATUS, BT_MESH_LEN_EXACT(4), node_identity_status},
{ OP_LPN_TIMEOUT_STATUS, BT_MESH_LEN_EXACT(5), lpn_timeout_status },
{ OP_KRP_STATUS, BT_MESH_LEN_EXACT(4), krp_status},
BT_MESH_MODEL_OP_END,
};
static int cfg_cli_init(const struct bt_mesh_model *model)
{
if (!bt_mesh_model_in_primary(model)) {
LOG_ERR("Configuration Client only allowed in primary element");
return -EINVAL;
}
if (!model->rt->user_data) {
LOG_ERR("No Configuration Client context provided");
return -EINVAL;
}
cli = model->rt->user_data;
cli->model = model;
msg_timeout = CONFIG_BT_MESH_CFG_CLI_TIMEOUT;
/*
* Configuration Model security is device-key based and both the local
* and remote keys are allowed to access this model.
*/
model->keys[0] = BT_MESH_KEY_DEV_ANY;
model->rt->flags |= BT_MESH_MOD_DEVKEY_ONLY;
bt_mesh_msg_ack_ctx_init(&cli->ack_ctx);
return 0;
}
const struct bt_mesh_model_cb bt_mesh_cfg_cli_cb = {
.init = cfg_cli_init,
};
int bt_mesh_cfg_cli_comp_data_get(uint16_t net_idx, uint16_t addr, uint8_t page, uint8_t *rsp,
struct net_buf_simple *comp)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_DEV_COMP_DATA_GET, 1);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct comp_data param = {
.page = rsp,
.comp = comp,
};
const struct bt_mesh_msg_rsp_ctx rsp_ctx = {
.ack = &cli->ack_ctx,
.op = OP_DEV_COMP_DATA_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_DEV_COMP_DATA_GET);
net_buf_simple_add_u8(&msg, page);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !rsp && !comp ? NULL : &rsp_ctx);
}
static int get_state_u8(uint16_t net_idx, uint16_t addr, uint32_t op, uint32_t rsp, uint8_t *val)
{
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 0);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
const struct bt_mesh_msg_rsp_ctx rsp_ctx = {
.ack = &cli->ack_ctx,
.op = rsp,
.user_data = val,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, op);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !val ? NULL : &rsp_ctx);
}
static int set_state_u8(uint16_t net_idx, uint16_t addr, uint32_t op, uint32_t rsp, uint8_t new_val,
uint8_t *val)
{
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 1);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
const struct bt_mesh_msg_rsp_ctx rsp_ctx = {
.ack = &cli->ack_ctx,
.op = rsp,
.user_data = val,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, op);
net_buf_simple_add_u8(&msg, new_val);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !val ? NULL : &rsp_ctx);
}
int bt_mesh_cfg_cli_beacon_get(uint16_t net_idx, uint16_t addr, uint8_t *status)
{
return get_state_u8(net_idx, addr, OP_BEACON_GET, OP_BEACON_STATUS, status);
}
int bt_mesh_cfg_cli_krp_get(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx, uint8_t *status,
uint8_t *phase)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_KRP_GET, 2);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct krp_param param = {
.status = status,
.phase = phase,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_KRP_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_KRP_GET);
net_buf_simple_add_le16(&msg, key_net_idx);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !phase ? NULL : &rsp);
}
int bt_mesh_cfg_cli_krp_set(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
uint8_t transition, uint8_t *status, uint8_t *phase)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_KRP_SET, 3);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct krp_param param = {
.status = status,
.phase = phase,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_KRP_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_KRP_SET);
net_buf_simple_add_le16(&msg, key_net_idx);
net_buf_simple_add_u8(&msg, transition);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !phase ? NULL : &rsp);
}
int bt_mesh_cfg_cli_beacon_set(uint16_t net_idx, uint16_t addr, uint8_t val, uint8_t *status)
{
return set_state_u8(net_idx, addr, OP_BEACON_SET, OP_BEACON_STATUS, val, status);
}
int bt_mesh_cfg_cli_ttl_get(uint16_t net_idx, uint16_t addr, uint8_t *ttl)
{
return get_state_u8(net_idx, addr, OP_DEFAULT_TTL_GET, OP_DEFAULT_TTL_STATUS, ttl);
}
int bt_mesh_cfg_cli_ttl_set(uint16_t net_idx, uint16_t addr, uint8_t val, uint8_t *ttl)
{
return set_state_u8(net_idx, addr, OP_DEFAULT_TTL_SET, OP_DEFAULT_TTL_STATUS, val, ttl);
}
int bt_mesh_cfg_cli_friend_get(uint16_t net_idx, uint16_t addr, uint8_t *status)
{
return get_state_u8(net_idx, addr, OP_FRIEND_GET, OP_FRIEND_STATUS, status);
}
int bt_mesh_cfg_cli_friend_set(uint16_t net_idx, uint16_t addr, uint8_t val, uint8_t *status)
{
return set_state_u8(net_idx, addr, OP_FRIEND_SET, OP_FRIEND_STATUS, val, status);
}
int bt_mesh_cfg_cli_gatt_proxy_get(uint16_t net_idx, uint16_t addr, uint8_t *status)
{
return get_state_u8(net_idx, addr, OP_GATT_PROXY_GET, OP_GATT_PROXY_STATUS, status);
}
int bt_mesh_cfg_cli_gatt_proxy_set(uint16_t net_idx, uint16_t addr, uint8_t val, uint8_t *status)
{
return set_state_u8(net_idx, addr, OP_GATT_PROXY_SET, OP_GATT_PROXY_STATUS, val, status);
}
int bt_mesh_cfg_cli_net_transmit_set(uint16_t net_idx, uint16_t addr, uint8_t val,
uint8_t *transmit)
{
return set_state_u8(net_idx, addr, OP_NET_TRANSMIT_SET, OP_NET_TRANSMIT_STATUS, val,
transmit);
}
int bt_mesh_cfg_cli_net_transmit_get(uint16_t net_idx, uint16_t addr, uint8_t *transmit)
{
return get_state_u8(net_idx, addr, OP_NET_TRANSMIT_GET, OP_NET_TRANSMIT_STATUS, transmit);
}
int bt_mesh_cfg_cli_relay_get(uint16_t net_idx, uint16_t addr, uint8_t *status, uint8_t *transmit)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_RELAY_GET, 0);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct relay_param param = {
.status = status,
.transmit = transmit,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_RELAY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_RELAY_GET);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !transmit ? NULL : &rsp);
}
int bt_mesh_cfg_cli_relay_set(uint16_t net_idx, uint16_t addr, uint8_t new_relay,
uint8_t new_transmit, uint8_t *status, uint8_t *transmit)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_RELAY_SET, 2);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct relay_param param = {
.status = status,
.transmit = transmit,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_RELAY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_RELAY_SET);
net_buf_simple_add_u8(&msg, new_relay);
net_buf_simple_add_u8(&msg, new_transmit);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !transmit ? NULL : &rsp);
}
int bt_mesh_cfg_cli_net_key_add(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
const uint8_t net_key[16], uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_NET_KEY_ADD, 18);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct net_key_param param = {
.status = status,
.net_idx = key_net_idx,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_NET_KEY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_NET_KEY_ADD);
net_buf_simple_add_le16(&msg, key_net_idx);
net_buf_simple_add_mem(&msg, net_key, 16);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_net_key_update(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
const uint8_t net_key[16], uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_NET_KEY_UPDATE, 18);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct net_key_param param = {
.status = status,
.net_idx = key_net_idx,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_NET_KEY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_NET_KEY_UPDATE);
net_buf_simple_add_le16(&msg, key_net_idx);
net_buf_simple_add_mem(&msg, net_key, 16);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_net_key_get(uint16_t net_idx, uint16_t addr, uint16_t *keys, size_t *key_cnt)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_NET_KEY_GET, 0);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct net_key_list_param param = {
.keys = keys,
.key_cnt = key_cnt,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_NET_KEY_LIST,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_NET_KEY_GET);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !keys && !key_cnt ? NULL : &rsp);
}
int bt_mesh_cfg_cli_net_key_del(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_NET_KEY_DEL, 2);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct net_key_param param = {
.status = status,
.net_idx = key_net_idx,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_NET_KEY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_NET_KEY_DEL);
net_buf_simple_add_le16(&msg, key_net_idx);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_app_key_add(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
uint16_t key_app_idx, const uint8_t app_key[16], uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_APP_KEY_ADD, 19);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct app_key_param param = {
.status = status,
.net_idx = key_net_idx,
.app_idx = key_app_idx,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_APP_KEY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_APP_KEY_ADD);
key_idx_pack_pair(&msg, key_net_idx, key_app_idx);
net_buf_simple_add_mem(&msg, app_key, 16);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_app_key_update(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
uint16_t key_app_idx, const uint8_t app_key[16], uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_APP_KEY_UPDATE, 19);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct app_key_param param = {
.status = status,
.net_idx = key_net_idx,
.app_idx = key_app_idx,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_APP_KEY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_APP_KEY_UPDATE);
key_idx_pack_pair(&msg, key_net_idx, key_app_idx);
net_buf_simple_add_mem(&msg, app_key, 16);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_node_reset(uint16_t net_idx, uint16_t addr, bool *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_NODE_RESET, 0);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
if (status) {
*status = false;
}
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_NODE_RESET_STATUS,
.user_data = status,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_NODE_RESET);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_app_key_get(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
uint8_t *status, uint16_t *keys, size_t *key_cnt)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_APP_KEY_GET, 2);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct app_key_list_param param = {
.net_idx = key_net_idx,
.status = status,
.keys = keys,
.key_cnt = key_cnt,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_APP_KEY_LIST,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_APP_KEY_GET);
net_buf_simple_add_le16(&msg, key_net_idx);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg,
!status && (!keys || !key_cnt) ? NULL : &rsp);
}
int bt_mesh_cfg_cli_app_key_del(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
uint16_t key_app_idx, uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_APP_KEY_DEL, 3);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct app_key_param param = {
.status = status,
.net_idx = key_net_idx,
.app_idx = key_app_idx,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_APP_KEY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_APP_KEY_DEL);
key_idx_pack_pair(&msg, key_net_idx, key_app_idx);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
static int mod_app_bind(uint16_t net_idx, uint16_t addr, uint16_t elem_addr, uint16_t mod_app_idx,
uint16_t mod_id, uint16_t cid, uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_APP_BIND, 8);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct mod_app_param param = {
.status = status,
.elem_addr = elem_addr,
.mod_app_idx = mod_app_idx,
.mod_id = mod_id,
.cid = cid,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_MOD_APP_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_MOD_APP_BIND);
net_buf_simple_add_le16(&msg, elem_addr);
net_buf_simple_add_le16(&msg, mod_app_idx);
if (cid != CID_NVAL) {
net_buf_simple_add_le16(&msg, cid);
}
net_buf_simple_add_le16(&msg, mod_id);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_mod_app_bind(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_app_idx, uint16_t mod_id, uint8_t *status)
{
return mod_app_bind(net_idx, addr, elem_addr, mod_app_idx, mod_id, CID_NVAL, status);
}
int bt_mesh_cfg_cli_mod_app_bind_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_app_idx, uint16_t mod_id, uint16_t cid,
uint8_t *status)
{
if (cid == CID_NVAL) {
return -EINVAL;
}
return mod_app_bind(net_idx, addr, elem_addr, mod_app_idx, mod_id, cid, status);
}
static int mod_app_unbind(uint16_t net_idx, uint16_t addr, uint16_t elem_addr, uint16_t mod_app_idx,
uint16_t mod_id, uint16_t cid, uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_APP_UNBIND, 8);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct mod_app_param param = {
.status = status,
.elem_addr = elem_addr,
.mod_app_idx = mod_app_idx,
.mod_id = mod_id,
.cid = cid,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_MOD_APP_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_MOD_APP_UNBIND);
net_buf_simple_add_le16(&msg, elem_addr);
net_buf_simple_add_le16(&msg, mod_app_idx);
if (cid != CID_NVAL) {
net_buf_simple_add_le16(&msg, cid);
}
net_buf_simple_add_le16(&msg, mod_id);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_mod_app_unbind(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_app_idx, uint16_t mod_id, uint8_t *status)
{
return mod_app_unbind(net_idx, addr, elem_addr, mod_app_idx, mod_id, CID_NVAL, status);
}
int bt_mesh_cfg_cli_mod_app_unbind_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_app_idx, uint16_t mod_id, uint16_t cid,
uint8_t *status)
{
if (cid == CID_NVAL) {
return -EINVAL;
}
return mod_app_unbind(net_idx, addr, elem_addr, mod_app_idx, mod_id, cid, status);
}
static int mod_member_list_get(uint32_t op, uint32_t expect_op, uint16_t net_idx, uint16_t addr,
uint16_t elem_addr, uint16_t mod_id, uint16_t cid, uint8_t *status,
uint16_t *apps, size_t *app_cnt)
{
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 6);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct mod_member_list_param param = {
.status = status,
.elem_addr = elem_addr,
.mod_id = mod_id,
.cid = cid,
.members = apps,
.member_cnt = app_cnt,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = expect_op,
.user_data = &param,
.timeout = msg_timeout,
};
LOG_DBG("net_idx 0x%04x addr 0x%04x elem_addr 0x%04x", net_idx, addr, elem_addr);
LOG_DBG("mod_id 0x%04x cid 0x%04x op: %x", mod_id, cid, op);
bt_mesh_model_msg_init(&msg, op);
net_buf_simple_add_le16(&msg, elem_addr);
if (cid != CID_NVAL) {
net_buf_simple_add_le16(&msg, cid);
}
net_buf_simple_add_le16(&msg, mod_id);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg,
!status && (!apps || !app_cnt) ? NULL : &rsp);
}
int bt_mesh_cfg_cli_mod_app_get(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, uint8_t *status, uint16_t *apps, size_t *app_cnt)
{
return mod_member_list_get(OP_SIG_MOD_APP_GET, OP_SIG_MOD_APP_LIST, net_idx, addr,
elem_addr, mod_id, CID_NVAL, status, apps, app_cnt);
}
int bt_mesh_cfg_cli_mod_app_get_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, uint16_t cid, uint8_t *status, uint16_t *apps,
size_t *app_cnt)
{
if (cid == CID_NVAL) {
return -EINVAL;
}
return mod_member_list_get(OP_VND_MOD_APP_GET, OP_VND_MOD_APP_LIST, net_idx, addr,
elem_addr, mod_id, cid, status, apps, app_cnt);
}
static int mod_sub(uint32_t op, uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t sub_addr, uint16_t mod_id, uint16_t cid, uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 8);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct mod_sub_param param = {
.status = status,
.elem_addr = elem_addr,
.expect_sub = &sub_addr,
.mod_id = mod_id,
.cid = cid,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_MOD_SUB_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, op);
net_buf_simple_add_le16(&msg, elem_addr);
if (sub_addr != BT_MESH_ADDR_UNASSIGNED) {
net_buf_simple_add_le16(&msg, sub_addr);
}
if (cid != CID_NVAL) {
net_buf_simple_add_le16(&msg, cid);
}
net_buf_simple_add_le16(&msg, mod_id);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_mod_sub_add(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t sub_addr, uint16_t mod_id, uint8_t *status)
{
if (!BT_MESH_ADDR_IS_GROUP(sub_addr) && !BT_MESH_ADDR_IS_FIXED_GROUP(sub_addr)) {
return -EINVAL;
}
return mod_sub(OP_MOD_SUB_ADD, net_idx, addr, elem_addr, sub_addr, mod_id, CID_NVAL,
status);
}
int bt_mesh_cfg_cli_mod_sub_add_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t sub_addr, uint16_t mod_id, uint16_t cid,
uint8_t *status)
{
if ((!BT_MESH_ADDR_IS_GROUP(sub_addr) && !BT_MESH_ADDR_IS_FIXED_GROUP(sub_addr)) ||
cid == CID_NVAL) {
return -EINVAL;
}
return mod_sub(OP_MOD_SUB_ADD, net_idx, addr, elem_addr, sub_addr, mod_id, cid, status);
}
int bt_mesh_cfg_cli_mod_sub_del(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t sub_addr, uint16_t mod_id, uint8_t *status)
{
if (!BT_MESH_ADDR_IS_GROUP(sub_addr) && !BT_MESH_ADDR_IS_FIXED_GROUP(sub_addr)) {
return -EINVAL;
}
return mod_sub(OP_MOD_SUB_DEL, net_idx, addr, elem_addr, sub_addr, mod_id, CID_NVAL,
status);
}
int bt_mesh_cfg_cli_mod_sub_del_all(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, uint8_t *status)
{
return mod_sub(OP_MOD_SUB_DEL_ALL, net_idx, addr, elem_addr, BT_MESH_ADDR_UNASSIGNED,
mod_id, CID_NVAL, status);
}
int bt_mesh_cfg_cli_mod_sub_del_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t sub_addr, uint16_t mod_id, uint16_t cid,
uint8_t *status)
{
if ((!BT_MESH_ADDR_IS_GROUP(sub_addr) && !BT_MESH_ADDR_IS_FIXED_GROUP(sub_addr)) ||
cid == CID_NVAL) {
return -EINVAL;
}
return mod_sub(OP_MOD_SUB_DEL, net_idx, addr, elem_addr, sub_addr, mod_id, cid, status);
}
int bt_mesh_cfg_cli_mod_sub_del_all_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, uint16_t cid, uint8_t *status)
{
if (cid == CID_NVAL) {
return -EINVAL;
}
return mod_sub(OP_MOD_SUB_DEL_ALL, net_idx, addr, elem_addr, BT_MESH_ADDR_UNASSIGNED,
mod_id, cid, status);
}
int bt_mesh_cfg_cli_mod_sub_overwrite(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t sub_addr, uint16_t mod_id, uint8_t *status)
{
if (!BT_MESH_ADDR_IS_GROUP(sub_addr) && !BT_MESH_ADDR_IS_FIXED_GROUP(sub_addr)) {
return -EINVAL;
}
return mod_sub(OP_MOD_SUB_OVERWRITE, net_idx, addr, elem_addr, sub_addr, mod_id, CID_NVAL,
status);
}
int bt_mesh_cfg_cli_mod_sub_overwrite_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t sub_addr, uint16_t mod_id, uint16_t cid,
uint8_t *status)
{
if ((!BT_MESH_ADDR_IS_GROUP(sub_addr) && !BT_MESH_ADDR_IS_FIXED_GROUP(sub_addr)) ||
cid == CID_NVAL) {
return -EINVAL;
}
return mod_sub(OP_MOD_SUB_OVERWRITE, net_idx, addr, elem_addr, sub_addr, mod_id, cid,
status);
}
static int mod_sub_va(uint32_t op, uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
const uint8_t label[16], uint16_t mod_id, uint16_t cid, uint16_t *virt_addr,
uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 22);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct mod_sub_param param = {
.status = status,
.elem_addr = elem_addr,
.sub_addr = virt_addr,
.mod_id = mod_id,
.cid = cid,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_MOD_SUB_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
LOG_DBG("net_idx 0x%04x addr 0x%04x elem_addr 0x%04x label %s", net_idx, addr, elem_addr,
bt_hex(label, 16));
LOG_DBG("mod_id 0x%04x cid 0x%04x", mod_id, cid);
bt_mesh_model_msg_init(&msg, op);
net_buf_simple_add_le16(&msg, elem_addr);
net_buf_simple_add_mem(&msg, label, 16);
if (cid != CID_NVAL) {
net_buf_simple_add_le16(&msg, cid);
}
net_buf_simple_add_le16(&msg, mod_id);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !virt_addr ? NULL : &rsp);
}
int bt_mesh_cfg_cli_mod_sub_va_add(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
const uint8_t label[16], uint16_t mod_id, uint16_t *virt_addr,
uint8_t *status)
{
return mod_sub_va(OP_MOD_SUB_VA_ADD, net_idx, addr, elem_addr, label, mod_id, CID_NVAL,
virt_addr, status);
}
int bt_mesh_cfg_cli_mod_sub_va_add_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
const uint8_t label[16], uint16_t mod_id, uint16_t cid,
uint16_t *virt_addr, uint8_t *status)
{
if (cid == CID_NVAL) {
return -EINVAL;
}
return mod_sub_va(OP_MOD_SUB_VA_ADD, net_idx, addr, elem_addr, label, mod_id, cid,
virt_addr, status);
}
int bt_mesh_cfg_cli_mod_sub_va_del(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
const uint8_t label[16], uint16_t mod_id, uint16_t *virt_addr,
uint8_t *status)
{
return mod_sub_va(OP_MOD_SUB_VA_DEL, net_idx, addr, elem_addr, label, mod_id, CID_NVAL,
virt_addr, status);
}
int bt_mesh_cfg_cli_mod_sub_va_del_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
const uint8_t label[16], uint16_t mod_id, uint16_t cid,
uint16_t *virt_addr, uint8_t *status)
{
if (cid == CID_NVAL) {
return -EINVAL;
}
return mod_sub_va(OP_MOD_SUB_VA_DEL, net_idx, addr, elem_addr, label, mod_id, cid,
virt_addr, status);
}
int bt_mesh_cfg_cli_mod_sub_va_overwrite(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
const uint8_t label[16], uint16_t mod_id,
uint16_t *virt_addr, uint8_t *status)
{
return mod_sub_va(OP_MOD_SUB_VA_OVERWRITE, net_idx, addr, elem_addr, label, mod_id,
CID_NVAL, virt_addr, status);
}
int bt_mesh_cfg_cli_mod_sub_va_overwrite_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
const uint8_t label[16], uint16_t mod_id, uint16_t cid,
uint16_t *virt_addr, uint8_t *status)
{
if (cid == CID_NVAL) {
return -EINVAL;
}
return mod_sub_va(OP_MOD_SUB_VA_OVERWRITE, net_idx, addr, elem_addr, label, mod_id, cid,
virt_addr, status);
}
int bt_mesh_cfg_cli_mod_sub_get(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, uint8_t *status, uint16_t *subs, size_t *sub_cnt)
{
return mod_member_list_get(OP_MOD_SUB_GET, OP_MOD_SUB_LIST, net_idx, addr, elem_addr,
mod_id, CID_NVAL, status, subs, sub_cnt);
}
int bt_mesh_cfg_cli_mod_sub_get_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, uint16_t cid, uint8_t *status, uint16_t *subs,
size_t *sub_cnt)
{
if (cid == CID_NVAL) {
return -EINVAL;
}
return mod_member_list_get(OP_MOD_SUB_GET_VND, OP_MOD_SUB_LIST_VND, net_idx, addr,
elem_addr, mod_id, cid, status, subs, sub_cnt);
}
static int mod_pub_get(uint16_t net_idx, uint16_t addr, uint16_t elem_addr, uint16_t mod_id,
uint16_t cid, struct bt_mesh_cfg_cli_mod_pub *pub, uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_PUB_GET, 6);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct mod_pub_param param = {
.mod_id = mod_id,
.cid = cid,
.elem_addr = elem_addr,
.status = status,
.pub = pub,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_MOD_PUB_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_MOD_PUB_GET);
net_buf_simple_add_le16(&msg, elem_addr);
if (cid != CID_NVAL) {
net_buf_simple_add_le16(&msg, cid);
}
net_buf_simple_add_le16(&msg, mod_id);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !pub ? NULL : &rsp);
}
int bt_mesh_cfg_cli_mod_pub_get(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, struct bt_mesh_cfg_cli_mod_pub *pub,
uint8_t *status)
{
return mod_pub_get(net_idx, addr, elem_addr, mod_id, CID_NVAL, pub, status);
}
int bt_mesh_cfg_cli_mod_pub_get_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, uint16_t cid,
struct bt_mesh_cfg_cli_mod_pub *pub, uint8_t *status)
{
if (cid == CID_NVAL) {
return -EINVAL;
}
return mod_pub_get(net_idx, addr, elem_addr, mod_id, cid, pub, status);
}
static int mod_pub_set(uint16_t net_idx, uint16_t addr, uint16_t elem_addr, uint16_t mod_id,
uint16_t cid, struct bt_mesh_cfg_cli_mod_pub *pub, uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_PUB_SET, 13);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct mod_pub_param param = {
.mod_id = mod_id,
.cid = cid,
.elem_addr = elem_addr,
.status = status,
.pub = pub,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_MOD_PUB_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_MOD_PUB_SET);
net_buf_simple_add_le16(&msg, elem_addr);
net_buf_simple_add_le16(&msg, pub->addr);
net_buf_simple_add_le16(&msg, (pub->app_idx | (pub->cred_flag << 12)));
net_buf_simple_add_u8(&msg, pub->ttl);
net_buf_simple_add_u8(&msg, pub->period);
net_buf_simple_add_u8(&msg, pub->transmit);
if (cid != CID_NVAL) {
net_buf_simple_add_le16(&msg, cid);
}
net_buf_simple_add_le16(&msg, mod_id);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
static int mod_pub_va_set(uint16_t net_idx, uint16_t addr, uint16_t elem_addr, uint16_t mod_id,
uint16_t cid, struct bt_mesh_cfg_cli_mod_pub *pub, uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_PUB_VA_SET, 27);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct mod_pub_param param = {
.mod_id = mod_id,
.cid = cid,
.elem_addr = elem_addr,
.status = status,
.pub = pub,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_MOD_PUB_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
LOG_DBG("app_idx 0x%04x", pub->app_idx);
bt_mesh_model_msg_init(&msg, OP_MOD_PUB_VA_SET);
net_buf_simple_add_le16(&msg, elem_addr);
net_buf_simple_add_mem(&msg, pub->uuid, 16);
net_buf_simple_add_le16(&msg, (pub->app_idx | (pub->cred_flag << 12)));
net_buf_simple_add_u8(&msg, pub->ttl);
net_buf_simple_add_u8(&msg, pub->period);
net_buf_simple_add_u8(&msg, pub->transmit);
if (cid != CID_NVAL) {
net_buf_simple_add_le16(&msg, cid);
}
net_buf_simple_add_le16(&msg, mod_id);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_mod_pub_set(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, struct bt_mesh_cfg_cli_mod_pub *pub,
uint8_t *status)
{
if (!pub) {
return -EINVAL;
}
if (pub->uuid) {
return mod_pub_va_set(net_idx, addr, elem_addr, mod_id, CID_NVAL, pub, status);
} else {
return mod_pub_set(net_idx, addr, elem_addr, mod_id, CID_NVAL, pub, status);
}
}
int bt_mesh_cfg_cli_mod_pub_set_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
uint16_t mod_id, uint16_t cid,
struct bt_mesh_cfg_cli_mod_pub *pub, uint8_t *status)
{
if (!pub) {
return -EINVAL;
}
if (cid == CID_NVAL) {
return -EINVAL;
}
if (pub->uuid) {
return mod_pub_va_set(net_idx, addr, elem_addr, mod_id, cid, pub, status);
} else {
return mod_pub_set(net_idx, addr, elem_addr, mod_id, cid, pub, status);
}
}
int bt_mesh_cfg_cli_hb_sub_set(uint16_t net_idx, uint16_t addr, struct bt_mesh_cfg_cli_hb_sub *sub,
uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_SUB_SET, 5);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct hb_sub_param param = {
.status = status,
.sub = sub,
};
if (!sub) {
return -EINVAL;
}
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_HEARTBEAT_SUB_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_HEARTBEAT_SUB_SET);
net_buf_simple_add_le16(&msg, sub->src);
net_buf_simple_add_le16(&msg, sub->dst);
net_buf_simple_add_u8(&msg, sub->period);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_hb_sub_get(uint16_t net_idx, uint16_t addr, struct bt_mesh_cfg_cli_hb_sub *sub,
uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_SUB_GET, 0);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct hb_sub_param param = {
.status = status,
.sub = sub,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_HEARTBEAT_SUB_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_HEARTBEAT_SUB_GET);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !sub ? NULL : &rsp);
}
int bt_mesh_cfg_cli_hb_pub_set(uint16_t net_idx, uint16_t addr,
const struct bt_mesh_cfg_cli_hb_pub *pub, uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_PUB_SET, 9);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct hb_pub_param param = {
.status = status,
};
if (!pub) {
return -EINVAL;
}
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_HEARTBEAT_PUB_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_HEARTBEAT_PUB_SET);
net_buf_simple_add_le16(&msg, pub->dst);
net_buf_simple_add_u8(&msg, pub->count);
net_buf_simple_add_u8(&msg, pub->period);
net_buf_simple_add_u8(&msg, pub->ttl);
net_buf_simple_add_le16(&msg, pub->feat);
net_buf_simple_add_le16(&msg, pub->net_idx);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status ? NULL : &rsp);
}
int bt_mesh_cfg_cli_hb_pub_get(uint16_t net_idx, uint16_t addr, struct bt_mesh_cfg_cli_hb_pub *pub,
uint8_t *status)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_PUB_GET, 0);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct hb_pub_param param = {
.status = status,
.pub = pub,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_HEARTBEAT_PUB_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_HEARTBEAT_PUB_GET);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !pub ? NULL : &rsp);
}
int bt_mesh_cfg_cli_node_identity_set(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
uint8_t new_identity, uint8_t *status, uint8_t *identity)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_NODE_IDENTITY_SET, 4);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct node_idt_param param = {
.status = status,
.net_idx = key_net_idx,
.identity = identity,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_NODE_IDENTITY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_NODE_IDENTITY_SET);
net_buf_simple_add_le16(&msg, key_net_idx);
net_buf_simple_add_u8(&msg, new_identity);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !identity ? NULL : &rsp);
}
int bt_mesh_cfg_cli_node_identity_get(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
uint8_t *status, uint8_t *identity)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_NODE_IDENTITY_GET, 2);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct node_idt_param param = {
.status = status,
.net_idx = key_net_idx,
.identity = identity,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_NODE_IDENTITY_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_NODE_IDENTITY_GET);
net_buf_simple_add_le16(&msg, key_net_idx);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !status && !identity ? NULL : &rsp);
}
int bt_mesh_cfg_cli_lpn_timeout_get(uint16_t net_idx, uint16_t addr, uint16_t unicast_addr,
int32_t *polltimeout)
{
BT_MESH_MODEL_BUF_DEFINE(msg, OP_LPN_TIMEOUT_GET, 2);
struct bt_mesh_msg_ctx ctx = BT_MESH_MSG_CTX_INIT_DEV(net_idx, addr);
struct lpn_timeout_param param = {
.unicast_addr = unicast_addr,
.polltimeout = polltimeout,
};
const struct bt_mesh_msg_rsp_ctx rsp = {
.ack = &cli->ack_ctx,
.op = OP_LPN_TIMEOUT_STATUS,
.user_data = &param,
.timeout = msg_timeout,
};
bt_mesh_model_msg_init(&msg, OP_LPN_TIMEOUT_GET);
net_buf_simple_add_le16(&msg, unicast_addr);
return bt_mesh_msg_ackd_send(cli->model, &ctx, &msg, !polltimeout ? NULL : &rsp);
}
int32_t bt_mesh_cfg_cli_timeout_get(void)
{
return msg_timeout;
}
void bt_mesh_cfg_cli_timeout_set(int32_t timeout)
{
msg_timeout = timeout;
}
int bt_mesh_comp_p0_get(struct bt_mesh_comp_p0 *page,
struct net_buf_simple *buf)
{
if (buf->len < 10) {
return -EINVAL;
}
page->cid = net_buf_simple_pull_le16(buf);
page->pid = net_buf_simple_pull_le16(buf);
page->vid = net_buf_simple_pull_le16(buf);
page->crpl = net_buf_simple_pull_le16(buf);
page->feat = net_buf_simple_pull_le16(buf);
page->_buf = buf;
return 0;
}
struct bt_mesh_comp_p0_elem *bt_mesh_comp_p0_elem_pull(const struct bt_mesh_comp_p0 *page,
struct bt_mesh_comp_p0_elem *elem)
{
size_t modlist_size;
if (page->_buf->len < 4) {
return NULL;
}
elem->loc = net_buf_simple_pull_le16(page->_buf);
elem->nsig = net_buf_simple_pull_u8(page->_buf);
elem->nvnd = net_buf_simple_pull_u8(page->_buf);
modlist_size = elem->nsig * 2 + elem->nvnd * 4;
if (page->_buf->len < modlist_size) {
return NULL;
}
elem->_buf = net_buf_simple_pull_mem(page->_buf, modlist_size);
return elem;
}
uint16_t bt_mesh_comp_p0_elem_mod(struct bt_mesh_comp_p0_elem *elem, int idx)
{
CHECKIF(idx >= elem->nsig) {
return 0xffff;
}
return sys_get_le16(&elem->_buf[idx * 2]);
}
struct bt_mesh_mod_id_vnd bt_mesh_comp_p0_elem_mod_vnd(struct bt_mesh_comp_p0_elem *elem, int idx)
{
CHECKIF(idx >= elem->nvnd) {
return (struct bt_mesh_mod_id_vnd){ 0xffff, 0xffff };
}
size_t offset = elem->nsig * 2 + idx * 4;
struct bt_mesh_mod_id_vnd mod = {
.company = sys_get_le16(&elem->_buf[offset]),
.id = sys_get_le16(&elem->_buf[offset + 2]),
};
return mod;
}
struct bt_mesh_comp_p1_elem *bt_mesh_comp_p1_elem_pull(struct net_buf_simple *buf,
struct bt_mesh_comp_p1_elem *elem)
{
if (buf->len < 4) {
LOG_DBG("No more elements to pull or missing data");
return NULL;
}
size_t elem_size = 0;
uint8_t header, ext_item_cnt;
bool fmt, cor_present;
int i;
elem->nsig = net_buf_simple_pull_u8(buf);
elem->nvnd = net_buf_simple_pull_u8(buf);
for (i = 0; i < elem->nsig + elem->nvnd; i++) {
header = buf->data[elem_size];
cor_present = COR_PRESENT(header);
fmt = FMT(header);
ext_item_cnt = EXT_ITEM_CNT(header);
LOG_DBG("header %d, cor_present %d, fmt %d, ext_item_cnt %d",
header, cor_present, fmt, ext_item_cnt);
/* Size of element equals 1 octet (header) + optional 1 octet
* (Correspondence ID, if applies) + size of Extended Model Items
* (each 1 or 2 octet long, depending on format)
*/
elem_size += (1 + cor_present) + (fmt + 1) * ext_item_cnt;
}
net_buf_simple_init_with_data(elem->_buf,
net_buf_simple_pull_mem(buf, elem_size),
elem_size);
return elem;
}
struct bt_mesh_comp_p1_model_item *bt_mesh_comp_p1_item_pull(
struct bt_mesh_comp_p1_elem *elem, struct bt_mesh_comp_p1_model_item *item)
{
if (elem->_buf->len < 1) {
LOG_ERR("Empty buffer");
return NULL;
}
LOG_DBG("N_SIG %d, N_VND %d, buf len=%d:0x%s",
elem->nsig, elem->nvnd, elem->_buf->len,
bt_hex(elem->_buf->data, elem->_buf->len));
size_t item_size;
uint8_t header;
header = net_buf_simple_pull_u8(elem->_buf);
item->cor_present = COR_PRESENT(header);
item->format = FMT(header);
item->ext_item_cnt = EXT_ITEM_CNT(header);
item_size = item->ext_item_cnt * (item->format + 1);
if (item->cor_present) {
item->cor_id = net_buf_simple_pull_u8(elem->_buf);
}
net_buf_simple_init_with_data(item->_buf,
net_buf_simple_pull_mem(elem->_buf, item_size),
item_size);
return item;
}
static struct bt_mesh_comp_p1_item_short *comp_p1_pull_item_short(
struct bt_mesh_comp_p1_model_item *item, struct bt_mesh_comp_p1_item_short *ext_item)
{
if (item->_buf->len < 1) {
LOG_ERR("Empty buffer");
return NULL;
}
LOG_DBG("Correspondence ID %s, format %s, extended items count=%d",
item->cor_present ? "present" : "not present",
item->format ? "long" : "short",
item->ext_item_cnt);
if (item->format == 1 || item->_buf->len != 1) {
return NULL;
}
uint8_t item_data = net_buf_simple_pull_u8(item->_buf);
ext_item->elem_offset = OFFSET(item_data);
ext_item->mod_item_idx = IDX(item_data);
return ext_item;
}
static struct bt_mesh_comp_p1_item_long *comp_p1_pull_item_long(
struct bt_mesh_comp_p1_model_item *item, struct bt_mesh_comp_p1_item_long *ext_item)
{
if (item->_buf->len < 2) {
LOG_ERR("Missing data, buf len=%d", item->_buf->len);
return NULL;
}
LOG_DBG("Correspondence ID %s, format %s, extended items count=%d",
item->cor_present ? "present" : "not present",
item->format ? "long" : "short",
item->ext_item_cnt);
if (item->format == 0 || item->_buf->len != 2) {
return NULL;
}
ext_item->elem_offset = net_buf_simple_pull_u8(item->_buf);
ext_item->mod_item_idx = net_buf_simple_pull_u8(item->_buf);
return ext_item;
}
struct bt_mesh_comp_p1_ext_item *bt_mesh_comp_p1_pull_ext_item(
struct bt_mesh_comp_p1_model_item *item, struct bt_mesh_comp_p1_ext_item *ext_item)
{
if (item->_buf->len < 1) {
LOG_ERR("Empty buffer");
return NULL;
} else if (item->_buf->len < 2) {
LOG_DBG("Item in short format");
ext_item->type = SHORT;
comp_p1_pull_item_short(item, &ext_item->short_item);
} else {
LOG_DBG("Item in long format");
ext_item->type = LONG;
comp_p1_pull_item_long(item, &ext_item->long_item);
}
return ext_item;
}
struct bt_mesh_comp_p2_record *bt_mesh_comp_p2_record_pull(struct net_buf_simple *buf,
struct bt_mesh_comp_p2_record *record)
{
if (buf->len < 8) {
LOG_DBG("No more elements to pull or missing data");
return NULL;
}
uint8_t elem_offset_cnt;
uint16_t data_len;
record->id = net_buf_simple_pull_le16(buf);
record->version.x = net_buf_simple_pull_u8(buf);
record->version.y = net_buf_simple_pull_u8(buf);
record->version.z = net_buf_simple_pull_u8(buf);
elem_offset_cnt = net_buf_simple_pull_u8(buf);
if (buf->len < elem_offset_cnt + 2) {
LOG_WRN("Invalid composition data offset count");
return NULL;
}
net_buf_simple_init_with_data(record->elem_buf,
net_buf_simple_pull_mem(buf, elem_offset_cnt),
elem_offset_cnt);
data_len = net_buf_simple_pull_le16(buf);
if (buf->len < data_len) {
LOG_WRN("Invalid composition data additional data length");
return NULL;
}
net_buf_simple_init_with_data(record->data_buf,
net_buf_simple_pull_mem(buf, data_len), data_len);
return record;
}