| /* |
| * Copyright (c) 2017 Intel Corporation |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| #include <zephyr/zephyr.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> |
| |
| #define BT_DBG_ENABLED IS_ENABLED(CONFIG_BT_MESH_DEBUG_MODEL) |
| #define LOG_MODULE_NAME bt_mesh_cfg_cli |
| #include "common/log.h" |
| |
| #include "net.h" |
| #include "foundation.h" |
| |
| #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) |
| |
| 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(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| struct comp_data *param; |
| uint8_t page; |
| 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)); |
| |
| page = net_buf_simple_pull_u8(buf); |
| |
| if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_DEV_COMP_DATA_STATUS, ctx->addr, |
| (void **)¶m)) { |
| 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); |
| } |
| return 0; |
| } |
| |
| 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) |
| { |
| uint8_t *param; |
| uint8_t status; |
| |
| 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)); |
| |
| status = net_buf_simple_pull_u8(buf); |
| |
| if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, expect_status, ctx->addr, |
| (void **)¶m)) { |
| |
| if (param) { |
| *param = status; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| return 0; |
| } |
| |
| static int beacon_status(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| return state_status_u8(model, ctx, buf, OP_BEACON_STATUS); |
| } |
| |
| static int ttl_status(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| return state_status_u8(model, ctx, buf, OP_DEFAULT_TTL_STATUS); |
| } |
| |
| static int friend_status(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| return state_status_u8(model, ctx, buf, OP_FRIEND_STATUS); |
| } |
| |
| static int gatt_proxy_status(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| return state_status_u8(model, ctx, buf, OP_GATT_PROXY_STATUS); |
| } |
| |
| static int transmit_status(struct bt_mesh_model *model, struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| return state_status_u8(model, ctx, buf, OP_NET_TRANSMIT_STATUS); |
| } |
| |
| struct krp_param { |
| uint8_t *status; |
| uint16_t net_idx; |
| uint8_t *phase; |
| }; |
| |
| static int krp_status(struct bt_mesh_model *model, struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| struct krp_param *param; |
| uint16_t net_idx; |
| uint8_t status, phase; |
| |
| 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)); |
| |
| 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 **)¶m)) { |
| if (param->net_idx != net_idx) { |
| return -ENOENT; |
| } |
| |
| if (param->status) { |
| *param->status = status; |
| } |
| |
| if (param->phase) { |
| *param->phase = phase; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| |
| return 0; |
| } |
| |
| struct relay_param { |
| uint8_t *status; |
| uint8_t *transmit; |
| }; |
| |
| static int relay_status(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; |
| |
| 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)); |
| |
| 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 **)¶m)) { |
| if (param->status) { |
| *param->status = status; |
| } |
| |
| if (param->transmit) { |
| *param->transmit = transmit; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| |
| return 0; |
| } |
| |
| static int net_transmit_status(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| return state_status_u8(model, ctx, buf, OP_NET_TRANSMIT_STATUS); |
| } |
| |
| struct net_key_param { |
| uint8_t *status; |
| uint16_t net_idx; |
| }; |
| |
| static int net_key_status(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; |
| |
| 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)); |
| |
| 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 **)¶m)) { |
| |
| if (param->net_idx != net_idx) { |
| BT_WARN("Net Key Status key index does not match"); |
| return -ENOENT; |
| } |
| |
| if (param->status) { |
| *param->status = status; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| return 0; |
| } |
| |
| struct net_key_list_param { |
| uint16_t *keys; |
| size_t *key_cnt; |
| }; |
| |
| static int net_key_list(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| 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)); |
| |
| if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_NET_KEY_LIST, ctx->addr, |
| (void **)¶m)) { |
| |
| if (param->keys && param->key_cnt) { |
| |
| 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; |
| } |
| |
| if (buf->len > 0) { |
| BT_ERR("The message size for the application opcode is incorrect."); |
| return -EMSGSIZE; |
| } |
| |
| *param->key_cnt = i; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| |
| return 0; |
| } |
| |
| static int node_reset_status(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| bool *param = NULL; |
| |
| BT_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 **)¶m)) { |
| |
| if (param) { |
| *param = true; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| return 0; |
| } |
| |
| struct app_key_param { |
| uint8_t *status; |
| uint16_t net_idx; |
| uint16_t app_idx; |
| }; |
| |
| static int app_key_status(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; |
| |
| 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)); |
| |
| status = net_buf_simple_pull_u8(buf); |
| key_idx_unpack(buf, &net_idx, &app_idx); |
| |
| if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_APP_KEY_STATUS, ctx->addr, |
| (void **)¶m)) { |
| |
| if (param->net_idx != net_idx || param->app_idx != app_idx) { |
| BT_WARN("App Key Status key indices did not match"); |
| return -ENOENT; |
| } |
| |
| if (param->status) { |
| *param->status = status; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| return 0; |
| } |
| |
| struct app_key_list_param { |
| uint16_t net_idx; |
| uint8_t *status; |
| uint16_t *keys; |
| size_t *key_cnt; |
| }; |
| |
| static int app_key_list(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| struct app_key_list_param *param; |
| uint16_t net_idx; |
| uint8_t status; |
| 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)); |
| |
| 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_APP_KEY_LIST, ctx->addr, |
| (void **)¶m)) { |
| |
| if (param->net_idx != net_idx) { |
| BT_WARN("App Key List Net Key index did not match"); |
| return -ENOENT; |
| } |
| |
| if (param->keys && param->key_cnt) { |
| |
| for (i = 0; i < *param->key_cnt && buf->len >= 3; i += 2) { |
| key_idx_unpack(buf, ¶m->keys[i], |
| ¶m->keys[i + 1]); |
| } |
| |
| if (buf->len > 0U) { |
| BT_ERR("The message size for the application opcode is incorrect."); |
| return -EMSGSIZE; |
| } |
| |
| *param->key_cnt = i; |
| } |
| |
| if (param->status) { |
| *param->status = status; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| return 0; |
| } |
| |
| 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(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; |
| |
| 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)); |
| |
| if ((buf->len != 7U) && (buf->len != 9U)) { |
| BT_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 **)¶m)) { |
| |
| if (param->elem_addr != elem_addr || |
| param->mod_app_idx != mod_app_idx || |
| param->mod_id != mod_id || param->cid != cid) { |
| BT_WARN("Model App Status parameters did not match"); |
| return -ENOENT; |
| } |
| |
| if (param->status) { |
| *param->status = status; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| return 0; |
| } |
| |
| 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_member_list_handle(struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf, uint16_t op, |
| bool vnd) |
| { |
| struct mod_member_list_param *param; |
| uint16_t elem_addr, mod_id, cid; |
| uint8_t status; |
| int i; |
| |
| if ((vnd && buf->len < 7U) || (buf->len < 5U)) { |
| BT_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); |
| if (vnd) { |
| cid = net_buf_simple_pull_le16(buf); |
| } |
| |
| mod_id = net_buf_simple_pull_le16(buf); |
| |
| if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, op, ctx->addr, |
| (void **)¶m)) { |
| |
| if (param->elem_addr != elem_addr || param->mod_id != mod_id || |
| (vnd && param->cid != cid)) { |
| BT_WARN("Model Member List parameters did not match"); |
| return -ENOENT; |
| } |
| |
| if (buf->len % 2) { |
| BT_WARN("Model Member List invalid length"); |
| return -EMSGSIZE; |
| } |
| |
| if (param->member_cnt && param->members) { |
| |
| 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); |
| } |
| return 0; |
| } |
| |
| static int mod_app_list(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, struct net_buf_simple *buf) |
| { |
| 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)); |
| |
| return mod_member_list_handle(ctx, buf, OP_SIG_MOD_APP_LIST, false); |
| } |
| |
| static int mod_app_list_vnd(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| 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)); |
| |
| return mod_member_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_mod_pub *pub; |
| }; |
| |
| static int mod_pub_status(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| struct mod_pub_param *param; |
| uint16_t mod_id, cid, elem_addr; |
| struct bt_mesh_cfg_mod_pub pub; |
| uint8_t status; |
| |
| 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)); |
| |
| if ((buf->len != 12U) && (buf->len != 14U)) { |
| BT_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 **)¶m)) { |
| if (mod_id != param->mod_id || cid != param->cid) { |
| BT_WARN("Mod Pub Model ID or Company ID mismatch"); |
| return -ENOENT; |
| } |
| |
| if (elem_addr != param->elem_addr) { |
| BT_WARN("Model Pub Status for unexpected element (0x%04x)", elem_addr); |
| return -ENOENT; |
| } |
| |
| if (param->status) { |
| *param->status = status; |
| } |
| |
| if (param->pub) { |
| *param->pub = pub; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| return 0; |
| } |
| |
| 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(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; |
| |
| 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)); |
| |
| if ((buf->len != 7U) && (buf->len != 9U)) { |
| BT_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 **)¶m)) { |
| if (param->elem_addr != elem_addr || param->mod_id != mod_id || |
| (param->expect_sub && *param->expect_sub != sub_addr) || |
| param->cid != cid) { |
| BT_WARN("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, mod_id); |
| } |
| |
| return err; |
| } |
| |
| static int mod_sub_list(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, struct net_buf_simple *buf) |
| { |
| 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)); |
| |
| return mod_member_list_handle(ctx, buf, OP_MOD_SUB_LIST, false); |
| } |
| |
| static int mod_sub_list_vnd(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| 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)); |
| |
| return mod_member_list_handle(ctx, buf, OP_MOD_SUB_LIST_VND, true); |
| } |
| |
| struct hb_sub_param { |
| uint8_t *status; |
| struct bt_mesh_cfg_hb_sub *sub; |
| }; |
| |
| static int hb_sub_status(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_hb_sub sub; |
| uint8_t status; |
| |
| 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)); |
| |
| 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 **)¶m)) { |
| if (param->status) { |
| *param->status = status; |
| } |
| |
| if (param->sub) { |
| *param->sub = sub; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| return 0; |
| } |
| |
| struct hb_pub_param { |
| uint8_t *status; |
| struct bt_mesh_cfg_hb_pub *pub; |
| }; |
| |
| static int hb_pub_status(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_hb_pub pub; |
| |
| 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)); |
| |
| 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_u8(buf); |
| pub.net_idx = net_buf_simple_pull_u8(buf); |
| |
| if (bt_mesh_msg_ack_ctx_match(&cli->ack_ctx, OP_HEARTBEAT_PUB_STATUS, |
| ctx->addr, (void **)¶m)) { |
| if (param->status) { |
| *param->status = status; |
| } |
| |
| if (param->pub) { |
| *param->pub = pub; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| return 0; |
| } |
| |
| struct node_idt_param { |
| uint8_t *status; |
| uint16_t net_idx; |
| uint8_t *identity; |
| }; |
| |
| static int node_identity_status(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; |
| |
| 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)); |
| |
| 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 **)¶m)) { |
| if (param && param->status) { |
| *param->status = status; |
| } |
| |
| if (param && param->identity) { |
| *param->identity = identity; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| |
| return 0; |
| } |
| |
| struct lpn_timeout_param { |
| uint16_t unicast_addr; |
| int32_t *polltimeout; |
| }; |
| |
| static int lpn_timeout_status(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; |
| |
| 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)); |
| |
| 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 **)¶m)) { |
| if (param->unicast_addr != unicast_addr) { |
| return -ENOENT; |
| } |
| |
| if (param->polltimeout) { |
| *param->polltimeout = polltimeout; |
| } |
| |
| bt_mesh_msg_ack_ctx_rx(&cli->ack_ctx); |
| } |
| |
| return 0; |
| } |
| |
| const struct bt_mesh_model_op bt_mesh_cfg_cli_op[] = { |
| { 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 }, |
| { 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_NET_TRANSMIT_STATUS, BT_MESH_LEN_EXACT(1), transmit_status}, |
| { OP_KRP_STATUS, BT_MESH_LEN_EXACT(4), krp_status}, |
| BT_MESH_MODEL_OP_END, |
| }; |
| |
| 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; |
| 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; |
| |
| 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, |
| }; |
| |
| static int cli_prepare(void *param, uint32_t op, uint16_t addr) |
| { |
| if (!cli) { |
| BT_ERR("No available Configuration Client context!"); |
| return -EINVAL; |
| } |
| |
| return bt_mesh_msg_ack_ctx_prepare(&cli->ack_ctx, op, addr, param); |
| } |
| |
| int bt_mesh_cfg_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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| struct comp_data param = { |
| .page = rsp, |
| .comp = comp, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_DEV_COMP_DATA_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, OP_DEV_COMP_DATA_GET); |
| net_buf_simple_add_u8(&msg, page); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!rsp && !comp) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| int err; |
| |
| err = cli_prepare(val, rsp, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, op); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!val) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| int err; |
| |
| err = cli_prepare(val, rsp, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, op); |
| net_buf_simple_add_u8(&msg, new_val); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!val) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_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_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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| struct krp_param param = { |
| .status = status, |
| .phase = phase, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_KRP_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, OP_KRP_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); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !phase) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| struct krp_param param = { |
| .status = status, |
| .phase = phase, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_KRP_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !phase) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_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_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_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_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_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_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_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_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); |
| } |
| |
| |
| int bt_mesh_cfg_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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| struct relay_param param = { |
| .status = status, |
| .transmit = transmit, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_RELAY_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, OP_RELAY_GET); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !transmit) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_RELAY_SET, 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 relay_param param = { |
| .status = status, |
| .transmit = transmit, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_RELAY_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !transmit) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_NET_KEY_ADD, 18); |
| 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; |
| |
| err = cli_prepare(¶m, OP_NET_KEY_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_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 = { |
| .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; |
| |
| err = cli_prepare(¶m, OP_NET_KEY_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_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 = { |
| .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; |
| |
| err = cli_prepare(¶m, OP_NET_KEY_LIST, addr); |
| 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); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!keys || !key_cnt) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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; |
| |
| err = cli_prepare(¶m, OP_NET_KEY_STATUS, addr); |
| 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); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_APP_KEY_ADD, 19); |
| 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; |
| |
| err = cli_prepare(¶m, OP_APP_KEY_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_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 = { |
| .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; |
| |
| err = cli_prepare(¶m, OP_APP_KEY_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, OP_APP_KEY_UPDATE); |
| key_idx_pack(&msg, key_net_idx, key_app_idx); |
| net_buf_simple_add_mem(&msg, app_key, 16); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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; |
| } |
| |
| err = cli_prepare(status, OP_NODE_RESET_STATUS, addr); |
| 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); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| 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; |
| |
| err = cli_prepare(¶m, OP_APP_KEY_LIST, addr); |
| 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); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && (!keys || !key_cnt)) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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; |
| |
| err = cli_prepare(¶m, OP_APP_KEY_STATUS, addr); |
| 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); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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 = { |
| .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; |
| |
| err = cli_prepare(¶m, OP_MOD_APP_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| return mod_app_bind(net_idx, addr, elem_addr, mod_app_idx, mod_id, |
| CID_NVAL, status); |
| } |
| |
| 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) |
| { |
| 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 = { |
| .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; |
| |
| err = cli_prepare(¶m, OP_MOD_APP_STATUS, addr); |
| 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); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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); |
| } |
| |
| 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 = { |
| .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; |
| |
| err = cli_prepare(¶m, expect_op, addr); |
| 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); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && (!apps || !app_cnt)) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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, |
| 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_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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| struct mod_sub_param param = { |
| .status = status, |
| .elem_addr = elem_addr, |
| .expect_sub = &sub_addr, |
| .mod_id = mod_id, |
| .cid = cid, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_MOD_SUB_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| 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_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_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_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_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_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_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_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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .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; |
| |
| err = cli_prepare(¶m, OP_MOD_SUB_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| BT_DBG("net_idx 0x%04x addr 0x%04x elem_addr 0x%04x label %s", |
| net_idx, addr, elem_addr, bt_hex(label, 16)); |
| BT_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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !virt_addr) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| 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_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_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_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_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_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_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_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_mod_pub *pub, uint8_t *status) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_PUB_GET, 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_pub_param param = { |
| .mod_id = mod_id, |
| .cid = cid, |
| .elem_addr = elem_addr, |
| .status = status, |
| .pub = pub, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_MOD_PUB_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !pub) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| return mod_pub_get(net_idx, addr, elem_addr, mod_id, CID_NVAL, |
| pub, status); |
| } |
| |
| 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) |
| { |
| 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_mod_pub *pub, uint8_t *status) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_PUB_SET, 13); |
| 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_pub_param param = { |
| .mod_id = mod_id, |
| .cid = cid, |
| .elem_addr = elem_addr, |
| .status = status, |
| .pub = pub, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_MOD_PUB_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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_mod_pub *pub, uint8_t *status) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_MOD_PUB_VA_SET, 27); |
| 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_pub_param param = { |
| .mod_id = mod_id, |
| .cid = cid, |
| .elem_addr = elem_addr, |
| .status = status, |
| .pub = pub, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_MOD_PUB_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| BT_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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| 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_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) |
| { |
| 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_hb_sub_set(uint16_t net_idx, uint16_t addr, |
| struct bt_mesh_cfg_hb_sub *sub, uint8_t *status) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_SUB_SET, 5); |
| 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 hb_sub_param param = { |
| .status = status, |
| .sub = sub, |
| }; |
| int err; |
| |
| if (!sub) { |
| return -EINVAL; |
| } |
| |
| err = cli_prepare(¶m, OP_HEARTBEAT_SUB_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_hb_sub_get(uint16_t net_idx, uint16_t addr, |
| struct bt_mesh_cfg_hb_sub *sub, uint8_t *status) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_SUB_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 hb_sub_param param = { |
| .status = status, |
| .sub = sub, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_HEARTBEAT_SUB_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, OP_HEARTBEAT_SUB_GET); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !sub) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_PUB_SET, 9); |
| 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 hb_pub_param param = { |
| .status = status, |
| }; |
| int err; |
| |
| if (!pub) { |
| return -EINVAL; |
| } |
| |
| err = cli_prepare(¶m, OP_HEARTBEAT_PUB_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_hb_pub_get(uint16_t net_idx, uint16_t addr, |
| struct bt_mesh_cfg_hb_pub *pub, uint8_t *status) |
| { |
| BT_MESH_MODEL_BUF_DEFINE(msg, OP_HEARTBEAT_PUB_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 hb_pub_param param = { |
| .status = status, |
| .pub = pub, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_HEARTBEAT_PUB_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, OP_HEARTBEAT_PUB_GET); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !pub) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| struct node_idt_param param = { |
| .status = status, |
| .net_idx = key_net_idx, |
| .identity = identity, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_NODE_IDENTITY_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| 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); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !identity) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| struct node_idt_param param = { |
| .status = status, |
| .net_idx = key_net_idx, |
| .identity = identity, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_NODE_IDENTITY_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, OP_NODE_IDENTITY_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); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!status && !identity) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| int bt_mesh_cfg_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 = { |
| .net_idx = net_idx, |
| .app_idx = BT_MESH_KEY_DEV_REMOTE, |
| .addr = addr, |
| .send_ttl = BT_MESH_TTL_DEFAULT, |
| }; |
| struct lpn_timeout_param param = { |
| .unicast_addr = unicast_addr, |
| .polltimeout = polltimeout, |
| }; |
| int err; |
| |
| err = cli_prepare(¶m, OP_LPN_TIMEOUT_STATUS, addr); |
| if (err) { |
| return err; |
| } |
| |
| bt_mesh_model_msg_init(&msg, OP_LPN_TIMEOUT_GET); |
| net_buf_simple_add_le16(&msg, unicast_addr); |
| |
| err = bt_mesh_model_send(cli->model, &ctx, &msg, NULL, NULL); |
| if (err) { |
| BT_ERR("model_send() failed (err %d)", err); |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return err; |
| } |
| |
| if (!polltimeout) { |
| bt_mesh_msg_ack_ctx_clear(&cli->ack_ctx); |
| return 0; |
| } |
| |
| return bt_mesh_msg_ack_ctx_wait(&cli->ack_ctx, K_MSEC(msg_timeout)); |
| } |
| |
| 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; |
| } |