| /* |
| * Copyright (c) 2022 Nordic Semiconductor ASA |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| #include <zephyr/bluetooth/mesh.h> |
| |
| #include "access.h" |
| #include "foundation.h" |
| #include "net.h" |
| #include "mesh.h" |
| #include "transport.h" |
| #include "op_agg.h" |
| |
| #define LOG_LEVEL CONFIG_BT_MESH_MODEL_LOG_LEVEL |
| #include <zephyr/logging/log.h> |
| LOG_MODULE_REGISTER(bt_mesh_op_agg_srv); |
| |
| /** Mesh Opcodes Aggragator Server Model Context */ |
| static struct bt_mesh_op_agg_srv { |
| /** Composition data model entry pointer. */ |
| struct bt_mesh_model *model; |
| } srv; |
| |
| static int handle_sequence(struct bt_mesh_model *model, |
| struct bt_mesh_msg_ctx *ctx, |
| struct net_buf_simple *buf) |
| { |
| struct op_agg_ctx *agg = bt_mesh_op_agg_ctx_get(); |
| struct net_buf_simple_state state; |
| struct net_buf_simple msg; |
| uint16_t elem; |
| uint8_t *status; |
| int err; |
| |
| elem = net_buf_simple_pull_le16(buf); |
| ctx->recv_dst = elem; |
| |
| bt_mesh_model_msg_init(agg->sdu, OP_OPCODES_AGGREGATOR_STATUS); |
| status = net_buf_simple_add_u8(agg->sdu, 0); |
| net_buf_simple_add_le16(agg->sdu, elem); |
| |
| agg->net_idx = ctx->net_idx; |
| agg->app_idx = ctx->app_idx; |
| agg->addr = ctx->addr; |
| agg->initialized = true; |
| |
| if (!BT_MESH_ADDR_IS_UNICAST(elem)) { |
| LOG_WRN("Address is not unicast, ignoring."); |
| return -EINVAL; |
| } |
| |
| net_buf_simple_save(buf, &state); |
| while (buf->len > 0) { |
| err = bt_mesh_op_agg_decode_msg(&msg, buf); |
| if (err) { |
| LOG_ERR("Unable to parse Opcodes Aggregator Sequence message (err %d)", |
| err); |
| return err; |
| } |
| } |
| net_buf_simple_restore(buf, &state); |
| |
| if (!bt_mesh_elem_find(elem)) { |
| *status = ACCESS_STATUS_INVALID_ADDRESS; |
| goto send; |
| } |
| |
| while (buf->len > 0) { |
| (void) bt_mesh_op_agg_decode_msg(&msg, buf); |
| |
| agg->ack = false; |
| agg->rsp_err = 0; |
| err = bt_mesh_model_recv(ctx, &msg); |
| |
| if (agg->rsp_err) { |
| *status = agg->rsp_err; |
| break; |
| } |
| |
| if (err) { |
| *status = err; |
| break; |
| } |
| |
| if (!agg->ack) { |
| net_buf_simple_add_u8(agg->sdu, 0); |
| } |
| } |
| |
| send: |
| agg->initialized = false; |
| err = bt_mesh_model_send(model, ctx, agg->sdu, NULL, NULL); |
| if (err) { |
| LOG_ERR("Unable to send Opcodes Aggregator Status"); |
| return err; |
| } |
| |
| return 0; |
| } |
| |
| const struct bt_mesh_model_op _bt_mesh_op_agg_srv_op[] = { |
| { OP_OPCODES_AGGREGATOR_SEQUENCE, BT_MESH_LEN_MIN(2), handle_sequence }, |
| BT_MESH_MODEL_OP_END, |
| }; |
| |
| static int op_agg_srv_init(struct bt_mesh_model *model) |
| { |
| if (!bt_mesh_model_in_primary(model)) { |
| LOG_ERR("Opcodes Aggregator Server only allowed in primary element"); |
| return -EINVAL; |
| } |
| |
| /* Opcodes Aggregator Server model shall use the device key and |
| * application keys. |
| */ |
| model->keys[0] = BT_MESH_KEY_DEV_ANY; |
| |
| srv.model = model; |
| |
| return 0; |
| } |
| |
| const struct bt_mesh_model_cb _bt_mesh_op_agg_srv_cb = { |
| .init = op_agg_srv_init, |
| }; |