Bluetooth: host: Add handl HCI_LE_Connectionless_IQ_Report (7c834bf1) · Commits · Wenxi XU / zephyr

include/bluetooth/direction.h

+3 −3

Original line number	Diff line number	Diff line
		@@ -95,11 +95,11 @@ struct bt_df_per_adv_sync_iq_samples_report {
		int16_t rssi;
		/** Id of antenna used to measure the RSSI. */
		uint8_t rssi_ant_id;
		/** Type of CTE (@ref BT_DF_CTE_TYPE). */
		/** Type of CTE (@ref bt_df_cte_type). */
		uint8_t cte_type;
		/** Duration of slots when received CTE type is AoA (@ref BT_DF_ANTENNA_SWITCHING_SLOT). */
		/** Duration of slots when received CTE type is AoA (@ref bt_df_antenna_switching_slot). */
		uint8_t slot_durations;
		/** Status of received PDU with CTE (@ref BT_DF_RX_POCKET_STATUS). */
		/** Status of received PDU with CTE (@ref bt_df_packet_status). */
		uint8_t packet_status;
		/** Number of IQ samples in report. */
		uint8_t sample_count;

subsys/bluetooth/host/direction.c

+45 −0

Original line number	Diff line number	Diff line
		@@ -15,6 +15,7 @@
		#include <bluetooth/direction.h>

		#include "hci_core.h"
		#include "scan.h"
		#include "conn_internal.h"
		#include "direction_internal.h"

		@@ -308,6 +309,50 @@ static int hci_df_set_cl_cte_rx_enable(struct bt_le_per_adv_sync *sync, bool ena

		return 0;
		}

		void hci_df_prepare_connectionless_iq_report(struct net_buf *buf,
		struct bt_df_per_adv_sync_iq_samples_report *report,
		struct bt_le_per_adv_sync **per_adv_sync_to_report)
		{
		struct bt_hci_evt_le_connectionless_iq_report *evt;
		struct bt_le_per_adv_sync *per_adv_sync;

		if (buf->len < sizeof(*evt)) {
		BT_ERR("Unexpected end of buffer");
		return;
		}

		evt = net_buf_pull_mem(buf, sizeof(*evt));

		per_adv_sync = bt_hci_get_per_adv_sync(sys_le16_to_cpu(evt->sync_handle));

		if (!per_adv_sync) {
		BT_ERR("Unknown handle 0x%04X for iq samples report",
		sys_le16_to_cpu(evt->sync_handle));
		return;
		}

		if (!atomic_test_bit(per_adv_sync->flags, BT_PER_ADV_SYNC_CTE_ENABLED)) {
		BT_ERR("Received PA CTE report when CTE receive disabled");
		return;
		}

		if (!(per_adv_sync->cte_type & BIT(evt->cte_type))) {
		BT_DBG("CTE filtered out by cte_type: %u", evt->cte_type);
		return;
		}

		report->chan_idx = evt->chan_idx;
		report->rssi = evt->rssi;
		report->rssi_ant_id = evt->rssi_ant_id;
		report->cte_type = BIT(evt->cte_type);
		report->packet_status = evt->packet_status;
		report->slot_durations = evt->slot_durations;
		report->sample_count = evt->sample_count;
		report->sample = &evt->sample[0];

		*per_adv_sync_to_report = per_adv_sync;
		}
		#endif /* CONFIG_BT_DF_CONNECTIONLESS_CTE_RX */

		#if defined(CONFIG_BT_CTLR_DF_CONN_CTE_RSP)

subsys/bluetooth/host/direction_internal.h

+4 −0

Original line number	Diff line number	Diff line
		@@ -6,3 +6,7 @@

		/* Performs initialization of Direction Finding in Host */
		int le_df_init(void);

		void hci_df_prepare_connectionless_iq_report(struct net_buf *buf,
		struct bt_df_per_adv_sync_iq_samples_report *report,
		struct bt_le_per_adv_sync **per_adv_sync_to_report);

subsys/bluetooth/host/hci_core.c

+9 −0

Original line number	Diff line number	Diff line
		@@ -2133,6 +2133,10 @@ static const struct event_handler meta_events[] = {
		sizeof(struct bt_hci_evt_le_biginfo_adv_report)),
		#endif /* (CONFIG_BT_ISO_BROADCAST) */
		#endif /* (CONFIG_BT_ISO) */
		#if defined(CONFIG_BT_DF_CONNECTIONLESS_CTE_RX)
		EVENT_HANDLER(BT_HCI_EVT_LE_CONNECTIONLESS_IQ_REPORT, bt_hci_le_df_connectionless_iq_report,
		sizeof(struct bt_hci_evt_le_connectionless_iq_report)),
		#endif /* CONFIG_BT_DF_CONNECTIONLESS_CTE_RX */
		};

		static void hci_le_meta_event(struct net_buf *buf)
		@@ -2684,6 +2688,11 @@ static int le_set_event_mask(void)
		}
		}

		/* Enable IQ samples report events receiver */
		if (IS_ENABLED(CONFIG_BT_DF_CONNECTIONLESS_CTE_RX)) {
		mask \|= BT_EVT_MASK_LE_CONNECTIONLESS_IQ_REPORT;
		}

		sys_put_le64(mask, cp_mask->events);
		return bt_hci_cmd_send_sync(BT_HCI_OP_LE_SET_EVENT_MASK, buf, NULL);
		}

subsys/bluetooth/host/hci_core.h

+1 −0

Original line number	Diff line number	Diff line
		@@ -402,6 +402,7 @@ void bt_hci_le_per_adv_sync_established(struct net_buf *buf);
		void bt_hci_le_per_adv_report(struct net_buf *buf);
		void bt_hci_le_per_adv_sync_lost(struct net_buf *buf);
		void bt_hci_le_biginfo_adv_report(struct net_buf *buf);
		void bt_hci_le_df_connectionless_iq_report(struct net_buf *buf);
		void bt_hci_le_past_received(struct net_buf *buf);

		/* Adv HCI event handlers */

Admin message