8183c991f8
Fix various unit test build warnings, unused variables, set but unused variables, wrong types etc... Signed-off-by: Fabio Baltieri <fabiobaltieri@google.com>
1696 lines
41 KiB
C
1696 lines
41 KiB
C
/*
|
|
* Copyright (c) 2020 Demant
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <zephyr/types.h>
|
|
#include <zephyr/ztest.h>
|
|
|
|
#define ULL_LLCP_UNITTEST
|
|
|
|
#include <zephyr/bluetooth/hci.h>
|
|
#include <zephyr/sys/byteorder.h>
|
|
#include <zephyr/sys/slist.h>
|
|
#include <zephyr/sys/util.h>
|
|
#include "hal/ccm.h"
|
|
|
|
#include "util/util.h"
|
|
#include "util/mem.h"
|
|
#include "util/memq.h"
|
|
#include "util/dbuf.h"
|
|
|
|
#include "pdu_df.h"
|
|
#include "lll/pdu_vendor.h"
|
|
#include "pdu.h"
|
|
#include "ll.h"
|
|
#include "ll_settings.h"
|
|
|
|
#include "lll.h"
|
|
#include "lll/lll_df_types.h"
|
|
#include "lll_conn.h"
|
|
#include "lll_conn_iso.h"
|
|
|
|
#include "ull_tx_queue.h"
|
|
|
|
#include "isoal.h"
|
|
#include "ull_iso_types.h"
|
|
#include "ull_conn_iso_types.h"
|
|
|
|
#include "ull_internal.h"
|
|
#include "ull_conn_types.h"
|
|
#include "ull_llcp.h"
|
|
#include "ull_conn_internal.h"
|
|
#include "ull_llcp_internal.h"
|
|
|
|
#include "helper_pdu.h"
|
|
#include "helper_util.h"
|
|
|
|
#define PREFER_S8_CODING 1
|
|
#define PREFER_S2_CODING 0
|
|
|
|
#define HOST_INITIATED 1U
|
|
|
|
static struct ll_conn conn;
|
|
|
|
static void phy_setup(void *data)
|
|
{
|
|
test_setup(&conn);
|
|
|
|
/* Emulate initial conn state */
|
|
conn.phy_pref_rx = PHY_1M | PHY_2M | PHY_CODED;
|
|
conn.phy_pref_tx = PHY_1M | PHY_2M | PHY_CODED;
|
|
conn.lll.phy_flags = PREFER_S2_CODING;
|
|
conn.lll.phy_tx_time = PHY_1M;
|
|
conn.lll.phy_rx = PHY_1M;
|
|
conn.lll.phy_tx = PHY_1M;
|
|
|
|
/* Init DLE data */
|
|
ull_conn_default_tx_octets_set(251);
|
|
ull_conn_default_tx_time_set(2120);
|
|
ull_dle_init(&conn, PHY_1M);
|
|
/* Emulate different remote numbers to trigger update of eff */
|
|
conn.lll.dle.remote.max_tx_octets = PDU_DC_PAYLOAD_SIZE_MIN * 3;
|
|
conn.lll.dle.remote.max_rx_octets = PDU_DC_PAYLOAD_SIZE_MIN * 3;
|
|
conn.lll.dle.remote.max_tx_time = PDU_DC_MAX_US(conn.lll.dle.remote.max_tx_octets,
|
|
PHY_1M);
|
|
conn.lll.dle.remote.max_rx_time = PDU_DC_MAX_US(conn.lll.dle.remote.max_rx_octets,
|
|
PHY_1M);
|
|
ull_dle_update_eff(&conn);
|
|
}
|
|
|
|
#define CHECK_PREF_PHY_STATE(_conn, _tx, _rx) \
|
|
do { \
|
|
zassert_equal(_conn.phy_pref_rx, _rx, \
|
|
"Preferred RX PHY mismatch %d (actual) != %d (expected)", \
|
|
_conn.phy_pref_rx, _rx); \
|
|
zassert_equal(_conn.phy_pref_tx, _tx, \
|
|
"Preferred TX PHY mismatch %d (actual) != %d (expected)", \
|
|
_conn.phy_pref_tx, _tx); \
|
|
} while (0)
|
|
|
|
#define CHECK_CURRENT_PHY_STATE(_conn, _tx, _flags, _rx) \
|
|
do { \
|
|
zassert_equal(_conn.lll.phy_rx, _rx, \
|
|
"Current RX PHY mismatch %d (actual) != %d (expected)", \
|
|
_conn.lll.phy_rx, _rx); \
|
|
zassert_equal(_conn.lll.phy_tx, _tx, \
|
|
"Current TX PHY mismatch %d (actual) != %d (expected)", \
|
|
_conn.lll.phy_tx, _tx); \
|
|
zassert_equal(_conn.lll.phy_rx, _rx, \
|
|
"Current Flags mismatch %d (actual) != %d (expected)", \
|
|
_conn.lll.phy_flags, _flags); \
|
|
} while (0)
|
|
|
|
static bool is_instant_reached(struct ll_conn *conn, uint16_t instant)
|
|
{
|
|
return ((event_counter(conn) - instant) & 0xFFFF) <= 0x7FFF;
|
|
}
|
|
|
|
/* +-----+ +-------+ +-----+
|
|
* | UT | | LL_A | | LT |
|
|
* +-----+ +-------+ +-----+
|
|
* | | |
|
|
*/
|
|
ZTEST(phy_central, test_phy_update_central_loc)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data *pdu;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_1M | PHY_2M,
|
|
.tx_phys = PHY_1M | PHY_2M };
|
|
struct pdu_data_llctrl_phy_upd_ind ind = { .instant = 8,
|
|
.c_to_p_phy = PHY_2M,
|
|
.p_to_c_phy = PHY_2M };
|
|
struct pdu_data_llctrl_length_rsp length_ntf = {
|
|
3 * PDU_DC_PAYLOAD_SIZE_MIN, PDU_DC_MAX_US(3 * PDU_DC_PAYLOAD_SIZE_MIN, PHY_2M),
|
|
3 * PDU_DC_PAYLOAD_SIZE_MIN, PDU_DC_MAX_US(3 * PDU_DC_PAYLOAD_SIZE_MIN, PHY_2M)
|
|
};
|
|
uint16_t instant;
|
|
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_SUCCESS };
|
|
|
|
/* 'Trigger' DLE ntf on PHY update, as this forces change to eff tx/rx times */
|
|
conn.lll.dle.eff.max_rx_time = 0;
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_2M, PREFER_S8_CODING, PHY_2M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/* Steal all ntf buffers, to trigger TX stall on non avail of NTF buffer for DLE */
|
|
while (ll_pdu_rx_alloc_peek(1)) {
|
|
ntf = ll_pdu_rx_alloc();
|
|
/* Make sure we use a correct type or the release won't work */
|
|
ntf->hdr.type = NODE_RX_TYPE_DC_PDU;
|
|
}
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_RSP, &conn, &rsp);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* No TX yet as unable to pre-allocate NTF buffer for DLE */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Release RX node to now allow pre-alloc for DLE NTF */
|
|
release_ntf(ntf);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_UPDATE_IND, &conn, &tx, &ind);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Save Instant */
|
|
pdu = (struct pdu_data *)tx->pdu;
|
|
instant = sys_le16_to_cpu(pdu->llctrl.phy_upd_ind.instant);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* */
|
|
while (!is_instant_reached(&conn, instant)) {
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
CHECK_CURRENT_PHY_STATE(conn, PHY_1M, PREFER_S8_CODING, PHY_1M);
|
|
|
|
/* There should NOT be a host notification */
|
|
ut_rx_q_is_empty();
|
|
}
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be two host notifications, one pu and one dle */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
ut_rx_pdu(LL_LENGTH_RSP, &ntf, &length_ntf);
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
ut_rx_q_is_empty();
|
|
|
|
|
|
CHECK_CURRENT_PHY_STATE(conn, PHY_2M, PREFER_S8_CODING, PHY_2M);
|
|
CHECK_PREF_PHY_STATE(conn, PHY_2M, PHY_2M);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_central, test_phy_update_central_loc_invalid)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
|
|
struct pdu_data_llctrl_reject_ind reject_ind = { };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_2M, PREFER_S8_CODING, PHY_2M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Rx */
|
|
lt_tx(LL_REJECT_IND, &conn, &reject_ind);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Termination 'triggered' */
|
|
zassert_equal(conn.llcp_terminate.reason_final, BT_HCI_ERR_LMP_PDU_NOT_ALLOWED,
|
|
"Terminate reason %d", conn.llcp_terminate.reason_final);
|
|
|
|
/* There should be nohost notifications */
|
|
ut_rx_q_is_empty();
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_central, test_phy_update_central_loc_unsupp_feat)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
|
|
struct pdu_data_llctrl_unknown_rsp unknown_rsp = { .type = PDU_DATA_LLCTRL_TYPE_PHY_REQ };
|
|
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_UNSUPP_REMOTE_FEATURE };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_2M, PREFER_S8_CODING, PHY_2M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Rx */
|
|
lt_tx(LL_UNKNOWN_RSP, &conn, &unknown_rsp);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be one host notification */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_central, test_phy_update_central_rem)
|
|
{
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data *pdu;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_1M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_upd_ind ind = { .instant = 8,
|
|
.c_to_p_phy = 0,
|
|
.p_to_c_phy = PHY_2M };
|
|
uint16_t instant;
|
|
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_SUCCESS };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Steal all ntf buffers, to trigger TX stall on non avail of NTF buffer for DLE */
|
|
while (ll_pdu_rx_alloc_peek(1)) {
|
|
ntf = ll_pdu_rx_alloc();
|
|
/* Make sure we use a correct type or the release won't work */
|
|
ntf->hdr.type = NODE_RX_TYPE_DC_PDU;
|
|
}
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_REQ, &conn, &req);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* No TX yet as unable to pre-allocate NTF buffer for DLE */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Release RX node to now allow pre-alloc for DLE NTF */
|
|
release_ntf(ntf);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_UPDATE_IND, &conn, &tx, &ind);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Save Instant */
|
|
pdu = (struct pdu_data *)tx->pdu;
|
|
instant = sys_le16_to_cpu(pdu->llctrl.phy_upd_ind.instant);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* */
|
|
while (!is_instant_reached(&conn, instant)) {
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should NOT be a host notification */
|
|
ut_rx_q_is_empty();
|
|
}
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be one host notification */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
CHECK_CURRENT_PHY_STATE(conn, PHY_1M, PREFER_S8_CODING, PHY_2M);
|
|
CHECK_PREF_PHY_STATE(conn, PHY_1M | PHY_2M | PHY_CODED, PHY_1M | PHY_2M | PHY_CODED);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_periph, test_phy_update_periph_loc)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
uint16_t instant;
|
|
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_SUCCESS };
|
|
|
|
struct pdu_data_llctrl_phy_upd_ind phy_update_ind = { .c_to_p_phy = PHY_2M,
|
|
.p_to_c_phy = PHY_2M };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_2M, PREFER_S8_CODING, PHY_2M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
phy_update_ind.instant = instant = event_counter(&conn) + 6;
|
|
lt_tx(LL_PHY_UPDATE_IND, &conn, &phy_update_ind);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* */
|
|
while (!is_instant_reached(&conn, instant)) {
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should NOT be a host notification */
|
|
ut_rx_q_is_empty();
|
|
}
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be one host notification */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
CHECK_CURRENT_PHY_STATE(conn, PHY_2M, PREFER_S8_CODING, PHY_2M);
|
|
CHECK_PREF_PHY_STATE(conn, PHY_2M, PHY_2M);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_periph, test_phy_update_periph_loc_invalid_central)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
uint16_t instant;
|
|
struct pdu_data_llctrl_conn_param_req conn_param_req = { };
|
|
|
|
struct pdu_data_llctrl_phy_upd_ind phy_update_ind = { .c_to_p_phy = PHY_2M,
|
|
.p_to_c_phy = PHY_2M };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_2M, PREFER_S8_CODING, PHY_2M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
phy_update_ind.instant = instant = event_counter(&conn) + 6;
|
|
lt_tx(LL_PHY_UPDATE_IND, &conn, &phy_update_ind);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* One event ahead */
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should NOT be a host notification */
|
|
ut_rx_q_is_empty();
|
|
|
|
/* 'Inject' invalid param request from central */
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
/* Rx */
|
|
lt_tx(LL_CONNECTION_PARAM_REQ, &conn, &conn_param_req);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Termination 'triggered' */
|
|
zassert_equal(conn.llcp_terminate.reason_final, BT_HCI_ERR_DIFF_TRANS_COLLISION,
|
|
"Terminate reason %d", conn.llcp_terminate.reason_final);
|
|
}
|
|
|
|
ZTEST(phy_periph, test_phy_update_periph_rem)
|
|
{
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_1M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_1M | PHY_2M | PHY_CODED,
|
|
.tx_phys = PHY_1M | PHY_2M | PHY_CODED };
|
|
struct pdu_data_llctrl_phy_upd_ind ind = { .instant = 7,
|
|
.c_to_p_phy = 0,
|
|
.p_to_c_phy = PHY_2M };
|
|
uint16_t instant;
|
|
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_SUCCESS };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_REQ, &conn, &req);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* We received a REQ, so data tx should be paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_RSP, &conn, &tx, &rsp);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
ind.instant = instant = event_counter(&conn) + 6;
|
|
lt_tx(LL_PHY_UPDATE_IND, &conn, &ind);
|
|
|
|
/* We are sending RSP, so data tx should be paused until after tx ack */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* */
|
|
while (!is_instant_reached(&conn, instant)) {
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should NOT be a host notification */
|
|
ut_rx_q_is_empty();
|
|
}
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be one host notification */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
CHECK_CURRENT_PHY_STATE(conn, PHY_2M, PREFER_S8_CODING, PHY_1M);
|
|
CHECK_PREF_PHY_STATE(conn, PHY_1M | PHY_2M | PHY_CODED, PHY_1M | PHY_2M | PHY_CODED);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_periph, test_phy_update_periph_loc_unsupp_feat)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
|
|
struct pdu_data_llctrl_unknown_rsp unknown_rsp = { .type = PDU_DATA_LLCTRL_TYPE_PHY_REQ };
|
|
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_UNSUPP_REMOTE_FEATURE };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_2M, PREFER_S8_CODING, PHY_2M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_UNKNOWN_RSP, &conn, &unknown_rsp);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be one host notification */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_periph, test_phy_update_periph_rem_invalid)
|
|
{
|
|
struct node_tx *tx;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_1M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_1M | PHY_2M | PHY_CODED,
|
|
.tx_phys = PHY_1M | PHY_2M | PHY_CODED };
|
|
struct pdu_data_llctrl_reject_ind reject_ind = { };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_REQ, &conn, &req);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* We received a REQ, so data tx should be paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_RSP, &conn, &tx, &rsp);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Inject invalid PDU */
|
|
lt_tx(LL_REJECT_IND, &conn, &reject_ind);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Termination 'triggered' */
|
|
zassert_equal(conn.llcp_terminate.reason_final, BT_HCI_ERR_LMP_PDU_NOT_ALLOWED,
|
|
"Terminate reason %d", conn.llcp_terminate.reason_final);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_central, test_phy_update_central_loc_collision)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data *pdu;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_1M | PHY_2M,
|
|
.tx_phys = PHY_1M | PHY_2M };
|
|
struct pdu_data_llctrl_phy_upd_ind ind = { .instant = 9,
|
|
.c_to_p_phy = PHY_2M,
|
|
.p_to_c_phy = PHY_2M };
|
|
uint16_t instant;
|
|
|
|
struct pdu_data_llctrl_reject_ext_ind reject_ext_ind = {
|
|
.reject_opcode = PDU_DATA_LLCTRL_TYPE_PHY_REQ,
|
|
.error_code = BT_HCI_ERR_LL_PROC_COLLISION
|
|
};
|
|
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_SUCCESS };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
|
|
|
|
/* Emulate valid feature exchange */
|
|
conn.llcp.fex.valid = 1;
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_2M, PREFER_S8_CODING, PHY_2M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/*** ***/
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx - emulate colliding PHY_REQ from peer */
|
|
lt_tx(LL_PHY_REQ, &conn, &req);
|
|
|
|
/* Check that data tx is paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/*** ***/
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
test_print_conn(&conn);
|
|
/* Tx Queue should have one LL Control PDU */
|
|
printf("Tx REJECT\n");
|
|
lt_rx(LL_REJECT_EXT_IND, &conn, &tx, &reject_ext_ind);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
printf("Done again\n");
|
|
event_done(&conn);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/*** ***/
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
printf("Empty\n");
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
printf("Tx again\n");
|
|
lt_tx(LL_PHY_RSP, &conn, &rsp);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/*** ***/
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
printf("And again\n");
|
|
lt_rx(LL_PHY_UPDATE_IND, &conn, &tx, &ind);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is not paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Save Instant */
|
|
pdu = (struct pdu_data *)tx->pdu;
|
|
instant = sys_le16_to_cpu(pdu->llctrl.phy_upd_ind.instant);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* */
|
|
while (!is_instant_reached(&conn, instant)) {
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should NOT be a host notification */
|
|
ut_rx_q_is_empty();
|
|
}
|
|
|
|
/*** ***/
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be one host notification */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_central, test_phy_update_central_rem_collision)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data *pdu;
|
|
struct pdu_data_llctrl_phy_req req_peripheral = { .rx_phys = PHY_1M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_req req_central = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_1M | PHY_2M,
|
|
.tx_phys = PHY_1M | PHY_2M };
|
|
struct pdu_data_llctrl_phy_upd_ind ind_1 = { .instant = 7,
|
|
.c_to_p_phy = 0,
|
|
.p_to_c_phy = PHY_2M };
|
|
struct pdu_data_llctrl_phy_upd_ind ind_2 = {
|
|
.instant = 15, .c_to_p_phy = PHY_2M, .p_to_c_phy = 0};
|
|
uint16_t instant;
|
|
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_SUCCESS };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/*** ***/
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_REQ, &conn, &req_peripheral);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/*** ***/
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_2M, PREFER_S8_CODING, PHY_2M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/*** ***/
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_UPDATE_IND, &conn, &tx, &ind_1);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Save Instant */
|
|
pdu = (struct pdu_data *)tx->pdu;
|
|
instant = sys_le16_to_cpu(pdu->llctrl.phy_upd_ind.instant);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* */
|
|
while (!is_instant_reached(&conn, instant)) {
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should NOT be a host notification */
|
|
ut_rx_q_is_empty();
|
|
}
|
|
|
|
/* Execute connection event that is an instant. It is required to send notifications to
|
|
* Host that complete already started PHY update procedure.
|
|
*/
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Start execution of a paused local PHY update procedure. It is delayed by one connection
|
|
* event due to completion of remote PHY update at end of the "at instant" conneciton event.
|
|
*/
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req_central);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_RSP, &conn, &rsp);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* There should be one host notification */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_UPDATE_IND, &conn, &tx, &ind_2);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Save Instant */
|
|
pdu = (struct pdu_data *)tx->pdu;
|
|
instant = sys_le16_to_cpu(pdu->llctrl.phy_upd_ind.instant);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* */
|
|
while (!is_instant_reached(&conn, instant)) {
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should NOT be a host notification */
|
|
ut_rx_q_is_empty();
|
|
}
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be one host notification */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_periph, test_phy_update_periph_loc_collision)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data_llctrl_phy_req req_central = { .rx_phys = PHY_1M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_req req_peripheral = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_2M, .tx_phys = PHY_2M };
|
|
struct pdu_data_llctrl_phy_upd_ind ind = { .instant = 7,
|
|
.c_to_p_phy = PHY_2M,
|
|
.p_to_c_phy = PHY_1M };
|
|
uint16_t instant;
|
|
|
|
struct pdu_data_llctrl_reject_ext_ind reject_ext_ind = {
|
|
.reject_opcode = PDU_DATA_LLCTRL_TYPE_PHY_REQ,
|
|
.error_code = BT_HCI_ERR_LL_PROC_COLLISION
|
|
};
|
|
|
|
struct node_rx_pu pu = { 0 };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/*** ***/
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_2M, PREFER_S8_CODING, PHY_2M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req_peripheral);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_REQ, &conn, &req_central);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_RSP, &conn, &tx, &rsp);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_REJECT_EXT_IND, &conn, &reject_ext_ind);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be one host notification */
|
|
pu.status = BT_HCI_ERR_LL_PROC_COLLISION;
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Rx */
|
|
ind.instant = instant = event_counter(&conn) + 6;
|
|
lt_tx(LL_PHY_UPDATE_IND, &conn, &ind);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* */
|
|
while (!is_instant_reached(&conn, instant)) {
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should NOT be a host notification */
|
|
ut_rx_q_is_empty();
|
|
}
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* There should be one host notification */
|
|
pu.status = BT_HCI_ERR_SUCCESS;
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(),
|
|
"Free CTX buffers %d", llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_central, test_phy_update_central_loc_no_act_change)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data *pdu;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_1M, .tx_phys = PHY_1M };
|
|
struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_1M | PHY_2M,
|
|
.tx_phys = PHY_1M | PHY_2M };
|
|
struct pdu_data_llctrl_phy_upd_ind ind = { .instant = 0, .c_to_p_phy = 0, .p_to_c_phy = 0 };
|
|
uint16_t instant;
|
|
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_SUCCESS };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_1M, PREFER_S8_CODING, PHY_1M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_RSP, &conn, &rsp);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_UPDATE_IND, &conn, &tx, &ind);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Save Instant */
|
|
pdu = (struct pdu_data *)tx->pdu;
|
|
instant = sys_le16_to_cpu(pdu->llctrl.phy_upd_ind.instant);
|
|
|
|
/* Check if instant is zero, due to no actual PHY change */
|
|
zassert_equal(instant, 0, "Unexpected instant %d", instant);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* There should be one host notifications, due to host initiated PHY upd */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
CHECK_CURRENT_PHY_STATE(conn, PHY_1M, PREFER_S8_CODING, PHY_1M);
|
|
CHECK_PREF_PHY_STATE(conn, PHY_1M, PHY_1M);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(), "Free CTX buffers %d",
|
|
llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_central, test_phy_update_central_rem_no_actual_change)
|
|
{
|
|
struct node_tx *tx;
|
|
struct pdu_data *pdu;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_1M, .tx_phys = PHY_1M };
|
|
struct pdu_data_llctrl_phy_upd_ind ind = { .instant = 0, .c_to_p_phy = 0, .p_to_c_phy = 0 };
|
|
uint16_t instant;
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_REQ, &conn, &req);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_UPDATE_IND, &conn, &tx, &ind);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Save Instant */
|
|
pdu = (struct pdu_data *)tx->pdu;
|
|
instant = sys_le16_to_cpu(pdu->llctrl.phy_upd_ind.instant);
|
|
|
|
/* Check if instant is zero, due to no actual PHY change */
|
|
zassert_equal(instant, 0, "Unexpected instant %d", instant);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* There is not actual PHY change, so there shouldn't be host notification */
|
|
ut_rx_q_is_empty();
|
|
|
|
CHECK_CURRENT_PHY_STATE(conn, PHY_1M, PREFER_S8_CODING, PHY_1M);
|
|
CHECK_PREF_PHY_STATE(conn, PHY_1M | PHY_2M | PHY_CODED, PHY_1M | PHY_2M | PHY_CODED);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(), "Free CTX buffers %d",
|
|
llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_periph, test_phy_update_periph_loc_no_actual_change)
|
|
{
|
|
uint8_t err;
|
|
struct node_tx *tx;
|
|
struct node_rx_pdu *ntf;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_1M, .tx_phys = PHY_1M };
|
|
struct node_rx_pu pu = { .status = BT_HCI_ERR_SUCCESS };
|
|
struct pdu_data_llctrl_phy_upd_ind phy_update_ind = { .instant = 0,
|
|
.c_to_p_phy = 0,
|
|
.p_to_c_phy = 0 };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Initiate an PHY Update Procedure */
|
|
err = ull_cp_phy_update(&conn, PHY_1M, PREFER_S8_CODING, PHY_1M, HOST_INITIATED);
|
|
zassert_equal(err, BT_HCI_ERR_SUCCESS);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_REQ, &conn, &tx, &req);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Check that data tx was paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_UPDATE_IND, &conn, &phy_update_ind);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* There should be one notification due to Host initiated PHY UPD */
|
|
ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu);
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Release Ntf */
|
|
release_ntf(ntf);
|
|
|
|
CHECK_CURRENT_PHY_STATE(conn, PHY_1M, PREFER_S8_CODING, PHY_1M);
|
|
CHECK_PREF_PHY_STATE(conn, PHY_1M, PHY_1M);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(), "Free CTX buffers %d",
|
|
llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST(phy_periph, test_phy_update_periph_rem_no_actual_change)
|
|
{
|
|
struct node_tx *tx;
|
|
struct pdu_data_llctrl_phy_req req = { .rx_phys = PHY_1M, .tx_phys = PHY_1M };
|
|
struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_1M | PHY_2M | PHY_CODED,
|
|
.tx_phys = PHY_1M | PHY_2M | PHY_CODED };
|
|
struct pdu_data_llctrl_phy_upd_ind ind = { .instant = 0, .c_to_p_phy = 0, .p_to_c_phy = 0 };
|
|
|
|
/* Role */
|
|
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
|
|
|
|
/* Connect */
|
|
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should NOT have a LL Control PDU */
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_REQ, &conn, &req);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* We received a REQ, so data tx should be paused */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Tx Queue should have one LL Control PDU */
|
|
lt_rx(LL_PHY_RSP, &conn, &tx, &rsp);
|
|
lt_rx_q_is_empty(&conn);
|
|
|
|
/* Rx */
|
|
lt_tx(LL_PHY_UPDATE_IND, &conn, &ind);
|
|
|
|
/* We are sending RSP, so data tx should be paused until after tx ack */
|
|
zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused");
|
|
|
|
/* TX Ack */
|
|
event_tx_ack(&conn, tx);
|
|
|
|
/* Check that data tx is no longer paused */
|
|
zassert_equal(conn.tx_q.pause_data, 0U, "Data tx is paused");
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
/* Release Tx */
|
|
ull_cp_release_tx(&conn, tx);
|
|
|
|
/* There should be no host notification */
|
|
ut_rx_q_is_empty();
|
|
|
|
/* Prepare */
|
|
event_prepare(&conn);
|
|
|
|
/* Done */
|
|
event_done(&conn);
|
|
|
|
CHECK_CURRENT_PHY_STATE(conn, PHY_1M, PREFER_S8_CODING, PHY_1M);
|
|
CHECK_PREF_PHY_STATE(conn, PHY_1M | PHY_2M | PHY_CODED, PHY_1M | PHY_2M | PHY_CODED);
|
|
|
|
zassert_equal(llcp_ctx_buffers_free(), test_ctx_buffers_cnt(), "Free CTX buffers %d",
|
|
llcp_ctx_buffers_free());
|
|
}
|
|
|
|
ZTEST_SUITE(phy_central, NULL, NULL, phy_setup, NULL, NULL);
|
|
ZTEST_SUITE(phy_periph, NULL, NULL, phy_setup, NULL, NULL);
|