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