71 lines
2.1 KiB
C
71 lines
2.1 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2020 Nordic Semiconductor ASA
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <zephyr/net/buf.h>
|
||
|
|
#include <zephyr/bluetooth/bluetooth.h>
|
||
|
|
#include <zephyr/bluetooth/conn.h>
|
||
|
|
#include <zephyr/bluetooth/gatt.h>
|
||
|
|
#include <zephyr/bluetooth/mesh.h>
|
||
|
|
#include <zephyr/types.h>
|
||
|
|
|
||
|
|
#include "net.h"
|
||
|
|
#include "sar_cfg_internal.h"
|
||
|
|
|
||
|
|
void bt_mesh_sar_tx_encode(struct net_buf_simple *buf,
|
||
|
|
const struct bt_mesh_sar_tx *tx)
|
||
|
|
{
|
||
|
|
net_buf_simple_add_u8(buf, (tx->seg_int_step & 0xf) |
|
||
|
|
(tx->unicast_retrans_count << 4));
|
||
|
|
net_buf_simple_add_u8(buf, (tx->unicast_retrans_without_prog_count &
|
||
|
|
0xf) | (tx->unicast_retrans_int_step << 4));
|
||
|
|
net_buf_simple_add_u8(buf, (tx->unicast_retrans_int_inc & 0xf) |
|
||
|
|
(tx->multicast_retrans_count << 4));
|
||
|
|
net_buf_simple_add_u8(buf, tx->multicast_retrans_int & 0xf);
|
||
|
|
}
|
||
|
|
|
||
|
|
void bt_mesh_sar_rx_encode(struct net_buf_simple *buf,
|
||
|
|
const struct bt_mesh_sar_rx *rx)
|
||
|
|
{
|
||
|
|
net_buf_simple_add_u8(buf, (rx->seg_thresh & 0x1f) |
|
||
|
|
(rx->ack_delay_inc << 5));
|
||
|
|
net_buf_simple_add_u8(buf, (rx->discard_timeout & 0xf) |
|
||
|
|
((rx->rx_seg_int_step & 0xf) << 4));
|
||
|
|
net_buf_simple_add_u8(buf, (rx->ack_retrans_count & 0x3));
|
||
|
|
}
|
||
|
|
|
||
|
|
void bt_mesh_sar_tx_decode(struct net_buf_simple *buf,
|
||
|
|
struct bt_mesh_sar_tx *tx)
|
||
|
|
{
|
||
|
|
uint8_t val;
|
||
|
|
|
||
|
|
val = net_buf_simple_pull_u8(buf);
|
||
|
|
tx->seg_int_step = (val & 0xf);
|
||
|
|
tx->unicast_retrans_count = (val >> 4);
|
||
|
|
val = net_buf_simple_pull_u8(buf);
|
||
|
|
tx->unicast_retrans_without_prog_count = (val & 0xf);
|
||
|
|
tx->unicast_retrans_int_step = (val >> 4);
|
||
|
|
val = net_buf_simple_pull_u8(buf);
|
||
|
|
tx->unicast_retrans_int_inc = (val & 0xf);
|
||
|
|
tx->multicast_retrans_count = (val >> 4);
|
||
|
|
val = net_buf_simple_pull_u8(buf);
|
||
|
|
tx->multicast_retrans_int = (val & 0xf);
|
||
|
|
}
|
||
|
|
|
||
|
|
void bt_mesh_sar_rx_decode(struct net_buf_simple *buf,
|
||
|
|
struct bt_mesh_sar_rx *rx)
|
||
|
|
{
|
||
|
|
uint8_t val;
|
||
|
|
|
||
|
|
val = net_buf_simple_pull_u8(buf);
|
||
|
|
rx->seg_thresh = (val & 0x1f);
|
||
|
|
rx->ack_delay_inc = (val >> 5);
|
||
|
|
val = net_buf_simple_pull_u8(buf);
|
||
|
|
rx->discard_timeout = (val & 0xf);
|
||
|
|
rx->rx_seg_int_step = (val >> 4);
|
||
|
|
val = net_buf_simple_pull_u8(buf);
|
||
|
|
rx->ack_retrans_count = (val & 0x3);
|
||
|
|
}
|