| /* |
| * Copyright (c) 2020 Nordic Semiconductor ASA |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| #include <zephyr/types.h> |
| #include <zephyr/sys/byteorder.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_conn_types.h" |
| |
| #include "ull_internal.h" |
| #include "ull_llcp.h" |
| #include "ull_llcp_internal.h" |
| #include "ull_conn_internal.h" |
| |
| #include "ll_feat.h" |
| |
| #include "helper_pdu.h" |
| #include "helper_util.h" |
| #include "helper_features.h" |
| |
| static struct ll_conn conn; |
| |
| static void fex_setup(void *data) |
| { |
| test_setup(&conn); |
| } |
| |
| /* |
| * +-----+ +-------+ +-----+ |
| * | UT | | LL_A | | LT | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start | | |
| * | Feature Exchange Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_FEATURE_REQ | |
| * | |------------------>| |
| * | | | |
| * | | LL_FEATURE_RSP | |
| * | |<------------------| |
| * | | | |
| * | Feature Exchange Proc. | | |
| * | Complete | | |
| * |<---------------------------| | |
| * | | | |
| */ |
| ZTEST(fex_central, test_feat_exchange_central_loc) |
| { |
| uint64_t err; |
| uint64_t set_featureset[] = { DEFAULT_FEATURE, DEFAULT_FEATURE }; |
| uint64_t rsp_featureset[] = { |
| (LL_FEAT_BIT_MASK_VALID & FEAT_FILTER_OCTET0) | DEFAULT_FEATURE, 0x0 |
| }; |
| uint64_t exp_rsp_featureset[] = { ((LL_FEAT_BIT_MASK_VALID & FEAT_FILTER_OCTET0) | |
| DEFAULT_FEATURE) & |
| LL_FEAT_BIT_MASK_VALID, |
| 0x0 }; |
| int feat_to_test = ARRAY_SIZE(set_featureset); |
| |
| struct node_tx *tx; |
| struct node_rx_pdu *ntf; |
| |
| struct pdu_data_llctrl_feature_req local_feature_req; |
| struct pdu_data_llctrl_feature_rsp remote_feature_rsp; |
| struct pdu_data_llctrl_feature_rsp exp_remote_feature_rsp; |
| int feat_counter; |
| |
| for (feat_counter = 0; feat_counter < feat_to_test; feat_counter++) { |
| sys_put_le64(set_featureset[feat_counter], local_feature_req.features); |
| |
| sys_put_le64(rsp_featureset[feat_counter], remote_feature_rsp.features); |
| |
| sys_put_le64(exp_rsp_featureset[feat_counter], exp_remote_feature_rsp.features); |
| |
| test_set_role(&conn, BT_HCI_ROLE_CENTRAL); |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate a Feature Exchange Procedure */ |
| err = ull_cp_feature_exchange(&conn); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS); |
| |
| event_prepare(&conn); |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_FEATURE_REQ, &conn, &tx, &local_feature_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_FEATURE_RSP, &conn, &remote_feature_rsp); |
| |
| event_done(&conn); |
| /* There should be one host notification */ |
| |
| ut_rx_pdu(LL_FEATURE_RSP, &ntf, &exp_remote_feature_rsp); |
| |
| ut_rx_q_is_empty(); |
| |
| ull_cp_release_tx(&conn, tx); |
| ull_cp_release_ntf(ntf); |
| } |
| |
| /* Test that host enabled feature makes it into feature exchange */ |
| ll_set_host_feature(BT_LE_FEAT_BIT_ISO_CHANNELS, 1); |
| |
| /* Add host feature bit to expected features bit mask */ |
| set_featureset[0] |= BIT64(BT_LE_FEAT_BIT_ISO_CHANNELS); |
| |
| sys_put_le64(set_featureset[0], local_feature_req.features); |
| /* Initiate a Feature Exchange Procedure */ |
| err = ull_cp_feature_exchange(&conn); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS); |
| |
| event_prepare(&conn); |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_FEATURE_REQ, &conn, &tx, &local_feature_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_FEATURE_RSP, &conn, &remote_feature_rsp); |
| |
| event_done(&conn); |
| /* There should be one host notification */ |
| |
| ut_rx_pdu(LL_FEATURE_RSP, &ntf, &exp_remote_feature_rsp); |
| |
| ut_rx_q_is_empty(); |
| |
| ull_cp_release_tx(&conn, tx); |
| ull_cp_release_ntf(ntf); |
| |
| /* Remove host feature bit again */ |
| ll_set_host_feature(BT_LE_FEAT_BIT_ISO_CHANNELS, 0); |
| |
| zassert_equal(conn.lll.event_counter, feat_to_test + 1, "Wrong event-count %d\n", |
| conn.lll.event_counter); |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| /* |
| * +-----+ +-------+ +-----+ |
| * | UT | | LL_A | | LT | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | Start | | |
| * | Feature Exchange Proc. | | |
| * |--------------------------->| | |
| * | | | |
| * | | LL_FEATURE_REQ | |
| * | |------------------>| |
| * | | | |
| * | | LL_<INVALID>_RSP | |
| * | |<------------------| |
| * | | | |
| * ~~~~~~~~~~~~~~~~ TERMINATE CONNECTION ~~~~~~~~~~~~~~ |
| * | | | |
| */ |
| ZTEST(fex_central, test_feat_exchange_central_loc_invalid_rsp) |
| { |
| uint64_t err; |
| struct pdu_data_llctrl_feature_req local_feature_req; |
| 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_FEATURE_REQ, |
| .error_code = BT_HCI_ERR_LL_PROC_COLLISION |
| }; |
| struct node_tx *tx; |
| |
| |
| sys_put_le64(DEFAULT_FEATURE, local_feature_req.features); |
| |
| test_set_role(&conn, BT_HCI_ROLE_CENTRAL); |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate a Feature Exchange Procedure */ |
| err = ull_cp_feature_exchange(&conn); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS); |
| |
| event_prepare(&conn); |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_FEATURE_REQ, &conn, &tx, &local_feature_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_REJECT_IND, &conn, &reject_ind); |
| |
| 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()); |
| |
| test_set_role(&conn, BT_HCI_ROLE_CENTRAL); |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Initiate another Feature Exchange Procedure */ |
| err = ull_cp_feature_exchange(&conn); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS); |
| |
| event_prepare(&conn); |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_FEATURE_REQ, &conn, &tx, &local_feature_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_REJECT_EXT_IND, &conn, &reject_ext_ind); |
| |
| 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()); |
| } |
| |
| ZTEST(fex_central, test_feat_exchange_central_loc_2) |
| { |
| uint8_t err; |
| |
| test_set_role(&conn, BT_HCI_ROLE_CENTRAL); |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| err = ull_cp_feature_exchange(&conn); |
| for (int i = 0U; i < CONFIG_BT_CTLR_LLCP_LOCAL_PROC_CTX_BUF_NUM; i++) { |
| zassert_equal(err, BT_HCI_ERR_SUCCESS); |
| err = ull_cp_feature_exchange(&conn); |
| } |
| |
| zassert_not_equal(err, BT_HCI_ERR_SUCCESS, NULL); |
| zassert_equal(ctx_buffers_free(), |
| test_ctx_buffers_cnt() - CONFIG_BT_CTLR_LLCP_LOCAL_PROC_CTX_BUF_NUM, |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| /* |
| * +-----+ +-------+ +-----+ |
| * | UT | | LL_A | | LT | |
| * +-----+ +-------+ +-----+ |
| * | | | |
| * | | LL_PERIPH_FEAT_XCHG | |
| * | |<------------------------| |
| * | | | |
| * | | LL_FEATURE_RSP | |
| * | |------------------------>| |
| * | | | |
| */ |
| #define CENTRAL_NR_OF_EVENTS 2 |
| ZTEST(fex_central, test_feat_exchange_central_rem) |
| { |
| uint64_t set_featureset[] = { |
| DEFAULT_FEATURE, |
| LL_FEAT_BIT_MASK_VALID, |
| EXPECTED_FEAT_EXCH_VALID, |
| 0xFFFFFFFFFFFFFFFF, |
| 0x0 }; |
| uint64_t exp_featureset[] = { DEFAULT_FEATURE & COMMON_FEAT_OCTET0(LL_FEAT_BIT_MASK_VALID), |
| DEFAULT_FEATURE & COMMON_FEAT_OCTET0(LL_FEAT_BIT_MASK_VALID), |
| DEFAULT_FEATURE & |
| COMMON_FEAT_OCTET0(EXPECTED_FEAT_EXCH_VALID), |
| DEFAULT_FEATURE & COMMON_FEAT_OCTET0(LL_FEAT_BIT_MASK_VALID), |
| DEFAULT_FEATURE & 0xFFFFFFFFFFFFFF00 }; |
| int feat_to_test = ARRAY_SIZE(set_featureset); |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_feature_req remote_feature_req; |
| struct pdu_data_llctrl_feature_rsp local_feature_rsp; |
| |
| test_set_role(&conn, BT_HCI_ROLE_CENTRAL); |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| for (int feat_count = 0; feat_count < feat_to_test; feat_count++) { |
| sys_put_le64(set_featureset[feat_count], remote_feature_req.features); |
| sys_put_le64(exp_featureset[feat_count], local_feature_rsp.features); |
| |
| event_prepare(&conn); |
| |
| lt_tx(LL_PERIPH_FEAT_XCHG, &conn, &remote_feature_req); |
| |
| event_done(&conn); |
| |
| event_prepare(&conn); |
| |
| lt_rx(LL_FEATURE_RSP, &conn, &tx, &local_feature_rsp); |
| lt_rx_q_is_empty(&conn); |
| |
| event_done(&conn); |
| |
| ut_rx_q_is_empty(); |
| |
| ull_cp_release_tx(&conn, tx); |
| } |
| zassert_equal(conn.lll.event_counter, CENTRAL_NR_OF_EVENTS * (feat_to_test), |
| "Wrong event-count %d\n", conn.lll.event_counter); |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| #undef CENTRAL_NR_OF_EVENTS |
| #define CENTRAL_NR_OF_EVENTS 3 |
| ZTEST(fex_central, test_feat_exchange_central_rem_2) |
| { |
| /* |
| * we could combine some of the following, |
| * but in reality we should add some more |
| * test cases |
| */ |
| uint64_t set_featureset[] = { |
| DEFAULT_FEATURE, |
| LL_FEAT_BIT_MASK_VALID, |
| EXPECTED_FEAT_EXCH_VALID, |
| 0xFFFFFFFFFFFFFFFF, |
| 0x0 }; |
| uint64_t exp_featureset[] = { DEFAULT_FEATURE & COMMON_FEAT_OCTET0(LL_FEAT_BIT_MASK_VALID), |
| DEFAULT_FEATURE & COMMON_FEAT_OCTET0(LL_FEAT_BIT_MASK_VALID), |
| DEFAULT_FEATURE & |
| COMMON_FEAT_OCTET0(EXPECTED_FEAT_EXCH_VALID), |
| DEFAULT_FEATURE & COMMON_FEAT_OCTET0(LL_FEAT_BIT_MASK_VALID), |
| DEFAULT_FEATURE & 0xFFFFFFFFFFFFFF00 }; |
| uint64_t ut_featureset[] = { |
| DEFAULT_FEATURE, |
| DEFAULT_FEATURE, |
| DEFAULT_FEATURE, |
| DEFAULT_FEATURE, |
| DEFAULT_FEATURE }; |
| uint64_t ut_exp_featureset[] = { |
| DEFAULT_FEATURE & LL_FEAT_BIT_MASK_VALID, DEFAULT_FEATURE & LL_FEAT_BIT_MASK_VALID, |
| DEFAULT_FEATURE & LL_FEAT_BIT_MASK_VALID, DEFAULT_FEATURE & LL_FEAT_BIT_MASK_VALID, |
| (DEFAULT_FEATURE & LL_FEAT_BIT_MASK_VALID) & 0xFFFFFFFFFFFFFF00 |
| }; |
| |
| int feat_to_test = ARRAY_SIZE(set_featureset); |
| uint64_t err; |
| struct node_tx *tx; |
| struct node_rx_pdu *ntf; |
| |
| struct pdu_data_llctrl_feature_req remote_feature_req; |
| struct pdu_data_llctrl_feature_rsp local_feature_rsp; |
| struct pdu_data_llctrl_feature_req ut_feature_req; |
| struct pdu_data_llctrl_feature_req ut_feature_rsp; |
| |
| test_set_role(&conn, BT_HCI_ROLE_CENTRAL); |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| for (int feat_count = 0; feat_count < feat_to_test; feat_count++) { |
| sys_put_le64(set_featureset[feat_count], remote_feature_req.features); |
| sys_put_le64(exp_featureset[feat_count], local_feature_rsp.features); |
| sys_put_le64(ut_featureset[feat_count], ut_feature_req.features); |
| sys_put_le64(ut_exp_featureset[feat_count], ut_feature_rsp.features); |
| |
| err = ull_cp_feature_exchange(&conn); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS); |
| |
| event_prepare(&conn); |
| lt_tx(LL_PERIPH_FEAT_XCHG, &conn, &remote_feature_req); |
| event_done(&conn); |
| |
| event_prepare(&conn); |
| lt_rx(LL_FEATURE_REQ, &conn, &tx, &ut_feature_req); |
| lt_tx(LL_FEATURE_RSP, &conn, &local_feature_rsp); |
| event_done(&conn); |
| |
| ull_cp_release_tx(&conn, tx); |
| |
| event_prepare(&conn); |
| lt_rx(LL_FEATURE_RSP, &conn, &tx, &local_feature_rsp); |
| event_done(&conn); |
| |
| ut_rx_pdu(LL_FEATURE_RSP, &ntf, &ut_feature_rsp); |
| |
| /* |
| * at the end of a loop all queues should be empty |
| */ |
| ut_rx_q_is_empty(); |
| lt_rx_q_is_empty(&conn); |
| |
| ull_cp_release_tx(&conn, tx); |
| ull_cp_release_ntf(ntf); |
| } |
| |
| zassert_equal(conn.lll.event_counter, CENTRAL_NR_OF_EVENTS * (feat_to_test), |
| "Wrong event-count %d\n", conn.lll.event_counter); |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| ZTEST(fex_periph, test_peripheral_feat_exchange_periph_loc) |
| { |
| uint64_t err; |
| uint64_t featureset; |
| struct node_tx *tx; |
| struct node_rx_pdu *ntf; |
| |
| struct pdu_data_llctrl_feature_req local_feature_req; |
| struct pdu_data_llctrl_feature_rsp remote_feature_rsp; |
| |
| featureset = DEFAULT_FEATURE; |
| sys_put_le64(featureset, local_feature_req.features); |
| featureset &= LL_FEAT_BIT_MASK_VALID; |
| sys_put_le64(featureset, remote_feature_rsp.features); |
| |
| test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL); |
| /* Connect */ |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Steal all ntf buffers, so as to check that the wait_ntf mechanism works */ |
| 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; |
| } |
| |
| /* Initiate a Feature Exchange Procedure */ |
| err = ull_cp_feature_exchange(&conn); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS); |
| |
| event_prepare(&conn); |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_PERIPH_FEAT_XCHG, &conn, &tx, &local_feature_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx */ |
| lt_tx(LL_FEATURE_RSP, &conn, &remote_feature_rsp); |
| |
| event_done(&conn); |
| |
| ut_rx_q_is_empty(); |
| |
| /* Release Ntf, so next cycle will generate NTF and complete procedure */ |
| ull_cp_release_ntf(ntf); |
| |
| event_prepare(&conn); |
| event_done(&conn); |
| |
| /* There should be one host notification */ |
| |
| ut_rx_pdu(LL_FEATURE_RSP, &ntf, &remote_feature_rsp); |
| ut_rx_q_is_empty(); |
| zassert_equal(conn.lll.event_counter, 2, "Wrong event-count %d\n", |
| conn.lll.event_counter); |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| ZTEST(fex_periph, test_feat_exchange_periph_loc_unknown_rsp) |
| { |
| uint64_t err; |
| uint64_t featureset; |
| struct node_tx *tx; |
| |
| struct pdu_data_llctrl_feature_req local_feature_req; |
| |
| struct node_rx_pdu *ntf; |
| struct pdu_data_llctrl_unknown_rsp unknown_rsp = { |
| .type = PDU_DATA_LLCTRL_TYPE_PER_INIT_FEAT_XCHG |
| }; |
| |
| featureset = DEFAULT_FEATURE; |
| sys_put_le64(featureset, local_feature_req.features); |
| |
| test_set_role(&conn, BT_HCI_ROLE_PERIPHERAL); |
| |
| ull_cp_state_set(&conn, ULL_CP_CONNECTED); |
| |
| /* Steal all ntf buffers, so as to check that the wait_ntf mechanism works */ |
| 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; |
| } |
| |
| /* Initiate a Feature Exchange Procedure */ |
| |
| event_prepare(&conn); |
| err = ull_cp_feature_exchange(&conn); |
| zassert_equal(err, BT_HCI_ERR_SUCCESS); |
| event_done(&conn); |
| |
| event_prepare(&conn); |
| |
| /* Tx Queue should have one LL Control PDU */ |
| lt_rx(LL_PERIPH_FEAT_XCHG, &conn, &tx, &local_feature_req); |
| lt_rx_q_is_empty(&conn); |
| |
| /* Rx Commented out for know, handling of UNKNOWN response will come in an update */ |
| |
| lt_tx(LL_UNKNOWN_RSP, &conn, &unknown_rsp); |
| |
| event_done(&conn); |
| |
| ut_rx_q_is_empty(); |
| |
| /* Release Ntf, so next cycle will generate NTF and complete procedure */ |
| ull_cp_release_ntf(ntf); |
| |
| event_prepare(&conn); |
| event_done(&conn); |
| |
| ut_rx_pdu(LL_UNKNOWN_RSP, &ntf, &unknown_rsp); |
| ut_rx_q_is_empty(); |
| zassert_equal(conn.lll.event_counter, 3, "Wrong event-count %d\n", |
| conn.lll.event_counter); |
| zassert_equal(ctx_buffers_free(), test_ctx_buffers_cnt(), |
| "Free CTX buffers %d", ctx_buffers_free()); |
| } |
| |
| ZTEST_SUITE(fex_central, NULL, NULL, fex_setup, NULL, NULL); |
| ZTEST_SUITE(fex_periph, NULL, NULL, fex_setup, NULL, NULL); |