bartoszek/zephyr
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
dc5cf7b76c
zephyr/tests/bluetooth/controller/ctrl_sca_update/src/main.c
Erik Brockhoff b3b4b9e322 Bluetooth: controller: implementing SCA update procedure PDU flow 
Adding PDU flow and unittest for Sleep clock accuracy procedure

Signed-off-by: Erik Brockhoff <erbr@oticon.com>

wip kconf
2022-11-08 10:44:54 +01:00

569 lines
17 KiB
C
Raw Blame History

/*
* Copyright (c) 2022 Demant
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <zephyr/types.h>
#include <zephyr/ztest.h>
#include "kconfig.h"
#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.h"
#include "ll.h"
#include "ll_feat.h"
#include "ll_settings.h"
#include "lll.h"
#include "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_conn_types.h"
#include "ull_llcp.h"
#include "ull_conn_internal.h"
#include "ull_llcp_internal.h"
#include "ull_llcp_features.h"
#include "helper_pdu.h"
#include "helper_util.h"
struct ll_conn conn;
static void setup(void)
{
test_setup(&conn);
}
/* +-----+ +-------+ +-----+
* | UT | | LL_A | | LT |
* +-----+ +-------+ +-----+
* | | |
* | Start | |
* | SCA Update Proc. | |
* |--------------------------->| |
* | | |
* | | LL_CLOCK_ACCURACY_REQ |
* | |------------------------------->|
* | | |
* | | LL_CLOCK_ACCURACY_RSP |
* | |<-------------------------------|
* | | |
* | Start | |
* | SCA UPdate Proc. | |
* |--------------------------->| |
* | | |
* | | LL_CLOCK_ACCURACY_REQ |
* | |------------------------------->|
* | | |
* | | LL_UNKNOWN_RSP |
* | |<-------------------------------|
* | | |
*/
void test_sca_central_loc(void)
{
uint8_t err;
struct node_tx *tx;
struct node_rx_pdu *ntf;
struct node_rx_sca scau = { .status = BT_HCI_ERR_SUCCESS, .sca = 2 };
struct pdu_data_llctrl_clock_accuracy_req local_sca_req = { };
struct pdu_data_llctrl_clock_accuracy_rsp remote_sca_rsp = { .sca = 2 };
struct pdu_data_llctrl_unknown_rsp unknown_rsp = {
.type = PDU_DATA_LLCTRL_TYPE_CLOCK_ACCURACY_REQ
};
/* Role */
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
/* Connect */
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
/* Initiate an SCA Procedure */
err = ull_cp_req_peer_sca(&conn);
zassert_equal(err, BT_HCI_ERR_SUCCESS);
/* Confirm SCA Update is indicated as supported */
zassert_equal(feature_sca(&conn), true, "SCA Update Feature masked out");
/* Prepare */
event_prepare(&conn);
/* Tx Queue should have one LL Control PDU */
lt_rx(LL_CLOCK_ACCURACY_REQ, &conn, &tx, &local_sca_req);
lt_rx_q_is_empty(&conn);
/* Rx */
lt_tx(LL_CLOCK_ACCURACY_RSP, &conn, &remote_sca_rsp);
/* Done */
event_done(&conn);
/* Release tx node */
ull_cp_release_tx(&conn, tx);
/* Termination not 'triggered' */
zassert_equal(conn.llcp_terminate.reason_final, 0,
"Terminate reason %d", conn.llcp_terminate.reason_final);
/* There should be one notification due to Peer SCA Request */
ut_rx_node(NODE_PEER_SCA_UPDATE, &ntf, &scau);
ut_rx_q_is_empty();
zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(),
"Free CTX buffers %d", ctx_buffers_free());
/* Initiate another SCA Procedure */
err = ull_cp_req_peer_sca(&conn);
zassert_equal(err, BT_HCI_ERR_SUCCESS);
/* Prepare */
event_prepare(&conn);
/* Tx Queue should have one LL Control PDU */
lt_rx(LL_CLOCK_ACCURACY_REQ, &conn, &tx, &local_sca_req);
lt_rx_q_is_empty(&conn);
/* Rx */
lt_tx(LL_UNKNOWN_RSP, &conn, &unknown_rsp);
/* Done */
event_done(&conn);
/* Release tx node */
ull_cp_release_tx(&conn, tx);
/* Confirm SCA Update is now indicated as NOT supported */
zassert_equal(feature_sca(&conn), false, "SCA Update Feature masked in");
/* Termination not 'triggered' */
zassert_equal(conn.llcp_terminate.reason_final, 0,
"Terminate reason %d", conn.llcp_terminate.reason_final);
scau.status = BT_HCI_ERR_UNSUPP_FEATURE_PARAM_VAL;
scau.sca = 0;
/* There should be one notification due to Peer SCA Request */
ut_rx_node(NODE_PEER_SCA_UPDATE, &ntf, &scau);
ut_rx_q_is_empty();
zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(),
"Free CTX buffers %d", ctx_buffers_free());
}
/* +-----+ +-------+ +-----+
* | UT | | LL_A | | LT |
* +-----+ +-------+ +-----+
* | | |
* | Start | |
* | SCA Update Proc. | |
* |--------------------------->| |
* | | |
* | | LL_CLOCK_ACCURACY_REQ |
* | |------------------------->|
* | | |
* | | LL_<INVALID>_RSP |
* | |<-------------------------|
* | | |
* ~~~~~~~~~~~~~~~~~ TERMINATE CONNECTION ~~~~~~~~~~~~~~
* | | |
*/
void test_sca_central_loc_invalid_rsp(void)
{
uint8_t err;
struct node_tx *tx;
struct pdu_data_llctrl_reject_ind reject_ind = {
.error_code = BT_HCI_ERR_LL_PROC_COLLISION
};
struct pdu_data_llctrl_reject_ext_ind reject_ext_ind = {
.reject_opcode = PDU_DATA_LLCTRL_TYPE_CLOCK_ACCURACY_REQ,
.error_code = BT_HCI_ERR_LL_PROC_COLLISION
};
struct pdu_data_llctrl_clock_accuracy_req local_sca_req = {};
/* Role */
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
/* Connect */
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
/* Initiate an SCA Procedure */
err = ull_cp_req_peer_sca(&conn);
zassert_equal(err, BT_HCI_ERR_SUCCESS);
/* Prepare */
event_prepare(&conn);
/* Tx Queue should have one LL Control PDU */
lt_rx(LL_CLOCK_ACCURACY_REQ, &conn, &tx, &local_sca_req);
lt_rx_q_is_empty(&conn);
/* Rx */
lt_tx(LL_REJECT_EXT_IND, &conn, &reject_ext_ind);
/* Done */
event_done(&conn);
/* Release tx node */
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);
/* Clear termination flag for subsequent test cycle */
conn.llcp_terminate.reason_final = 0;
/* There should not be a host notifications */
ut_rx_q_is_empty();
zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(),
"Free CTX buffers %d", ctx_buffers_free());
/* Initiate another SCA Procedure */
err = ull_cp_req_peer_sca(&conn);
zassert_equal(err, BT_HCI_ERR_SUCCESS);
/* Prepare */
event_prepare(&conn);
/* Tx Queue should have one LL Control PDU */
lt_rx(LL_CLOCK_ACCURACY_REQ, &conn, &tx, &local_sca_req);
lt_rx_q_is_empty(&conn);
/* Rx */
lt_tx(LL_REJECT_IND, &conn, &reject_ind);
/* Done */
event_done(&conn);
/* Release tx node */
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 not be a host notifications */
ut_rx_q_is_empty();
zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(),
"Free CTX buffers %d", ctx_buffers_free());
}
/* +-----+ +-------+ +-----+
* | UT | | LL_A | | LT |
* +-----+ +-------+ +-----+
* | | |
* | Start | |
* | SCA Update Proc. | |
* |--------------------------->| |
* | | |
* | | LL_CLOCK_ACCURACY_REQ |
* | |------------------------->|
* | | |
* | | LL_<INVALID>_RSP |
* | |<-------------------------|
* | | |
* ~~~~~~~~~~~~~~~~~ TERMINATE CONNECTION ~~~~~~~~~~~~~~
* | | |
*/
void test_sca_peripheral_loc_invalid_rsp(void)
{
uint8_t err;
struct node_tx *tx;
struct pdu_data_llctrl_reject_ind reject_ind = {
.error_code = BT_HCI_ERR_LL_PROC_COLLISION
};
struct pdu_data_llctrl_reject_ext_ind reject_ext_ind = {
.reject_opcode = PDU_DATA_LLCTRL_TYPE_CLOCK_ACCURACY_REQ,
.error_code = BT_HCI_ERR_LL_PROC_COLLISION
};
struct pdu_data_llctrl_clock_accuracy_req local_sca_req = {};
/* Role */
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
/* Connect */
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
/* Initiate an SCA Procedure */
err = ull_cp_req_peer_sca(&conn);
zassert_equal(err, BT_HCI_ERR_SUCCESS);
/* Prepare */
event_prepare(&conn);
/* Tx Queue should have one LL Control PDU */
lt_rx(LL_CLOCK_ACCURACY_REQ, &conn, &tx, &local_sca_req);
lt_rx_q_is_empty(&conn);
/* Rx */
lt_tx(LL_REJECT_EXT_IND, &conn, &reject_ext_ind);
/* Done */
event_done(&conn);
/* Release tx node */
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);
/* Clear termination flag for subsequent test cycle */
conn.llcp_terminate.reason_final = 0;
/* There should not be a host notifications */
ut_rx_q_is_empty();
zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(),
"Free CTX buffers %d", ctx_buffers_free());
/* Initiate another SCA Procedure */
err = ull_cp_req_peer_sca(&conn);
zassert_equal(err, BT_HCI_ERR_SUCCESS);
/* Prepare */
event_prepare(&conn);
/* Tx Queue should have one LL Control PDU */
lt_rx(LL_CLOCK_ACCURACY_REQ, &conn, &tx, &local_sca_req);
lt_rx_q_is_empty(&conn);
/* Rx */
lt_tx(LL_REJECT_IND, &conn, &reject_ind);
/* Done */
event_done(&conn);
/* Release tx node */
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 not be a host notifications */
ut_rx_q_is_empty();
zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(),
"Free CTX buffers %d", ctx_buffers_free());
}
/* +-----+ +-------+ +-----+
* | UT | | LL_A | | LT |
* +-----+ +-------+ +-----+
* | | |
* | Start | |
* | SCA Update Proc. | |
* |--------------------------->| |
* | | |
* | | LL_CLOCK_ACCURACY_REQ |
* | |------------------------->|
* | | |
* | | LL_CLOCK_ACCURACY_RSP |
* | |<-------------------------|
* | | |
* | | |
*/
void test_ping_periph_loc(void)
{
uint8_t err;
struct node_tx *tx;
struct node_rx_pdu *ntf;
struct node_rx_sca scau = { .status = BT_HCI_ERR_SUCCESS, .sca = 2 };
struct pdu_data_llctrl_clock_accuracy_req local_sca_req = { };
struct pdu_data_llctrl_clock_accuracy_rsp remote_sca_rsp = { .sca = 2 };
/* Role */
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
/* Connect */
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
/* Initiate an SCA Procedure */
err = ull_cp_req_peer_sca(&conn);
zassert_equal(err, BT_HCI_ERR_SUCCESS);
/* Prepare */
event_prepare(&conn);
/* Tx Queue should have one LL Control PDU */
lt_rx(LL_CLOCK_ACCURACY_REQ, &conn, &tx, &local_sca_req);
lt_rx_q_is_empty(&conn);
/* Rx */
lt_tx(LL_CLOCK_ACCURACY_RSP, &conn, &remote_sca_rsp);
/* Done */
event_done(&conn);
/* Release tx node */
ull_cp_release_tx(&conn, tx);
/* Termination not 'triggered' */
zassert_equal(conn.llcp_terminate.reason_final, 0,
"Terminate reason %d", conn.llcp_terminate.reason_final);
/* There should be one notification due to Peer SCA Request */
ut_rx_node(NODE_PEER_SCA_UPDATE, &ntf, &scau);
ut_rx_q_is_empty();
zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(),
"Free CTX buffers %d", ctx_buffers_free());
}
/* +-----+ +-------+ +-----+
* | UT | | LL_A | | LT |
* +-----+ +-------+ +-----+
* | | |
* | | LL_CLOCK_ACCURACY_REQ |
* | |------------------------->|
* | | |
* | | LL_CLOCK_ACCURACY_RSP |
* | |<-------------------------|
* | | |
* | | |
*/
void test_ping_central_rem(void)
{
struct node_tx *tx;
struct pdu_data_llctrl_clock_accuracy_req local_sca_req = { };
struct pdu_data_llctrl_clock_accuracy_rsp remote_sca_rsp = { };
/* Role */
test_set_role(&conn, BT_HCI_ROLE_CENTRAL);
/* Connect */
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
/* Prepare */
event_prepare(&conn);
/* Tx */
lt_tx(LL_CLOCK_ACCURACY_REQ, &conn, &local_sca_req);
/* Done */
event_done(&conn);
/* Prepare */
event_prepare(&conn);
/* Tx Queue should have one LL Control PDU */
lt_rx(LL_CLOCK_ACCURACY_RSP, &conn, &tx, &remote_sca_rsp);
lt_rx_q_is_empty(&conn);
event_tx_ack(&conn, tx);
/* Done */
event_done(&conn);
/* Release tx node */
ull_cp_release_tx(&conn, tx);
/* There should not be a host notifications */
ut_rx_q_is_empty();
zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(),
"Free CTX buffers %d", ctx_buffers_free());
}
/* +-----+ +-------+ +-----+
* | UT | | LL_A | | LT |
* +-----+ +-------+ +-----+
* | | |
* | | LL_CLOCK_ACCURACY_REQ |
* | |------------------------->|
* | | |
* | | LL_CLOCK_ACCURACY_RSP |
* | |<-------------------------|
* | | |
* | | |
*/
void test_ping_periph_rem(void)
{
struct node_tx *tx;
struct pdu_data_llctrl_clock_accuracy_req local_sca_req = { };
struct pdu_data_llctrl_clock_accuracy_rsp remote_sca_rsp = { };
/* Role */
test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL);
/* Connect */
ull_cp_state_set(&conn, ULL_CP_CONNECTED);
/* Prepare */
event_prepare(&conn);
/* Tx */
lt_tx(LL_CLOCK_ACCURACY_REQ, &conn, &local_sca_req);
/* Done */
event_done(&conn);
/* Prepare */
event_prepare(&conn);
/* Tx Queue should have one LL Control PDU */
lt_rx(LL_CLOCK_ACCURACY_RSP, &conn, &tx, &remote_sca_rsp);
lt_rx_q_is_empty(&conn);
event_tx_ack(&conn, tx);
/* Done */
event_done(&conn);
/* Release tx node */
ull_cp_release_tx(&conn, tx);
/* There should not be a host notifications */
ut_rx_q_is_empty();
zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(),
"Free CTX buffers %d", ctx_buffers_free());
}
void test_main(void)
{
ztest_test_suite(sca,
ztest_unit_test_setup_teardown(test_sca_central_loc, setup,
unit_test_noop),
ztest_unit_test_setup_teardown(test_sca_central_loc_invalid_rsp, setup,
unit_test_noop),
ztest_unit_test_setup_teardown(test_ping_periph_loc, setup,
unit_test_noop),
ztest_unit_test_setup_teardown(test_sca_peripheral_loc_invalid_rsp, setup,
unit_test_noop),
ztest_unit_test_setup_teardown(test_ping_central_rem, setup,
unit_test_noop),
ztest_unit_test_setup_teardown(test_ping_periph_rem, setup,
unit_test_noop)
);
ztest_run_test_suite(sca);
}
Reference in New Issue View Git Blame Copy Permalink