| /* |
| * Copyright (c) 2021 Nordic Semiconductor ASA |
| * |
| * 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_settings.h" |
| |
| #include "lll.h" |
| #include "ll_feat.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 "helper_pdu.h" |
| #include "helper_util.h" |
| |
| struct ll_conn conn; |
| |
| static void setup(void *data) |
| { |
| test_setup(&conn); |
| |
| /* Set CTE request enable as if it was called by Host */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| } |
| |
| static void fex_setup(void *data) |
| { |
| setup(data); |
| |
| /* Emulate valid feature exchange and all features valid for local and peer devices */ |
| memset(&conn.llcp.fex, 0, sizeof(conn.llcp.fex)); |
| conn.llcp.fex.features_used = LL_FEAT; |
| conn.llcp.fex.features_peer = LL_FEAT; |
| |
| conn.llcp.fex.valid = 1; |
| } |
| |
| /* Tests of successful execution of CTE Request Procedure */ |
| |
| /* +-----+ +-------+ +-----+ |
| * | UT | | LL_A | | LT | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start initiation | | |
| * | CTE Request Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_LE_CTE_REQ | |
| * | |------------------>| |
| * | | | |
| * | | LL_LE_CTE_RSP | |
| * | |<------------------| |
| * | | | |
| * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| * | | | |
| * | LE Connection IQ Report | | |
| * |<---------------------------| | |
| * | | | |
| * | | | |
| */ |
| ZTEST(cte_req_after_fex, test_cte_req_central_local) |
| { |
| uint8_t err; |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| struct pdu_data_llctrl_cte_rsp remote_cte_rsp = {}; |
| struct node_rx_pdu *ntf; |
| |
| /* Role */ |
| test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| |
| /* Initiate an CTE Request Procedure */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_CTE_REQ, &conn, &tx, &local_cte_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_CTE_RSP, &conn, &remote_cte_rsp); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Receive notification of sampled CTE response */ |
| ut_rx_pdu(LL_CTE_RSP, &ntf, &remote_cte_rsp); |
| |
| /* The RX queue should be empty now */ |
| ut_rx_q_is_empty(); |
| |
| /* Release Ntf */ |
| ull_cp_release_ntf(ntf); |
| |
| /* Release tx node */ |
| ull_cp_release_tx(&conn, tx); |
| |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| /* +-----+ +-------+ +-----+ |
| * | UT | | LL_A | | LT | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start initiator | | |
| * | CTE Request Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_LE_CTE_REQ | |
| * | |------------------>| |
| * | | | |
| * | | LL_LE_CTE_RSP | |
| * | |<------------------| |
| * | | | |
| * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| * | | | |
| * | LE Connection IQ Report | | |
| * |<---------------------------| | |
| * | | | |
| * | | | |
| */ |
| ZTEST(cte_req_after_fex, test_cte_req_peripheral_local) |
| { |
| uint8_t err; |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| |
| struct pdu_data_llctrl_cte_rsp remote_cte_rsp = {}; |
| struct node_rx_pdu *ntf; |
| |
| /* Role */ |
| test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate an CTE Request Procedure */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_CTE_REQ, &conn, &tx, &local_cte_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_CTE_RSP, &conn, &remote_cte_rsp); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Receive notification of sampled CTE response */ |
| ut_rx_pdu(LL_CTE_RSP, &ntf, &remote_cte_rsp); |
| |
| /* The RX queue should be empty now */ |
| ut_rx_q_is_empty(); |
| |
| /* Release Ntf */ |
| ull_cp_release_ntf(ntf); |
| |
| /* Release tx node */ |
| ull_cp_release_tx(&conn, tx); |
| |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| /* +-----+ +-------+ +-----+ |
| * | UT | | LL_A | | LT | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start responder | | |
| * | CTE Request Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_LE_CTE_REQ | |
| * | |<------------------| |
| * | | | |
| * | | LL_LE_CTE_RSP | |
| * | |------------------>| |
| * | | | |
| * | | | |
| */ |
| ZTEST(cte_req_after_fex, test_cte_req_central_remote) |
| { |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| |
| struct pdu_data_llctrl_cte_rsp remote_cte_rsp = {}; |
| |
| /* Role */ |
| test_set_role(&conn, BT_HCI_ROLE_CENTRAL); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Enable response for CTE request */ |
| ull_cp_cte_rsp_enable(&conn, true, BT_HCI_LE_CTE_LEN_MAX, |
| (BT_HCI_LE_AOA_CTE | BT_HCI_LE_AOD_CTE_1US | BT_HCI_LE_AOD_CTE_2US)); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx */ |
| lt_tx(LL_CTE_REQ, &conn, &local_cte_req); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_CTE_RSP, &conn, &tx, &remote_cte_rsp); |
| lt_rx_q_is_empty(&conn); |
| |
| /* TX Ack */ |
| 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 | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start responder | | |
| * | CTE Request Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_LE_CTE_REQ | |
| * | |<------------------| |
| * | | | |
| * | | LL_LE_CTE_RSP | |
| * | |------------------>| |
| * | | | |
| * | | | |
| */ |
| ZTEST(cte_req_after_fex, test_cte_req_peripheral_remote) |
| { |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| |
| struct pdu_data_llctrl_cte_rsp remote_cte_rsp = {}; |
| |
| /* Role */ |
| test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Enable response for CTE request */ |
| ull_cp_cte_rsp_enable(&conn, true, BT_HCI_LE_CTE_LEN_MAX, |
| (BT_HCI_LE_AOA_CTE | BT_HCI_LE_AOD_CTE_1US | BT_HCI_LE_AOD_CTE_2US)); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx */ |
| lt_tx(LL_CTE_REQ, &conn, &local_cte_req); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_CTE_RSP, &conn, &tx, &remote_cte_rsp); |
| lt_rx_q_is_empty(&conn); |
| |
| /* TX Ack */ |
| 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()); |
| } |
| |
| /* Tests of expected failures during execution of CTE Request Procedure */ |
| |
| /* +-----+ +-------+ +-----+ |
| * | UT | | LL_A | | LT | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start initiation | | |
| * | CTE Request Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_LE_CTE_REQ | |
| * | |------------------------------->| |
| * | | | |
| * | | LL_REJECT_EXT_IND | |
| * | | BT_HCI_ERR_UNSUPP_LL_PARAM_VAL | |
| * | | or BT_HCI_ERR_INVALID_LL_PARAM | |
| * | |<-------------------------------| |
| * | | | |
| * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| * | | | |
| * | LE CTE Request Failed | | |
| * |<---------------------------| | |
| * | | | |
| * | | | |
| */ |
| ZTEST(cte_req_after_fex, test_cte_req_rejected_inv_ll_param_central_local) |
| { |
| uint8_t err; |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOD_CTE_1US, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| struct pdu_data_llctrl_reject_ext_ind remote_reject_ext_ind = { |
| .reject_opcode = PDU_DATA_LLCTRL_TYPE_CTE_REQ, |
| .error_code = BT_HCI_ERR_UNSUPP_LL_PARAM_VAL, |
| }; |
| struct node_rx_pdu *ntf; |
| |
| /* Role */ |
| test_set_role(&conn, BT_HCI_ROLE_CENTRAL); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate an CTE Request Procedure */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_CTE_REQ, &conn, &tx, &local_cte_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_REJECT_EXT_IND, &conn, &remote_reject_ext_ind); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Receive notification of sampled CTE response */ |
| ut_rx_pdu(LL_REJECT_EXT_IND, &ntf, &remote_reject_ext_ind); |
| |
| /* The RX queue should be empty now */ |
| ut_rx_q_is_empty(); |
| |
| /* Release Ntf */ |
| ull_cp_release_ntf(ntf); |
| |
| /* Release tx node */ |
| ull_cp_release_tx(&conn, tx); |
| |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| /* +-----+ +-------+ +-----+ |
| * | UT | | LL_A | | LT | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start initiation | | |
| * | CTE Request Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_LE_CTE_REQ | |
| * | |------------------------------->| |
| * | | | |
| * | | LL_REJECT_EXT_IND | |
| * | | BT_HCI_ERR_UNSUPP_LL_PARAM_VAL | |
| * | | or BT_HCI_ERR_INVALID_LL_PARAM | |
| * | |<-------------------------------| |
| * | | | |
| * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| * | | | |
| * | LE CTE Request Failed | | |
| * |<---------------------------| | |
| * | | | |
| * | | | |
| */ |
| ZTEST(cte_req_after_fex, test_cte_req_rejected_inv_ll_param_peripheral_local) |
| { |
| uint8_t err; |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOD_CTE_1US, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| struct pdu_data_llctrl_reject_ext_ind remote_reject_ext_ind = { |
| .reject_opcode = PDU_DATA_LLCTRL_TYPE_CTE_REQ, |
| .error_code = BT_HCI_ERR_UNSUPP_LL_PARAM_VAL, |
| }; |
| struct node_rx_pdu *ntf; |
| |
| /* Role */ |
| test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate an CTE Request Procedure */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_CTE_REQ, &conn, &tx, &local_cte_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_REJECT_EXT_IND, &conn, &remote_reject_ext_ind); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Receive notification of sampled CTE response */ |
| ut_rx_pdu(LL_REJECT_EXT_IND, &ntf, &remote_reject_ext_ind); |
| |
| /* The RX queue should be empty now */ |
| ut_rx_q_is_empty(); |
| |
| /* Release Ntf */ |
| ull_cp_release_ntf(ntf); |
| |
| /* Release tx node */ |
| ull_cp_release_tx(&conn, tx); |
| |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| /* +-----+ +-------+ +-----+ |
| * | UT | | LL_A | | LT | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start initiation | | |
| * | CTE Reqest Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_LE_CTE_REQ | |
| * | |<-------------------------------| |
| * | | | |
| * | | LL_REJECT_EXT_IND | |
| * | | BT_HCI_ERR_UNSUPP_LL_PARAM_VAL | |
| * | |------------------------------->| |
| * | | | |
| */ |
| ZTEST(cte_req_after_fex, test_cte_req_reject_inv_ll_param_central_remote) |
| { |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOD_CTE_2US, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| |
| struct pdu_data_llctrl_reject_ext_ind remote_reject_ext_ind = { |
| .reject_opcode = PDU_DATA_LLCTRL_TYPE_CTE_REQ, |
| .error_code = BT_HCI_ERR_UNSUPP_LL_PARAM_VAL, |
| }; |
| |
| /* Role */ |
| test_set_role(&conn, BT_HCI_ROLE_CENTRAL); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Enable response for CTE request */ |
| ull_cp_cte_rsp_enable(&conn, true, BT_HCI_LE_CTE_LEN_MAX, |
| (BT_HCI_LE_AOA_CTE_RSP | BT_HCI_LE_AOD_CTE_RSP_1US)); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx */ |
| lt_tx(LL_CTE_REQ, &conn, &local_cte_req); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_REJECT_EXT_IND, &conn, &tx, &remote_reject_ext_ind); |
| lt_rx_q_is_empty(&conn); |
| |
| /* TX Ack */ |
| 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 | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start initiation | | |
| * | CTE Reqest Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_LE_CTE_REQ | |
| * | |<-------------------------------| |
| * | | | |
| * | | LL_REJECT_EXT_IND | |
| * | | BT_HCI_ERR_UNSUPP_LL_PARAM_VAL | |
| * | |------------------------------->| |
| * | | | |
| */ |
| ZTEST(cte_req_after_fex, test_cte_req_reject_inv_ll_param_peripheral_remote) |
| { |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOD_CTE_2US, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| |
| struct pdu_data_llctrl_reject_ext_ind remote_reject_ext_ind = { |
| .reject_opcode = PDU_DATA_LLCTRL_TYPE_CTE_REQ, |
| .error_code = BT_HCI_ERR_UNSUPP_LL_PARAM_VAL, |
| }; |
| |
| /* Role */ |
| test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Enable response for CTE request */ |
| ull_cp_cte_rsp_enable(&conn, true, BT_HCI_LE_CTE_LEN_MAX, |
| (BT_HCI_LE_AOA_CTE | BT_HCI_LE_AOD_CTE_1US)); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx */ |
| lt_tx(LL_CTE_REQ, &conn, &local_cte_req); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_REJECT_EXT_IND, &conn, &tx, &remote_reject_ext_ind); |
| lt_rx_q_is_empty(&conn); |
| |
| /* TX Ack */ |
| 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 | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start initiation | | |
| * | CTE Request Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_LE_CTE_REQ | |
| * | |------------------------------->| |
| * | | | |
| * | | LL_UNKNOWN_RSP | |
| * | |<-------------------------------| |
| * | | | |
| * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| * | | | |
| * | LE CTE Request Failed | | |
| * |<---------------------------| | |
| * | | | |
| * | | | |
| */ |
| static void test_cte_req_ll_unknown_rsp_local(uint8_t role) |
| { |
| uint8_t err; |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOD_CTE_1US, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| |
| struct pdu_data_llctrl_unknown_rsp unknown_rsp = { .type = PDU_DATA_LLCTRL_TYPE_CTE_REQ }; |
| struct node_rx_pdu *ntf; |
| |
| /* Role */ |
| test_set_role(&conn, role); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate an CTE Request Procedure */ |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_CTE_REQ, &conn, &tx, &local_cte_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_UNKNOWN_RSP, &conn, &unknown_rsp); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Receive notification of reception of unknown response. The notification is changed to |
| * HCI_LE_CTE_Request_Failed before send to host by HCI. This is why it is verified if CTE |
| * request state machine sends LL_UNKNOWN_RSP towards host. |
| */ |
| ut_rx_pdu(LL_UNKNOWN_RSP, &ntf, &unknown_rsp); |
| |
| /* The RX queue should be empty now */ |
| ut_rx_q_is_empty(); |
| |
| /* Release Ntf */ |
| ull_cp_release_ntf(ntf); |
| |
| /* Release tx node */ |
| ull_cp_release_tx(&conn, tx); |
| |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), "Free CTX buffers %d", |
| ctx_buffers_free()); |
| |
| /* Verify that CTE response feature is marked as not supported by peer device */ |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_UNSUPP_REMOTE_FEATURE, NULL); |
| } |
| |
| ZTEST(cte_req, test_cte_req_ll_unknown_rsp_central_local) |
| { |
| test_cte_req_ll_unknown_rsp_local(BT_HCI_ROLE_CENTRAL); |
| } |
| |
| ZTEST(cte_req, test_cte_req_ll_unknown_rsp_peripheral_local) |
| { |
| test_cte_req_ll_unknown_rsp_local(BT_HCI_ROLE_PERIPHERAL); |
| } |
| |
| /* Tests related with PHY update procedure and CTE request procedure "collision" */ |
| |
| #define PREFER_S2_CODING 0U |
| #define HOST_INITIATED 1U |
| #define PHY_UPDATE_INSTANT_DELTA 6U |
| #define PHY_PREFER_ANY (PHY_1M | PHY_2M | PHY_CODED) |
| /* Arbitrary value used for setting effective maximum number of TX/RX octets */ |
| #define PDU_PDU_MAX_OCTETS (PDU_DC_PAYLOAD_SIZE_MIN * 3) |
| |
| static void check_pref_phy_state(const struct ll_conn *conn, uint8_t phy_tx, uint8_t phy_rx) |
| { |
| zassert_equal(conn->phy_pref_rx, phy_rx, |
| "Preferred RX PHY mismatch %d (actual) != %d (expected)", conn->phy_pref_rx, |
| phy_rx); |
| zassert_equal(conn->phy_pref_tx, phy_tx, |
| "Preferred TX PHY mismatch %d (actual) != %d (expected)", conn->phy_pref_tx, |
| phy_tx); |
| } |
| |
| static void check_current_phy_state(const struct ll_conn *conn, uint8_t phy_tx, uint8_t flags, |
| uint8_t phy_rx) |
| { |
| zassert_equal(conn->lll.phy_rx, phy_rx, |
| "Current RX PHY mismatch %d (actual) != %d (expected)", conn->lll.phy_rx, |
| phy_rx); |
| zassert_equal(conn->lll.phy_tx, phy_tx, |
| "Current TX PHY mismatch %d (actual) != %d (expected)", conn->lll.phy_tx, |
| phy_tx); |
| zassert_equal(conn->lll.phy_flags, flags, |
| "Current Flags mismatch %d (actual) != %d (expected)", conn->lll.phy_flags, |
| flags); |
| } |
| |
| static bool is_instant_reached(struct ll_conn *conn, uint16_t instant) |
| { |
| /* Check if instant is in the past. |
| * |
| * NOTE: If conn_event > instant then subtract operation will result in value greater than |
| * 0x7FFF for uint16_t type. This is based on modulo 65536 math. The 0x7FFF is |
| * maximum positive difference between actual value of connection event counter and |
| * instant. |
| */ |
| return (uint16_t)(event_counter(conn) - instant) <= (uint16_t)0x7FFF; |
| } |
| |
| static uint16_t pu_event_counter(struct ll_conn *conn) |
| { |
| struct lll_conn *lll; |
| uint16_t event_counter; |
| |
| lll = &conn->lll; |
| |
| /* Calculate current event counter */ |
| event_counter = lll->event_counter + lll->latency_prepare; |
| |
| return event_counter; |
| } |
| |
| static void phy_update_setup(void) |
| { |
| /* Emulate initial conn state */ |
| conn.phy_pref_rx = PHY_PREFER_ANY; |
| conn.phy_pref_tx = PHY_PREFER_ANY; |
| 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(PDU_DC_PAYLOAD_SIZE_MAX); |
| /* PHY Coded support is enabled hence it limits the max TX time */ |
| ull_conn_default_tx_time_set(PDU_DC_PAYLOAD_TIME_MAX_CODED); |
| /* Initialize with defauly PHY1M */ |
| ull_dle_init(&conn, PHY_1M); |
| /* Emulate different remote numbers to trigger update of effective max TX octets and time. |
| * Numbers are taken arbitrary. |
| */ |
| conn.lll.dle.remote.max_tx_octets = PDU_PDU_MAX_OCTETS; |
| conn.lll.dle.remote.max_rx_octets = PDU_PDU_MAX_OCTETS; |
| 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); |
| } |
| |
| static void run_local_cte_req(struct pdu_data_llctrl_cte_req *cte_req) |
| { |
| struct pdu_data_llctrl_cte_rsp remote_cte_rsp = {}; |
| struct node_tx *tx = NULL; |
| struct node_rx_pdu *ntf; |
| |
| /* The CTE request should already be in local control procedures queue */ |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_CTE_REQ, &conn, &tx, cte_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_CTE_RSP, &conn, &remote_cte_rsp); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Receive notification of sampled CTE response */ |
| ut_rx_pdu(LL_CTE_RSP, &ntf, &remote_cte_rsp); |
| |
| /* The RX queue should be empty now */ |
| ut_rx_q_is_empty(); |
| |
| /* Release Ntf */ |
| ull_cp_release_ntf(ntf); |
| |
| /* Release tx node */ |
| ull_cp_release_tx(&conn, tx); |
| } |
| |
| static void wait_for_phy_update_instant(uint8_t instant) |
| { |
| /* */ |
| 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_S2_CODING, PHY_1M); |
| |
| /* There should NOT be a host notification */ |
| ut_rx_q_is_empty(); |
| } |
| } |
| |
| static void check_phy_update(bool is_local, struct pdu_data_llctrl_phy_req *phy_req, |
| uint8_t ctx_num_at_end, bool dle_ntf) |
| { |
| struct pdu_data_llctrl_length_rsp length_ntf = { |
| PDU_PDU_MAX_OCTETS, PDU_DC_MAX_US(PDU_PDU_MAX_OCTETS, phy_req->tx_phys), |
| PDU_PDU_MAX_OCTETS, PDU_DC_MAX_US(PDU_PDU_MAX_OCTETS, phy_req->rx_phys) |
| }; |
| struct node_rx_pu pu = {.status = BT_HCI_ERR_SUCCESS}; |
| struct node_rx_pdu *ntf; |
| |
| /* Execute connection event that is an instant. It is required to send notifications to |
| * Host that complete already started PHY update procedure. |
| */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should NOT have a LL Control PDU */ |
| lt_rx_q_is_empty(&conn); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Tx Queue should NOT have a LL Control PDU */ |
| lt_rx_q_is_empty(&conn); |
| |
| /* There should be two host notifications, one pu and one dle */ |
| ut_rx_node(NODE_PHY_UPDATE, &ntf, &pu); |
| if (dle_ntf) { |
| ut_rx_pdu(LL_LENGTH_RSP, &ntf, &length_ntf); |
| } |
| |
| /* Release Ntf */ |
| ull_cp_release_ntf(ntf); |
| |
| /* The RX queue should be empty now */ |
| ut_rx_q_is_empty(); |
| |
| check_current_phy_state(&conn, phy_req->tx_phys, PREFER_S2_CODING, phy_req->tx_phys); |
| if (is_local) { |
| check_pref_phy_state(&conn, phy_req->rx_phys, phy_req->tx_phys); |
| } else { |
| check_pref_phy_state(&conn, PHY_PREFER_ANY, PHY_PREFER_ANY); |
| } |
| |
| /* There is still queued CTE REQ so number of contexts is smaller by 1 than max */ |
| zassert_equal(ctx_buffers_free(), ctx_num_at_end, "Free CTX buffers %d", |
| ctx_buffers_free()); |
| } |
| |
| /** |
| * @brief The function executes and verifies PHY update procedure in central role. |
| * |
| * @param is_local Flag informing if PHY request is local or remote. |
| * @param phy_req Parameters of PHY update request. |
| * @param events_at_start Number of connection events at function start. |
| * @param ctx_num_at_end Expected number of free procedure contexts at function end. |
| */ |
| static void run_phy_update_central(bool is_local, struct pdu_data_llctrl_phy_req *phy_req, |
| uint8_t events_at_start, uint8_t ctx_num_at_end, bool dle_ntf) |
| { |
| struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_PREFER_ANY, |
| .tx_phys = PHY_PREFER_ANY }; |
| struct pdu_data_llctrl_phy_upd_ind ind = { .instant = events_at_start + |
| PHY_UPDATE_INSTANT_DELTA, |
| .c_to_p_phy = phy_req->tx_phys, |
| .p_to_c_phy = phy_req->rx_phys }; |
| struct node_tx *tx = NULL; |
| struct pdu_data *pdu; |
| uint16_t instant; |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| if (is_local) { |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_PHY_REQ, &conn, &tx, phy_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* TX Ack */ |
| event_tx_ack(&conn, tx); |
| |
| /* Rx */ |
| lt_tx(LL_PHY_RSP, &conn, &rsp); |
| |
| ind.instant += 1; |
| } |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Check that data tx was paused */ |
| zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused"); |
| |
| if (tx != NULL) { |
| /* 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); |
| |
| /* Release Tx */ |
| ull_cp_release_tx(&conn, tx); |
| |
| wait_for_phy_update_instant(instant); |
| |
| check_phy_update(is_local, phy_req, ctx_num_at_end, dle_ntf); |
| } |
| |
| /** |
| * @brief The function executes and verifies PHY update procedure in peripheral role. |
| * |
| * @param is_local Flag informing if PHY request is local or remote. |
| * @param phy_req Parameters of PHY update request. |
| * @param events_at_start Number of connection events at function start. |
| * @param ctx_num_at_end Expected number of free procedure contexts at function end. |
| */ |
| static void run_phy_update_peripheral(bool is_local, struct pdu_data_llctrl_phy_req *phy_req, |
| uint8_t events_at_start, uint8_t ctx_num_at_end, bool dle_ntf) |
| { |
| struct pdu_data_llctrl_phy_req rsp = { .rx_phys = PHY_PREFER_ANY, |
| .tx_phys = PHY_PREFER_ANY }; |
| struct pdu_data_llctrl_phy_upd_ind ind = { .c_to_p_phy = phy_req->rx_phys, |
| .p_to_c_phy = phy_req->tx_phys }; |
| struct node_tx *tx; |
| uint16_t instant; |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| if (is_local) { |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_PHY_REQ, &conn, &tx, phy_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* TX Ack */ |
| event_tx_ack(&conn, tx); |
| } |
| |
| /* Done */ |
| event_done(&conn); |
| |
| if (is_local) { |
| /* Release Tx */ |
| ull_cp_release_tx(&conn, tx); |
| } else { |
| /* Check that data tx was paused */ |
| zassert_equal(conn.tx_q.pause_data, 1U, "Data tx is not paused"); |
| } |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| instant = event_counter(&conn) + PHY_UPDATE_INSTANT_DELTA; |
| ind.instant = instant; |
| |
| if (is_local) { |
| /* Tx Queue should NOT have a LL Control PDU */ |
| lt_rx_q_is_empty(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_tx(LL_PHY_UPDATE_IND, &conn, &ind); |
| } else { |
| /* 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); |
| |
| if (!is_local) { |
| /* Release Tx */ |
| ull_cp_release_tx(&conn, tx); |
| } |
| |
| wait_for_phy_update_instant(instant); |
| |
| check_phy_update(is_local, phy_req, ctx_num_at_end, dle_ntf); |
| } |
| |
| static void test_local_cte_req_wait_for_phy_update_complete_and_disable(uint8_t role) |
| { |
| uint8_t err; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| struct pdu_data_llctrl_phy_req phy_req = { .rx_phys = PHY_CODED, .tx_phys = PHY_CODED }; |
| |
| phy_update_setup(); |
| |
| /* Role */ |
| test_set_role(&conn, role); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate an PHY Update Procedure */ |
| err = ull_cp_phy_update(&conn, PHY_CODED, PREFER_S2_CODING, PHY_CODED, HOST_INITIATED); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| /* Initiate an CTE Request Procedure */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| if (role == BT_HCI_ROLE_CENTRAL) { |
| run_phy_update_central(true, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt() - 1, true); |
| } else { |
| run_phy_update_peripheral(true, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt() - 1, true); |
| } |
| |
| /* In this test CTE request is local procedure. Local procedures are handled after remote |
| * procedures, hence PHY update will be handled one event after completion of CTE request. |
| */ |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should not have any LL Control PDU */ |
| lt_rx_q_is_empty(&conn); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* 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()); |
| } |
| |
| ZTEST(cte_req_after_fex, test_central_local_cte_req_wait_for_phy_update_complete_and_disable) |
| { |
| test_local_cte_req_wait_for_phy_update_complete_and_disable(BT_HCI_ROLE_CENTRAL); |
| } |
| |
| ZTEST(cte_req_after_fex, test_peripheral_local_cte_req_wait_for_phy_update_complete_and_disable) |
| { |
| test_local_cte_req_wait_for_phy_update_complete_and_disable(BT_HCI_ROLE_PERIPHERAL); |
| } |
| |
| static void test_local_cte_req_wait_for_phy_update_complete(uint8_t role) |
| { |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| struct pdu_data_llctrl_phy_req phy_req = { .rx_phys = PHY_2M, .tx_phys = PHY_2M }; |
| |
| uint8_t err; |
| |
| phy_update_setup(); |
| |
| /* Role */ |
| test_set_role(&conn, role); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate an PHY Update Procedure */ |
| err = ull_cp_phy_update(&conn, phy_req.rx_phys, PREFER_S2_CODING, phy_req.tx_phys, |
| HOST_INITIATED); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| /* Initiate an CTE Request Procedure */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| if (role == BT_HCI_ROLE_CENTRAL) { |
| run_phy_update_central(true, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt() - 1, false); |
| } else { |
| run_phy_update_peripheral(true, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt() - 1, false); |
| } |
| |
| /* PHY update was completed. Handle CTE request */ |
| run_local_cte_req(&local_cte_req); |
| |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| ZTEST(cte_req_after_fex, test_central_local_cte_req_wait_for_phy_update_complete) |
| { |
| test_local_cte_req_wait_for_phy_update_complete(BT_HCI_ROLE_CENTRAL); |
| } |
| |
| ZTEST(cte_req_after_fex, test_peripheral_local_cte_req_wait_for_phy_update_complete) |
| { |
| test_local_cte_req_wait_for_phy_update_complete(BT_HCI_ROLE_PERIPHERAL); |
| } |
| |
| static void test_local_phy_update_wait_for_cte_req_complete(uint8_t role) |
| { |
| struct pdu_data_llctrl_phy_req phy_req = { .rx_phys = PHY_CODED, .tx_phys = PHY_CODED }; |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| uint8_t err; |
| |
| phy_update_setup(); |
| |
| /* Role */ |
| test_set_role(&conn, role); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate an CTE Request Procedure */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| /* Initiate an PHY Update Procedure */ |
| err = ull_cp_phy_update(&conn, PHY_CODED, PREFER_S2_CODING, PHY_CODED, HOST_INITIATED); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| /* Handle CTE request */ |
| run_local_cte_req(&local_cte_req); |
| |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt() - 1, |
| "Free CTX buffers %d", ctx_buffers_free()); |
| |
| if (role == BT_HCI_ROLE_CENTRAL) { |
| run_phy_update_central(true, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt(), true); |
| } else { |
| run_phy_update_peripheral(true, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt(), true); |
| } |
| } |
| |
| ZTEST(cte_req_after_fex, test_central_local_phy_update_wait_for_cte_req_complete) |
| { |
| test_local_phy_update_wait_for_cte_req_complete(BT_HCI_ROLE_CENTRAL); |
| } |
| |
| ZTEST(cte_req_after_fex, test_peripheral_local_phy_update_wait_for_cte_req_complete) |
| { |
| test_local_phy_update_wait_for_cte_req_complete(BT_HCI_ROLE_PERIPHERAL); |
| } |
| |
| static void run_remote_cte_req(struct pdu_data_llctrl_cte_req *cte_req) |
| { |
| struct pdu_data_llctrl_cte_rsp remote_cte_rsp = {}; |
| struct node_tx *tx; |
| |
| /* The CTE response should already be enabled and request PDU should already be |
| * received. |
| */ |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_CTE_RSP, &conn, &tx, &remote_cte_rsp); |
| lt_rx_q_is_empty(&conn); |
| |
| /* TX Ack */ |
| 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(); |
| } |
| |
| static void test_phy_update_wait_for_remote_cte_req_complete(uint8_t role) |
| { |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| struct pdu_data_llctrl_phy_req phy_req = { .rx_phys = PHY_CODED, .tx_phys = PHY_CODED }; |
| uint8_t err; |
| |
| phy_update_setup(); |
| |
| /* Role */ |
| test_set_role(&conn, role); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Enable response for CTE request */ |
| ull_cp_cte_rsp_enable(&conn, true, BT_HCI_LE_CTE_LEN_MAX, |
| (BT_HCI_LE_AOA_CTE | BT_HCI_LE_AOD_CTE_1US | BT_HCI_LE_AOD_CTE_2US)); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx */ |
| lt_tx(LL_CTE_REQ, &conn, &local_cte_req); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Initiate an PHY Update Procedure */ |
| err = ull_cp_phy_update(&conn, PHY_CODED, PREFER_S2_CODING, PHY_CODED, HOST_INITIATED); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| run_remote_cte_req(&local_cte_req); |
| |
| /* There should not be a host notifications */ |
| ut_rx_q_is_empty(); |
| |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt() - 1, |
| "Free CTX buffers %d", ctx_buffers_free()); |
| |
| if (role == BT_HCI_ROLE_CENTRAL) { |
| run_phy_update_central(true, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt(), true); |
| } else { |
| run_phy_update_peripheral(true, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt(), true); |
| } |
| } |
| |
| ZTEST(cte_req_after_fex, test_central_phy_update_wait_for_remote_cte_req_complete) |
| { |
| test_phy_update_wait_for_remote_cte_req_complete(BT_HCI_ROLE_CENTRAL); |
| } |
| |
| ZTEST(cte_req_after_fex, test_peripheral_phy_update_wait_for_remote_cte_req_complete) |
| { |
| test_phy_update_wait_for_remote_cte_req_complete(BT_HCI_ROLE_PERIPHERAL); |
| } |
| |
| static void test_cte_req_wait_for_remote_phy_update_complete_and_disable(uint8_t role) |
| { |
| uint8_t err; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| struct pdu_data_llctrl_phy_req phy_req = { .rx_phys = PHY_CODED, .tx_phys = PHY_CODED }; |
| |
| phy_update_setup(); |
| |
| /* Role */ |
| test_set_role(&conn, role); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx */ |
| lt_tx(LL_PHY_REQ, &conn, &phy_req); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Initiate an CTE Request Procedure */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| if (role == BT_HCI_ROLE_CENTRAL) { |
| run_phy_update_central(false, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt(), true); |
| } else { |
| run_phy_update_peripheral(false, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt(), true); |
| } |
| |
| /* There is no special handling of CTE REQ completion. It is done when instant happens just |
| * after remote PHY update completes. |
| */ |
| } |
| |
| ZTEST(cte_req_after_fex, test_central_cte_req_wait_for_remote_phy_update_complete_and_disable) |
| { |
| test_cte_req_wait_for_remote_phy_update_complete_and_disable(BT_HCI_ROLE_CENTRAL); |
| } |
| |
| ZTEST(cte_req_after_fex, test_peripheral_cte_req_wait_for_remote_phy_update_complete_and_disable) |
| { |
| test_cte_req_wait_for_remote_phy_update_complete_and_disable(BT_HCI_ROLE_PERIPHERAL); |
| } |
| |
| static void test_cte_req_wait_for_remote_phy_update_complete(uint8_t role) |
| { |
| uint8_t err; |
| |
| struct pdu_data_llctrl_cte_req local_cte_req = { |
| .cte_type_req = BT_HCI_LE_AOA_CTE, |
| .min_cte_len_req = BT_HCI_LE_CTE_LEN_MIN, |
| }; |
| struct pdu_data_llctrl_phy_req phy_req = { .rx_phys = PHY_2M, .tx_phys = PHY_2M }; |
| |
| phy_update_setup(); |
| |
| /* Role */ |
| test_set_role(&conn, role); |
| |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Prepare */ |
| event_prepare(&conn); |
| |
| /* Tx */ |
| lt_tx(LL_PHY_REQ, &conn, &phy_req); |
| |
| /* Done */ |
| event_done(&conn); |
| |
| /* Initiate an CTE Request Procedure */ |
| conn.llcp.cte_req.is_enabled = 1U; |
| |
| err = ull_cp_cte_req(&conn, local_cte_req.min_cte_len_req, local_cte_req.cte_type_req); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| |
| if (role == BT_HCI_ROLE_CENTRAL) { |
| run_phy_update_central(false, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt() - 1, false); |
| } else { |
| run_phy_update_peripheral(false, &phy_req, pu_event_counter(&conn), |
| test_ctx_buffers_cnt() - 1, false); |
| } |
| |
| /* There is no special handling of CTE REQ completion here. It is done when instant happens |
| * just after remote PHY update completes. |
| */ |
| /* PHY update was completed. Handle CTE request */ |
| run_local_cte_req(&local_cte_req); |
| |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), "Free CTX buffers %d", |
| ctx_buffers_free()); |
| } |
| |
| ZTEST(cte_req_after_fex, test_central_cte_req_wait_for_remote_phy_update_complete) |
| { |
| test_cte_req_wait_for_remote_phy_update_complete(BT_HCI_ROLE_CENTRAL); |
| } |
| |
| ZTEST(cte_req_after_fex, test_peripheral_cte_req_wait_for_remote_phy_update_complete) |
| { |
| test_cte_req_wait_for_remote_phy_update_complete(BT_HCI_ROLE_PERIPHERAL); |
| } |
| |
| ZTEST_SUITE(cte_req, NULL, NULL, setup, NULL, NULL); |
| ZTEST_SUITE(cte_req_after_fex, NULL, NULL, fex_setup, NULL, NULL); |
