124b21a9bSAlok Singh // SPDX-License-Identifier: BSD-3-Clause-Clear
224b21a9bSAlok Singh /*
324b21a9bSAlok Singh * Copyright (c) 2019-2021 The Linux Foundation. All rights reserved.
424b21a9bSAlok Singh * Copyright (c) Qualcomm Technologies, Inc. and/or its subsidiaries.
524b21a9bSAlok Singh */
624b21a9bSAlok Singh
724b21a9bSAlok Singh #include "hal_desc.h"
824b21a9bSAlok Singh #include "../dp_mon.h"
924b21a9bSAlok Singh #include "dp_mon.h"
1024b21a9bSAlok Singh #include "../debug.h"
1124b21a9bSAlok Singh #include "hal_qcn9274.h"
1224b21a9bSAlok Singh #include "dp_rx.h"
13e475119bSAlok Singh #include "../dp_tx.h"
1424b21a9bSAlok Singh #include "../peer.h"
1524b21a9bSAlok Singh
16e0016465SAlok Singh static void
ath12k_wifi7_dp_mon_hal_aggr_tlv(struct hal_rx_mon_ppdu_info * ppdu_info,u16 tlv_len,const void * tlv_data)1700b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_aggr_tlv(struct hal_rx_mon_ppdu_info *ppdu_info,
1800b67b7cSAlok Singh u16 tlv_len, const void *tlv_data)
1900b67b7cSAlok Singh {
2000b67b7cSAlok Singh if (tlv_len <= HAL_RX_MON_MAX_AGGR_SIZE - ppdu_info->tlv_aggr.cur_len) {
2100b67b7cSAlok Singh memcpy(ppdu_info->tlv_aggr.buf + ppdu_info->tlv_aggr.cur_len,
2200b67b7cSAlok Singh tlv_data, tlv_len);
2300b67b7cSAlok Singh ppdu_info->tlv_aggr.cur_len += tlv_len;
2400b67b7cSAlok Singh }
2500b67b7cSAlok Singh }
2600b67b7cSAlok Singh
2700b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_rx_memset_ppdu_info(struct hal_rx_mon_ppdu_info * ppdu_info)28e0016465SAlok Singh ath12k_wifi7_dp_mon_rx_memset_ppdu_info(struct hal_rx_mon_ppdu_info *ppdu_info)
29e0016465SAlok Singh {
30e0016465SAlok Singh memset(ppdu_info, 0, sizeof(*ppdu_info));
31e0016465SAlok Singh ppdu_info->peer_id = HAL_INVALID_PEERID;
32e0016465SAlok Singh }
33e0016465SAlok Singh
347cd7392aSAlok Singh /* Hardware fill buffer with 128 bytes aligned. So need to reap it
357cd7392aSAlok Singh * with 128 bytes aligned.
367cd7392aSAlok Singh */
377cd7392aSAlok Singh #define RXDMA_DATA_DMA_BLOCK_SIZE 128
387cd7392aSAlok Singh
397cd7392aSAlok Singh static void
ath12k_wifi7_dp_mon_get_buf_len(struct hal_rx_msdu_desc_info * info,bool * is_frag,u32 * total_len,u32 * frag_len,u32 * msdu_cnt)407cd7392aSAlok Singh ath12k_wifi7_dp_mon_get_buf_len(struct hal_rx_msdu_desc_info *info,
417cd7392aSAlok Singh bool *is_frag, u32 *total_len,
427cd7392aSAlok Singh u32 *frag_len, u32 *msdu_cnt)
437cd7392aSAlok Singh {
447cd7392aSAlok Singh if (info->msdu_flags & RX_MSDU_DESC_INFO0_MSDU_CONTINUATION) {
457cd7392aSAlok Singh *is_frag = true;
467cd7392aSAlok Singh *frag_len = (RX_MON_STATUS_BASE_BUF_SIZE -
477cd7392aSAlok Singh sizeof(struct hal_rx_desc)) &
487cd7392aSAlok Singh ~(RXDMA_DATA_DMA_BLOCK_SIZE - 1);
497cd7392aSAlok Singh *total_len += *frag_len;
507cd7392aSAlok Singh } else {
517cd7392aSAlok Singh if (*is_frag)
527cd7392aSAlok Singh *frag_len = info->msdu_len - *total_len;
537cd7392aSAlok Singh else
547cd7392aSAlok Singh *frag_len = info->msdu_len;
557cd7392aSAlok Singh
567cd7392aSAlok Singh *msdu_cnt -= 1;
577cd7392aSAlok Singh }
587cd7392aSAlok Singh }
597cd7392aSAlok Singh
60f4bcbaebSAlok Singh static void
ath12k_wifi7_dp_mon_rx_handle_ofdma_info(const struct hal_rx_ppdu_end_user_stats * ppdu_end_user,struct hal_rx_user_status * rx_user_status)615db19c48SAlok Singh ath12k_wifi7_dp_mon_rx_handle_ofdma_info(const struct hal_rx_ppdu_end_user_stats *ppdu_end_user,
625db19c48SAlok Singh struct hal_rx_user_status *rx_user_status)
635db19c48SAlok Singh {
645db19c48SAlok Singh rx_user_status->ul_ofdma_user_v0_word0 =
655db19c48SAlok Singh __le32_to_cpu(ppdu_end_user->usr_resp_ref);
665db19c48SAlok Singh rx_user_status->ul_ofdma_user_v0_word1 =
675db19c48SAlok Singh __le32_to_cpu(ppdu_end_user->usr_resp_ref_ext);
685db19c48SAlok Singh }
695db19c48SAlok Singh
705db19c48SAlok Singh static void
ath12k_wifi7_dp_mon_rx_populate_byte_count(const struct hal_rx_ppdu_end_user_stats * stats,void * ppduinfo,struct hal_rx_user_status * rx_user_status)715db19c48SAlok Singh ath12k_wifi7_dp_mon_rx_populate_byte_count(const struct hal_rx_ppdu_end_user_stats *stats,
725db19c48SAlok Singh void *ppduinfo,
735db19c48SAlok Singh struct hal_rx_user_status *rx_user_status)
745db19c48SAlok Singh {
755db19c48SAlok Singh rx_user_status->mpdu_ok_byte_count =
765db19c48SAlok Singh le32_get_bits(stats->info7,
775db19c48SAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO7_MPDU_OK_BYTE_COUNT);
785db19c48SAlok Singh rx_user_status->mpdu_err_byte_count =
795db19c48SAlok Singh le32_get_bits(stats->info8,
805db19c48SAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO8_MPDU_ERR_BYTE_COUNT);
815db19c48SAlok Singh }
825db19c48SAlok Singh
835db19c48SAlok Singh static void
ath12k_wifi7_dp_mon_rx_populate_mu_user_info(const struct hal_rx_ppdu_end_user_stats * rx_tlv,struct hal_rx_mon_ppdu_info * ppdu_info,struct hal_rx_user_status * rx_user_status)845db19c48SAlok Singh ath12k_wifi7_dp_mon_rx_populate_mu_user_info(const struct hal_rx_ppdu_end_user_stats *rx_tlv,
855db19c48SAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info,
865db19c48SAlok Singh struct hal_rx_user_status *rx_user_status)
875db19c48SAlok Singh {
885db19c48SAlok Singh rx_user_status->ast_index = ppdu_info->ast_index;
895db19c48SAlok Singh rx_user_status->tid = ppdu_info->tid;
905db19c48SAlok Singh rx_user_status->tcp_ack_msdu_count =
915db19c48SAlok Singh ppdu_info->tcp_ack_msdu_count;
925db19c48SAlok Singh rx_user_status->tcp_msdu_count =
935db19c48SAlok Singh ppdu_info->tcp_msdu_count;
945db19c48SAlok Singh rx_user_status->udp_msdu_count =
955db19c48SAlok Singh ppdu_info->udp_msdu_count;
965db19c48SAlok Singh rx_user_status->other_msdu_count =
975db19c48SAlok Singh ppdu_info->other_msdu_count;
985db19c48SAlok Singh rx_user_status->frame_control = ppdu_info->frame_control;
995db19c48SAlok Singh rx_user_status->frame_control_info_valid =
1005db19c48SAlok Singh ppdu_info->frame_control_info_valid;
1015db19c48SAlok Singh rx_user_status->data_sequence_control_info_valid =
1025db19c48SAlok Singh ppdu_info->data_sequence_control_info_valid;
1035db19c48SAlok Singh rx_user_status->first_data_seq_ctrl =
1045db19c48SAlok Singh ppdu_info->first_data_seq_ctrl;
1055db19c48SAlok Singh rx_user_status->preamble_type = ppdu_info->preamble_type;
1065db19c48SAlok Singh rx_user_status->ht_flags = ppdu_info->ht_flags;
1075db19c48SAlok Singh rx_user_status->vht_flags = ppdu_info->vht_flags;
1085db19c48SAlok Singh rx_user_status->he_flags = ppdu_info->he_flags;
1095db19c48SAlok Singh rx_user_status->rs_flags = ppdu_info->rs_flags;
1105db19c48SAlok Singh
1115db19c48SAlok Singh rx_user_status->mpdu_cnt_fcs_ok =
1125db19c48SAlok Singh ppdu_info->num_mpdu_fcs_ok;
1135db19c48SAlok Singh rx_user_status->mpdu_cnt_fcs_err =
1145db19c48SAlok Singh ppdu_info->num_mpdu_fcs_err;
1155db19c48SAlok Singh memcpy(&rx_user_status->mpdu_fcs_ok_bitmap[0], &ppdu_info->mpdu_fcs_ok_bitmap[0],
1165db19c48SAlok Singh HAL_RX_NUM_WORDS_PER_PPDU_BITMAP *
1175db19c48SAlok Singh sizeof(ppdu_info->mpdu_fcs_ok_bitmap[0]));
1185db19c48SAlok Singh
1195db19c48SAlok Singh ath12k_wifi7_dp_mon_rx_populate_byte_count(rx_tlv, ppdu_info, rx_user_status);
1205db19c48SAlok Singh }
1215db19c48SAlok Singh
1225db19c48SAlok Singh static inline enum ath12k_eht_ru_size
hal_rx_mon_hal_ru_size_to_ath12k_ru_size(u32 hal_ru_size)1235db19c48SAlok Singh hal_rx_mon_hal_ru_size_to_ath12k_ru_size(u32 hal_ru_size)
1245db19c48SAlok Singh {
1255db19c48SAlok Singh switch (hal_ru_size) {
1265db19c48SAlok Singh case HAL_EHT_RU_26:
1275db19c48SAlok Singh return ATH12K_EHT_RU_26;
1285db19c48SAlok Singh case HAL_EHT_RU_52:
1295db19c48SAlok Singh return ATH12K_EHT_RU_52;
1305db19c48SAlok Singh case HAL_EHT_RU_78:
1315db19c48SAlok Singh return ATH12K_EHT_RU_52_26;
1325db19c48SAlok Singh case HAL_EHT_RU_106:
1335db19c48SAlok Singh return ATH12K_EHT_RU_106;
1345db19c48SAlok Singh case HAL_EHT_RU_132:
1355db19c48SAlok Singh return ATH12K_EHT_RU_106_26;
1365db19c48SAlok Singh case HAL_EHT_RU_242:
1375db19c48SAlok Singh return ATH12K_EHT_RU_242;
1385db19c48SAlok Singh case HAL_EHT_RU_484:
1395db19c48SAlok Singh return ATH12K_EHT_RU_484;
1405db19c48SAlok Singh case HAL_EHT_RU_726:
1415db19c48SAlok Singh return ATH12K_EHT_RU_484_242;
1425db19c48SAlok Singh case HAL_EHT_RU_996:
1435db19c48SAlok Singh return ATH12K_EHT_RU_996;
1445db19c48SAlok Singh case HAL_EHT_RU_996x2:
1455db19c48SAlok Singh return ATH12K_EHT_RU_996x2;
1465db19c48SAlok Singh case HAL_EHT_RU_996x3:
1475db19c48SAlok Singh return ATH12K_EHT_RU_996x3;
1485db19c48SAlok Singh case HAL_EHT_RU_996x4:
1495db19c48SAlok Singh return ATH12K_EHT_RU_996x4;
1505db19c48SAlok Singh case HAL_EHT_RU_NONE:
1515db19c48SAlok Singh return ATH12K_EHT_RU_INVALID;
1525db19c48SAlok Singh case HAL_EHT_RU_996_484:
1535db19c48SAlok Singh return ATH12K_EHT_RU_996_484;
1545db19c48SAlok Singh case HAL_EHT_RU_996x2_484:
1555db19c48SAlok Singh return ATH12K_EHT_RU_996x2_484;
1565db19c48SAlok Singh case HAL_EHT_RU_996x3_484:
1575db19c48SAlok Singh return ATH12K_EHT_RU_996x3_484;
1585db19c48SAlok Singh case HAL_EHT_RU_996_484_242:
1595db19c48SAlok Singh return ATH12K_EHT_RU_996_484_242;
1605db19c48SAlok Singh default:
1615db19c48SAlok Singh return ATH12K_EHT_RU_INVALID;
1625db19c48SAlok Singh }
1635db19c48SAlok Singh }
1645db19c48SAlok Singh
1655db19c48SAlok Singh static inline u32
hal_rx_ul_ofdma_ru_size_to_width(enum ath12k_eht_ru_size ru_size)1665db19c48SAlok Singh hal_rx_ul_ofdma_ru_size_to_width(enum ath12k_eht_ru_size ru_size)
1675db19c48SAlok Singh {
1685db19c48SAlok Singh switch (ru_size) {
1695db19c48SAlok Singh case ATH12K_EHT_RU_26:
1705db19c48SAlok Singh return RU_26;
1715db19c48SAlok Singh case ATH12K_EHT_RU_52:
1725db19c48SAlok Singh return RU_52;
1735db19c48SAlok Singh case ATH12K_EHT_RU_52_26:
1745db19c48SAlok Singh return RU_52_26;
1755db19c48SAlok Singh case ATH12K_EHT_RU_106:
1765db19c48SAlok Singh return RU_106;
1775db19c48SAlok Singh case ATH12K_EHT_RU_106_26:
1785db19c48SAlok Singh return RU_106_26;
1795db19c48SAlok Singh case ATH12K_EHT_RU_242:
1805db19c48SAlok Singh return RU_242;
1815db19c48SAlok Singh case ATH12K_EHT_RU_484:
1825db19c48SAlok Singh return RU_484;
1835db19c48SAlok Singh case ATH12K_EHT_RU_484_242:
1845db19c48SAlok Singh return RU_484_242;
1855db19c48SAlok Singh case ATH12K_EHT_RU_996:
1865db19c48SAlok Singh return RU_996;
1875db19c48SAlok Singh case ATH12K_EHT_RU_996_484:
1885db19c48SAlok Singh return RU_996_484;
1895db19c48SAlok Singh case ATH12K_EHT_RU_996_484_242:
1905db19c48SAlok Singh return RU_996_484_242;
1915db19c48SAlok Singh case ATH12K_EHT_RU_996x2:
1925db19c48SAlok Singh return RU_2X996;
1935db19c48SAlok Singh case ATH12K_EHT_RU_996x2_484:
1945db19c48SAlok Singh return RU_2X996_484;
1955db19c48SAlok Singh case ATH12K_EHT_RU_996x3:
1965db19c48SAlok Singh return RU_3X996;
1975db19c48SAlok Singh case ATH12K_EHT_RU_996x3_484:
1985db19c48SAlok Singh return RU_3X996_484;
1995db19c48SAlok Singh case ATH12K_EHT_RU_996x4:
2005db19c48SAlok Singh return RU_4X996;
2015db19c48SAlok Singh default:
2025db19c48SAlok Singh return RU_INVALID;
2035db19c48SAlok Singh }
2045db19c48SAlok Singh }
2055db19c48SAlok Singh
2065db19c48SAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_user_info(const struct hal_receive_user_info * rx_usr_info,u16 user_id,struct hal_rx_mon_ppdu_info * ppdu_info)2075db19c48SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_user_info(const struct hal_receive_user_info *rx_usr_info,
2085db19c48SAlok Singh u16 user_id,
2095db19c48SAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
2105db19c48SAlok Singh {
2115db19c48SAlok Singh struct hal_rx_user_status *mon_rx_user_status = NULL;
2125db19c48SAlok Singh struct hal_rx_radiotap_eht *eht = &ppdu_info->eht_info.eht;
2135db19c48SAlok Singh enum ath12k_eht_ru_size rtap_ru_size = ATH12K_EHT_RU_INVALID;
2145db19c48SAlok Singh u32 ru_width, reception_type, ru_index = HAL_EHT_RU_INVALID;
2155db19c48SAlok Singh u32 ru_type_80_0, ru_start_index_80_0;
2165db19c48SAlok Singh u32 ru_type_80_1, ru_start_index_80_1;
2175db19c48SAlok Singh u32 ru_type_80_2, ru_start_index_80_2;
2185db19c48SAlok Singh u32 ru_type_80_3, ru_start_index_80_3;
2195db19c48SAlok Singh u32 ru_size = 0, num_80mhz_with_ru = 0;
2205db19c48SAlok Singh u64 ru_index_320mhz = 0;
2215db19c48SAlok Singh u32 ru_index_per80mhz;
2225db19c48SAlok Singh
2235db19c48SAlok Singh reception_type = le32_get_bits(rx_usr_info->info0,
2245db19c48SAlok Singh HAL_RX_USR_INFO0_RECEPTION_TYPE);
2255db19c48SAlok Singh
2265db19c48SAlok Singh switch (reception_type) {
2275db19c48SAlok Singh case HAL_RECEPTION_TYPE_SU:
2285db19c48SAlok Singh ppdu_info->reception_type = HAL_RX_RECEPTION_TYPE_SU;
2295db19c48SAlok Singh break;
2305db19c48SAlok Singh case HAL_RECEPTION_TYPE_DL_MU_MIMO:
2315db19c48SAlok Singh case HAL_RECEPTION_TYPE_UL_MU_MIMO:
2325db19c48SAlok Singh ppdu_info->reception_type = HAL_RX_RECEPTION_TYPE_MU_MIMO;
2335db19c48SAlok Singh break;
2345db19c48SAlok Singh case HAL_RECEPTION_TYPE_DL_MU_OFMA:
2355db19c48SAlok Singh case HAL_RECEPTION_TYPE_UL_MU_OFDMA:
2365db19c48SAlok Singh ppdu_info->reception_type = HAL_RX_RECEPTION_TYPE_MU_OFDMA;
2375db19c48SAlok Singh break;
2385db19c48SAlok Singh case HAL_RECEPTION_TYPE_DL_MU_OFDMA_MIMO:
2395db19c48SAlok Singh case HAL_RECEPTION_TYPE_UL_MU_OFDMA_MIMO:
2405db19c48SAlok Singh ppdu_info->reception_type = HAL_RX_RECEPTION_TYPE_MU_OFDMA_MIMO;
2415db19c48SAlok Singh }
2425db19c48SAlok Singh
2435db19c48SAlok Singh ppdu_info->is_stbc = le32_get_bits(rx_usr_info->info0, HAL_RX_USR_INFO0_STBC);
2445db19c48SAlok Singh ppdu_info->ldpc = le32_get_bits(rx_usr_info->info2, HAL_RX_USR_INFO2_LDPC);
2455db19c48SAlok Singh ppdu_info->dcm = le32_get_bits(rx_usr_info->info2, HAL_RX_USR_INFO2_STA_DCM);
2465db19c48SAlok Singh ppdu_info->bw = le32_get_bits(rx_usr_info->info1, HAL_RX_USR_INFO1_RX_BW);
2475db19c48SAlok Singh ppdu_info->mcs = le32_get_bits(rx_usr_info->info1, HAL_RX_USR_INFO1_MCS);
2485db19c48SAlok Singh ppdu_info->nss = le32_get_bits(rx_usr_info->info2, HAL_RX_USR_INFO2_NSS) + 1;
2495db19c48SAlok Singh
2505db19c48SAlok Singh if (user_id < HAL_MAX_UL_MU_USERS) {
2515db19c48SAlok Singh mon_rx_user_status = &ppdu_info->userstats[user_id];
2525db19c48SAlok Singh mon_rx_user_status->mcs = ppdu_info->mcs;
2535db19c48SAlok Singh mon_rx_user_status->nss = ppdu_info->nss;
2545db19c48SAlok Singh }
2555db19c48SAlok Singh
2565db19c48SAlok Singh if (!(ppdu_info->reception_type == HAL_RX_RECEPTION_TYPE_MU_MIMO ||
2575db19c48SAlok Singh ppdu_info->reception_type == HAL_RX_RECEPTION_TYPE_MU_OFDMA ||
2585db19c48SAlok Singh ppdu_info->reception_type == HAL_RX_RECEPTION_TYPE_MU_OFDMA_MIMO))
2595db19c48SAlok Singh return;
2605db19c48SAlok Singh
2615db19c48SAlok Singh /* RU allocation present only for OFDMA reception */
2625db19c48SAlok Singh ru_type_80_0 = le32_get_bits(rx_usr_info->info2, HAL_RX_USR_INFO2_RU_TYPE_80_0);
2635db19c48SAlok Singh ru_start_index_80_0 = le32_get_bits(rx_usr_info->info3,
2645db19c48SAlok Singh HAL_RX_USR_INFO3_RU_START_IDX_80_0);
2655db19c48SAlok Singh if (ru_type_80_0 != HAL_EHT_RU_NONE) {
2665db19c48SAlok Singh ru_size += ru_type_80_0;
2675db19c48SAlok Singh ru_index_per80mhz = ru_start_index_80_0;
2685db19c48SAlok Singh ru_index = ru_index_per80mhz;
2695db19c48SAlok Singh ru_index_320mhz |= HAL_RU_PER80(ru_type_80_0, 0, ru_index_per80mhz);
2705db19c48SAlok Singh num_80mhz_with_ru++;
2715db19c48SAlok Singh }
2725db19c48SAlok Singh
2735db19c48SAlok Singh ru_type_80_1 = le32_get_bits(rx_usr_info->info2, HAL_RX_USR_INFO2_RU_TYPE_80_1);
2745db19c48SAlok Singh ru_start_index_80_1 = le32_get_bits(rx_usr_info->info3,
2755db19c48SAlok Singh HAL_RX_USR_INFO3_RU_START_IDX_80_1);
2765db19c48SAlok Singh if (ru_type_80_1 != HAL_EHT_RU_NONE) {
2775db19c48SAlok Singh ru_size += ru_type_80_1;
2785db19c48SAlok Singh ru_index_per80mhz = ru_start_index_80_1;
2795db19c48SAlok Singh ru_index = ru_index_per80mhz;
2805db19c48SAlok Singh ru_index_320mhz |= HAL_RU_PER80(ru_type_80_1, 1, ru_index_per80mhz);
2815db19c48SAlok Singh num_80mhz_with_ru++;
2825db19c48SAlok Singh }
2835db19c48SAlok Singh
2845db19c48SAlok Singh ru_type_80_2 = le32_get_bits(rx_usr_info->info2, HAL_RX_USR_INFO2_RU_TYPE_80_2);
2855db19c48SAlok Singh ru_start_index_80_2 = le32_get_bits(rx_usr_info->info3,
2865db19c48SAlok Singh HAL_RX_USR_INFO3_RU_START_IDX_80_2);
2875db19c48SAlok Singh if (ru_type_80_2 != HAL_EHT_RU_NONE) {
2885db19c48SAlok Singh ru_size += ru_type_80_2;
2895db19c48SAlok Singh ru_index_per80mhz = ru_start_index_80_2;
2905db19c48SAlok Singh ru_index = ru_index_per80mhz;
2915db19c48SAlok Singh ru_index_320mhz |= HAL_RU_PER80(ru_type_80_2, 2, ru_index_per80mhz);
2925db19c48SAlok Singh num_80mhz_with_ru++;
2935db19c48SAlok Singh }
2945db19c48SAlok Singh
2955db19c48SAlok Singh ru_type_80_3 = le32_get_bits(rx_usr_info->info2, HAL_RX_USR_INFO2_RU_TYPE_80_3);
2965db19c48SAlok Singh ru_start_index_80_3 = le32_get_bits(rx_usr_info->info2,
2975db19c48SAlok Singh HAL_RX_USR_INFO3_RU_START_IDX_80_3);
2985db19c48SAlok Singh if (ru_type_80_3 != HAL_EHT_RU_NONE) {
2995db19c48SAlok Singh ru_size += ru_type_80_3;
3005db19c48SAlok Singh ru_index_per80mhz = ru_start_index_80_3;
3015db19c48SAlok Singh ru_index = ru_index_per80mhz;
3025db19c48SAlok Singh ru_index_320mhz |= HAL_RU_PER80(ru_type_80_3, 3, ru_index_per80mhz);
3035db19c48SAlok Singh num_80mhz_with_ru++;
3045db19c48SAlok Singh }
3055db19c48SAlok Singh
3065db19c48SAlok Singh if (num_80mhz_with_ru > 1) {
3075db19c48SAlok Singh /* Calculate the MRU index */
3085db19c48SAlok Singh switch (ru_index_320mhz) {
3095db19c48SAlok Singh case HAL_EHT_RU_996_484_0:
3105db19c48SAlok Singh case HAL_EHT_RU_996x2_484_0:
3115db19c48SAlok Singh case HAL_EHT_RU_996x3_484_0:
3125db19c48SAlok Singh ru_index = 0;
3135db19c48SAlok Singh break;
3145db19c48SAlok Singh case HAL_EHT_RU_996_484_1:
3155db19c48SAlok Singh case HAL_EHT_RU_996x2_484_1:
3165db19c48SAlok Singh case HAL_EHT_RU_996x3_484_1:
3175db19c48SAlok Singh ru_index = 1;
3185db19c48SAlok Singh break;
3195db19c48SAlok Singh case HAL_EHT_RU_996_484_2:
3205db19c48SAlok Singh case HAL_EHT_RU_996x2_484_2:
3215db19c48SAlok Singh case HAL_EHT_RU_996x3_484_2:
3225db19c48SAlok Singh ru_index = 2;
3235db19c48SAlok Singh break;
3245db19c48SAlok Singh case HAL_EHT_RU_996_484_3:
3255db19c48SAlok Singh case HAL_EHT_RU_996x2_484_3:
3265db19c48SAlok Singh case HAL_EHT_RU_996x3_484_3:
3275db19c48SAlok Singh ru_index = 3;
3285db19c48SAlok Singh break;
3295db19c48SAlok Singh case HAL_EHT_RU_996_484_4:
3305db19c48SAlok Singh case HAL_EHT_RU_996x2_484_4:
3315db19c48SAlok Singh case HAL_EHT_RU_996x3_484_4:
3325db19c48SAlok Singh ru_index = 4;
3335db19c48SAlok Singh break;
3345db19c48SAlok Singh case HAL_EHT_RU_996_484_5:
3355db19c48SAlok Singh case HAL_EHT_RU_996x2_484_5:
3365db19c48SAlok Singh case HAL_EHT_RU_996x3_484_5:
3375db19c48SAlok Singh ru_index = 5;
3385db19c48SAlok Singh break;
3395db19c48SAlok Singh case HAL_EHT_RU_996_484_6:
3405db19c48SAlok Singh case HAL_EHT_RU_996x2_484_6:
3415db19c48SAlok Singh case HAL_EHT_RU_996x3_484_6:
3425db19c48SAlok Singh ru_index = 6;
3435db19c48SAlok Singh break;
3445db19c48SAlok Singh case HAL_EHT_RU_996_484_7:
3455db19c48SAlok Singh case HAL_EHT_RU_996x2_484_7:
3465db19c48SAlok Singh case HAL_EHT_RU_996x3_484_7:
3475db19c48SAlok Singh ru_index = 7;
3485db19c48SAlok Singh break;
3495db19c48SAlok Singh case HAL_EHT_RU_996x2_484_8:
3505db19c48SAlok Singh ru_index = 8;
3515db19c48SAlok Singh break;
3525db19c48SAlok Singh case HAL_EHT_RU_996x2_484_9:
3535db19c48SAlok Singh ru_index = 9;
3545db19c48SAlok Singh break;
3555db19c48SAlok Singh case HAL_EHT_RU_996x2_484_10:
3565db19c48SAlok Singh ru_index = 10;
3575db19c48SAlok Singh break;
3585db19c48SAlok Singh case HAL_EHT_RU_996x2_484_11:
3595db19c48SAlok Singh ru_index = 11;
3605db19c48SAlok Singh break;
3615db19c48SAlok Singh default:
3625db19c48SAlok Singh ru_index = HAL_EHT_RU_INVALID;
3635db19c48SAlok Singh break;
3645db19c48SAlok Singh }
3655db19c48SAlok Singh
3665db19c48SAlok Singh ru_size += 4;
3675db19c48SAlok Singh }
3685db19c48SAlok Singh
3695db19c48SAlok Singh rtap_ru_size = hal_rx_mon_hal_ru_size_to_ath12k_ru_size(ru_size);
3705db19c48SAlok Singh if (rtap_ru_size != ATH12K_EHT_RU_INVALID) {
3715db19c48SAlok Singh u32 known, data;
3725db19c48SAlok Singh
3735db19c48SAlok Singh known = __le32_to_cpu(eht->known);
3745db19c48SAlok Singh known |= IEEE80211_RADIOTAP_EHT_KNOWN_RU_MRU_SIZE_OM;
3755db19c48SAlok Singh eht->known = cpu_to_le32(known);
3765db19c48SAlok Singh
3775db19c48SAlok Singh data = __le32_to_cpu(eht->data[1]);
3785db19c48SAlok Singh data |= u32_encode_bits(rtap_ru_size,
3795db19c48SAlok Singh IEEE80211_RADIOTAP_EHT_DATA1_RU_SIZE);
3805db19c48SAlok Singh eht->data[1] = cpu_to_le32(data);
3815db19c48SAlok Singh }
3825db19c48SAlok Singh
3835db19c48SAlok Singh if (ru_index != HAL_EHT_RU_INVALID) {
3845db19c48SAlok Singh u32 known, data;
3855db19c48SAlok Singh
3865db19c48SAlok Singh known = __le32_to_cpu(eht->known);
3875db19c48SAlok Singh known |= IEEE80211_RADIOTAP_EHT_KNOWN_RU_MRU_INDEX_OM;
3885db19c48SAlok Singh eht->known = cpu_to_le32(known);
3895db19c48SAlok Singh
3905db19c48SAlok Singh data = __le32_to_cpu(eht->data[1]);
3915db19c48SAlok Singh data |= u32_encode_bits(rtap_ru_size,
3925db19c48SAlok Singh IEEE80211_RADIOTAP_EHT_DATA1_RU_INDEX);
3935db19c48SAlok Singh eht->data[1] = cpu_to_le32(data);
3945db19c48SAlok Singh }
3955db19c48SAlok Singh
3965db19c48SAlok Singh if (mon_rx_user_status && ru_index != HAL_EHT_RU_INVALID &&
3975db19c48SAlok Singh rtap_ru_size != ATH12K_EHT_RU_INVALID) {
3985db19c48SAlok Singh mon_rx_user_status->ul_ofdma_ru_start_index = ru_index;
3995db19c48SAlok Singh mon_rx_user_status->ul_ofdma_ru_size = rtap_ru_size;
4005db19c48SAlok Singh
4015db19c48SAlok Singh ru_width = hal_rx_ul_ofdma_ru_size_to_width(rtap_ru_size);
4025db19c48SAlok Singh
4035db19c48SAlok Singh mon_rx_user_status->ul_ofdma_ru_width = ru_width;
4045db19c48SAlok Singh mon_rx_user_status->ofdma_info_valid = 1;
4055db19c48SAlok Singh }
4065db19c48SAlok Singh }
4075db19c48SAlok Singh
4085db19c48SAlok Singh static void
ath12k_wifi7_dp_mon_parse_l_sig_b(const struct hal_rx_lsig_b_info * lsigb,struct hal_rx_mon_ppdu_info * ppdu_info)409e5419861SAlok Singh ath12k_wifi7_dp_mon_parse_l_sig_b(const struct hal_rx_lsig_b_info *lsigb,
410e5419861SAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
411e5419861SAlok Singh {
412e5419861SAlok Singh u32 info0 = __le32_to_cpu(lsigb->info0);
413e5419861SAlok Singh u8 rate;
414e5419861SAlok Singh
415e5419861SAlok Singh rate = u32_get_bits(info0, HAL_RX_LSIG_B_INFO_INFO0_RATE);
416e5419861SAlok Singh switch (rate) {
417e5419861SAlok Singh case 1:
418e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_1_MBPS;
419e5419861SAlok Singh break;
420e5419861SAlok Singh case 2:
421e5419861SAlok Singh case 5:
422e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_2_MBPS;
423e5419861SAlok Singh break;
424e5419861SAlok Singh case 3:
425e5419861SAlok Singh case 6:
426e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_5_5_MBPS;
427e5419861SAlok Singh break;
428e5419861SAlok Singh case 4:
429e5419861SAlok Singh case 7:
430e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_11_MBPS;
431e5419861SAlok Singh break;
432e5419861SAlok Singh default:
433e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_INVALID;
434e5419861SAlok Singh }
435e5419861SAlok Singh
436e5419861SAlok Singh ppdu_info->rate = rate;
437e5419861SAlok Singh ppdu_info->cck_flag = 1;
438e5419861SAlok Singh }
439e5419861SAlok Singh
440e5419861SAlok Singh static void
ath12k_wifi7_dp_mon_parse_l_sig_a(const struct hal_rx_lsig_a_info * lsiga,struct hal_rx_mon_ppdu_info * ppdu_info)441e5419861SAlok Singh ath12k_wifi7_dp_mon_parse_l_sig_a(const struct hal_rx_lsig_a_info *lsiga,
442e5419861SAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
443e5419861SAlok Singh {
444e5419861SAlok Singh u32 info0 = __le32_to_cpu(lsiga->info0);
445e5419861SAlok Singh u8 rate;
446e5419861SAlok Singh
447e5419861SAlok Singh rate = u32_get_bits(info0, HAL_RX_LSIG_A_INFO_INFO0_RATE);
448e5419861SAlok Singh switch (rate) {
449e5419861SAlok Singh case 8:
450e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_48_MBPS;
451e5419861SAlok Singh break;
452e5419861SAlok Singh case 9:
453e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_24_MBPS;
454e5419861SAlok Singh break;
455e5419861SAlok Singh case 10:
456e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_12_MBPS;
457e5419861SAlok Singh break;
458e5419861SAlok Singh case 11:
459e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_6_MBPS;
460e5419861SAlok Singh break;
461e5419861SAlok Singh case 12:
462e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_54_MBPS;
463e5419861SAlok Singh break;
464e5419861SAlok Singh case 13:
465e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_36_MBPS;
466e5419861SAlok Singh break;
467e5419861SAlok Singh case 14:
468e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_18_MBPS;
469e5419861SAlok Singh break;
470e5419861SAlok Singh case 15:
471e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_9_MBPS;
472e5419861SAlok Singh break;
473e5419861SAlok Singh default:
474e5419861SAlok Singh rate = HAL_RX_LEGACY_RATE_INVALID;
475e5419861SAlok Singh }
476e5419861SAlok Singh
477e5419861SAlok Singh ppdu_info->rate = rate;
478e5419861SAlok Singh }
479e5419861SAlok Singh
480e5419861SAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_cmn(const struct hal_mon_usig_cmn * cmn,struct hal_rx_mon_ppdu_info * ppdu_info)481e5419861SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_cmn(const struct hal_mon_usig_cmn *cmn,
482e5419861SAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
483e5419861SAlok Singh {
484e5419861SAlok Singh u32 common;
485e5419861SAlok Singh
486e5419861SAlok Singh ppdu_info->u_sig_info.bw = le32_get_bits(cmn->info0,
487e5419861SAlok Singh HAL_RX_USIG_CMN_INFO0_BW);
488e5419861SAlok Singh ppdu_info->u_sig_info.ul_dl = le32_get_bits(cmn->info0,
489e5419861SAlok Singh HAL_RX_USIG_CMN_INFO0_UL_DL);
490e5419861SAlok Singh
491e5419861SAlok Singh common = __le32_to_cpu(ppdu_info->u_sig_info.usig.common);
492e5419861SAlok Singh common |= IEEE80211_RADIOTAP_EHT_USIG_COMMON_PHY_VER_KNOWN |
493e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_BW_KNOWN |
494e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_UL_DL_KNOWN |
495e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_BSS_COLOR_KNOWN |
496e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_TXOP_KNOWN |
497e5419861SAlok Singh ATH12K_LE32_DEC_ENC(cmn->info0,
498e5419861SAlok Singh HAL_RX_USIG_CMN_INFO0_PHY_VERSION,
499e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_PHY_VER) |
500e5419861SAlok Singh u32_encode_bits(ppdu_info->u_sig_info.bw,
501e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_BW) |
502e5419861SAlok Singh u32_encode_bits(ppdu_info->u_sig_info.ul_dl,
503e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_UL_DL) |
504e5419861SAlok Singh ATH12K_LE32_DEC_ENC(cmn->info0,
505e5419861SAlok Singh HAL_RX_USIG_CMN_INFO0_BSS_COLOR,
506e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_BSS_COLOR) |
507e5419861SAlok Singh ATH12K_LE32_DEC_ENC(cmn->info0,
508e5419861SAlok Singh HAL_RX_USIG_CMN_INFO0_TXOP,
509e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_TXOP);
510e5419861SAlok Singh ppdu_info->u_sig_info.usig.common = cpu_to_le32(common);
511e5419861SAlok Singh
512e5419861SAlok Singh switch (ppdu_info->u_sig_info.bw) {
513e5419861SAlok Singh default:
514e5419861SAlok Singh fallthrough;
515e5419861SAlok Singh case HAL_EHT_BW_20:
516e5419861SAlok Singh ppdu_info->bw = HAL_RX_BW_20MHZ;
517e5419861SAlok Singh break;
518e5419861SAlok Singh case HAL_EHT_BW_40:
519e5419861SAlok Singh ppdu_info->bw = HAL_RX_BW_40MHZ;
520e5419861SAlok Singh break;
521e5419861SAlok Singh case HAL_EHT_BW_80:
522e5419861SAlok Singh ppdu_info->bw = HAL_RX_BW_80MHZ;
523e5419861SAlok Singh break;
524e5419861SAlok Singh case HAL_EHT_BW_160:
525e5419861SAlok Singh ppdu_info->bw = HAL_RX_BW_160MHZ;
526e5419861SAlok Singh break;
527e5419861SAlok Singh case HAL_EHT_BW_320_1:
528e5419861SAlok Singh case HAL_EHT_BW_320_2:
529e5419861SAlok Singh ppdu_info->bw = HAL_RX_BW_320MHZ;
530e5419861SAlok Singh break;
531e5419861SAlok Singh }
532e5419861SAlok Singh }
533e5419861SAlok Singh
534e5419861SAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_tb(const struct hal_mon_usig_tb * usig_tb,struct hal_rx_mon_ppdu_info * ppdu_info)535e5419861SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_tb(const struct hal_mon_usig_tb *usig_tb,
536e5419861SAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
537e5419861SAlok Singh {
538e5419861SAlok Singh struct ieee80211_radiotap_eht_usig *usig = &ppdu_info->u_sig_info.usig;
539e5419861SAlok Singh enum ieee80211_radiotap_eht_usig_tb spatial_reuse1, spatial_reuse2;
540e5419861SAlok Singh u32 common, value, mask;
541e5419861SAlok Singh
542e5419861SAlok Singh spatial_reuse1 = IEEE80211_RADIOTAP_EHT_USIG2_TB_B3_B6_SPATIAL_REUSE_1;
543e5419861SAlok Singh spatial_reuse2 = IEEE80211_RADIOTAP_EHT_USIG2_TB_B7_B10_SPATIAL_REUSE_2;
544e5419861SAlok Singh
545e5419861SAlok Singh common = __le32_to_cpu(usig->common);
546e5419861SAlok Singh value = __le32_to_cpu(usig->value);
547e5419861SAlok Singh mask = __le32_to_cpu(usig->mask);
548e5419861SAlok Singh
549e5419861SAlok Singh ppdu_info->u_sig_info.ppdu_type_comp_mode =
550e5419861SAlok Singh le32_get_bits(usig_tb->info0,
551e5419861SAlok Singh HAL_RX_USIG_TB_INFO0_PPDU_TYPE_COMP_MODE);
552e5419861SAlok Singh
553e5419861SAlok Singh common |= ATH12K_LE32_DEC_ENC(usig_tb->info0,
554e5419861SAlok Singh HAL_RX_USIG_TB_INFO0_RX_INTEG_CHECK_PASS,
555e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_BAD_USIG_CRC);
556e5419861SAlok Singh
557e5419861SAlok Singh value |= IEEE80211_RADIOTAP_EHT_USIG1_TB_B20_B25_DISREGARD |
558e5419861SAlok Singh u32_encode_bits(ppdu_info->u_sig_info.ppdu_type_comp_mode,
559e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B0_B1_PPDU_TYPE) |
560e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B2_VALIDATE |
561e5419861SAlok Singh ATH12K_LE32_DEC_ENC(usig_tb->info0,
562e5419861SAlok Singh HAL_RX_USIG_TB_INFO0_SPATIAL_REUSE_1,
563e5419861SAlok Singh spatial_reuse1) |
564e5419861SAlok Singh ATH12K_LE32_DEC_ENC(usig_tb->info0,
565e5419861SAlok Singh HAL_RX_USIG_TB_INFO0_SPATIAL_REUSE_2,
566e5419861SAlok Singh spatial_reuse2) |
567e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B11_B15_DISREGARD |
568e5419861SAlok Singh ATH12K_LE32_DEC_ENC(usig_tb->info0,
569e5419861SAlok Singh HAL_RX_USIG_TB_INFO0_CRC,
570e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B16_B19_CRC) |
571e5419861SAlok Singh ATH12K_LE32_DEC_ENC(usig_tb->info0,
572e5419861SAlok Singh HAL_RX_USIG_TB_INFO0_TAIL,
573e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B20_B25_TAIL);
574e5419861SAlok Singh
575e5419861SAlok Singh mask |= IEEE80211_RADIOTAP_EHT_USIG1_TB_B20_B25_DISREGARD |
576e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B0_B1_PPDU_TYPE |
577e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B2_VALIDATE |
578e5419861SAlok Singh spatial_reuse1 | spatial_reuse2 |
579e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B11_B15_DISREGARD |
580e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B16_B19_CRC |
581e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_TB_B20_B25_TAIL;
582e5419861SAlok Singh
583e5419861SAlok Singh usig->common = cpu_to_le32(common);
584e5419861SAlok Singh usig->value = cpu_to_le32(value);
585e5419861SAlok Singh usig->mask = cpu_to_le32(mask);
586e5419861SAlok Singh }
587e5419861SAlok Singh
588e5419861SAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_mu(const struct hal_mon_usig_mu * usig_mu,struct hal_rx_mon_ppdu_info * ppdu_info)589e5419861SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_mu(const struct hal_mon_usig_mu *usig_mu,
590e5419861SAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
591e5419861SAlok Singh {
592e5419861SAlok Singh struct ieee80211_radiotap_eht_usig *usig = &ppdu_info->u_sig_info.usig;
593e5419861SAlok Singh enum ieee80211_radiotap_eht_usig_mu sig_symb, punc;
594e5419861SAlok Singh u32 common, value, mask;
595e5419861SAlok Singh
596e5419861SAlok Singh sig_symb = IEEE80211_RADIOTAP_EHT_USIG2_MU_B11_B15_EHT_SIG_SYMBOLS;
597e5419861SAlok Singh punc = IEEE80211_RADIOTAP_EHT_USIG2_MU_B3_B7_PUNCTURED_INFO;
598e5419861SAlok Singh
599e5419861SAlok Singh common = __le32_to_cpu(usig->common);
600e5419861SAlok Singh value = __le32_to_cpu(usig->value);
601e5419861SAlok Singh mask = __le32_to_cpu(usig->mask);
602e5419861SAlok Singh
603e5419861SAlok Singh ppdu_info->u_sig_info.ppdu_type_comp_mode =
604e5419861SAlok Singh le32_get_bits(usig_mu->info0,
605e5419861SAlok Singh HAL_RX_USIG_MU_INFO0_PPDU_TYPE_COMP_MODE);
606e5419861SAlok Singh ppdu_info->u_sig_info.eht_sig_mcs =
607e5419861SAlok Singh le32_get_bits(usig_mu->info0,
608e5419861SAlok Singh HAL_RX_USIG_MU_INFO0_EHT_SIG_MCS);
609e5419861SAlok Singh ppdu_info->u_sig_info.num_eht_sig_sym =
610e5419861SAlok Singh le32_get_bits(usig_mu->info0,
611e5419861SAlok Singh HAL_RX_USIG_MU_INFO0_NUM_EHT_SIG_SYM);
612e5419861SAlok Singh
613e5419861SAlok Singh common |= ATH12K_LE32_DEC_ENC(usig_mu->info0,
614e5419861SAlok Singh HAL_RX_USIG_MU_INFO0_RX_INTEG_CHECK_PASS,
615e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG_COMMON_BAD_USIG_CRC);
616e5419861SAlok Singh
617e5419861SAlok Singh value |= IEEE80211_RADIOTAP_EHT_USIG1_MU_B20_B24_DISREGARD |
618e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG1_MU_B25_VALIDATE |
619e5419861SAlok Singh u32_encode_bits(ppdu_info->u_sig_info.ppdu_type_comp_mode,
620e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B0_B1_PPDU_TYPE) |
621e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B2_VALIDATE |
622e5419861SAlok Singh ATH12K_LE32_DEC_ENC(usig_mu->info0,
623e5419861SAlok Singh HAL_RX_USIG_MU_INFO0_PUNC_CH_INFO,
624e5419861SAlok Singh punc) |
625e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B8_VALIDATE |
626e5419861SAlok Singh u32_encode_bits(ppdu_info->u_sig_info.eht_sig_mcs,
627e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B9_B10_SIG_MCS) |
628e5419861SAlok Singh u32_encode_bits(ppdu_info->u_sig_info.num_eht_sig_sym,
629e5419861SAlok Singh sig_symb) |
630e5419861SAlok Singh ATH12K_LE32_DEC_ENC(usig_mu->info0,
631e5419861SAlok Singh HAL_RX_USIG_MU_INFO0_CRC,
632e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B16_B19_CRC) |
633e5419861SAlok Singh ATH12K_LE32_DEC_ENC(usig_mu->info0,
634e5419861SAlok Singh HAL_RX_USIG_MU_INFO0_TAIL,
635e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B20_B25_TAIL);
636e5419861SAlok Singh
637e5419861SAlok Singh mask |= IEEE80211_RADIOTAP_EHT_USIG1_MU_B20_B24_DISREGARD |
638e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG1_MU_B25_VALIDATE |
639e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B0_B1_PPDU_TYPE |
640e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B2_VALIDATE |
641e5419861SAlok Singh punc |
642e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B8_VALIDATE |
643e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B9_B10_SIG_MCS |
644e5419861SAlok Singh sig_symb |
645e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B16_B19_CRC |
646e5419861SAlok Singh IEEE80211_RADIOTAP_EHT_USIG2_MU_B20_B25_TAIL;
647e5419861SAlok Singh
648e5419861SAlok Singh usig->common = cpu_to_le32(common);
649e5419861SAlok Singh usig->value = cpu_to_le32(value);
650e5419861SAlok Singh usig->mask = cpu_to_le32(mask);
651e5419861SAlok Singh }
652e5419861SAlok Singh
653e5419861SAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_hdr(const struct hal_mon_usig_hdr * usig,struct hal_rx_mon_ppdu_info * ppdu_info)654e5419861SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_hdr(const struct hal_mon_usig_hdr *usig,
655e5419861SAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
656e5419861SAlok Singh {
657e5419861SAlok Singh u8 comp_mode;
658e5419861SAlok Singh
659e5419861SAlok Singh ppdu_info->eht_usig = true;
660e5419861SAlok Singh
661e5419861SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_cmn(&usig->cmn, ppdu_info);
662e5419861SAlok Singh
663e5419861SAlok Singh comp_mode = le32_get_bits(usig->non_cmn.mu.info0,
664e5419861SAlok Singh HAL_RX_USIG_MU_INFO0_PPDU_TYPE_COMP_MODE);
665e5419861SAlok Singh
666e5419861SAlok Singh if (comp_mode == 0 && ppdu_info->u_sig_info.ul_dl)
667e5419861SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_tb(&usig->non_cmn.tb, ppdu_info);
668e5419861SAlok Singh else
669e5419861SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_mu(&usig->non_cmn.mu, ppdu_info);
670e5419861SAlok Singh }
671e5419861SAlok Singh
672e5419861SAlok Singh static void
ath12k_wifi7_dp_mon_parse_vht_sig_a(const struct hal_rx_vht_sig_a_info * vht_sig,struct hal_rx_mon_ppdu_info * ppdu_info)673f4bcbaebSAlok Singh ath12k_wifi7_dp_mon_parse_vht_sig_a(const struct hal_rx_vht_sig_a_info *vht_sig,
674f4bcbaebSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
675f4bcbaebSAlok Singh {
676f4bcbaebSAlok Singh u32 nsts, info0, info1;
677f4bcbaebSAlok Singh u8 gi_setting;
678f4bcbaebSAlok Singh
679f4bcbaebSAlok Singh info0 = __le32_to_cpu(vht_sig->info0);
680f4bcbaebSAlok Singh info1 = __le32_to_cpu(vht_sig->info1);
681f4bcbaebSAlok Singh
682f4bcbaebSAlok Singh ppdu_info->ldpc = u32_get_bits(info1, HAL_RX_VHT_SIG_A_INFO_INFO1_SU_MU_CODING);
683f4bcbaebSAlok Singh ppdu_info->mcs = u32_get_bits(info1, HAL_RX_VHT_SIG_A_INFO_INFO1_MCS);
684f4bcbaebSAlok Singh gi_setting = u32_get_bits(info1, HAL_RX_VHT_SIG_A_INFO_INFO1_GI_SETTING);
685f4bcbaebSAlok Singh switch (gi_setting) {
686f4bcbaebSAlok Singh case HAL_RX_VHT_SIG_A_NORMAL_GI:
687f4bcbaebSAlok Singh ppdu_info->gi = HAL_RX_GI_0_8_US;
688f4bcbaebSAlok Singh break;
689f4bcbaebSAlok Singh case HAL_RX_VHT_SIG_A_SHORT_GI:
690f4bcbaebSAlok Singh case HAL_RX_VHT_SIG_A_SHORT_GI_AMBIGUITY:
691f4bcbaebSAlok Singh ppdu_info->gi = HAL_RX_GI_0_4_US;
692f4bcbaebSAlok Singh break;
693f4bcbaebSAlok Singh }
694f4bcbaebSAlok Singh
695f4bcbaebSAlok Singh ppdu_info->is_stbc = u32_get_bits(info0, HAL_RX_VHT_SIG_A_INFO_INFO0_STBC);
696f4bcbaebSAlok Singh nsts = u32_get_bits(info0, HAL_RX_VHT_SIG_A_INFO_INFO0_NSTS);
697f4bcbaebSAlok Singh if (ppdu_info->is_stbc && nsts > 0)
698f4bcbaebSAlok Singh nsts = ((nsts + 1) >> 1) - 1;
699f4bcbaebSAlok Singh
700631ee338SJeff Johnson ppdu_info->nss = u32_get_bits(nsts, VHT_SIG_SU_NSS_MASK) + 1;
701f4bcbaebSAlok Singh ppdu_info->bw = u32_get_bits(info0, HAL_RX_VHT_SIG_A_INFO_INFO0_BW);
702f4bcbaebSAlok Singh ppdu_info->beamformed = u32_get_bits(info1,
703f4bcbaebSAlok Singh HAL_RX_VHT_SIG_A_INFO_INFO1_BEAMFORMED);
704f4bcbaebSAlok Singh ppdu_info->vht_flag_values5 = u32_get_bits(info0,
705f4bcbaebSAlok Singh HAL_RX_VHT_SIG_A_INFO_INFO0_GROUP_ID);
706f4bcbaebSAlok Singh ppdu_info->vht_flag_values3[0] = (((ppdu_info->mcs) << 4) |
707f4bcbaebSAlok Singh ppdu_info->nss);
708f4bcbaebSAlok Singh ppdu_info->vht_flag_values2 = ppdu_info->bw;
709f4bcbaebSAlok Singh ppdu_info->vht_flag_values4 =
710f4bcbaebSAlok Singh u32_get_bits(info1, HAL_RX_VHT_SIG_A_INFO_INFO1_SU_MU_CODING);
711f4bcbaebSAlok Singh }
712f4bcbaebSAlok Singh
713f4bcbaebSAlok Singh static void
ath12k_wifi7_dp_mon_parse_ht_sig(const struct hal_rx_ht_sig_info * ht_sig,struct hal_rx_mon_ppdu_info * ppdu_info)714f4bcbaebSAlok Singh ath12k_wifi7_dp_mon_parse_ht_sig(const struct hal_rx_ht_sig_info *ht_sig,
715f4bcbaebSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
716f4bcbaebSAlok Singh {
717f4bcbaebSAlok Singh u32 info0 = __le32_to_cpu(ht_sig->info0);
718f4bcbaebSAlok Singh u32 info1 = __le32_to_cpu(ht_sig->info1);
719f4bcbaebSAlok Singh
720f4bcbaebSAlok Singh ppdu_info->mcs = u32_get_bits(info0, HAL_RX_HT_SIG_INFO_INFO0_MCS);
721f4bcbaebSAlok Singh ppdu_info->bw = u32_get_bits(info0, HAL_RX_HT_SIG_INFO_INFO0_BW);
722f4bcbaebSAlok Singh ppdu_info->is_stbc = u32_get_bits(info1, HAL_RX_HT_SIG_INFO_INFO1_STBC);
723f4bcbaebSAlok Singh ppdu_info->ldpc = u32_get_bits(info1, HAL_RX_HT_SIG_INFO_INFO1_FEC_CODING);
724f4bcbaebSAlok Singh ppdu_info->gi = u32_get_bits(info1, HAL_RX_HT_SIG_INFO_INFO1_GI);
725631ee338SJeff Johnson ppdu_info->nss = (ppdu_info->mcs >> 3) + 1;
726f4bcbaebSAlok Singh }
727f4bcbaebSAlok Singh
728dde5748cSAlok Singh static void
ath12k_wifi7_dp_mon_parse_he_sig_b2_ofdma(const struct hal_rx_he_sig_b2_ofdma_info * ofdma,struct hal_rx_mon_ppdu_info * ppdu_info)729dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_b2_ofdma(const struct hal_rx_he_sig_b2_ofdma_info *ofdma,
730dde5748cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
731dde5748cSAlok Singh {
732dde5748cSAlok Singh u32 info0, value;
733dde5748cSAlok Singh
734dde5748cSAlok Singh info0 = __le32_to_cpu(ofdma->info0);
735dde5748cSAlok Singh
736dde5748cSAlok Singh ppdu_info->he_data1 |= HE_MCS_KNOWN | HE_DCM_KNOWN | HE_CODING_KNOWN;
737dde5748cSAlok Singh
738dde5748cSAlok Singh /* HE-data2 */
739dde5748cSAlok Singh ppdu_info->he_data2 |= HE_TXBF_KNOWN;
740dde5748cSAlok Singh
741dde5748cSAlok Singh ppdu_info->mcs = u32_get_bits(info0, HAL_RX_HE_SIG_B2_OFDMA_INFO_INFO0_STA_MCS);
742dde5748cSAlok Singh value = ppdu_info->mcs << HE_TRANSMIT_MCS_SHIFT;
743dde5748cSAlok Singh ppdu_info->he_data3 |= value;
744dde5748cSAlok Singh
745dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_B2_OFDMA_INFO_INFO0_STA_DCM);
746dde5748cSAlok Singh value = value << HE_DCM_SHIFT;
747dde5748cSAlok Singh ppdu_info->he_data3 |= value;
748dde5748cSAlok Singh
749dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_B2_OFDMA_INFO_INFO0_STA_CODING);
750dde5748cSAlok Singh ppdu_info->ldpc = value;
751dde5748cSAlok Singh value = value << HE_CODING_SHIFT;
752dde5748cSAlok Singh ppdu_info->he_data3 |= value;
753dde5748cSAlok Singh
754dde5748cSAlok Singh /* HE-data4 */
755dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_B2_OFDMA_INFO_INFO0_STA_ID);
756dde5748cSAlok Singh value = value << HE_STA_ID_SHIFT;
757dde5748cSAlok Singh ppdu_info->he_data4 |= value;
758dde5748cSAlok Singh
759631ee338SJeff Johnson ppdu_info->nss =
760631ee338SJeff Johnson u32_get_bits(info0,
761631ee338SJeff Johnson HAL_RX_HE_SIG_B2_OFDMA_INFO_INFO0_STA_NSTS) + 1;
762dde5748cSAlok Singh ppdu_info->beamformed = u32_get_bits(info0,
763dde5748cSAlok Singh HAL_RX_HE_SIG_B2_OFDMA_INFO_INFO0_STA_TXBF);
764dde5748cSAlok Singh }
765dde5748cSAlok Singh
766dde5748cSAlok Singh static void
ath12k_wifi7_dp_mon_parse_he_sig_b2_mu(const struct hal_rx_he_sig_b2_mu_info * he_sig_b2_mu,struct hal_rx_mon_ppdu_info * ppdu_info)767dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_b2_mu(const struct hal_rx_he_sig_b2_mu_info *he_sig_b2_mu,
768dde5748cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
769dde5748cSAlok Singh {
770dde5748cSAlok Singh u32 info0, value;
771dde5748cSAlok Singh
772dde5748cSAlok Singh info0 = __le32_to_cpu(he_sig_b2_mu->info0);
773dde5748cSAlok Singh
774dde5748cSAlok Singh ppdu_info->he_data1 |= HE_MCS_KNOWN | HE_CODING_KNOWN;
775dde5748cSAlok Singh
776dde5748cSAlok Singh ppdu_info->mcs = u32_get_bits(info0, HAL_RX_HE_SIG_B2_MU_INFO_INFO0_STA_MCS);
777dde5748cSAlok Singh value = ppdu_info->mcs << HE_TRANSMIT_MCS_SHIFT;
778dde5748cSAlok Singh ppdu_info->he_data3 |= value;
779dde5748cSAlok Singh
780dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_B2_MU_INFO_INFO0_STA_CODING);
781dde5748cSAlok Singh ppdu_info->ldpc = value;
782dde5748cSAlok Singh value = value << HE_CODING_SHIFT;
783dde5748cSAlok Singh ppdu_info->he_data3 |= value;
784dde5748cSAlok Singh
785dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_B2_MU_INFO_INFO0_STA_ID);
786dde5748cSAlok Singh value = value << HE_STA_ID_SHIFT;
787dde5748cSAlok Singh ppdu_info->he_data4 |= value;
788dde5748cSAlok Singh
789631ee338SJeff Johnson ppdu_info->nss =
790631ee338SJeff Johnson u32_get_bits(info0,
791631ee338SJeff Johnson HAL_RX_HE_SIG_B2_MU_INFO_INFO0_STA_NSTS) + 1;
792dde5748cSAlok Singh }
793dde5748cSAlok Singh
794dde5748cSAlok Singh static void
ath12k_wifi7_dp_mon_parse_he_sig_b1_mu(const struct hal_rx_he_sig_b1_mu_info * he_sig_b1_mu,struct hal_rx_mon_ppdu_info * ppdu_info)795dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_b1_mu(const struct hal_rx_he_sig_b1_mu_info *he_sig_b1_mu,
796dde5748cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
797dde5748cSAlok Singh {
798dde5748cSAlok Singh u32 info0 = __le32_to_cpu(he_sig_b1_mu->info0);
799dde5748cSAlok Singh u16 ru_tones;
800dde5748cSAlok Singh
801dde5748cSAlok Singh ru_tones = u32_get_bits(info0,
802dde5748cSAlok Singh HAL_RX_HE_SIG_B1_MU_INFO_INFO0_RU_ALLOCATION);
803dde5748cSAlok Singh ppdu_info->ru_alloc = ath12k_he_ru_tones_to_nl80211_he_ru_alloc(ru_tones);
804dde5748cSAlok Singh ppdu_info->he_RU[0] = ru_tones;
805dde5748cSAlok Singh }
806dde5748cSAlok Singh
807dde5748cSAlok Singh static void
ath12k_wifi7_dp_mon_parse_he_sig_mu(const struct hal_rx_he_sig_a_mu_dl_info * he_sig_a_mu_dl,struct hal_rx_mon_ppdu_info * ppdu_info)808dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_mu(const struct hal_rx_he_sig_a_mu_dl_info *he_sig_a_mu_dl,
809dde5748cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
810dde5748cSAlok Singh {
811dde5748cSAlok Singh u32 info0, info1, value;
812dde5748cSAlok Singh u16 he_gi = 0, he_ltf = 0;
813dde5748cSAlok Singh
814dde5748cSAlok Singh info0 = __le32_to_cpu(he_sig_a_mu_dl->info0);
815dde5748cSAlok Singh info1 = __le32_to_cpu(he_sig_a_mu_dl->info1);
816dde5748cSAlok Singh
817dde5748cSAlok Singh ppdu_info->he_mu_flags = 1;
818dde5748cSAlok Singh
819dde5748cSAlok Singh ppdu_info->he_data1 = HE_MU_FORMAT_TYPE;
820dde5748cSAlok Singh ppdu_info->he_data1 |=
821dde5748cSAlok Singh HE_BSS_COLOR_KNOWN |
822dde5748cSAlok Singh HE_DL_UL_KNOWN |
823dde5748cSAlok Singh HE_LDPC_EXTRA_SYMBOL_KNOWN |
824dde5748cSAlok Singh HE_STBC_KNOWN |
825dde5748cSAlok Singh HE_DATA_BW_RU_KNOWN |
826dde5748cSAlok Singh HE_DOPPLER_KNOWN;
827dde5748cSAlok Singh
828dde5748cSAlok Singh ppdu_info->he_data2 =
829dde5748cSAlok Singh HE_GI_KNOWN |
830dde5748cSAlok Singh HE_LTF_SYMBOLS_KNOWN |
831dde5748cSAlok Singh HE_PRE_FEC_PADDING_KNOWN |
832dde5748cSAlok Singh HE_PE_DISAMBIGUITY_KNOWN |
833dde5748cSAlok Singh HE_TXOP_KNOWN |
834dde5748cSAlok Singh HE_MIDABLE_PERIODICITY_KNOWN;
835dde5748cSAlok Singh
836dde5748cSAlok Singh /* data3 */
837dde5748cSAlok Singh ppdu_info->he_data3 = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_BSS_COLOR);
838dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_UL_FLAG);
839dde5748cSAlok Singh value = value << HE_DL_UL_SHIFT;
840dde5748cSAlok Singh ppdu_info->he_data3 |= value;
841dde5748cSAlok Singh
842dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_MU_DL_INFO1_LDPC_EXTRA);
843dde5748cSAlok Singh value = value << HE_LDPC_EXTRA_SYMBOL_SHIFT;
844dde5748cSAlok Singh ppdu_info->he_data3 |= value;
845dde5748cSAlok Singh
846dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_MU_DL_INFO1_STBC);
847dde5748cSAlok Singh value = value << HE_STBC_SHIFT;
848dde5748cSAlok Singh ppdu_info->he_data3 |= value;
849dde5748cSAlok Singh
850dde5748cSAlok Singh /* data4 */
851dde5748cSAlok Singh ppdu_info->he_data4 = u32_get_bits(info0,
852dde5748cSAlok Singh HAL_RX_HE_SIG_A_MU_DL_INFO0_SPATIAL_REUSE);
853dde5748cSAlok Singh ppdu_info->he_data4 = value;
854dde5748cSAlok Singh
855dde5748cSAlok Singh /* data5 */
856dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_TRANSMIT_BW);
857dde5748cSAlok Singh ppdu_info->he_data5 = value;
858dde5748cSAlok Singh ppdu_info->bw = value;
859dde5748cSAlok Singh
860dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_CP_LTF_SIZE);
861dde5748cSAlok Singh switch (value) {
862dde5748cSAlok Singh case 0:
863dde5748cSAlok Singh he_gi = HE_GI_0_8;
864dde5748cSAlok Singh he_ltf = HE_LTF_4_X;
865dde5748cSAlok Singh break;
866dde5748cSAlok Singh case 1:
867dde5748cSAlok Singh he_gi = HE_GI_0_8;
868dde5748cSAlok Singh he_ltf = HE_LTF_2_X;
869dde5748cSAlok Singh break;
870dde5748cSAlok Singh case 2:
871dde5748cSAlok Singh he_gi = HE_GI_1_6;
872dde5748cSAlok Singh he_ltf = HE_LTF_2_X;
873dde5748cSAlok Singh break;
874dde5748cSAlok Singh case 3:
875dde5748cSAlok Singh he_gi = HE_GI_3_2;
876dde5748cSAlok Singh he_ltf = HE_LTF_4_X;
877dde5748cSAlok Singh break;
878dde5748cSAlok Singh }
879dde5748cSAlok Singh
880dde5748cSAlok Singh ppdu_info->gi = he_gi;
881dde5748cSAlok Singh value = he_gi << HE_GI_SHIFT;
882dde5748cSAlok Singh ppdu_info->he_data5 |= value;
883dde5748cSAlok Singh
884dde5748cSAlok Singh value = he_ltf << HE_LTF_SIZE_SHIFT;
885dde5748cSAlok Singh ppdu_info->he_data5 |= value;
886dde5748cSAlok Singh
887dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_MU_DL_INFO1_NUM_LTF_SYMB);
888dde5748cSAlok Singh value = (value << HE_LTF_SYM_SHIFT);
889dde5748cSAlok Singh ppdu_info->he_data5 |= value;
890dde5748cSAlok Singh
891dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_MU_DL_INFO1_PKT_EXT_FACTOR);
892dde5748cSAlok Singh value = value << HE_PRE_FEC_PAD_SHIFT;
893dde5748cSAlok Singh ppdu_info->he_data5 |= value;
894dde5748cSAlok Singh
895dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_MU_DL_INFO1_PKT_EXT_PE_DISAM);
896dde5748cSAlok Singh value = value << HE_PE_DISAMBIGUITY_SHIFT;
897dde5748cSAlok Singh ppdu_info->he_data5 |= value;
898dde5748cSAlok Singh
899dde5748cSAlok Singh /*data6*/
900dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_DOPPLER_INDICATION);
901dde5748cSAlok Singh value = value << HE_DOPPLER_SHIFT;
902dde5748cSAlok Singh ppdu_info->he_data6 |= value;
903dde5748cSAlok Singh
904dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_MU_DL_INFO1_TXOP_DURATION);
905dde5748cSAlok Singh value = value << HE_TXOP_SHIFT;
906dde5748cSAlok Singh ppdu_info->he_data6 |= value;
907dde5748cSAlok Singh
908dde5748cSAlok Singh /* HE-MU Flags */
909dde5748cSAlok Singh /* HE-MU-flags1 */
910dde5748cSAlok Singh ppdu_info->he_flags1 =
911dde5748cSAlok Singh HE_SIG_B_MCS_KNOWN |
912dde5748cSAlok Singh HE_SIG_B_DCM_KNOWN |
913dde5748cSAlok Singh HE_SIG_B_COMPRESSION_FLAG_1_KNOWN |
914dde5748cSAlok Singh HE_SIG_B_SYM_NUM_KNOWN |
915dde5748cSAlok Singh HE_RU_0_KNOWN;
916dde5748cSAlok Singh
917dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_MCS_OF_SIGB);
918dde5748cSAlok Singh ppdu_info->he_flags1 |= value;
919dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_DCM_OF_SIGB);
920dde5748cSAlok Singh value = value << HE_DCM_FLAG_1_SHIFT;
921dde5748cSAlok Singh ppdu_info->he_flags1 |= value;
922dde5748cSAlok Singh
923dde5748cSAlok Singh /* HE-MU-flags2 */
924dde5748cSAlok Singh ppdu_info->he_flags2 = HE_BW_KNOWN;
925dde5748cSAlok Singh
926dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_TRANSMIT_BW);
927dde5748cSAlok Singh ppdu_info->he_flags2 |= value;
928dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_COMP_MODE_SIGB);
929dde5748cSAlok Singh value = value << HE_SIG_B_COMPRESSION_FLAG_2_SHIFT;
930dde5748cSAlok Singh ppdu_info->he_flags2 |= value;
931dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_MU_DL_INFO0_NUM_SIGB_SYMB);
932dde5748cSAlok Singh value = value - 1;
933dde5748cSAlok Singh value = value << HE_NUM_SIG_B_SYMBOLS_SHIFT;
934dde5748cSAlok Singh ppdu_info->he_flags2 |= value;
935dde5748cSAlok Singh
936dde5748cSAlok Singh ppdu_info->is_stbc = info1 &
937dde5748cSAlok Singh HAL_RX_HE_SIG_A_MU_DL_INFO1_STBC;
938dde5748cSAlok Singh }
939dde5748cSAlok Singh
940dde5748cSAlok Singh static void
ath12k_wifi7_dp_mon_parse_he_sig_su(const struct hal_rx_he_sig_a_su_info * he_sig_a,struct hal_rx_mon_ppdu_info * ppdu_info)941dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_su(const struct hal_rx_he_sig_a_su_info *he_sig_a,
942dde5748cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
943dde5748cSAlok Singh {
944dde5748cSAlok Singh u32 info0, info1, value;
945dde5748cSAlok Singh u32 dcm;
946dde5748cSAlok Singh u8 he_dcm = 0, he_stbc = 0;
947dde5748cSAlok Singh u16 he_gi = 0, he_ltf = 0;
948dde5748cSAlok Singh
949dde5748cSAlok Singh ppdu_info->he_flags = 1;
950dde5748cSAlok Singh
951dde5748cSAlok Singh info0 = __le32_to_cpu(he_sig_a->info0);
952dde5748cSAlok Singh info1 = __le32_to_cpu(he_sig_a->info1);
953dde5748cSAlok Singh
954dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_FORMAT_IND);
955dde5748cSAlok Singh if (value == 0)
956dde5748cSAlok Singh ppdu_info->he_data1 = HE_TRIG_FORMAT_TYPE;
957dde5748cSAlok Singh else
958dde5748cSAlok Singh ppdu_info->he_data1 = HE_SU_FORMAT_TYPE;
959dde5748cSAlok Singh
960dde5748cSAlok Singh ppdu_info->he_data1 |=
961dde5748cSAlok Singh HE_BSS_COLOR_KNOWN |
962dde5748cSAlok Singh HE_BEAM_CHANGE_KNOWN |
963dde5748cSAlok Singh HE_DL_UL_KNOWN |
964dde5748cSAlok Singh HE_MCS_KNOWN |
965dde5748cSAlok Singh HE_DCM_KNOWN |
966dde5748cSAlok Singh HE_CODING_KNOWN |
967dde5748cSAlok Singh HE_LDPC_EXTRA_SYMBOL_KNOWN |
968dde5748cSAlok Singh HE_STBC_KNOWN |
969dde5748cSAlok Singh HE_DATA_BW_RU_KNOWN |
970dde5748cSAlok Singh HE_DOPPLER_KNOWN;
971dde5748cSAlok Singh
972dde5748cSAlok Singh ppdu_info->he_data2 |=
973dde5748cSAlok Singh HE_GI_KNOWN |
974dde5748cSAlok Singh HE_TXBF_KNOWN |
975dde5748cSAlok Singh HE_PE_DISAMBIGUITY_KNOWN |
976dde5748cSAlok Singh HE_TXOP_KNOWN |
977dde5748cSAlok Singh HE_LTF_SYMBOLS_KNOWN |
978dde5748cSAlok Singh HE_PRE_FEC_PADDING_KNOWN |
979dde5748cSAlok Singh HE_MIDABLE_PERIODICITY_KNOWN;
980dde5748cSAlok Singh
981dde5748cSAlok Singh ppdu_info->he_data3 = u32_get_bits(info0,
982dde5748cSAlok Singh HAL_RX_HE_SIG_A_SU_INFO_INFO0_BSS_COLOR);
983dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_BEAM_CHANGE);
984dde5748cSAlok Singh value = value << HE_BEAM_CHANGE_SHIFT;
985dde5748cSAlok Singh ppdu_info->he_data3 |= value;
986dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_DL_UL_FLAG);
987dde5748cSAlok Singh value = value << HE_DL_UL_SHIFT;
988dde5748cSAlok Singh ppdu_info->he_data3 |= value;
989dde5748cSAlok Singh
990dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_TRANSMIT_MCS);
991dde5748cSAlok Singh ppdu_info->mcs = value;
992dde5748cSAlok Singh value = value << HE_TRANSMIT_MCS_SHIFT;
993dde5748cSAlok Singh ppdu_info->he_data3 |= value;
994dde5748cSAlok Singh
995dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_DCM);
996dde5748cSAlok Singh he_dcm = value;
997dde5748cSAlok Singh value = value << HE_DCM_SHIFT;
998dde5748cSAlok Singh ppdu_info->he_data3 |= value;
999dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_CODING);
1000dde5748cSAlok Singh value = value << HE_CODING_SHIFT;
1001dde5748cSAlok Singh ppdu_info->he_data3 |= value;
1002dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_LDPC_EXTRA);
1003dde5748cSAlok Singh value = value << HE_LDPC_EXTRA_SYMBOL_SHIFT;
1004dde5748cSAlok Singh ppdu_info->he_data3 |= value;
1005dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_STBC);
1006dde5748cSAlok Singh he_stbc = value;
1007dde5748cSAlok Singh value = value << HE_STBC_SHIFT;
1008dde5748cSAlok Singh ppdu_info->he_data3 |= value;
1009dde5748cSAlok Singh
1010dde5748cSAlok Singh /* data4 */
1011dde5748cSAlok Singh ppdu_info->he_data4 = u32_get_bits(info0,
1012dde5748cSAlok Singh HAL_RX_HE_SIG_A_SU_INFO_INFO0_SPATIAL_REUSE);
1013dde5748cSAlok Singh
1014dde5748cSAlok Singh /* data5 */
1015dde5748cSAlok Singh value = u32_get_bits(info0,
1016dde5748cSAlok Singh HAL_RX_HE_SIG_A_SU_INFO_INFO0_TRANSMIT_BW);
1017dde5748cSAlok Singh ppdu_info->he_data5 = value;
1018dde5748cSAlok Singh ppdu_info->bw = value;
1019dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_CP_LTF_SIZE);
1020dde5748cSAlok Singh switch (value) {
1021dde5748cSAlok Singh case 0:
1022dde5748cSAlok Singh he_gi = HE_GI_0_8;
1023dde5748cSAlok Singh he_ltf = HE_LTF_1_X;
1024dde5748cSAlok Singh break;
1025dde5748cSAlok Singh case 1:
1026dde5748cSAlok Singh he_gi = HE_GI_0_8;
1027dde5748cSAlok Singh he_ltf = HE_LTF_2_X;
1028dde5748cSAlok Singh break;
1029dde5748cSAlok Singh case 2:
1030dde5748cSAlok Singh he_gi = HE_GI_1_6;
1031dde5748cSAlok Singh he_ltf = HE_LTF_2_X;
1032dde5748cSAlok Singh break;
1033dde5748cSAlok Singh case 3:
1034dde5748cSAlok Singh if (he_dcm && he_stbc) {
1035dde5748cSAlok Singh he_gi = HE_GI_0_8;
1036dde5748cSAlok Singh he_ltf = HE_LTF_4_X;
1037dde5748cSAlok Singh } else {
1038dde5748cSAlok Singh he_gi = HE_GI_3_2;
1039dde5748cSAlok Singh he_ltf = HE_LTF_4_X;
1040dde5748cSAlok Singh }
1041dde5748cSAlok Singh break;
1042dde5748cSAlok Singh }
1043dde5748cSAlok Singh ppdu_info->gi = he_gi;
1044dde5748cSAlok Singh value = he_gi << HE_GI_SHIFT;
1045dde5748cSAlok Singh ppdu_info->he_data5 |= value;
1046dde5748cSAlok Singh value = he_ltf << HE_LTF_SIZE_SHIFT;
1047dde5748cSAlok Singh ppdu_info->ltf_size = he_ltf;
1048dde5748cSAlok Singh ppdu_info->he_data5 |= value;
1049dde5748cSAlok Singh
1050dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_NSTS);
1051dde5748cSAlok Singh value = (value << HE_LTF_SYM_SHIFT);
1052dde5748cSAlok Singh ppdu_info->he_data5 |= value;
1053dde5748cSAlok Singh
1054dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_PKT_EXT_FACTOR);
1055dde5748cSAlok Singh value = value << HE_PRE_FEC_PAD_SHIFT;
1056dde5748cSAlok Singh ppdu_info->he_data5 |= value;
1057dde5748cSAlok Singh
1058dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_TXBF);
1059dde5748cSAlok Singh value = value << HE_TXBF_SHIFT;
1060dde5748cSAlok Singh ppdu_info->he_data5 |= value;
1061dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_PKT_EXT_PE_DISAM);
1062dde5748cSAlok Singh value = value << HE_PE_DISAMBIGUITY_SHIFT;
1063dde5748cSAlok Singh ppdu_info->he_data5 |= value;
1064dde5748cSAlok Singh
1065dde5748cSAlok Singh /* data6 */
1066dde5748cSAlok Singh value = u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_NSTS);
1067dde5748cSAlok Singh value++;
1068dde5748cSAlok Singh ppdu_info->he_data6 = value;
1069dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_DOPPLER_IND);
1070dde5748cSAlok Singh value = value << HE_DOPPLER_SHIFT;
1071dde5748cSAlok Singh ppdu_info->he_data6 |= value;
1072dde5748cSAlok Singh value = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_TXOP_DURATION);
1073dde5748cSAlok Singh value = value << HE_TXOP_SHIFT;
1074dde5748cSAlok Singh ppdu_info->he_data6 |= value;
1075dde5748cSAlok Singh
1076dde5748cSAlok Singh ppdu_info->mcs =
1077dde5748cSAlok Singh u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_TRANSMIT_MCS);
1078dde5748cSAlok Singh ppdu_info->bw =
1079dde5748cSAlok Singh u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_TRANSMIT_BW);
1080dde5748cSAlok Singh ppdu_info->ldpc = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_CODING);
1081dde5748cSAlok Singh ppdu_info->is_stbc = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_STBC);
1082dde5748cSAlok Singh ppdu_info->beamformed = u32_get_bits(info1, HAL_RX_HE_SIG_A_SU_INFO_INFO1_TXBF);
1083dde5748cSAlok Singh dcm = u32_get_bits(info0, HAL_RX_HE_SIG_A_SU_INFO_INFO0_DCM);
1084631ee338SJeff Johnson ppdu_info->nss = u32_get_bits(info0,
1085631ee338SJeff Johnson HAL_RX_HE_SIG_A_SU_INFO_INFO0_NSTS) + 1;
1086dde5748cSAlok Singh ppdu_info->dcm = dcm;
1087dde5748cSAlok Singh }
1088dde5748cSAlok Singh
108900b67b7cSAlok Singh static inline bool
ath12k_wifi7_dp_mon_hal_rx_is_non_ofdma(const struct hal_rx_u_sig_info * usig_info)109000b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_is_non_ofdma(const struct hal_rx_u_sig_info *usig_info)
109100b67b7cSAlok Singh {
109200b67b7cSAlok Singh u32 ppdu_type_comp_mode = usig_info->ppdu_type_comp_mode;
109300b67b7cSAlok Singh u32 ul_dl = usig_info->ul_dl;
109400b67b7cSAlok Singh
109500b67b7cSAlok Singh if ((ppdu_type_comp_mode == HAL_RX_RECEPTION_TYPE_MU_MIMO && ul_dl == 0) ||
109600b67b7cSAlok Singh (ppdu_type_comp_mode == HAL_RX_RECEPTION_TYPE_MU_OFDMA && ul_dl == 0) ||
109700b67b7cSAlok Singh (ppdu_type_comp_mode == HAL_RX_RECEPTION_TYPE_MU_MIMO && ul_dl == 1))
109800b67b7cSAlok Singh return true;
109900b67b7cSAlok Singh
110000b67b7cSAlok Singh return false;
110100b67b7cSAlok Singh }
110200b67b7cSAlok Singh
110300b67b7cSAlok Singh static inline bool
ath12k_wifi7_dp_mon_hal_rx_is_ofdma(const struct hal_rx_u_sig_info * usig_info)110400b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_is_ofdma(const struct hal_rx_u_sig_info *usig_info)
110500b67b7cSAlok Singh {
110600b67b7cSAlok Singh if (usig_info->ppdu_type_comp_mode == 0 && usig_info->ul_dl == 0)
110700b67b7cSAlok Singh return true;
110800b67b7cSAlok Singh
110900b67b7cSAlok Singh return false;
111000b67b7cSAlok Singh }
111100b67b7cSAlok Singh
111200b67b7cSAlok Singh static inline bool
ath12k_wifi7_dp_mon_hal_rx_is_frame_type_ndp(const struct hal_rx_u_sig_info * usig_info)111300b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_is_frame_type_ndp(const struct hal_rx_u_sig_info *usig_info)
111400b67b7cSAlok Singh {
111500b67b7cSAlok Singh if (usig_info->ppdu_type_comp_mode == 1 &&
111600b67b7cSAlok Singh usig_info->eht_sig_mcs == 0 &&
111700b67b7cSAlok Singh usig_info->num_eht_sig_sym == 0)
111800b67b7cSAlok Singh return true;
111900b67b7cSAlok Singh
112000b67b7cSAlok Singh return false;
112100b67b7cSAlok Singh }
112200b67b7cSAlok Singh
112300b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_eht_sig_ndp(const struct hal_eht_sig_ndp_cmn_eb * eht_sig_ndp,struct hal_rx_mon_ppdu_info * ppdu_info)112400b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_sig_ndp(const struct hal_eht_sig_ndp_cmn_eb *eht_sig_ndp,
112500b67b7cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
112600b67b7cSAlok Singh {
112700b67b7cSAlok Singh struct hal_rx_radiotap_eht *eht = &ppdu_info->eht_info.eht;
112800b67b7cSAlok Singh u32 known, data;
112900b67b7cSAlok Singh
113000b67b7cSAlok Singh known = __le32_to_cpu(eht->known);
113100b67b7cSAlok Singh known |= IEEE80211_RADIOTAP_EHT_KNOWN_SPATIAL_REUSE |
113200b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_EHT_LTF |
113300b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_NSS_S |
113400b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_BEAMFORMED_S |
113500b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_DISREGARD_S |
113600b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_CRC1 |
113700b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_TAIL1;
113800b67b7cSAlok Singh eht->known = cpu_to_le32(known);
113900b67b7cSAlok Singh
114000b67b7cSAlok Singh data = __le32_to_cpu(eht->data[0]);
114100b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(eht_sig_ndp->info0,
114200b67b7cSAlok Singh HAL_RX_EHT_SIG_NDP_CMN_INFO0_SPATIAL_REUSE,
114300b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_SPATIAL_REUSE);
114400b67b7cSAlok Singh /* GI and LTF size are separately indicated in radiotap header
114500b67b7cSAlok Singh * and hence will be parsed from other TLV
114600b67b7cSAlok Singh */
114700b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(eht_sig_ndp->info0,
114800b67b7cSAlok Singh HAL_RX_EHT_SIG_NDP_CMN_INFO0_NUM_LTF_SYM,
114900b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_EHT_LTF);
115000b67b7cSAlok Singh
115100b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(eht_sig_ndp->info0,
115200b67b7cSAlok Singh HAL_RX_EHT_SIG_NDP_CMN_INFO0_CRC,
115300b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_CRC1_O);
115400b67b7cSAlok Singh
115500b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(eht_sig_ndp->info0,
115600b67b7cSAlok Singh HAL_RX_EHT_SIG_NDP_CMN_INFO0_DISREGARD,
115700b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_DISREGARD_S);
115800b67b7cSAlok Singh eht->data[0] = cpu_to_le32(data);
115900b67b7cSAlok Singh
116000b67b7cSAlok Singh data = __le32_to_cpu(eht->data[7]);
116100b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(eht_sig_ndp->info0,
116200b67b7cSAlok Singh HAL_RX_EHT_SIG_NDP_CMN_INFO0_NSS,
116300b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA7_NSS_S);
116400b67b7cSAlok Singh
116500b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(eht_sig_ndp->info0,
116600b67b7cSAlok Singh HAL_RX_EHT_SIG_NDP_CMN_INFO0_BEAMFORMED,
116700b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA7_BEAMFORMED_S);
116800b67b7cSAlok Singh eht->data[7] = cpu_to_le32(data);
116900b67b7cSAlok Singh }
117000b67b7cSAlok Singh
117100b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_usig_overflow(const struct hal_eht_sig_usig_overflow * ovflow,struct hal_rx_mon_ppdu_info * ppdu_info)117200b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_usig_overflow(const struct hal_eht_sig_usig_overflow *ovflow,
117300b67b7cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
117400b67b7cSAlok Singh {
117500b67b7cSAlok Singh struct hal_rx_radiotap_eht *eht = &ppdu_info->eht_info.eht;
117600b67b7cSAlok Singh u32 known, data;
117700b67b7cSAlok Singh
117800b67b7cSAlok Singh known = __le32_to_cpu(eht->known);
117900b67b7cSAlok Singh known |= IEEE80211_RADIOTAP_EHT_KNOWN_SPATIAL_REUSE |
118000b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_EHT_LTF |
118100b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_LDPC_EXTRA_SYM_OM |
118200b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_PRE_PADD_FACOR_OM |
118300b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_PE_DISAMBIGUITY_OM |
118400b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_KNOWN_DISREGARD_O;
118500b67b7cSAlok Singh eht->known = cpu_to_le32(known);
118600b67b7cSAlok Singh
118700b67b7cSAlok Singh data = __le32_to_cpu(eht->data[0]);
118800b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(ovflow->info0,
118900b67b7cSAlok Singh HAL_RX_EHT_SIG_OVERFLOW_INFO0_SPATIAL_REUSE,
119000b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_SPATIAL_REUSE);
119100b67b7cSAlok Singh
119200b67b7cSAlok Singh /* GI and LTF size are separately indicated in radiotap header
119300b67b7cSAlok Singh * and hence will be parsed from other TLV
119400b67b7cSAlok Singh */
119500b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(ovflow->info0,
119600b67b7cSAlok Singh HAL_RX_EHT_SIG_OVERFLOW_INFO0_NUM_LTF_SYM,
119700b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_EHT_LTF);
119800b67b7cSAlok Singh
119900b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(ovflow->info0,
120000b67b7cSAlok Singh HAL_RX_EHT_SIG_OVERFLOW_INFO0_LDPC_EXTA_SYM,
120100b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_LDPC_EXTRA_SYM_OM);
120200b67b7cSAlok Singh
120300b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(ovflow->info0,
120400b67b7cSAlok Singh HAL_RX_EHT_SIG_OVERFLOW_INFO0_PRE_FEC_PAD_FACTOR,
120500b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_PRE_PADD_FACOR_OM);
120600b67b7cSAlok Singh
120700b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(ovflow->info0,
120800b67b7cSAlok Singh HAL_RX_EHT_SIG_OVERFLOW_INFO0_DISAMBIGUITY,
120900b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_PE_DISAMBIGUITY_OM);
121000b67b7cSAlok Singh
121100b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(ovflow->info0,
121200b67b7cSAlok Singh HAL_RX_EHT_SIG_OVERFLOW_INFO0_DISREGARD,
121300b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA0_DISREGARD_O);
121400b67b7cSAlok Singh eht->data[0] = cpu_to_le32(data);
121500b67b7cSAlok Singh }
121600b67b7cSAlok Singh
121700b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_non_ofdma_users(const struct hal_eht_sig_non_ofdma_cmn_eb * eb,struct hal_rx_mon_ppdu_info * ppdu_info)121800b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_non_ofdma_users(const struct hal_eht_sig_non_ofdma_cmn_eb *eb,
121900b67b7cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
122000b67b7cSAlok Singh {
122100b67b7cSAlok Singh struct hal_rx_radiotap_eht *eht = &ppdu_info->eht_info.eht;
122200b67b7cSAlok Singh u32 known, data;
122300b67b7cSAlok Singh
122400b67b7cSAlok Singh known = __le32_to_cpu(eht->known);
122500b67b7cSAlok Singh known |= IEEE80211_RADIOTAP_EHT_KNOWN_NR_NON_OFDMA_USERS_M;
122600b67b7cSAlok Singh eht->known = cpu_to_le32(known);
122700b67b7cSAlok Singh
122800b67b7cSAlok Singh data = __le32_to_cpu(eht->data[7]);
122900b67b7cSAlok Singh data |= ATH12K_LE32_DEC_ENC(eb->info0,
123000b67b7cSAlok Singh HAL_RX_EHT_SIG_NON_OFDMA_INFO0_NUM_USERS,
123100b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_DATA7_NUM_OF_NON_OFDMA_USERS);
123200b67b7cSAlok Singh eht->data[7] = cpu_to_le32(data);
123300b67b7cSAlok Singh }
123400b67b7cSAlok Singh
123500b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_eht_mumimo_user(const struct hal_eht_sig_mu_mimo * user,struct hal_rx_mon_ppdu_info * ppdu_info)123600b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_mumimo_user(const struct hal_eht_sig_mu_mimo *user,
123700b67b7cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
123800b67b7cSAlok Singh {
123900b67b7cSAlok Singh struct hal_rx_eht_info *eht_info = &ppdu_info->eht_info;
124000b67b7cSAlok Singh u32 user_idx;
124100b67b7cSAlok Singh
124200b67b7cSAlok Singh if (eht_info->num_user_info >= ARRAY_SIZE(eht_info->user_info))
124300b67b7cSAlok Singh return;
124400b67b7cSAlok Singh
124500b67b7cSAlok Singh user_idx = eht_info->num_user_info++;
124600b67b7cSAlok Singh
124700b67b7cSAlok Singh eht_info->user_info[user_idx] |=
124800b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_STA_ID_KNOWN |
124900b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_MCS_KNOWN |
125000b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_CODING_KNOWN |
125100b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_SPATIAL_CONFIG_KNOWN_M |
125200b67b7cSAlok Singh ATH12K_LE32_DEC_ENC(user->info0,
125300b67b7cSAlok Singh HAL_RX_EHT_SIG_MUMIMO_USER_INFO0_STA_ID,
125400b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_STA_ID) |
125500b67b7cSAlok Singh ATH12K_LE32_DEC_ENC(user->info0,
125600b67b7cSAlok Singh HAL_RX_EHT_SIG_MUMIMO_USER_INFO0_CODING,
125700b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_CODING) |
125800b67b7cSAlok Singh ATH12K_LE32_DEC_ENC(user->info0,
125900b67b7cSAlok Singh HAL_RX_EHT_SIG_MUMIMO_USER_INFO0_MCS,
126000b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_MCS) |
126100b67b7cSAlok Singh ATH12K_LE32_DEC_ENC(user->info0,
126200b67b7cSAlok Singh HAL_RX_EHT_SIG_MUMIMO_USER_INFO0_SPATIAL_CODING,
126300b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_SPATIAL_CONFIG_M);
126400b67b7cSAlok Singh
126500b67b7cSAlok Singh ppdu_info->mcs = le32_get_bits(user->info0,
126600b67b7cSAlok Singh HAL_RX_EHT_SIG_MUMIMO_USER_INFO0_MCS);
126700b67b7cSAlok Singh }
126800b67b7cSAlok Singh
126900b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_eht_non_mumimo_user(const struct hal_eht_sig_non_mu_mimo * user,struct hal_rx_mon_ppdu_info * ppdu_info)127000b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_non_mumimo_user(const struct hal_eht_sig_non_mu_mimo *user,
127100b67b7cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
127200b67b7cSAlok Singh {
127300b67b7cSAlok Singh struct hal_rx_eht_info *eht_info = &ppdu_info->eht_info;
127400b67b7cSAlok Singh u32 user_idx;
127500b67b7cSAlok Singh
127600b67b7cSAlok Singh if (eht_info->num_user_info >= ARRAY_SIZE(eht_info->user_info))
127700b67b7cSAlok Singh return;
127800b67b7cSAlok Singh
127900b67b7cSAlok Singh user_idx = eht_info->num_user_info++;
128000b67b7cSAlok Singh
128100b67b7cSAlok Singh eht_info->user_info[user_idx] |=
128200b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_STA_ID_KNOWN |
128300b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_MCS_KNOWN |
128400b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_CODING_KNOWN |
128500b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_NSS_KNOWN_O |
128600b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_BEAMFORMING_KNOWN_O |
128700b67b7cSAlok Singh ATH12K_LE32_DEC_ENC(user->info0,
128800b67b7cSAlok Singh HAL_RX_EHT_SIG_NON_MUMIMO_USER_INFO0_STA_ID,
128900b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_STA_ID) |
129000b67b7cSAlok Singh ATH12K_LE32_DEC_ENC(user->info0,
129100b67b7cSAlok Singh HAL_RX_EHT_SIG_NON_MUMIMO_USER_INFO0_CODING,
129200b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_CODING) |
129300b67b7cSAlok Singh ATH12K_LE32_DEC_ENC(user->info0,
129400b67b7cSAlok Singh HAL_RX_EHT_SIG_NON_MUMIMO_USER_INFO0_MCS,
129500b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_MCS) |
129600b67b7cSAlok Singh ATH12K_LE32_DEC_ENC(user->info0,
129700b67b7cSAlok Singh HAL_RX_EHT_SIG_NON_MUMIMO_USER_INFO0_NSS,
129800b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_NSS_O) |
129900b67b7cSAlok Singh ATH12K_LE32_DEC_ENC(user->info0,
130000b67b7cSAlok Singh HAL_RX_EHT_SIG_NON_MUMIMO_USER_INFO0_BEAMFORMED,
130100b67b7cSAlok Singh IEEE80211_RADIOTAP_EHT_USER_INFO_BEAMFORMING_O);
130200b67b7cSAlok Singh
130300b67b7cSAlok Singh ppdu_info->mcs = le32_get_bits(user->info0,
130400b67b7cSAlok Singh HAL_RX_EHT_SIG_NON_MUMIMO_USER_INFO0_MCS);
130500b67b7cSAlok Singh
130600b67b7cSAlok Singh ppdu_info->nss = le32_get_bits(user->info0,
130700b67b7cSAlok Singh HAL_RX_EHT_SIG_NON_MUMIMO_USER_INFO0_NSS) + 1;
130800b67b7cSAlok Singh }
130900b67b7cSAlok Singh
131000b67b7cSAlok Singh static inline bool
ath12k_wifi7_dp_mon_hal_rx_is_mu_mimo_user(const struct hal_rx_u_sig_info * usig_info)131100b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_is_mu_mimo_user(const struct hal_rx_u_sig_info *usig_info)
131200b67b7cSAlok Singh {
131300b67b7cSAlok Singh if (usig_info->ppdu_type_comp_mode == HAL_RX_RECEPTION_TYPE_SU &&
131400b67b7cSAlok Singh usig_info->ul_dl == 1)
131500b67b7cSAlok Singh return true;
131600b67b7cSAlok Singh
131700b67b7cSAlok Singh return false;
131800b67b7cSAlok Singh }
131900b67b7cSAlok Singh
132000b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_eht_sig_non_ofdma(const void * tlv,struct hal_rx_mon_ppdu_info * ppdu_info)132100b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_sig_non_ofdma(const void *tlv,
132200b67b7cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
132300b67b7cSAlok Singh {
132400b67b7cSAlok Singh const struct hal_eht_sig_non_ofdma_cmn_eb *eb = tlv;
132500b67b7cSAlok Singh
132600b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_usig_overflow(tlv, ppdu_info);
132700b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_non_ofdma_users(eb, ppdu_info);
132800b67b7cSAlok Singh
132900b67b7cSAlok Singh if (ath12k_wifi7_dp_mon_hal_rx_is_mu_mimo_user(&ppdu_info->u_sig_info))
133000b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_mumimo_user(&eb->user_field.mu_mimo,
133100b67b7cSAlok Singh ppdu_info);
133200b67b7cSAlok Singh else
133300b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_non_mumimo_user(&eb->user_field.n_mu_mimo,
133400b67b7cSAlok Singh ppdu_info);
133500b67b7cSAlok Singh }
133600b67b7cSAlok Singh
133700b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_ru_allocation(const struct hal_eht_sig_ofdma_cmn_eb * eb,struct hal_rx_mon_ppdu_info * ppdu_info)133800b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_ru_allocation(const struct hal_eht_sig_ofdma_cmn_eb *eb,
133900b67b7cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
134000b67b7cSAlok Singh {
134100b67b7cSAlok Singh const struct hal_eht_sig_ofdma_cmn_eb1 *ofdma_cmn_eb1 = &eb->eb1;
134200b67b7cSAlok Singh const struct hal_eht_sig_ofdma_cmn_eb2 *ofdma_cmn_eb2 = &eb->eb2;
134300b67b7cSAlok Singh struct hal_rx_radiotap_eht *eht = &ppdu_info->eht_info.eht;
134400b67b7cSAlok Singh enum ieee80211_radiotap_eht_data ru_123, ru_124, ru_125, ru_126;
134500b67b7cSAlok Singh enum ieee80211_radiotap_eht_data ru_121, ru_122, ru_112, ru_111;
134600b67b7cSAlok Singh u32 data;
134700b67b7cSAlok Singh
134800b67b7cSAlok Singh ru_123 = IEEE80211_RADIOTAP_EHT_DATA4_RU_ALLOC_CC_1_2_3;
134900b67b7cSAlok Singh ru_124 = IEEE80211_RADIOTAP_EHT_DATA5_RU_ALLOC_CC_1_2_4;
135000b67b7cSAlok Singh ru_125 = IEEE80211_RADIOTAP_EHT_DATA5_RU_ALLOC_CC_1_2_5;
135100b67b7cSAlok Singh ru_126 = IEEE80211_RADIOTAP_EHT_DATA6_RU_ALLOC_CC_1_2_6;
135200b67b7cSAlok Singh ru_121 = IEEE80211_RADIOTAP_EHT_DATA3_RU_ALLOC_CC_1_2_1;
135300b67b7cSAlok Singh ru_122 = IEEE80211_RADIOTAP_EHT_DATA3_RU_ALLOC_CC_1_2_2;
135400b67b7cSAlok Singh ru_112 = IEEE80211_RADIOTAP_EHT_DATA2_RU_ALLOC_CC_1_1_2;
135500b67b7cSAlok Singh ru_111 = IEEE80211_RADIOTAP_EHT_DATA1_RU_ALLOC_CC_1_1_1;
135600b67b7cSAlok Singh
135700b67b7cSAlok Singh switch (ppdu_info->u_sig_info.bw) {
135800b67b7cSAlok Singh case HAL_EHT_BW_320_2:
135900b67b7cSAlok Singh case HAL_EHT_BW_320_1:
136000b67b7cSAlok Singh data = __le32_to_cpu(eht->data[4]);
136100b67b7cSAlok Singh /* CC1 2::3 */
136200b67b7cSAlok Singh data |= IEEE80211_RADIOTAP_EHT_DATA4_RU_ALLOC_CC_1_2_3_KNOWN |
136300b67b7cSAlok Singh ATH12K_LE64_DEC_ENC(ofdma_cmn_eb2->info0,
136400b67b7cSAlok Singh HAL_RX_EHT_SIG_OFDMA_EB2_RU_ALLOC_2_3,
136500b67b7cSAlok Singh ru_123);
136600b67b7cSAlok Singh eht->data[4] = cpu_to_le32(data);
136700b67b7cSAlok Singh
136800b67b7cSAlok Singh data = __le32_to_cpu(eht->data[5]);
136900b67b7cSAlok Singh /* CC1 2::4 */
137000b67b7cSAlok Singh data |= IEEE80211_RADIOTAP_EHT_DATA5_RU_ALLOC_CC_1_2_4_KNOWN |
137100b67b7cSAlok Singh ATH12K_LE64_DEC_ENC(ofdma_cmn_eb2->info0,
137200b67b7cSAlok Singh HAL_RX_EHT_SIG_OFDMA_EB2_RU_ALLOC_2_4,
137300b67b7cSAlok Singh ru_124);
137400b67b7cSAlok Singh
137500b67b7cSAlok Singh /* CC1 2::5 */
137600b67b7cSAlok Singh data |= IEEE80211_RADIOTAP_EHT_DATA5_RU_ALLOC_CC_1_2_5_KNOWN |
137700b67b7cSAlok Singh ATH12K_LE64_DEC_ENC(ofdma_cmn_eb2->info0,
137800b67b7cSAlok Singh HAL_RX_EHT_SIG_OFDMA_EB2_RU_ALLOC_2_5,
137900b67b7cSAlok Singh ru_125);
138000b67b7cSAlok Singh eht->data[5] = cpu_to_le32(data);
138100b67b7cSAlok Singh
138200b67b7cSAlok Singh data = __le32_to_cpu(eht->data[6]);
138300b67b7cSAlok Singh /* CC1 2::6 */
138400b67b7cSAlok Singh data |= IEEE80211_RADIOTAP_EHT_DATA6_RU_ALLOC_CC_1_2_6_KNOWN |
138500b67b7cSAlok Singh ATH12K_LE64_DEC_ENC(ofdma_cmn_eb2->info0,
138600b67b7cSAlok Singh HAL_RX_EHT_SIG_OFDMA_EB2_RU_ALLOC_2_6,
138700b67b7cSAlok Singh ru_126);
138800b67b7cSAlok Singh eht->data[6] = cpu_to_le32(data);
138900b67b7cSAlok Singh
139000b67b7cSAlok Singh fallthrough;
139100b67b7cSAlok Singh case HAL_EHT_BW_160:
139200b67b7cSAlok Singh data = __le32_to_cpu(eht->data[3]);
139300b67b7cSAlok Singh /* CC1 2::1 */
139400b67b7cSAlok Singh data |= IEEE80211_RADIOTAP_EHT_DATA3_RU_ALLOC_CC_1_2_1_KNOWN |
139500b67b7cSAlok Singh ATH12K_LE64_DEC_ENC(ofdma_cmn_eb2->info0,
139600b67b7cSAlok Singh HAL_RX_EHT_SIG_OFDMA_EB2_RU_ALLOC_2_1,
139700b67b7cSAlok Singh ru_121);
139800b67b7cSAlok Singh /* CC1 2::2 */
139900b67b7cSAlok Singh data |= IEEE80211_RADIOTAP_EHT_DATA3_RU_ALLOC_CC_1_2_2_KNOWN |
140000b67b7cSAlok Singh ATH12K_LE64_DEC_ENC(ofdma_cmn_eb2->info0,
140100b67b7cSAlok Singh HAL_RX_EHT_SIG_OFDMA_EB2_RU_ALLOC_2_2,
140200b67b7cSAlok Singh ru_122);
140300b67b7cSAlok Singh eht->data[3] = cpu_to_le32(data);
140400b67b7cSAlok Singh
140500b67b7cSAlok Singh fallthrough;
140600b67b7cSAlok Singh case HAL_EHT_BW_80:
140700b67b7cSAlok Singh data = __le32_to_cpu(eht->data[2]);
140800b67b7cSAlok Singh /* CC1 1::2 */
140900b67b7cSAlok Singh data |= IEEE80211_RADIOTAP_EHT_DATA2_RU_ALLOC_CC_1_1_2_KNOWN |
141000b67b7cSAlok Singh ATH12K_LE64_DEC_ENC(ofdma_cmn_eb1->info0,
141100b67b7cSAlok Singh HAL_RX_EHT_SIG_OFDMA_EB1_RU_ALLOC_1_2,
141200b67b7cSAlok Singh ru_112);
141300b67b7cSAlok Singh eht->data[2] = cpu_to_le32(data);
141400b67b7cSAlok Singh
141500b67b7cSAlok Singh fallthrough;
141600b67b7cSAlok Singh case HAL_EHT_BW_40:
141700b67b7cSAlok Singh fallthrough;
141800b67b7cSAlok Singh case HAL_EHT_BW_20:
141900b67b7cSAlok Singh data = __le32_to_cpu(eht->data[1]);
142000b67b7cSAlok Singh /* CC1 1::1 */
142100b67b7cSAlok Singh data |= IEEE80211_RADIOTAP_EHT_DATA1_RU_ALLOC_CC_1_1_1_KNOWN |
142200b67b7cSAlok Singh ATH12K_LE64_DEC_ENC(ofdma_cmn_eb1->info0,
142300b67b7cSAlok Singh HAL_RX_EHT_SIG_OFDMA_EB1_RU_ALLOC_1_1,
142400b67b7cSAlok Singh ru_111);
142500b67b7cSAlok Singh eht->data[1] = cpu_to_le32(data);
142600b67b7cSAlok Singh break;
142700b67b7cSAlok Singh default:
142800b67b7cSAlok Singh break;
142900b67b7cSAlok Singh }
143000b67b7cSAlok Singh }
143100b67b7cSAlok Singh
143200b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_hal_rx_parse_eht_sig_ofdma(const void * tlv,struct hal_rx_mon_ppdu_info * ppdu_info)143300b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_sig_ofdma(const void *tlv,
143400b67b7cSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info)
143500b67b7cSAlok Singh {
143600b67b7cSAlok Singh const struct hal_eht_sig_ofdma_cmn_eb *ofdma = tlv;
143700b67b7cSAlok Singh
143800b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_usig_overflow(tlv, ppdu_info);
143900b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_ru_allocation(ofdma, ppdu_info);
144000b67b7cSAlok Singh
144100b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_non_mumimo_user(&ofdma->user_field.n_mu_mimo,
144200b67b7cSAlok Singh ppdu_info);
144300b67b7cSAlok Singh }
144400b67b7cSAlok Singh
144500b67b7cSAlok Singh static void
ath12k_wifi7_dp_mon_parse_eht_sig_hdr(struct hal_rx_mon_ppdu_info * ppdu_info,const void * tlv_data)144600b67b7cSAlok Singh ath12k_wifi7_dp_mon_parse_eht_sig_hdr(struct hal_rx_mon_ppdu_info *ppdu_info,
144700b67b7cSAlok Singh const void *tlv_data)
144800b67b7cSAlok Singh {
144900b67b7cSAlok Singh ppdu_info->is_eht = true;
145000b67b7cSAlok Singh
145100b67b7cSAlok Singh if (ath12k_wifi7_dp_mon_hal_rx_is_frame_type_ndp(&ppdu_info->u_sig_info))
145200b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_sig_ndp(tlv_data, ppdu_info);
145300b67b7cSAlok Singh else if (ath12k_wifi7_dp_mon_hal_rx_is_non_ofdma(&ppdu_info->u_sig_info))
145400b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_sig_non_ofdma(tlv_data, ppdu_info);
145500b67b7cSAlok Singh else if (ath12k_wifi7_dp_mon_hal_rx_is_ofdma(&ppdu_info->u_sig_info))
145600b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_eht_sig_ofdma(tlv_data, ppdu_info);
145700b67b7cSAlok Singh }
145800b67b7cSAlok Singh
ath12k_wifi7_dp_mon_parse_rx_msdu_end_err(u32 info,u32 * errmap)1459965aea91SAlok Singh static void ath12k_wifi7_dp_mon_parse_rx_msdu_end_err(u32 info, u32 *errmap)
1460965aea91SAlok Singh {
1461965aea91SAlok Singh if (info & RX_MSDU_END_INFO13_FCS_ERR)
1462965aea91SAlok Singh *errmap |= HAL_RX_MPDU_ERR_FCS;
1463965aea91SAlok Singh
1464965aea91SAlok Singh if (info & RX_MSDU_END_INFO13_DECRYPT_ERR)
1465965aea91SAlok Singh *errmap |= HAL_RX_MPDU_ERR_DECRYPT;
1466965aea91SAlok Singh
1467965aea91SAlok Singh if (info & RX_MSDU_END_INFO13_TKIP_MIC_ERR)
1468965aea91SAlok Singh *errmap |= HAL_RX_MPDU_ERR_TKIP_MIC;
1469965aea91SAlok Singh
1470965aea91SAlok Singh if (info & RX_MSDU_END_INFO13_A_MSDU_ERROR)
1471965aea91SAlok Singh *errmap |= HAL_RX_MPDU_ERR_AMSDU_ERR;
1472965aea91SAlok Singh
1473965aea91SAlok Singh if (info & RX_MSDU_END_INFO13_OVERFLOW_ERR)
1474965aea91SAlok Singh *errmap |= HAL_RX_MPDU_ERR_OVERFLOW;
1475965aea91SAlok Singh
1476965aea91SAlok Singh if (info & RX_MSDU_END_INFO13_MSDU_LEN_ERR)
1477965aea91SAlok Singh *errmap |= HAL_RX_MPDU_ERR_MSDU_LEN;
1478965aea91SAlok Singh
1479965aea91SAlok Singh if (info & RX_MSDU_END_INFO13_MPDU_LEN_ERR)
1480965aea91SAlok Singh *errmap |= HAL_RX_MPDU_ERR_MPDU_LEN;
1481965aea91SAlok Singh }
1482965aea91SAlok Singh
1483965aea91SAlok Singh static void
ath12k_wifi7_parse_cmn_usr_info(const struct hal_phyrx_common_user_info * cmn_usr_info,struct hal_rx_mon_ppdu_info * ppdu_info)1484631ee338SJeff Johnson ath12k_wifi7_parse_cmn_usr_info(const struct hal_phyrx_common_user_info *cmn_usr_info,
1485631ee338SJeff Johnson struct hal_rx_mon_ppdu_info *ppdu_info)
1486631ee338SJeff Johnson {
1487631ee338SJeff Johnson struct hal_rx_radiotap_eht *eht = &ppdu_info->eht_info.eht;
1488631ee338SJeff Johnson u32 known, data, cp_setting, ltf_size;
1489631ee338SJeff Johnson
1490631ee338SJeff Johnson known = __le32_to_cpu(eht->known);
1491631ee338SJeff Johnson known |= IEEE80211_RADIOTAP_EHT_KNOWN_GI |
1492631ee338SJeff Johnson IEEE80211_RADIOTAP_EHT_KNOWN_EHT_LTF;
1493631ee338SJeff Johnson eht->known = cpu_to_le32(known);
1494631ee338SJeff Johnson
1495631ee338SJeff Johnson cp_setting = le32_get_bits(cmn_usr_info->info0,
1496631ee338SJeff Johnson HAL_RX_CMN_USR_INFO0_CP_SETTING);
1497631ee338SJeff Johnson ltf_size = le32_get_bits(cmn_usr_info->info0,
1498631ee338SJeff Johnson HAL_RX_CMN_USR_INFO0_LTF_SIZE);
1499631ee338SJeff Johnson
1500631ee338SJeff Johnson data = __le32_to_cpu(eht->data[0]);
1501631ee338SJeff Johnson data |= u32_encode_bits(cp_setting, IEEE80211_RADIOTAP_EHT_DATA0_GI);
1502631ee338SJeff Johnson data |= u32_encode_bits(ltf_size, IEEE80211_RADIOTAP_EHT_DATA0_LTF);
1503631ee338SJeff Johnson eht->data[0] = cpu_to_le32(data);
1504631ee338SJeff Johnson
1505631ee338SJeff Johnson if (!ppdu_info->ltf_size)
1506631ee338SJeff Johnson ppdu_info->ltf_size = ltf_size;
1507631ee338SJeff Johnson if (!ppdu_info->gi)
1508631ee338SJeff Johnson ppdu_info->gi = cp_setting;
1509631ee338SJeff Johnson }
1510631ee338SJeff Johnson
1511631ee338SJeff Johnson static void
ath12k_wifi7_dp_mon_parse_status_msdu_end(struct ath12k_mon_data * pmon,const struct hal_rx_msdu_end * msdu_end)1512965aea91SAlok Singh ath12k_wifi7_dp_mon_parse_status_msdu_end(struct ath12k_mon_data *pmon,
1513965aea91SAlok Singh const struct hal_rx_msdu_end *msdu_end)
1514965aea91SAlok Singh {
1515965aea91SAlok Singh ath12k_wifi7_dp_mon_parse_rx_msdu_end_err(__le32_to_cpu(msdu_end->info2),
1516965aea91SAlok Singh &pmon->err_bitmap);
1517965aea91SAlok Singh pmon->decap_format = le32_get_bits(msdu_end->info1,
1518965aea91SAlok Singh RX_MSDU_END_INFO11_DECAP_FORMAT);
1519965aea91SAlok Singh }
1520965aea91SAlok Singh
1521e475119bSAlok Singh static enum hal_rx_mon_status
ath12k_wifi7_dp_mon_rx_parse_status_tlv(struct ath12k_pdev_dp * dp_pdev,struct ath12k_mon_data * pmon,const struct hal_tlv_64_hdr * tlv)1522e475119bSAlok Singh ath12k_wifi7_dp_mon_rx_parse_status_tlv(struct ath12k_pdev_dp *dp_pdev,
1523e475119bSAlok Singh struct ath12k_mon_data *pmon,
1524e475119bSAlok Singh const struct hal_tlv_64_hdr *tlv)
1525e475119bSAlok Singh {
1526e475119bSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info = &pmon->mon_ppdu_info;
1527e475119bSAlok Singh const void *tlv_data = tlv->value;
1528e475119bSAlok Singh u32 info[7], userid;
1529e475119bSAlok Singh u16 tlv_tag, tlv_len;
1530e475119bSAlok Singh
1531e475119bSAlok Singh tlv_tag = le64_get_bits(tlv->tl, HAL_TLV_64_HDR_TAG);
1532e475119bSAlok Singh tlv_len = le64_get_bits(tlv->tl, HAL_TLV_64_HDR_LEN);
1533e475119bSAlok Singh userid = le64_get_bits(tlv->tl, HAL_TLV_64_USR_ID);
1534e475119bSAlok Singh
1535e475119bSAlok Singh if (ppdu_info->tlv_aggr.in_progress && ppdu_info->tlv_aggr.tlv_tag != tlv_tag) {
153600b67b7cSAlok Singh ath12k_wifi7_dp_mon_parse_eht_sig_hdr(ppdu_info,
153700b67b7cSAlok Singh ppdu_info->tlv_aggr.buf);
1538e475119bSAlok Singh
1539e475119bSAlok Singh ppdu_info->tlv_aggr.in_progress = false;
1540e475119bSAlok Singh ppdu_info->tlv_aggr.cur_len = 0;
1541e475119bSAlok Singh }
1542e475119bSAlok Singh
1543e475119bSAlok Singh switch (tlv_tag) {
1544e475119bSAlok Singh case HAL_RX_PPDU_START: {
1545e475119bSAlok Singh const struct hal_rx_ppdu_start *ppdu_start = tlv_data;
1546e475119bSAlok Singh
1547e475119bSAlok Singh u64 ppdu_ts = ath12k_le32hilo_to_u64(ppdu_start->ppdu_start_ts_63_32,
1548e475119bSAlok Singh ppdu_start->ppdu_start_ts_31_0);
1549e475119bSAlok Singh
1550e475119bSAlok Singh info[0] = __le32_to_cpu(ppdu_start->info0);
1551e475119bSAlok Singh
1552e475119bSAlok Singh ppdu_info->ppdu_id = u32_get_bits(info[0],
1553e475119bSAlok Singh HAL_RX_PPDU_START_INFO0_PPDU_ID);
1554e475119bSAlok Singh
1555e475119bSAlok Singh info[1] = __le32_to_cpu(ppdu_start->info1);
1556e475119bSAlok Singh ppdu_info->chan_num = u32_get_bits(info[1],
1557e475119bSAlok Singh HAL_RX_PPDU_START_INFO1_CHAN_NUM);
1558e475119bSAlok Singh ppdu_info->freq = u32_get_bits(info[1],
1559e475119bSAlok Singh HAL_RX_PPDU_START_INFO1_CHAN_FREQ);
1560e475119bSAlok Singh ppdu_info->ppdu_ts = ppdu_ts;
1561e475119bSAlok Singh
1562e475119bSAlok Singh if (ppdu_info->ppdu_id != ppdu_info->last_ppdu_id) {
1563e475119bSAlok Singh ppdu_info->last_ppdu_id = ppdu_info->ppdu_id;
1564e475119bSAlok Singh ppdu_info->num_users = 0;
1565e475119bSAlok Singh memset(&ppdu_info->mpdu_fcs_ok_bitmap, 0,
1566e475119bSAlok Singh HAL_RX_NUM_WORDS_PER_PPDU_BITMAP *
1567e475119bSAlok Singh sizeof(ppdu_info->mpdu_fcs_ok_bitmap[0]));
1568e475119bSAlok Singh }
1569e475119bSAlok Singh break;
1570e475119bSAlok Singh }
1571e475119bSAlok Singh case HAL_RX_PPDU_END_USER_STATS: {
1572e475119bSAlok Singh const struct hal_rx_ppdu_end_user_stats *eu_stats = tlv_data;
1573e475119bSAlok Singh u32 tid_bitmap;
1574e475119bSAlok Singh
1575e475119bSAlok Singh info[0] = __le32_to_cpu(eu_stats->info0);
1576e475119bSAlok Singh info[1] = __le32_to_cpu(eu_stats->info1);
1577e475119bSAlok Singh info[2] = __le32_to_cpu(eu_stats->info2);
1578e475119bSAlok Singh info[4] = __le32_to_cpu(eu_stats->info4);
1579e475119bSAlok Singh info[5] = __le32_to_cpu(eu_stats->info5);
1580e475119bSAlok Singh info[6] = __le32_to_cpu(eu_stats->info6);
1581e475119bSAlok Singh
1582e475119bSAlok Singh ppdu_info->ast_index =
1583e475119bSAlok Singh u32_get_bits(info[2], HAL_RX_PPDU_END_USER_STATS_INFO2_AST_INDEX);
1584e475119bSAlok Singh ppdu_info->fc_valid =
1585e475119bSAlok Singh u32_get_bits(info[1], HAL_RX_PPDU_END_USER_STATS_INFO1_FC_VALID);
1586e475119bSAlok Singh tid_bitmap = u32_get_bits(info[6],
1587e475119bSAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO6_TID_BITMAP);
1588e475119bSAlok Singh ppdu_info->tid = ffs(tid_bitmap) - 1;
1589e475119bSAlok Singh ppdu_info->tcp_msdu_count =
1590e475119bSAlok Singh u32_get_bits(info[4],
1591e475119bSAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO4_TCP_MSDU_CNT);
1592e475119bSAlok Singh ppdu_info->udp_msdu_count =
1593e475119bSAlok Singh u32_get_bits(info[4],
1594e475119bSAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO4_UDP_MSDU_CNT);
1595e475119bSAlok Singh ppdu_info->other_msdu_count =
1596e475119bSAlok Singh u32_get_bits(info[5],
1597e475119bSAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO5_OTHER_MSDU_CNT);
1598e475119bSAlok Singh ppdu_info->tcp_ack_msdu_count =
1599e475119bSAlok Singh u32_get_bits(info[5],
1600e475119bSAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO5_TCP_ACK_MSDU_CNT);
1601e475119bSAlok Singh ppdu_info->preamble_type =
1602e475119bSAlok Singh u32_get_bits(info[1],
1603e475119bSAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO1_PKT_TYPE);
1604e475119bSAlok Singh ppdu_info->num_mpdu_fcs_ok =
1605e475119bSAlok Singh u32_get_bits(info[1],
1606e475119bSAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO1_MPDU_CNT_FCS_OK);
1607e475119bSAlok Singh ppdu_info->num_mpdu_fcs_err =
1608e475119bSAlok Singh u32_get_bits(info[0],
1609e475119bSAlok Singh HAL_RX_PPDU_END_USER_STATS_INFO0_MPDU_CNT_FCS_ERR);
1610e475119bSAlok Singh ppdu_info->peer_id =
1611e475119bSAlok Singh u32_get_bits(info[0], HAL_RX_PPDU_END_USER_STATS_INFO0_PEER_ID);
1612e475119bSAlok Singh
1613e475119bSAlok Singh switch (ppdu_info->preamble_type) {
1614e475119bSAlok Singh case HAL_RX_PREAMBLE_11N:
1615e475119bSAlok Singh ppdu_info->ht_flags = 1;
1616e475119bSAlok Singh break;
1617e475119bSAlok Singh case HAL_RX_PREAMBLE_11AC:
1618e475119bSAlok Singh ppdu_info->vht_flags = 1;
1619e475119bSAlok Singh break;
1620e475119bSAlok Singh case HAL_RX_PREAMBLE_11AX:
1621e475119bSAlok Singh ppdu_info->he_flags = 1;
1622e475119bSAlok Singh break;
1623e475119bSAlok Singh case HAL_RX_PREAMBLE_11BE:
1624e475119bSAlok Singh ppdu_info->is_eht = true;
1625e475119bSAlok Singh break;
1626e475119bSAlok Singh default:
1627e475119bSAlok Singh break;
1628e475119bSAlok Singh }
1629e475119bSAlok Singh
1630e475119bSAlok Singh if (userid < HAL_MAX_UL_MU_USERS) {
1631e475119bSAlok Singh struct hal_rx_user_status *rxuser_stats =
1632e475119bSAlok Singh &ppdu_info->userstats[userid];
1633e475119bSAlok Singh
1634e475119bSAlok Singh if (ppdu_info->num_mpdu_fcs_ok > 1 ||
1635e475119bSAlok Singh ppdu_info->num_mpdu_fcs_err > 1)
1636e475119bSAlok Singh ppdu_info->userstats[userid].ampdu_present = true;
1637e475119bSAlok Singh
1638e475119bSAlok Singh ppdu_info->num_users += 1;
1639e475119bSAlok Singh
16405db19c48SAlok Singh ath12k_wifi7_dp_mon_rx_handle_ofdma_info(eu_stats, rxuser_stats);
16415db19c48SAlok Singh ath12k_wifi7_dp_mon_rx_populate_mu_user_info(eu_stats, ppdu_info,
1642e475119bSAlok Singh rxuser_stats);
1643e475119bSAlok Singh }
1644e475119bSAlok Singh ppdu_info->mpdu_fcs_ok_bitmap[0] = __le32_to_cpu(eu_stats->rsvd1[0]);
1645e475119bSAlok Singh ppdu_info->mpdu_fcs_ok_bitmap[1] = __le32_to_cpu(eu_stats->rsvd1[1]);
1646e475119bSAlok Singh break;
1647e475119bSAlok Singh }
1648e475119bSAlok Singh case HAL_RX_PPDU_END_USER_STATS_EXT: {
1649e475119bSAlok Singh const struct hal_rx_ppdu_end_user_stats_ext *eu_stats = tlv_data;
1650e475119bSAlok Singh
1651e475119bSAlok Singh ppdu_info->mpdu_fcs_ok_bitmap[2] = __le32_to_cpu(eu_stats->info1);
1652e475119bSAlok Singh ppdu_info->mpdu_fcs_ok_bitmap[3] = __le32_to_cpu(eu_stats->info2);
1653e475119bSAlok Singh ppdu_info->mpdu_fcs_ok_bitmap[4] = __le32_to_cpu(eu_stats->info3);
1654e475119bSAlok Singh ppdu_info->mpdu_fcs_ok_bitmap[5] = __le32_to_cpu(eu_stats->info4);
1655e475119bSAlok Singh ppdu_info->mpdu_fcs_ok_bitmap[6] = __le32_to_cpu(eu_stats->info5);
1656e475119bSAlok Singh ppdu_info->mpdu_fcs_ok_bitmap[7] = __le32_to_cpu(eu_stats->info6);
1657e475119bSAlok Singh break;
1658e475119bSAlok Singh }
1659e475119bSAlok Singh case HAL_PHYRX_HT_SIG:
1660f4bcbaebSAlok Singh ath12k_wifi7_dp_mon_parse_ht_sig(tlv_data, ppdu_info);
1661e475119bSAlok Singh break;
1662e475119bSAlok Singh
1663e475119bSAlok Singh case HAL_PHYRX_L_SIG_B:
1664e5419861SAlok Singh ath12k_wifi7_dp_mon_parse_l_sig_b(tlv_data, ppdu_info);
1665e475119bSAlok Singh break;
1666e475119bSAlok Singh
1667e475119bSAlok Singh case HAL_PHYRX_L_SIG_A:
1668e5419861SAlok Singh ath12k_wifi7_dp_mon_parse_l_sig_a(tlv_data, ppdu_info);
1669e475119bSAlok Singh break;
1670e475119bSAlok Singh
1671e475119bSAlok Singh case HAL_PHYRX_VHT_SIG_A:
1672f4bcbaebSAlok Singh ath12k_wifi7_dp_mon_parse_vht_sig_a(tlv_data, ppdu_info);
1673e475119bSAlok Singh break;
1674e475119bSAlok Singh
1675e475119bSAlok Singh case HAL_PHYRX_HE_SIG_A_SU:
1676dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_su(tlv_data, ppdu_info);
1677e475119bSAlok Singh break;
1678e475119bSAlok Singh
1679e475119bSAlok Singh case HAL_PHYRX_HE_SIG_A_MU_DL:
1680dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_mu(tlv_data, ppdu_info);
1681e475119bSAlok Singh break;
1682e475119bSAlok Singh
1683e475119bSAlok Singh case HAL_PHYRX_HE_SIG_B1_MU:
1684dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_b1_mu(tlv_data, ppdu_info);
1685e475119bSAlok Singh break;
1686e475119bSAlok Singh
1687e475119bSAlok Singh case HAL_PHYRX_HE_SIG_B2_MU:
1688dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_b2_mu(tlv_data, ppdu_info);
1689e475119bSAlok Singh break;
1690e475119bSAlok Singh
1691e475119bSAlok Singh case HAL_PHYRX_HE_SIG_B2_OFDMA:
1692dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_b2_ofdma(tlv_data, ppdu_info);
1693e475119bSAlok Singh break;
1694e475119bSAlok Singh
1695e475119bSAlok Singh case HAL_PHYRX_RSSI_LEGACY: {
1696e475119bSAlok Singh const struct hal_rx_phyrx_rssi_legacy_info *rssi = tlv_data;
1697e475119bSAlok Singh
1698e475119bSAlok Singh info[0] = __le32_to_cpu(rssi->info0);
1699631ee338SJeff Johnson info[2] = __le32_to_cpu(rssi->info2);
1700e475119bSAlok Singh
1701e475119bSAlok Singh /* TODO: Please note that the combined rssi will not be accurate
1702e475119bSAlok Singh * in MU case. Rssi in MU needs to be retrieved from
1703e475119bSAlok Singh * PHYRX_OTHER_RECEIVE_INFO TLV.
1704e475119bSAlok Singh */
1705e475119bSAlok Singh ppdu_info->rssi_comb =
1706631ee338SJeff Johnson u32_get_bits(info[2],
1707631ee338SJeff Johnson HAL_RX_RSSI_LEGACY_INFO_INFO2_RSSI_COMB_PPDU);
1708e475119bSAlok Singh
1709e475119bSAlok Singh ppdu_info->bw = u32_get_bits(info[0],
1710631ee338SJeff Johnson HAL_RX_RSSI_LEGACY_INFO_INFO0_RX_BW);
1711e475119bSAlok Singh break;
1712e475119bSAlok Singh }
1713631ee338SJeff Johnson case HAL_PHYRX_COMMON_USER_INFO: {
1714631ee338SJeff Johnson ath12k_wifi7_parse_cmn_usr_info(tlv_data, ppdu_info);
1715e475119bSAlok Singh break;
1716e475119bSAlok Singh }
1717e475119bSAlok Singh case HAL_RX_PPDU_START_USER_INFO:
17185db19c48SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_user_info(tlv_data, userid, ppdu_info);
1719e475119bSAlok Singh break;
1720e475119bSAlok Singh
1721e475119bSAlok Singh case HAL_RXPCU_PPDU_END_INFO: {
1722e475119bSAlok Singh const struct hal_rx_ppdu_end_duration *ppdu_rx_duration = tlv_data;
1723e475119bSAlok Singh
1724e475119bSAlok Singh info[0] = __le32_to_cpu(ppdu_rx_duration->info0);
1725e475119bSAlok Singh ppdu_info->rx_duration =
1726e475119bSAlok Singh u32_get_bits(info[0], HAL_RX_PPDU_END_DURATION);
1727e475119bSAlok Singh ppdu_info->tsft = __le32_to_cpu(ppdu_rx_duration->rsvd0[1]);
1728e475119bSAlok Singh ppdu_info->tsft = (ppdu_info->tsft << 32) |
1729e475119bSAlok Singh __le32_to_cpu(ppdu_rx_duration->rsvd0[0]);
1730e475119bSAlok Singh break;
1731e475119bSAlok Singh }
1732e475119bSAlok Singh case HAL_RX_MPDU_START: {
1733e475119bSAlok Singh const struct hal_rx_mpdu_start *mpdu_start = tlv_data;
1734e475119bSAlok Singh u16 peer_id;
1735e475119bSAlok Singh
1736e475119bSAlok Singh info[1] = __le32_to_cpu(mpdu_start->info1);
1737e475119bSAlok Singh peer_id = u32_get_bits(info[1], HAL_RX_MPDU_START_INFO1_PEERID);
1738e475119bSAlok Singh if (peer_id)
1739e475119bSAlok Singh ppdu_info->peer_id = peer_id;
1740e475119bSAlok Singh
1741e475119bSAlok Singh ppdu_info->mpdu_len += u32_get_bits(info[1],
1742e475119bSAlok Singh HAL_RX_MPDU_START_INFO2_MPDU_LEN);
1743e475119bSAlok Singh if (userid < HAL_MAX_UL_MU_USERS) {
1744e475119bSAlok Singh info[0] = __le32_to_cpu(mpdu_start->info0);
1745e475119bSAlok Singh ppdu_info->userid = userid;
1746e475119bSAlok Singh ppdu_info->userstats[userid].ampdu_id =
1747e475119bSAlok Singh u32_get_bits(info[0], HAL_RX_MPDU_START_INFO0_PPDU_ID);
1748e475119bSAlok Singh }
1749e475119bSAlok Singh
1750e475119bSAlok Singh return HAL_RX_MON_STATUS_MPDU_START;
1751e475119bSAlok Singh }
1752e475119bSAlok Singh case HAL_RX_MSDU_START:
1753e475119bSAlok Singh /* TODO: add msdu start parsing logic */
1754e475119bSAlok Singh break;
1755e475119bSAlok Singh case HAL_MON_BUF_ADDR:
1756e475119bSAlok Singh return HAL_RX_MON_STATUS_BUF_ADDR;
1757e475119bSAlok Singh case HAL_RX_MSDU_END:
1758965aea91SAlok Singh ath12k_wifi7_dp_mon_parse_status_msdu_end(pmon, tlv_data);
1759e475119bSAlok Singh return HAL_RX_MON_STATUS_MSDU_END;
1760e475119bSAlok Singh case HAL_RX_MPDU_END:
1761e475119bSAlok Singh return HAL_RX_MON_STATUS_MPDU_END;
1762e475119bSAlok Singh case HAL_PHYRX_GENERIC_U_SIG:
1763e5419861SAlok Singh ath12k_wifi7_dp_mon_hal_rx_parse_u_sig_hdr(tlv_data, ppdu_info);
1764e475119bSAlok Singh break;
1765e475119bSAlok Singh case HAL_PHYRX_GENERIC_EHT_SIG:
1766e475119bSAlok Singh /* Handle the case where aggregation is in progress
1767e475119bSAlok Singh * or the current TLV is one of the TLVs which should be
1768e475119bSAlok Singh * aggregated
1769e475119bSAlok Singh */
1770e475119bSAlok Singh if (!ppdu_info->tlv_aggr.in_progress) {
1771e475119bSAlok Singh ppdu_info->tlv_aggr.in_progress = true;
1772e475119bSAlok Singh ppdu_info->tlv_aggr.tlv_tag = tlv_tag;
1773e475119bSAlok Singh ppdu_info->tlv_aggr.cur_len = 0;
1774e475119bSAlok Singh }
1775e475119bSAlok Singh
1776e475119bSAlok Singh ppdu_info->is_eht = true;
1777e475119bSAlok Singh
177800b67b7cSAlok Singh ath12k_wifi7_dp_mon_hal_aggr_tlv(ppdu_info, tlv_len, tlv_data);
1779e475119bSAlok Singh break;
1780e475119bSAlok Singh case HAL_DUMMY:
1781e475119bSAlok Singh return HAL_RX_MON_STATUS_BUF_DONE;
1782e475119bSAlok Singh case HAL_RX_PPDU_END_STATUS_DONE:
1783e475119bSAlok Singh case 0:
1784e475119bSAlok Singh return HAL_RX_MON_STATUS_PPDU_DONE;
1785e475119bSAlok Singh default:
1786e475119bSAlok Singh break;
1787e475119bSAlok Singh }
1788e475119bSAlok Singh
1789e475119bSAlok Singh return HAL_RX_MON_STATUS_PPDU_NOT_DONE;
1790e475119bSAlok Singh }
1791e475119bSAlok Singh
1792e475119bSAlok Singh static int
ath12k_wifi7_dp_mon_parse_rx_dest_tlv(struct ath12k_pdev_dp * dp_pdev,struct ath12k_mon_data * pmon,enum hal_rx_mon_status hal_status,const void * tlv_data)1793e475119bSAlok Singh ath12k_wifi7_dp_mon_parse_rx_dest_tlv(struct ath12k_pdev_dp *dp_pdev,
1794e475119bSAlok Singh struct ath12k_mon_data *pmon,
1795e475119bSAlok Singh enum hal_rx_mon_status hal_status,
1796e475119bSAlok Singh const void *tlv_data)
1797e475119bSAlok Singh {
1798e475119bSAlok Singh switch (hal_status) {
1799e475119bSAlok Singh case HAL_RX_MON_STATUS_MPDU_START:
1800e475119bSAlok Singh if (WARN_ON_ONCE(pmon->mon_mpdu))
1801e475119bSAlok Singh break;
1802e475119bSAlok Singh
1803*69050f8dSKees Cook pmon->mon_mpdu = kzalloc_obj(*pmon->mon_mpdu, GFP_ATOMIC);
1804e475119bSAlok Singh if (!pmon->mon_mpdu)
1805e475119bSAlok Singh return -ENOMEM;
1806e475119bSAlok Singh break;
1807e475119bSAlok Singh case HAL_RX_MON_STATUS_BUF_ADDR:
1808e475119bSAlok Singh return ath12k_dp_mon_parse_status_buf(dp_pdev, pmon, tlv_data);
1809e475119bSAlok Singh case HAL_RX_MON_STATUS_MPDU_END:
1810e475119bSAlok Singh /* If no MSDU then free empty MPDU */
1811e475119bSAlok Singh if (pmon->mon_mpdu->tail) {
1812e475119bSAlok Singh pmon->mon_mpdu->tail->next = NULL;
1813e475119bSAlok Singh list_add_tail(&pmon->mon_mpdu->list, &pmon->dp_rx_mon_mpdu_list);
1814e475119bSAlok Singh } else {
1815e475119bSAlok Singh kfree(pmon->mon_mpdu);
1816e475119bSAlok Singh }
1817e475119bSAlok Singh pmon->mon_mpdu = NULL;
1818e475119bSAlok Singh break;
1819e475119bSAlok Singh case HAL_RX_MON_STATUS_MSDU_END:
1820e475119bSAlok Singh pmon->mon_mpdu->decap_format = pmon->decap_format;
1821e475119bSAlok Singh pmon->mon_mpdu->err_bitmap = pmon->err_bitmap;
1822e475119bSAlok Singh break;
1823e475119bSAlok Singh default:
1824e475119bSAlok Singh break;
1825e475119bSAlok Singh }
1826e475119bSAlok Singh
1827e475119bSAlok Singh return 0;
1828e475119bSAlok Singh }
1829e475119bSAlok Singh
183052758ff7SAlok Singh static struct dp_mon_tx_ppdu_info *
ath12k_wifi7_dp_mon_tx_get_ppdu_info(struct ath12k_mon_data * pmon,unsigned int ppdu_id,enum dp_mon_tx_ppdu_info_type type)183152758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_get_ppdu_info(struct ath12k_mon_data *pmon,
183252758ff7SAlok Singh unsigned int ppdu_id,
183352758ff7SAlok Singh enum dp_mon_tx_ppdu_info_type type)
183452758ff7SAlok Singh {
183552758ff7SAlok Singh struct dp_mon_tx_ppdu_info *tx_ppdu_info;
183652758ff7SAlok Singh
183752758ff7SAlok Singh if (type == DP_MON_TX_PROT_PPDU_INFO) {
183852758ff7SAlok Singh tx_ppdu_info = pmon->tx_prot_ppdu_info;
183952758ff7SAlok Singh
184052758ff7SAlok Singh if (tx_ppdu_info && !tx_ppdu_info->is_used)
184152758ff7SAlok Singh return tx_ppdu_info;
184252758ff7SAlok Singh kfree(tx_ppdu_info);
184352758ff7SAlok Singh } else {
184452758ff7SAlok Singh tx_ppdu_info = pmon->tx_data_ppdu_info;
184552758ff7SAlok Singh
184652758ff7SAlok Singh if (tx_ppdu_info && !tx_ppdu_info->is_used)
184752758ff7SAlok Singh return tx_ppdu_info;
184852758ff7SAlok Singh kfree(tx_ppdu_info);
184952758ff7SAlok Singh }
185052758ff7SAlok Singh
185152758ff7SAlok Singh /* allocate new tx_ppdu_info */
1852*69050f8dSKees Cook tx_ppdu_info = kzalloc_obj(*tx_ppdu_info, GFP_ATOMIC);
185352758ff7SAlok Singh if (!tx_ppdu_info)
185452758ff7SAlok Singh return NULL;
185552758ff7SAlok Singh
185652758ff7SAlok Singh tx_ppdu_info->is_used = 0;
185752758ff7SAlok Singh tx_ppdu_info->ppdu_id = ppdu_id;
185852758ff7SAlok Singh
185952758ff7SAlok Singh if (type == DP_MON_TX_PROT_PPDU_INFO)
186052758ff7SAlok Singh pmon->tx_prot_ppdu_info = tx_ppdu_info;
186152758ff7SAlok Singh else
186252758ff7SAlok Singh pmon->tx_data_ppdu_info = tx_ppdu_info;
186352758ff7SAlok Singh
186452758ff7SAlok Singh return tx_ppdu_info;
186552758ff7SAlok Singh }
186652758ff7SAlok Singh
186752758ff7SAlok Singh static struct dp_mon_tx_ppdu_info *
ath12k_wifi7_dp_mon_hal_tx_ppdu_info(struct ath12k_mon_data * pmon,u16 tlv_tag)186852758ff7SAlok Singh ath12k_wifi7_dp_mon_hal_tx_ppdu_info(struct ath12k_mon_data *pmon,
186952758ff7SAlok Singh u16 tlv_tag)
187052758ff7SAlok Singh {
187152758ff7SAlok Singh switch (tlv_tag) {
187252758ff7SAlok Singh case HAL_TX_FES_SETUP:
187352758ff7SAlok Singh case HAL_TX_FLUSH:
187452758ff7SAlok Singh case HAL_PCU_PPDU_SETUP_INIT:
187552758ff7SAlok Singh case HAL_TX_PEER_ENTRY:
187652758ff7SAlok Singh case HAL_TX_QUEUE_EXTENSION:
187752758ff7SAlok Singh case HAL_TX_MPDU_START:
187852758ff7SAlok Singh case HAL_TX_MSDU_START:
187952758ff7SAlok Singh case HAL_TX_DATA:
188052758ff7SAlok Singh case HAL_MON_BUF_ADDR:
188152758ff7SAlok Singh case HAL_TX_MPDU_END:
188252758ff7SAlok Singh case HAL_TX_LAST_MPDU_FETCHED:
188352758ff7SAlok Singh case HAL_TX_LAST_MPDU_END:
188452758ff7SAlok Singh case HAL_COEX_TX_REQ:
188552758ff7SAlok Singh case HAL_TX_RAW_OR_NATIVE_FRAME_SETUP:
188652758ff7SAlok Singh case HAL_SCH_CRITICAL_TLV_REFERENCE:
188752758ff7SAlok Singh case HAL_TX_FES_SETUP_COMPLETE:
188852758ff7SAlok Singh case HAL_TQM_MPDU_GLOBAL_START:
188952758ff7SAlok Singh case HAL_SCHEDULER_END:
189052758ff7SAlok Singh case HAL_TX_FES_STATUS_USER_PPDU:
189152758ff7SAlok Singh break;
189252758ff7SAlok Singh case HAL_TX_FES_STATUS_PROT: {
189352758ff7SAlok Singh if (!pmon->tx_prot_ppdu_info->is_used)
189452758ff7SAlok Singh pmon->tx_prot_ppdu_info->is_used = true;
189552758ff7SAlok Singh
189652758ff7SAlok Singh return pmon->tx_prot_ppdu_info;
189752758ff7SAlok Singh }
189852758ff7SAlok Singh }
189952758ff7SAlok Singh
190052758ff7SAlok Singh if (!pmon->tx_data_ppdu_info->is_used)
190152758ff7SAlok Singh pmon->tx_data_ppdu_info->is_used = true;
190252758ff7SAlok Singh
190352758ff7SAlok Singh return pmon->tx_data_ppdu_info;
190452758ff7SAlok Singh }
190552758ff7SAlok Singh
190652758ff7SAlok Singh #define MAX_MONITOR_HEADER 512
190752758ff7SAlok Singh #define MAX_DUMMY_FRM_BODY 128
190852758ff7SAlok Singh
190952758ff7SAlok Singh static struct
ath12k_wifi7_dp_mon_tx_alloc_skb(void)191052758ff7SAlok Singh sk_buff *ath12k_wifi7_dp_mon_tx_alloc_skb(void)
191152758ff7SAlok Singh {
191252758ff7SAlok Singh struct sk_buff *skb;
191352758ff7SAlok Singh
191452758ff7SAlok Singh skb = dev_alloc_skb(MAX_MONITOR_HEADER + MAX_DUMMY_FRM_BODY);
191552758ff7SAlok Singh if (!skb)
191652758ff7SAlok Singh return NULL;
191752758ff7SAlok Singh
191852758ff7SAlok Singh skb_reserve(skb, MAX_MONITOR_HEADER);
191952758ff7SAlok Singh
192052758ff7SAlok Singh if (!IS_ALIGNED((unsigned long)skb->data, 4))
192152758ff7SAlok Singh skb_pull(skb, PTR_ALIGN(skb->data, 4) - skb->data);
192252758ff7SAlok Singh
192352758ff7SAlok Singh return skb;
192452758ff7SAlok Singh }
192552758ff7SAlok Singh
192652758ff7SAlok Singh static int
ath12k_wifi7_dp_mon_tx_gen_cts2self_frame(struct dp_mon_tx_ppdu_info * tx_ppdu_info)192752758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_gen_cts2self_frame(struct dp_mon_tx_ppdu_info *tx_ppdu_info)
192852758ff7SAlok Singh {
192952758ff7SAlok Singh struct sk_buff *skb;
193052758ff7SAlok Singh struct ieee80211_cts *cts;
193152758ff7SAlok Singh
193252758ff7SAlok Singh skb = ath12k_wifi7_dp_mon_tx_alloc_skb();
193352758ff7SAlok Singh if (!skb)
193452758ff7SAlok Singh return -ENOMEM;
193552758ff7SAlok Singh
193652758ff7SAlok Singh cts = (struct ieee80211_cts *)skb->data;
193752758ff7SAlok Singh memset(cts, 0, MAX_DUMMY_FRM_BODY);
193852758ff7SAlok Singh cts->frame_control =
193952758ff7SAlok Singh cpu_to_le16(IEEE80211_FTYPE_CTL | IEEE80211_STYPE_CTS);
194052758ff7SAlok Singh cts->duration = cpu_to_le16(tx_ppdu_info->rx_status.rx_duration);
194152758ff7SAlok Singh memcpy(cts->ra, tx_ppdu_info->rx_status.addr1, sizeof(cts->ra));
194252758ff7SAlok Singh
194352758ff7SAlok Singh skb_put(skb, sizeof(*cts));
194452758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->head = skb;
194552758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->tail = NULL;
194652758ff7SAlok Singh list_add_tail(&tx_ppdu_info->tx_mon_mpdu->list,
194752758ff7SAlok Singh &tx_ppdu_info->dp_tx_mon_mpdu_list);
194852758ff7SAlok Singh
194952758ff7SAlok Singh return 0;
195052758ff7SAlok Singh }
195152758ff7SAlok Singh
195252758ff7SAlok Singh static int
ath12k_wifi7_dp_mon_tx_gen_rts_frame(struct dp_mon_tx_ppdu_info * tx_ppdu_info)195352758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_gen_rts_frame(struct dp_mon_tx_ppdu_info *tx_ppdu_info)
195452758ff7SAlok Singh {
195552758ff7SAlok Singh struct sk_buff *skb;
195652758ff7SAlok Singh struct ieee80211_rts *rts;
195752758ff7SAlok Singh
195852758ff7SAlok Singh skb = ath12k_wifi7_dp_mon_tx_alloc_skb();
195952758ff7SAlok Singh if (!skb)
196052758ff7SAlok Singh return -ENOMEM;
196152758ff7SAlok Singh
196252758ff7SAlok Singh rts = (struct ieee80211_rts *)skb->data;
196352758ff7SAlok Singh memset(rts, 0, MAX_DUMMY_FRM_BODY);
196452758ff7SAlok Singh rts->frame_control =
196552758ff7SAlok Singh cpu_to_le16(IEEE80211_FTYPE_CTL | IEEE80211_STYPE_RTS);
196652758ff7SAlok Singh rts->duration = cpu_to_le16(tx_ppdu_info->rx_status.rx_duration);
196752758ff7SAlok Singh memcpy(rts->ra, tx_ppdu_info->rx_status.addr1, sizeof(rts->ra));
196852758ff7SAlok Singh memcpy(rts->ta, tx_ppdu_info->rx_status.addr2, sizeof(rts->ta));
196952758ff7SAlok Singh
197052758ff7SAlok Singh skb_put(skb, sizeof(*rts));
197152758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->head = skb;
197252758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->tail = NULL;
197352758ff7SAlok Singh list_add_tail(&tx_ppdu_info->tx_mon_mpdu->list,
197452758ff7SAlok Singh &tx_ppdu_info->dp_tx_mon_mpdu_list);
197552758ff7SAlok Singh
197652758ff7SAlok Singh return 0;
197752758ff7SAlok Singh }
197852758ff7SAlok Singh
197952758ff7SAlok Singh static int
ath12k_wifi7_dp_mon_tx_gen_3addr_qos_null_frame(struct dp_mon_tx_ppdu_info * tx_ppdu_info)198052758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_gen_3addr_qos_null_frame(struct dp_mon_tx_ppdu_info *tx_ppdu_info)
198152758ff7SAlok Singh {
198252758ff7SAlok Singh struct sk_buff *skb;
198352758ff7SAlok Singh struct ieee80211_qos_hdr *qhdr;
198452758ff7SAlok Singh
198552758ff7SAlok Singh skb = ath12k_wifi7_dp_mon_tx_alloc_skb();
198652758ff7SAlok Singh if (!skb)
198752758ff7SAlok Singh return -ENOMEM;
198852758ff7SAlok Singh
198952758ff7SAlok Singh qhdr = (struct ieee80211_qos_hdr *)skb->data;
199052758ff7SAlok Singh memset(qhdr, 0, MAX_DUMMY_FRM_BODY);
199152758ff7SAlok Singh qhdr->frame_control =
199252758ff7SAlok Singh cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_QOS_NULLFUNC);
199352758ff7SAlok Singh qhdr->duration_id = cpu_to_le16(tx_ppdu_info->rx_status.rx_duration);
199452758ff7SAlok Singh memcpy(qhdr->addr1, tx_ppdu_info->rx_status.addr1, ETH_ALEN);
199552758ff7SAlok Singh memcpy(qhdr->addr2, tx_ppdu_info->rx_status.addr2, ETH_ALEN);
199652758ff7SAlok Singh memcpy(qhdr->addr3, tx_ppdu_info->rx_status.addr3, ETH_ALEN);
199752758ff7SAlok Singh
199852758ff7SAlok Singh skb_put(skb, sizeof(*qhdr));
199952758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->head = skb;
200052758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->tail = NULL;
200152758ff7SAlok Singh list_add_tail(&tx_ppdu_info->tx_mon_mpdu->list,
200252758ff7SAlok Singh &tx_ppdu_info->dp_tx_mon_mpdu_list);
200352758ff7SAlok Singh
200452758ff7SAlok Singh return 0;
200552758ff7SAlok Singh }
200652758ff7SAlok Singh
200752758ff7SAlok Singh static int
ath12k_wifi7_dp_mon_tx_gen_4addr_qos_null_frame(struct dp_mon_tx_ppdu_info * tx_ppdu_info)200852758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_gen_4addr_qos_null_frame(struct dp_mon_tx_ppdu_info *tx_ppdu_info)
200952758ff7SAlok Singh {
201052758ff7SAlok Singh struct sk_buff *skb;
201152758ff7SAlok Singh struct dp_mon_qosframe_addr4 *qhdr;
201252758ff7SAlok Singh
201352758ff7SAlok Singh skb = ath12k_wifi7_dp_mon_tx_alloc_skb();
201452758ff7SAlok Singh if (!skb)
201552758ff7SAlok Singh return -ENOMEM;
201652758ff7SAlok Singh
201752758ff7SAlok Singh qhdr = (struct dp_mon_qosframe_addr4 *)skb->data;
201852758ff7SAlok Singh memset(qhdr, 0, MAX_DUMMY_FRM_BODY);
201952758ff7SAlok Singh qhdr->frame_control =
202052758ff7SAlok Singh cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_QOS_NULLFUNC);
202152758ff7SAlok Singh qhdr->duration = cpu_to_le16(tx_ppdu_info->rx_status.rx_duration);
202252758ff7SAlok Singh memcpy(qhdr->addr1, tx_ppdu_info->rx_status.addr1, ETH_ALEN);
202352758ff7SAlok Singh memcpy(qhdr->addr2, tx_ppdu_info->rx_status.addr2, ETH_ALEN);
202452758ff7SAlok Singh memcpy(qhdr->addr3, tx_ppdu_info->rx_status.addr3, ETH_ALEN);
202552758ff7SAlok Singh memcpy(qhdr->addr4, tx_ppdu_info->rx_status.addr4, ETH_ALEN);
202652758ff7SAlok Singh
202752758ff7SAlok Singh skb_put(skb, sizeof(*qhdr));
202852758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->head = skb;
202952758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->tail = NULL;
203052758ff7SAlok Singh list_add_tail(&tx_ppdu_info->tx_mon_mpdu->list,
203152758ff7SAlok Singh &tx_ppdu_info->dp_tx_mon_mpdu_list);
203252758ff7SAlok Singh
203352758ff7SAlok Singh return 0;
203452758ff7SAlok Singh }
203552758ff7SAlok Singh
203652758ff7SAlok Singh static int
ath12k_wifi7_dp_mon_tx_gen_ack_frame(struct dp_mon_tx_ppdu_info * tx_ppdu_info)203752758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_gen_ack_frame(struct dp_mon_tx_ppdu_info *tx_ppdu_info)
203852758ff7SAlok Singh {
203952758ff7SAlok Singh struct sk_buff *skb;
204052758ff7SAlok Singh struct dp_mon_frame_min_one *fbmhdr;
204152758ff7SAlok Singh
204252758ff7SAlok Singh skb = ath12k_wifi7_dp_mon_tx_alloc_skb();
204352758ff7SAlok Singh if (!skb)
204452758ff7SAlok Singh return -ENOMEM;
204552758ff7SAlok Singh
204652758ff7SAlok Singh fbmhdr = (struct dp_mon_frame_min_one *)skb->data;
204752758ff7SAlok Singh memset(fbmhdr, 0, MAX_DUMMY_FRM_BODY);
204852758ff7SAlok Singh fbmhdr->frame_control =
204952758ff7SAlok Singh cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_QOS_CFACK);
205052758ff7SAlok Singh memcpy(fbmhdr->addr1, tx_ppdu_info->rx_status.addr1, ETH_ALEN);
205152758ff7SAlok Singh
205252758ff7SAlok Singh /* set duration zero for ack frame */
205352758ff7SAlok Singh fbmhdr->duration = 0;
205452758ff7SAlok Singh
205552758ff7SAlok Singh skb_put(skb, sizeof(*fbmhdr));
205652758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->head = skb;
205752758ff7SAlok Singh tx_ppdu_info->tx_mon_mpdu->tail = NULL;
205852758ff7SAlok Singh list_add_tail(&tx_ppdu_info->tx_mon_mpdu->list,
205952758ff7SAlok Singh &tx_ppdu_info->dp_tx_mon_mpdu_list);
206052758ff7SAlok Singh
206152758ff7SAlok Singh return 0;
206252758ff7SAlok Singh }
206352758ff7SAlok Singh
206452758ff7SAlok Singh static int
ath12k_wifi7_dp_mon_tx_gen_prot_frame(struct dp_mon_tx_ppdu_info * tx_ppdu_info)206552758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_gen_prot_frame(struct dp_mon_tx_ppdu_info *tx_ppdu_info)
206652758ff7SAlok Singh {
206752758ff7SAlok Singh int ret = 0;
206852758ff7SAlok Singh
206952758ff7SAlok Singh switch (tx_ppdu_info->rx_status.medium_prot_type) {
207052758ff7SAlok Singh case DP_MON_TX_MEDIUM_RTS_LEGACY:
207152758ff7SAlok Singh case DP_MON_TX_MEDIUM_RTS_11AC_STATIC_BW:
207252758ff7SAlok Singh case DP_MON_TX_MEDIUM_RTS_11AC_DYNAMIC_BW:
207352758ff7SAlok Singh ret = ath12k_wifi7_dp_mon_tx_gen_rts_frame(tx_ppdu_info);
207452758ff7SAlok Singh break;
207552758ff7SAlok Singh case DP_MON_TX_MEDIUM_CTS2SELF:
207652758ff7SAlok Singh ret = ath12k_wifi7_dp_mon_tx_gen_cts2self_frame(tx_ppdu_info);
207752758ff7SAlok Singh break;
207852758ff7SAlok Singh case DP_MON_TX_MEDIUM_QOS_NULL_NO_ACK_3ADDR:
207952758ff7SAlok Singh ret = ath12k_wifi7_dp_mon_tx_gen_3addr_qos_null_frame(tx_ppdu_info);
208052758ff7SAlok Singh break;
208152758ff7SAlok Singh case DP_MON_TX_MEDIUM_QOS_NULL_NO_ACK_4ADDR:
208252758ff7SAlok Singh ret = ath12k_wifi7_dp_mon_tx_gen_4addr_qos_null_frame(tx_ppdu_info);
208352758ff7SAlok Singh break;
208452758ff7SAlok Singh }
208552758ff7SAlok Singh
208652758ff7SAlok Singh return ret;
208752758ff7SAlok Singh }
208852758ff7SAlok Singh
208952758ff7SAlok Singh static enum dp_mon_tx_tlv_status
ath12k_wifi7_dp_mon_tx_parse_status_tlv(struct ath12k_base * ab,struct ath12k_mon_data * pmon,u16 tlv_tag,const void * tlv_data,u32 userid)209052758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_parse_status_tlv(struct ath12k_base *ab,
209152758ff7SAlok Singh struct ath12k_mon_data *pmon,
209252758ff7SAlok Singh u16 tlv_tag, const void *tlv_data,
209352758ff7SAlok Singh u32 userid)
209452758ff7SAlok Singh {
209552758ff7SAlok Singh struct dp_mon_tx_ppdu_info *tx_ppdu_info;
209652758ff7SAlok Singh enum dp_mon_tx_tlv_status status = DP_MON_TX_STATUS_PPDU_NOT_DONE;
209752758ff7SAlok Singh u32 info[7];
209852758ff7SAlok Singh
209952758ff7SAlok Singh tx_ppdu_info = ath12k_wifi7_dp_mon_hal_tx_ppdu_info(pmon, tlv_tag);
210052758ff7SAlok Singh
210152758ff7SAlok Singh switch (tlv_tag) {
210252758ff7SAlok Singh case HAL_TX_FES_SETUP: {
210352758ff7SAlok Singh const struct hal_tx_fes_setup *tx_fes_setup = tlv_data;
210452758ff7SAlok Singh
210552758ff7SAlok Singh info[0] = __le32_to_cpu(tx_fes_setup->info0);
210652758ff7SAlok Singh tx_ppdu_info->ppdu_id = __le32_to_cpu(tx_fes_setup->schedule_id);
210752758ff7SAlok Singh tx_ppdu_info->num_users =
210852758ff7SAlok Singh u32_get_bits(info[0], HAL_TX_FES_SETUP_INFO0_NUM_OF_USERS);
210952758ff7SAlok Singh status = DP_MON_TX_FES_SETUP;
211052758ff7SAlok Singh break;
211152758ff7SAlok Singh }
211252758ff7SAlok Singh
211352758ff7SAlok Singh case HAL_TX_FES_STATUS_END: {
211452758ff7SAlok Singh const struct hal_tx_fes_status_end *tx_fes_status_end = tlv_data;
211552758ff7SAlok Singh u32 tst_15_0, tst_31_16;
211652758ff7SAlok Singh
211752758ff7SAlok Singh info[0] = __le32_to_cpu(tx_fes_status_end->info0);
211852758ff7SAlok Singh tst_15_0 =
211952758ff7SAlok Singh u32_get_bits(info[0],
212052758ff7SAlok Singh HAL_TX_FES_STATUS_END_INFO0_START_TIMESTAMP_15_0);
212152758ff7SAlok Singh tst_31_16 =
212252758ff7SAlok Singh u32_get_bits(info[0],
212352758ff7SAlok Singh HAL_TX_FES_STATUS_END_INFO0_START_TIMESTAMP_31_16);
212452758ff7SAlok Singh
212552758ff7SAlok Singh tx_ppdu_info->rx_status.ppdu_ts = (tst_15_0 | (tst_31_16 << 16));
212652758ff7SAlok Singh status = DP_MON_TX_FES_STATUS_END;
212752758ff7SAlok Singh break;
212852758ff7SAlok Singh }
212952758ff7SAlok Singh
213052758ff7SAlok Singh case HAL_RX_RESPONSE_REQUIRED_INFO: {
213152758ff7SAlok Singh const struct hal_rx_resp_req_info *rx_resp_req_info = tlv_data;
213252758ff7SAlok Singh u32 addr_32;
213352758ff7SAlok Singh u16 addr_16;
213452758ff7SAlok Singh
213552758ff7SAlok Singh info[0] = __le32_to_cpu(rx_resp_req_info->info0);
213652758ff7SAlok Singh info[1] = __le32_to_cpu(rx_resp_req_info->info1);
213752758ff7SAlok Singh info[2] = __le32_to_cpu(rx_resp_req_info->info2);
213852758ff7SAlok Singh info[3] = __le32_to_cpu(rx_resp_req_info->info3);
213952758ff7SAlok Singh info[4] = __le32_to_cpu(rx_resp_req_info->info4);
214052758ff7SAlok Singh info[5] = __le32_to_cpu(rx_resp_req_info->info5);
214152758ff7SAlok Singh
214252758ff7SAlok Singh tx_ppdu_info->rx_status.ppdu_id =
214352758ff7SAlok Singh u32_get_bits(info[0], HAL_RX_RESP_REQ_INFO0_PPDU_ID);
214452758ff7SAlok Singh tx_ppdu_info->rx_status.reception_type =
214552758ff7SAlok Singh u32_get_bits(info[0], HAL_RX_RESP_REQ_INFO0_RECEPTION_TYPE);
214652758ff7SAlok Singh tx_ppdu_info->rx_status.rx_duration =
214752758ff7SAlok Singh u32_get_bits(info[1], HAL_RX_RESP_REQ_INFO1_DURATION);
214852758ff7SAlok Singh tx_ppdu_info->rx_status.mcs =
214952758ff7SAlok Singh u32_get_bits(info[1], HAL_RX_RESP_REQ_INFO1_RATE_MCS);
215052758ff7SAlok Singh tx_ppdu_info->rx_status.sgi =
215152758ff7SAlok Singh u32_get_bits(info[1], HAL_RX_RESP_REQ_INFO1_SGI);
215252758ff7SAlok Singh tx_ppdu_info->rx_status.is_stbc =
215352758ff7SAlok Singh u32_get_bits(info[1], HAL_RX_RESP_REQ_INFO1_STBC);
215452758ff7SAlok Singh tx_ppdu_info->rx_status.ldpc =
215552758ff7SAlok Singh u32_get_bits(info[1], HAL_RX_RESP_REQ_INFO1_LDPC);
215652758ff7SAlok Singh tx_ppdu_info->rx_status.is_ampdu =
215752758ff7SAlok Singh u32_get_bits(info[1], HAL_RX_RESP_REQ_INFO1_IS_AMPDU);
215852758ff7SAlok Singh tx_ppdu_info->rx_status.num_users =
215952758ff7SAlok Singh u32_get_bits(info[2], HAL_RX_RESP_REQ_INFO2_NUM_USER);
216052758ff7SAlok Singh
216152758ff7SAlok Singh addr_32 = u32_get_bits(info[3], HAL_RX_RESP_REQ_INFO3_ADDR1_31_0);
216252758ff7SAlok Singh addr_16 = u32_get_bits(info[3], HAL_RX_RESP_REQ_INFO4_ADDR1_47_32);
216352758ff7SAlok Singh ath12k_dp_get_mac_addr(addr_32, addr_16, tx_ppdu_info->rx_status.addr1);
216452758ff7SAlok Singh
216552758ff7SAlok Singh addr_16 = u32_get_bits(info[4], HAL_RX_RESP_REQ_INFO4_ADDR1_15_0);
216652758ff7SAlok Singh addr_32 = u32_get_bits(info[5], HAL_RX_RESP_REQ_INFO5_ADDR1_47_16);
216752758ff7SAlok Singh ath12k_dp_get_mac_addr(addr_32, addr_16, tx_ppdu_info->rx_status.addr2);
216852758ff7SAlok Singh
216952758ff7SAlok Singh if (tx_ppdu_info->rx_status.reception_type == 0)
217052758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_gen_cts2self_frame(tx_ppdu_info);
217152758ff7SAlok Singh status = DP_MON_RX_RESPONSE_REQUIRED_INFO;
217252758ff7SAlok Singh break;
217352758ff7SAlok Singh }
217452758ff7SAlok Singh
217552758ff7SAlok Singh case HAL_PCU_PPDU_SETUP_INIT: {
217652758ff7SAlok Singh const struct hal_tx_pcu_ppdu_setup_init *ppdu_setup = tlv_data;
217752758ff7SAlok Singh u32 addr_32;
217852758ff7SAlok Singh u16 addr_16;
217952758ff7SAlok Singh
218052758ff7SAlok Singh info[0] = __le32_to_cpu(ppdu_setup->info0);
218152758ff7SAlok Singh info[1] = __le32_to_cpu(ppdu_setup->info1);
218252758ff7SAlok Singh info[2] = __le32_to_cpu(ppdu_setup->info2);
218352758ff7SAlok Singh info[3] = __le32_to_cpu(ppdu_setup->info3);
218452758ff7SAlok Singh info[4] = __le32_to_cpu(ppdu_setup->info4);
218552758ff7SAlok Singh info[5] = __le32_to_cpu(ppdu_setup->info5);
218652758ff7SAlok Singh info[6] = __le32_to_cpu(ppdu_setup->info6);
218752758ff7SAlok Singh
218852758ff7SAlok Singh /* protection frame address 1 */
218952758ff7SAlok Singh addr_32 = u32_get_bits(info[1],
219052758ff7SAlok Singh HAL_TX_PPDU_SETUP_INFO1_PROT_FRAME_ADDR1_31_0);
219152758ff7SAlok Singh addr_16 = u32_get_bits(info[2],
219252758ff7SAlok Singh HAL_TX_PPDU_SETUP_INFO2_PROT_FRAME_ADDR1_47_32);
219352758ff7SAlok Singh ath12k_dp_get_mac_addr(addr_32, addr_16, tx_ppdu_info->rx_status.addr1);
219452758ff7SAlok Singh
219552758ff7SAlok Singh /* protection frame address 2 */
219652758ff7SAlok Singh addr_16 = u32_get_bits(info[2],
219752758ff7SAlok Singh HAL_TX_PPDU_SETUP_INFO2_PROT_FRAME_ADDR2_15_0);
219852758ff7SAlok Singh addr_32 = u32_get_bits(info[3],
219952758ff7SAlok Singh HAL_TX_PPDU_SETUP_INFO3_PROT_FRAME_ADDR2_47_16);
220052758ff7SAlok Singh ath12k_dp_get_mac_addr(addr_32, addr_16, tx_ppdu_info->rx_status.addr2);
220152758ff7SAlok Singh
220252758ff7SAlok Singh /* protection frame address 3 */
220352758ff7SAlok Singh addr_32 = u32_get_bits(info[4],
220452758ff7SAlok Singh HAL_TX_PPDU_SETUP_INFO4_PROT_FRAME_ADDR3_31_0);
220552758ff7SAlok Singh addr_16 = u32_get_bits(info[5],
220652758ff7SAlok Singh HAL_TX_PPDU_SETUP_INFO5_PROT_FRAME_ADDR3_47_32);
220752758ff7SAlok Singh ath12k_dp_get_mac_addr(addr_32, addr_16, tx_ppdu_info->rx_status.addr3);
220852758ff7SAlok Singh
220952758ff7SAlok Singh /* protection frame address 4 */
221052758ff7SAlok Singh addr_16 = u32_get_bits(info[5],
221152758ff7SAlok Singh HAL_TX_PPDU_SETUP_INFO5_PROT_FRAME_ADDR4_15_0);
221252758ff7SAlok Singh addr_32 = u32_get_bits(info[6],
221352758ff7SAlok Singh HAL_TX_PPDU_SETUP_INFO6_PROT_FRAME_ADDR4_47_16);
221452758ff7SAlok Singh ath12k_dp_get_mac_addr(addr_32, addr_16, tx_ppdu_info->rx_status.addr4);
221552758ff7SAlok Singh
221652758ff7SAlok Singh status = u32_get_bits(info[0],
221752758ff7SAlok Singh HAL_TX_PPDU_SETUP_INFO0_MEDIUM_PROT_TYPE);
221852758ff7SAlok Singh break;
221952758ff7SAlok Singh }
222052758ff7SAlok Singh
222152758ff7SAlok Singh case HAL_TX_QUEUE_EXTENSION: {
222252758ff7SAlok Singh const struct hal_tx_queue_exten *tx_q_exten = tlv_data;
222352758ff7SAlok Singh
222452758ff7SAlok Singh info[0] = __le32_to_cpu(tx_q_exten->info0);
222552758ff7SAlok Singh
222652758ff7SAlok Singh tx_ppdu_info->rx_status.frame_control =
222752758ff7SAlok Singh u32_get_bits(info[0],
222852758ff7SAlok Singh HAL_TX_Q_EXT_INFO0_FRAME_CTRL);
222952758ff7SAlok Singh tx_ppdu_info->rx_status.fc_valid = true;
223052758ff7SAlok Singh break;
223152758ff7SAlok Singh }
223252758ff7SAlok Singh
223352758ff7SAlok Singh case HAL_TX_FES_STATUS_START: {
223452758ff7SAlok Singh const struct hal_tx_fes_status_start *tx_fes_start = tlv_data;
223552758ff7SAlok Singh
223652758ff7SAlok Singh info[0] = __le32_to_cpu(tx_fes_start->info0);
223752758ff7SAlok Singh
223852758ff7SAlok Singh tx_ppdu_info->rx_status.medium_prot_type =
223952758ff7SAlok Singh u32_get_bits(info[0],
224052758ff7SAlok Singh HAL_TX_FES_STATUS_START_INFO0_MEDIUM_PROT_TYPE);
224152758ff7SAlok Singh break;
224252758ff7SAlok Singh }
224352758ff7SAlok Singh
224452758ff7SAlok Singh case HAL_TX_FES_STATUS_PROT: {
224552758ff7SAlok Singh const struct hal_tx_fes_status_prot *tx_fes_status = tlv_data;
224652758ff7SAlok Singh u32 start_timestamp;
224752758ff7SAlok Singh u32 end_timestamp;
224852758ff7SAlok Singh
224952758ff7SAlok Singh info[0] = __le32_to_cpu(tx_fes_status->info0);
225052758ff7SAlok Singh info[1] = __le32_to_cpu(tx_fes_status->info1);
225152758ff7SAlok Singh
225252758ff7SAlok Singh start_timestamp =
225352758ff7SAlok Singh u32_get_bits(info[0],
225452758ff7SAlok Singh HAL_TX_FES_STAT_PROT_INFO0_STRT_FRM_TS_15_0);
225552758ff7SAlok Singh start_timestamp |=
225652758ff7SAlok Singh u32_get_bits(info[0],
225752758ff7SAlok Singh HAL_TX_FES_STAT_PROT_INFO0_STRT_FRM_TS_31_16) << 15;
225852758ff7SAlok Singh end_timestamp =
225952758ff7SAlok Singh u32_get_bits(info[1],
226052758ff7SAlok Singh HAL_TX_FES_STAT_PROT_INFO1_END_FRM_TS_15_0);
226152758ff7SAlok Singh end_timestamp |=
226252758ff7SAlok Singh u32_get_bits(info[1],
226352758ff7SAlok Singh HAL_TX_FES_STAT_PROT_INFO1_END_FRM_TS_31_16) << 15;
226452758ff7SAlok Singh tx_ppdu_info->rx_status.rx_duration = end_timestamp - start_timestamp;
226552758ff7SAlok Singh
226652758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_gen_prot_frame(tx_ppdu_info);
226752758ff7SAlok Singh break;
226852758ff7SAlok Singh }
226952758ff7SAlok Singh
227052758ff7SAlok Singh case HAL_TX_FES_STATUS_START_PPDU:
227152758ff7SAlok Singh case HAL_TX_FES_STATUS_START_PROT: {
227252758ff7SAlok Singh const struct hal_tx_fes_status_start_prot *tx_fes_stat_start = tlv_data;
227352758ff7SAlok Singh u64 ppdu_ts;
227452758ff7SAlok Singh
227552758ff7SAlok Singh info[0] = __le32_to_cpu(tx_fes_stat_start->info0);
227652758ff7SAlok Singh
227752758ff7SAlok Singh tx_ppdu_info->rx_status.ppdu_ts =
227852758ff7SAlok Singh u32_get_bits(info[0],
227952758ff7SAlok Singh HAL_TX_FES_STAT_STRT_INFO0_PROT_TS_LOWER_32);
228052758ff7SAlok Singh ppdu_ts = (u32_get_bits(info[1],
228152758ff7SAlok Singh HAL_TX_FES_STAT_STRT_INFO1_PROT_TS_UPPER_32));
228252758ff7SAlok Singh tx_ppdu_info->rx_status.ppdu_ts |= ppdu_ts << 32;
228352758ff7SAlok Singh break;
228452758ff7SAlok Singh }
228552758ff7SAlok Singh
228652758ff7SAlok Singh case HAL_TX_FES_STATUS_USER_PPDU: {
228752758ff7SAlok Singh const struct hal_tx_fes_status_user_ppdu *tx_fes_usr_ppdu = tlv_data;
228852758ff7SAlok Singh
228952758ff7SAlok Singh info[0] = __le32_to_cpu(tx_fes_usr_ppdu->info0);
229052758ff7SAlok Singh
229152758ff7SAlok Singh tx_ppdu_info->rx_status.rx_duration =
229252758ff7SAlok Singh u32_get_bits(info[0],
229352758ff7SAlok Singh HAL_TX_FES_STAT_USR_PPDU_INFO0_DURATION);
229452758ff7SAlok Singh break;
229552758ff7SAlok Singh }
229652758ff7SAlok Singh
229752758ff7SAlok Singh case HAL_MACTX_HE_SIG_A_SU:
2298dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_su(tlv_data,
2299dde5748cSAlok Singh &tx_ppdu_info->rx_status);
230052758ff7SAlok Singh break;
230152758ff7SAlok Singh
230252758ff7SAlok Singh case HAL_MACTX_HE_SIG_A_MU_DL:
2303dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_mu(tlv_data, &tx_ppdu_info->rx_status);
230452758ff7SAlok Singh break;
230552758ff7SAlok Singh
230652758ff7SAlok Singh case HAL_MACTX_HE_SIG_B1_MU:
2307dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_b1_mu(tlv_data,
2308dde5748cSAlok Singh &tx_ppdu_info->rx_status);
230952758ff7SAlok Singh break;
231052758ff7SAlok Singh
231152758ff7SAlok Singh case HAL_MACTX_HE_SIG_B2_MU:
2312dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_b2_mu(tlv_data,
2313dde5748cSAlok Singh &tx_ppdu_info->rx_status);
231452758ff7SAlok Singh break;
231552758ff7SAlok Singh
231652758ff7SAlok Singh case HAL_MACTX_HE_SIG_B2_OFDMA:
2317dde5748cSAlok Singh ath12k_wifi7_dp_mon_parse_he_sig_b2_ofdma(tlv_data,
2318dde5748cSAlok Singh &tx_ppdu_info->rx_status);
231952758ff7SAlok Singh break;
232052758ff7SAlok Singh
232152758ff7SAlok Singh case HAL_MACTX_VHT_SIG_A:
2322f4bcbaebSAlok Singh ath12k_wifi7_dp_mon_parse_vht_sig_a(tlv_data, &tx_ppdu_info->rx_status);
232352758ff7SAlok Singh break;
232452758ff7SAlok Singh
232552758ff7SAlok Singh case HAL_MACTX_L_SIG_A:
2326e5419861SAlok Singh ath12k_wifi7_dp_mon_parse_l_sig_a(tlv_data, &tx_ppdu_info->rx_status);
232752758ff7SAlok Singh break;
232852758ff7SAlok Singh
232952758ff7SAlok Singh case HAL_MACTX_L_SIG_B:
2330e5419861SAlok Singh ath12k_wifi7_dp_mon_parse_l_sig_b(tlv_data, &tx_ppdu_info->rx_status);
233152758ff7SAlok Singh break;
233252758ff7SAlok Singh
233352758ff7SAlok Singh case HAL_RX_FRAME_BITMAP_ACK: {
233452758ff7SAlok Singh const struct hal_rx_frame_bitmap_ack *fbm_ack = tlv_data;
233552758ff7SAlok Singh u32 addr_32;
233652758ff7SAlok Singh u16 addr_16;
233752758ff7SAlok Singh
233852758ff7SAlok Singh info[0] = __le32_to_cpu(fbm_ack->info0);
233952758ff7SAlok Singh info[1] = __le32_to_cpu(fbm_ack->info1);
234052758ff7SAlok Singh
234152758ff7SAlok Singh addr_32 = u32_get_bits(info[0],
234252758ff7SAlok Singh HAL_RX_FBM_ACK_INFO0_ADDR1_31_0);
234352758ff7SAlok Singh addr_16 = u32_get_bits(info[1],
234452758ff7SAlok Singh HAL_RX_FBM_ACK_INFO1_ADDR1_47_32);
234552758ff7SAlok Singh ath12k_dp_get_mac_addr(addr_32, addr_16, tx_ppdu_info->rx_status.addr1);
234652758ff7SAlok Singh
234752758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_gen_ack_frame(tx_ppdu_info);
234852758ff7SAlok Singh break;
234952758ff7SAlok Singh }
235052758ff7SAlok Singh
235152758ff7SAlok Singh case HAL_MACTX_PHY_DESC: {
235252758ff7SAlok Singh const struct hal_tx_phy_desc *tx_phy_desc = tlv_data;
235352758ff7SAlok Singh
235452758ff7SAlok Singh info[0] = __le32_to_cpu(tx_phy_desc->info0);
235552758ff7SAlok Singh info[1] = __le32_to_cpu(tx_phy_desc->info1);
235652758ff7SAlok Singh info[2] = __le32_to_cpu(tx_phy_desc->info2);
235752758ff7SAlok Singh info[3] = __le32_to_cpu(tx_phy_desc->info3);
235852758ff7SAlok Singh
235952758ff7SAlok Singh tx_ppdu_info->rx_status.beamformed =
236052758ff7SAlok Singh u32_get_bits(info[0],
236152758ff7SAlok Singh HAL_TX_PHY_DESC_INFO0_BF_TYPE);
236252758ff7SAlok Singh tx_ppdu_info->rx_status.preamble_type =
236352758ff7SAlok Singh u32_get_bits(info[0],
236452758ff7SAlok Singh HAL_TX_PHY_DESC_INFO0_PREAMBLE_11B);
236552758ff7SAlok Singh tx_ppdu_info->rx_status.mcs =
236652758ff7SAlok Singh u32_get_bits(info[1],
236752758ff7SAlok Singh HAL_TX_PHY_DESC_INFO1_MCS);
236852758ff7SAlok Singh tx_ppdu_info->rx_status.ltf_size =
236952758ff7SAlok Singh u32_get_bits(info[3],
237052758ff7SAlok Singh HAL_TX_PHY_DESC_INFO3_LTF_SIZE);
237152758ff7SAlok Singh tx_ppdu_info->rx_status.nss =
237252758ff7SAlok Singh u32_get_bits(info[2],
237352758ff7SAlok Singh HAL_TX_PHY_DESC_INFO2_NSS);
237452758ff7SAlok Singh tx_ppdu_info->rx_status.chan_num =
237552758ff7SAlok Singh u32_get_bits(info[3],
237652758ff7SAlok Singh HAL_TX_PHY_DESC_INFO3_ACTIVE_CHANNEL);
237752758ff7SAlok Singh tx_ppdu_info->rx_status.bw =
237852758ff7SAlok Singh u32_get_bits(info[0],
237952758ff7SAlok Singh HAL_TX_PHY_DESC_INFO0_BANDWIDTH);
238052758ff7SAlok Singh break;
238152758ff7SAlok Singh }
238252758ff7SAlok Singh
238352758ff7SAlok Singh case HAL_TX_MPDU_START: {
238452758ff7SAlok Singh struct dp_mon_mpdu *mon_mpdu = tx_ppdu_info->tx_mon_mpdu;
238552758ff7SAlok Singh
2386*69050f8dSKees Cook mon_mpdu = kzalloc_obj(*mon_mpdu, GFP_ATOMIC);
238752758ff7SAlok Singh if (!mon_mpdu)
238852758ff7SAlok Singh return DP_MON_TX_STATUS_PPDU_NOT_DONE;
238952758ff7SAlok Singh status = DP_MON_TX_MPDU_START;
239052758ff7SAlok Singh break;
239152758ff7SAlok Singh }
239252758ff7SAlok Singh
239352758ff7SAlok Singh case HAL_TX_MPDU_END:
239452758ff7SAlok Singh list_add_tail(&tx_ppdu_info->tx_mon_mpdu->list,
239552758ff7SAlok Singh &tx_ppdu_info->dp_tx_mon_mpdu_list);
239652758ff7SAlok Singh break;
239752758ff7SAlok Singh }
239852758ff7SAlok Singh
239952758ff7SAlok Singh return status;
240052758ff7SAlok Singh }
240152758ff7SAlok Singh
240252758ff7SAlok Singh static enum dp_mon_tx_tlv_status
ath12k_wifi7_dp_mon_tx_status_get_num_user(u16 tlv_tag,struct hal_tlv_hdr * tx_tlv,u8 * num_users)240352758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_status_get_num_user(u16 tlv_tag,
240452758ff7SAlok Singh struct hal_tlv_hdr *tx_tlv,
240552758ff7SAlok Singh u8 *num_users)
240652758ff7SAlok Singh {
240752758ff7SAlok Singh u32 tlv_status = DP_MON_TX_STATUS_PPDU_NOT_DONE;
240852758ff7SAlok Singh u32 info0;
240952758ff7SAlok Singh
241052758ff7SAlok Singh switch (tlv_tag) {
241152758ff7SAlok Singh case HAL_TX_FES_SETUP: {
241252758ff7SAlok Singh struct hal_tx_fes_setup *tx_fes_setup =
241352758ff7SAlok Singh (struct hal_tx_fes_setup *)tx_tlv;
241452758ff7SAlok Singh
241552758ff7SAlok Singh info0 = __le32_to_cpu(tx_fes_setup->info0);
241652758ff7SAlok Singh
241752758ff7SAlok Singh *num_users = u32_get_bits(info0, HAL_TX_FES_SETUP_INFO0_NUM_OF_USERS);
241852758ff7SAlok Singh tlv_status = DP_MON_TX_FES_SETUP;
241952758ff7SAlok Singh break;
242052758ff7SAlok Singh }
242152758ff7SAlok Singh
242252758ff7SAlok Singh case HAL_RX_RESPONSE_REQUIRED_INFO: {
242352758ff7SAlok Singh /* TODO: need to update *num_users */
242452758ff7SAlok Singh tlv_status = DP_MON_RX_RESPONSE_REQUIRED_INFO;
242552758ff7SAlok Singh break;
242652758ff7SAlok Singh }
242752758ff7SAlok Singh }
242852758ff7SAlok Singh
242952758ff7SAlok Singh return tlv_status;
243052758ff7SAlok Singh }
243152758ff7SAlok Singh
24327cd7392aSAlok Singh static int
ath12k_wifi7_dp_mon_rx_deliver(struct ath12k_pdev_dp * dp_pdev,struct dp_mon_mpdu * mon_mpdu,struct hal_rx_mon_ppdu_info * ppduinfo,struct napi_struct * napi)24337cd7392aSAlok Singh ath12k_wifi7_dp_mon_rx_deliver(struct ath12k_pdev_dp *dp_pdev,
24347cd7392aSAlok Singh struct dp_mon_mpdu *mon_mpdu,
24357cd7392aSAlok Singh struct hal_rx_mon_ppdu_info *ppduinfo,
24367cd7392aSAlok Singh struct napi_struct *napi)
24377cd7392aSAlok Singh {
24387cd7392aSAlok Singh struct sk_buff *mon_skb, *skb_next, *header;
24397cd7392aSAlok Singh struct ieee80211_rx_status *rxs = &dp_pdev->rx_status;
24407cd7392aSAlok Singh u8 decap = DP_RX_DECAP_TYPE_RAW;
24417cd7392aSAlok Singh
24427cd7392aSAlok Singh mon_skb = ath12k_dp_mon_rx_merg_msdus(dp_pdev, mon_mpdu, ppduinfo, rxs);
24437cd7392aSAlok Singh if (!mon_skb)
24447cd7392aSAlok Singh goto mon_deliver_fail;
24457cd7392aSAlok Singh
24467cd7392aSAlok Singh header = mon_skb;
24477cd7392aSAlok Singh rxs->flag = 0;
24487cd7392aSAlok Singh
24497cd7392aSAlok Singh if (mon_mpdu->err_bitmap & HAL_RX_MPDU_ERR_FCS)
24507cd7392aSAlok Singh rxs->flag = RX_FLAG_FAILED_FCS_CRC;
24517cd7392aSAlok Singh
24527cd7392aSAlok Singh do {
24537cd7392aSAlok Singh skb_next = mon_skb->next;
24547cd7392aSAlok Singh if (!skb_next)
24557cd7392aSAlok Singh rxs->flag &= ~RX_FLAG_AMSDU_MORE;
24567cd7392aSAlok Singh else
24577cd7392aSAlok Singh rxs->flag |= RX_FLAG_AMSDU_MORE;
24587cd7392aSAlok Singh
24597cd7392aSAlok Singh if (mon_skb == header) {
24607cd7392aSAlok Singh header = NULL;
24617cd7392aSAlok Singh rxs->flag &= ~RX_FLAG_ALLOW_SAME_PN;
24627cd7392aSAlok Singh } else {
24637cd7392aSAlok Singh rxs->flag |= RX_FLAG_ALLOW_SAME_PN;
24647cd7392aSAlok Singh }
24657cd7392aSAlok Singh rxs->flag |= RX_FLAG_ONLY_MONITOR;
24667cd7392aSAlok Singh
24677cd7392aSAlok Singh if (!(rxs->flag & RX_FLAG_ONLY_MONITOR))
24687cd7392aSAlok Singh decap = mon_mpdu->decap_format;
24697cd7392aSAlok Singh
24707cd7392aSAlok Singh ath12k_dp_mon_update_radiotap(dp_pdev, ppduinfo, mon_skb, rxs);
2471631ee338SJeff Johnson ath12k_dp_mon_rx_deliver_msdu(dp_pdev, napi, mon_skb, ppduinfo,
2472631ee338SJeff Johnson rxs, decap);
24737cd7392aSAlok Singh mon_skb = skb_next;
24747cd7392aSAlok Singh } while (mon_skb);
24757cd7392aSAlok Singh rxs->flag = 0;
24767cd7392aSAlok Singh
24777cd7392aSAlok Singh return 0;
24787cd7392aSAlok Singh
24797cd7392aSAlok Singh mon_deliver_fail:
24807cd7392aSAlok Singh mon_skb = mon_mpdu->head;
24817cd7392aSAlok Singh while (mon_skb) {
24827cd7392aSAlok Singh skb_next = mon_skb->next;
24837cd7392aSAlok Singh dev_kfree_skb_any(mon_skb);
24847cd7392aSAlok Singh mon_skb = skb_next;
24857cd7392aSAlok Singh }
24867cd7392aSAlok Singh return -EINVAL;
24877cd7392aSAlok Singh }
24887cd7392aSAlok Singh
248952758ff7SAlok Singh static void
ath12k_wifi7_dp_mon_tx_process_ppdu_info(struct ath12k_pdev_dp * dp_pdev,struct napi_struct * napi,struct dp_mon_tx_ppdu_info * tx_ppdu_info)249052758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_process_ppdu_info(struct ath12k_pdev_dp *dp_pdev,
249152758ff7SAlok Singh struct napi_struct *napi,
249252758ff7SAlok Singh struct dp_mon_tx_ppdu_info *tx_ppdu_info)
249352758ff7SAlok Singh {
249452758ff7SAlok Singh struct dp_mon_mpdu *tmp, *mon_mpdu;
249552758ff7SAlok Singh
249652758ff7SAlok Singh list_for_each_entry_safe(mon_mpdu, tmp,
249752758ff7SAlok Singh &tx_ppdu_info->dp_tx_mon_mpdu_list, list) {
249852758ff7SAlok Singh list_del(&mon_mpdu->list);
249952758ff7SAlok Singh
250052758ff7SAlok Singh if (mon_mpdu->head)
25017cd7392aSAlok Singh ath12k_wifi7_dp_mon_rx_deliver(dp_pdev, mon_mpdu,
250252758ff7SAlok Singh &tx_ppdu_info->rx_status, napi);
250352758ff7SAlok Singh
250452758ff7SAlok Singh kfree(mon_mpdu);
250552758ff7SAlok Singh }
250652758ff7SAlok Singh }
250752758ff7SAlok Singh
250852758ff7SAlok Singh enum hal_rx_mon_status
ath12k_wifi7_dp_mon_tx_parse_mon_status(struct ath12k_pdev_dp * dp_pdev,struct ath12k_mon_data * pmon,struct sk_buff * skb,struct napi_struct * napi,u32 ppdu_id)250952758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_parse_mon_status(struct ath12k_pdev_dp *dp_pdev,
251052758ff7SAlok Singh struct ath12k_mon_data *pmon,
251152758ff7SAlok Singh struct sk_buff *skb,
251252758ff7SAlok Singh struct napi_struct *napi,
251352758ff7SAlok Singh u32 ppdu_id)
251452758ff7SAlok Singh {
251552758ff7SAlok Singh struct ath12k_dp *dp = dp_pdev->dp;
251652758ff7SAlok Singh struct ath12k_base *ab = dp->ab;
251752758ff7SAlok Singh struct dp_mon_tx_ppdu_info *tx_prot_ppdu_info, *tx_data_ppdu_info;
251852758ff7SAlok Singh struct hal_tlv_hdr *tlv;
251952758ff7SAlok Singh u8 *ptr = skb->data;
252052758ff7SAlok Singh u16 tlv_tag;
252152758ff7SAlok Singh u16 tlv_len;
252252758ff7SAlok Singh u32 tlv_userid = 0;
252352758ff7SAlok Singh u8 num_user;
252452758ff7SAlok Singh u32 tlv_status = DP_MON_TX_STATUS_PPDU_NOT_DONE;
252552758ff7SAlok Singh
252652758ff7SAlok Singh tx_prot_ppdu_info =
252752758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_get_ppdu_info(pmon, ppdu_id,
252852758ff7SAlok Singh DP_MON_TX_PROT_PPDU_INFO);
252952758ff7SAlok Singh if (!tx_prot_ppdu_info)
253052758ff7SAlok Singh return -ENOMEM;
253152758ff7SAlok Singh
253252758ff7SAlok Singh tlv = (struct hal_tlv_hdr *)ptr;
253352758ff7SAlok Singh tlv_tag = le32_get_bits(tlv->tl, HAL_TLV_HDR_TAG);
253452758ff7SAlok Singh
253552758ff7SAlok Singh tlv_status = ath12k_wifi7_dp_mon_tx_status_get_num_user(tlv_tag, tlv,
253652758ff7SAlok Singh &num_user);
253752758ff7SAlok Singh if (tlv_status == DP_MON_TX_STATUS_PPDU_NOT_DONE || !num_user)
253852758ff7SAlok Singh return -EINVAL;
253952758ff7SAlok Singh
254052758ff7SAlok Singh tx_data_ppdu_info =
254152758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_get_ppdu_info(pmon, ppdu_id,
254252758ff7SAlok Singh DP_MON_TX_DATA_PPDU_INFO);
254352758ff7SAlok Singh if (!tx_data_ppdu_info)
254452758ff7SAlok Singh return -ENOMEM;
254552758ff7SAlok Singh
254652758ff7SAlok Singh do {
254752758ff7SAlok Singh tlv = (struct hal_tlv_hdr *)ptr;
254852758ff7SAlok Singh tlv_tag = le32_get_bits(tlv->tl, HAL_TLV_HDR_TAG);
254952758ff7SAlok Singh tlv_len = le32_get_bits(tlv->tl, HAL_TLV_HDR_LEN);
255052758ff7SAlok Singh tlv_userid = le32_get_bits(tlv->tl, HAL_TLV_USR_ID);
255152758ff7SAlok Singh
255252758ff7SAlok Singh tlv_status = ath12k_wifi7_dp_mon_tx_parse_status_tlv(ab, pmon,
255352758ff7SAlok Singh tlv_tag, ptr,
255452758ff7SAlok Singh tlv_userid);
255552758ff7SAlok Singh ptr += tlv_len;
255652758ff7SAlok Singh ptr = PTR_ALIGN(ptr, HAL_TLV_ALIGN);
255752758ff7SAlok Singh if ((ptr - skb->data) >= DP_TX_MONITOR_BUF_SIZE)
255852758ff7SAlok Singh break;
255952758ff7SAlok Singh } while (tlv_status != DP_MON_TX_FES_STATUS_END);
256052758ff7SAlok Singh
256152758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_process_ppdu_info(dp_pdev, napi, tx_data_ppdu_info);
256252758ff7SAlok Singh ath12k_wifi7_dp_mon_tx_process_ppdu_info(dp_pdev, napi, tx_prot_ppdu_info);
256352758ff7SAlok Singh
256452758ff7SAlok Singh return tlv_status;
256552758ff7SAlok Singh }
256652758ff7SAlok Singh
2567965aea91SAlok Singh static void
ath12k_wifi7_dp_mon_next_link_desc_get(struct ath12k_base * ab,struct hal_rx_msdu_link * msdu_link,dma_addr_t * paddr,u32 * sw_cookie,u8 * rbm,struct ath12k_buffer_addr ** pp_buf_addr_info)2568965aea91SAlok Singh ath12k_wifi7_dp_mon_next_link_desc_get(struct ath12k_base *ab,
2569965aea91SAlok Singh struct hal_rx_msdu_link *msdu_link,
2570965aea91SAlok Singh dma_addr_t *paddr, u32 *sw_cookie, u8 *rbm,
2571965aea91SAlok Singh struct ath12k_buffer_addr **pp_buf_addr_info)
2572965aea91SAlok Singh {
2573965aea91SAlok Singh struct ath12k_buffer_addr *buf_addr_info;
2574965aea91SAlok Singh
2575965aea91SAlok Singh buf_addr_info = &msdu_link->buf_addr_info;
2576965aea91SAlok Singh
2577965aea91SAlok Singh ath12k_wifi7_hal_rx_buf_addr_info_get(buf_addr_info, paddr, sw_cookie, rbm);
2578965aea91SAlok Singh
2579965aea91SAlok Singh *pp_buf_addr_info = buf_addr_info;
2580965aea91SAlok Singh }
2581965aea91SAlok Singh
2582906b5ac9SAlok Singh static u32
ath12k_wifi7_dp_rx_mon_mpdu_pop(struct ath12k * ar,int mac_id,void * ring_entry,struct sk_buff ** head_msdu,struct sk_buff ** tail_msdu,struct list_head * used_list,u32 * npackets,u32 * ppdu_id)2583906b5ac9SAlok Singh ath12k_wifi7_dp_rx_mon_mpdu_pop(struct ath12k *ar, int mac_id,
2584906b5ac9SAlok Singh void *ring_entry, struct sk_buff **head_msdu,
2585906b5ac9SAlok Singh struct sk_buff **tail_msdu,
2586906b5ac9SAlok Singh struct list_head *used_list,
2587906b5ac9SAlok Singh u32 *npackets, u32 *ppdu_id)
2588906b5ac9SAlok Singh {
2589906b5ac9SAlok Singh struct ath12k_mon_data *pmon = (struct ath12k_mon_data *)&ar->dp.mon_data;
2590906b5ac9SAlok Singh struct ath12k_base *ab = ar->ab;
2591906b5ac9SAlok Singh struct ath12k_dp *dp = ath12k_ab_to_dp(ab);
2592906b5ac9SAlok Singh struct ath12k_buffer_addr *p_buf_addr_info, *p_last_buf_addr_info;
2593906b5ac9SAlok Singh u32 msdu_ppdu_id = 0, msdu_cnt = 0, total_len = 0, frag_len = 0;
2594906b5ac9SAlok Singh u32 rx_buf_size, rx_pkt_offset, sw_cookie;
2595906b5ac9SAlok Singh bool is_frag, is_first_msdu, drop_mpdu = false;
2596906b5ac9SAlok Singh struct hal_reo_entrance_ring *ent_desc =
2597906b5ac9SAlok Singh (struct hal_reo_entrance_ring *)ring_entry;
2598906b5ac9SAlok Singh u32 rx_bufs_used = 0, i = 0, desc_bank = 0;
2599906b5ac9SAlok Singh struct hal_rx_desc *rx_desc, *tail_rx_desc;
2600906b5ac9SAlok Singh struct hal_rx_msdu_link *msdu_link_desc;
2601906b5ac9SAlok Singh struct sk_buff *msdu = NULL, *last = NULL;
2602906b5ac9SAlok Singh struct ath12k_rx_desc_info *desc_info;
2603906b5ac9SAlok Singh struct ath12k_buffer_addr buf_info;
2604906b5ac9SAlok Singh struct hal_rx_msdu_list msdu_list;
2605906b5ac9SAlok Singh struct ath12k_skb_rxcb *rxcb;
2606906b5ac9SAlok Singh u16 num_msdus = 0;
2607906b5ac9SAlok Singh dma_addr_t paddr;
2608906b5ac9SAlok Singh u8 rbm;
2609906b5ac9SAlok Singh
2610906b5ac9SAlok Singh ath12k_wifi7_hal_rx_reo_ent_buf_paddr_get(ring_entry, &paddr,
2611906b5ac9SAlok Singh &sw_cookie,
2612906b5ac9SAlok Singh &p_last_buf_addr_info,
2613906b5ac9SAlok Singh &rbm,
2614906b5ac9SAlok Singh &msdu_cnt);
2615906b5ac9SAlok Singh
2616906b5ac9SAlok Singh spin_lock_bh(&pmon->mon_lock);
2617906b5ac9SAlok Singh
2618906b5ac9SAlok Singh if (le32_get_bits(ent_desc->info1,
2619906b5ac9SAlok Singh HAL_REO_ENTR_RING_INFO1_RXDMA_PUSH_REASON) ==
2620906b5ac9SAlok Singh HAL_REO_DEST_RING_PUSH_REASON_ERR_DETECTED) {
2621906b5ac9SAlok Singh u8 rxdma_err = le32_get_bits(ent_desc->info1,
2622906b5ac9SAlok Singh HAL_REO_ENTR_RING_INFO1_RXDMA_ERROR_CODE);
2623906b5ac9SAlok Singh if (rxdma_err == HAL_REO_ENTR_RING_RXDMA_ECODE_FLUSH_REQUEST_ERR ||
2624906b5ac9SAlok Singh rxdma_err == HAL_REO_ENTR_RING_RXDMA_ECODE_MPDU_LEN_ERR ||
2625906b5ac9SAlok Singh rxdma_err == HAL_REO_ENTR_RING_RXDMA_ECODE_OVERFLOW_ERR) {
2626906b5ac9SAlok Singh drop_mpdu = true;
2627906b5ac9SAlok Singh pmon->rx_mon_stats.dest_mpdu_drop++;
2628906b5ac9SAlok Singh }
2629906b5ac9SAlok Singh }
2630906b5ac9SAlok Singh
2631906b5ac9SAlok Singh is_frag = false;
2632906b5ac9SAlok Singh is_first_msdu = true;
2633906b5ac9SAlok Singh rx_pkt_offset = sizeof(struct hal_rx_desc);
2634906b5ac9SAlok Singh
2635906b5ac9SAlok Singh do {
2636906b5ac9SAlok Singh if (pmon->mon_last_linkdesc_paddr == paddr) {
2637906b5ac9SAlok Singh pmon->rx_mon_stats.dup_mon_linkdesc_cnt++;
2638906b5ac9SAlok Singh spin_unlock_bh(&pmon->mon_lock);
2639906b5ac9SAlok Singh return rx_bufs_used;
2640906b5ac9SAlok Singh }
2641906b5ac9SAlok Singh
2642906b5ac9SAlok Singh desc_bank = u32_get_bits(sw_cookie, DP_LINK_DESC_BANK_MASK);
2643906b5ac9SAlok Singh msdu_link_desc =
2644906b5ac9SAlok Singh dp->link_desc_banks[desc_bank].vaddr +
2645906b5ac9SAlok Singh (paddr - dp->link_desc_banks[desc_bank].paddr);
2646906b5ac9SAlok Singh
2647906b5ac9SAlok Singh ath12k_wifi7_hal_rx_msdu_list_get(ar, msdu_link_desc, &msdu_list,
2648906b5ac9SAlok Singh &num_msdus);
2649906b5ac9SAlok Singh desc_info = ath12k_dp_get_rx_desc(ar->ab->dp,
2650906b5ac9SAlok Singh msdu_list.sw_cookie[num_msdus - 1]);
2651906b5ac9SAlok Singh tail_rx_desc = (struct hal_rx_desc *)(desc_info->skb)->data;
2652906b5ac9SAlok Singh
2653906b5ac9SAlok Singh for (i = 0; i < num_msdus; i++) {
2654906b5ac9SAlok Singh u32 l2_hdr_offset;
2655906b5ac9SAlok Singh
2656906b5ac9SAlok Singh if (pmon->mon_last_buf_cookie == msdu_list.sw_cookie[i]) {
2657906b5ac9SAlok Singh ath12k_dbg(ar->ab, ATH12K_DBG_DATA,
2658906b5ac9SAlok Singh "i %d last_cookie %d is same\n",
2659906b5ac9SAlok Singh i, pmon->mon_last_buf_cookie);
2660906b5ac9SAlok Singh drop_mpdu = true;
2661906b5ac9SAlok Singh pmon->rx_mon_stats.dup_mon_buf_cnt++;
2662906b5ac9SAlok Singh continue;
2663906b5ac9SAlok Singh }
2664906b5ac9SAlok Singh
2665906b5ac9SAlok Singh desc_info =
2666906b5ac9SAlok Singh ath12k_dp_get_rx_desc(ar->ab->dp, msdu_list.sw_cookie[i]);
2667906b5ac9SAlok Singh msdu = desc_info->skb;
2668906b5ac9SAlok Singh
2669906b5ac9SAlok Singh if (!msdu) {
2670906b5ac9SAlok Singh ath12k_dbg(ar->ab, ATH12K_DBG_DATA,
2671906b5ac9SAlok Singh "msdu_pop: invalid msdu (%d/%d)\n",
2672906b5ac9SAlok Singh i + 1, num_msdus);
2673906b5ac9SAlok Singh goto next_msdu;
2674906b5ac9SAlok Singh }
2675906b5ac9SAlok Singh rxcb = ATH12K_SKB_RXCB(msdu);
2676906b5ac9SAlok Singh if (rxcb->paddr != msdu_list.paddr[i]) {
2677906b5ac9SAlok Singh ath12k_dbg(ar->ab, ATH12K_DBG_DATA,
2678906b5ac9SAlok Singh "i %d paddr %lx != %lx\n",
2679906b5ac9SAlok Singh i, (unsigned long)rxcb->paddr,
2680906b5ac9SAlok Singh (unsigned long)msdu_list.paddr[i]);
2681906b5ac9SAlok Singh drop_mpdu = true;
2682906b5ac9SAlok Singh continue;
2683906b5ac9SAlok Singh }
2684906b5ac9SAlok Singh if (!rxcb->unmapped) {
2685906b5ac9SAlok Singh dma_unmap_single(ar->ab->dev, rxcb->paddr,
2686906b5ac9SAlok Singh msdu->len +
2687906b5ac9SAlok Singh skb_tailroom(msdu),
2688906b5ac9SAlok Singh DMA_FROM_DEVICE);
2689906b5ac9SAlok Singh rxcb->unmapped = 1;
2690906b5ac9SAlok Singh }
2691906b5ac9SAlok Singh if (drop_mpdu) {
2692906b5ac9SAlok Singh ath12k_dbg(ar->ab, ATH12K_DBG_DATA,
2693906b5ac9SAlok Singh "i %d drop msdu %p *ppdu_id %x\n",
2694906b5ac9SAlok Singh i, msdu, *ppdu_id);
2695906b5ac9SAlok Singh dev_kfree_skb_any(msdu);
2696906b5ac9SAlok Singh msdu = NULL;
2697906b5ac9SAlok Singh goto next_msdu;
2698906b5ac9SAlok Singh }
2699906b5ac9SAlok Singh
2700906b5ac9SAlok Singh rx_desc = (struct hal_rx_desc *)msdu->data;
2701906b5ac9SAlok Singh l2_hdr_offset = ath12k_dp_rx_h_l3pad(ar->ab, tail_rx_desc);
2702906b5ac9SAlok Singh if (is_first_msdu) {
2703906b5ac9SAlok Singh if (!ath12k_wifi7_dp_rxdesc_mpdu_valid(ar->ab,
2704906b5ac9SAlok Singh rx_desc)) {
2705906b5ac9SAlok Singh drop_mpdu = true;
2706906b5ac9SAlok Singh dev_kfree_skb_any(msdu);
2707906b5ac9SAlok Singh msdu = NULL;
2708906b5ac9SAlok Singh pmon->mon_last_linkdesc_paddr = paddr;
2709906b5ac9SAlok Singh goto next_msdu;
2710906b5ac9SAlok Singh }
2711906b5ac9SAlok Singh msdu_ppdu_id =
2712906b5ac9SAlok Singh ath12k_dp_rxdesc_get_ppduid(ar->ab, rx_desc);
2713906b5ac9SAlok Singh
2714906b5ac9SAlok Singh if (ath12k_dp_mon_comp_ppduid(msdu_ppdu_id,
2715906b5ac9SAlok Singh ppdu_id)) {
2716906b5ac9SAlok Singh spin_unlock_bh(&pmon->mon_lock);
2717906b5ac9SAlok Singh return rx_bufs_used;
2718906b5ac9SAlok Singh }
2719906b5ac9SAlok Singh pmon->mon_last_linkdesc_paddr = paddr;
2720906b5ac9SAlok Singh is_first_msdu = false;
2721906b5ac9SAlok Singh }
27227cd7392aSAlok Singh ath12k_wifi7_dp_mon_get_buf_len(&msdu_list.msdu_info[i],
2723906b5ac9SAlok Singh &is_frag, &total_len,
2724906b5ac9SAlok Singh &frag_len, &msdu_cnt);
2725906b5ac9SAlok Singh rx_buf_size = rx_pkt_offset + l2_hdr_offset + frag_len;
2726906b5ac9SAlok Singh
2727906b5ac9SAlok Singh if (ath12k_dp_pkt_set_pktlen(msdu, rx_buf_size)) {
2728906b5ac9SAlok Singh dev_kfree_skb_any(msdu);
2729906b5ac9SAlok Singh goto next_msdu;
2730906b5ac9SAlok Singh }
2731906b5ac9SAlok Singh
2732906b5ac9SAlok Singh if (!(*head_msdu))
2733906b5ac9SAlok Singh *head_msdu = msdu;
2734906b5ac9SAlok Singh else if (last)
2735906b5ac9SAlok Singh last->next = msdu;
2736906b5ac9SAlok Singh
2737906b5ac9SAlok Singh last = msdu;
2738906b5ac9SAlok Singh next_msdu:
2739906b5ac9SAlok Singh pmon->mon_last_buf_cookie = msdu_list.sw_cookie[i];
2740906b5ac9SAlok Singh rx_bufs_used++;
2741906b5ac9SAlok Singh desc_info->skb = NULL;
2742906b5ac9SAlok Singh list_add_tail(&desc_info->list, used_list);
2743906b5ac9SAlok Singh }
2744906b5ac9SAlok Singh
2745906b5ac9SAlok Singh ath12k_wifi7_hal_rx_buf_addr_info_set(&buf_info, paddr,
2746906b5ac9SAlok Singh sw_cookie, rbm);
2747906b5ac9SAlok Singh
2748965aea91SAlok Singh ath12k_wifi7_dp_mon_next_link_desc_get(ab,
2749965aea91SAlok Singh msdu_link_desc, &paddr,
2750906b5ac9SAlok Singh &sw_cookie, &rbm,
2751906b5ac9SAlok Singh &p_buf_addr_info);
2752906b5ac9SAlok Singh
2753906b5ac9SAlok Singh ath12k_dp_arch_rx_link_desc_return(ar->ab->dp, &buf_info,
2754906b5ac9SAlok Singh HAL_WBM_REL_BM_ACT_PUT_IN_IDLE);
2755906b5ac9SAlok Singh
2756906b5ac9SAlok Singh p_last_buf_addr_info = p_buf_addr_info;
2757906b5ac9SAlok Singh
2758906b5ac9SAlok Singh } while (paddr && msdu_cnt);
2759906b5ac9SAlok Singh
2760906b5ac9SAlok Singh spin_unlock_bh(&pmon->mon_lock);
2761906b5ac9SAlok Singh
2762906b5ac9SAlok Singh if (last)
2763906b5ac9SAlok Singh last->next = NULL;
2764906b5ac9SAlok Singh
2765906b5ac9SAlok Singh *tail_msdu = msdu;
2766906b5ac9SAlok Singh
2767906b5ac9SAlok Singh if (msdu_cnt == 0)
2768906b5ac9SAlok Singh *npackets = 1;
2769906b5ac9SAlok Singh
2770906b5ac9SAlok Singh return rx_bufs_used;
2771906b5ac9SAlok Singh }
2772906b5ac9SAlok Singh
2773e0016465SAlok Singh /* The destination ring processing is stuck if the destination is not
2774e0016465SAlok Singh * moving while status ring moves 16 PPDU. The destination ring processing
2775e0016465SAlok Singh * skips this destination ring PPDU as a workaround.
2776e0016465SAlok Singh */
2777e0016465SAlok Singh #define MON_DEST_RING_STUCK_MAX_CNT 16
2778e0016465SAlok Singh
2779e0016465SAlok Singh static void
ath12k_wifi7_dp_rx_mon_dest_process(struct ath12k * ar,int mac_id,u32 quota,struct napi_struct * napi)2780e0016465SAlok Singh ath12k_wifi7_dp_rx_mon_dest_process(struct ath12k *ar, int mac_id,
2781e0016465SAlok Singh u32 quota, struct napi_struct *napi)
2782e0016465SAlok Singh {
2783e0016465SAlok Singh struct ath12k_mon_data *pmon = (struct ath12k_mon_data *)&ar->dp.mon_data;
2784e0016465SAlok Singh struct ath12k_pdev_mon_stats *rx_mon_stats;
2785e0016465SAlok Singh u32 ppdu_id, rx_bufs_used = 0, ring_id;
2786e0016465SAlok Singh u32 mpdu_rx_bufs_used, npackets = 0;
2787e0016465SAlok Singh struct ath12k_base *ab = ar->ab;
2788e0016465SAlok Singh struct ath12k_dp *dp = ath12k_ab_to_dp(ab);
2789e0016465SAlok Singh void *ring_entry, *mon_dst_srng;
2790e0016465SAlok Singh struct dp_mon_mpdu *tmp_mpdu;
2791e0016465SAlok Singh LIST_HEAD(rx_desc_used_list);
2792e0016465SAlok Singh struct hal_srng *srng;
2793e0016465SAlok Singh
2794e0016465SAlok Singh ring_id = dp->rxdma_err_dst_ring[mac_id].ring_id;
2795e0016465SAlok Singh srng = &ab->hal.srng_list[ring_id];
2796e0016465SAlok Singh
2797e0016465SAlok Singh mon_dst_srng = &ab->hal.srng_list[ring_id];
2798e0016465SAlok Singh
2799e0016465SAlok Singh spin_lock_bh(&srng->lock);
2800e0016465SAlok Singh
2801e0016465SAlok Singh ath12k_hal_srng_access_begin(ab, mon_dst_srng);
2802e0016465SAlok Singh
2803e0016465SAlok Singh ppdu_id = pmon->mon_ppdu_info.ppdu_id;
2804e0016465SAlok Singh rx_mon_stats = &pmon->rx_mon_stats;
2805e0016465SAlok Singh
2806e0016465SAlok Singh while ((ring_entry = ath12k_hal_srng_dst_peek(ar->ab, mon_dst_srng))) {
2807e0016465SAlok Singh struct sk_buff *head_msdu, *tail_msdu;
2808e0016465SAlok Singh
2809e0016465SAlok Singh head_msdu = NULL;
2810e0016465SAlok Singh tail_msdu = NULL;
2811e0016465SAlok Singh
2812906b5ac9SAlok Singh mpdu_rx_bufs_used = ath12k_wifi7_dp_rx_mon_mpdu_pop(ar, mac_id,
2813906b5ac9SAlok Singh ring_entry,
2814906b5ac9SAlok Singh &head_msdu,
2815906b5ac9SAlok Singh &tail_msdu,
2816e0016465SAlok Singh &rx_desc_used_list,
2817906b5ac9SAlok Singh &npackets,
2818906b5ac9SAlok Singh &ppdu_id);
2819e0016465SAlok Singh
2820e0016465SAlok Singh rx_bufs_used += mpdu_rx_bufs_used;
2821e0016465SAlok Singh
2822e0016465SAlok Singh if (mpdu_rx_bufs_used) {
2823e0016465SAlok Singh dp->mon_dest_ring_stuck_cnt = 0;
2824e0016465SAlok Singh } else {
2825e0016465SAlok Singh dp->mon_dest_ring_stuck_cnt++;
2826e0016465SAlok Singh rx_mon_stats->dest_mon_not_reaped++;
2827e0016465SAlok Singh }
2828e0016465SAlok Singh
2829e0016465SAlok Singh if (dp->mon_dest_ring_stuck_cnt > MON_DEST_RING_STUCK_MAX_CNT) {
2830e0016465SAlok Singh rx_mon_stats->dest_mon_stuck++;
2831e0016465SAlok Singh ath12k_dbg(ar->ab, ATH12K_DBG_DATA,
2832e0016465SAlok Singh "status ring ppdu_id=%d dest ring ppdu_id=%d mon_dest_ring_stuck_cnt=%d dest_mon_not_reaped=%u dest_mon_stuck=%u\n",
2833e0016465SAlok Singh pmon->mon_ppdu_info.ppdu_id, ppdu_id,
2834e0016465SAlok Singh dp->mon_dest_ring_stuck_cnt,
2835e0016465SAlok Singh rx_mon_stats->dest_mon_not_reaped,
2836e0016465SAlok Singh rx_mon_stats->dest_mon_stuck);
2837e0016465SAlok Singh spin_lock_bh(&pmon->mon_lock);
2838e0016465SAlok Singh pmon->mon_ppdu_info.ppdu_id = ppdu_id;
2839e0016465SAlok Singh spin_unlock_bh(&pmon->mon_lock);
2840e0016465SAlok Singh continue;
2841e0016465SAlok Singh }
2842e0016465SAlok Singh
2843e0016465SAlok Singh if (ppdu_id != pmon->mon_ppdu_info.ppdu_id) {
2844e0016465SAlok Singh spin_lock_bh(&pmon->mon_lock);
2845e0016465SAlok Singh pmon->mon_ppdu_status = DP_PPDU_STATUS_START;
2846e0016465SAlok Singh spin_unlock_bh(&pmon->mon_lock);
2847e0016465SAlok Singh ath12k_dbg(ar->ab, ATH12K_DBG_DATA,
2848e0016465SAlok Singh "dest_rx: new ppdu_id %x != status ppdu_id %x dest_mon_not_reaped = %u dest_mon_stuck = %u\n",
2849e0016465SAlok Singh ppdu_id, pmon->mon_ppdu_info.ppdu_id,
2850e0016465SAlok Singh rx_mon_stats->dest_mon_not_reaped,
2851e0016465SAlok Singh rx_mon_stats->dest_mon_stuck);
2852e0016465SAlok Singh break;
2853e0016465SAlok Singh }
2854e0016465SAlok Singh
2855e0016465SAlok Singh if (head_msdu && tail_msdu) {
2856*69050f8dSKees Cook tmp_mpdu = kzalloc_obj(*tmp_mpdu, GFP_ATOMIC);
2857e0016465SAlok Singh if (!tmp_mpdu)
2858e0016465SAlok Singh break;
2859e0016465SAlok Singh
2860e0016465SAlok Singh tmp_mpdu->head = head_msdu;
2861e0016465SAlok Singh tmp_mpdu->tail = tail_msdu;
2862e0016465SAlok Singh tmp_mpdu->err_bitmap = pmon->err_bitmap;
2863e0016465SAlok Singh tmp_mpdu->decap_format = pmon->decap_format;
28647cd7392aSAlok Singh ath12k_wifi7_dp_mon_rx_deliver(&ar->dp, tmp_mpdu,
2865e0016465SAlok Singh &pmon->mon_ppdu_info, napi);
2866e0016465SAlok Singh rx_mon_stats->dest_mpdu_done++;
2867e0016465SAlok Singh kfree(tmp_mpdu);
2868e0016465SAlok Singh }
2869e0016465SAlok Singh
2870e0016465SAlok Singh ring_entry = ath12k_hal_srng_dst_get_next_entry(ar->ab,
2871e0016465SAlok Singh mon_dst_srng);
2872e0016465SAlok Singh }
2873e0016465SAlok Singh ath12k_hal_srng_access_end(ar->ab, mon_dst_srng);
2874e0016465SAlok Singh
2875e0016465SAlok Singh spin_unlock_bh(&srng->lock);
2876e0016465SAlok Singh
2877e0016465SAlok Singh if (rx_bufs_used) {
2878e0016465SAlok Singh rx_mon_stats->dest_ppdu_done++;
2879e0016465SAlok Singh ath12k_dp_rx_bufs_replenish(ar->ab->dp,
2880e0016465SAlok Singh &dp->rx_refill_buf_ring,
2881e0016465SAlok Singh &rx_desc_used_list,
2882e0016465SAlok Singh rx_bufs_used);
2883e0016465SAlok Singh }
2884e0016465SAlok Singh }
2885e0016465SAlok Singh
2886e0016465SAlok Singh static enum dp_mon_status_buf_state
ath12k_wifi7_dp_rx_mon_buf_done(struct ath12k_base * ab,struct hal_srng * srng,struct dp_rxdma_mon_ring * rx_ring)2887e0016465SAlok Singh ath12k_wifi7_dp_rx_mon_buf_done(struct ath12k_base *ab, struct hal_srng *srng,
2888e0016465SAlok Singh struct dp_rxdma_mon_ring *rx_ring)
2889e0016465SAlok Singh {
2890e0016465SAlok Singh struct ath12k_skb_rxcb *rxcb;
2891e0016465SAlok Singh struct hal_tlv_64_hdr *tlv;
2892e0016465SAlok Singh struct sk_buff *skb;
2893e0016465SAlok Singh void *status_desc;
2894e0016465SAlok Singh dma_addr_t paddr;
2895e0016465SAlok Singh u32 cookie;
2896e0016465SAlok Singh int buf_id;
2897e0016465SAlok Singh u8 rbm;
2898e0016465SAlok Singh
2899e0016465SAlok Singh status_desc = ath12k_hal_srng_src_next_peek(ab, srng);
2900e0016465SAlok Singh if (!status_desc)
2901e0016465SAlok Singh return DP_MON_STATUS_NO_DMA;
2902e0016465SAlok Singh
2903e0016465SAlok Singh ath12k_wifi7_hal_rx_buf_addr_info_get(status_desc, &paddr, &cookie, &rbm);
2904e0016465SAlok Singh
2905e0016465SAlok Singh buf_id = u32_get_bits(cookie, DP_RXDMA_BUF_COOKIE_BUF_ID);
2906e0016465SAlok Singh
2907e0016465SAlok Singh spin_lock_bh(&rx_ring->idr_lock);
2908e0016465SAlok Singh skb = idr_find(&rx_ring->bufs_idr, buf_id);
2909e0016465SAlok Singh spin_unlock_bh(&rx_ring->idr_lock);
2910e0016465SAlok Singh
2911e0016465SAlok Singh if (!skb)
2912e0016465SAlok Singh return DP_MON_STATUS_NO_DMA;
2913e0016465SAlok Singh
2914e0016465SAlok Singh rxcb = ATH12K_SKB_RXCB(skb);
2915e0016465SAlok Singh dma_sync_single_for_cpu(ab->dev, rxcb->paddr,
2916e0016465SAlok Singh skb->len + skb_tailroom(skb),
2917e0016465SAlok Singh DMA_FROM_DEVICE);
2918e0016465SAlok Singh
2919e0016465SAlok Singh tlv = (struct hal_tlv_64_hdr *)skb->data;
2920e0016465SAlok Singh if (le64_get_bits(tlv->tl, HAL_TLV_HDR_TAG) != HAL_RX_STATUS_BUFFER_DONE)
2921e0016465SAlok Singh return DP_MON_STATUS_NO_DMA;
2922e0016465SAlok Singh
2923e0016465SAlok Singh return DP_MON_STATUS_REPLINISH;
2924e0016465SAlok Singh }
2925e0016465SAlok Singh
2926e0016465SAlok Singh static enum hal_rx_mon_status
ath12k_wifi7_dp_mon_parse_rx_dest(struct ath12k_pdev_dp * dp_pdev,struct ath12k_mon_data * pmon,struct sk_buff * skb)2927e0016465SAlok Singh ath12k_wifi7_dp_mon_parse_rx_dest(struct ath12k_pdev_dp *dp_pdev,
2928e0016465SAlok Singh struct ath12k_mon_data *pmon,
2929e0016465SAlok Singh struct sk_buff *skb)
2930e0016465SAlok Singh {
2931e0016465SAlok Singh struct ath12k *ar = ath12k_pdev_dp_to_ar(dp_pdev);
2932e0016465SAlok Singh struct hal_tlv_64_hdr *tlv;
2933e0016465SAlok Singh struct ath12k_skb_rxcb *rxcb;
2934e0016465SAlok Singh enum hal_rx_mon_status hal_status;
2935e0016465SAlok Singh u16 tlv_tag, tlv_len;
2936e0016465SAlok Singh u8 *ptr = skb->data;
2937e0016465SAlok Singh
2938e0016465SAlok Singh do {
2939e0016465SAlok Singh tlv = (struct hal_tlv_64_hdr *)ptr;
2940e0016465SAlok Singh tlv_tag = le64_get_bits(tlv->tl, HAL_TLV_64_HDR_TAG);
2941e0016465SAlok Singh
2942e0016465SAlok Singh /* The actual length of PPDU_END is the combined length of many PHY
2943e0016465SAlok Singh * TLVs that follow. Skip the TLV header and
2944e0016465SAlok Singh * rx_rxpcu_classification_overview that follows the header to get to
2945e0016465SAlok Singh * next TLV.
2946e0016465SAlok Singh */
2947e0016465SAlok Singh
2948e0016465SAlok Singh if (tlv_tag == HAL_RX_PPDU_END)
2949e0016465SAlok Singh tlv_len = sizeof(struct hal_rx_rxpcu_classification_overview);
2950e0016465SAlok Singh else
2951e0016465SAlok Singh tlv_len = le64_get_bits(tlv->tl, HAL_TLV_64_HDR_LEN);
2952e0016465SAlok Singh
2953e475119bSAlok Singh hal_status = ath12k_wifi7_dp_mon_rx_parse_status_tlv(dp_pdev, pmon,
2954e475119bSAlok Singh tlv);
2955e0016465SAlok Singh
2956e0016465SAlok Singh if (ar->monitor_started && ar->ab->hw_params->rxdma1_enable &&
2957e475119bSAlok Singh ath12k_wifi7_dp_mon_parse_rx_dest_tlv(dp_pdev, pmon, hal_status,
2958e0016465SAlok Singh tlv->value))
2959e0016465SAlok Singh return HAL_RX_MON_STATUS_PPDU_DONE;
2960e0016465SAlok Singh
2961e0016465SAlok Singh ptr += sizeof(*tlv) + tlv_len;
2962e0016465SAlok Singh ptr = PTR_ALIGN(ptr, HAL_TLV_64_ALIGN);
2963e0016465SAlok Singh
2964e0016465SAlok Singh if ((ptr - skb->data) > skb->len)
2965e0016465SAlok Singh break;
2966e0016465SAlok Singh
2967e0016465SAlok Singh } while ((hal_status == HAL_RX_MON_STATUS_PPDU_NOT_DONE) ||
2968e0016465SAlok Singh (hal_status == HAL_RX_MON_STATUS_BUF_ADDR) ||
2969e0016465SAlok Singh (hal_status == HAL_RX_MON_STATUS_MPDU_START) ||
2970e0016465SAlok Singh (hal_status == HAL_RX_MON_STATUS_MPDU_END) ||
2971e0016465SAlok Singh (hal_status == HAL_RX_MON_STATUS_MSDU_END));
2972e0016465SAlok Singh
2973e0016465SAlok Singh rxcb = ATH12K_SKB_RXCB(skb);
2974e0016465SAlok Singh if (rxcb->is_end_of_ppdu)
2975e0016465SAlok Singh hal_status = HAL_RX_MON_STATUS_PPDU_DONE;
2976e0016465SAlok Singh
2977e0016465SAlok Singh return hal_status;
2978e0016465SAlok Singh }
2979e0016465SAlok Singh
2980e0016465SAlok Singh static enum hal_rx_mon_status
ath12k_wifi7_dp_mon_rx_parse_mon_status(struct ath12k_pdev_dp * dp_pdev,struct ath12k_mon_data * pmon,struct sk_buff * skb,struct napi_struct * napi)2981e0016465SAlok Singh ath12k_wifi7_dp_mon_rx_parse_mon_status(struct ath12k_pdev_dp *dp_pdev,
2982e0016465SAlok Singh struct ath12k_mon_data *pmon,
2983e0016465SAlok Singh struct sk_buff *skb,
2984e0016465SAlok Singh struct napi_struct *napi)
2985e0016465SAlok Singh {
2986e0016465SAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info = &pmon->mon_ppdu_info;
2987e0016465SAlok Singh struct dp_mon_mpdu *tmp;
2988e0016465SAlok Singh struct dp_mon_mpdu *mon_mpdu = pmon->mon_mpdu;
2989e0016465SAlok Singh enum hal_rx_mon_status hal_status;
2990e0016465SAlok Singh
2991e0016465SAlok Singh hal_status = ath12k_wifi7_dp_mon_parse_rx_dest(dp_pdev, pmon, skb);
2992e0016465SAlok Singh if (hal_status != HAL_RX_MON_STATUS_PPDU_DONE)
2993e0016465SAlok Singh return hal_status;
2994e0016465SAlok Singh
2995e0016465SAlok Singh list_for_each_entry_safe(mon_mpdu, tmp, &pmon->dp_rx_mon_mpdu_list, list) {
2996e0016465SAlok Singh list_del(&mon_mpdu->list);
2997e0016465SAlok Singh
2998e0016465SAlok Singh if (mon_mpdu->head && mon_mpdu->tail)
29997cd7392aSAlok Singh ath12k_wifi7_dp_mon_rx_deliver(dp_pdev, mon_mpdu,
30007cd7392aSAlok Singh ppdu_info, napi);
3001e0016465SAlok Singh
3002e0016465SAlok Singh kfree(mon_mpdu);
3003e0016465SAlok Singh }
3004e0016465SAlok Singh
3005e0016465SAlok Singh return hal_status;
3006e0016465SAlok Singh }
3007e0016465SAlok Singh
3008e0016465SAlok Singh static int
ath12k_wifi7_dp_rx_reap_mon_status_ring(struct ath12k_base * ab,int mac_id,int * budget,struct sk_buff_head * skb_list)3009e0016465SAlok Singh ath12k_wifi7_dp_rx_reap_mon_status_ring(struct ath12k_base *ab, int mac_id,
3010e0016465SAlok Singh int *budget, struct sk_buff_head *skb_list)
3011e0016465SAlok Singh {
3012e0016465SAlok Singh const struct ath12k_hw_hal_params *hal_params;
3013e0016465SAlok Singh int buf_id, srng_id, num_buffs_reaped = 0;
3014e0016465SAlok Singh enum dp_mon_status_buf_state reap_status;
3015e0016465SAlok Singh struct dp_rxdma_mon_ring *rx_ring;
3016e0016465SAlok Singh struct ath12k_mon_data *pmon;
3017e0016465SAlok Singh struct ath12k_skb_rxcb *rxcb;
3018e0016465SAlok Singh struct hal_tlv_64_hdr *tlv;
3019e0016465SAlok Singh void *rx_mon_status_desc;
3020e0016465SAlok Singh struct hal_srng *srng;
3021e0016465SAlok Singh struct ath12k_dp *dp;
3022e0016465SAlok Singh struct sk_buff *skb;
3023e0016465SAlok Singh struct ath12k *ar;
3024e0016465SAlok Singh dma_addr_t paddr;
3025e0016465SAlok Singh u32 cookie;
3026e0016465SAlok Singh u8 rbm;
3027e0016465SAlok Singh
3028e0016465SAlok Singh ar = ab->pdevs[ath12k_hw_mac_id_to_pdev_id(ab->hw_params, mac_id)].ar;
3029e0016465SAlok Singh dp = ath12k_ab_to_dp(ab);
3030e0016465SAlok Singh pmon = &ar->dp.mon_data;
3031e0016465SAlok Singh srng_id = ath12k_hw_mac_id_to_srng_id(ab->hw_params, mac_id);
3032e0016465SAlok Singh rx_ring = &dp->rx_mon_status_refill_ring[srng_id];
3033e0016465SAlok Singh
3034e0016465SAlok Singh srng = &ab->hal.srng_list[rx_ring->refill_buf_ring.ring_id];
3035e0016465SAlok Singh
3036e0016465SAlok Singh spin_lock_bh(&srng->lock);
3037e0016465SAlok Singh
3038e0016465SAlok Singh ath12k_hal_srng_access_begin(ab, srng);
3039e0016465SAlok Singh
3040e0016465SAlok Singh while (*budget) {
3041e0016465SAlok Singh *budget -= 1;
3042e0016465SAlok Singh rx_mon_status_desc = ath12k_hal_srng_src_peek(ab, srng);
3043e0016465SAlok Singh if (!rx_mon_status_desc) {
3044e0016465SAlok Singh pmon->buf_state = DP_MON_STATUS_REPLINISH;
3045e0016465SAlok Singh break;
3046e0016465SAlok Singh }
3047e0016465SAlok Singh ath12k_wifi7_hal_rx_buf_addr_info_get(rx_mon_status_desc, &paddr,
3048e0016465SAlok Singh &cookie, &rbm);
3049e0016465SAlok Singh if (paddr) {
3050e0016465SAlok Singh buf_id = u32_get_bits(cookie, DP_RXDMA_BUF_COOKIE_BUF_ID);
3051e0016465SAlok Singh
3052e0016465SAlok Singh spin_lock_bh(&rx_ring->idr_lock);
3053e0016465SAlok Singh skb = idr_find(&rx_ring->bufs_idr, buf_id);
3054e0016465SAlok Singh spin_unlock_bh(&rx_ring->idr_lock);
3055e0016465SAlok Singh
3056e0016465SAlok Singh if (!skb) {
3057e0016465SAlok Singh ath12k_warn(ab, "rx monitor status with invalid buf_id %d\n",
3058e0016465SAlok Singh buf_id);
3059e0016465SAlok Singh pmon->buf_state = DP_MON_STATUS_REPLINISH;
3060e0016465SAlok Singh goto move_next;
3061e0016465SAlok Singh }
3062e0016465SAlok Singh
3063e0016465SAlok Singh rxcb = ATH12K_SKB_RXCB(skb);
3064e0016465SAlok Singh
3065e0016465SAlok Singh dma_sync_single_for_cpu(ab->dev, rxcb->paddr,
3066e0016465SAlok Singh skb->len + skb_tailroom(skb),
3067e0016465SAlok Singh DMA_FROM_DEVICE);
3068e0016465SAlok Singh
3069e0016465SAlok Singh tlv = (struct hal_tlv_64_hdr *)skb->data;
3070e0016465SAlok Singh if (le64_get_bits(tlv->tl, HAL_TLV_HDR_TAG) !=
3071e0016465SAlok Singh HAL_RX_STATUS_BUFFER_DONE) {
3072e0016465SAlok Singh pmon->buf_state = DP_MON_STATUS_NO_DMA;
3073e0016465SAlok Singh ath12k_warn(ab,
3074e0016465SAlok Singh "mon status DONE not set %llx, buf_id %d\n",
3075e0016465SAlok Singh le64_get_bits(tlv->tl, HAL_TLV_HDR_TAG),
3076e0016465SAlok Singh buf_id);
3077e0016465SAlok Singh /* RxDMA status done bit might not be set even
3078e0016465SAlok Singh * though tp is moved by HW.
3079e0016465SAlok Singh */
3080e0016465SAlok Singh
3081e0016465SAlok Singh /* If done status is missing:
3082e0016465SAlok Singh * 1. As per MAC team's suggestion,
3083e0016465SAlok Singh * when HP + 1 entry is peeked and if DMA
3084e0016465SAlok Singh * is not done and if HP + 2 entry's DMA done
3085e0016465SAlok Singh * is set. skip HP + 1 entry and
3086e0016465SAlok Singh * start processing in next interrupt.
3087e0016465SAlok Singh * 2. If HP + 2 entry's DMA done is not set,
3088e0016465SAlok Singh * poll onto HP + 1 entry DMA done to be set.
3089e0016465SAlok Singh * Check status for same buffer for next time
3090e0016465SAlok Singh * dp_rx_mon_status_srng_process
3091e0016465SAlok Singh */
3092e0016465SAlok Singh reap_status = ath12k_wifi7_dp_rx_mon_buf_done(ab, srng,
3093e0016465SAlok Singh rx_ring);
3094e0016465SAlok Singh if (reap_status == DP_MON_STATUS_NO_DMA)
3095e0016465SAlok Singh continue;
3096e0016465SAlok Singh
3097e0016465SAlok Singh spin_lock_bh(&rx_ring->idr_lock);
3098e0016465SAlok Singh idr_remove(&rx_ring->bufs_idr, buf_id);
3099e0016465SAlok Singh spin_unlock_bh(&rx_ring->idr_lock);
3100e0016465SAlok Singh
3101e0016465SAlok Singh dma_unmap_single(ab->dev, rxcb->paddr,
3102e0016465SAlok Singh skb->len + skb_tailroom(skb),
3103e0016465SAlok Singh DMA_FROM_DEVICE);
3104e0016465SAlok Singh
3105e0016465SAlok Singh dev_kfree_skb_any(skb);
3106e0016465SAlok Singh pmon->buf_state = DP_MON_STATUS_REPLINISH;
3107e0016465SAlok Singh goto move_next;
3108e0016465SAlok Singh }
3109e0016465SAlok Singh
3110e0016465SAlok Singh spin_lock_bh(&rx_ring->idr_lock);
3111e0016465SAlok Singh idr_remove(&rx_ring->bufs_idr, buf_id);
3112e0016465SAlok Singh spin_unlock_bh(&rx_ring->idr_lock);
3113e0016465SAlok Singh
3114e0016465SAlok Singh dma_unmap_single(ab->dev, rxcb->paddr,
3115e0016465SAlok Singh skb->len + skb_tailroom(skb),
3116e0016465SAlok Singh DMA_FROM_DEVICE);
3117e0016465SAlok Singh
3118e0016465SAlok Singh if (ath12k_dp_pkt_set_pktlen(skb, RX_MON_STATUS_BUF_SIZE)) {
3119e0016465SAlok Singh dev_kfree_skb_any(skb);
3120e0016465SAlok Singh goto move_next;
3121e0016465SAlok Singh }
3122e0016465SAlok Singh __skb_queue_tail(skb_list, skb);
3123e0016465SAlok Singh } else {
3124e0016465SAlok Singh pmon->buf_state = DP_MON_STATUS_REPLINISH;
3125e0016465SAlok Singh }
3126e0016465SAlok Singh move_next:
3127e0016465SAlok Singh skb = ath12k_dp_rx_alloc_mon_status_buf(ab, rx_ring,
3128e0016465SAlok Singh &buf_id);
3129e0016465SAlok Singh hal_params = ab->hal.hal_params;
3130e0016465SAlok Singh
3131e0016465SAlok Singh if (!skb) {
3132e0016465SAlok Singh ath12k_warn(ab, "failed to alloc buffer for status ring\n");
3133e0016465SAlok Singh ath12k_wifi7_hal_rx_buf_addr_info_set(rx_mon_status_desc,
3134e0016465SAlok Singh 0, 0,
3135e0016465SAlok Singh hal_params->rx_buf_rbm);
3136e0016465SAlok Singh num_buffs_reaped++;
3137e0016465SAlok Singh break;
3138e0016465SAlok Singh }
3139e0016465SAlok Singh rxcb = ATH12K_SKB_RXCB(skb);
3140e0016465SAlok Singh
3141e0016465SAlok Singh cookie = u32_encode_bits(mac_id, DP_RXDMA_BUF_COOKIE_PDEV_ID) |
3142e0016465SAlok Singh u32_encode_bits(buf_id, DP_RXDMA_BUF_COOKIE_BUF_ID);
3143e0016465SAlok Singh
3144e0016465SAlok Singh ath12k_wifi7_hal_rx_buf_addr_info_set(rx_mon_status_desc, rxcb->paddr,
3145e0016465SAlok Singh cookie, hal_params->rx_buf_rbm);
3146e0016465SAlok Singh ath12k_hal_srng_src_get_next_entry(ab, srng);
3147e0016465SAlok Singh num_buffs_reaped++;
3148e0016465SAlok Singh }
3149e0016465SAlok Singh ath12k_hal_srng_access_end(ab, srng);
3150e0016465SAlok Singh spin_unlock_bh(&srng->lock);
3151e0016465SAlok Singh
3152e0016465SAlok Singh return num_buffs_reaped;
3153e0016465SAlok Singh }
3154e0016465SAlok Singh
315524b21a9bSAlok Singh static int
__ath12k_wifi7_dp_mon_process_ring(struct ath12k * ar,int mac_id,struct napi_struct * napi,int * budget)315624b21a9bSAlok Singh __ath12k_wifi7_dp_mon_process_ring(struct ath12k *ar, int mac_id,
315724b21a9bSAlok Singh struct napi_struct *napi, int *budget)
315824b21a9bSAlok Singh {
315924b21a9bSAlok Singh struct ath12k_mon_data *pmon = (struct ath12k_mon_data *)&ar->dp.mon_data;
316024b21a9bSAlok Singh struct ath12k_pdev_mon_stats *rx_mon_stats = &pmon->rx_mon_stats;
316124b21a9bSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info = &pmon->mon_ppdu_info;
316224b21a9bSAlok Singh enum hal_rx_mon_status hal_status;
316324b21a9bSAlok Singh struct sk_buff_head skb_list;
316424b21a9bSAlok Singh int num_buffs_reaped;
316524b21a9bSAlok Singh struct sk_buff *skb;
316624b21a9bSAlok Singh
316724b21a9bSAlok Singh __skb_queue_head_init(&skb_list);
316824b21a9bSAlok Singh
3169e0016465SAlok Singh num_buffs_reaped = ath12k_wifi7_dp_rx_reap_mon_status_ring(ar->ab, mac_id,
317024b21a9bSAlok Singh budget, &skb_list);
317124b21a9bSAlok Singh if (!num_buffs_reaped)
317224b21a9bSAlok Singh goto exit;
317324b21a9bSAlok Singh
317424b21a9bSAlok Singh while ((skb = __skb_dequeue(&skb_list))) {
317524b21a9bSAlok Singh memset(ppdu_info, 0, sizeof(*ppdu_info));
317624b21a9bSAlok Singh ppdu_info->peer_id = HAL_INVALID_PEERID;
317724b21a9bSAlok Singh
3178e0016465SAlok Singh hal_status = ath12k_wifi7_dp_mon_parse_rx_dest(&ar->dp, pmon, skb);
317924b21a9bSAlok Singh
318024b21a9bSAlok Singh if (ar->monitor_started &&
318124b21a9bSAlok Singh pmon->mon_ppdu_status == DP_PPDU_STATUS_START &&
318224b21a9bSAlok Singh hal_status == HAL_TLV_STATUS_PPDU_DONE) {
318324b21a9bSAlok Singh rx_mon_stats->status_ppdu_done++;
318424b21a9bSAlok Singh pmon->mon_ppdu_status = DP_PPDU_STATUS_DONE;
3185e0016465SAlok Singh ath12k_wifi7_dp_rx_mon_dest_process(ar, mac_id, *budget, napi);
318624b21a9bSAlok Singh pmon->mon_ppdu_status = DP_PPDU_STATUS_START;
318724b21a9bSAlok Singh }
318824b21a9bSAlok Singh
318924b21a9bSAlok Singh dev_kfree_skb_any(skb);
319024b21a9bSAlok Singh }
319124b21a9bSAlok Singh
319224b21a9bSAlok Singh exit:
319324b21a9bSAlok Singh return num_buffs_reaped;
319424b21a9bSAlok Singh }
319524b21a9bSAlok Singh
319624b21a9bSAlok Singh static int
ath12k_wifi7_dp_mon_srng_process(struct ath12k_pdev_dp * pdev_dp,int * budget,struct napi_struct * napi)319724b21a9bSAlok Singh ath12k_wifi7_dp_mon_srng_process(struct ath12k_pdev_dp *pdev_dp, int *budget,
319824b21a9bSAlok Singh struct napi_struct *napi)
319924b21a9bSAlok Singh {
320024b21a9bSAlok Singh struct ath12k_dp *dp = pdev_dp->dp;
320124b21a9bSAlok Singh struct ath12k_base *ab = dp->ab;
320224b21a9bSAlok Singh struct ath12k_mon_data *pmon = (struct ath12k_mon_data *)&pdev_dp->mon_data;
320324b21a9bSAlok Singh struct hal_rx_mon_ppdu_info *ppdu_info = &pmon->mon_ppdu_info;
320424b21a9bSAlok Singh struct hal_mon_dest_desc *mon_dst_desc;
320524b21a9bSAlok Singh struct sk_buff *skb;
320624b21a9bSAlok Singh struct ath12k_skb_rxcb *rxcb;
320724b21a9bSAlok Singh struct dp_srng *mon_dst_ring;
320824b21a9bSAlok Singh struct hal_srng *srng;
320924b21a9bSAlok Singh struct dp_rxdma_mon_ring *buf_ring;
321024b21a9bSAlok Singh struct ath12k_dp_link_peer *peer;
321124b21a9bSAlok Singh struct sk_buff_head skb_list;
321224b21a9bSAlok Singh u64 cookie;
321324b21a9bSAlok Singh int num_buffs_reaped = 0, srng_id, buf_id;
321424b21a9bSAlok Singh u32 hal_status, end_offset, info0, end_reason;
321524b21a9bSAlok Singh u8 pdev_idx = ath12k_hw_mac_id_to_pdev_id(ab->hw_params, pdev_dp->mac_id);
321624b21a9bSAlok Singh
321724b21a9bSAlok Singh __skb_queue_head_init(&skb_list);
321824b21a9bSAlok Singh srng_id = ath12k_hw_mac_id_to_srng_id(ab->hw_params, pdev_idx);
321924b21a9bSAlok Singh mon_dst_ring = &pdev_dp->rxdma_mon_dst_ring[srng_id];
322024b21a9bSAlok Singh buf_ring = &dp->rxdma_mon_buf_ring;
322124b21a9bSAlok Singh
322224b21a9bSAlok Singh srng = &ab->hal.srng_list[mon_dst_ring->ring_id];
322324b21a9bSAlok Singh spin_lock_bh(&srng->lock);
322424b21a9bSAlok Singh ath12k_hal_srng_access_begin(ab, srng);
322524b21a9bSAlok Singh
322624b21a9bSAlok Singh while (likely(*budget)) {
322724b21a9bSAlok Singh mon_dst_desc = ath12k_hal_srng_dst_peek(ab, srng);
322824b21a9bSAlok Singh if (unlikely(!mon_dst_desc))
322924b21a9bSAlok Singh break;
323024b21a9bSAlok Singh
323124b21a9bSAlok Singh /* In case of empty descriptor, the cookie in the ring descriptor
323224b21a9bSAlok Singh * is invalid. Therefore, this entry is skipped, and ring processing
323324b21a9bSAlok Singh * continues.
323424b21a9bSAlok Singh */
323524b21a9bSAlok Singh info0 = le32_to_cpu(mon_dst_desc->info0);
323624b21a9bSAlok Singh if (u32_get_bits(info0, HAL_MON_DEST_INFO0_EMPTY_DESC))
323724b21a9bSAlok Singh goto move_next;
323824b21a9bSAlok Singh
323924b21a9bSAlok Singh cookie = le32_to_cpu(mon_dst_desc->cookie);
324024b21a9bSAlok Singh buf_id = u32_get_bits(cookie, DP_RXDMA_BUF_COOKIE_BUF_ID);
324124b21a9bSAlok Singh
324224b21a9bSAlok Singh spin_lock_bh(&buf_ring->idr_lock);
324324b21a9bSAlok Singh skb = idr_remove(&buf_ring->bufs_idr, buf_id);
324424b21a9bSAlok Singh spin_unlock_bh(&buf_ring->idr_lock);
324524b21a9bSAlok Singh
324624b21a9bSAlok Singh if (unlikely(!skb)) {
324724b21a9bSAlok Singh ath12k_warn(ab, "monitor destination with invalid buf_id %d\n",
324824b21a9bSAlok Singh buf_id);
324924b21a9bSAlok Singh goto move_next;
325024b21a9bSAlok Singh }
325124b21a9bSAlok Singh
325224b21a9bSAlok Singh rxcb = ATH12K_SKB_RXCB(skb);
325324b21a9bSAlok Singh dma_unmap_single(ab->dev, rxcb->paddr,
325424b21a9bSAlok Singh skb->len + skb_tailroom(skb),
325524b21a9bSAlok Singh DMA_FROM_DEVICE);
325624b21a9bSAlok Singh
325724b21a9bSAlok Singh end_reason = u32_get_bits(info0, HAL_MON_DEST_INFO0_END_REASON);
325824b21a9bSAlok Singh
325924b21a9bSAlok Singh /* HAL_MON_FLUSH_DETECTED implies that an rx flush received at the end of
326024b21a9bSAlok Singh * rx PPDU and HAL_MON_PPDU_TRUNCATED implies that the PPDU got
326124b21a9bSAlok Singh * truncated due to a system level error. In both the cases, buffer data
326224b21a9bSAlok Singh * can be discarded
326324b21a9bSAlok Singh */
326424b21a9bSAlok Singh if ((end_reason == HAL_MON_FLUSH_DETECTED) ||
326524b21a9bSAlok Singh (end_reason == HAL_MON_PPDU_TRUNCATED)) {
326624b21a9bSAlok Singh ath12k_dbg(ab, ATH12K_DBG_DATA,
326724b21a9bSAlok Singh "Monitor dest descriptor end reason %d", end_reason);
326824b21a9bSAlok Singh dev_kfree_skb_any(skb);
326924b21a9bSAlok Singh goto move_next;
327024b21a9bSAlok Singh }
327124b21a9bSAlok Singh
327224b21a9bSAlok Singh /* Calculate the budget when the ring descriptor with the
327324b21a9bSAlok Singh * HAL_MON_END_OF_PPDU to ensure that one PPDU worth of data is always
327424b21a9bSAlok Singh * reaped. This helps to efficiently utilize the NAPI budget.
327524b21a9bSAlok Singh */
327624b21a9bSAlok Singh if (end_reason == HAL_MON_END_OF_PPDU) {
327724b21a9bSAlok Singh *budget -= 1;
327824b21a9bSAlok Singh rxcb->is_end_of_ppdu = true;
327924b21a9bSAlok Singh }
328024b21a9bSAlok Singh
328124b21a9bSAlok Singh end_offset = u32_get_bits(info0, HAL_MON_DEST_INFO0_END_OFFSET);
328224b21a9bSAlok Singh if (likely(end_offset <= DP_RX_BUFFER_SIZE)) {
328324b21a9bSAlok Singh skb_put(skb, end_offset);
328424b21a9bSAlok Singh } else {
328524b21a9bSAlok Singh ath12k_warn(ab,
328624b21a9bSAlok Singh "invalid offset on mon stats destination %u\n",
328724b21a9bSAlok Singh end_offset);
328824b21a9bSAlok Singh skb_put(skb, DP_RX_BUFFER_SIZE);
328924b21a9bSAlok Singh }
329024b21a9bSAlok Singh
329124b21a9bSAlok Singh __skb_queue_tail(&skb_list, skb);
329224b21a9bSAlok Singh
329324b21a9bSAlok Singh move_next:
329424b21a9bSAlok Singh ath12k_dp_mon_buf_replenish(ab, buf_ring, 1);
329524b21a9bSAlok Singh ath12k_hal_srng_dst_get_next_entry(ab, srng);
329624b21a9bSAlok Singh num_buffs_reaped++;
329724b21a9bSAlok Singh }
329824b21a9bSAlok Singh
329924b21a9bSAlok Singh ath12k_hal_srng_access_end(ab, srng);
330024b21a9bSAlok Singh spin_unlock_bh(&srng->lock);
330124b21a9bSAlok Singh
330224b21a9bSAlok Singh if (!num_buffs_reaped)
330324b21a9bSAlok Singh return 0;
330424b21a9bSAlok Singh
330524b21a9bSAlok Singh /* In some cases, one PPDU worth of data can be spread across multiple NAPI
330624b21a9bSAlok Singh * schedules, To avoid losing existing parsed ppdu_info information, skip
330724b21a9bSAlok Singh * the memset of the ppdu_info structure and continue processing it.
330824b21a9bSAlok Singh */
330924b21a9bSAlok Singh if (!ppdu_info->ppdu_continuation)
3310e0016465SAlok Singh ath12k_wifi7_dp_mon_rx_memset_ppdu_info(ppdu_info);
331124b21a9bSAlok Singh
331224b21a9bSAlok Singh while ((skb = __skb_dequeue(&skb_list))) {
3313e0016465SAlok Singh hal_status = ath12k_wifi7_dp_mon_rx_parse_mon_status(pdev_dp, pmon,
3314e0016465SAlok Singh skb, napi);
331524b21a9bSAlok Singh if (hal_status != HAL_RX_MON_STATUS_PPDU_DONE) {
331624b21a9bSAlok Singh ppdu_info->ppdu_continuation = true;
331724b21a9bSAlok Singh dev_kfree_skb_any(skb);
331824b21a9bSAlok Singh continue;
331924b21a9bSAlok Singh }
332024b21a9bSAlok Singh
332124b21a9bSAlok Singh if (ppdu_info->peer_id == HAL_INVALID_PEERID)
332224b21a9bSAlok Singh goto free_skb;
332324b21a9bSAlok Singh
332424b21a9bSAlok Singh rcu_read_lock();
332524b21a9bSAlok Singh peer = ath12k_dp_link_peer_find_by_peerid(pdev_dp, ppdu_info->peer_id);
332624b21a9bSAlok Singh if (!peer || !peer->sta) {
332724b21a9bSAlok Singh ath12k_dbg(ab, ATH12K_DBG_DATA,
332824b21a9bSAlok Singh "failed to find the peer with monitor peer_id %d\n",
332924b21a9bSAlok Singh ppdu_info->peer_id);
333024b21a9bSAlok Singh goto next_skb;
333124b21a9bSAlok Singh }
333224b21a9bSAlok Singh
333324b21a9bSAlok Singh if (ppdu_info->reception_type == HAL_RX_RECEPTION_TYPE_SU) {
333424b21a9bSAlok Singh ath12k_dp_mon_rx_update_peer_su_stats(peer, ppdu_info);
333524b21a9bSAlok Singh } else if ((ppdu_info->fc_valid) &&
333624b21a9bSAlok Singh (ppdu_info->ast_index != HAL_AST_IDX_INVALID)) {
333724b21a9bSAlok Singh ath12k_dp_mon_rx_process_ulofdma(ppdu_info);
333824b21a9bSAlok Singh ath12k_dp_mon_rx_update_peer_mu_stats(ab, ppdu_info);
333924b21a9bSAlok Singh }
334024b21a9bSAlok Singh
334124b21a9bSAlok Singh next_skb:
334224b21a9bSAlok Singh rcu_read_unlock();
334324b21a9bSAlok Singh free_skb:
334424b21a9bSAlok Singh dev_kfree_skb_any(skb);
3345e0016465SAlok Singh ath12k_wifi7_dp_mon_rx_memset_ppdu_info(ppdu_info);
334624b21a9bSAlok Singh }
334724b21a9bSAlok Singh
334824b21a9bSAlok Singh return num_buffs_reaped;
334924b21a9bSAlok Singh }
335024b21a9bSAlok Singh
ath12k_wifi7_dp_mon_process_ring(struct ath12k_dp * dp,int mac_id,struct napi_struct * napi,int budget,enum dp_monitor_mode monitor_mode)335124b21a9bSAlok Singh int ath12k_wifi7_dp_mon_process_ring(struct ath12k_dp *dp, int mac_id,
335224b21a9bSAlok Singh struct napi_struct *napi, int budget,
335324b21a9bSAlok Singh enum dp_monitor_mode monitor_mode)
335424b21a9bSAlok Singh {
335524b21a9bSAlok Singh u8 pdev_idx = ath12k_hw_mac_id_to_pdev_id(dp->hw_params, mac_id);
335624b21a9bSAlok Singh struct ath12k_pdev_dp *dp_pdev;
335724b21a9bSAlok Singh struct ath12k *ar;
335824b21a9bSAlok Singh int num_buffs_reaped = 0;
335924b21a9bSAlok Singh
336024b21a9bSAlok Singh rcu_read_lock();
336124b21a9bSAlok Singh
336224b21a9bSAlok Singh dp_pdev = ath12k_dp_to_pdev_dp(dp, pdev_idx);
336324b21a9bSAlok Singh if (!dp_pdev) {
336424b21a9bSAlok Singh rcu_read_unlock();
336524b21a9bSAlok Singh return 0;
336624b21a9bSAlok Singh }
336724b21a9bSAlok Singh
336824b21a9bSAlok Singh if (dp->hw_params->rxdma1_enable) {
336924b21a9bSAlok Singh if (monitor_mode == ATH12K_DP_RX_MONITOR_MODE)
337024b21a9bSAlok Singh num_buffs_reaped = ath12k_wifi7_dp_mon_srng_process(dp_pdev,
337124b21a9bSAlok Singh &budget,
337224b21a9bSAlok Singh napi);
337324b21a9bSAlok Singh } else {
337424b21a9bSAlok Singh ar = ath12k_pdev_dp_to_ar(dp_pdev);
337524b21a9bSAlok Singh
337624b21a9bSAlok Singh if (ar->monitor_started)
337724b21a9bSAlok Singh num_buffs_reaped =
337824b21a9bSAlok Singh __ath12k_wifi7_dp_mon_process_ring(ar, mac_id, napi,
337924b21a9bSAlok Singh &budget);
338024b21a9bSAlok Singh }
338124b21a9bSAlok Singh
338224b21a9bSAlok Singh rcu_read_unlock();
338324b21a9bSAlok Singh
338424b21a9bSAlok Singh return num_buffs_reaped;
338524b21a9bSAlok Singh }
3386