blob: 6ba497be0c0c6cea6b6bbdfd9624356e561121a6 [file] [log] [blame]
/*
* Copyright (c) 2021 Nordic Semiconductor ASA
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <zephyr/bluetooth/mesh.h>
#include "msg.h"
#define LOG_LEVEL CONFIG_BT_MESH_ACCESS_LOG_LEVEL
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(bt_mesh_msg);
void bt_mesh_model_msg_init(struct net_buf_simple *msg, uint32_t opcode)
{
net_buf_simple_init(msg, 0);
switch (BT_MESH_MODEL_OP_LEN(opcode)) {
case 1:
net_buf_simple_add_u8(msg, opcode);
break;
case 2:
net_buf_simple_add_be16(msg, opcode);
break;
case 3:
net_buf_simple_add_u8(msg, ((opcode >> 16) & 0xff));
/* Using LE for the CID since the model layer is defined as
* little-endian in the mesh spec and using BT_MESH_MODEL_OP_3
* will declare the opcode in this way.
*/
net_buf_simple_add_le16(msg, opcode & 0xffff);
break;
default:
LOG_WRN("Unknown opcode format");
break;
}
}
void bt_mesh_msg_ack_ctx_clear(struct bt_mesh_msg_ack_ctx *ack)
{
ack->op = 0U;
ack->user_data = NULL;
ack->dst = BT_MESH_ADDR_UNASSIGNED;
}
int bt_mesh_msg_ack_ctx_prepare(struct bt_mesh_msg_ack_ctx *ack,
uint32_t op, uint16_t dst, void *user_data)
{
if (ack->op) {
LOG_WRN("Another synchronous operation pending");
return -EBUSY;
}
ack->op = op;
ack->user_data = user_data;
ack->dst = dst;
return 0;
}
int bt_mesh_msg_ack_ctx_wait(struct bt_mesh_msg_ack_ctx *ack, k_timeout_t timeout)
{
int err;
err = k_sem_take(&ack->sem, timeout);
bt_mesh_msg_ack_ctx_clear(ack);
if (err == -EAGAIN) {
return -ETIMEDOUT;
}
return err;
}
bool bt_mesh_msg_ack_ctx_match(const struct bt_mesh_msg_ack_ctx *ack,
uint32_t op, uint16_t addr, void **user_data)
{
if (ack->op != op || (BT_MESH_ADDR_IS_UNICAST(ack->dst) && ack->dst != addr)) {
return false;
}
if (user_data != NULL) {
*user_data = ack->user_data;
}
return true;
}
int bt_mesh_msg_send(const struct bt_mesh_model *model, struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf)
{
if (!ctx && !model->pub) {
return -ENOTSUP;
}
if (ctx) {
return bt_mesh_model_send(model, ctx, buf, NULL, 0);
}
net_buf_simple_reset(model->pub->msg);
net_buf_simple_add_mem(model->pub->msg, buf->data, buf->len);
return bt_mesh_model_publish(model);
}
int bt_mesh_msg_ackd_send(const struct bt_mesh_model *model, struct bt_mesh_msg_ctx *ctx,
struct net_buf_simple *buf, const struct bt_mesh_msg_rsp_ctx *rsp)
{
int err;
if (rsp) {
err = bt_mesh_msg_ack_ctx_prepare(rsp->ack, rsp->op,
ctx ? ctx->addr : model->pub->addr,
rsp->user_data);
if (err) {
return err;
}
}
err = bt_mesh_msg_send(model, ctx, buf);
if (!rsp) {
return err;
}
if (!err) {
return bt_mesh_msg_ack_ctx_wait(rsp->ack, K_MSEC(rsp->timeout));
}
bt_mesh_msg_ack_ctx_clear(rsp->ack);
return err;
}