2017-11-12 13:48:55 +02:00
|
|
|
/*
|
|
|
|
* Copyright (c) 2017 Intel Corporation
|
|
|
|
*
|
|
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <zephyr.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <stdbool.h>
|
|
|
|
#include <zephyr/types.h>
|
2019-06-26 10:33:55 -04:00
|
|
|
#include <sys/util.h>
|
2019-06-26 10:33:41 -04:00
|
|
|
#include <sys/byteorder.h>
|
2021-03-23 14:50:09 +01:00
|
|
|
#include <sys/check.h>
|
2017-11-12 13:48:55 +02:00
|
|
|
|
|
|
|
#include <bluetooth/bluetooth.h>
|
|
|
|
#include <bluetooth/conn.h>
|
|
|
|
#include <bluetooth/mesh.h>
|
|
|
|
|
|
|
|
#define BT_DBG_ENABLED IS_ENABLED(CONFIG_BT_MESH_DEBUG_MODEL)
|
2018-07-17 10:35:52 +03:00
|
|
|
#define LOG_MODULE_NAME bt_mesh_cfg_cli
|
2017-11-12 13:48:55 +02:00
|
|
|
#include "common/log.h"
|
|
|
|
|
2018-05-07 09:48:36 +03:00
|
|
|
#include "net.h"
|
2017-11-12 17:47:00 +02:00
|
|
|
#include "foundation.h"
|
|
|
|
|
2017-11-16 10:28:33 +02:00
|
|
|
#define CID_NVAL 0xffff
|
|
|
|
|
2019-10-08 09:39:48 +02:00
|
|
|
/* 2 byte dummy opcode for getting compile time buffer sizes. */
|
|
|
|
#define DUMMY_2_BYTE_OP BT_MESH_MODEL_OP_2(0xff, 0xff)
|
|
|
|
|
2017-11-12 17:47:00 +02:00
|
|
|
struct comp_data {
|
2021-03-23 14:35:03 +01:00
|
|
|
uint8_t *page;
|
2017-11-12 17:47:00 +02:00
|
|
|
struct net_buf_simple *comp;
|
|
|
|
};
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
static int32_t msg_timeout;
|
2017-11-14 20:45:26 +02:00
|
|
|
|
2017-11-12 17:47:00 +02:00
|
|
|
static struct bt_mesh_cfg_cli *cli;
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int comp_data_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-12 17:47:00 +02:00
|
|
|
{
|
|
|
|
struct comp_data *param;
|
|
|
|
size_t to_copy;
|
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_DEV_COMP_DATA_STATUS, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-12 17:47:00 +02:00
|
|
|
}
|
|
|
|
|
2021-03-23 14:35:03 +01:00
|
|
|
if (param->page) {
|
|
|
|
*(param->page) = net_buf_simple_pull_u8(buf);
|
|
|
|
}
|
|
|
|
|
2019-02-11 17:14:19 +00:00
|
|
|
to_copy = MIN(net_buf_simple_tailroom(param->comp), buf->len);
|
2017-11-12 17:47:00 +02:00
|
|
|
net_buf_simple_add_mem(param->comp, buf->data, to_copy);
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-11-12 17:47:00 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int state_status_u8(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf,
|
|
|
|
uint32_t expect_status)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t *status;
|
2017-11-12 21:10:05 +02:00
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, expect_status, ctx->addr,
|
|
|
|
(void **)&status)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-12 21:10:05 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
*status = net_buf_simple_pull_u8(buf);
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-11-12 21:10:05 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int beacon_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-12 18:33:47 +02:00
|
|
|
{
|
2021-04-14 13:17:59 +02:00
|
|
|
return state_status_u8(model, ctx, buf, OP_BEACON_STATUS);
|
2017-11-12 21:10:05 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int ttl_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
2021-04-14 13:17:59 +02:00
|
|
|
return state_status_u8(model, ctx, buf, OP_DEFAULT_TTL_STATUS);
|
2017-11-12 21:10:05 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int friend_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
2021-04-14 13:17:59 +02:00
|
|
|
return state_status_u8(model, ctx, buf, OP_FRIEND_STATUS);
|
2017-11-12 21:10:05 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int gatt_proxy_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
2021-04-14 13:17:59 +02:00
|
|
|
return state_status_u8(model, ctx, buf, OP_GATT_PROXY_STATUS);
|
2017-11-12 21:10:05 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
struct relay_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t *status;
|
|
|
|
uint8_t *transmit;
|
2017-11-12 21:10:05 +02:00
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int relay_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
|
|
|
struct relay_param *param;
|
2017-11-12 18:33:47 +02:00
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_RELAY_STATUS, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-12 18:33:47 +02:00
|
|
|
}
|
|
|
|
|
2017-11-12 21:10:05 +02:00
|
|
|
*param->status = net_buf_simple_pull_u8(buf);
|
|
|
|
*param->transmit = net_buf_simple_pull_u8(buf);
|
2017-11-12 18:33:47 +02:00
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-11-12 18:33:47 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int net_transmit_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2021-02-12 11:47:47 +01:00
|
|
|
{
|
2021-04-27 15:59:54 +02:00
|
|
|
return state_status_u8(model, ctx, buf, OP_NET_TRANSMIT_STATUS);
|
2021-02-12 11:47:47 +01:00
|
|
|
}
|
|
|
|
|
2017-12-01 10:54:38 +02:00
|
|
|
struct net_key_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t *status;
|
|
|
|
uint16_t net_idx;
|
2017-12-01 10:54:38 +02:00
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int net_key_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-12-01 10:54:38 +02:00
|
|
|
{
|
|
|
|
struct net_key_param *param;
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t net_idx;
|
|
|
|
uint8_t status;
|
2017-12-01 10:54:38 +02:00
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_NET_KEY_STATUS, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-12-01 10:54:38 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
status = net_buf_simple_pull_u8(buf);
|
2020-04-22 14:02:18 +02:00
|
|
|
net_idx = net_buf_simple_pull_le16(buf) & 0xfff;
|
2017-12-01 10:54:38 +02:00
|
|
|
|
|
|
|
if (param->net_idx != net_idx) {
|
|
|
|
BT_WARN("Net Key Status key index does not match");
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-12-01 10:54:38 +02:00
|
|
|
}
|
|
|
|
|
2018-04-03 13:38:43 +03:00
|
|
|
if (param->status) {
|
|
|
|
*param->status = status;
|
|
|
|
}
|
2017-12-01 10:54:38 +02:00
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-12-01 10:54:38 +02:00
|
|
|
}
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
struct net_key_list_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t *keys;
|
2020-04-22 10:14:12 +02:00
|
|
|
size_t *key_cnt;
|
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int net_key_list(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
|
|
|
struct net_key_list_param *param;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_NET_KEY_LIST, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
for (i = 0; i < *param->key_cnt && buf->len >= 3; i += 2) {
|
|
|
|
key_idx_unpack(buf, ¶m->keys[i], ¶m->keys[i + 1]);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (i < *param->key_cnt && buf->len >= 2) {
|
|
|
|
param->keys[i++] = net_buf_simple_pull_le16(buf) & 0xfff;
|
|
|
|
}
|
|
|
|
|
2021-04-27 15:59:54 +02:00
|
|
|
if (buf->len > 0) {
|
|
|
|
BT_ERR("The message size for the application opcode is incorrect.");
|
|
|
|
return -EMSGSIZE;
|
|
|
|
}
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
*param->key_cnt = i;
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int node_reset_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2020-09-23 09:47:29 +08:00
|
|
|
{
|
|
|
|
bool *param = NULL;
|
2021-04-27 15:59:54 +02:00
|
|
|
BT_DBG("net_idx 0x%04x app_idx 0x%04x src 0x%04x", ctx->net_idx,
|
|
|
|
ctx->app_idx, ctx->addr);
|
2020-09-23 09:47:29 +08:00
|
|
|
|
2021-04-27 15:59:54 +02:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_NODE_RESET_STATUS,
|
|
|
|
ctx->addr, (void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2020-09-23 09:47:29 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (param) {
|
|
|
|
*param = true;
|
|
|
|
}
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2020-09-23 09:47:29 +08:00
|
|
|
}
|
|
|
|
|
2017-11-12 23:04:36 +02:00
|
|
|
struct app_key_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t *status;
|
|
|
|
uint16_t net_idx;
|
|
|
|
uint16_t app_idx;
|
2017-11-12 23:04:36 +02:00
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int app_key_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-12 23:04:36 +02:00
|
|
|
{
|
|
|
|
struct app_key_param *param;
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t net_idx, app_idx;
|
|
|
|
uint8_t status;
|
2017-11-12 23:04:36 +02:00
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_APP_KEY_STATUS, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-12 23:04:36 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
status = net_buf_simple_pull_u8(buf);
|
|
|
|
key_idx_unpack(buf, &net_idx, &app_idx);
|
|
|
|
|
|
|
|
if (param->net_idx != net_idx || param->app_idx != app_idx) {
|
|
|
|
BT_WARN("App Key Status key indices did not match");
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-12 23:04:36 +02:00
|
|
|
}
|
|
|
|
|
2018-04-03 13:38:43 +03:00
|
|
|
if (param->status) {
|
|
|
|
*param->status = status;
|
|
|
|
}
|
2017-11-12 23:04:36 +02:00
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-11-12 23:04:36 +02:00
|
|
|
}
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
struct app_key_list_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t net_idx;
|
|
|
|
uint8_t *status;
|
|
|
|
uint16_t *keys;
|
2020-04-22 10:14:12 +02:00
|
|
|
size_t *key_cnt;
|
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int app_key_list(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
|
|
|
struct app_key_list_param *param;
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t net_idx;
|
|
|
|
uint8_t status;
|
2020-04-22 10:14:12 +02:00
|
|
|
int i;
|
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_APP_KEY_LIST, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
status = net_buf_simple_pull_u8(buf);
|
|
|
|
net_idx = net_buf_simple_pull_le16(buf) & 0xfff;
|
|
|
|
|
|
|
|
if (param->net_idx != net_idx) {
|
|
|
|
BT_WARN("App Key List Net Key index did not match");
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
for (i = 0; i < *param->key_cnt && buf->len >= 3; i += 2) {
|
|
|
|
key_idx_unpack(buf, ¶m->keys[i], ¶m->keys[i + 1]);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (i < *param->key_cnt && buf->len >= 2) {
|
|
|
|
param->keys[i++] = net_buf_simple_pull_le16(buf) & 0xfff;
|
|
|
|
}
|
|
|
|
|
2021-04-27 15:59:54 +02:00
|
|
|
if (buf->len > 0U) {
|
|
|
|
BT_ERR("The message size for the application opcode is incorrect.");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
*param->key_cnt = i;
|
|
|
|
if (param->status) {
|
|
|
|
*param->status = status;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2017-11-12 23:38:44 +02:00
|
|
|
struct mod_app_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t *status;
|
|
|
|
uint16_t elem_addr;
|
|
|
|
uint16_t mod_app_idx;
|
|
|
|
uint16_t mod_id;
|
|
|
|
uint16_t cid;
|
2017-11-12 23:38:44 +02:00
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int mod_app_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-12 23:38:44 +02:00
|
|
|
{
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t elem_addr, mod_app_idx, mod_id, cid;
|
2017-11-12 23:38:44 +02:00
|
|
|
struct mod_app_param *param;
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t status;
|
2017-11-12 23:38:44 +02:00
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-04-27 15:59:54 +02:00
|
|
|
if ((buf->len != 7U) && (buf->len != 9U)) {
|
|
|
|
BT_ERR("The message size for the application opcode is incorrect.");
|
|
|
|
return -EMSGSIZE;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_MOD_APP_STATUS, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-12 23:38:44 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
status = net_buf_simple_pull_u8(buf);
|
|
|
|
elem_addr = net_buf_simple_pull_le16(buf);
|
|
|
|
mod_app_idx = net_buf_simple_pull_le16(buf);
|
|
|
|
|
2019-03-26 19:57:45 -06:00
|
|
|
if (buf->len >= 4U) {
|
2017-11-12 23:38:44 +02:00
|
|
|
cid = net_buf_simple_pull_le16(buf);
|
|
|
|
} else {
|
2017-11-16 10:28:33 +02:00
|
|
|
cid = CID_NVAL;
|
2017-11-12 23:38:44 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
mod_id = net_buf_simple_pull_le16(buf);
|
|
|
|
|
|
|
|
if (param->elem_addr != elem_addr ||
|
2017-11-16 10:28:33 +02:00
|
|
|
param->mod_app_idx != mod_app_idx || param->mod_id != mod_id ||
|
|
|
|
param->cid != cid) {
|
2017-11-12 23:38:44 +02:00
|
|
|
BT_WARN("Model App Status parameters did not match");
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-12 23:38:44 +02:00
|
|
|
}
|
|
|
|
|
2018-04-03 13:38:43 +03:00
|
|
|
if (param->status) {
|
|
|
|
*param->status = status;
|
|
|
|
}
|
2017-11-12 23:38:44 +02:00
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-11-12 23:38:44 +02:00
|
|
|
}
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
struct mod_member_list_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t *status;
|
|
|
|
uint16_t elem_addr;
|
|
|
|
uint16_t mod_id;
|
|
|
|
uint16_t cid;
|
|
|
|
uint16_t *members;
|
2020-04-22 10:14:12 +02:00
|
|
|
size_t *member_cnt;
|
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int mod_member_list_handle(struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf, bool vnd,
|
|
|
|
struct mod_member_list_param *param)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t elem_addr, mod_id, cid;
|
|
|
|
uint8_t status;
|
2020-04-22 10:14:12 +02:00
|
|
|
int i;
|
|
|
|
|
2021-04-27 15:59:54 +02:00
|
|
|
if ((vnd && buf->len < 7U) || (buf->len < 5U)) {
|
|
|
|
BT_ERR("The message size for the application opcode is incorrect.");
|
|
|
|
return -EMSGSIZE;
|
|
|
|
}
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
status = net_buf_simple_pull_u8(buf);
|
|
|
|
elem_addr = net_buf_simple_pull_le16(buf);
|
|
|
|
if (vnd) {
|
|
|
|
cid = net_buf_simple_pull_le16(buf);
|
|
|
|
}
|
|
|
|
|
|
|
|
mod_id = net_buf_simple_pull_le16(buf);
|
|
|
|
|
|
|
|
if (param->elem_addr != elem_addr || param->mod_id != mod_id ||
|
|
|
|
(vnd && param->cid != cid)) {
|
|
|
|
BT_WARN("Model Member List parameters did not match");
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2021-04-27 15:59:54 +02:00
|
|
|
if (buf->len % 2U) {
|
|
|
|
BT_ERR("Model Member List invalid length");
|
|
|
|
return -EMSGSIZE;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int mod_app_list(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
2021-03-24 17:38:03 +01:00
|
|
|
struct mod_member_list_param *param;
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_SIG_MOD_APP_LIST, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
return mod_member_list_handle(ctx, buf, false, param);
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int mod_app_list_vnd(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
2021-03-24 17:38:03 +01:00
|
|
|
struct mod_member_list_param *param;
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_VND_MOD_APP_LIST, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
return mod_member_list_handle(ctx, buf, true, param);
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2017-11-16 12:29:31 +02:00
|
|
|
struct mod_pub_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t mod_id;
|
|
|
|
uint16_t cid;
|
|
|
|
uint16_t elem_addr;
|
|
|
|
uint8_t *status;
|
2017-11-16 12:29:31 +02:00
|
|
|
struct bt_mesh_cfg_mod_pub *pub;
|
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int mod_pub_status(struct bt_mesh_model *model,
|
2017-11-16 12:29:31 +02:00
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
|
|
|
{
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t mod_id, cid, elem_addr;
|
2017-11-16 12:29:31 +02:00
|
|
|
struct mod_pub_param *param;
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t status;
|
2017-11-16 12:29:31 +02:00
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-04-27 15:59:54 +02:00
|
|
|
if ((buf->len != 12U) && (buf->len != 14U)) {
|
|
|
|
BT_ERR("The message size for the application opcode is incorrect.");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_MOD_PUB_STATUS, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
if (param->cid != CID_NVAL) {
|
|
|
|
if (buf->len < 14) {
|
|
|
|
BT_WARN("Unexpected Mod Pub Status with SIG Model");
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
cid = sys_get_le16(&buf->data[10]);
|
|
|
|
mod_id = sys_get_le16(&buf->data[12]);
|
|
|
|
} else {
|
|
|
|
if (buf->len > 12) {
|
|
|
|
BT_WARN("Unexpected Mod Pub Status with Vendor Model");
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
cid = CID_NVAL;
|
|
|
|
mod_id = sys_get_le16(&buf->data[10]);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (mod_id != param->mod_id || cid != param->cid) {
|
|
|
|
BT_WARN("Mod Pub Model ID or Company ID mismatch");
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
status = net_buf_simple_pull_u8(buf);
|
|
|
|
|
|
|
|
elem_addr = net_buf_simple_pull_le16(buf);
|
|
|
|
if (elem_addr != param->elem_addr) {
|
|
|
|
BT_WARN("Model Pub Status for unexpected element (0x%04x)",
|
|
|
|
elem_addr);
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
2018-03-19 16:58:06 +02:00
|
|
|
if (param->status) {
|
|
|
|
*param->status = status;
|
|
|
|
}
|
2017-11-16 12:29:31 +02:00
|
|
|
|
|
|
|
if (param->pub) {
|
|
|
|
param->pub->addr = net_buf_simple_pull_le16(buf);
|
|
|
|
param->pub->app_idx = net_buf_simple_pull_le16(buf);
|
|
|
|
param->pub->cred_flag = (param->pub->app_idx & BIT(12));
|
|
|
|
param->pub->app_idx &= BIT_MASK(12);
|
|
|
|
param->pub->ttl = net_buf_simple_pull_u8(buf);
|
|
|
|
param->pub->period = net_buf_simple_pull_u8(buf);
|
|
|
|
param->pub->transmit = net_buf_simple_pull_u8(buf);
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
2017-11-12 23:51:28 +02:00
|
|
|
struct mod_sub_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t *status;
|
|
|
|
uint16_t elem_addr;
|
|
|
|
uint16_t *sub_addr;
|
|
|
|
uint16_t *expect_sub;
|
|
|
|
uint16_t mod_id;
|
|
|
|
uint16_t cid;
|
2017-11-12 23:51:28 +02:00
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int mod_sub_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-12 23:51:28 +02:00
|
|
|
{
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t elem_addr, sub_addr, mod_id, cid;
|
2017-11-12 23:51:28 +02:00
|
|
|
struct mod_sub_param *param;
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t status;
|
2017-11-12 23:51:28 +02:00
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-04-27 15:59:54 +02:00
|
|
|
if ((buf->len != 7U) && (buf->len != 9U)) {
|
|
|
|
BT_ERR("The message size for the application opcode is incorrect.");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_MOD_SUB_STATUS, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-12 23:51:28 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
status = net_buf_simple_pull_u8(buf);
|
|
|
|
elem_addr = net_buf_simple_pull_le16(buf);
|
|
|
|
sub_addr = net_buf_simple_pull_le16(buf);
|
|
|
|
|
2019-03-26 19:57:45 -06:00
|
|
|
if (buf->len >= 4U) {
|
2017-11-12 23:51:28 +02:00
|
|
|
cid = net_buf_simple_pull_le16(buf);
|
|
|
|
} else {
|
2017-11-16 10:28:33 +02:00
|
|
|
cid = CID_NVAL;
|
2017-11-12 23:51:28 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
mod_id = net_buf_simple_pull_le16(buf);
|
|
|
|
|
2017-11-24 13:36:05 +02:00
|
|
|
if (param->elem_addr != elem_addr || param->mod_id != mod_id ||
|
|
|
|
(param->expect_sub && *param->expect_sub != sub_addr) ||
|
2017-11-16 10:28:33 +02:00
|
|
|
param->cid != cid) {
|
2017-11-12 23:51:28 +02:00
|
|
|
BT_WARN("Model Subscription Status parameters did not match");
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-12 23:51:28 +02:00
|
|
|
}
|
|
|
|
|
2017-11-24 13:36:05 +02:00
|
|
|
if (param->sub_addr) {
|
|
|
|
*param->sub_addr = sub_addr;
|
|
|
|
}
|
|
|
|
|
2018-03-19 16:58:06 +02:00
|
|
|
if (param->status) {
|
|
|
|
*param->status = status;
|
|
|
|
}
|
2017-11-12 23:51:28 +02:00
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-11-12 23:51:28 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int mod_sub_list(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
2021-03-24 17:38:03 +01:00
|
|
|
struct mod_member_list_param *param;
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_MOD_SUB_LIST, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
return mod_member_list_handle(ctx, buf, false, param);
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int mod_sub_list_vnd(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
2021-03-24 17:38:03 +01:00
|
|
|
struct mod_member_list_param *param;
|
|
|
|
|
2020-04-22 10:14:12 +02:00
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_MOD_SUB_LIST_VND, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
return mod_member_list_handle(ctx, buf, true, param);
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2017-11-13 00:22:09 +02:00
|
|
|
struct hb_sub_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t *status;
|
2017-11-16 14:21:23 +02:00
|
|
|
struct bt_mesh_cfg_hb_sub *sub;
|
2017-11-13 00:22:09 +02:00
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int hb_sub_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-13 00:22:09 +02:00
|
|
|
{
|
|
|
|
struct hb_sub_param *param;
|
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_HEARTBEAT_SUB_STATUS, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-13 00:22:09 +02:00
|
|
|
}
|
|
|
|
|
2017-11-14 20:42:48 +02:00
|
|
|
*param->status = net_buf_simple_pull_u8(buf);
|
2017-11-13 00:22:09 +02:00
|
|
|
|
2017-11-16 14:21:23 +02:00
|
|
|
param->sub->src = net_buf_simple_pull_le16(buf);
|
|
|
|
param->sub->dst = net_buf_simple_pull_le16(buf);
|
|
|
|
param->sub->period = net_buf_simple_pull_u8(buf);
|
|
|
|
param->sub->count = net_buf_simple_pull_u8(buf);
|
|
|
|
param->sub->min = net_buf_simple_pull_u8(buf);
|
|
|
|
param->sub->max = net_buf_simple_pull_u8(buf);
|
2017-11-13 00:22:09 +02:00
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-11-13 00:22:09 +02:00
|
|
|
}
|
|
|
|
|
2017-11-14 10:46:22 +02:00
|
|
|
struct hb_pub_param {
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t *status;
|
2017-11-16 12:50:13 +02:00
|
|
|
struct bt_mesh_cfg_hb_pub *pub;
|
2017-11-14 10:46:22 +02:00
|
|
|
};
|
|
|
|
|
2021-04-14 13:17:59 +02:00
|
|
|
static int hb_pub_status(struct bt_mesh_model *model,
|
|
|
|
struct bt_mesh_msg_ctx *ctx,
|
|
|
|
struct net_buf_simple *buf)
|
2017-11-14 10:46:22 +02:00
|
|
|
{
|
|
|
|
struct hb_pub_param *param;
|
|
|
|
|
|
|
|
BT_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));
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
if (!bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_HEARTBEAT_PUB_STATUS, ctx->addr,
|
|
|
|
(void **)¶m)) {
|
2021-04-14 13:17:59 +02:00
|
|
|
return -ENOENT;
|
2017-11-14 10:46:22 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
*param->status = net_buf_simple_pull_u8(buf);
|
2017-11-16 12:50:13 +02:00
|
|
|
|
|
|
|
if (param->pub) {
|
|
|
|
param->pub->dst = net_buf_simple_pull_le16(buf);
|
|
|
|
param->pub->count = net_buf_simple_pull_u8(buf);
|
|
|
|
param->pub->period = net_buf_simple_pull_u8(buf);
|
|
|
|
param->pub->ttl = net_buf_simple_pull_u8(buf);
|
|
|
|
param->pub->feat = net_buf_simple_pull_u8(buf);
|
|
|
|
param->pub->net_idx = net_buf_simple_pull_u8(buf);
|
|
|
|
}
|
2017-11-14 10:46:22 +02:00
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx);
|
2021-04-14 13:17:59 +02:00
|
|
|
|
|
|
|
return 0;
|
2017-11-14 10:46:22 +02:00
|
|
|
}
|
|
|
|
|
2017-11-12 13:48:55 +02:00
|
|
|
const struct bt_mesh_model_op bt_mesh_cfg_cli_op[] = {
|
2021-04-27 15:59:54 +02:00
|
|
|
{ OP_DEV_COMP_DATA_STATUS, BT_MESH_LEN_MIN(15), 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 },
|
2017-11-12 13:48:55 +02:00
|
|
|
BT_MESH_MODEL_OP_END,
|
|
|
|
};
|
2017-11-12 17:47:00 +02:00
|
|
|
|
2019-08-19 10:05:36 +02:00
|
|
|
static int cfg_cli_init(struct bt_mesh_model *model)
|
|
|
|
{
|
|
|
|
if (!bt_mesh_model_in_primary(model)) {
|
|
|
|
BT_ERR("Configuration Client only allowed in primary element");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!model->user_data) {
|
|
|
|
BT_ERR("No Configuration Client context provided");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
cli = model->user_data;
|
|
|
|
cli->model = model;
|
2020-04-06 13:56:14 +02:00
|
|
|
msg_timeout = 2 * MSEC_PER_SEC;
|
2019-08-19 10:05:36 +02:00
|
|
|
|
2019-07-12 15:57:58 +02:00
|
|
|
/*
|
|
|
|
* 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;
|
2019-08-19 10:05:36 +02:00
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_init(&cli->ack_ctx);
|
2019-08-19 10:05:36 +02:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
const struct bt_mesh_model_cb bt_mesh_cfg_cli_cb = {
|
|
|
|
.init = cfg_cli_init,
|
|
|
|
};
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
static int cli_prepare(void *param, uint32_t op, uint16_t addr)
|
2017-11-12 18:33:47 +02:00
|
|
|
{
|
|
|
|
if (!cli) {
|
|
|
|
BT_ERR("No available Configuration Client context!");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_prepare(&cli->ack_ctx, op, addr, param);
|
2017-11-22 18:51:45 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_comp_data_get(uint16_t net_idx, uint16_t addr, uint8_t page,
|
2021-03-23 14:35:03 +01:00
|
|
|
uint8_t *rsp, struct net_buf_simple *comp)
|
2017-11-12 17:47:00 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_DEV_COMP_DATA_GET, 1);
|
2017-11-12 17:47:00 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-12 17:47:00 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct comp_data param = {
|
2021-03-23 14:35:03 +01:00
|
|
|
.page = rsp,
|
2017-11-12 17:47:00 +02:00
|
|
|
.comp = comp,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_DEV_COMP_DATA_STATUS, addr);
|
2017-11-12 18:33:47 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
2017-11-12 17:47:00 +02:00
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, OP_DEV_COMP_DATA_GET);
|
|
|
|
net_buf_simple_add_u8(&msg, page);
|
2017-11-12 17:47:00 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-12 17:47:00 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 17:47:00 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-12 17:47:00 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
static int get_state_u8(uint16_t net_idx, uint16_t addr, uint32_t op, uint32_t rsp,
|
|
|
|
uint8_t *val)
|
2017-11-12 18:33:47 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 0);
|
2017-11-12 18:33:47 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-12 18:33:47 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(val, rsp, addr);
|
2017-11-12 18:33:47 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, op);
|
2017-11-12 18:33:47 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-12 18:33:47 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 18:33:47 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-12 18:33:47 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
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)
|
2017-11-12 18:33:47 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 1);
|
2017-11-12 18:33:47 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-12 18:33:47 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(val, rsp, addr);
|
2017-11-12 18:33:47 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, op);
|
|
|
|
net_buf_simple_add_u8(&msg, new_val);
|
2017-11-12 18:33:47 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-12 18:33:47 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 18:33:47 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-12 18:33:47 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_beacon_get(uint16_t net_idx, uint16_t addr, uint8_t *status)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
|
|
|
return get_state_u8(net_idx, addr, OP_BEACON_GET, OP_BEACON_STATUS,
|
|
|
|
status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_beacon_set(uint16_t net_idx, uint16_t addr, uint8_t val, uint8_t *status)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
|
|
|
return set_state_u8(net_idx, addr, OP_BEACON_SET, OP_BEACON_STATUS,
|
|
|
|
val, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_ttl_get(uint16_t net_idx, uint16_t addr, uint8_t *ttl)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
|
|
|
return get_state_u8(net_idx, addr, OP_DEFAULT_TTL_GET,
|
|
|
|
OP_DEFAULT_TTL_STATUS, ttl);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_ttl_set(uint16_t net_idx, uint16_t addr, uint8_t val, uint8_t *ttl)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
|
|
|
return set_state_u8(net_idx, addr, OP_DEFAULT_TTL_SET,
|
|
|
|
OP_DEFAULT_TTL_STATUS, val, ttl);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_friend_get(uint16_t net_idx, uint16_t addr, uint8_t *status)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
|
|
|
return get_state_u8(net_idx, addr, OP_FRIEND_GET,
|
|
|
|
OP_FRIEND_STATUS, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_friend_set(uint16_t net_idx, uint16_t addr, uint8_t val, uint8_t *status)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
|
|
|
return set_state_u8(net_idx, addr, OP_FRIEND_SET, OP_FRIEND_STATUS,
|
|
|
|
val, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_gatt_proxy_get(uint16_t net_idx, uint16_t addr, uint8_t *status)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
|
|
|
return get_state_u8(net_idx, addr, OP_GATT_PROXY_GET,
|
|
|
|
OP_GATT_PROXY_STATUS, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_gatt_proxy_set(uint16_t net_idx, uint16_t addr, uint8_t val,
|
|
|
|
uint8_t *status)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
|
|
|
return set_state_u8(net_idx, addr, OP_GATT_PROXY_SET,
|
|
|
|
OP_GATT_PROXY_STATUS, val, status);
|
|
|
|
}
|
|
|
|
|
2020-09-23 10:50:23 +08:00
|
|
|
int bt_mesh_cfg_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_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);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_relay_get(uint16_t net_idx, uint16_t addr, uint8_t *status,
|
|
|
|
uint8_t *transmit)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_RELAY_GET, 0);
|
2017-11-12 21:10:05 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-12 21:10:05 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct relay_param param = {
|
|
|
|
.status = status,
|
|
|
|
.transmit = transmit,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_RELAY_STATUS, addr);
|
2017-11-12 21:10:05 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, OP_RELAY_GET);
|
2017-11-12 21:10:05 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-12 21:10:05 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 21:10:05 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-12 21:10:05 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_relay_set(uint16_t net_idx, uint16_t addr, uint8_t new_relay,
|
|
|
|
uint8_t new_transmit, uint8_t *status, uint8_t *transmit)
|
2017-11-12 21:10:05 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_RELAY_SET, 2);
|
2017-11-12 21:10:05 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-12 21:10:05 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct relay_param param = {
|
|
|
|
.status = status,
|
|
|
|
.transmit = transmit,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_RELAY_STATUS, addr);
|
2017-11-12 21:10:05 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
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);
|
2017-11-12 21:10:05 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-12 21:10:05 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 21:10:05 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-12 21:10:05 +02:00
|
|
|
}
|
2017-11-12 18:33:47 +02:00
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_net_key_add(uint16_t net_idx, uint16_t addr, uint16_t key_net_idx,
|
|
|
|
const uint8_t net_key[16], uint8_t *status)
|
2017-12-01 10:54:38 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_NET_KEY_ADD, 18);
|
2017-12-01 10:54:38 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-12-01 10:54:38 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct net_key_param param = {
|
|
|
|
.status = status,
|
|
|
|
.net_idx = key_net_idx,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_NET_KEY_STATUS, addr);
|
2017-12-01 10:54:38 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
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);
|
2017-12-01 10:54:38 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-12-01 10:54:38 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-12-01 10:54:38 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-12-01 10:54:38 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-12-01 10:54:38 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_net_key_get(uint16_t net_idx, uint16_t addr, uint16_t *keys,
|
2020-04-22 10:14:12 +02:00
|
|
|
size_t *key_cnt)
|
|
|
|
{
|
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_NET_KEY_GET, 0);
|
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct net_key_list_param param = {
|
|
|
|
.keys = keys,
|
|
|
|
.key_cnt = key_cnt,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_NET_KEY_LIST, addr);
|
2020-04-22 10:14:12 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
bt_mesh_model_msg_init(&msg, OP_NET_KEY_GET);
|
|
|
|
|
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-04-22 10:14:12 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2020-08-27 10:37:48 +02:00
|
|
|
int bt_mesh_cfg_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 = {
|
|
|
|
.net_idx = net_idx,
|
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct net_key_param param = {
|
|
|
|
.status = status,
|
|
|
|
.net_idx = key_net_idx,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_NET_KEY_STATUS, addr);
|
2020-08-27 10:37:48 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
bt_mesh_model_msg_init(&msg, OP_NET_KEY_DEL);
|
|
|
|
net_buf_simple_add_le16(&msg, key_net_idx);
|
|
|
|
|
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-08-27 10:37:48 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-08-27 10:37:48 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2020-08-27 10:37:48 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-12 23:04:36 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_APP_KEY_ADD, 19);
|
2017-11-12 23:04:36 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-12 23:04:36 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct app_key_param param = {
|
|
|
|
.status = status,
|
|
|
|
.net_idx = key_net_idx,
|
|
|
|
.app_idx = key_app_idx,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_APP_KEY_STATUS, addr);
|
2017-11-12 23:04:36 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, OP_APP_KEY_ADD);
|
|
|
|
key_idx_pack(&msg, key_net_idx, key_app_idx);
|
|
|
|
net_buf_simple_add_mem(&msg, app_key, 16);
|
2017-11-12 23:04:36 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-12 23:04:36 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-09-23 09:47:29 +08:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-09-23 09:47:29 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2020-09-23 09:47:29 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
int bt_mesh_cfg_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 = {
|
|
|
|
.net_idx = net_idx,
|
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
|
|
|
|
int err;
|
|
|
|
|
|
|
|
if (status) {
|
|
|
|
*status = false;
|
|
|
|
}
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(status, OP_NODE_RESET_STATUS, addr);
|
2020-09-23 09:47:29 +08:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
bt_mesh_model_msg_init(&msg, OP_NODE_RESET);
|
|
|
|
|
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 23:04:36 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2017-11-12 23:38:44 +02:00
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 23:38:44 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-12 23:04:36 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_APP_KEY_GET, 2);
|
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct app_key_list_param param = {
|
|
|
|
.net_idx = key_net_idx,
|
|
|
|
.status = status,
|
|
|
|
.keys = keys,
|
|
|
|
.key_cnt = key_cnt,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_APP_KEY_LIST, addr);
|
2020-04-22 10:14:12 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
bt_mesh_model_msg_init(&msg, OP_APP_KEY_GET);
|
|
|
|
net_buf_simple_add_le16(&msg, key_net_idx);
|
|
|
|
|
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-04-22 10:14:12 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2020-09-02 20:45:07 +08:00
|
|
|
int bt_mesh_cfg_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 = {
|
|
|
|
.net_idx = net_idx,
|
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct app_key_param param = {
|
|
|
|
.status = status,
|
|
|
|
.net_idx = key_net_idx,
|
|
|
|
.app_idx = key_app_idx,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_APP_KEY_STATUS, addr);
|
2020-09-02 20:45:07 +08:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
bt_mesh_model_msg_init(&msg, OP_APP_KEY_DEL);
|
|
|
|
key_idx_pack(&msg, key_net_idx, key_app_idx);
|
|
|
|
|
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-09-02 20:45:07 +08:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-09-02 20:45:07 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2020-09-02 20:45:07 +08:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
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)
|
2017-11-12 23:38:44 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_APP_BIND, 8);
|
2017-11-12 23:38:44 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-12 23:38:44 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct mod_app_param param = {
|
|
|
|
.status = status,
|
|
|
|
.elem_addr = elem_addr,
|
|
|
|
.mod_app_idx = mod_app_idx,
|
|
|
|
.mod_id = mod_id,
|
|
|
|
.cid = cid,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_MOD_APP_STATUS, addr);
|
2017-11-12 23:38:44 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
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);
|
2017-11-12 23:38:44 +02:00
|
|
|
|
2017-11-16 10:28:33 +02:00
|
|
|
if (cid != CID_NVAL) {
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, cid);
|
2017-11-12 23:38:44 +02:00
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, mod_id);
|
2017-11-12 23:38:44 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-12 23:38:44 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 23:38:44 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 23:38:44 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-12 23:38:44 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-12 23:38:44 +02:00
|
|
|
{
|
|
|
|
return mod_app_bind(net_idx, addr, elem_addr, mod_app_idx, mod_id,
|
2017-11-16 10:28:33 +02:00
|
|
|
CID_NVAL, status);
|
2017-11-12 23:38:44 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-12 23:38:44 +02:00
|
|
|
{
|
2017-11-16 10:28:33 +02:00
|
|
|
if (cid == CID_NVAL) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return mod_app_bind(net_idx, addr, elem_addr, mod_app_idx, mod_id, cid,
|
|
|
|
status);
|
2017-11-12 23:38:44 +02:00
|
|
|
}
|
|
|
|
|
2020-09-02 20:45:07 +08:00
|
|
|
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 = {
|
|
|
|
.net_idx = net_idx,
|
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct mod_app_param param = {
|
|
|
|
.status = status,
|
|
|
|
.elem_addr = elem_addr,
|
|
|
|
.mod_app_idx = mod_app_idx,
|
|
|
|
.mod_id = mod_id,
|
|
|
|
.cid = cid,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_MOD_APP_STATUS, addr);
|
2020-09-02 20:45:07 +08:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
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);
|
|
|
|
|
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-09-02 20:45:07 +08:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-09-02 20:45:07 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2020-09-02 20:45:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
int bt_mesh_cfg_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_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);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
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,
|
2020-04-22 10:14:12 +02:00
|
|
|
size_t *app_cnt)
|
|
|
|
{
|
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 6);
|
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct mod_member_list_param param = {
|
|
|
|
.status = status,
|
|
|
|
.elem_addr = elem_addr,
|
|
|
|
.mod_id = mod_id,
|
|
|
|
.cid = cid,
|
|
|
|
.members = apps,
|
|
|
|
.member_cnt = app_cnt,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, expect_op, addr);
|
2020-04-22 10:14:12 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
BT_DBG("net_idx 0x%04x addr 0x%04x elem_addr 0x%04x",
|
|
|
|
net_idx, addr, elem_addr);
|
|
|
|
BT_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);
|
|
|
|
|
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-04-22 10:14:12 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2020-04-22 10:14:12 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_mod_app_get(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
|
|
|
|
uint16_t mod_id, uint8_t *status, uint16_t *apps,
|
2020-04-22 10:14:12 +02:00
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
|
|
|
if (cid == CID_NVAL) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return mod_member_list_get(OP_VND_MOD_APP_GET, OP_VND_MOD_APP_LIST,
|
2021-03-02 10:41:41 +01:00
|
|
|
net_idx, addr, elem_addr, mod_id, cid,
|
2020-04-22 10:14:12 +02:00
|
|
|
status, apps, app_cnt);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
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)
|
2017-11-12 23:51:28 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 8);
|
2017-11-12 23:51:28 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-12 23:51:28 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct mod_sub_param param = {
|
|
|
|
.status = status,
|
|
|
|
.elem_addr = elem_addr,
|
2017-11-24 13:36:05 +02:00
|
|
|
.expect_sub = &sub_addr,
|
2017-11-12 23:51:28 +02:00
|
|
|
.mod_id = mod_id,
|
|
|
|
.cid = cid,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_MOD_SUB_STATUS, addr);
|
2017-11-12 23:51:28 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, op);
|
|
|
|
net_buf_simple_add_le16(&msg, elem_addr);
|
|
|
|
net_buf_simple_add_le16(&msg, sub_addr);
|
2017-11-12 23:51:28 +02:00
|
|
|
|
2017-11-16 10:28:33 +02:00
|
|
|
if (cid != CID_NVAL) {
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, cid);
|
2017-11-12 23:51:28 +02:00
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, mod_id);
|
2017-11-12 23:51:28 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-12 23:51:28 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-12 23:51:28 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2020-11-24 16:16:02 +01:00
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2020-11-24 16:16:02 +01:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-12 23:51:28 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-12 23:51:28 +02:00
|
|
|
{
|
2017-11-18 11:52:21 +02:00
|
|
|
return mod_sub(OP_MOD_SUB_ADD, net_idx, addr, elem_addr, sub_addr,
|
|
|
|
mod_id, CID_NVAL, status);
|
2017-11-12 23:51:28 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-12 23:51:28 +02:00
|
|
|
{
|
2017-11-16 10:28:33 +02:00
|
|
|
if (cid == CID_NVAL) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2017-11-18 11:52:21 +02:00
|
|
|
return mod_sub(OP_MOD_SUB_ADD, net_idx, addr, elem_addr, sub_addr,
|
|
|
|
mod_id, cid, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-18 11:52:21 +02:00
|
|
|
{
|
|
|
|
return mod_sub(OP_MOD_SUB_DEL, net_idx, addr, elem_addr, sub_addr,
|
|
|
|
mod_id, CID_NVAL, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_mod_sub_del_vnd(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
|
2021-02-22 23:21:16 -08:00
|
|
|
uint16_t sub_addr, uint16_t mod_id, uint16_t cid,
|
|
|
|
uint8_t *status)
|
2017-11-18 11:52:21 +02:00
|
|
|
{
|
|
|
|
if (cid == CID_NVAL) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return mod_sub(OP_MOD_SUB_DEL, net_idx, addr, elem_addr, sub_addr,
|
|
|
|
mod_id, cid, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-18 11:52:21 +02:00
|
|
|
{
|
|
|
|
return mod_sub(OP_MOD_SUB_OVERWRITE, net_idx, addr, elem_addr,
|
|
|
|
sub_addr, mod_id, CID_NVAL, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-18 11:52:21 +02:00
|
|
|
{
|
|
|
|
if (cid == CID_NVAL) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return mod_sub(OP_MOD_SUB_OVERWRITE, net_idx, addr, elem_addr,
|
|
|
|
sub_addr, mod_id, cid, status);
|
2017-11-12 23:51:28 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
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)
|
2017-11-24 13:36:05 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, DUMMY_2_BYTE_OP, 22);
|
2017-11-24 13:36:05 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-24 13:36:05 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct mod_sub_param param = {
|
|
|
|
.status = status,
|
|
|
|
.elem_addr = elem_addr,
|
|
|
|
.sub_addr = virt_addr,
|
|
|
|
.mod_id = mod_id,
|
|
|
|
.cid = cid,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_MOD_SUB_STATUS, addr);
|
2017-11-24 13:36:05 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
BT_DBG("net_idx 0x%04x addr 0x%04x elem_addr 0x%04x label %s",
|
2021-02-22 23:21:16 -08:00
|
|
|
net_idx, addr, elem_addr, log_strdup(label));
|
2017-11-24 13:36:05 +02:00
|
|
|
BT_DBG("mod_id 0x%04x cid 0x%04x", mod_id, cid);
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, op);
|
|
|
|
net_buf_simple_add_le16(&msg, elem_addr);
|
|
|
|
net_buf_simple_add_mem(&msg, label, 16);
|
2017-11-24 13:36:05 +02:00
|
|
|
|
|
|
|
if (cid != CID_NVAL) {
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, cid);
|
2017-11-24 13:36:05 +02:00
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, mod_id);
|
2017-11-24 13:36:05 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-24 13:36:05 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-24 13:36:05 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-24 13:36:05 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-24 13:36:05 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-24 13:36:05 +02:00
|
|
|
{
|
|
|
|
return mod_sub_va(OP_MOD_SUB_VA_ADD, net_idx, addr, elem_addr, label,
|
|
|
|
mod_id, CID_NVAL, virt_addr, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-24 13:36:05 +02:00
|
|
|
{
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-24 13:36:05 +02:00
|
|
|
{
|
|
|
|
return mod_sub_va(OP_MOD_SUB_VA_DEL, net_idx, addr, elem_addr, label,
|
|
|
|
mod_id, CID_NVAL, virt_addr, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-24 13:36:05 +02:00
|
|
|
{
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-24 13:36:05 +02:00
|
|
|
{
|
|
|
|
return mod_sub_va(OP_MOD_SUB_VA_OVERWRITE, net_idx, addr, elem_addr,
|
|
|
|
label, mod_id, CID_NVAL, virt_addr, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2017-11-24 13:36:05 +02:00
|
|
|
{
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_mod_sub_get(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
|
|
|
|
uint16_t mod_id, uint8_t *status, uint16_t *subs,
|
2020-04-22 10:14:12 +02:00
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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)
|
2020-04-22 10:14:12 +02:00
|
|
|
{
|
|
|
|
if (cid == CID_NVAL) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return mod_member_list_get(OP_MOD_SUB_GET_VND, OP_MOD_SUB_LIST_VND,
|
2021-03-02 10:41:41 +01:00
|
|
|
net_idx, addr, elem_addr, mod_id, cid,
|
2020-04-22 10:14:12 +02:00
|
|
|
status, subs, sub_cnt);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
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_mod_pub *pub, uint8_t *status)
|
2017-11-16 12:29:31 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_PUB_GET, 6);
|
2017-11-16 12:29:31 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-16 12:29:31 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct mod_pub_param param = {
|
|
|
|
.mod_id = mod_id,
|
|
|
|
.cid = cid,
|
|
|
|
.elem_addr = elem_addr,
|
|
|
|
.status = status,
|
|
|
|
.pub = pub,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_MOD_PUB_STATUS, addr);
|
2017-11-16 12:29:31 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, OP_MOD_PUB_GET);
|
2017-11-16 12:29:31 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, elem_addr);
|
2017-11-16 12:29:31 +02:00
|
|
|
|
|
|
|
if (cid != CID_NVAL) {
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, cid);
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, mod_id);
|
2017-11-16 12:29:31 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-16 12:29:31 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-16 12:29:31 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-16 12:29:31 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_mod_pub_get(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
|
|
|
|
uint16_t mod_id, struct bt_mesh_cfg_mod_pub *pub,
|
|
|
|
uint8_t *status)
|
2017-11-16 12:29:31 +02:00
|
|
|
{
|
|
|
|
return mod_pub_get(net_idx, addr, elem_addr, mod_id, CID_NVAL,
|
|
|
|
pub, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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_mod_pub *pub, uint8_t *status)
|
2017-11-16 12:29:31 +02:00
|
|
|
{
|
|
|
|
if (cid == CID_NVAL) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2018-01-31 13:06:21 -08:00
|
|
|
return mod_pub_get(net_idx, addr, elem_addr, mod_id, cid, pub, status);
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
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_mod_pub *pub, uint8_t *status)
|
2017-11-16 12:29:31 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_PUB_SET, 13);
|
2017-11-16 12:29:31 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-16 12:29:31 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct mod_pub_param param = {
|
|
|
|
.mod_id = mod_id,
|
|
|
|
.cid = cid,
|
|
|
|
.elem_addr = elem_addr,
|
|
|
|
.status = status,
|
|
|
|
.pub = pub,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_MOD_PUB_STATUS, addr);
|
2017-11-16 12:29:31 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, OP_MOD_PUB_SET);
|
2017-11-16 12:29:31 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, elem_addr);
|
|
|
|
net_buf_simple_add_le16(&msg, pub->addr);
|
2019-11-14 02:49:38 -08:00
|
|
|
net_buf_simple_add_le16(&msg, (pub->app_idx | (pub->cred_flag << 12)));
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_u8(&msg, pub->ttl);
|
|
|
|
net_buf_simple_add_u8(&msg, pub->period);
|
|
|
|
net_buf_simple_add_u8(&msg, pub->transmit);
|
2017-11-16 12:29:31 +02:00
|
|
|
|
|
|
|
if (cid != CID_NVAL) {
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, cid);
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
net_buf_simple_add_le16(&msg, mod_id);
|
2017-11-16 12:29:31 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-16 12:29:31 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-16 12:29:31 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-16 12:29:31 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_mod_pub_set(uint16_t net_idx, uint16_t addr, uint16_t elem_addr,
|
|
|
|
uint16_t mod_id, struct bt_mesh_cfg_mod_pub *pub,
|
|
|
|
uint8_t *status)
|
2017-11-16 12:29:31 +02:00
|
|
|
{
|
|
|
|
return mod_pub_set(net_idx, addr, elem_addr, mod_id, CID_NVAL,
|
|
|
|
pub, status);
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_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_mod_pub *pub, uint8_t *status)
|
2017-11-16 12:29:31 +02:00
|
|
|
{
|
|
|
|
if (cid == CID_NVAL) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2018-01-31 13:06:21 -08:00
|
|
|
return mod_pub_set(net_idx, addr, elem_addr, mod_id, cid, pub, status);
|
2017-11-16 12:29:31 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_hb_sub_set(uint16_t net_idx, uint16_t addr,
|
|
|
|
struct bt_mesh_cfg_hb_sub *sub, uint8_t *status)
|
2017-11-13 00:22:09 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_SUB_SET, 5);
|
2017-11-13 00:22:09 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-13 00:22:09 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct hb_sub_param param = {
|
|
|
|
.status = status,
|
2017-11-16 14:21:23 +02:00
|
|
|
.sub = sub,
|
2017-11-13 00:22:09 +02:00
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_HEARTBEAT_SUB_STATUS, addr);
|
2017-11-13 00:22:09 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
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);
|
2017-11-14 20:42:48 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-14 20:42:48 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-14 20:42:48 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-14 20:42:48 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-14 20:42:48 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_hb_sub_get(uint16_t net_idx, uint16_t addr,
|
|
|
|
struct bt_mesh_cfg_hb_sub *sub, uint8_t *status)
|
2017-11-14 20:42:48 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_SUB_GET, 0);
|
2017-11-14 20:42:48 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-14 20:42:48 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct hb_sub_param param = {
|
|
|
|
.status = status,
|
2017-11-16 14:21:23 +02:00
|
|
|
.sub = sub,
|
2017-11-14 20:42:48 +02:00
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_HEARTBEAT_SUB_STATUS, addr);
|
2017-11-14 20:42:48 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, OP_HEARTBEAT_SUB_GET);
|
2017-11-13 00:22:09 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-13 00:22:09 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-13 00:22:09 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-13 00:22:09 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-13 00:22:09 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_hb_pub_set(uint16_t net_idx, uint16_t addr,
|
|
|
|
const struct bt_mesh_cfg_hb_pub *pub, uint8_t *status)
|
2017-11-14 10:46:22 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_PUB_SET, 9);
|
2017-11-14 10:46:22 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-14 10:46:22 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct hb_pub_param param = {
|
|
|
|
.status = status,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_HEARTBEAT_PUB_STATUS, addr);
|
2017-11-14 10:46:22 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
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);
|
2017-11-14 10:46:22 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-14 10:46:22 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-14 10:46:22 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-14 10:46:22 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-14 10:46:22 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int bt_mesh_cfg_hb_pub_get(uint16_t net_idx, uint16_t addr,
|
|
|
|
struct bt_mesh_cfg_hb_pub *pub, uint8_t *status)
|
2017-11-14 20:18:04 +02:00
|
|
|
{
|
2019-10-08 09:39:48 +02:00
|
|
|
BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_PUB_GET, 0);
|
2017-11-14 20:18:04 +02:00
|
|
|
struct bt_mesh_msg_ctx ctx = {
|
|
|
|
.net_idx = net_idx,
|
2019-07-12 15:57:58 +02:00
|
|
|
.app_idx = BT_MESH_KEY_DEV_REMOTE,
|
2017-11-14 20:18:04 +02:00
|
|
|
.addr = addr,
|
|
|
|
.send_ttl = BT_MESH_TTL_DEFAULT,
|
|
|
|
};
|
|
|
|
struct hb_pub_param param = {
|
|
|
|
.status = status,
|
2017-11-16 12:50:13 +02:00
|
|
|
.pub = pub,
|
2017-11-14 20:18:04 +02:00
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2021-03-24 12:59:45 +01:00
|
|
|
err = cli_prepare(¶m, OP_HEARTBEAT_PUB_STATUS, addr);
|
2017-11-14 20:18:04 +02:00
|
|
|
if (err) {
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
bt_mesh_model_msg_init(&msg, OP_HEARTBEAT_PUB_GET);
|
2017-11-14 20:18:04 +02:00
|
|
|
|
2018-02-10 10:32:58 +02:00
|
|
|
err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL);
|
2017-11-14 20:18:04 +02:00
|
|
|
if (err) {
|
|
|
|
BT_ERR("model_send() failed (err %d)", err);
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-14 20:18:04 +02:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!status) {
|
2021-03-24 17:38:03 +01:00
|
|
|
bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx);
|
2017-11-14 20:18:04 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-03-24 17:38:03 +01:00
|
|
|
return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout));
|
2017-11-14 20:18:04 +02:00
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
int32_t bt_mesh_cfg_cli_timeout_get(void)
|
2017-11-14 20:45:26 +02:00
|
|
|
{
|
|
|
|
return msg_timeout;
|
|
|
|
}
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
void bt_mesh_cfg_cli_timeout_set(int32_t timeout)
|
2017-11-14 20:45:26 +02:00
|
|
|
{
|
|
|
|
msg_timeout = timeout;
|
|
|
|
}
|
2021-03-23 14:50:09 +01:00
|
|
|
|
|
|
|
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;
|
|
|
|
}
|