|
@@ -0,0 +1,1014 @@
|
|
|
+
|
|
|
+ * Copyright (c) 2017 The Linux Foundation. All rights reserved.
|
|
|
+ *
|
|
|
+ * Permission to use, copy, modify, and/or distribute this software for
|
|
|
+ * any purpose with or without fee is hereby granted, provided that the
|
|
|
+ * above copyright notice and this permission notice appear in all
|
|
|
+ * copies.
|
|
|
+ *
|
|
|
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
|
|
|
+ * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
|
|
|
+ * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
|
|
|
+ * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
|
|
|
+ * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
|
|
|
+ * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
|
|
|
+ * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
|
|
+ * PERFORMANCE OF THIS SOFTWARE.
|
|
|
+ */
|
|
|
+
|
|
|
+#include "dp_types.h"
|
|
|
+#include "dp_rx.h"
|
|
|
+#include "dp_peer.h"
|
|
|
+#include "hal_rx.h"
|
|
|
+#include "hal_api.h"
|
|
|
+#include "qdf_trace.h"
|
|
|
+#include "qdf_nbuf.h"
|
|
|
+#include "hal_api_mon.h"
|
|
|
+#include "ieee80211.h"
|
|
|
+#include "dp_rx_mon.h"
|
|
|
+#include "wlan_cfg.h"
|
|
|
+
|
|
|
+
|
|
|
+ * dp_rx_mon_link_desc_return() - Return a MPDU link descriptor to HW
|
|
|
+ * (WBM), following error handling
|
|
|
+ *
|
|
|
+ * @dp_pdev: core txrx pdev context
|
|
|
+ * @buf_addr_info: void pointer to monitor link descriptor buf addr info
|
|
|
+ * Return: QDF_STATUS
|
|
|
+ */
|
|
|
+static QDF_STATUS
|
|
|
+dp_rx_mon_link_desc_return(struct dp_pdev *dp_pdev,
|
|
|
+ void *buf_addr_info)
|
|
|
+{
|
|
|
+ struct dp_srng *dp_srng;
|
|
|
+ void *hal_srng;
|
|
|
+ void *hal_soc;
|
|
|
+ QDF_STATUS status = QDF_STATUS_E_FAILURE;
|
|
|
+ void *src_srng_desc;
|
|
|
+
|
|
|
+ hal_soc = dp_pdev->soc->hal_soc;
|
|
|
+
|
|
|
+ dp_srng = &dp_pdev->rxdma_mon_desc_ring;
|
|
|
+ hal_srng = dp_srng->hal_srng;
|
|
|
+
|
|
|
+ qdf_assert(hal_srng);
|
|
|
+
|
|
|
+ if (qdf_unlikely(hal_srng_access_start(hal_soc, hal_srng))) {
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ * Need API to convert from hal_ring pointer to
|
|
|
+ * Ring Type / Ring Id combo
|
|
|
+ */
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
|
|
|
+ "%s %d : \
|
|
|
+ HAL RING Access For WBM Release SRNG Failed -- %p\n",
|
|
|
+ __func__, __LINE__, hal_srng);
|
|
|
+ goto done;
|
|
|
+ }
|
|
|
+
|
|
|
+ src_srng_desc = hal_srng_src_get_next(hal_soc, hal_srng);
|
|
|
+
|
|
|
+ if (qdf_likely(src_srng_desc)) {
|
|
|
+
|
|
|
+ hal_rx_mon_msdu_link_desc_set(hal_soc,
|
|
|
+ src_srng_desc, buf_addr_info);
|
|
|
+ status = QDF_STATUS_SUCCESS;
|
|
|
+ } else {
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
|
|
|
+ "%s %d -- Monitor Link Desc WBM Release Ring Full\n",
|
|
|
+ __func__, __LINE__);
|
|
|
+ }
|
|
|
+done:
|
|
|
+ hal_srng_access_end(hal_soc, hal_srng);
|
|
|
+ return status;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+ * dp_rx_mon_mpdu_pop() - Return a MPDU link descriptor to HW
|
|
|
+ * (WBM), following error handling
|
|
|
+ *
|
|
|
+ * @soc: core DP main context
|
|
|
+ * @mac_id: mac id which is one of 3 mac_ids
|
|
|
+ * @rxdma_dst_ring_desc: void pointer to monitor link descriptor buf addr info
|
|
|
+ * @head_msdu: head of msdu to be popped
|
|
|
+ * @tail_msdu: tail of msdu to be popped
|
|
|
+ * @npackets: number of packet to be popped
|
|
|
+ * @ppdu_id: ppdu id of processing ppdu
|
|
|
+ * @head: head of descs list to be freed
|
|
|
+ * @tail: tail of decs list to be freed
|
|
|
+ * Return: number of msdu in MPDU to be popped
|
|
|
+ */
|
|
|
+static inline
|
|
|
+uint32_t
|
|
|
+dp_rx_mon_mpdu_pop(struct dp_soc *soc, uint32_t mac_id,
|
|
|
+ void *rxdma_dst_ring_desc, qdf_nbuf_t *head_msdu,
|
|
|
+ qdf_nbuf_t *tail_msdu, uint32_t *npackets, uint32_t *ppdu_id,
|
|
|
+ union dp_rx_desc_list_elem_t **head,
|
|
|
+ union dp_rx_desc_list_elem_t **tail)
|
|
|
+{
|
|
|
+ struct dp_pdev *dp_pdev = soc->pdev_list[mac_id];
|
|
|
+ void *rx_desc_tlv;
|
|
|
+ void *rx_msdu_link_desc;
|
|
|
+ qdf_nbuf_t msdu;
|
|
|
+ qdf_nbuf_t last;
|
|
|
+ struct hal_rx_msdu_list msdu_list;
|
|
|
+ uint8_t num_msdus;
|
|
|
+ uint32_t rx_buf_size, rx_pkt_offset;
|
|
|
+ struct hal_buf_info buf_info;
|
|
|
+ void *p_buf_addr_info;
|
|
|
+ void *p_last_buf_addr_info;
|
|
|
+ uint32_t rx_bufs_used = 0;
|
|
|
+ uint32_t msdu_ppdu_id, msdu_cnt;
|
|
|
+ uint8_t *data;
|
|
|
+ uint32_t i;
|
|
|
+
|
|
|
+ msdu = 0;
|
|
|
+
|
|
|
+ last = NULL;
|
|
|
+
|
|
|
+ hal_rx_reo_ent_buf_paddr_get(rxdma_dst_ring_desc, &buf_info,
|
|
|
+ &p_last_buf_addr_info, &msdu_cnt);
|
|
|
+
|
|
|
+ do {
|
|
|
+ rx_msdu_link_desc =
|
|
|
+ dp_rx_cookie_2_mon_link_desc_va(dp_pdev, &buf_info);
|
|
|
+
|
|
|
+ qdf_assert(rx_msdu_link_desc);
|
|
|
+
|
|
|
+ num_msdus = msdu_cnt;
|
|
|
+
|
|
|
+ hal_rx_msdu_list_get(rx_msdu_link_desc, &msdu_list, &num_msdus);
|
|
|
+
|
|
|
+ msdu_cnt -= num_msdus;
|
|
|
+
|
|
|
+ for (i = 0; i < num_msdus; i++) {
|
|
|
+ uint32_t l2_hdr_offset;
|
|
|
+ struct dp_rx_desc *rx_desc =
|
|
|
+ dp_rx_cookie_2_va_mon_buf(soc,
|
|
|
+ msdu_list.sw_cookie[i]);
|
|
|
+
|
|
|
+ qdf_assert(rx_desc);
|
|
|
+ msdu = rx_desc->nbuf;
|
|
|
+
|
|
|
+ qdf_nbuf_unmap_single(soc->osdev, msdu,
|
|
|
+ QDF_DMA_FROM_DEVICE);
|
|
|
+
|
|
|
+ data = qdf_nbuf_data(msdu);
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_DP,
|
|
|
+ QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ "[%s][%d] msdu_nbuf=%p, data=%p\n",
|
|
|
+ __func__, __LINE__, msdu, data);
|
|
|
+
|
|
|
+ rx_pkt_offset = HAL_RX_MON_HW_RX_DESC_SIZE();
|
|
|
+
|
|
|
+ * HW structures call this L3 header padding
|
|
|
+ * -- even though this is actually the offset
|
|
|
+ * from the buffer beginning where the L2
|
|
|
+ * header begins.
|
|
|
+ */
|
|
|
+ l2_hdr_offset =
|
|
|
+ hal_rx_msdu_end_l3_hdr_padding_get(data);
|
|
|
+
|
|
|
+ rx_buf_size = rx_pkt_offset + l2_hdr_offset
|
|
|
+ + msdu_list.msdu_info[i].msdu_len;
|
|
|
+
|
|
|
+ qdf_nbuf_set_pktlen(msdu, rx_buf_size);
|
|
|
+
|
|
|
+ rx_desc_tlv = HAL_RX_MON_DEST_GET_DESC(data);
|
|
|
+
|
|
|
+#if 0
|
|
|
+
|
|
|
+
|
|
|
+ * Check if DMA completed -- msdu_done is the
|
|
|
+ * last bit to be written
|
|
|
+ */
|
|
|
+ if (!hal_rx_attn_msdu_done_get(rx_desc_tlv)) {
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_DP,
|
|
|
+ QDF_TRACE_LEVEL_ERROR,
|
|
|
+ "%s %d\n",
|
|
|
+ __func__, __LINE__);
|
|
|
+
|
|
|
+ print_hex_dump(KERN_ERR,
|
|
|
+ "\t Pkt Desc:",
|
|
|
+ DUMP_PREFIX_NONE, 32, 4,
|
|
|
+ rx_desc_tlv, 128, false);
|
|
|
+
|
|
|
+ qdf_assert(0);
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ msdu_ppdu_id =
|
|
|
+ HAL_RX_MON_HW_DESC_GET_PPDUID_GET(rx_desc_tlv);
|
|
|
+
|
|
|
+#if 0
|
|
|
+
|
|
|
+ if (*ppdu_id != msdu_ppdu_id) {
|
|
|
+ *ppdu_id = msdu_ppdu_id;
|
|
|
+ return rx_bufs_used;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ rx_bufs_used++;
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_DP,
|
|
|
+ QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ "rx_pkt_offset=%d, \
|
|
|
+ l2_hdr_offset=%d, msdu_len=%d, \
|
|
|
+ addr=%p\n",
|
|
|
+ rx_pkt_offset,
|
|
|
+ l2_hdr_offset,
|
|
|
+ msdu_list.msdu_info[i].msdu_len,
|
|
|
+ qdf_nbuf_data(msdu));
|
|
|
+
|
|
|
+ if (*head_msdu == NULL)
|
|
|
+ *head_msdu = msdu;
|
|
|
+ else
|
|
|
+ qdf_nbuf_set_next(last, msdu);
|
|
|
+
|
|
|
+ last = msdu;
|
|
|
+ dp_rx_add_to_free_desc_list(head,
|
|
|
+ tail, rx_desc);
|
|
|
+ }
|
|
|
+
|
|
|
+ hal_rx_mon_next_link_desc_get(rx_msdu_link_desc, &buf_info,
|
|
|
+ &p_buf_addr_info);
|
|
|
+
|
|
|
+ dp_rx_mon_link_desc_return(dp_pdev, p_last_buf_addr_info);
|
|
|
+ p_last_buf_addr_info = p_buf_addr_info;
|
|
|
+
|
|
|
+ } while (buf_info.paddr && msdu_cnt);
|
|
|
+
|
|
|
+ qdf_nbuf_set_next(last, NULL);
|
|
|
+
|
|
|
+ *tail_msdu = msdu;
|
|
|
+
|
|
|
+ return rx_bufs_used;
|
|
|
+
|
|
|
+}
|
|
|
+
|
|
|
+static inline
|
|
|
+void dp_rx_msdus_set_payload(qdf_nbuf_t msdu)
|
|
|
+{
|
|
|
+ uint8_t *data;
|
|
|
+ uint32_t rx_pkt_offset, l2_hdr_offset;
|
|
|
+
|
|
|
+ data = qdf_nbuf_data(msdu);
|
|
|
+ rx_pkt_offset = HAL_RX_MON_HW_RX_DESC_SIZE();
|
|
|
+ l2_hdr_offset = hal_rx_msdu_end_l3_hdr_padding_get(data);
|
|
|
+ qdf_nbuf_pull_head(msdu, rx_pkt_offset + l2_hdr_offset);
|
|
|
+
|
|
|
+ data = qdf_nbuf_data(msdu);
|
|
|
+
|
|
|
+
|
|
|
+}
|
|
|
+
|
|
|
+static inline
|
|
|
+qdf_nbuf_t dp_rx_mon_restitch_mpdu_from_msdus(struct dp_soc *soc,
|
|
|
+ uint32_t mac_id, qdf_nbuf_t head_msdu, qdf_nbuf_t last_msdu,
|
|
|
+ struct cdp_mon_status *rx_status)
|
|
|
+{
|
|
|
+ struct dp_pdev *dp_pdev = soc->pdev_list[mac_id];
|
|
|
+ qdf_nbuf_t msdu, mpdu_buf, prev_buf, msdu_orig, head_frag_list;
|
|
|
+ uint32_t decap_format, wifi_hdr_len, sec_hdr_len, msdu_llc_len,
|
|
|
+ mpdu_buf_len, decap_hdr_pull_bytes, frag_list_sum_len, dir,
|
|
|
+ is_amsdu, is_first_frag, amsdu_pad;
|
|
|
+ void *rx_desc;
|
|
|
+ char *hdr_desc;
|
|
|
+ unsigned char *dest;
|
|
|
+ struct ieee80211_frame *wh;
|
|
|
+ struct ieee80211_qoscntl *qos;
|
|
|
+ qdf_nbuf_t amsdu_llc_buf;
|
|
|
+ head_frag_list = NULL;
|
|
|
+
|
|
|
+
|
|
|
+ * payload
|
|
|
+ */
|
|
|
+
|
|
|
+ msdu_orig = head_msdu;
|
|
|
+
|
|
|
+ rx_desc = qdf_nbuf_data(msdu_orig);
|
|
|
+
|
|
|
+ if (HAL_RX_DESC_GET_MPDU_LENGTH_ERR(rx_desc)) {
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ }
|
|
|
+
|
|
|
+ rx_desc = qdf_nbuf_data(last_msdu);
|
|
|
+
|
|
|
+ rx_status->cdp_rs_fcs_err = HAL_RX_DESC_GET_MPDU_FCS_ERR(rx_desc);
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ rx_desc = qdf_nbuf_data(head_msdu);
|
|
|
+
|
|
|
+ HAL_RX_MON_HW_DESC_GET_PPDU_START_STATUS(rx_desc, rx_status);
|
|
|
+
|
|
|
+ decap_format = HAL_RX_DESC_GET_DECAP_FORMAT(rx_desc);
|
|
|
+
|
|
|
+
|
|
|
+ * packet in RAW mode.
|
|
|
+ */
|
|
|
+ if (decap_format == HAL_HW_RX_DECAP_FORMAT_RAW) {
|
|
|
+
|
|
|
+ * - but the RX status is usually enough
|
|
|
+ */
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ "[%s][%d] decap format raw\n", __func__, __LINE__);
|
|
|
+
|
|
|
+ dp_rx_msdus_set_payload(head_msdu);
|
|
|
+
|
|
|
+ mpdu_buf = head_msdu;
|
|
|
+ if (!mpdu_buf)
|
|
|
+ goto mpdu_stitch_fail;
|
|
|
+
|
|
|
+ prev_buf = mpdu_buf;
|
|
|
+
|
|
|
+ frag_list_sum_len = 0;
|
|
|
+ msdu_orig = qdf_nbuf_next(head_msdu);
|
|
|
+ is_first_frag = 1;
|
|
|
+
|
|
|
+ while (msdu_orig) {
|
|
|
+
|
|
|
+ dp_rx_msdus_set_payload(head_msdu);
|
|
|
+
|
|
|
+ msdu = msdu_orig;
|
|
|
+ if (!msdu)
|
|
|
+ goto mpdu_stitch_fail;
|
|
|
+
|
|
|
+ if (is_first_frag) {
|
|
|
+ is_first_frag = 0;
|
|
|
+ head_frag_list = msdu;
|
|
|
+ }
|
|
|
+
|
|
|
+ frag_list_sum_len += qdf_nbuf_len(msdu);
|
|
|
+
|
|
|
+
|
|
|
+ qdf_nbuf_set_next_ext(prev_buf, msdu);
|
|
|
+
|
|
|
+
|
|
|
+ prev_buf = msdu;
|
|
|
+ msdu_orig = qdf_nbuf_next(msdu_orig);
|
|
|
+ }
|
|
|
+
|
|
|
+ qdf_nbuf_trim_tail(prev_buf, HAL_RX_FCS_LEN);
|
|
|
+
|
|
|
+
|
|
|
+ if (head_frag_list) {
|
|
|
+ frag_list_sum_len -= HAL_RX_FCS_LEN;
|
|
|
+ qdf_nbuf_append_ext_list(mpdu_buf, head_frag_list,
|
|
|
+ frag_list_sum_len);
|
|
|
+ }
|
|
|
+
|
|
|
+ goto mpdu_stitch_done;
|
|
|
+ }
|
|
|
+
|
|
|
+
|
|
|
+ * Calculate the amount of header in decapped packet to knock off based
|
|
|
+ * on the decap type and the corresponding number of raw bytes to copy
|
|
|
+ * status header
|
|
|
+ */
|
|
|
+ rx_desc = qdf_nbuf_data(head_msdu);
|
|
|
+
|
|
|
+ hdr_desc = HAL_RX_DESC_GET_80211_HDR(rx_desc);
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ "[%s][%d] decap format not raw\n", __func__, __LINE__);
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ wifi_hdr_len = sizeof(struct ieee80211_frame);
|
|
|
+ wh = (struct ieee80211_frame *)hdr_desc;
|
|
|
+
|
|
|
+ dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK;
|
|
|
+
|
|
|
+ if (dir == IEEE80211_FC1_DIR_DSTODS)
|
|
|
+ wifi_hdr_len += 6;
|
|
|
+
|
|
|
+ is_amsdu = 0;
|
|
|
+ if (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_QOS) {
|
|
|
+ qos = (struct ieee80211_qoscntl *)
|
|
|
+ (hdr_desc + wifi_hdr_len);
|
|
|
+ wifi_hdr_len += 2;
|
|
|
+
|
|
|
+ is_amsdu = (qos->i_qos[0] & IEEE80211_QOS_AMSDU);
|
|
|
+ }
|
|
|
+
|
|
|
+
|
|
|
+ * and 'EXT_IV' flag
|
|
|
+ * */
|
|
|
+ if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
|
|
|
+ char *iv = (char *)wh + wifi_hdr_len;
|
|
|
+
|
|
|
+ if (iv[3] & KEY_EXTIV)
|
|
|
+ sec_hdr_len = 8;
|
|
|
+ else
|
|
|
+ sec_hdr_len = 4;
|
|
|
+ } else {
|
|
|
+ sec_hdr_len = 0;
|
|
|
+ }
|
|
|
+ wifi_hdr_len += sec_hdr_len;
|
|
|
+
|
|
|
+
|
|
|
+ msdu_llc_len = is_amsdu ? (14 + 8) : 8;
|
|
|
+
|
|
|
+ mpdu_buf_len = wifi_hdr_len + msdu_llc_len;
|
|
|
+
|
|
|
+
|
|
|
+ decap_hdr_pull_bytes = 14;
|
|
|
+
|
|
|
+
|
|
|
+ * status of the now decapped first msdu. Leave enough headroom for
|
|
|
+ * accomodating any radio-tap /prism like PHY header
|
|
|
+ */
|
|
|
+#define MAX_MONITOR_HEADER (512)
|
|
|
+ mpdu_buf = qdf_nbuf_alloc(dp_pdev->osif_pdev,
|
|
|
+ MAX_MONITOR_HEADER + mpdu_buf_len,
|
|
|
+ MAX_MONITOR_HEADER, 4, FALSE);
|
|
|
+
|
|
|
+ if (!mpdu_buf)
|
|
|
+ goto mpdu_stitch_done;
|
|
|
+
|
|
|
+
|
|
|
+ * - Note that there can be a 2 byte pad between heaader and enc header
|
|
|
+ */
|
|
|
+
|
|
|
+ prev_buf = mpdu_buf;
|
|
|
+ dest = qdf_nbuf_put_tail(prev_buf, wifi_hdr_len);
|
|
|
+ if (!dest) {
|
|
|
+ prev_buf = mpdu_buf = NULL;
|
|
|
+ goto mpdu_stitch_done;
|
|
|
+ }
|
|
|
+
|
|
|
+ qdf_mem_copy(dest, hdr_desc, wifi_hdr_len);
|
|
|
+ hdr_desc += wifi_hdr_len;
|
|
|
+
|
|
|
+#if 0
|
|
|
+ dest = qdf_nbuf_put_tail(prev_buf, sec_hdr_len);
|
|
|
+ adf_os_mem_copy(dest, hdr_desc, sec_hdr_len);
|
|
|
+ hdr_desc += sec_hdr_len;
|
|
|
+#endif
|
|
|
+
|
|
|
+
|
|
|
+ frag_list_sum_len = 0;
|
|
|
+ frag_list_sum_len -= msdu_llc_len;
|
|
|
+
|
|
|
+ msdu_orig = head_msdu;
|
|
|
+ is_first_frag = 1;
|
|
|
+ amsdu_pad = 0;
|
|
|
+
|
|
|
+ while (msdu_orig) {
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ msdu = msdu_orig;
|
|
|
+
|
|
|
+ if (!msdu)
|
|
|
+ goto mpdu_stitch_fail;
|
|
|
+
|
|
|
+ if (is_first_frag) {
|
|
|
+ head_frag_list = msdu;
|
|
|
+ } else {
|
|
|
+
|
|
|
+ rx_desc = qdf_nbuf_data(msdu_orig);
|
|
|
+ hdr_desc = HAL_RX_DESC_GET_80211_HDR(rx_desc);
|
|
|
+ }
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ if (is_first_frag) {
|
|
|
+ is_first_frag = 0;
|
|
|
+
|
|
|
+ dest = qdf_nbuf_put_tail(prev_buf,
|
|
|
+ msdu_llc_len + amsdu_pad);
|
|
|
+ if (!dest) {
|
|
|
+ mpdu_buf = NULL;
|
|
|
+ qdf_nbuf_free(msdu);
|
|
|
+ goto mpdu_stitch_done;
|
|
|
+ }
|
|
|
+
|
|
|
+ dest += amsdu_pad;
|
|
|
+ qdf_mem_copy(dest, hdr_desc, msdu_llc_len);
|
|
|
+
|
|
|
+
|
|
|
+ } else {
|
|
|
+ amsdu_llc_buf = qdf_nbuf_alloc(
|
|
|
+ dp_pdev->osif_pdev,
|
|
|
+ 32 + 32,
|
|
|
+ 32, 4, FALSE);
|
|
|
+
|
|
|
+ if (!amsdu_llc_buf)
|
|
|
+ goto mpdu_stitch_fail;
|
|
|
+
|
|
|
+ dest = qdf_nbuf_put_tail(amsdu_llc_buf,
|
|
|
+ msdu_llc_len + amsdu_pad);
|
|
|
+
|
|
|
+ if (!dest)
|
|
|
+ goto mpdu_stitch_fail;
|
|
|
+
|
|
|
+ dest += amsdu_pad;
|
|
|
+ qdf_mem_copy(dest, hdr_desc, msdu_llc_len);
|
|
|
+
|
|
|
+
|
|
|
+ * and cloned MSDUS */
|
|
|
+ qdf_nbuf_set_next_ext(prev_buf, amsdu_llc_buf);
|
|
|
+ prev_buf = amsdu_llc_buf;
|
|
|
+
|
|
|
+ qdf_nbuf_set_next_ext(prev_buf, msdu);
|
|
|
+
|
|
|
+ }
|
|
|
+
|
|
|
+ dp_rx_msdus_set_payload(msdu);
|
|
|
+
|
|
|
+
|
|
|
+ qdf_nbuf_pull_head(msdu, decap_hdr_pull_bytes);
|
|
|
+ frag_list_sum_len += msdu_llc_len + qdf_nbuf_len(msdu)
|
|
|
+ + amsdu_pad;
|
|
|
+
|
|
|
+
|
|
|
+ * AMSDU pad is 4 byte pad on AMSDU subframe */
|
|
|
+ amsdu_pad = (msdu_llc_len + qdf_nbuf_len(msdu)) & 0x3;
|
|
|
+ amsdu_pad = amsdu_pad ? (4 - amsdu_pad) : 0;
|
|
|
+
|
|
|
+
|
|
|
+ * probably iterate all the frags cloning them along the way and
|
|
|
+ * and also updating the prev_buf pointer
|
|
|
+ */
|
|
|
+
|
|
|
+
|
|
|
+ prev_buf = msdu;
|
|
|
+ msdu_orig = qdf_nbuf_next(msdu_orig);
|
|
|
+
|
|
|
+ }
|
|
|
+
|
|
|
+#if 0
|
|
|
+
|
|
|
+ qdf_nbuf_put_tail(prev_buf, HAL_RX_FCS_LEN);
|
|
|
+ frag_list_sum_len += HAL_RX_FCS_LEN;
|
|
|
+#endif
|
|
|
+
|
|
|
+
|
|
|
+ qdf_nbuf_append_ext_list(mpdu_buf, head_frag_list,
|
|
|
+ frag_list_sum_len);
|
|
|
+
|
|
|
+mpdu_stitch_done:
|
|
|
+
|
|
|
+
|
|
|
+#if 0
|
|
|
+
|
|
|
+ last_mpdu =
|
|
|
+ (*(((u_int32_t *)&rx_desc->attention)) &
|
|
|
+ RX_ATTENTION_0_LAST_MPDU_MASK) >>
|
|
|
+ RX_ATTENTION_0_LAST_MPDU_LSB;
|
|
|
+
|
|
|
+ if (last_mpdu)
|
|
|
+ rx_status->rs_tstamp.tsf = rx_desc->ppdu_end.tsf_timestamp;
|
|
|
+
|
|
|
+#endif
|
|
|
+
|
|
|
+ return mpdu_buf;
|
|
|
+
|
|
|
+mpdu_stitch_fail:
|
|
|
+ if ((mpdu_buf) && (decap_format != HAL_HW_RX_DECAP_FORMAT_RAW)) {
|
|
|
+
|
|
|
+ qdf_nbuf_free(mpdu_buf);
|
|
|
+ }
|
|
|
+ return NULL;
|
|
|
+
|
|
|
+}
|
|
|
+
|
|
|
+static inline
|
|
|
+QDF_STATUS dp_rx_mon_deliver(struct dp_soc *soc, uint32_t mac_id,
|
|
|
+ qdf_nbuf_t head_msdu, qdf_nbuf_t tail_msdu)
|
|
|
+{
|
|
|
+ struct dp_pdev *pdev = soc->pdev_list[mac_id];
|
|
|
+ struct cdp_mon_status *rs = &pdev->rx_mon_recv_status;
|
|
|
+ qdf_nbuf_t mon_skb, skb_next;
|
|
|
+ qdf_nbuf_t mon_mpdu = NULL;
|
|
|
+
|
|
|
+ if ((pdev->monitor_vdev == NULL) ||
|
|
|
+ (pdev->monitor_vdev->osif_rx_mon == NULL)) {
|
|
|
+ goto mon_deliver_fail;
|
|
|
+ }
|
|
|
+
|
|
|
+
|
|
|
+ mon_mpdu = dp_rx_mon_restitch_mpdu_from_msdus(soc, mac_id, head_msdu,
|
|
|
+ tail_msdu, rs);
|
|
|
+
|
|
|
+ if (mon_mpdu) {
|
|
|
+ pdev->monitor_vdev->osif_rx_mon(
|
|
|
+ pdev->monitor_vdev->osif_vdev, mon_mpdu, rs);
|
|
|
+
|
|
|
+ } else {
|
|
|
+ goto mon_deliver_fail;
|
|
|
+ }
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+
|
|
|
+mon_deliver_fail:
|
|
|
+ mon_skb = head_msdu;
|
|
|
+ while (mon_skb) {
|
|
|
+ skb_next = qdf_nbuf_next(mon_skb);
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ "[%s][%d] mon_skb=%p\n", __func__, __LINE__, mon_skb);
|
|
|
+
|
|
|
+ qdf_nbuf_free(mon_skb);
|
|
|
+ mon_skb = skb_next;
|
|
|
+ }
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+* dp_rx_mon_dest_process() - Brain of the Rx processing functionality
|
|
|
+* Called from the bottom half (tasklet/NET_RX_SOFTIRQ)
|
|
|
+* @soc: core txrx main context 164
|
|
|
+* @hal_ring: opaque pointer to the HAL Rx Ring, which will be serviced
|
|
|
+* @quota: No. of units (packets) that can be serviced in one shot.
|
|
|
+*
|
|
|
+* This function implements the core of Rx functionality. This is
|
|
|
+* expected to handle only non-error frames.
|
|
|
+*
|
|
|
+* Return: none
|
|
|
+*/
|
|
|
+void dp_rx_mon_dest_process(struct dp_soc *soc, uint32_t mac_id, uint32_t quota)
|
|
|
+{
|
|
|
+ struct dp_pdev *pdev = soc->pdev_list[mac_id];
|
|
|
+ uint8_t pdev_id = pdev->pdev_id;
|
|
|
+ void *hal_soc;
|
|
|
+ void *rxdma_dst_ring_desc;
|
|
|
+ void *mon_dst_srng = pdev->rxdma_mon_dst_ring.hal_srng;
|
|
|
+ union dp_rx_desc_list_elem_t *head = NULL;
|
|
|
+ union dp_rx_desc_list_elem_t *tail = NULL;
|
|
|
+ struct dp_srng *dp_rxdma_srng;
|
|
|
+ struct rx_desc_pool *rx_desc_pool;
|
|
|
+
|
|
|
+#ifdef DP_INTR_POLL_BASED
|
|
|
+ if (!pdev)
|
|
|
+ return;
|
|
|
+#endif
|
|
|
+
|
|
|
+ pdev_id = pdev->pdev_id;
|
|
|
+ mon_dst_srng = pdev->rxdma_mon_dst_ring.hal_srng;
|
|
|
+
|
|
|
+#if 0
|
|
|
+
|
|
|
+ if (pdev->mon_ppdu_status != DP_PPDU_STATUS_DONE)
|
|
|
+ return;
|
|
|
+#endif
|
|
|
+
|
|
|
+ if (!mon_dst_srng) {
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
|
|
|
+ "%s %d : HAL Monitor Destination Ring Init \
|
|
|
+ Failed -- %p\n",
|
|
|
+ __func__, __LINE__, mon_dst_srng);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ hal_soc = soc->hal_soc;
|
|
|
+
|
|
|
+ qdf_assert(hal_soc);
|
|
|
+
|
|
|
+ if (qdf_unlikely(hal_srng_access_start(hal_soc, mon_dst_srng))) {
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
|
|
|
+ "%s %d : HAL Monitor Destination Ring Init \
|
|
|
+ Failed -- %p\n",
|
|
|
+ __func__, __LINE__, mon_dst_srng);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ while (qdf_likely((rxdma_dst_ring_desc =
|
|
|
+ hal_srng_dst_peek(hal_soc, mon_dst_srng)))) {
|
|
|
+ qdf_nbuf_t head_msdu, tail_msdu;
|
|
|
+ uint32_t rx_bufs_used = 0;
|
|
|
+ uint32_t npackets, ppdu_id;
|
|
|
+ head_msdu = (qdf_nbuf_t) NULL;
|
|
|
+ tail_msdu = (qdf_nbuf_t) NULL;
|
|
|
+
|
|
|
+ ppdu_id = pdev->mon_ppdu_id;
|
|
|
+ rx_bufs_used += dp_rx_mon_mpdu_pop(soc, mac_id,
|
|
|
+ rxdma_dst_ring_desc,
|
|
|
+ &head_msdu, &tail_msdu,
|
|
|
+ &npackets, &ppdu_id,
|
|
|
+ &head, &tail);
|
|
|
+
|
|
|
+#if 0
|
|
|
+
|
|
|
+ if (ppdu_id != pdev->mon_ppdu_id) {
|
|
|
+ pdev->mon_ppdu_status = DP_PPDU_STATUS_START;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ dp_rx_mon_deliver(soc, mac_id, head_msdu, tail_msdu);
|
|
|
+
|
|
|
+
|
|
|
+ * ring pointer */
|
|
|
+ dp_rxdma_srng = &pdev->rxdma_mon_buf_ring;
|
|
|
+ rx_desc_pool = &soc->rx_desc_mon[pdev_id];
|
|
|
+
|
|
|
+ dp_rx_buffers_replenish(soc, pdev_id, dp_rxdma_srng,
|
|
|
+ rx_desc_pool, rx_bufs_used, &head, &tail,
|
|
|
+ HAL_RX_BUF_RBM_SW3_BM);
|
|
|
+
|
|
|
+ rxdma_dst_ring_desc = hal_srng_dst_get_next(hal_soc,
|
|
|
+ mon_dst_srng);
|
|
|
+ }
|
|
|
+
|
|
|
+ hal_srng_access_end(hal_soc, mon_dst_srng);
|
|
|
+}
|
|
|
+
|
|
|
+static QDF_STATUS
|
|
|
+dp_rx_pdev_mon_buf_attach(struct dp_pdev *pdev) {
|
|
|
+ uint8_t pdev_id = pdev->pdev_id;
|
|
|
+ struct dp_soc *soc = pdev->soc;
|
|
|
+ union dp_rx_desc_list_elem_t *desc_list = NULL;
|
|
|
+ union dp_rx_desc_list_elem_t *tail = NULL;
|
|
|
+ struct dp_srng *rxdma_srng;
|
|
|
+ uint32_t rxdma_entries;
|
|
|
+ struct rx_desc_pool *rx_desc_pool;
|
|
|
+
|
|
|
+ rxdma_srng = &pdev->rxdma_mon_buf_ring;
|
|
|
+
|
|
|
+ rxdma_entries = rxdma_srng->alloc_size/hal_srng_get_entrysize(
|
|
|
+ soc->hal_soc,
|
|
|
+ RXDMA_MONITOR_BUF);
|
|
|
+
|
|
|
+ rx_desc_pool = &soc->rx_desc_mon[pdev_id];
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_WARN,
|
|
|
+ "%s: Mon RX Desc Pool[%d] allocation size=%d\n"
|
|
|
+ , __func__, pdev_id, rxdma_entries*3);
|
|
|
+
|
|
|
+ dp_rx_desc_pool_alloc(soc, pdev_id, rxdma_entries*3, rx_desc_pool);
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_WARN,
|
|
|
+ "%s: Mon RX Buffers Replenish pdev_id=%d\n",
|
|
|
+ __func__, pdev_id);
|
|
|
+
|
|
|
+ dp_rx_buffers_replenish(soc, pdev_id, rxdma_srng, rx_desc_pool,
|
|
|
+ rxdma_entries, &desc_list, &tail, HAL_RX_BUF_RBM_SW3_BM);
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+
|
|
|
+static QDF_STATUS
|
|
|
+dp_rx_pdev_mon_buf_detach(struct dp_pdev *pdev) {
|
|
|
+ uint8_t pdev_id = pdev->pdev_id;
|
|
|
+ struct dp_soc *soc = pdev->soc;
|
|
|
+ struct rx_desc_pool *rx_desc_pool;
|
|
|
+
|
|
|
+ rx_desc_pool = &soc->rx_desc_mon[pdev_id];
|
|
|
+ dp_rx_desc_pool_free(soc, pdev_id, rx_desc_pool);
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+ * Allocate and setup link descriptor pool that will be used by HW for
|
|
|
+ * various link and queue descriptors and managed by WBM
|
|
|
+ */
|
|
|
+static int dp_mon_link_desc_pool_setup(struct dp_soc *soc, uint32_t mac_id)
|
|
|
+{
|
|
|
+ struct dp_pdev *dp_pdev = soc->pdev_list[mac_id];
|
|
|
+ int link_desc_size = hal_get_link_desc_size(soc->hal_soc);
|
|
|
+ int link_desc_align = hal_get_link_desc_align(soc->hal_soc);
|
|
|
+ uint32_t max_alloc_size = wlan_cfg_max_alloc_size(soc->wlan_cfg_ctx);
|
|
|
+ uint32_t total_link_descs, total_mem_size;
|
|
|
+ uint32_t num_link_desc_banks;
|
|
|
+ uint32_t last_bank_size = 0;
|
|
|
+ uint32_t entry_size, num_entries;
|
|
|
+ void *mon_desc_srng;
|
|
|
+ uint32_t num_replenish_buf;
|
|
|
+ struct dp_srng *dp_srng;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ dp_srng = &dp_pdev->rxdma_mon_desc_ring;
|
|
|
+
|
|
|
+ num_entries = dp_srng->alloc_size/hal_srng_get_entrysize(
|
|
|
+ soc->hal_soc, RXDMA_MONITOR_DESC);
|
|
|
+
|
|
|
+
|
|
|
+ total_link_descs = 1;
|
|
|
+ while (total_link_descs < num_entries)
|
|
|
+ total_link_descs <<= 1;
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO_HIGH,
|
|
|
+ "%s: total_link_descs: %u, link_desc_size: %d\n",
|
|
|
+ __func__, total_link_descs, link_desc_size);
|
|
|
+
|
|
|
+ total_mem_size = total_link_descs * link_desc_size;
|
|
|
+
|
|
|
+ total_mem_size += link_desc_align;
|
|
|
+
|
|
|
+ if (total_mem_size <= max_alloc_size) {
|
|
|
+ num_link_desc_banks = 0;
|
|
|
+ last_bank_size = total_mem_size;
|
|
|
+ } else {
|
|
|
+ num_link_desc_banks = (total_mem_size) /
|
|
|
+ (max_alloc_size - link_desc_align);
|
|
|
+ last_bank_size = total_mem_size %
|
|
|
+ (max_alloc_size - link_desc_align);
|
|
|
+ }
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_WARN,
|
|
|
+ "%s: total_mem_size: %d, num_link_desc_banks: %u, \
|
|
|
+ max_alloc_size: %d\n",
|
|
|
+ __func__, total_mem_size, num_link_desc_banks, max_alloc_size);
|
|
|
+
|
|
|
+ for (i = 0; i < num_link_desc_banks; i++) {
|
|
|
+ dp_pdev->link_desc_banks[i].base_vaddr_unaligned =
|
|
|
+ qdf_mem_alloc_consistent(soc->osdev, NULL,
|
|
|
+ max_alloc_size,
|
|
|
+ &(dp_pdev->link_desc_banks[i].base_paddr_unaligned));
|
|
|
+ dp_pdev->link_desc_banks[i].size = max_alloc_size;
|
|
|
+
|
|
|
+ dp_pdev->link_desc_banks[i].base_vaddr =
|
|
|
+ (void *)((unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr_unaligned) +
|
|
|
+ ((unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr_unaligned) %
|
|
|
+ link_desc_align));
|
|
|
+
|
|
|
+ dp_pdev->link_desc_banks[i].base_paddr =
|
|
|
+ (unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_paddr_unaligned) +
|
|
|
+ ((unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr) -
|
|
|
+ (unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr_unaligned));
|
|
|
+
|
|
|
+ if (!dp_pdev->link_desc_banks[i].base_vaddr_unaligned) {
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
|
|
|
+ "%s: Link desc memory allocation failed\n",
|
|
|
+ __func__);
|
|
|
+ goto fail;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (last_bank_size) {
|
|
|
+
|
|
|
+ * multiple of max_alloc_size
|
|
|
+ */
|
|
|
+ dp_pdev->link_desc_banks[i].base_vaddr_unaligned =
|
|
|
+ qdf_mem_alloc_consistent(soc->osdev,
|
|
|
+ NULL, last_bank_size,
|
|
|
+ &(dp_pdev->link_desc_banks[i].base_paddr_unaligned));
|
|
|
+ dp_pdev->link_desc_banks[i].size = last_bank_size;
|
|
|
+
|
|
|
+ dp_pdev->link_desc_banks[i].base_vaddr =
|
|
|
+ (void *)((unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr_unaligned) +
|
|
|
+ ((unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr_unaligned) %
|
|
|
+ link_desc_align));
|
|
|
+
|
|
|
+ dp_pdev->link_desc_banks[i].base_paddr =
|
|
|
+ (unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_paddr_unaligned) +
|
|
|
+ ((unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr) -
|
|
|
+ (unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr_unaligned));
|
|
|
+ }
|
|
|
+
|
|
|
+
|
|
|
+ entry_size = hal_srng_get_entrysize(soc->hal_soc, RXDMA_MONITOR_DESC);
|
|
|
+ total_mem_size = entry_size * total_link_descs;
|
|
|
+
|
|
|
+ mon_desc_srng = dp_pdev->rxdma_mon_desc_ring.hal_srng;
|
|
|
+
|
|
|
+ num_replenish_buf = 0;
|
|
|
+
|
|
|
+ if (total_mem_size <= max_alloc_size) {
|
|
|
+ void *desc;
|
|
|
+
|
|
|
+ hal_srng_access_start_unlocked(soc->hal_soc, mon_desc_srng);
|
|
|
+
|
|
|
+ for (i = 0; i < MAX_MON_LINK_DESC_BANKS &&
|
|
|
+ dp_pdev->link_desc_banks[i].base_paddr; i++) {
|
|
|
+ uint32_t num_entries =
|
|
|
+ (dp_pdev->link_desc_banks[i].size -
|
|
|
+ (unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr) -
|
|
|
+ (unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr_unaligned))
|
|
|
+ / link_desc_size;
|
|
|
+ unsigned long paddr =
|
|
|
+ (unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_paddr);
|
|
|
+ unsigned long vaddr =
|
|
|
+ (unsigned long)
|
|
|
+ (dp_pdev->link_desc_banks[i].base_vaddr);
|
|
|
+
|
|
|
+ while (num_entries && (desc =
|
|
|
+ hal_srng_src_get_next(soc->hal_soc,
|
|
|
+ mon_desc_srng))) {
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_TXRX,
|
|
|
+ QDF_TRACE_LEVEL_DEBUG,
|
|
|
+ "[%s][%d] desc=%p, i=%d, vaddr=%lx, paddr=%lx",
|
|
|
+ __func__, __LINE__, desc, i,
|
|
|
+ (unsigned long)vaddr, (unsigned long)paddr);
|
|
|
+
|
|
|
+ hal_set_link_desc_addr(desc, i, paddr);
|
|
|
+ num_entries--;
|
|
|
+ num_replenish_buf++;
|
|
|
+ paddr += link_desc_size;
|
|
|
+ vaddr += link_desc_size;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ hal_srng_access_end_unlocked(soc->hal_soc, mon_desc_srng);
|
|
|
+ } else {
|
|
|
+ qdf_assert(0);
|
|
|
+ }
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_WARN,
|
|
|
+ "%s: successfully replenished %d buffer\n",
|
|
|
+ __func__, num_replenish_buf);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+
|
|
|
+fail:
|
|
|
+ for (i = 0; i < MAX_MON_LINK_DESC_BANKS; i++) {
|
|
|
+ if (dp_pdev->link_desc_banks[i].base_vaddr_unaligned) {
|
|
|
+ qdf_mem_free_consistent(soc->osdev, NULL,
|
|
|
+ dp_pdev->link_desc_banks[i].size,
|
|
|
+ dp_pdev->link_desc_banks[i].base_vaddr_unaligned,
|
|
|
+ dp_pdev->link_desc_banks[i].base_paddr_unaligned, 0);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+ * Free link descriptor pool that was setup HW
|
|
|
+ */
|
|
|
+static void dp_mon_link_desc_pool_cleanup(struct dp_soc *soc, uint32_t mac_id)
|
|
|
+{
|
|
|
+ struct dp_pdev *dp_pdev = soc->pdev_list[mac_id];
|
|
|
+ int i;
|
|
|
+
|
|
|
+ for (i = 0; i < MAX_MON_LINK_DESC_BANKS; i++) {
|
|
|
+ if (dp_pdev->link_desc_banks[i].base_vaddr_unaligned) {
|
|
|
+ qdf_mem_free_consistent(soc->osdev, NULL,
|
|
|
+ dp_pdev->link_desc_banks[i].size,
|
|
|
+ dp_pdev->link_desc_banks[i].base_vaddr_unaligned,
|
|
|
+ dp_pdev->link_desc_banks[i].base_paddr_unaligned, 0);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+ * dp_rx_pdev_mon_attach() - attach DP RX for monitor mode
|
|
|
+ * @pdev: core txrx pdev context
|
|
|
+ *
|
|
|
+ * This function will attach a DP RX for monitor mode instance into
|
|
|
+ * the main device (SOC) context. Will allocate dp rx resource and
|
|
|
+ * initialize resources.
|
|
|
+ *
|
|
|
+ * Return: QDF_STATUS_SUCCESS: success
|
|
|
+ * QDF_STATUS_E_RESOURCES: Error return
|
|
|
+ */
|
|
|
+
|
|
|
+QDF_STATUS
|
|
|
+dp_rx_pdev_mon_attach(struct dp_pdev *pdev) {
|
|
|
+ uint8_t pdev_id = pdev->pdev_id;
|
|
|
+ struct dp_soc *soc = pdev->soc;
|
|
|
+
|
|
|
+ QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_WARN,
|
|
|
+ "%s: pdev attach id=%d\n", __func__, pdev_id);
|
|
|
+
|
|
|
+ dp_rx_pdev_mon_buf_attach(pdev);
|
|
|
+ dp_rx_pdev_mon_status_attach(pdev);
|
|
|
+ dp_mon_link_desc_pool_setup(soc, pdev_id);
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+
|
|
|
+ * dp_rx_pdev_mon_detach() - detach dp rx for monitor mode
|
|
|
+ * @pdev: core txrx pdev context
|
|
|
+ *
|
|
|
+ * This function will detach DP RX for monitor mode from
|
|
|
+ * main device context. will free DP Rx resources for
|
|
|
+ * monitor mode
|
|
|
+ *
|
|
|
+ * Return: QDF_STATUS_SUCCESS: success
|
|
|
+ * QDF_STATUS_E_RESOURCES: Error return
|
|
|
+ */
|
|
|
+QDF_STATUS
|
|
|
+dp_rx_pdev_mon_detach(struct dp_pdev *pdev) {
|
|
|
+ uint8_t pdev_id = pdev->pdev_id;
|
|
|
+ struct dp_soc *soc = pdev->soc;
|
|
|
+
|
|
|
+ dp_mon_link_desc_pool_cleanup(soc, pdev_id);
|
|
|
+ dp_rx_pdev_mon_status_detach(pdev);
|
|
|
+ dp_rx_pdev_mon_buf_detach(pdev);
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|