dp_rh_rx.c 45 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606
  1. /*
  2. * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved.
  3. *
  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. */
  18. #include "cdp_txrx_cmn_struct.h"
  19. #include "hal_hw_headers.h"
  20. #include "dp_types.h"
  21. #include "dp_rx.h"
  22. #include "dp_tx.h"
  23. #include "dp_rx_defrag.h"
  24. #include "dp_rh_rx.h"
  25. #include "dp_rh_htt.h"
  26. #include "dp_peer.h"
  27. #include "hal_rx.h"
  28. #include "hal_rh_rx.h"
  29. #include "hal_api.h"
  30. #include "hal_rh_api.h"
  31. #include "qdf_nbuf.h"
  32. #include "dp_internal.h"
  33. #ifdef WIFI_MONITOR_SUPPORT
  34. #include <dp_mon.h>
  35. #endif
  36. #ifdef FEATURE_WDS
  37. #include "dp_txrx_wds.h"
  38. #endif
  39. #include "dp_hist.h"
  40. #include "dp_rx_buffer_pool.h"
  41. #include "dp_rh.h"
  42. static inline uint8_t dp_rx_get_ctx_id_frm_napiid(uint8_t napi_id)
  43. {
  44. /*
  45. * This is NAPI to CE then to rx context id mapping
  46. * example: CE1 is assigned with napi id 3(ce_id+1)
  47. * CE1 maps to RX context id 0, so napi id 2 maps to
  48. * RX context id 0, this need to optimized further.
  49. */
  50. switch (napi_id) {
  51. case 2:
  52. return 0;
  53. case 11:
  54. return 1;
  55. case 12:
  56. return 2;
  57. default:
  58. dp_err("Invalid napi id, this should not happen");
  59. qdf_assert_always(0);
  60. break;
  61. }
  62. return 0;
  63. }
  64. void
  65. dp_rx_data_flush(void *data)
  66. {
  67. struct qca_napi_info *napi_info = (struct qca_napi_info *)data;
  68. uint8_t rx_ctx_id = dp_rx_get_ctx_id_frm_napiid(napi_info->id);
  69. struct dp_soc *soc = cds_get_context(QDF_MODULE_ID_SOC);
  70. struct dp_vdev *vdev;
  71. int i;
  72. if (rx_ctx_id == 0 && soc->rx.flags.defrag_timeout_check) {
  73. uint32_t now_ms =
  74. qdf_system_ticks_to_msecs(qdf_system_ticks());
  75. if (now_ms >= soc->rx.defrag.next_flush_ms)
  76. dp_rx_defrag_waitlist_flush(soc);
  77. }
  78. /*Get first available vdev to flush all RX packets across soc*/
  79. for (i = 0; i < MAX_VDEV_CNT; i++) {
  80. vdev = dp_vdev_get_ref_by_id(soc, i, DP_MOD_ID_RX);
  81. if (vdev && vdev->osif_fisa_flush)
  82. vdev->osif_fisa_flush(soc, rx_ctx_id);
  83. if (vdev && vdev->osif_gro_flush) {
  84. vdev->osif_gro_flush(vdev->osif_vdev,
  85. rx_ctx_id);
  86. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_RX);
  87. return;
  88. }
  89. if (vdev)
  90. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_RX);
  91. }
  92. }
  93. static inline
  94. bool is_sa_da_idx_valid(uint32_t max_ast,
  95. qdf_nbuf_t nbuf, struct hal_rx_msdu_metadata msdu_info)
  96. {
  97. if ((qdf_nbuf_is_sa_valid(nbuf) && (msdu_info.sa_idx > max_ast)) ||
  98. (!qdf_nbuf_is_da_mcbc(nbuf) && qdf_nbuf_is_da_valid(nbuf) &&
  99. (msdu_info.da_idx > max_ast)))
  100. return false;
  101. return true;
  102. }
  103. #if defined(FEATURE_MCL_REPEATER) && defined(FEATURE_MEC)
  104. /**
  105. * dp_rx_mec_check_wrapper() - wrapper to dp_rx_mcast_echo_check
  106. * @soc: core DP main context
  107. * @txrx_peer: dp peer handler
  108. * @rx_tlv_hdr: start of the rx TLV header
  109. * @nbuf: pkt buffer
  110. *
  111. * Return: bool (true if it is a looped back pkt else false)
  112. */
  113. static inline bool dp_rx_mec_check_wrapper(struct dp_soc *soc,
  114. struct dp_txrx_peer *txrx_peer,
  115. uint8_t *rx_tlv_hdr,
  116. qdf_nbuf_t nbuf)
  117. {
  118. return dp_rx_mcast_echo_check(soc, txrx_peer, rx_tlv_hdr, nbuf);
  119. }
  120. #else
  121. static inline bool dp_rx_mec_check_wrapper(struct dp_soc *soc,
  122. struct dp_txrx_peer *txrx_peer,
  123. uint8_t *rx_tlv_hdr,
  124. qdf_nbuf_t nbuf)
  125. {
  126. return false;
  127. }
  128. #endif
  129. static bool
  130. dp_rx_intrabss_ucast_check_rh(struct dp_soc *soc, qdf_nbuf_t nbuf,
  131. struct dp_txrx_peer *ta_txrx_peer,
  132. struct hal_rx_msdu_metadata *msdu_metadata,
  133. uint8_t *p_tx_vdev_id)
  134. {
  135. uint16_t da_peer_id;
  136. struct dp_txrx_peer *da_peer;
  137. struct dp_ast_entry *ast_entry;
  138. dp_txrx_ref_handle txrx_ref_handle = NULL;
  139. if (!qdf_nbuf_is_da_valid(nbuf) || qdf_nbuf_is_da_mcbc(nbuf))
  140. return false;
  141. ast_entry = soc->ast_table[msdu_metadata->da_idx];
  142. if (!ast_entry)
  143. return false;
  144. if (ast_entry->type == CDP_TXRX_AST_TYPE_DA) {
  145. ast_entry->is_active = TRUE;
  146. return false;
  147. }
  148. da_peer_id = ast_entry->peer_id;
  149. /* TA peer cannot be same as peer(DA) on which AST is present
  150. * this indicates a change in topology and that AST entries
  151. * are yet to be updated.
  152. */
  153. if (da_peer_id == ta_txrx_peer->peer_id ||
  154. da_peer_id == HTT_INVALID_PEER)
  155. return false;
  156. da_peer = dp_txrx_peer_get_ref_by_id(soc, da_peer_id,
  157. &txrx_ref_handle, DP_MOD_ID_RX);
  158. if (!da_peer)
  159. return false;
  160. *p_tx_vdev_id = da_peer->vdev->vdev_id;
  161. /* If the source or destination peer in the isolation
  162. * list then dont forward instead push to bridge stack.
  163. */
  164. if (dp_get_peer_isolation(ta_txrx_peer) ||
  165. dp_get_peer_isolation(da_peer) ||
  166. da_peer->vdev->vdev_id != ta_txrx_peer->vdev->vdev_id) {
  167. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX);
  168. return false;
  169. }
  170. if (da_peer->bss_peer) {
  171. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX);
  172. return false;
  173. }
  174. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX);
  175. return true;
  176. }
  177. /*
  178. * dp_rx_intrabss_fwd_rh() - Implements the Intra-BSS forwarding logic
  179. *
  180. * @soc: core txrx main context
  181. * @ta_txrx_peer : source peer entry
  182. * @rx_tlv_hdr : start address of rx tlvs
  183. * @nbuf : nbuf that has to be intrabss forwarded
  184. *
  185. * Return: bool: true if it is forwarded else false
  186. */
  187. static bool
  188. dp_rx_intrabss_fwd_rh(struct dp_soc *soc,
  189. struct dp_txrx_peer *ta_txrx_peer,
  190. uint8_t *rx_tlv_hdr,
  191. qdf_nbuf_t nbuf,
  192. struct hal_rx_msdu_metadata msdu_metadata,
  193. struct cdp_tid_rx_stats *tid_stats)
  194. {
  195. uint8_t tx_vdev_id;
  196. /* if it is a broadcast pkt (eg: ARP) and it is not its own
  197. * source, then clone the pkt and send the cloned pkt for
  198. * intra BSS forwarding and original pkt up the network stack
  199. * Note: how do we handle multicast pkts. do we forward
  200. * all multicast pkts as is or let a higher layer module
  201. * like igmpsnoop decide whether to forward or not with
  202. * Mcast enhancement.
  203. */
  204. if (qdf_nbuf_is_da_mcbc(nbuf) && !ta_txrx_peer->bss_peer)
  205. return dp_rx_intrabss_mcbc_fwd(soc, ta_txrx_peer, rx_tlv_hdr,
  206. nbuf, tid_stats, 0);
  207. if (dp_rx_intrabss_eapol_drop_check(soc, ta_txrx_peer, rx_tlv_hdr,
  208. nbuf))
  209. return true;
  210. if (dp_rx_intrabss_ucast_check_rh(soc, nbuf, ta_txrx_peer,
  211. &msdu_metadata, &tx_vdev_id))
  212. return dp_rx_intrabss_ucast_fwd(soc, ta_txrx_peer, tx_vdev_id,
  213. rx_tlv_hdr, nbuf, tid_stats,
  214. 0);
  215. return false;
  216. }
  217. #ifdef RX_DESC_DEBUG_CHECK
  218. static
  219. QDF_STATUS dp_rx_desc_nbuf_sanity_check_rh(struct dp_soc *soc,
  220. uint32_t *msg_word,
  221. struct dp_rx_desc *rx_desc)
  222. {
  223. uint64_t paddr;
  224. paddr = (HTT_RX_DATA_MSDU_INFO_BUFFER_ADDR_LOW_GET(*msg_word) |
  225. ((uint64_t)(HTT_RX_DATA_MSDU_INFO_BUFFER_ADDR_HIGH_GET(*(msg_word + 1))) << 32));
  226. /* Sanity check for possible buffer paddr corruption */
  227. if (dp_rx_desc_paddr_sanity_check(rx_desc, paddr))
  228. return QDF_STATUS_SUCCESS;
  229. return QDF_STATUS_E_FAILURE;
  230. }
  231. #else
  232. static inline
  233. QDF_STATUS dp_rx_desc_nbuf_sanity_check_rh(struct dp_soc *soc,
  234. uint32_t *msg_word,
  235. struct dp_rx_desc *rx_desc)
  236. #endif
  237. #ifdef DUP_RX_DESC_WAR
  238. static
  239. void dp_rx_dump_info_and_assert_rh(struct dp_soc *soc,
  240. uint32_t *msg_word,
  241. struct dp_rx_desc *rx_desc)
  242. {
  243. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_INFO_HIGH,
  244. msg_word, HTT_RX_DATA_MSDU_INFO_SIZE);
  245. dp_rx_desc_dump(rx_desc);
  246. }
  247. #else
  248. static
  249. void dp_rx_dump_info_and_assert_rh(struct dp_soc *soc,
  250. uint32_t *msg_word,
  251. struct dp_rx_desc *rx_desc)
  252. {
  253. dp_rx_desc_dump(rx_desc);
  254. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_INFO_HIGH,
  255. msg_word, HTT_RX_DATA_MSDU_INFO_SIZE);
  256. qdf_assert_always(0);
  257. }
  258. #endif
  259. #ifdef WLAN_FEATURE_DP_RX_RING_HISTORY
  260. static void
  261. dp_rx_ring_record_entry_rh(struct dp_soc *soc, uint8_t ring_num,
  262. uint32_t *msg_word)
  263. {
  264. struct dp_buf_info_record *record;
  265. uint32_t idx;
  266. if (qdf_unlikely(!soc->rx_ring_history[ring_num]))
  267. return;
  268. idx = dp_history_get_next_index(&soc->rx_ring_history[ring_num]->index,
  269. DP_RX_HIST_MAX);
  270. /* No NULL check needed for record since its an array */
  271. record = &soc->rx_ring_history[ring_num]->entry[idx];
  272. record->timestamp = qdf_get_log_timestamp();
  273. record->hbi.paddr =
  274. (HTT_RX_DATA_MSDU_INFO_BUFFER_ADDR_LOW_GET(*msg_word) |
  275. ((uint64_t)(HTT_RX_DATA_MSDU_INFO_BUFFER_ADDR_HIGH_GET(*(msg_word + 1))) << 32));
  276. record->hbi.sw_cookie =
  277. HTT_RX_DATA_MSDU_INFO_SW_BUFFER_COOKIE_GET(*(msg_word + 1));
  278. }
  279. #else
  280. static inline void
  281. dp_rx_ring_record_entry_rh(struct dp_soc *soc, uint8_t rx_ring_num,
  282. uint32_t *msg_word) {}
  283. #endif
  284. #ifdef WLAN_FEATURE_MARK_FIRST_WAKEUP_PACKET
  285. static inline void
  286. dp_rx_mark_first_packet_after_wow_wakeup_rh(struct dp_soc *soc,
  287. uint32_t *msg_word,
  288. qdf_nbuf_t nbuf)
  289. {
  290. struct dp_pdev *pdev = soc->pdev_list[0];
  291. if (!pdev->is_first_wakeup_packet)
  292. return;
  293. if (HTT_RX_DATA_MSDU_INFO_IS_FIRST_PKT_AFTER_WKP_GET(*(msg_word + 2))) {
  294. qdf_nbuf_mark_wakeup_frame(nbuf);
  295. dp_info("First packet after WOW Wakeup rcvd");
  296. }
  297. }
  298. #else
  299. static inline void
  300. dp_rx_mark_first_packet_after_wow_wakeup_rh(struct dp_soc *soc,
  301. uint32_t *msg_word,
  302. qdf_nbuf_t nbuf) {}
  303. #endif
  304. #ifdef QCA_SUPPORT_EAPOL_OVER_CONTROL_PORT
  305. static void
  306. dp_rx_deliver_to_osif_stack_rh(struct dp_soc *soc,
  307. struct dp_vdev *vdev,
  308. struct dp_txrx_peer *txrx_peer,
  309. qdf_nbuf_t nbuf,
  310. qdf_nbuf_t tail,
  311. bool is_eapol)
  312. {
  313. if (is_eapol && soc->eapol_over_control_port)
  314. dp_rx_eapol_deliver_to_stack(soc, vdev, txrx_peer, nbuf, NULL);
  315. else
  316. dp_rx_deliver_to_stack(soc, vdev, txrx_peer, nbuf, NULL);
  317. }
  318. #else
  319. static void
  320. dp_rx_deliver_to_osif_stack_rh(struct dp_soc *soc,
  321. struct dp_vdev *vdev,
  322. struct dp_txrx_peer *txrx_peer,
  323. qdf_nbuf_t nbuf,
  324. qdf_nbuf_t tail,
  325. bool is_eapol)
  326. {
  327. dp_rx_deliver_to_stack(soc, vdev, txrx_peer, nbuf, NULL);
  328. }
  329. #endif
  330. static void
  331. dp_rx_decrypt_unecrypt_err_handler_rh(struct dp_soc *soc, qdf_nbuf_t nbuf,
  332. uint8_t error_code, uint8_t mac_id)
  333. {
  334. uint32_t pkt_len, l2_hdr_offset;
  335. uint16_t msdu_len;
  336. struct dp_vdev *vdev;
  337. struct dp_txrx_peer *txrx_peer = NULL;
  338. dp_txrx_ref_handle txrx_ref_handle = NULL;
  339. qdf_ether_header_t *eh;
  340. bool is_broadcast;
  341. uint8_t *rx_tlv_hdr;
  342. uint16_t peer_id;
  343. rx_tlv_hdr = qdf_nbuf_data(nbuf);
  344. /*
  345. * Check if DMA completed -- msdu_done is the last bit
  346. * to be written
  347. */
  348. if (!hal_rx_attn_msdu_done_get(soc->hal_soc, rx_tlv_hdr)) {
  349. dp_err_rl("MSDU DONE failure");
  350. hal_rx_dump_pkt_tlvs(soc->hal_soc, rx_tlv_hdr,
  351. QDF_TRACE_LEVEL_INFO);
  352. qdf_assert(0);
  353. }
  354. if (qdf_unlikely(qdf_nbuf_is_rx_chfrag_cont(nbuf))) {
  355. dp_err("Unsupported MSDU format rcvd for error:%u", error_code);
  356. qdf_assert_always(0);
  357. goto free_nbuf;
  358. }
  359. peer_id = QDF_NBUF_CB_RX_PEER_ID(nbuf);
  360. txrx_peer = dp_tgt_txrx_peer_get_ref_by_id(soc, peer_id,
  361. &txrx_ref_handle,
  362. DP_MOD_ID_RX);
  363. if (!txrx_peer) {
  364. QDF_TRACE_ERROR_RL(QDF_MODULE_ID_DP, "txrx_peer is NULL");
  365. DP_STATS_INC_PKT(soc, rx.err.rx_invalid_peer, 1,
  366. qdf_nbuf_len(nbuf));
  367. /* Trigger invalid peer handler wrapper */
  368. dp_rx_process_invalid_peer_wrapper(soc, nbuf, true, mac_id);
  369. return;
  370. }
  371. l2_hdr_offset = hal_rx_msdu_end_l3_hdr_padding_get(soc->hal_soc,
  372. rx_tlv_hdr);
  373. msdu_len = hal_rx_msdu_start_msdu_len_get(soc->hal_soc, rx_tlv_hdr);
  374. pkt_len = msdu_len + l2_hdr_offset + soc->rx_pkt_tlv_size;
  375. if (qdf_unlikely(pkt_len > RX_DATA_BUFFER_SIZE)) {
  376. DP_STATS_INC_PKT(soc, rx.err.rx_invalid_pkt_len,
  377. 1, pkt_len);
  378. goto free_nbuf;
  379. }
  380. /* Set length in nbuf */
  381. qdf_nbuf_set_pktlen(nbuf, pkt_len);
  382. qdf_nbuf_set_next(nbuf, NULL);
  383. qdf_nbuf_set_rx_chfrag_start(nbuf, 1);
  384. qdf_nbuf_set_rx_chfrag_end(nbuf, 1);
  385. vdev = txrx_peer->vdev;
  386. if (!vdev) {
  387. dp_rx_info_rl("%pK: INVALID vdev %pK OR osif_rx", soc,
  388. vdev);
  389. DP_STATS_INC(soc, rx.err.invalid_vdev, 1);
  390. goto free_nbuf;
  391. }
  392. /*
  393. * Advance the packet start pointer by total size of
  394. * pre-header TLV's
  395. */
  396. dp_rx_skip_tlvs(soc, nbuf, l2_hdr_offset);
  397. /*
  398. * WAPI cert AP sends rekey frames as unencrypted.
  399. * Thus RXDMA will report unencrypted frame error.
  400. * To pass WAPI cert case, SW needs to pass unencrypted
  401. * rekey frame to stack.
  402. *
  403. * In dynamic WEP case rekey frames are not encrypted
  404. * similar to WAPI. Allow EAPOL when 8021+wep is enabled and
  405. * key install is already done
  406. */
  407. if ((qdf_nbuf_is_ipv4_wapi_pkt(nbuf)) ||
  408. ((vdev->sec_type == cdp_sec_type_wep104) &&
  409. (qdf_nbuf_is_ipv4_eapol_pkt(nbuf)))) {
  410. if (qdf_unlikely(hal_rx_msdu_end_da_is_mcbc_get(soc->hal_soc,
  411. rx_tlv_hdr) &&
  412. (vdev->rx_decap_type ==
  413. htt_cmn_pkt_type_ethernet))) {
  414. eh = (qdf_ether_header_t *)qdf_nbuf_data(nbuf);
  415. is_broadcast = (QDF_IS_ADDR_BROADCAST
  416. (eh->ether_dhost)) ? 1 : 0;
  417. DP_PEER_PER_PKT_STATS_INC_PKT(txrx_peer, rx.multicast,
  418. 1, qdf_nbuf_len(nbuf), 0);
  419. if (is_broadcast) {
  420. DP_PEER_PER_PKT_STATS_INC_PKT(txrx_peer, rx.bcast,
  421. 1, qdf_nbuf_len(nbuf), 0);
  422. }
  423. } else {
  424. DP_PEER_PER_PKT_STATS_INC_PKT(txrx_peer, rx.unicast, 1,
  425. qdf_nbuf_len(nbuf),
  426. 0);
  427. }
  428. if (qdf_unlikely(vdev->rx_decap_type == htt_cmn_pkt_type_raw)) {
  429. dp_rx_deliver_raw(vdev, nbuf, txrx_peer, 0);
  430. } else {
  431. /* Update the protocol tag in SKB based on CCE metadata */
  432. dp_rx_update_protocol_tag(soc, vdev, nbuf, rx_tlv_hdr,
  433. EXCEPTION_DEST_RING_ID, true, true);
  434. /* Update the flow tag in SKB based on FSE metadata */
  435. dp_rx_update_flow_tag(soc, vdev, nbuf, rx_tlv_hdr, true);
  436. DP_PEER_STATS_FLAT_INC(txrx_peer, to_stack.num, 1);
  437. qdf_nbuf_set_exc_frame(nbuf, 1);
  438. dp_rx_deliver_to_osif_stack_rh(soc, vdev, txrx_peer, nbuf, NULL,
  439. qdf_nbuf_is_ipv4_eapol_pkt(nbuf));
  440. }
  441. }
  442. if (txrx_peer)
  443. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX);
  444. return;
  445. free_nbuf:
  446. if (txrx_peer)
  447. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX);
  448. dp_rx_nbuf_free(nbuf);
  449. }
  450. static void
  451. dp_rx_2k_jump_oor_err_handler_rh(struct dp_soc *soc, qdf_nbuf_t nbuf,
  452. uint32_t error_code)
  453. {
  454. uint32_t frame_mask;
  455. struct dp_txrx_peer *txrx_peer = NULL;
  456. dp_txrx_ref_handle txrx_ref_handle = NULL;
  457. uint8_t *rx_tlv_hdr;
  458. uint16_t peer_id;
  459. rx_tlv_hdr = qdf_nbuf_data(nbuf);
  460. if (qdf_unlikely(qdf_nbuf_is_rx_chfrag_cont(nbuf))) {
  461. dp_err("Unsupported MSDU format rcvd for error:%u", error_code);
  462. qdf_assert_always(0);
  463. goto free_nbuf;
  464. }
  465. peer_id = QDF_NBUF_CB_RX_PEER_ID(nbuf);
  466. txrx_peer = dp_tgt_txrx_peer_get_ref_by_id(soc, peer_id,
  467. &txrx_ref_handle,
  468. DP_MOD_ID_RX);
  469. if (!txrx_peer) {
  470. dp_info_rl("peer not found");
  471. goto free_nbuf;
  472. }
  473. if (error_code == HTT_RXDATA_ERR_OOR) {
  474. frame_mask = FRAME_MASK_IPV4_ARP | FRAME_MASK_IPV4_DHCP |
  475. FRAME_MASK_IPV4_EAPOL | FRAME_MASK_IPV6_DHCP;
  476. } else {
  477. frame_mask = FRAME_MASK_IPV4_ARP;
  478. }
  479. if (dp_rx_deliver_special_frame(soc, txrx_peer, nbuf, frame_mask,
  480. rx_tlv_hdr)) {
  481. if (error_code == HTT_RXDATA_ERR_OOR) {
  482. DP_STATS_INC(soc, rx.err.reo_err_oor_to_stack, 1);
  483. } else {
  484. DP_STATS_INC(soc, rx.err.rx_2k_jump_to_stack, 1);
  485. }
  486. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX);
  487. return;
  488. }
  489. free_nbuf:
  490. if (txrx_peer)
  491. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX);
  492. if (error_code == HTT_RXDATA_ERR_OOR) {
  493. DP_STATS_INC(soc, rx.err.reo_err_oor_drop, 1);
  494. } else {
  495. DP_STATS_INC(soc, rx.err.rx_2k_jump_drop, 1);
  496. }
  497. dp_rx_nbuf_free(nbuf);
  498. }
  499. static void dp_rx_mic_err_handler_rh(struct dp_soc *soc, qdf_nbuf_t nbuf)
  500. {
  501. struct dp_vdev *vdev;
  502. struct dp_pdev *pdev;
  503. struct dp_txrx_peer *txrx_peer = NULL;
  504. dp_txrx_ref_handle txrx_ref_handle = NULL;
  505. struct ol_if_ops *tops;
  506. uint16_t rx_seq, fragno;
  507. uint8_t is_raw;
  508. uint16_t peer_id;
  509. unsigned int tid;
  510. QDF_STATUS status;
  511. struct cdp_rx_mic_err_info mic_failure_info;
  512. /*
  513. * only first msdu, mpdu start description tlv valid?
  514. * and use it for following msdu.
  515. */
  516. if (!hal_rx_msdu_end_first_msdu_get(soc->hal_soc,
  517. qdf_nbuf_data(nbuf)))
  518. return;
  519. peer_id = QDF_NBUF_CB_RX_PEER_ID(nbuf);
  520. txrx_peer = dp_tgt_txrx_peer_get_ref_by_id(soc, peer_id,
  521. &txrx_ref_handle,
  522. DP_MOD_ID_RX);
  523. if (!txrx_peer) {
  524. dp_info_rl("txrx_peer not found");
  525. goto fail;
  526. }
  527. vdev = txrx_peer->vdev;
  528. if (!vdev) {
  529. dp_info_rl("VDEV not found");
  530. goto fail;
  531. }
  532. pdev = vdev->pdev;
  533. if (!pdev) {
  534. dp_info_rl("PDEV not found");
  535. goto fail;
  536. }
  537. /*TODO is raw support required for evros check*/
  538. is_raw = HAL_IS_DECAP_FORMAT_RAW(soc->hal_soc, qdf_nbuf_data(nbuf));
  539. if (is_raw) {
  540. fragno = dp_rx_frag_get_mpdu_frag_number(soc,
  541. qdf_nbuf_data(nbuf));
  542. /* Can get only last fragment */
  543. if (fragno) {
  544. tid = hal_rx_mpdu_start_tid_get(soc->hal_soc,
  545. qdf_nbuf_data(nbuf));
  546. rx_seq = hal_rx_get_rx_sequence(soc->hal_soc,
  547. qdf_nbuf_data(nbuf));
  548. status = dp_rx_defrag_add_last_frag(soc, txrx_peer,
  549. tid, rx_seq, nbuf);
  550. dp_info_rl("Frag pkt seq# %d frag# %d consumed " "status %d !",
  551. rx_seq, fragno, status);
  552. if (txrx_peer)
  553. dp_txrx_peer_unref_delete(txrx_ref_handle,
  554. DP_MOD_ID_RX);
  555. return;
  556. }
  557. }
  558. if (qdf_unlikely(qdf_nbuf_is_rx_chfrag_cont(nbuf))) {
  559. dp_err("Unsupported MSDU format rcvd in MIC error handler");
  560. qdf_assert_always(0);
  561. goto fail;
  562. }
  563. if (hal_rx_mpdu_get_addr1(soc->hal_soc, qdf_nbuf_data(nbuf),
  564. &mic_failure_info.da_mac_addr.bytes[0])) {
  565. dp_err_rl("Failed to get da_mac_addr");
  566. goto fail;
  567. }
  568. if (hal_rx_mpdu_get_addr2(soc->hal_soc, qdf_nbuf_data(nbuf),
  569. &mic_failure_info.ta_mac_addr.bytes[0])) {
  570. dp_err_rl("Failed to get ta_mac_addr");
  571. goto fail;
  572. }
  573. mic_failure_info.key_id = 0;
  574. mic_failure_info.multicast =
  575. IEEE80211_IS_MULTICAST(mic_failure_info.da_mac_addr.bytes);
  576. qdf_mem_zero(mic_failure_info.tsc, MIC_SEQ_CTR_SIZE);
  577. mic_failure_info.frame_type = cdp_rx_frame_type_802_11;
  578. mic_failure_info.data = NULL;
  579. mic_failure_info.vdev_id = vdev->vdev_id;
  580. tops = pdev->soc->cdp_soc.ol_ops;
  581. if (tops->rx_mic_error)
  582. tops->rx_mic_error(soc->ctrl_psoc, pdev->pdev_id,
  583. &mic_failure_info);
  584. fail:
  585. dp_rx_nbuf_free(nbuf);
  586. if (txrx_peer)
  587. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX);
  588. }
  589. static QDF_STATUS dp_rx_err_handler_rh(struct dp_soc *soc,
  590. struct dp_rx_desc *rx_desc,
  591. uint32_t error_code)
  592. {
  593. switch (error_code) {
  594. case HTT_RXDATA_ERR_MSDU_LIMIT:
  595. case HTT_RXDATA_ERR_FLUSH_REQUEST:
  596. case HTT_RXDATA_ERR_ZERO_LEN_MSDU:
  597. dp_rx_nbuf_free(rx_desc->nbuf);
  598. dp_err_rl("MSDU rcvd with error code: %u", error_code);
  599. break;
  600. case HTT_RXDATA_ERR_TKIP_MIC:
  601. dp_rx_mic_err_handler_rh(soc, rx_desc->nbuf);
  602. break;
  603. case HTT_RXDATA_ERR_OOR:
  604. case HTT_RXDATA_ERR_2K_JUMP:
  605. dp_rx_2k_jump_oor_err_handler_rh(soc, rx_desc->nbuf,
  606. error_code);
  607. break;
  608. case HTT_RXDATA_ERR_DECRYPT:
  609. case HTT_RXDATA_ERR_UNENCRYPTED:
  610. dp_rx_decrypt_unecrypt_err_handler_rh(soc, rx_desc->nbuf,
  611. error_code,
  612. rx_desc->pool_id);
  613. default:
  614. dp_err("Invalid error packet rcvd");
  615. dp_rx_desc_dump(rx_desc);
  616. qdf_assert_always(0);
  617. dp_rx_nbuf_free(rx_desc->nbuf);
  618. return QDF_STATUS_E_INVAL;
  619. }
  620. return QDF_STATUS_SUCCESS;
  621. }
  622. void
  623. dp_rx_data_indication_handler(struct dp_soc *soc, qdf_nbuf_t data_ind,
  624. uint16_t vdev_id, uint16_t peer_id,
  625. uint16_t msdu_count)
  626. {
  627. uint8_t *data_ind_msg;
  628. uint32_t *msg_word;
  629. uint32_t rx_ctx_id;
  630. hal_soc_handle_t hal_soc;
  631. struct dp_rx_desc *rx_desc = NULL;
  632. qdf_nbuf_t nbuf, next;
  633. union dp_rx_desc_list_elem_t *head[MAX_PDEV_CNT];
  634. union dp_rx_desc_list_elem_t *tail[MAX_PDEV_CNT];
  635. uint32_t num_pending = msdu_count;
  636. uint32_t rx_buf_cookie;
  637. uint16_t msdu_len = 0;
  638. struct dp_txrx_peer *txrx_peer;
  639. dp_txrx_ref_handle txrx_ref_handle = NULL;
  640. struct dp_vdev *vdev;
  641. uint32_t pkt_len = 0;
  642. uint8_t *rx_tlv_hdr;
  643. uint32_t rx_bufs_reaped[MAX_PDEV_CNT];
  644. uint8_t mac_id = 0;
  645. struct dp_pdev *rx_pdev;
  646. struct dp_srng *dp_rxdma_srng;
  647. struct rx_desc_pool *rx_desc_pool;
  648. struct cdp_tid_rx_stats *tid_stats;
  649. qdf_nbuf_t nbuf_head;
  650. qdf_nbuf_t nbuf_tail;
  651. qdf_nbuf_t deliver_list_head;
  652. qdf_nbuf_t deliver_list_tail;
  653. uint32_t num_rx_bufs_reaped = 0;
  654. struct hif_opaque_softc *scn;
  655. int32_t tid = 0;
  656. bool is_prev_msdu_last = true;
  657. uint32_t rx_ol_pkt_cnt = 0;
  658. struct hal_rx_msdu_metadata msdu_metadata;
  659. qdf_nbuf_t ebuf_head;
  660. qdf_nbuf_t ebuf_tail;
  661. uint8_t pkt_capture_offload = 0;
  662. uint32_t old_tid;
  663. uint32_t peer_ext_stats;
  664. uint32_t dsf;
  665. uint32_t max_ast;
  666. uint64_t current_time = 0;
  667. uint32_t error;
  668. uint32_t error_code;
  669. QDF_STATUS status;
  670. DP_HIST_INIT();
  671. qdf_assert_always(soc && msdu_count);
  672. hal_soc = soc->hal_soc;
  673. qdf_assert_always(hal_soc);
  674. scn = soc->hif_handle;
  675. dp_runtime_pm_mark_last_busy(soc);
  676. /* reset local variables here to be re-used in the function */
  677. nbuf_head = NULL;
  678. nbuf_tail = NULL;
  679. deliver_list_head = NULL;
  680. deliver_list_tail = NULL;
  681. txrx_peer = NULL;
  682. vdev = NULL;
  683. num_rx_bufs_reaped = 0;
  684. ebuf_head = NULL;
  685. ebuf_tail = NULL;
  686. qdf_mem_zero(rx_bufs_reaped, sizeof(rx_bufs_reaped));
  687. qdf_mem_zero(head, sizeof(head));
  688. qdf_mem_zero(tail, sizeof(tail));
  689. old_tid = 0xff;
  690. dsf = 0;
  691. peer_ext_stats = 0;
  692. max_ast = 0;
  693. rx_pdev = NULL;
  694. tid_stats = NULL;
  695. dp_pkt_get_timestamp(&current_time);
  696. peer_ext_stats = wlan_cfg_is_peer_ext_stats_enabled(soc->wlan_cfg_ctx);
  697. max_ast = wlan_cfg_get_max_ast_idx(soc->wlan_cfg_ctx);
  698. data_ind_msg = qdf_nbuf_data(data_ind);
  699. msg_word =
  700. (uint32_t *)(data_ind_msg + HTT_RX_DATA_IND_HDR_SIZE);
  701. rx_ctx_id =
  702. dp_rx_get_ctx_id_frm_napiid(QDF_NBUF_CB_RX_CTX_ID(data_ind));
  703. while (qdf_likely(num_pending)) {
  704. dp_rx_ring_record_entry_rh(soc, rx_ctx_id, msg_word);
  705. rx_buf_cookie =
  706. HTT_RX_DATA_MSDU_INFO_SW_BUFFER_COOKIE_GET(*(msg_word + 1));
  707. rx_desc = dp_rx_cookie_2_va_rxdma_buf(soc, rx_buf_cookie);
  708. if (qdf_unlikely(!rx_desc && !rx_desc->nbuf &&
  709. !rx_desc->in_use)) {
  710. dp_err("Invalid RX descriptor");
  711. qdf_assert_always(0);
  712. /* TODO handle this if its valid case */
  713. }
  714. status = dp_rx_desc_nbuf_sanity_check_rh(soc, msg_word,
  715. rx_desc);
  716. if (qdf_unlikely(QDF_IS_STATUS_ERROR(status))) {
  717. DP_STATS_INC(soc, rx.err.nbuf_sanity_fail, 1);
  718. dp_info_rl("Nbuf sanity check failure!");
  719. dp_rx_dump_info_and_assert_rh(soc, msg_word, rx_desc);
  720. rx_desc->in_err_state = 1;
  721. continue;
  722. }
  723. if (qdf_unlikely(!dp_rx_desc_check_magic(rx_desc))) {
  724. dp_err("Invalid rx_desc cookie=%d", rx_buf_cookie);
  725. DP_STATS_INC(soc, rx.err.rx_desc_invalid_magic, 1);
  726. dp_rx_dump_info_and_assert_rh(soc, msg_word, rx_desc);
  727. continue;
  728. }
  729. msdu_len =
  730. HTT_RX_DATA_MSDU_INFO_MSDU_LENGTH_GET(*(msg_word + 2));
  731. if (qdf_unlikely(
  732. HTT_RX_DATA_MSDU_INFO_MSDU_CONTINUATION_GET(*(msg_word + 2)))) {
  733. /* previous msdu has end bit set, so current one is
  734. * the new MPDU
  735. */
  736. if (is_prev_msdu_last) {
  737. /* For new MPDU check if we can read complete
  738. * MPDU by comparing the number of buffers
  739. * available and number of buffers needed to
  740. * reap this MPDU
  741. */
  742. if ((msdu_len /
  743. (RX_DATA_BUFFER_SIZE -
  744. soc->rx_pkt_tlv_size) + 1) >
  745. num_pending) {
  746. DP_STATS_INC(soc,
  747. rx.msdu_scatter_wait_break,
  748. 1);
  749. /* This is not expected host cannot deal
  750. * with partial frame in single DATA
  751. * indication, F.W has to submit full
  752. * frame in single DATA indication
  753. */
  754. qdf_assert_always(0);
  755. }
  756. is_prev_msdu_last = false;
  757. }
  758. }
  759. if (HTT_RX_DATA_MSDU_INFO_MPDU_RETRY_BIT_GET(*(msg_word + 2)))
  760. qdf_nbuf_set_rx_retry_flag(rx_desc->nbuf, 1);
  761. if (HTT_RX_DATA_MSDU_INFO_RAW_MPDU_FRAME_GET(*(msg_word + 2)))
  762. qdf_nbuf_set_raw_frame(rx_desc->nbuf, 1);
  763. /*
  764. * end MSDU has continuation bit set to zero using this to detect
  765. * full MSDU
  766. */
  767. if (!is_prev_msdu_last &&
  768. !HTT_RX_DATA_MSDU_INFO_MSDU_CONTINUATION_GET(*(msg_word + 2)))
  769. is_prev_msdu_last = true;
  770. rx_bufs_reaped[rx_desc->pool_id]++;
  771. QDF_NBUF_CB_RX_PEER_ID(rx_desc->nbuf) = peer_id;
  772. QDF_NBUF_CB_RX_VDEV_ID(rx_desc->nbuf) = vdev_id;
  773. dp_rx_mark_first_packet_after_wow_wakeup_rh(soc, msg_word,
  774. rx_desc->nbuf);
  775. /*
  776. * save msdu flags first, last and continuation msdu in
  777. * nbuf->cb, also save mcbc, is_da_valid, is_sa_valid and
  778. * length to nbuf->cb. This ensures the info required for
  779. * per pkt processing is always in the same cache line.
  780. * This helps in improving throughput for smaller pkt
  781. * sizes.
  782. */
  783. if (HTT_RX_DATA_MSDU_INFO_FIRST_MSDU_IN_MPDU_GET(*(msg_word + 2)))
  784. qdf_nbuf_set_rx_chfrag_start(rx_desc->nbuf, 1);
  785. if (HTT_RX_DATA_MSDU_INFO_MSDU_CONTINUATION_GET(*(msg_word + 2)))
  786. qdf_nbuf_set_rx_chfrag_cont(rx_desc->nbuf, 1);
  787. if (HTT_RX_DATA_MSDU_INFO_LAST_MSDU_IN_MPDU_GET(*(msg_word + 2)))
  788. qdf_nbuf_set_rx_chfrag_end(rx_desc->nbuf, 1);
  789. if (HTT_RX_DATA_MSDU_INFO_DA_IS_MCBC_GET(*(msg_word + 2)))
  790. qdf_nbuf_set_da_mcbc(rx_desc->nbuf, 1);
  791. if (HTT_RX_DATA_MSDU_INFO_DA_IS_VALID_GET(*(msg_word + 2)))
  792. qdf_nbuf_set_da_valid(rx_desc->nbuf, 1);
  793. if (HTT_RX_DATA_MSDU_INFO_SA_IS_VALID_GET(*(msg_word + 2)))
  794. qdf_nbuf_set_sa_valid(rx_desc->nbuf, 1);
  795. qdf_nbuf_set_tid_val(rx_desc->nbuf,
  796. HTT_RX_DATA_MSDU_INFO_TID_INFO_GET(*(msg_word + 2)));
  797. /*
  798. * TODO add REO destination indication value in HTT
  799. * set reo dest indication
  800. * qdf_nbuf_set_rx_reo_dest_ind_or_sw_excpt(
  801. * rx_desc->nbuf,
  802. * HAL_RX_REO_MSDU_REO_DST_IND_GET(ring_desc));
  803. */
  804. QDF_NBUF_CB_RX_PKT_LEN(rx_desc->nbuf) = msdu_len;
  805. QDF_NBUF_CB_RX_CTX_ID(rx_desc->nbuf) = rx_ctx_id;
  806. /*
  807. * TODO move unmap after scattered msdu waiting break logic
  808. * in case double skb unmap happened.
  809. */
  810. dp_rx_nbuf_unmap(soc, rx_desc, rx_ctx_id);
  811. rx_desc->unmapped = 1;
  812. error = HTT_RX_DATA_MSDU_INFO_ERROR_VALID_GET(*(msg_word + 3));
  813. if (qdf_unlikely(error)) {
  814. dp_rx_err("MSDU RX error encountered error:%u", error);
  815. error_code =
  816. HTT_RX_DATA_MSDU_INFO_ERROR_INFO_GET(*(msg_word + 3));
  817. dp_rx_err_handler_rh(soc, rx_desc, error_code);
  818. } else {
  819. DP_RX_PROCESS_NBUF(soc, nbuf_head, nbuf_tail, ebuf_head,
  820. ebuf_tail, rx_desc);
  821. }
  822. num_pending -= 1;
  823. dp_rx_add_to_free_desc_list(&head[rx_desc->pool_id],
  824. &tail[rx_desc->pool_id], rx_desc);
  825. num_rx_bufs_reaped++;
  826. msg_word += HTT_RX_DATA_MSDU_INFO_SIZE >> 2;
  827. }
  828. dp_rx_per_core_stats_update(soc, rx_ctx_id, num_rx_bufs_reaped);
  829. for (mac_id = 0; mac_id < MAX_PDEV_CNT; mac_id++) {
  830. /*
  831. * continue with next mac_id if no pkts were reaped
  832. * from that pool
  833. */
  834. if (!rx_bufs_reaped[mac_id])
  835. continue;
  836. dp_rxdma_srng = &soc->rx_refill_buf_ring[mac_id];
  837. rx_desc_pool = &soc->rx_desc_buf[mac_id];
  838. dp_rx_buffers_replenish_simple(soc, mac_id, dp_rxdma_srng,
  839. rx_desc_pool,
  840. rx_bufs_reaped[mac_id],
  841. &head[mac_id], &tail[mac_id]);
  842. }
  843. dp_verbose_debug("replenished %u\n", rx_bufs_reaped[0]);
  844. /* Peer can be NULL is case of LFR */
  845. if (qdf_likely(txrx_peer))
  846. vdev = NULL;
  847. /*
  848. * BIG loop where each nbuf is dequeued from global queue,
  849. * processed and queued back on a per vdev basis. These nbufs
  850. * are sent to stack as and when we run out of nbufs
  851. * or a new nbuf dequeued from global queue has a different
  852. * vdev when compared to previous nbuf.
  853. */
  854. nbuf = nbuf_head;
  855. while (nbuf) {
  856. next = nbuf->next;
  857. if (qdf_unlikely(dp_rx_is_raw_frame_dropped(nbuf))) {
  858. nbuf = next;
  859. DP_STATS_INC(soc, rx.err.raw_frm_drop, 1);
  860. continue;
  861. }
  862. rx_tlv_hdr = qdf_nbuf_data(nbuf);
  863. vdev_id = QDF_NBUF_CB_RX_VDEV_ID(nbuf);
  864. peer_id = QDF_NBUF_CB_RX_PEER_ID(nbuf);
  865. /* Get TID from struct cb->tid_val, save to tid */
  866. if (qdf_nbuf_is_rx_chfrag_start(nbuf)) {
  867. tid = qdf_nbuf_get_tid_val(nbuf);
  868. if (tid >= CDP_MAX_DATA_TIDS) {
  869. DP_STATS_INC(soc, rx.err.rx_invalid_tid_err, 1);
  870. dp_rx_nbuf_free(nbuf);
  871. nbuf = next;
  872. continue;
  873. }
  874. }
  875. if (qdf_unlikely(!txrx_peer)) {
  876. txrx_peer =
  877. dp_rx_get_txrx_peer_and_vdev(soc, nbuf, peer_id,
  878. &txrx_ref_handle,
  879. pkt_capture_offload,
  880. &vdev,
  881. &rx_pdev, &dsf,
  882. &old_tid);
  883. if (qdf_unlikely(!txrx_peer) || qdf_unlikely(!vdev)) {
  884. nbuf = next;
  885. continue;
  886. }
  887. } else if (txrx_peer && txrx_peer->peer_id != peer_id) {
  888. dp_txrx_peer_unref_delete(txrx_ref_handle,
  889. DP_MOD_ID_RX);
  890. txrx_peer =
  891. dp_rx_get_txrx_peer_and_vdev(soc, nbuf, peer_id,
  892. &txrx_ref_handle,
  893. pkt_capture_offload,
  894. &vdev,
  895. &rx_pdev, &dsf,
  896. &old_tid);
  897. if (qdf_unlikely(!txrx_peer) || qdf_unlikely(!vdev)) {
  898. nbuf = next;
  899. continue;
  900. }
  901. }
  902. if (txrx_peer) {
  903. QDF_NBUF_CB_DP_TRACE_PRINT(nbuf) = false;
  904. qdf_dp_trace_set_track(nbuf, QDF_RX);
  905. QDF_NBUF_CB_RX_DP_TRACE(nbuf) = 1;
  906. QDF_NBUF_CB_RX_PACKET_TRACK(nbuf) =
  907. QDF_NBUF_RX_PKT_DATA_TRACK;
  908. }
  909. /* when hlos tid override is enabled, save tid in
  910. * skb->priority
  911. */
  912. if (qdf_unlikely(vdev->skip_sw_tid_classification &
  913. DP_TXRX_HLOS_TID_OVERRIDE_ENABLED))
  914. qdf_nbuf_set_priority(nbuf, tid);
  915. DP_RX_TID_SAVE(nbuf, tid);
  916. if (qdf_unlikely(dsf) || qdf_unlikely(peer_ext_stats) ||
  917. dp_rx_pkt_tracepoints_enabled())
  918. qdf_nbuf_set_timestamp(nbuf);
  919. if (qdf_likely(old_tid != tid)) {
  920. tid_stats =
  921. &rx_pdev->stats.tid_stats.tid_rx_stats[rx_ctx_id][tid];
  922. old_tid = tid;
  923. }
  924. /*
  925. * Check if DMA completed -- msdu_done is the last bit
  926. * to be written
  927. */
  928. if (qdf_likely(!qdf_nbuf_is_rx_chfrag_cont(nbuf))) {
  929. if (qdf_unlikely(!hal_rx_attn_msdu_done_get_rh(
  930. rx_tlv_hdr))) {
  931. dp_err_rl("MSDU DONE failure");
  932. DP_STATS_INC(soc, rx.err.msdu_done_fail, 1);
  933. hal_rx_dump_pkt_tlvs(hal_soc, rx_tlv_hdr,
  934. QDF_TRACE_LEVEL_INFO);
  935. tid_stats->fail_cnt[MSDU_DONE_FAILURE]++;
  936. qdf_assert(0);
  937. dp_rx_nbuf_free(nbuf);
  938. nbuf = next;
  939. continue;
  940. } else if (qdf_unlikely(hal_rx_attn_msdu_len_err_get_rh(
  941. rx_tlv_hdr))) {
  942. DP_STATS_INC(soc, rx.err.msdu_len_err, 1);
  943. dp_rx_nbuf_free(nbuf);
  944. nbuf = next;
  945. continue;
  946. }
  947. }
  948. DP_HIST_PACKET_COUNT_INC(vdev->pdev->pdev_id);
  949. /*
  950. * First IF condition:
  951. * This condition is valid when 802.11 fragemented
  952. * pkts reinjected back, even though this case is
  953. * not valid for Rhine keeping it for sanity, verify
  954. * and remove this first if condition based on test.
  955. * Second IF condition:
  956. * The below condition happens when an MSDU is spread
  957. * across multiple buffers. This can happen in two cases
  958. * 1. The nbuf size is smaller then the received msdu.
  959. * ex: we have set the nbuf size to 2048 during
  960. * nbuf_alloc. but we received an msdu which is
  961. * 2304 bytes in size then this msdu is spread
  962. * across 2 nbufs.
  963. *
  964. * 2. AMSDUs when RAW mode is enabled.
  965. * ex: 1st MSDU is in 1st nbuf and 2nd MSDU is spread
  966. * across 1st nbuf and 2nd nbuf and last MSDU is
  967. * spread across 2nd nbuf and 3rd nbuf.
  968. *
  969. * for these scenarios let us create a skb frag_list and
  970. * append these buffers till the last MSDU of the AMSDU
  971. * Third condition:
  972. * This is the most likely case, we receive 802.3 pkts
  973. * decapsulated by HW, here we need to set the pkt length.
  974. */
  975. hal_rx_msdu_metadata_get(hal_soc, rx_tlv_hdr, &msdu_metadata);
  976. if (qdf_unlikely(qdf_nbuf_is_frag(nbuf))) {
  977. bool is_mcbc, is_sa_vld, is_da_vld;
  978. is_mcbc = hal_rx_msdu_end_da_is_mcbc_get(soc->hal_soc,
  979. rx_tlv_hdr);
  980. is_sa_vld =
  981. hal_rx_msdu_end_sa_is_valid_get(soc->hal_soc,
  982. rx_tlv_hdr);
  983. is_da_vld =
  984. hal_rx_msdu_end_da_is_valid_get(soc->hal_soc,
  985. rx_tlv_hdr);
  986. qdf_nbuf_set_da_mcbc(nbuf, is_mcbc);
  987. qdf_nbuf_set_da_valid(nbuf, is_da_vld);
  988. qdf_nbuf_set_sa_valid(nbuf, is_sa_vld);
  989. qdf_nbuf_pull_head(nbuf, soc->rx_pkt_tlv_size);
  990. } else if (qdf_nbuf_is_rx_chfrag_cont(nbuf)) {
  991. msdu_len = QDF_NBUF_CB_RX_PKT_LEN(nbuf);
  992. nbuf = dp_rx_sg_create(soc, nbuf);
  993. next = nbuf->next;
  994. if (qdf_nbuf_is_raw_frame(nbuf)) {
  995. DP_STATS_INC(vdev->pdev, rx_raw_pkts, 1);
  996. DP_PEER_PER_PKT_STATS_INC_PKT(txrx_peer,
  997. rx.raw, 1,
  998. msdu_len,
  999. 0);
  1000. } else {
  1001. dp_rx_nbuf_free(nbuf);
  1002. DP_STATS_INC(soc, rx.err.scatter_msdu, 1);
  1003. dp_info_rl("scatter msdu len %d, dropped",
  1004. msdu_len);
  1005. nbuf = next;
  1006. continue;
  1007. }
  1008. } else {
  1009. msdu_len = QDF_NBUF_CB_RX_PKT_LEN(nbuf);
  1010. pkt_len = msdu_len +
  1011. msdu_metadata.l3_hdr_pad +
  1012. soc->rx_pkt_tlv_size;
  1013. qdf_nbuf_set_pktlen(nbuf, pkt_len);
  1014. dp_rx_skip_tlvs(soc, nbuf, msdu_metadata.l3_hdr_pad);
  1015. }
  1016. dp_rx_send_pktlog(soc, rx_pdev, nbuf, QDF_TX_RX_STATUS_OK);
  1017. if (!dp_wds_rx_policy_check(rx_tlv_hdr, vdev, txrx_peer)) {
  1018. dp_rx_err("%pK: Policy Check Drop pkt", soc);
  1019. DP_PEER_PER_PKT_STATS_INC(txrx_peer,
  1020. rx.policy_check_drop, 1, 0);
  1021. tid_stats->fail_cnt[POLICY_CHECK_DROP]++;
  1022. /* Drop & free packet */
  1023. dp_rx_nbuf_free(nbuf);
  1024. /* Statistics */
  1025. nbuf = next;
  1026. continue;
  1027. }
  1028. /*
  1029. * Drop non-EAPOL frames from unauthorized peer.
  1030. */
  1031. if (qdf_likely(txrx_peer) &&
  1032. qdf_unlikely(!txrx_peer->authorize) &&
  1033. !qdf_nbuf_is_raw_frame(nbuf)) {
  1034. bool is_eapol = qdf_nbuf_is_ipv4_eapol_pkt(nbuf) ||
  1035. qdf_nbuf_is_ipv4_wapi_pkt(nbuf);
  1036. if (!is_eapol) {
  1037. DP_PEER_PER_PKT_STATS_INC(txrx_peer,
  1038. rx.peer_unauth_rx_pkt_drop,
  1039. 1, 0);
  1040. dp_rx_nbuf_free(nbuf);
  1041. nbuf = next;
  1042. continue;
  1043. }
  1044. }
  1045. if (soc->process_rx_status)
  1046. dp_rx_cksum_offload(vdev->pdev, nbuf, rx_tlv_hdr);
  1047. dp_rx_msdu_stats_update(soc, nbuf, rx_tlv_hdr, txrx_peer,
  1048. rx_ctx_id, tid_stats, 0);
  1049. if (qdf_likely(vdev->rx_decap_type ==
  1050. htt_cmn_pkt_type_ethernet)) {
  1051. /* Due to HW issue, sometimes we see that the sa_idx
  1052. * and da_idx are invalid with sa_valid and da_valid
  1053. * bits set
  1054. *
  1055. * in this case we also see that value of
  1056. * sa_sw_peer_id is set as 0
  1057. *
  1058. * Drop the packet if sa_idx and da_idx OOB or
  1059. * sa_sw_peerid is 0
  1060. */
  1061. if (!is_sa_da_idx_valid(max_ast, nbuf,
  1062. msdu_metadata)) {
  1063. dp_rx_nbuf_free(nbuf);
  1064. nbuf = next;
  1065. DP_STATS_INC(soc, rx.err.invalid_sa_da_idx, 1);
  1066. continue;
  1067. }
  1068. if (qdf_unlikely(dp_rx_mec_check_wrapper(soc,
  1069. txrx_peer,
  1070. rx_tlv_hdr,
  1071. nbuf))) {
  1072. /* this is a looped back MCBC pkt,drop it */
  1073. DP_PEER_PER_PKT_STATS_INC_PKT(txrx_peer,
  1074. rx.mec_drop, 1,
  1075. QDF_NBUF_CB_RX_PKT_LEN(nbuf),
  1076. 0);
  1077. dp_rx_nbuf_free(nbuf);
  1078. nbuf = next;
  1079. continue;
  1080. }
  1081. /* WDS Source Port Learning */
  1082. if (qdf_likely(vdev->wds_enabled))
  1083. dp_rx_wds_srcport_learn(soc,
  1084. rx_tlv_hdr,
  1085. txrx_peer,
  1086. nbuf,
  1087. msdu_metadata);
  1088. /* Intrabss-fwd */
  1089. if (dp_rx_check_ap_bridge(vdev))
  1090. if (dp_rx_intrabss_fwd_rh(soc, txrx_peer,
  1091. rx_tlv_hdr,
  1092. nbuf,
  1093. msdu_metadata,
  1094. tid_stats)) {
  1095. nbuf = next;
  1096. tid_stats->intrabss_cnt++;
  1097. continue; /* Get next desc */
  1098. }
  1099. }
  1100. dp_rx_fill_gro_info(soc, rx_tlv_hdr, nbuf, &rx_ol_pkt_cnt);
  1101. dp_rx_update_stats(soc, nbuf);
  1102. dp_pkt_add_timestamp(txrx_peer->vdev, QDF_PKT_RX_DRIVER_ENTRY,
  1103. current_time, nbuf);
  1104. DP_RX_LIST_APPEND(deliver_list_head,
  1105. deliver_list_tail,
  1106. nbuf);
  1107. DP_PEER_STATS_FLAT_INC_PKT(txrx_peer, to_stack, 1,
  1108. QDF_NBUF_CB_RX_PKT_LEN(nbuf));
  1109. if (qdf_unlikely(txrx_peer->in_twt))
  1110. DP_PEER_PER_PKT_STATS_INC_PKT(txrx_peer,
  1111. rx.to_stack_twt, 1,
  1112. QDF_NBUF_CB_RX_PKT_LEN(nbuf),
  1113. 0);
  1114. tid_stats->delivered_to_stack++;
  1115. nbuf = next;
  1116. }
  1117. DP_RX_DELIVER_TO_STACK(soc, vdev, txrx_peer, peer_id,
  1118. pkt_capture_offload,
  1119. deliver_list_head,
  1120. deliver_list_tail);
  1121. if (qdf_likely(txrx_peer))
  1122. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX);
  1123. if (vdev && vdev->osif_fisa_flush)
  1124. vdev->osif_fisa_flush(soc, rx_ctx_id);
  1125. if (vdev && vdev->osif_gro_flush && rx_ol_pkt_cnt) {
  1126. vdev->osif_gro_flush(vdev->osif_vdev,
  1127. rx_ctx_id);
  1128. }
  1129. /* Update histogram statistics by looping through pdev's */
  1130. DP_RX_HIST_STATS_PER_PDEV();
  1131. }
  1132. /*
  1133. * dp_rx_defrag_deliver_rh(): Deliver defrag packet to stack
  1134. * @peer: Pointer to the peer
  1135. * @tid: Transmit Identifier
  1136. * @head: Nbuf to be delivered
  1137. *
  1138. * Returns: None
  1139. */
  1140. static inline void dp_rx_defrag_deliver_rh(struct dp_txrx_peer *txrx_peer,
  1141. unsigned int tid,
  1142. qdf_nbuf_t head)
  1143. {
  1144. struct dp_vdev *vdev = txrx_peer->vdev;
  1145. struct dp_soc *soc = vdev->pdev->soc;
  1146. qdf_nbuf_t deliver_list_head = NULL;
  1147. qdf_nbuf_t deliver_list_tail = NULL;
  1148. uint8_t *rx_tlv_hdr;
  1149. rx_tlv_hdr = qdf_nbuf_data(head);
  1150. QDF_NBUF_CB_RX_VDEV_ID(head) = vdev->vdev_id;
  1151. qdf_nbuf_set_tid_val(head, tid);
  1152. qdf_nbuf_pull_head(head, soc->rx_pkt_tlv_size);
  1153. DP_RX_LIST_APPEND(deliver_list_head, deliver_list_tail,
  1154. head);
  1155. dp_rx_deliver_to_stack(soc, vdev, txrx_peer, deliver_list_head,
  1156. deliver_list_tail);
  1157. }
  1158. static
  1159. QDF_STATUS dp_rx_defrag_store_fragment_rh(struct dp_soc *soc, qdf_nbuf_t frag)
  1160. {
  1161. struct dp_rx_reorder_array_elem *rx_reorder_array_elem;
  1162. struct dp_pdev *pdev;
  1163. struct dp_txrx_peer *txrx_peer = NULL;
  1164. dp_txrx_ref_handle txrx_ref_handle = NULL;
  1165. uint16_t peer_id, tid;
  1166. uint8_t fragno, more_frag, all_frag_present = 0;
  1167. uint16_t rxseq;
  1168. QDF_STATUS status;
  1169. struct dp_rx_tid_defrag *rx_tid;
  1170. uint8_t mpdu_sequence_control_valid;
  1171. uint8_t mpdu_frame_control_valid;
  1172. uint8_t *rx_buf_start = qdf_nbuf_data(frag);
  1173. uint32_t msdu_len;
  1174. if (qdf_nbuf_len(frag) > 0) {
  1175. dp_rx_info("Dropping unexpected packet with skb_len: %d, data len: %d",
  1176. (uint32_t)qdf_nbuf_len(frag), frag->data_len);
  1177. DP_STATS_INC(soc, rx.rx_frag_err_len_error, 1);
  1178. goto discard_frag;
  1179. }
  1180. msdu_len = QDF_NBUF_CB_RX_PKT_LEN(frag);
  1181. qdf_nbuf_set_pktlen(frag, (msdu_len + soc->rx_pkt_tlv_size));
  1182. qdf_nbuf_append_ext_list(frag, NULL, 0);
  1183. /* Check if the packet is from a valid peer */
  1184. peer_id = QDF_NBUF_CB_RX_PEER_ID(frag);
  1185. txrx_peer = dp_txrx_peer_get_ref_by_id(soc, peer_id, &txrx_ref_handle,
  1186. DP_MOD_ID_RX);
  1187. if (!txrx_peer) {
  1188. /* We should not receive anything from unknown peer
  1189. * however, that might happen while we are in the monitor mode.
  1190. * We don't need to handle that here
  1191. */
  1192. dp_rx_info_rl("Unknown peer with peer_id %d, dropping fragment",
  1193. peer_id);
  1194. DP_STATS_INC(soc, rx.rx_frag_err_no_peer, 1);
  1195. goto discard_frag;
  1196. }
  1197. tid = qdf_nbuf_get_tid_val(frag);
  1198. if (tid >= DP_MAX_TIDS) {
  1199. dp_rx_info("TID out of bounds: %d", tid);
  1200. qdf_assert_always(0);
  1201. goto discard_frag;
  1202. }
  1203. mpdu_sequence_control_valid =
  1204. hal_rx_get_mpdu_sequence_control_valid(soc->hal_soc,
  1205. rx_buf_start);
  1206. /* Invalid MPDU sequence control field, MPDU is of no use */
  1207. if (!mpdu_sequence_control_valid) {
  1208. dp_rx_err("Invalid MPDU seq control field, dropping MPDU");
  1209. qdf_assert(0);
  1210. goto discard_frag;
  1211. }
  1212. mpdu_frame_control_valid =
  1213. hal_rx_get_mpdu_frame_control_valid(soc->hal_soc,
  1214. rx_buf_start);
  1215. /* Invalid frame control field */
  1216. if (!mpdu_frame_control_valid) {
  1217. dp_rx_err("Invalid frame control field, dropping MPDU");
  1218. qdf_assert(0);
  1219. goto discard_frag;
  1220. }
  1221. /* Current mpdu sequence */
  1222. more_frag = dp_rx_frag_get_more_frag_bit(soc, rx_buf_start);
  1223. /* HW does not populate the fragment number as of now
  1224. * need to get from the 802.11 header
  1225. */
  1226. fragno = dp_rx_frag_get_mpdu_frag_number(soc, rx_buf_start);
  1227. rxseq = dp_rx_frag_get_mpdu_seq_number(soc, rx_buf_start);
  1228. pdev = txrx_peer->vdev->pdev;
  1229. rx_tid = &txrx_peer->rx_tid[tid];
  1230. qdf_spin_lock_bh(&rx_tid->defrag_tid_lock);
  1231. rx_reorder_array_elem = txrx_peer->rx_tid[tid].array;
  1232. if (!rx_reorder_array_elem) {
  1233. dp_err_rl("Rcvd Fragmented pkt before tid setup for peer %pK",
  1234. txrx_peer);
  1235. qdf_spin_unlock_bh(&rx_tid->defrag_tid_lock);
  1236. goto discard_frag;
  1237. }
  1238. /*
  1239. * !more_frag: no more fragments to be delivered
  1240. * !frag_no: packet is not fragmented
  1241. * !rx_reorder_array_elem->head: no saved fragments so far
  1242. */
  1243. if (!more_frag && !fragno && !rx_reorder_array_elem->head) {
  1244. /* We should not get into this situation here.
  1245. * It means an unfragmented packet with fragment flag
  1246. * is delivered over frag indication.
  1247. * Typically it follows normal rx path.
  1248. */
  1249. dp_rx_err("Rcvd unfragmented pkt on fragmented path, dropping");
  1250. qdf_spin_unlock_bh(&rx_tid->defrag_tid_lock);
  1251. qdf_assert(0);
  1252. goto discard_frag;
  1253. }
  1254. /* Check if the fragment is for the same sequence or a different one */
  1255. dp_rx_debug("rx_tid %d", tid);
  1256. if (rx_reorder_array_elem->head) {
  1257. dp_rx_debug("rxseq %d\n", rxseq);
  1258. if (rxseq != rx_tid->curr_seq_num) {
  1259. dp_rx_debug("mismatch cur_seq %d rxseq %d\n",
  1260. rx_tid->curr_seq_num, rxseq);
  1261. /* Drop stored fragments if out of sequence
  1262. * fragment is received
  1263. */
  1264. dp_rx_reorder_flush_frag(txrx_peer, tid);
  1265. DP_STATS_INC(soc, rx.rx_frag_oor, 1);
  1266. dp_rx_debug("cur rxseq %d\n", rxseq);
  1267. /*
  1268. * The sequence number for this fragment becomes the
  1269. * new sequence number to be processed
  1270. */
  1271. rx_tid->curr_seq_num = rxseq;
  1272. }
  1273. } else {
  1274. /* Check if we are processing first fragment if it is
  1275. * not first fragment discard fragment.
  1276. */
  1277. if (fragno) {
  1278. qdf_spin_unlock_bh(&rx_tid->defrag_tid_lock);
  1279. goto discard_frag;
  1280. }
  1281. dp_rx_debug("cur rxseq %d\n", rxseq);
  1282. /* Start of a new sequence */
  1283. dp_rx_defrag_cleanup(txrx_peer, tid);
  1284. rx_tid->curr_seq_num = rxseq;
  1285. }
  1286. /*
  1287. * If the earlier sequence was dropped, this will be the fresh start.
  1288. * Else, continue with next fragment in a given sequence
  1289. */
  1290. status = dp_rx_defrag_fraglist_insert(txrx_peer, tid,
  1291. &rx_reorder_array_elem->head,
  1292. &rx_reorder_array_elem->tail,
  1293. frag, &all_frag_present);
  1294. if (pdev->soc->rx.flags.defrag_timeout_check)
  1295. dp_rx_defrag_waitlist_remove(txrx_peer, tid);
  1296. /* Yet to receive more fragments for this sequence number */
  1297. if (!all_frag_present) {
  1298. uint32_t now_ms =
  1299. qdf_system_ticks_to_msecs(qdf_system_ticks());
  1300. txrx_peer->rx_tid[tid].defrag_timeout_ms =
  1301. now_ms + pdev->soc->rx.defrag.timeout_ms;
  1302. if (pdev->soc->rx.flags.defrag_timeout_check)
  1303. dp_rx_defrag_waitlist_add(txrx_peer, tid);
  1304. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX_ERR);
  1305. qdf_spin_unlock_bh(&rx_tid->defrag_tid_lock);
  1306. return QDF_STATUS_SUCCESS;
  1307. }
  1308. dp_rx_debug("All fragments received for sequence: %d", rxseq);
  1309. /* Process the fragments */
  1310. status = dp_rx_defrag(txrx_peer, tid, rx_reorder_array_elem->head,
  1311. rx_reorder_array_elem->tail);
  1312. if (QDF_IS_STATUS_ERROR(status)) {
  1313. dp_rx_err("Fragment processing failed");
  1314. dp_rx_defrag_cleanup(txrx_peer, tid);
  1315. qdf_spin_unlock_bh(&rx_tid->defrag_tid_lock);
  1316. goto end;
  1317. }
  1318. dp_rx_defrag_deliver_rh(txrx_peer, tid, rx_reorder_array_elem->head);
  1319. dp_rx_debug("Fragmented sequence successfully reinjected");
  1320. dp_rx_defrag_cleanup(txrx_peer, tid);
  1321. qdf_spin_unlock_bh(&rx_tid->defrag_tid_lock);
  1322. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX_ERR);
  1323. return QDF_STATUS_SUCCESS;
  1324. discard_frag:
  1325. dp_rx_nbuf_free(frag);
  1326. end:
  1327. if (txrx_peer)
  1328. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_RX_ERR);
  1329. DP_STATS_INC(soc, rx.rx_frag_err, 1);
  1330. return QDF_STATUS_E_DEFRAG_ERROR;
  1331. }
  1332. void
  1333. dp_rx_frag_indication_handler(struct dp_soc *soc, qdf_nbuf_t data_ind,
  1334. uint16_t vdev_id, uint16_t peer_id)
  1335. {
  1336. uint8_t *data_ind_msg;
  1337. uint32_t *msg_word;
  1338. uint32_t rx_ctx_id;
  1339. qdf_nbuf_t nbuf;
  1340. union dp_rx_desc_list_elem_t *head = NULL;
  1341. union dp_rx_desc_list_elem_t *tail = NULL;
  1342. QDF_STATUS status = QDF_STATUS_SUCCESS;
  1343. uint32_t rx_buf_cookie;
  1344. struct dp_rx_desc *rx_desc;
  1345. uint8_t mac_id = 0;
  1346. qdf_assert(soc);
  1347. data_ind_msg = qdf_nbuf_data(data_ind);
  1348. msg_word =
  1349. (uint32_t *)(data_ind_msg + HTT_RX_DATA_IND_HDR_SIZE);
  1350. rx_ctx_id =
  1351. dp_rx_get_ctx_id_frm_napiid(QDF_NBUF_CB_RX_CTX_ID(data_ind));
  1352. rx_buf_cookie =
  1353. HTT_RX_DATA_MSDU_INFO_SW_BUFFER_COOKIE_GET(*(msg_word + 1));
  1354. rx_desc = dp_rx_cookie_2_va_rxdma_buf(soc, rx_buf_cookie);
  1355. if (qdf_unlikely(!rx_desc && !rx_desc->nbuf &&
  1356. !rx_desc->in_use)) {
  1357. dp_rx_err("Invalid RX descriptor");
  1358. qdf_assert_always(0);
  1359. /* TODO handle this if its valid case */
  1360. }
  1361. if (qdf_unlikely(!dp_rx_desc_check_magic(rx_desc))) {
  1362. dp_err("Invalid rx_desc cookie=%d", rx_buf_cookie);
  1363. DP_STATS_INC(soc, rx.err.rx_desc_invalid_magic, 1);
  1364. qdf_assert(0);
  1365. }
  1366. nbuf = rx_desc->nbuf;
  1367. QDF_NBUF_CB_RX_PKT_LEN(nbuf) =
  1368. HTT_RX_DATA_MSDU_INFO_MSDU_LENGTH_GET(*(msg_word + 2));
  1369. qdf_nbuf_set_tid_val(nbuf, HTT_RX_DATA_MSDU_INFO_TID_INFO_GET(*(msg_word + 2)));
  1370. QDF_NBUF_CB_RX_PEER_ID(nbuf) = peer_id;
  1371. QDF_NBUF_CB_RX_VDEV_ID(nbuf) = vdev_id;
  1372. QDF_NBUF_CB_RX_CTX_ID(nbuf) = rx_ctx_id;
  1373. dp_rx_nbuf_unmap(soc, rx_desc, rx_ctx_id);
  1374. rx_desc->unmapped = 1;
  1375. dp_rx_add_to_free_desc_list(&head, &tail, rx_desc);
  1376. dp_rx_buffers_replenish_simple(soc, rx_desc->pool_id,
  1377. &soc->rx_refill_buf_ring[mac_id],
  1378. &soc->rx_desc_buf[rx_desc->pool_id],
  1379. 1, &head, &tail);
  1380. if (dp_rx_buffer_pool_refill(soc, nbuf, rx_desc->pool_id))
  1381. /* fragment queued back to the pool no frag to handle*/
  1382. return;
  1383. /* Process fragment-by-fragment */
  1384. status = dp_rx_defrag_store_fragment_rh(soc, nbuf);
  1385. if (QDF_IS_STATUS_ERROR(status))
  1386. dp_rx_err("Unable to handle frag ret:%u", status);
  1387. }
  1388. QDF_STATUS dp_rx_desc_pool_init_rh(struct dp_soc *soc,
  1389. struct rx_desc_pool *rx_desc_pool,
  1390. uint32_t pool_id)
  1391. {
  1392. return dp_rx_desc_pool_init_generic(soc, rx_desc_pool, pool_id);
  1393. }
  1394. void dp_rx_desc_pool_deinit_rh(struct dp_soc *soc,
  1395. struct rx_desc_pool *rx_desc_pool,
  1396. uint32_t pool_id)
  1397. {
  1398. }