blob: 626aedb3ca26da108ef25c4a1ae59df6fe788af9 [file] [log] [blame]
Kai Chen6eca1a62017-01-12 10:17:53 -08001/*
Pranita Solankeed0aba62018-01-12 19:14:31 +05302 * Copyright (c) 2017-2018 The Linux Foundation. All rights reserved.
Kai Chen6eca1a62017-01-12 10:17:53 -08003 *
4 * Permission to use, copy, modify, and/or distribute this software for
5 * any purpose with or without fee is hereby granted, provided that the
6 * above copyright notice and this permission notice appear in all
7 * copies.
8 *
9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
10 * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
11 * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
12 * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
13 * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
14 * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
15 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
16 * PERFORMANCE OF THIS SOFTWARE.
17 */
Balamurugan Mahalingamd0159642018-07-11 15:02:29 +053018#include "hal_hw_headers.h"
Kai Chen6eca1a62017-01-12 10:17:53 -080019#include "dp_types.h"
20#include "dp_rx.h"
21#include "dp_peer.h"
22#include "hal_rx.h"
23#include "hal_api.h"
24#include "qdf_trace.h"
25#include "qdf_nbuf.h"
26#include "hal_api_mon.h"
Kai Chen6eca1a62017-01-12 10:17:53 -080027#include "dp_rx_mon.h"
Keyur Parekhfad6d082017-05-07 08:54:47 -070028#include "dp_internal.h"
29#include "qdf_mem.h" /* qdf_mem_malloc,free */
Kai Chen6eca1a62017-01-12 10:17:53 -080030
ydb247452018-08-08 00:23:16 +053031#ifdef FEATURE_PERPKT_INFO
32#include "dp_ratetable.h"
33#endif
34
Kai Chen6eca1a62017-01-12 10:17:53 -080035/**
Anish Nataraj38a29562017-08-18 19:41:17 +053036* dp_rx_populate_cdp_indication_ppdu() - Populate cdp rx indication structure
Soumya Bhat560f90c2018-03-30 13:53:26 +053037* @pdev: pdev ctx
Anish Nataraj38a29562017-08-18 19:41:17 +053038* @ppdu_info: ppdu info structure from ppdu ring
39* @ppdu_nbuf: qdf nbuf abstraction for linux skb
40*
41* Return: none
42*/
43#ifdef FEATURE_PERPKT_INFO
44static inline void
Soumya Bhat560f90c2018-03-30 13:53:26 +053045dp_rx_populate_cdp_indication_ppdu(struct dp_pdev *pdev,
Anish Nataraj38a29562017-08-18 19:41:17 +053046 struct hal_rx_ppdu_info *ppdu_info,
47 qdf_nbuf_t ppdu_nbuf)
48{
49 struct dp_peer *peer;
Soumya Bhat560f90c2018-03-30 13:53:26 +053050 struct dp_soc *soc = pdev->soc;
Anish Nataraj38a29562017-08-18 19:41:17 +053051 struct dp_ast_entry *ast_entry;
52 struct cdp_rx_indication_ppdu *cdp_rx_ppdu;
53 uint32_t ast_index;
54
55 cdp_rx_ppdu = (struct cdp_rx_indication_ppdu *)ppdu_nbuf->data;
56
Pamidipati, Vijayd7eb83e2017-09-20 21:19:56 +053057 cdp_rx_ppdu->first_data_seq_ctrl =
58 ppdu_info->rx_status.first_data_seq_ctrl;
Anish Natarajeb30aa72018-09-20 16:34:01 +053059 cdp_rx_ppdu->frame_ctrl =
60 ppdu_info->rx_status.frame_control;
Anish Nataraj38a29562017-08-18 19:41:17 +053061 cdp_rx_ppdu->ppdu_id = ppdu_info->com_info.ppdu_id;
nobelj9ab76e22018-02-13 18:10:54 -080062 cdp_rx_ppdu->length = ppdu_info->rx_status.ppdu_len;
Anish Nataraj38a29562017-08-18 19:41:17 +053063 cdp_rx_ppdu->duration = ppdu_info->rx_status.duration;
64 cdp_rx_ppdu->u.bw = ppdu_info->rx_status.bw;
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +053065 cdp_rx_ppdu->tcp_msdu_count = ppdu_info->rx_status.tcp_msdu_count;
66 cdp_rx_ppdu->udp_msdu_count = ppdu_info->rx_status.udp_msdu_count;
67 cdp_rx_ppdu->other_msdu_count = ppdu_info->rx_status.other_msdu_count;
Anish Nataraj38a29562017-08-18 19:41:17 +053068 cdp_rx_ppdu->u.nss = ppdu_info->rx_status.nss;
69 cdp_rx_ppdu->u.mcs = ppdu_info->rx_status.mcs;
Keyur Parekh49cdc742018-05-09 10:59:03 -070070 if ((ppdu_info->rx_status.sgi == VHT_SGI_NYSM) &&
71 (ppdu_info->rx_status.preamble_type == HAL_RX_PKT_TYPE_11AC))
72 cdp_rx_ppdu->u.gi = CDP_SGI_0_4_US;
73 else
74 cdp_rx_ppdu->u.gi = ppdu_info->rx_status.sgi;
Anish Nataraj50347012018-03-06 21:12:45 +053075 cdp_rx_ppdu->u.ldpc = ppdu_info->rx_status.ldpc;
Anish Nataraj38a29562017-08-18 19:41:17 +053076 cdp_rx_ppdu->u.preamble = ppdu_info->rx_status.preamble_type;
Anish Nataraj28490c42018-01-19 19:34:54 +053077 cdp_rx_ppdu->u.ppdu_type = ppdu_info->rx_status.reception_type;
Anish Nataraj38a29562017-08-18 19:41:17 +053078 cdp_rx_ppdu->rssi = ppdu_info->rx_status.rssi_comb;
Anish Nataraj57614da2018-02-07 23:04:24 +053079 cdp_rx_ppdu->timestamp = ppdu_info->rx_status.tsft;
80 cdp_rx_ppdu->channel = ppdu_info->rx_status.chan_num;
nobeljd8039592018-03-13 16:59:42 -070081 cdp_rx_ppdu->beamformed = ppdu_info->rx_status.beamformed;
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +053082 cdp_rx_ppdu->num_msdu = (cdp_rx_ppdu->tcp_msdu_count +
83 cdp_rx_ppdu->udp_msdu_count +
84 cdp_rx_ppdu->other_msdu_count);
Pranita Solankeed0aba62018-01-12 19:14:31 +053085
Anish Nataraj57614da2018-02-07 23:04:24 +053086 cdp_rx_ppdu->num_mpdu = ppdu_info->com_info.mpdu_cnt_fcs_ok;
Pranita Solankeed0aba62018-01-12 19:14:31 +053087 if (ppdu_info->com_info.mpdu_cnt_fcs_ok > 1)
88 cdp_rx_ppdu->is_ampdu = 1;
89 else
90 cdp_rx_ppdu->is_ampdu = 0;
Anish Nataraj45d282c2017-12-30 01:03:38 +053091
92 cdp_rx_ppdu->tid = ppdu_info->rx_status.tid;
Anish Nataraj57614da2018-02-07 23:04:24 +053093 cdp_rx_ppdu->lsig_a = ppdu_info->rx_status.rate;
Soumya Bhat560f90c2018-03-30 13:53:26 +053094
95 ast_index = ppdu_info->rx_status.ast_index;
96 if (ast_index > (WLAN_UMAC_PSOC_MAX_PEERS * 2)) {
97 cdp_rx_ppdu->peer_id = HTT_INVALID_PEER;
98 return;
99 }
100
101 ast_entry = soc->ast_table[ast_index];
102 if (!ast_entry) {
103 cdp_rx_ppdu->peer_id = HTT_INVALID_PEER;
104 return;
105 }
106 peer = ast_entry->peer;
107 if (!peer || peer->peer_ids[0] == HTT_INVALID_PEER) {
108 cdp_rx_ppdu->peer_id = HTT_INVALID_PEER;
109 return;
110 }
111
112 qdf_mem_copy(cdp_rx_ppdu->mac_addr,
113 peer->mac_addr.raw, DP_MAC_ADDR_LEN);
114 cdp_rx_ppdu->peer_id = peer->peer_ids[0];
115 cdp_rx_ppdu->vdev_id = peer->vdev->vdev_id;
Anish Nataraj38a29562017-08-18 19:41:17 +0530116}
117#else
118static inline void
Soumya Bhat560f90c2018-03-30 13:53:26 +0530119dp_rx_populate_cdp_indication_ppdu(struct dp_pdev *pdev,
Anish Nataraj38a29562017-08-18 19:41:17 +0530120 struct hal_rx_ppdu_info *ppdu_info,
121 qdf_nbuf_t ppdu_nbuf)
122{
123}
124#endif
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530125/**
126 * dp_rx_stats_update() - Update per-peer statistics
127 * @soc: Datapath SOC handle
128 * @peer: Datapath peer handle
129 * @ppdu: PPDU Descriptor
130 *
131 * Return: None
132 */
133#ifdef FEATURE_PERPKT_INFO
ydb247452018-08-08 00:23:16 +0530134static inline void dp_rx_rate_stats_update(struct dp_peer *peer,
135 struct cdp_rx_indication_ppdu *ppdu)
136{
137 uint32_t ratekbps = 0;
138 uint32_t ppdu_rx_rate = 0;
139 uint32_t nss = 0;
140
141 if (!peer || !ppdu)
142 return;
143
144 if (ppdu->u.nss == 0)
145 nss = 0;
146 else
147 nss = ppdu->u.nss - 1;
148
Anish Nataraj376d9b12018-08-13 14:12:01 +0530149 ratekbps = dp_getrateindex(ppdu->u.gi,
150 ppdu->u.mcs,
ydb247452018-08-08 00:23:16 +0530151 nss,
152 ppdu->u.preamble,
153 ppdu->u.bw);
154
155 if (!ratekbps)
156 return;
157
158 DP_STATS_UPD(peer, rx.last_rx_rate, ratekbps);
159 dp_ath_rate_lpf(peer->stats.rx.avg_rx_rate, ratekbps);
160 ppdu_rx_rate = dp_ath_rate_out(peer->stats.rx.avg_rx_rate);
161 DP_STATS_UPD(peer, rx.rnd_avg_rx_rate, ppdu_rx_rate);
162
163 if (peer->vdev)
164 peer->vdev->stats.rx.last_rx_rate = ratekbps;
165}
166
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530167static void dp_rx_stats_update(struct dp_pdev *pdev, struct dp_peer *peer,
168 struct cdp_rx_indication_ppdu *ppdu)
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530169{
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530170 struct dp_soc *soc = NULL;
Anish Nataraj28490c42018-01-19 19:34:54 +0530171 uint8_t mcs, preamble, ac = 0;
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530172 uint16_t num_msdu;
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530173 bool is_invalid_peer = false;
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530174
175 mcs = ppdu->u.mcs;
176 preamble = ppdu->u.preamble;
177 num_msdu = ppdu->num_msdu;
178
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530179 if (pdev)
180 soc = pdev->soc;
181 else
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530182 return;
183
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530184 if (!peer) {
185 is_invalid_peer = true;
186 peer = pdev->invalid_peer;
187 }
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530188
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530189 if (!soc || soc->process_rx_status)
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530190 return;
Pranita Solankefc2ff392017-12-15 19:25:13 +0530191
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530192 DP_STATS_UPD(peer, rx.rssi, ppdu->rssi);
Pranita Solankeed0aba62018-01-12 19:14:31 +0530193
194 if ((preamble == DOT11_A) || (preamble == DOT11_B))
195 ppdu->u.nss = 1;
196
197 if (ppdu->u.nss)
198 DP_STATS_INC(peer, rx.nss[ppdu->u.nss - 1], num_msdu);
199
Pranita Solankea12b4b32017-11-20 23:04:14 +0530200 DP_STATS_INC(peer, rx.sgi_count[ppdu->u.gi], num_msdu);
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530201 DP_STATS_INC(peer, rx.bw[ppdu->u.bw], num_msdu);
Anish Nataraj28490c42018-01-19 19:34:54 +0530202 DP_STATS_INC(peer, rx.reception_type[ppdu->u.ppdu_type], num_msdu);
Pranita Solankea12b4b32017-11-20 23:04:14 +0530203 DP_STATS_INCC(peer, rx.ampdu_cnt, num_msdu, ppdu->is_ampdu);
204 DP_STATS_INCC(peer, rx.non_ampdu_cnt, num_msdu, !(ppdu->is_ampdu));
205 DP_STATS_UPD(peer, rx.rx_rate, mcs);
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530206 DP_STATS_INCC(peer,
Pranita Solankeed0aba62018-01-12 19:14:31 +0530207 rx.pkt_type[preamble].mcs_count[MAX_MCS - 1], num_msdu,
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530208 ((mcs >= MAX_MCS_11A) && (preamble == DOT11_A)));
209 DP_STATS_INCC(peer,
210 rx.pkt_type[preamble].mcs_count[mcs], num_msdu,
Pranita Solankea12b4b32017-11-20 23:04:14 +0530211 ((mcs < MAX_MCS_11A) && (preamble == DOT11_A)));
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530212 DP_STATS_INCC(peer,
Pranita Solankeed0aba62018-01-12 19:14:31 +0530213 rx.pkt_type[preamble].mcs_count[MAX_MCS - 1], num_msdu,
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530214 ((mcs >= MAX_MCS_11B) && (preamble == DOT11_B)));
215 DP_STATS_INCC(peer,
216 rx.pkt_type[preamble].mcs_count[mcs], num_msdu,
Pranita Solankea12b4b32017-11-20 23:04:14 +0530217 ((mcs < MAX_MCS_11B) && (preamble == DOT11_B)));
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530218 DP_STATS_INCC(peer,
Pranita Solankeed0aba62018-01-12 19:14:31 +0530219 rx.pkt_type[preamble].mcs_count[MAX_MCS - 1], num_msdu,
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530220 ((mcs >= MAX_MCS_11A) && (preamble == DOT11_N)));
221 DP_STATS_INCC(peer,
222 rx.pkt_type[preamble].mcs_count[mcs], num_msdu,
Pranita Solankea12b4b32017-11-20 23:04:14 +0530223 ((mcs < MAX_MCS_11A) && (preamble == DOT11_N)));
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530224 DP_STATS_INCC(peer,
Pranita Solankeed0aba62018-01-12 19:14:31 +0530225 rx.pkt_type[preamble].mcs_count[MAX_MCS - 1], num_msdu,
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530226 ((mcs >= MAX_MCS_11AC) && (preamble == DOT11_AC)));
227 DP_STATS_INCC(peer,
228 rx.pkt_type[preamble].mcs_count[mcs], num_msdu,
229 ((mcs < MAX_MCS_11AC) && (preamble == DOT11_AC)));
230 DP_STATS_INCC(peer,
Pranita Solankeed0aba62018-01-12 19:14:31 +0530231 rx.pkt_type[preamble].mcs_count[MAX_MCS - 1], num_msdu,
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530232 ((mcs >= (MAX_MCS - 1)) && (preamble == DOT11_AX)));
233 DP_STATS_INCC(peer,
234 rx.pkt_type[preamble].mcs_count[mcs], num_msdu,
235 ((mcs < (MAX_MCS - 1)) && (preamble == DOT11_AX)));
Anish Nataraj28490c42018-01-19 19:34:54 +0530236 /*
237 * If invalid TID, it could be a non-qos frame, hence do not update
238 * any AC counters
239 */
240 ac = TID_TO_WME_AC(ppdu->tid);
241 if (ppdu->tid != HAL_TID_INVALID)
242 DP_STATS_INC(peer, rx.wme_ac_type[ac], num_msdu);
Amir Patel52c6b732018-08-03 12:13:22 +0530243 dp_peer_stats_notify(peer);
244 DP_STATS_UPD(peer, rx.last_rssi, ppdu->rssi);
Anish Nataraj28490c42018-01-19 19:34:54 +0530245
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530246 if (is_invalid_peer)
247 return;
248
ydb247452018-08-08 00:23:16 +0530249 dp_rx_rate_stats_update(peer, ppdu);
250
Amir Patel756d05e2018-10-10 12:35:30 +0530251#if defined(FEATURE_PERPKT_INFO) && WDI_EVENT_ENABLE
252 dp_wdi_event_handler(WDI_EVENT_UPDATE_DP_STATS, pdev->soc,
253 &peer->stats, ppdu->peer_id,
254 UPDATE_PEER_STATS, pdev->pdev_id);
255#endif
Pamidipati, Vijay57a435a2017-10-17 11:03:39 +0530256}
257#endif
Anish Nataraj38a29562017-08-18 19:41:17 +0530258
259/**
Soumya Bhat7422db82017-12-15 13:48:53 +0530260 * dp_rx_handle_mcopy_mode() - Allocate and deliver first MSDU payload
Pranita Solankefc2ff392017-12-15 19:25:13 +0530261 * @soc: core txrx main context
262 * @pdev: pdev strcuture
263 * @ppdu_info: structure for rx ppdu ring
264 *
265 * Return: QDF_STATUS_SUCCESS - If nbuf to be freed by caller
266 * QDF_STATUS_E_ALREADY - If nbuf not to be freed by caller
Soumya Bhat7422db82017-12-15 13:48:53 +0530267 */
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530268#ifdef FEATURE_PERPKT_INFO
269static inline QDF_STATUS
Soumya Bhat7422db82017-12-15 13:48:53 +0530270dp_rx_handle_mcopy_mode(struct dp_soc *soc, struct dp_pdev *pdev,
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530271 struct hal_rx_ppdu_info *ppdu_info, qdf_nbuf_t nbuf)
272{
273 uint8_t size = 0;
274
Soumya Bhatdc8aca82018-03-13 14:10:24 +0530275 if (ppdu_info->msdu_info.first_msdu_payload == NULL)
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530276 return QDF_STATUS_SUCCESS;
277
Soumya Bhat2f54de22018-02-21 09:54:28 +0530278 if (pdev->m_copy_id.rx_ppdu_id == ppdu_info->com_info.ppdu_id)
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530279 return QDF_STATUS_SUCCESS;
280
Soumya Bhat2f54de22018-02-21 09:54:28 +0530281 pdev->m_copy_id.rx_ppdu_id = ppdu_info->com_info.ppdu_id;
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530282
Soumya Bhat2f54de22018-02-21 09:54:28 +0530283 /* Include 2 bytes of reserved space appended to the msdu payload */
Soumya Bhatdc8aca82018-03-13 14:10:24 +0530284 size = (ppdu_info->msdu_info.first_msdu_payload -
285 qdf_nbuf_data(nbuf)) + 2;
286 ppdu_info->msdu_info.first_msdu_payload = NULL;
Soumya Bhat7422db82017-12-15 13:48:53 +0530287
288 if (qdf_nbuf_pull_head(nbuf, size) == NULL)
289 return QDF_STATUS_SUCCESS;
290
Soumya Bhatdc8aca82018-03-13 14:10:24 +0530291 /* only retain RX MSDU payload in the skb */
292 qdf_nbuf_trim_tail(nbuf, qdf_nbuf_len(nbuf) -
293 ppdu_info->msdu_info.payload_len);
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530294 dp_wdi_event_handler(WDI_EVENT_RX_DATA, soc,
295 nbuf, HTT_INVALID_PEER, WDI_NO_VAL, pdev->pdev_id);
296 return QDF_STATUS_E_ALREADY;
297}
298#else
299static inline QDF_STATUS
Soumya Bhat7422db82017-12-15 13:48:53 +0530300dp_rx_handle_mcopy_mode(struct dp_soc *soc, struct dp_pdev *pdev,
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530301 struct hal_rx_ppdu_info *ppdu_info, qdf_nbuf_t nbuf)
302{
303 return QDF_STATUS_SUCCESS;
304}
305#endif
306
sumedh baikady59a2d332018-05-22 01:50:38 -0700307/**
308 * dp_rx_handle_smart_mesh_mode() - Deliver header for smart mesh
309 * @soc: Datapath SOC handle
310 * @pdev: Datapath PDEV handle
311 * @ppdu_info: Structure for rx ppdu info
312 * @nbuf: Qdf nbuf abstraction for linux skb
313 *
314 * Return: 0 on success, 1 on failure
315 */
316static inline int
317dp_rx_handle_smart_mesh_mode(struct dp_soc *soc, struct dp_pdev *pdev,
318 struct hal_rx_ppdu_info *ppdu_info,
319 qdf_nbuf_t nbuf)
320{
321 uint8_t size = 0;
322
323 if (!pdev->monitor_vdev) {
324 QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
325 "[%s]:[%d] Monitor vdev is NULL !!",
326 __func__, __LINE__);
327 return 1;
328 }
329 if (ppdu_info->msdu_info.first_msdu_payload == NULL) {
330 QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
331 "[%s]:[%d] First msdu payload not present",
332 __func__, __LINE__);
333 return 1;
334 }
335
336 /* Include 2 bytes of reserved space appended to the msdu payload */
337 size = (ppdu_info->msdu_info.first_msdu_payload -
338 qdf_nbuf_data(nbuf)) + 2;
339 ppdu_info->msdu_info.first_msdu_payload = NULL;
340
341 if (qdf_nbuf_pull_head(nbuf, size) == NULL) {
342 QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
343 "[%s]:[%d] No header present",
344 __func__, __LINE__);
345 return 1;
346 }
347
348 /* only retain RX MSDU payload in the skb */
349 qdf_nbuf_trim_tail(nbuf, qdf_nbuf_len(nbuf) -
350 ppdu_info->msdu_info.payload_len);
351 qdf_nbuf_update_radiotap(&(pdev->ppdu_info.rx_status),
352 nbuf, sizeof(struct rx_pkt_tlvs));
353 pdev->monitor_vdev->osif_rx_mon(pdev->monitor_vdev->osif_vdev,
354 nbuf, NULL);
355
356 return 0;
357}
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530358
359/**
Anish Nataraj38a29562017-08-18 19:41:17 +0530360* dp_rx_handle_ppdu_stats() - Allocate and deliver ppdu stats to cdp layer
361* @soc: core txrx main context
362* @pdev: pdev strcuture
363* @ppdu_info: structure for rx ppdu ring
364*
365* Return: none
366*/
367#ifdef FEATURE_PERPKT_INFO
368static inline void
369dp_rx_handle_ppdu_stats(struct dp_soc *soc, struct dp_pdev *pdev,
370 struct hal_rx_ppdu_info *ppdu_info)
371{
372 qdf_nbuf_t ppdu_nbuf;
373 struct dp_peer *peer;
374 struct cdp_rx_indication_ppdu *cdp_rx_ppdu;
375
Anish Nataraj28490c42018-01-19 19:34:54 +0530376 /*
377 * Do not allocate if fcs error,
378 * ast idx invalid / fctl invalid
379 */
Anish Nataraj28490c42018-01-19 19:34:54 +0530380 if (ppdu_info->com_info.mpdu_cnt_fcs_ok == 0)
381 return;
382
Chaithanya Garrepalli95fc62f2018-07-24 18:52:27 +0530383 if (ppdu_info->nac_info.fc_valid &&
384 ppdu_info->nac_info.to_ds_flag &&
385 ppdu_info->nac_info.mac_addr2_valid) {
386 struct dp_neighbour_peer *peer = NULL;
387 uint8_t rssi = ppdu_info->rx_status.rssi_comb;
388
389 qdf_spin_lock_bh(&pdev->neighbour_peer_mutex);
390 if (pdev->neighbour_peers_added) {
391 TAILQ_FOREACH(peer, &pdev->neighbour_peers_list,
392 neighbour_peer_list_elem) {
393 if (!qdf_mem_cmp(&peer->neighbour_peers_macaddr,
394 &ppdu_info->nac_info.mac_addr2,
395 DP_MAC_ADDR_LEN)) {
396 peer->rssi = rssi;
397 break;
398 }
399 }
400 }
401 qdf_spin_unlock_bh(&pdev->neighbour_peer_mutex);
402 }
403
Soumya Bhat560f90c2018-03-30 13:53:26 +0530404 if (!pdev->mcopy_mode) {
405 if (!ppdu_info->rx_status.frame_control_info_valid)
406 return;
Anish Nataraj28490c42018-01-19 19:34:54 +0530407
Soumya Bhat560f90c2018-03-30 13:53:26 +0530408 if (ppdu_info->rx_status.ast_index == HAL_AST_IDX_INVALID)
409 return;
410 }
Tallapragada Kalyana867edf2017-11-14 12:26:41 +0530411 ppdu_nbuf = qdf_nbuf_alloc(soc->osdev,
Anish Nataraj38a29562017-08-18 19:41:17 +0530412 sizeof(struct hal_rx_ppdu_info), 0, 0, FALSE);
413 if (ppdu_nbuf) {
Soumya Bhat560f90c2018-03-30 13:53:26 +0530414 dp_rx_populate_cdp_indication_ppdu(pdev, ppdu_info, ppdu_nbuf);
Anish Nataraj38a29562017-08-18 19:41:17 +0530415 qdf_nbuf_put_tail(ppdu_nbuf,
416 sizeof(struct cdp_rx_indication_ppdu));
417 cdp_rx_ppdu = (struct cdp_rx_indication_ppdu *)ppdu_nbuf->data;
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530418 peer = dp_peer_find_by_id(soc, cdp_rx_ppdu->peer_id);
Sravan Kumar Kairam26d471e2018-08-14 23:51:58 +0530419 if (cdp_rx_ppdu->peer_id != HTT_INVALID_PEER) {
Sravan Kumar Kairam26d471e2018-08-14 23:51:58 +0530420 if (peer) {
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530421 dp_rx_stats_update(pdev, peer, cdp_rx_ppdu);
Sravan Kumar Kairam26d471e2018-08-14 23:51:58 +0530422 dp_wdi_event_handler(WDI_EVENT_RX_PPDU_DESC,
423 soc, ppdu_nbuf, cdp_rx_ppdu->peer_id,
Anish Nataraj38a29562017-08-18 19:41:17 +0530424 WDI_NO_VAL, pdev->pdev_id);
Sravan Kumar Kairam26d471e2018-08-14 23:51:58 +0530425 dp_peer_unref_del_find_by_id(peer);
426 }
Soumya Bhat2f54de22018-02-21 09:54:28 +0530427 } else if (pdev->mcopy_mode) {
Ruchi, Agrawal4c5ade62018-09-27 21:52:11 +0530428 dp_rx_stats_update(pdev, peer, cdp_rx_ppdu);
Soumya Bhat2f54de22018-02-21 09:54:28 +0530429 dp_wdi_event_handler(WDI_EVENT_RX_PPDU_DESC, soc,
430 ppdu_nbuf, HTT_INVALID_PEER,
431 WDI_NO_VAL, pdev->pdev_id);
432 } else {
Anish Nataraj38a29562017-08-18 19:41:17 +0530433 qdf_nbuf_free(ppdu_nbuf);
Soumya Bhat2f54de22018-02-21 09:54:28 +0530434 }
Anish Nataraj38a29562017-08-18 19:41:17 +0530435 }
436}
437#else
438static inline void
439dp_rx_handle_ppdu_stats(struct dp_soc *soc, struct dp_pdev *pdev,
440 struct hal_rx_ppdu_info *ppdu_info)
441{
442}
443#endif
444
445/**
Kai Chen6eca1a62017-01-12 10:17:53 -0800446* dp_rx_mon_status_process_tlv() - Process status TLV in status
447* buffer on Rx status Queue posted by status SRNG processing.
448* @soc: core txrx main context
449* @mac_id: mac_id which is one of 3 mac_ids _ring
450*
451* Return: none
452*/
453static inline void
Karunakar Dasineni40555682017-03-26 22:44:39 -0700454dp_rx_mon_status_process_tlv(struct dp_soc *soc, uint32_t mac_id,
455 uint32_t quota)
456{
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800457 struct dp_pdev *pdev = dp_get_pdev_for_mac_id(soc, mac_id);
Kai Chen6eca1a62017-01-12 10:17:53 -0800458 struct hal_rx_ppdu_info *ppdu_info;
459 qdf_nbuf_t status_nbuf;
460 uint8_t *rx_tlv;
461 uint8_t *rx_tlv_start;
Kai Chenad516ae2017-09-08 18:35:47 -0700462 uint32_t tlv_status = HAL_TLV_STATUS_BUF_DONE;
Soumya Bhat2f54de22018-02-21 09:54:28 +0530463 QDF_STATUS m_copy_status = QDF_STATUS_SUCCESS;
Kai Chen783e0382018-01-25 16:29:08 -0800464 struct cdp_pdev_mon_stats *rx_mon_stats;
sumedh baikady59a2d332018-05-22 01:50:38 -0700465 int smart_mesh_status;
Kai Chen6eca1a62017-01-12 10:17:53 -0800466
Kai Chen6eca1a62017-01-12 10:17:53 -0800467 ppdu_info = &pdev->ppdu_info;
Kai Chen783e0382018-01-25 16:29:08 -0800468 rx_mon_stats = &pdev->rx_mon_stats;
Kai Chen6eca1a62017-01-12 10:17:53 -0800469
470 if (pdev->mon_ppdu_status != DP_PPDU_STATUS_START)
471 return;
472
473 while (!qdf_nbuf_is_queue_empty(&pdev->rx_status_q)) {
474
475 status_nbuf = qdf_nbuf_queue_remove(&pdev->rx_status_q);
476 rx_tlv = qdf_nbuf_data(status_nbuf);
477 rx_tlv_start = rx_tlv;
Venkata Sharath Chandra Manchala5a6f4292017-11-03 14:57:41 -0700478
Keyur Parekhfad6d082017-05-07 08:54:47 -0700479#ifndef REMOVE_PKT_LOG
Venkata Sharath Chandra Manchala5a6f4292017-11-03 14:57:41 -0700480#if defined(WDI_EVENT_ENABLE)
Keyur Parekhfad6d082017-05-07 08:54:47 -0700481 dp_wdi_event_handler(WDI_EVENT_RX_DESC, soc,
Keyur Parekhdb0fa142017-07-13 19:40:22 -0700482 status_nbuf, HTT_INVALID_PEER, WDI_NO_VAL, mac_id);
Keyur Parekhfad6d082017-05-07 08:54:47 -0700483#endif
484#endif
Soumya Bhat2f54de22018-02-21 09:54:28 +0530485 if ((pdev->monitor_vdev != NULL) || (pdev->enhanced_stats_en) ||
486 pdev->mcopy_mode) {
Kai Chen6eca1a62017-01-12 10:17:53 -0800487
Keyur Parekhfad6d082017-05-07 08:54:47 -0700488 do {
489 tlv_status = hal_rx_status_get_tlv_info(rx_tlv,
Balamurugan Mahalingamd0159642018-07-11 15:02:29 +0530490 ppdu_info, pdev->soc->hal_soc);
Kai Chen783e0382018-01-25 16:29:08 -0800491
492 dp_rx_mon_update_dbg_ppdu_stats(ppdu_info,
493 rx_mon_stats);
494
Keyur Parekhfad6d082017-05-07 08:54:47 -0700495 rx_tlv = hal_rx_status_get_next_tlv(rx_tlv);
Kai Chen6eca1a62017-01-12 10:17:53 -0800496
Keyur Parekhfad6d082017-05-07 08:54:47 -0700497 if ((rx_tlv - rx_tlv_start) >= RX_BUFFER_SIZE)
498 break;
Kai Chen6eca1a62017-01-12 10:17:53 -0800499
Keyur Parekhfad6d082017-05-07 08:54:47 -0700500 } while (tlv_status == HAL_TLV_STATUS_PPDU_NOT_DONE);
501 }
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530502
sumedh baikady59a2d332018-05-22 01:50:38 -0700503 if (ppdu_info->rx_status.monitor_direct_used && pdev->neighbour_peers_added
504 && pdev->monitor_vdev) {
505 smart_mesh_status = dp_rx_handle_smart_mesh_mode(soc,
506 pdev, ppdu_info, status_nbuf);
507 if (smart_mesh_status)
508 qdf_nbuf_free(status_nbuf);
509 }
Soumya Bhat7422db82017-12-15 13:48:53 +0530510 if (pdev->mcopy_mode) {
Soumya Bhat2f54de22018-02-21 09:54:28 +0530511 m_copy_status = dp_rx_handle_mcopy_mode(soc,
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530512 pdev, ppdu_info, status_nbuf);
Soumya Bhat2f54de22018-02-21 09:54:28 +0530513 if (m_copy_status == QDF_STATUS_SUCCESS)
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530514 qdf_nbuf_free(status_nbuf);
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530515 }
sumedh baikady59a2d332018-05-22 01:50:38 -0700516 if (!pdev->neighbour_peers_added && !pdev->mcopy_mode)
517 qdf_nbuf_free(status_nbuf);
Kai Chen6eca1a62017-01-12 10:17:53 -0800518
chenguo1b880462018-07-11 15:34:56 +0800519 if (tlv_status == HAL_TLV_STATUS_PPDU_NON_STD_DONE) {
520 dp_rx_mon_deliver_non_std(soc, mac_id);
521 } else if (tlv_status == HAL_TLV_STATUS_PPDU_DONE) {
Kai Chen783e0382018-01-25 16:29:08 -0800522 rx_mon_stats->status_ppdu_done++;
Soumya Bhat5c60deb2017-12-12 16:42:04 +0530523 if (pdev->enhanced_stats_en ||
sumedh baikady59a2d332018-05-22 01:50:38 -0700524 pdev->mcopy_mode || pdev->neighbour_peers_added)
Anish Nataraj38a29562017-08-18 19:41:17 +0530525 dp_rx_handle_ppdu_stats(soc, pdev, ppdu_info);
Soumya Bhat6fee59c2017-10-31 13:12:37 +0530526
nobelj1c31fee2018-03-21 11:47:05 -0700527 pdev->mon_ppdu_status = DP_PPDU_STATUS_DONE;
528 dp_rx_mon_dest_process(soc, mac_id, quota);
Kai Chencbe4c342017-06-12 20:06:35 -0700529 pdev->mon_ppdu_status = DP_PPDU_STATUS_START;
Kai Chen6eca1a62017-01-12 10:17:53 -0800530 }
531 }
532 return;
533}
534
535/*
536 * dp_rx_mon_status_srng_process() - Process monitor status ring
537 * post the status ring buffer to Rx status Queue for later
538 * processing when status ring is filled with status TLV.
539 * Allocate a new buffer to status ring if the filled buffer
540 * is posted.
541 *
542 * @soc: core txrx main context
543 * @mac_id: mac_id which is one of 3 mac_ids
544 * @quota: No. of ring entry that can be serviced in one shot.
545
546 * Return: uint32_t: No. of ring entry that is processed.
547 */
548static inline uint32_t
549dp_rx_mon_status_srng_process(struct dp_soc *soc, uint32_t mac_id,
550 uint32_t quota)
551{
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800552 struct dp_pdev *pdev = dp_get_pdev_for_mac_id(soc, mac_id);
Kai Chen6eca1a62017-01-12 10:17:53 -0800553 void *hal_soc;
554 void *mon_status_srng;
555 void *rxdma_mon_status_ring_entry;
556 QDF_STATUS status;
557 uint32_t work_done = 0;
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800558 int mac_for_pdev = dp_get_mac_id_for_mac(soc, mac_id);
Kai Chen6eca1a62017-01-12 10:17:53 -0800559
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800560 mon_status_srng = pdev->rxdma_mon_status_ring[mac_for_pdev].hal_srng;
Kai Chen6eca1a62017-01-12 10:17:53 -0800561
562 qdf_assert(mon_status_srng);
Houston Hoffman648a9182017-05-21 23:27:50 -0700563 if (!mon_status_srng || !hal_srng_initialized(mon_status_srng)) {
564
565 QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
Aditya Sathishded018e2018-07-02 16:25:21 +0530566 "%s %d : HAL Monitor Status Ring Init Failed -- %pK",
Houston Hoffman648a9182017-05-21 23:27:50 -0700567 __func__, __LINE__, mon_status_srng);
568 return work_done;
569 }
Kai Chen6eca1a62017-01-12 10:17:53 -0800570
571 hal_soc = soc->hal_soc;
572
573 qdf_assert(hal_soc);
574
575 if (qdf_unlikely(hal_srng_access_start(hal_soc, mon_status_srng)))
576 goto done;
577
578 /* mon_status_ring_desc => WBM_BUFFER_RING STRUCT =>
579 * BUFFER_ADDR_INFO STRUCT
580 */
581 while (qdf_likely((rxdma_mon_status_ring_entry =
582 hal_srng_src_peek(hal_soc, mon_status_srng))
583 && quota--)) {
584 uint32_t rx_buf_cookie;
585 qdf_nbuf_t status_nbuf;
586 struct dp_rx_desc *rx_desc;
587 uint8_t *status_buf;
588 qdf_dma_addr_t paddr;
589 uint64_t buf_addr;
590
591 buf_addr =
592 (HAL_RX_BUFFER_ADDR_31_0_GET(
593 rxdma_mon_status_ring_entry) |
594 ((uint64_t)(HAL_RX_BUFFER_ADDR_39_32_GET(
595 rxdma_mon_status_ring_entry)) << 32));
596
597 if (qdf_likely(buf_addr)) {
598
599 rx_buf_cookie =
600 HAL_RX_BUF_COOKIE_GET(
601 rxdma_mon_status_ring_entry);
602 rx_desc = dp_rx_cookie_2_va_mon_status(soc,
603 rx_buf_cookie);
604
605 qdf_assert(rx_desc);
606
607 status_nbuf = rx_desc->nbuf;
608
609 qdf_nbuf_sync_for_cpu(soc->osdev, status_nbuf,
610 QDF_DMA_FROM_DEVICE);
611
612 status_buf = qdf_nbuf_data(status_nbuf);
613
614 status = hal_get_rx_status_done(status_buf);
615
616 if (status != QDF_STATUS_SUCCESS) {
Karunakar Dasineni37995ac2018-02-06 12:37:30 -0800617 uint32_t hp, tp;
Venkata Sharath Chandra Manchala443b9b42018-10-10 12:04:54 -0700618 hal_get_sw_hptp(hal_soc, mon_status_srng,
619 &tp, &hp);
Kai Chen6eca1a62017-01-12 10:17:53 -0800620 QDF_TRACE(QDF_MODULE_ID_DP,
Karunakar Dasineni37995ac2018-02-06 12:37:30 -0800621 QDF_TRACE_LEVEL_ERROR,
622 "[%s][%d] status not done - hp:%u, tp:%u",
623 __func__, __LINE__, hp, tp);
624 /* WAR for missing status: Skip status entry */
625 hal_srng_src_get_next(hal_soc, mon_status_srng);
626 continue;
Kai Chen6eca1a62017-01-12 10:17:53 -0800627 }
628 qdf_nbuf_set_pktlen(status_nbuf, RX_BUFFER_SIZE);
629
630 qdf_nbuf_unmap_single(soc->osdev, status_nbuf,
631 QDF_DMA_FROM_DEVICE);
632
633 /* Put the status_nbuf to queue */
634 qdf_nbuf_queue_add(&pdev->rx_status_q, status_nbuf);
635
636 } else {
637 union dp_rx_desc_list_elem_t *desc_list = NULL;
638 union dp_rx_desc_list_elem_t *tail = NULL;
639 struct rx_desc_pool *rx_desc_pool;
640 uint32_t num_alloc_desc;
641
642 rx_desc_pool = &soc->rx_desc_status[mac_id];
643
644 num_alloc_desc = dp_rx_get_free_desc_list(soc, mac_id,
645 rx_desc_pool,
646 1,
647 &desc_list,
648 &tail);
649
650 rx_desc = &desc_list->rx_desc;
651 }
652
jinweic chenc3546322018-02-02 15:03:41 +0800653 status_nbuf = dp_rx_nbuf_prepare(soc, pdev);
Kai Chen6eca1a62017-01-12 10:17:53 -0800654
jinweic chenc3546322018-02-02 15:03:41 +0800655 /*
656 * qdf_nbuf alloc or map failed,
657 * free the dp rx desc to free list,
658 * fill in NULL dma address at current HP entry,
659 * keep HP in mon_status_ring unchanged,
660 * wait next time dp_rx_mon_status_srng_process
661 * to fill in buffer at current HP.
662 */
663 if (qdf_unlikely(status_nbuf == NULL)) {
664 union dp_rx_desc_list_elem_t *desc_list = NULL;
665 union dp_rx_desc_list_elem_t *tail = NULL;
666 struct rx_desc_pool *rx_desc_pool;
Kai Chen6eca1a62017-01-12 10:17:53 -0800667
jinweic chenc3546322018-02-02 15:03:41 +0800668 rx_desc_pool = &soc->rx_desc_status[mac_id];
Kai Chen6eca1a62017-01-12 10:17:53 -0800669
jinweic chenc3546322018-02-02 15:03:41 +0800670 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
671 "%s: fail to allocate or map qdf_nbuf",
672 __func__);
673 dp_rx_add_to_free_desc_list(&desc_list,
674 &tail, rx_desc);
675 dp_rx_add_desc_list_to_free_list(soc, &desc_list,
676 &tail, mac_id, rx_desc_pool);
677
678 hal_rxdma_buff_addr_info_set(
679 rxdma_mon_status_ring_entry,
680 0, 0, HAL_RX_BUF_RBM_SW3_BM);
681 work_done++;
682 break;
683 }
684
Kai Chen6eca1a62017-01-12 10:17:53 -0800685 paddr = qdf_nbuf_get_frag_paddr(status_nbuf, 0);
686
687 rx_desc->nbuf = status_nbuf;
Pramod Simha59fcb312017-06-22 17:43:16 -0700688 rx_desc->in_use = 1;
Kai Chen6eca1a62017-01-12 10:17:53 -0800689
690 hal_rxdma_buff_addr_info_set(rxdma_mon_status_ring_entry,
691 paddr, rx_desc->cookie, HAL_RX_BUF_RBM_SW3_BM);
692
Karunakar Dasineni37995ac2018-02-06 12:37:30 -0800693 hal_srng_src_get_next(hal_soc, mon_status_srng);
Kai Chen6eca1a62017-01-12 10:17:53 -0800694 work_done++;
695 }
696done:
697
698 hal_srng_access_end(hal_soc, mon_status_srng);
699
700 return work_done;
701
702}
703/*
704 * dp_rx_mon_status_process() - Process monitor status ring and
705 * TLV in status ring.
706 *
707 * @soc: core txrx main context
708 * @mac_id: mac_id which is one of 3 mac_ids
709 * @quota: No. of ring entry that can be serviced in one shot.
710
711 * Return: uint32_t: No. of ring entry that is processed.
712 */
713static inline uint32_t
714dp_rx_mon_status_process(struct dp_soc *soc, uint32_t mac_id, uint32_t quota) {
715 uint32_t work_done;
716
717 work_done = dp_rx_mon_status_srng_process(soc, mac_id, quota);
Karunakar Dasineni40555682017-03-26 22:44:39 -0700718 quota -= work_done;
719 dp_rx_mon_status_process_tlv(soc, mac_id, quota);
Kai Chen6eca1a62017-01-12 10:17:53 -0800720
721 return work_done;
722}
723/**
724 * dp_mon_process() - Main monitor mode processing roution.
725 * This call monitor status ring process then monitor
726 * destination ring process.
727 * Called from the bottom half (tasklet/NET_RX_SOFTIRQ)
728 * @soc: core txrx main context
729 * @mac_id: mac_id which is one of 3 mac_ids
730 * @quota: No. of status ring entry that can be serviced in one shot.
731
732 * Return: uint32_t: No. of ring entry that is processed.
733 */
734uint32_t
735dp_mon_process(struct dp_soc *soc, uint32_t mac_id, uint32_t quota) {
Karunakar Dasineni40555682017-03-26 22:44:39 -0700736 return dp_rx_mon_status_process(soc, mac_id, quota);
Kai Chen6eca1a62017-01-12 10:17:53 -0800737}
Karunakar Dasineni40555682017-03-26 22:44:39 -0700738
Kai Chen6eca1a62017-01-12 10:17:53 -0800739/**
Venkata Sharath Chandra Manchala87479582018-08-01 12:45:34 -0700740 * dp_rx_pdev_mon_status_detach() - detach dp rx for status ring
Kai Chen6eca1a62017-01-12 10:17:53 -0800741 * @pdev: core txrx pdev context
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800742 * @mac_id: mac_id/pdev_id correspondinggly for MCL and WIN
Kai Chen6eca1a62017-01-12 10:17:53 -0800743 *
744 * This function will detach DP RX status ring from
745 * main device context. will free DP Rx resources for
746 * status ring
747 *
748 * Return: QDF_STATUS_SUCCESS: success
749 * QDF_STATUS_E_RESOURCES: Error return
750 */
751QDF_STATUS
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800752dp_rx_pdev_mon_status_detach(struct dp_pdev *pdev, int mac_id)
Kai Chen6eca1a62017-01-12 10:17:53 -0800753{
Kai Chen6eca1a62017-01-12 10:17:53 -0800754 struct dp_soc *soc = pdev->soc;
755 struct rx_desc_pool *rx_desc_pool;
756
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800757 rx_desc_pool = &soc->rx_desc_status[mac_id];
758 if (rx_desc_pool->pool_size != 0)
759 dp_rx_desc_pool_free(soc, mac_id, rx_desc_pool);
Kai Chen6eca1a62017-01-12 10:17:53 -0800760
761 return QDF_STATUS_SUCCESS;
762}
763
764/*
765 * dp_rx_buffers_replenish() - replenish monitor status ring with
766 * rx nbufs called during dp rx
767 * monitor status ring initialization
768 *
769 * @soc: core txrx main context
770 * @mac_id: mac_id which is one of 3 mac_ids
771 * @dp_rxdma_srng: dp monitor status circular ring
772 * @rx_desc_pool; Pointer to Rx descriptor pool
773 * @num_req_buffers: number of buffer to be replenished
774 * @desc_list: list of descs if called from dp rx monitor status
775 * process or NULL during dp rx initialization or
776 * out of buffer interrupt
777 * @tail: tail of descs list
778 * @owner: who owns the nbuf (host, NSS etc...)
779 * Return: return success or failure
780 */
781static inline
782QDF_STATUS dp_rx_mon_status_buffers_replenish(struct dp_soc *dp_soc,
783 uint32_t mac_id,
784 struct dp_srng *dp_rxdma_srng,
785 struct rx_desc_pool *rx_desc_pool,
786 uint32_t num_req_buffers,
787 union dp_rx_desc_list_elem_t **desc_list,
788 union dp_rx_desc_list_elem_t **tail,
789 uint8_t owner)
790{
791 uint32_t num_alloc_desc;
792 uint16_t num_desc_to_free = 0;
793 uint32_t num_entries_avail;
jinweic chenc3546322018-02-02 15:03:41 +0800794 uint32_t count = 0;
Kai Chen6eca1a62017-01-12 10:17:53 -0800795 int sync_hw_ptr = 1;
796 qdf_dma_addr_t paddr;
797 qdf_nbuf_t rx_netbuf;
798 void *rxdma_ring_entry;
799 union dp_rx_desc_list_elem_t *next;
800 void *rxdma_srng;
jinweic chenc3546322018-02-02 15:03:41 +0800801 struct dp_pdev *dp_pdev = dp_get_pdev_for_mac_id(dp_soc, mac_id);
Kai Chen6eca1a62017-01-12 10:17:53 -0800802
803 rxdma_srng = dp_rxdma_srng->hal_srng;
804
805 qdf_assert(rxdma_srng);
806
Houston Hoffmanae850c62017-08-11 16:47:50 -0700807 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
Aditya Sathishded018e2018-07-02 16:25:21 +0530808 "[%s][%d] requested %d buffers for replenish",
Kai Chen6eca1a62017-01-12 10:17:53 -0800809 __func__, __LINE__, num_req_buffers);
810
811 /*
812 * if desc_list is NULL, allocate the descs from freelist
813 */
814 if (!(*desc_list)) {
815
816 num_alloc_desc = dp_rx_get_free_desc_list(dp_soc, mac_id,
817 rx_desc_pool,
818 num_req_buffers,
819 desc_list,
820 tail);
821
822 if (!num_alloc_desc) {
823 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
Aditya Sathishded018e2018-07-02 16:25:21 +0530824 "[%s][%d] no free rx_descs in freelist",
Kai Chen6eca1a62017-01-12 10:17:53 -0800825 __func__, __LINE__);
826 return QDF_STATUS_E_NOMEM;
827 }
828
Houston Hoffmanae850c62017-08-11 16:47:50 -0700829 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
Aditya Sathishded018e2018-07-02 16:25:21 +0530830 "[%s][%d] %d rx desc allocated", __func__, __LINE__,
Kai Chen6eca1a62017-01-12 10:17:53 -0800831 num_alloc_desc);
Houston Hoffmanae850c62017-08-11 16:47:50 -0700832
Kai Chen6eca1a62017-01-12 10:17:53 -0800833 num_req_buffers = num_alloc_desc;
834 }
835
836 hal_srng_access_start(dp_soc->hal_soc, rxdma_srng);
837 num_entries_avail = hal_srng_src_num_avail(dp_soc->hal_soc,
838 rxdma_srng, sync_hw_ptr);
839
Houston Hoffmanae850c62017-08-11 16:47:50 -0700840 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
Aditya Sathishded018e2018-07-02 16:25:21 +0530841 "[%s][%d] no of available entries in rxdma ring: %d",
Kai Chen6eca1a62017-01-12 10:17:53 -0800842 __func__, __LINE__, num_entries_avail);
843
844 if (num_entries_avail < num_req_buffers) {
845 num_desc_to_free = num_req_buffers - num_entries_avail;
846 num_req_buffers = num_entries_avail;
847 }
848
jinweic chenc3546322018-02-02 15:03:41 +0800849 while (count < num_req_buffers) {
850 rx_netbuf = dp_rx_nbuf_prepare(dp_soc, dp_pdev);
Kai Chen6eca1a62017-01-12 10:17:53 -0800851
jinweic chenc3546322018-02-02 15:03:41 +0800852 /*
853 * qdf_nbuf alloc or map failed,
854 * keep HP in mon_status_ring unchanged,
855 * wait dp_rx_mon_status_srng_process
856 * to fill in buffer at current HP.
857 */
858 if (qdf_unlikely(rx_netbuf == NULL)) {
859 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
860 "%s: qdf_nbuf allocate or map fail, count %d",
861 __func__, count);
862 break;
863 }
Kai Chen6eca1a62017-01-12 10:17:53 -0800864
865 paddr = qdf_nbuf_get_frag_paddr(rx_netbuf, 0);
866
867 next = (*desc_list)->next;
sumedh baikadyeca2de62018-04-11 14:20:38 -0700868 rxdma_ring_entry = hal_srng_src_get_next(dp_soc->hal_soc,
869 rxdma_srng);
870
871 if (qdf_unlikely(rxdma_ring_entry == NULL)) {
872 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
Aditya Sathishded018e2018-07-02 16:25:21 +0530873 "[%s][%d] rxdma_ring_entry is NULL, count - %d",
sumedh baikadyeca2de62018-04-11 14:20:38 -0700874 __func__, __LINE__, count);
875 qdf_nbuf_unmap_single(dp_soc->osdev, rx_netbuf,
876 QDF_DMA_BIDIRECTIONAL);
877 qdf_nbuf_free(rx_netbuf);
878 break;
879 }
Kai Chen6eca1a62017-01-12 10:17:53 -0800880
881 (*desc_list)->rx_desc.nbuf = rx_netbuf;
Pramod Simha59fcb312017-06-22 17:43:16 -0700882 (*desc_list)->rx_desc.in_use = 1;
jinweic chenc3546322018-02-02 15:03:41 +0800883 count++;
jinweic chenc3546322018-02-02 15:03:41 +0800884
Kai Chen6eca1a62017-01-12 10:17:53 -0800885 hal_rxdma_buff_addr_info_set(rxdma_ring_entry, paddr,
886 (*desc_list)->rx_desc.cookie, owner);
887
Karunakar Dasineni40555682017-03-26 22:44:39 -0700888 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
Jeff Johnson3f217e22017-09-18 10:13:35 -0700889 "[%s][%d] rx_desc=%pK, cookie=%d, nbuf=%pK, \
Aditya Sathishded018e2018-07-02 16:25:21 +0530890 paddr=%pK",
Kai Chen6eca1a62017-01-12 10:17:53 -0800891 __func__, __LINE__, &(*desc_list)->rx_desc,
892 (*desc_list)->rx_desc.cookie, rx_netbuf,
jinweic chenc3546322018-02-02 15:03:41 +0800893 (void *)paddr);
Kai Chen6eca1a62017-01-12 10:17:53 -0800894
895 *desc_list = next;
896 }
897
898 hal_srng_access_end(dp_soc->hal_soc, rxdma_srng);
899
Houston Hoffmanae850c62017-08-11 16:47:50 -0700900 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
Aditya Sathishded018e2018-07-02 16:25:21 +0530901 "successfully replenished %d buffers", num_req_buffers);
Kai Chen6eca1a62017-01-12 10:17:53 -0800902
Houston Hoffmanae850c62017-08-11 16:47:50 -0700903 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
Aditya Sathishded018e2018-07-02 16:25:21 +0530904 "%d rx desc added back to free list", num_desc_to_free);
Kai Chen6eca1a62017-01-12 10:17:53 -0800905
Houston Hoffmanae850c62017-08-11 16:47:50 -0700906 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
Aditya Sathishded018e2018-07-02 16:25:21 +0530907 "[%s][%d] desc_list=%pK, tail=%pK rx_desc=%pK, cookie=%d",
Kai Chen6eca1a62017-01-12 10:17:53 -0800908 __func__, __LINE__, desc_list, tail, &(*desc_list)->rx_desc,
909 (*desc_list)->rx_desc.cookie);
910
911 /*
912 * add any available free desc back to the free list
913 */
914 if (*desc_list) {
915 dp_rx_add_desc_list_to_free_list(dp_soc, desc_list, tail,
916 mac_id, rx_desc_pool);
917 }
918
919 return QDF_STATUS_SUCCESS;
920}
921/**
922 * dp_rx_pdev_mon_status_attach() - attach DP RX monitor status ring
923 * @pdev: core txrx pdev context
Venkata Sharath Chandra Manchala87479582018-08-01 12:45:34 -0700924 * @ring_id: ring number
Kai Chen6eca1a62017-01-12 10:17:53 -0800925 * This function will attach a DP RX monitor status ring into pDEV
926 * and replenish monitor status ring with buffer.
927 *
928 * Return: QDF_STATUS_SUCCESS: success
929 * QDF_STATUS_E_RESOURCES: Error return
930 */
931QDF_STATUS
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800932dp_rx_pdev_mon_status_attach(struct dp_pdev *pdev, int ring_id) {
Kai Chen6eca1a62017-01-12 10:17:53 -0800933 struct dp_soc *soc = pdev->soc;
934 union dp_rx_desc_list_elem_t *desc_list = NULL;
935 union dp_rx_desc_list_elem_t *tail = NULL;
936 struct dp_srng *rxdma_srng;
937 uint32_t rxdma_entries;
938 struct rx_desc_pool *rx_desc_pool;
Ravi Joshia9ebe0a2017-06-17 16:43:02 -0700939 QDF_STATUS status;
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800940 int mac_for_pdev = dp_get_mac_id_for_mac(soc, ring_id);
Kai Chen6eca1a62017-01-12 10:17:53 -0800941
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800942 rxdma_srng = &pdev->rxdma_mon_status_ring[mac_for_pdev];
Kai Chen6eca1a62017-01-12 10:17:53 -0800943
944 rxdma_entries = rxdma_srng->alloc_size/hal_srng_get_entrysize(
945 soc->hal_soc, RXDMA_MONITOR_STATUS);
946
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800947 rx_desc_pool = &soc->rx_desc_status[ring_id];
Kai Chen6eca1a62017-01-12 10:17:53 -0800948
Houston Hoffman41b912c2017-08-30 14:27:51 -0700949 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_INFO_LOW,
Aditya Sathishded018e2018-07-02 16:25:21 +0530950 "%s: Mon RX Status Pool[%d] allocation size=%d",
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800951 __func__, ring_id, rxdma_entries);
Kai Chen6eca1a62017-01-12 10:17:53 -0800952
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800953 status = dp_rx_desc_pool_alloc(soc, ring_id, rxdma_entries+1,
Ravi Joshia9ebe0a2017-06-17 16:43:02 -0700954 rx_desc_pool);
Ravi Joshi73a05512017-07-10 13:53:32 -0700955 if (!QDF_IS_STATUS_SUCCESS(status)) {
Ravi Joshia9ebe0a2017-06-17 16:43:02 -0700956 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
Aditya Sathishded018e2018-07-02 16:25:21 +0530957 "%s: dp_rx_desc_pool_alloc() failed ", __func__);
Ravi Joshia9ebe0a2017-06-17 16:43:02 -0700958 return status;
959 }
Kai Chen6eca1a62017-01-12 10:17:53 -0800960
Houston Hoffman41b912c2017-08-30 14:27:51 -0700961 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_INFO_LOW,
Aditya Sathishded018e2018-07-02 16:25:21 +0530962 "%s: Mon RX Status Buffers Replenish ring_id=%d",
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800963 __func__, ring_id);
Kai Chen6eca1a62017-01-12 10:17:53 -0800964
Manjunathappa Prakashd9ce3502018-02-05 14:09:17 -0800965 status = dp_rx_mon_status_buffers_replenish(soc, ring_id, rxdma_srng,
Ravi Joshia9ebe0a2017-06-17 16:43:02 -0700966 rx_desc_pool, rxdma_entries, &desc_list, &tail,
967 HAL_RX_BUF_RBM_SW3_BM);
Ravi Joshi73a05512017-07-10 13:53:32 -0700968 if (!QDF_IS_STATUS_SUCCESS(status)) {
Ravi Joshia9ebe0a2017-06-17 16:43:02 -0700969 QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
Aditya Sathishded018e2018-07-02 16:25:21 +0530970 "%s: dp_rx_buffers_replenish() failed ", __func__);
Ravi Joshia9ebe0a2017-06-17 16:43:02 -0700971 return status;
972 }
Kai Chen6eca1a62017-01-12 10:17:53 -0800973
974 qdf_nbuf_queue_init(&pdev->rx_status_q);
975
976 pdev->mon_ppdu_status = DP_PPDU_STATUS_START;
Kai Chen783e0382018-01-25 16:29:08 -0800977
Karunakar Dasineni40555682017-03-26 22:44:39 -0700978 qdf_mem_zero(&(pdev->ppdu_info.rx_status),
979 sizeof(pdev->ppdu_info.rx_status));
Kai Chen6eca1a62017-01-12 10:17:53 -0800980
Kai Chen783e0382018-01-25 16:29:08 -0800981 qdf_mem_zero(&pdev->rx_mon_stats,
982 sizeof(pdev->rx_mon_stats));
983
984 dp_rx_mon_init_dbg_ppdu_stats(&pdev->ppdu_info,
985 &pdev->rx_mon_stats);
986
Kai Chen6eca1a62017-01-12 10:17:53 -0800987 return QDF_STATUS_SUCCESS;
988}