dp_txrx_wds.c 36 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259
  1. /*
  2. * Copyright (c) 2016-2021 The Linux Foundation. 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 "htt.h"
  19. #include "dp_peer.h"
  20. #include "hal_rx.h"
  21. #include "hal_api.h"
  22. #include "qdf_nbuf.h"
  23. #include "dp_types.h"
  24. #include "dp_internal.h"
  25. #include "dp_tx.h"
  26. #include "enet.h"
  27. #include "dp_txrx_wds.h"
  28. /* Generic AST entry aging timer value */
  29. #define DP_AST_AGING_TIMER_DEFAULT_MS 5000
  30. #define DP_VLAN_UNTAGGED 0
  31. #define DP_VLAN_TAGGED_MULTICAST 1
  32. #define DP_VLAN_TAGGED_UNICAST 2
  33. #define DP_MAX_VLAN_IDS 4096
  34. #define DP_INVALID_AST_IDX 0xffff
  35. #define DP_INVALID_FLOW_PRIORITY 0xff
  36. #define DP_PEER_AST0_FLOW_MASK 0x4
  37. #define DP_PEER_AST1_FLOW_MASK 0x8
  38. #define DP_PEER_AST2_FLOW_MASK 0x1
  39. #define DP_PEER_AST3_FLOW_MASK 0x2
  40. #define DP_MAX_AST_INDEX_PER_PEER 4
  41. static void
  42. dp_peer_age_ast_entries(struct dp_soc *soc, struct dp_peer *peer, void *arg)
  43. {
  44. struct dp_ast_entry *ase, *temp_ase;
  45. struct ast_del_ctxt *del_ctxt = (struct ast_del_ctxt *)arg;
  46. if ((del_ctxt->del_count >= soc->max_ast_ageout_count) &&
  47. !del_ctxt->age) {
  48. return;
  49. }
  50. DP_PEER_ITERATE_ASE_LIST(peer, ase, temp_ase) {
  51. /*
  52. * Do not expire static ast entries and HM WDS entries
  53. */
  54. if (ase->type != CDP_TXRX_AST_TYPE_WDS &&
  55. ase->type != CDP_TXRX_AST_TYPE_DA)
  56. continue;
  57. if (ase->is_active) {
  58. if (del_ctxt->age)
  59. ase->is_active = FALSE;
  60. continue;
  61. }
  62. if (del_ctxt->del_count < soc->max_ast_ageout_count) {
  63. DP_STATS_INC(soc, ast.aged_out, 1);
  64. dp_peer_del_ast(soc, ase);
  65. del_ctxt->del_count++;
  66. } else {
  67. soc->pending_ageout = true;
  68. if (!del_ctxt->age)
  69. break;
  70. }
  71. }
  72. }
  73. static void
  74. dp_peer_age_mec_entries(struct dp_soc *soc)
  75. {
  76. uint32_t index;
  77. struct dp_mec_entry *mecentry, *mecentry_next;
  78. TAILQ_HEAD(, dp_mec_entry) free_list;
  79. TAILQ_INIT(&free_list);
  80. for (index = 0; index <= soc->mec_hash.mask; index++) {
  81. qdf_spin_lock_bh(&soc->mec_lock);
  82. /*
  83. * Expire MEC entry every n sec.
  84. */
  85. if (!TAILQ_EMPTY(&soc->mec_hash.bins[index])) {
  86. TAILQ_FOREACH_SAFE(mecentry, &soc->mec_hash.bins[index],
  87. hash_list_elem, mecentry_next) {
  88. if (mecentry->is_active) {
  89. mecentry->is_active = FALSE;
  90. continue;
  91. }
  92. dp_peer_mec_detach_entry(soc, mecentry,
  93. &free_list);
  94. }
  95. }
  96. qdf_spin_unlock_bh(&soc->mec_lock);
  97. }
  98. dp_peer_mec_free_list(soc, &free_list);
  99. }
  100. static void dp_ast_aging_timer_fn(void *soc_hdl)
  101. {
  102. struct dp_soc *soc = (struct dp_soc *)soc_hdl;
  103. struct ast_del_ctxt del_ctxt = {0};
  104. if (soc->wds_ast_aging_timer_cnt++ >= DP_WDS_AST_AGING_TIMER_CNT) {
  105. del_ctxt.age = true;
  106. soc->wds_ast_aging_timer_cnt = 0;
  107. }
  108. if (soc->pending_ageout || del_ctxt.age) {
  109. soc->pending_ageout = false;
  110. /* AST list access lock */
  111. qdf_spin_lock_bh(&soc->ast_lock);
  112. dp_soc_iterate_peer(soc, dp_peer_age_ast_entries, &del_ctxt,
  113. DP_MOD_ID_AST);
  114. qdf_spin_unlock_bh(&soc->ast_lock);
  115. }
  116. /*
  117. * If NSS offload is enabled, the MEC timeout
  118. * will be managed by NSS.
  119. */
  120. if (qdf_atomic_read(&soc->mec_cnt) &&
  121. !wlan_cfg_get_dp_soc_nss_cfg(soc->wlan_cfg_ctx))
  122. dp_peer_age_mec_entries(soc);
  123. if (qdf_atomic_read(&soc->cmn_init_done))
  124. qdf_timer_mod(&soc->ast_aging_timer,
  125. DP_AST_AGING_TIMER_DEFAULT_MS);
  126. }
  127. /*
  128. * dp_soc_wds_attach() - Setup WDS timer and AST table
  129. * @soc: Datapath SOC handle
  130. *
  131. * Return: None
  132. */
  133. void dp_soc_wds_attach(struct dp_soc *soc)
  134. {
  135. soc->wds_ast_aging_timer_cnt = 0;
  136. soc->pending_ageout = false;
  137. qdf_timer_init(soc->osdev, &soc->ast_aging_timer,
  138. dp_ast_aging_timer_fn, (void *)soc,
  139. QDF_TIMER_TYPE_WAKE_APPS);
  140. qdf_timer_mod(&soc->ast_aging_timer, DP_AST_AGING_TIMER_DEFAULT_MS);
  141. }
  142. /*
  143. * dp_soc_wds_detach() - Detach WDS data structures and timers
  144. * @txrx_soc: DP SOC handle
  145. *
  146. * Return: None
  147. */
  148. void dp_soc_wds_detach(struct dp_soc *soc)
  149. {
  150. qdf_timer_stop(&soc->ast_aging_timer);
  151. qdf_timer_free(&soc->ast_aging_timer);
  152. }
  153. /**
  154. * dp_tx_mec_handler() - Tx MEC Notify Handler
  155. * @vdev: pointer to dp dev handler
  156. * @status : Tx completion status from HTT descriptor
  157. *
  158. * Handles MEC notify event sent from fw to Host
  159. *
  160. * Return: none
  161. */
  162. void dp_tx_mec_handler(struct dp_vdev *vdev, uint8_t *status)
  163. {
  164. struct dp_soc *soc;
  165. QDF_STATUS add_mec_status;
  166. uint8_t mac_addr[QDF_MAC_ADDR_SIZE], i;
  167. if (!vdev->mec_enabled)
  168. return;
  169. /* MEC required only in STA mode */
  170. if (vdev->opmode != wlan_op_mode_sta)
  171. return;
  172. soc = vdev->pdev->soc;
  173. for (i = 0; i < QDF_MAC_ADDR_SIZE; i++)
  174. mac_addr[(QDF_MAC_ADDR_SIZE - 1) - i] =
  175. status[(QDF_MAC_ADDR_SIZE - 2) + i];
  176. dp_peer_debug("%pK: MEC add for mac_addr "QDF_MAC_ADDR_FMT,
  177. soc, QDF_MAC_ADDR_REF(mac_addr));
  178. if (qdf_mem_cmp(mac_addr, vdev->mac_addr.raw, QDF_MAC_ADDR_SIZE)) {
  179. add_mec_status = dp_peer_mec_add_entry(soc, vdev, mac_addr);
  180. dp_peer_debug("%pK: MEC add status %d", vdev, add_mec_status);
  181. }
  182. }
  183. #ifndef QCA_HOST_MODE_WIFI_DISABLED
  184. /**
  185. * dp_rx_da_learn() - Add AST entry based on DA lookup
  186. * This is a WAR for HK 1.0 and will
  187. * be removed in HK 2.0
  188. *
  189. * @soc: core txrx main context
  190. * @rx_tlv_hdr : start address of rx tlvs
  191. * @ta_peer : Transmitter peer entry
  192. * @nbuf : nbuf to retrieve destination mac for which AST will be added
  193. *
  194. */
  195. void
  196. dp_rx_da_learn(struct dp_soc *soc,
  197. uint8_t *rx_tlv_hdr,
  198. struct dp_peer *ta_peer,
  199. qdf_nbuf_t nbuf)
  200. {
  201. /* For HKv2 DA port learing is not needed */
  202. if (qdf_likely(soc->ast_override_support))
  203. return;
  204. if (qdf_unlikely(!ta_peer))
  205. return;
  206. if (qdf_unlikely(ta_peer->vdev->opmode != wlan_op_mode_ap))
  207. return;
  208. if (!soc->da_war_enabled)
  209. return;
  210. if (qdf_unlikely(!qdf_nbuf_is_da_valid(nbuf) &&
  211. !qdf_nbuf_is_da_mcbc(nbuf))) {
  212. dp_peer_add_ast(soc,
  213. ta_peer,
  214. qdf_nbuf_data(nbuf),
  215. CDP_TXRX_AST_TYPE_DA,
  216. DP_AST_FLAGS_HM);
  217. }
  218. }
  219. /**
  220. * dp_txrx_set_wds_rx_policy() - API to store datapath
  221. * config parameters
  222. * @soc - datapath soc handle
  223. * @vdev_id - id of datapath vdev handle
  224. * @cfg: ini parameter handle
  225. *
  226. * Return: status
  227. */
  228. #ifdef WDS_VENDOR_EXTENSION
  229. QDF_STATUS
  230. dp_txrx_set_wds_rx_policy(struct cdp_soc_t *soc_hdl, uint8_t vdev_id,
  231. u_int32_t val)
  232. {
  233. struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
  234. struct dp_peer *peer;
  235. struct dp_vdev *vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
  236. DP_MOD_ID_MISC);
  237. if (!vdev) {
  238. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  239. FL("vdev is NULL for vdev_id %d"), vdev_id);
  240. return QDF_STATUS_E_INVAL;
  241. }
  242. peer = dp_vdev_bss_peer_ref_n_get(vdev, DP_MOD_ID_AST);
  243. if (peer) {
  244. peer->wds_ecm.wds_rx_filter = 1;
  245. peer->wds_ecm.wds_rx_ucast_4addr =
  246. (val & WDS_POLICY_RX_UCAST_4ADDR) ? 1 : 0;
  247. peer->wds_ecm.wds_rx_mcast_4addr =
  248. (val & WDS_POLICY_RX_MCAST_4ADDR) ? 1 : 0;
  249. dp_peer_unref_delete(peer, DP_MOD_ID_AST);
  250. }
  251. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_MISC);
  252. return QDF_STATUS_SUCCESS;
  253. }
  254. /**
  255. * dp_txrx_peer_wds_tx_policy_update() - API to set tx wds policy
  256. *
  257. * @cdp_soc: DP soc handle
  258. * @vdev_id: id of vdev handle
  259. * @peer_mac: peer mac address
  260. * @wds_tx_ucast: policy for unicast transmission
  261. * @wds_tx_mcast: policy for multicast transmission
  262. *
  263. * Return: void
  264. */
  265. QDF_STATUS
  266. dp_txrx_peer_wds_tx_policy_update(struct cdp_soc_t *soc, uint8_t vdev_id,
  267. uint8_t *peer_mac, int wds_tx_ucast,
  268. int wds_tx_mcast)
  269. {
  270. struct dp_peer *peer = dp_peer_find_hash_find((struct dp_soc *)soc,
  271. peer_mac, 0,
  272. vdev_id,
  273. DP_MOD_ID_AST);
  274. if (!peer) {
  275. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  276. FL("peer is NULL for mac %pM vdev_id %d"),
  277. peer_mac, vdev_id);
  278. return QDF_STATUS_E_INVAL;
  279. }
  280. if (wds_tx_ucast || wds_tx_mcast) {
  281. peer->wds_enabled = 1;
  282. peer->wds_ecm.wds_tx_ucast_4addr = wds_tx_ucast;
  283. peer->wds_ecm.wds_tx_mcast_4addr = wds_tx_mcast;
  284. } else {
  285. peer->wds_enabled = 0;
  286. peer->wds_ecm.wds_tx_ucast_4addr = 0;
  287. peer->wds_ecm.wds_tx_mcast_4addr = 0;
  288. }
  289. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_INFO,
  290. "Policy Update set to :\n");
  291. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_INFO,
  292. "peer->wds_enabled %d\n", peer->wds_enabled);
  293. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_INFO,
  294. "peer->wds_ecm.wds_tx_ucast_4addr %d\n",
  295. peer->wds_ecm.wds_tx_ucast_4addr);
  296. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_INFO,
  297. "peer->wds_ecm.wds_tx_mcast_4addr %d\n",
  298. peer->wds_ecm.wds_tx_mcast_4addr);
  299. dp_peer_unref_delete(peer, DP_MOD_ID_AST);
  300. return QDF_STATUS_SUCCESS;
  301. }
  302. int dp_wds_rx_policy_check(uint8_t *rx_tlv_hdr,
  303. struct dp_vdev *vdev,
  304. struct dp_peer *peer)
  305. {
  306. struct dp_peer *bss_peer;
  307. int fr_ds, to_ds, rx_3addr, rx_4addr;
  308. int rx_policy_ucast, rx_policy_mcast;
  309. hal_soc_handle_t hal_soc = vdev->pdev->soc->hal_soc;
  310. int rx_mcast = hal_rx_msdu_end_da_is_mcbc_get(hal_soc, rx_tlv_hdr);
  311. if (vdev->opmode == wlan_op_mode_ap) {
  312. bss_peer = dp_vdev_bss_peer_ref_n_get(vdev, DP_MOD_ID_AST);
  313. /* if wds policy check is not enabled on this vdev, accept all frames */
  314. if (bss_peer && !bss_peer->wds_ecm.wds_rx_filter) {
  315. dp_peer_unref_delete(bss_peer, DP_MOD_ID_AST);
  316. return 1;
  317. }
  318. rx_policy_ucast = bss_peer->wds_ecm.wds_rx_ucast_4addr;
  319. rx_policy_mcast = bss_peer->wds_ecm.wds_rx_mcast_4addr;
  320. dp_peer_unref_delete(bss_peer, DP_MOD_ID_AST);
  321. } else { /* sta mode */
  322. if (!peer->wds_ecm.wds_rx_filter) {
  323. return 1;
  324. }
  325. rx_policy_ucast = peer->wds_ecm.wds_rx_ucast_4addr;
  326. rx_policy_mcast = peer->wds_ecm.wds_rx_mcast_4addr;
  327. }
  328. /* ------------------------------------------------
  329. * self
  330. * peer- rx rx-
  331. * wds ucast mcast dir policy accept note
  332. * ------------------------------------------------
  333. * 1 1 0 11 x1 1 AP configured to accept ds-to-ds Rx ucast from wds peers, constraint met; so, accept
  334. * 1 1 0 01 x1 0 AP configured to accept ds-to-ds Rx ucast from wds peers, constraint not met; so, drop
  335. * 1 1 0 10 x1 0 AP configured to accept ds-to-ds Rx ucast from wds peers, constraint not met; so, drop
  336. * 1 1 0 00 x1 0 bad frame, won't see it
  337. * 1 0 1 11 1x 1 AP configured to accept ds-to-ds Rx mcast from wds peers, constraint met; so, accept
  338. * 1 0 1 01 1x 0 AP configured to accept ds-to-ds Rx mcast from wds peers, constraint not met; so, drop
  339. * 1 0 1 10 1x 0 AP configured to accept ds-to-ds Rx mcast from wds peers, constraint not met; so, drop
  340. * 1 0 1 00 1x 0 bad frame, won't see it
  341. * 1 1 0 11 x0 0 AP configured to accept from-ds Rx ucast from wds peers, constraint not met; so, drop
  342. * 1 1 0 01 x0 0 AP configured to accept from-ds Rx ucast from wds peers, constraint not met; so, drop
  343. * 1 1 0 10 x0 1 AP configured to accept from-ds Rx ucast from wds peers, constraint met; so, accept
  344. * 1 1 0 00 x0 0 bad frame, won't see it
  345. * 1 0 1 11 0x 0 AP configured to accept from-ds Rx mcast from wds peers, constraint not met; so, drop
  346. * 1 0 1 01 0x 0 AP configured to accept from-ds Rx mcast from wds peers, constraint not met; so, drop
  347. * 1 0 1 10 0x 1 AP configured to accept from-ds Rx mcast from wds peers, constraint met; so, accept
  348. * 1 0 1 00 0x 0 bad frame, won't see it
  349. *
  350. * 0 x x 11 xx 0 we only accept td-ds Rx frames from non-wds peers in mode.
  351. * 0 x x 01 xx 1
  352. * 0 x x 10 xx 0
  353. * 0 x x 00 xx 0 bad frame, won't see it
  354. * ------------------------------------------------
  355. */
  356. fr_ds = hal_rx_mpdu_get_fr_ds(hal_soc, rx_tlv_hdr);
  357. to_ds = hal_rx_mpdu_get_to_ds(hal_soc, rx_tlv_hdr);
  358. rx_3addr = fr_ds ^ to_ds;
  359. rx_4addr = fr_ds & to_ds;
  360. if (vdev->opmode == wlan_op_mode_ap) {
  361. if ((!peer->wds_enabled && rx_3addr && to_ds) ||
  362. (peer->wds_enabled && !rx_mcast && (rx_4addr == rx_policy_ucast)) ||
  363. (peer->wds_enabled && rx_mcast && (rx_4addr == rx_policy_mcast))) {
  364. return 1;
  365. }
  366. } else { /* sta mode */
  367. if ((!rx_mcast && (rx_4addr == rx_policy_ucast)) ||
  368. (rx_mcast && (rx_4addr == rx_policy_mcast))) {
  369. return 1;
  370. }
  371. }
  372. return 0;
  373. }
  374. #endif
  375. /**
  376. * dp_tx_add_groupkey_metadata - Add group key in metadata
  377. * @vdev: DP vdev handle
  378. * @msdu_info: MSDU info to be setup in MSDU descriptor
  379. * @group_key: Group key index programmed in metadata
  380. *
  381. * Return: void
  382. */
  383. #ifdef QCA_MULTIPASS_SUPPORT
  384. static
  385. void dp_tx_add_groupkey_metadata(struct dp_vdev *vdev,
  386. struct dp_tx_msdu_info_s *msdu_info, uint16_t group_key)
  387. {
  388. struct htt_tx_msdu_desc_ext2_t *meta_data =
  389. (struct htt_tx_msdu_desc_ext2_t *)&msdu_info->meta_data[0];
  390. qdf_mem_zero(meta_data, sizeof(struct htt_tx_msdu_desc_ext2_t));
  391. /*
  392. * When attempting to send a multicast packet with multi-passphrase,
  393. * host shall add HTT EXT meta data "struct htt_tx_msdu_desc_ext2_t"
  394. * ref htt.h indicating the group_id field in "key_flags" also having
  395. * "valid_key_flags" as 1. Assign “key_flags = group_key_ix”.
  396. */
  397. HTT_TX_MSDU_EXT2_DESC_FLAG_VALID_KEY_FLAGS_SET(msdu_info->meta_data[0], 1);
  398. HTT_TX_MSDU_EXT2_DESC_KEY_FLAGS_SET(msdu_info->meta_data[2], group_key);
  399. }
  400. /**
  401. * dp_tx_remove_vlan_tag - Remove 4 bytes of vlan tag
  402. * @vdev: DP vdev handle
  403. * @tx_desc: Tx Descriptor Handle
  404. *
  405. * Return: void
  406. */
  407. static
  408. void dp_tx_remove_vlan_tag(struct dp_vdev *vdev, qdf_nbuf_t nbuf)
  409. {
  410. struct vlan_ethhdr veth_hdr;
  411. struct vlan_ethhdr *veh = (struct vlan_ethhdr *)nbuf->data;
  412. /*
  413. * Extract VLAN header of 4 bytes:
  414. * Frame Format : {dst_addr[6], src_addr[6], 802.1Q header[4], EtherType[2], Payload}
  415. * Before Removal : xx xx xx xx xx xx xx xx xx xx xx xx 81 00 00 02 08 00 45 00 00...
  416. * After Removal : xx xx xx xx xx xx xx xx xx xx xx xx 08 00 45 00 00...
  417. */
  418. qdf_mem_copy(&veth_hdr, veh, sizeof(veth_hdr));
  419. qdf_nbuf_pull_head(nbuf, ETHERTYPE_VLAN_LEN);
  420. veh = (struct vlan_ethhdr *)nbuf->data;
  421. qdf_mem_copy(veh, &veth_hdr, 2 * QDF_MAC_ADDR_SIZE);
  422. return;
  423. }
  424. /**
  425. * dp_tx_need_multipass_process - If frame needs multipass phrase processing
  426. * @vdev: DP vdev handle
  427. * @tx_desc: Tx Descriptor Handle
  428. * @vlan_id: vlan id of frame
  429. *
  430. * Return: whether peer is special or classic
  431. */
  432. static
  433. uint8_t dp_tx_need_multipass_process(struct dp_soc *soc, struct dp_vdev *vdev,
  434. qdf_nbuf_t buf, uint16_t *vlan_id)
  435. {
  436. struct dp_peer *peer = NULL;
  437. qdf_ether_header_t *eh = (qdf_ether_header_t *)qdf_nbuf_data(buf);
  438. struct vlan_ethhdr *veh = NULL;
  439. bool not_vlan = ((vdev->tx_encap_type == htt_cmn_pkt_type_raw) ||
  440. (htons(eh->ether_type) != ETH_P_8021Q));
  441. if (qdf_unlikely(not_vlan))
  442. return DP_VLAN_UNTAGGED;
  443. veh = (struct vlan_ethhdr *)eh;
  444. *vlan_id = (ntohs(veh->h_vlan_TCI) & VLAN_VID_MASK);
  445. if (qdf_unlikely(DP_FRAME_IS_MULTICAST((eh)->ether_dhost))) {
  446. qdf_spin_lock_bh(&vdev->mpass_peer_mutex);
  447. TAILQ_FOREACH(peer, &vdev->mpass_peer_list,
  448. mpass_peer_list_elem) {
  449. if (*vlan_id == peer->vlan_id) {
  450. qdf_spin_unlock_bh(&vdev->mpass_peer_mutex);
  451. return DP_VLAN_TAGGED_MULTICAST;
  452. }
  453. }
  454. qdf_spin_unlock_bh(&vdev->mpass_peer_mutex);
  455. return DP_VLAN_UNTAGGED;
  456. }
  457. peer = dp_peer_find_hash_find(soc, eh->ether_dhost, 0, DP_VDEV_ALL,
  458. DP_MOD_ID_TX_MULTIPASS);
  459. if (qdf_unlikely(peer == NULL))
  460. return DP_VLAN_UNTAGGED;
  461. /*
  462. * Do not drop the frame when vlan_id doesn't match.
  463. * Send the frame as it is.
  464. */
  465. if (*vlan_id == peer->vlan_id) {
  466. dp_peer_unref_delete(peer, DP_MOD_ID_TX_MULTIPASS);
  467. return DP_VLAN_TAGGED_UNICAST;
  468. }
  469. dp_peer_unref_delete(peer, DP_MOD_ID_TX_MULTIPASS);
  470. return DP_VLAN_UNTAGGED;
  471. }
  472. /**
  473. * dp_tx_multipass_process - Process vlan frames in tx path
  474. * @soc: dp soc handle
  475. * @vdev: DP vdev handle
  476. * @nbuf: skb
  477. * @msdu_info: msdu descriptor
  478. *
  479. * Return: status whether frame needs to be dropped or transmitted
  480. */
  481. bool dp_tx_multipass_process(struct dp_soc *soc, struct dp_vdev *vdev,
  482. qdf_nbuf_t nbuf,
  483. struct dp_tx_msdu_info_s *msdu_info)
  484. {
  485. uint16_t vlan_id = 0;
  486. uint16_t group_key = 0;
  487. uint8_t is_spcl_peer = DP_VLAN_UNTAGGED;
  488. qdf_nbuf_t nbuf_copy = NULL;
  489. if (HTT_TX_MSDU_EXT2_DESC_FLAG_VALID_KEY_FLAGS_GET(msdu_info->meta_data[0])) {
  490. return true;
  491. }
  492. is_spcl_peer = dp_tx_need_multipass_process(soc, vdev, nbuf, &vlan_id);
  493. if ((is_spcl_peer != DP_VLAN_TAGGED_MULTICAST) &&
  494. (is_spcl_peer != DP_VLAN_TAGGED_UNICAST))
  495. return true;
  496. if (is_spcl_peer == DP_VLAN_TAGGED_UNICAST) {
  497. dp_tx_remove_vlan_tag(vdev, nbuf);
  498. return true;
  499. }
  500. /* AP can have classic clients, special clients &
  501. * classic repeaters.
  502. * 1. Classic clients & special client:
  503. * Remove vlan header, find corresponding group key
  504. * index, fill in metaheader and enqueue multicast
  505. * frame to TCL.
  506. * 2. Classic repeater:
  507. * Pass through to classic repeater with vlan tag
  508. * intact without any group key index. Hardware
  509. * will know which key to use to send frame to
  510. * repeater.
  511. */
  512. nbuf_copy = qdf_nbuf_copy(nbuf);
  513. /*
  514. * Send multicast frame to special peers even
  515. * if pass through to classic repeater fails.
  516. */
  517. if (nbuf_copy) {
  518. struct dp_tx_msdu_info_s msdu_info_copy;
  519. qdf_mem_zero(&msdu_info_copy, sizeof(msdu_info_copy));
  520. msdu_info_copy.tid = HTT_TX_EXT_TID_INVALID;
  521. HTT_TX_MSDU_EXT2_DESC_FLAG_VALID_KEY_FLAGS_SET(msdu_info_copy.meta_data[0], 1);
  522. nbuf_copy = dp_tx_send_msdu_single(vdev, nbuf_copy, &msdu_info_copy, HTT_INVALID_PEER, NULL);
  523. if (nbuf_copy) {
  524. qdf_nbuf_free(nbuf_copy);
  525. qdf_err("nbuf_copy send failed");
  526. }
  527. }
  528. group_key = vdev->iv_vlan_map[vlan_id];
  529. /*
  530. * If group key is not installed, drop the frame.
  531. */
  532. if (!group_key)
  533. return false;
  534. dp_tx_remove_vlan_tag(vdev, nbuf);
  535. dp_tx_add_groupkey_metadata(vdev, msdu_info, group_key);
  536. msdu_info->exception_fw = 1;
  537. return true;
  538. }
  539. /**
  540. * dp_rx_multipass_process - insert vlan tag on frames for traffic separation
  541. * @vdev: DP vdev handle
  542. * @nbuf: skb
  543. * @tid: traffic priority
  544. *
  545. * Return: bool: true in case of success else false
  546. * Success is considered if:
  547. * i. If frame has vlan header
  548. * ii. If the frame comes from different peer and dont need multipass processing
  549. * Failure is considered if:
  550. * i. Frame comes from multipass peer but doesn't contain vlan header.
  551. * In failure case, drop such frames.
  552. */
  553. bool dp_rx_multipass_process(struct dp_peer *peer, qdf_nbuf_t nbuf, uint8_t tid)
  554. {
  555. struct vlan_ethhdr *vethhdrp;
  556. if (qdf_unlikely(!peer->vlan_id))
  557. return true;
  558. vethhdrp = (struct vlan_ethhdr *)qdf_nbuf_data(nbuf);
  559. /*
  560. * h_vlan_proto & h_vlan_TCI should be 0x8100 & zero respectively
  561. * as it is expected to be padded by 0
  562. * return false if frame doesn't have above tag so that caller will
  563. * drop the frame.
  564. */
  565. if (qdf_unlikely(vethhdrp->h_vlan_proto != htons(QDF_ETH_TYPE_8021Q)) ||
  566. qdf_unlikely(vethhdrp->h_vlan_TCI != 0))
  567. return false;
  568. vethhdrp->h_vlan_TCI = htons(((tid & 0x7) << VLAN_PRIO_SHIFT) |
  569. (peer->vlan_id & VLAN_VID_MASK));
  570. return true;
  571. }
  572. #endif /* QCA_MULTIPASS_SUPPORT */
  573. #endif /* QCA_HOST_MODE_WIFI_DISABLED */
  574. #ifdef QCA_MULTIPASS_SUPPORT
  575. /**
  576. * dp_peer_multipass_list_remove: remove peer from list
  577. * @peer: pointer to peer
  578. *
  579. * return: void
  580. */
  581. void dp_peer_multipass_list_remove(struct dp_peer *peer)
  582. {
  583. struct dp_vdev *vdev = peer->vdev;
  584. struct dp_peer *tpeer = NULL;
  585. bool found = 0;
  586. qdf_spin_lock_bh(&vdev->mpass_peer_mutex);
  587. TAILQ_FOREACH(tpeer, &vdev->mpass_peer_list, mpass_peer_list_elem) {
  588. if (tpeer == peer) {
  589. found = 1;
  590. TAILQ_REMOVE(&vdev->mpass_peer_list, peer, mpass_peer_list_elem);
  591. break;
  592. }
  593. }
  594. qdf_spin_unlock_bh(&vdev->mpass_peer_mutex);
  595. if (found)
  596. dp_peer_unref_delete(peer, DP_MOD_ID_TX_MULTIPASS);
  597. }
  598. /**
  599. * dp_peer_multipass_list_add: add to new multipass list
  600. * @dp_soc: soc handle
  601. * @peer_mac: mac address
  602. * @vdev_id: vdev id for peer
  603. * @vlan_id: vlan_id
  604. *
  605. * return: void
  606. */
  607. static void dp_peer_multipass_list_add(struct dp_soc *soc, uint8_t *peer_mac,
  608. uint8_t vdev_id, uint16_t vlan_id)
  609. {
  610. struct dp_peer *peer =
  611. dp_peer_find_hash_find(soc, peer_mac, 0, vdev_id,
  612. DP_MOD_ID_TX_MULTIPASS);
  613. if (qdf_unlikely(!peer)) {
  614. qdf_err("NULL peer");
  615. return;
  616. }
  617. /* If peer already exists in vdev multipass list, do not add it.
  618. * This may happen if key install comes twice or re-key
  619. * happens for a peer.
  620. */
  621. if (peer->vlan_id) {
  622. dp_debug("peer already added to vdev multipass list"
  623. "MAC: "QDF_MAC_ADDR_FMT" vlan: %d ",
  624. QDF_MAC_ADDR_REF(peer->mac_addr.raw), peer->vlan_id);
  625. dp_peer_unref_delete(peer, DP_MOD_ID_TX_MULTIPASS);
  626. return;
  627. }
  628. /*
  629. * Ref_cnt is incremented inside dp_peer_find_hash_find().
  630. * Decrement it when element is deleted from the list.
  631. */
  632. peer->vlan_id = vlan_id;
  633. qdf_spin_lock_bh(&peer->vdev->mpass_peer_mutex);
  634. TAILQ_INSERT_HEAD(&peer->vdev->mpass_peer_list, peer,
  635. mpass_peer_list_elem);
  636. qdf_spin_unlock_bh(&peer->vdev->mpass_peer_mutex);
  637. }
  638. /**
  639. * dp_peer_set_vlan_id: set vlan_id for this peer
  640. * @cdp_soc: soc handle
  641. * @vdev_id: vdev id for peer
  642. * @peer_mac: mac address
  643. * @vlan_id: vlan id for peer
  644. *
  645. * return: void
  646. */
  647. void dp_peer_set_vlan_id(struct cdp_soc_t *cdp_soc,
  648. uint8_t vdev_id, uint8_t *peer_mac,
  649. uint16_t vlan_id)
  650. {
  651. struct dp_soc *soc = (struct dp_soc *)cdp_soc;
  652. struct dp_vdev *vdev =
  653. dp_vdev_get_ref_by_id((struct dp_soc *)soc, vdev_id,
  654. DP_MOD_ID_TX_MULTIPASS);
  655. if (vdev && vdev->multipass_en) {
  656. dp_peer_multipass_list_add(soc, peer_mac, vdev_id, vlan_id);
  657. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_TX_MULTIPASS);
  658. }
  659. }
  660. /**
  661. * dp_set_vlan_groupkey: set vlan map for vdev
  662. * @soc: pointer to soc
  663. * @vdev_id : id of vdev
  664. * @vlan_id: vlan_id
  665. * @group_key: group key for vlan
  666. *
  667. * return: set success/failure
  668. */
  669. QDF_STATUS dp_set_vlan_groupkey(struct cdp_soc_t *soc_hdl, uint8_t vdev_id,
  670. uint16_t vlan_id, uint16_t group_key)
  671. {
  672. struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
  673. struct dp_vdev *vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
  674. DP_MOD_ID_TX_MULTIPASS);
  675. QDF_STATUS status;
  676. if (!vdev || !vdev->multipass_en) {
  677. status = QDF_STATUS_E_INVAL;
  678. goto fail;
  679. }
  680. if (!vdev->iv_vlan_map) {
  681. uint16_t vlan_map_size = (sizeof(uint16_t))*DP_MAX_VLAN_IDS;
  682. vdev->iv_vlan_map = (uint16_t *)qdf_mem_malloc(vlan_map_size);
  683. if (!vdev->iv_vlan_map) {
  684. QDF_TRACE_ERROR(QDF_MODULE_ID_DP, "iv_vlan_map");
  685. status = QDF_STATUS_E_NOMEM;
  686. goto fail;
  687. }
  688. /*
  689. * 0 is invalid group key.
  690. * Initilalize array with invalid group keys.
  691. */
  692. qdf_mem_zero(vdev->iv_vlan_map, vlan_map_size);
  693. }
  694. if (vlan_id >= DP_MAX_VLAN_IDS) {
  695. status = QDF_STATUS_E_INVAL;
  696. goto fail;
  697. }
  698. vdev->iv_vlan_map[vlan_id] = group_key;
  699. status = QDF_STATUS_SUCCESS;
  700. fail:
  701. if (vdev)
  702. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_TX_MULTIPASS);
  703. return status;
  704. }
  705. /**
  706. * dp_tx_vdev_multipass_deinit: set vlan map for vdev
  707. * @vdev_handle: pointer to vdev
  708. *
  709. * return: void
  710. */
  711. void dp_tx_vdev_multipass_deinit(struct dp_vdev *vdev)
  712. {
  713. struct dp_peer *peer = NULL;
  714. qdf_spin_lock_bh(&vdev->mpass_peer_mutex);
  715. TAILQ_FOREACH(peer, &vdev->mpass_peer_list, mpass_peer_list_elem)
  716. qdf_err("Peers present in mpass list :" QDF_MAC_ADDR_FMT,
  717. QDF_MAC_ADDR_REF(peer->mac_addr.raw));
  718. qdf_spin_unlock_bh(&vdev->mpass_peer_mutex);
  719. if (vdev->iv_vlan_map) {
  720. qdf_mem_free(vdev->iv_vlan_map);
  721. vdev->iv_vlan_map = NULL;
  722. }
  723. qdf_spinlock_destroy(&vdev->mpass_peer_mutex);
  724. }
  725. /**
  726. * dp_peer_multipass_list_init: initialize peer mulitpass list
  727. * @vdev_handle: pointer to vdev
  728. *
  729. * return: set success/failure
  730. */
  731. void dp_peer_multipass_list_init(struct dp_vdev *vdev)
  732. {
  733. /*
  734. * vdev->iv_vlan_map is allocated when the first configuration command
  735. * is issued to avoid unnecessary allocation for regular mode VAP.
  736. */
  737. TAILQ_INIT(&vdev->mpass_peer_list);
  738. qdf_spinlock_create(&vdev->mpass_peer_mutex);
  739. }
  740. #endif /* QCA_MULTIPASS_SUPPORT */
  741. #ifdef QCA_PEER_MULTIQ_SUPPORT
  742. /**
  743. * dp_peer_reset_flowq_map() - reset peer flowq map table
  744. * @peer - dp peer handle
  745. *
  746. * Return: none
  747. */
  748. void dp_peer_reset_flowq_map(struct dp_peer *peer)
  749. {
  750. int i = 0;
  751. if (!peer)
  752. return;
  753. for (i = 0; i < DP_PEER_AST_FLOWQ_MAX; i++) {
  754. peer->peer_ast_flowq_idx[i].is_valid = false;
  755. peer->peer_ast_flowq_idx[i].valid_tid_mask = false;
  756. peer->peer_ast_flowq_idx[i].ast_idx = DP_INVALID_AST_IDX;
  757. peer->peer_ast_flowq_idx[i].flowQ = DP_INVALID_FLOW_PRIORITY;
  758. }
  759. }
  760. /**
  761. * dp_peer_get_flowid_from_flowmask() - get flow id from flow mask
  762. * @peer - dp peer handle
  763. * @mask - flow mask
  764. *
  765. * Return: flow id
  766. */
  767. static int dp_peer_get_flowid_from_flowmask(struct dp_peer *peer,
  768. uint8_t mask)
  769. {
  770. if (!peer) {
  771. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  772. "%s: Invalid peer\n", __func__);
  773. return -1;
  774. }
  775. if (mask & DP_PEER_AST0_FLOW_MASK)
  776. return DP_PEER_AST_FLOWQ_UDP;
  777. else if (mask & DP_PEER_AST1_FLOW_MASK)
  778. return DP_PEER_AST_FLOWQ_NON_UDP;
  779. else if (mask & DP_PEER_AST2_FLOW_MASK)
  780. return DP_PEER_AST_FLOWQ_HI_PRIO;
  781. else if (mask & DP_PEER_AST3_FLOW_MASK)
  782. return DP_PEER_AST_FLOWQ_LOW_PRIO;
  783. return DP_PEER_AST_FLOWQ_MAX;
  784. }
  785. /**
  786. * dp_peer_get_ast_valid() - get ast index valid from mask
  787. * @mask - mask for ast valid bits
  788. * @index - index for an ast
  789. *
  790. * Return - 1 if ast index is valid from mask else 0
  791. */
  792. static inline bool dp_peer_get_ast_valid(uint8_t mask, uint16_t index)
  793. {
  794. if (index == 0)
  795. return 1;
  796. return ((mask) & (1 << ((index) - 1)));
  797. }
  798. /**
  799. * dp_peer_ast_index_flow_queue_map_create() - create ast index flow queue map
  800. * @soc - genereic soc handle
  801. * @is_wds - flag to indicate if peer is wds
  802. * @peer_id - peer_id from htt peer map message
  803. * @peer_mac_addr - mac address of the peer
  804. * @ast_info - ast flow override information from peer map
  805. *
  806. * Return: none
  807. */
  808. void dp_peer_ast_index_flow_queue_map_create(void *soc_hdl,
  809. bool is_wds, uint16_t peer_id, uint8_t *peer_mac_addr,
  810. struct dp_ast_flow_override_info *ast_info)
  811. {
  812. struct dp_soc *soc = (struct dp_soc *)soc_hdl;
  813. struct dp_peer *peer = NULL;
  814. uint8_t i;
  815. /*
  816. * Ast flow override feature is supported
  817. * only for connected client
  818. */
  819. if (is_wds)
  820. return;
  821. peer = dp_peer_get_ref_by_id(soc, peer_id, DP_MOD_ID_AST);
  822. if (!peer) {
  823. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  824. "%s: Invalid peer\n", __func__);
  825. return;
  826. }
  827. /* Valid only in AP mode */
  828. if (peer->vdev->opmode != wlan_op_mode_ap) {
  829. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  830. "%s: Peer ast flow map not in STA mode\n", __func__);
  831. goto end;
  832. }
  833. /* Making sure the peer is for this mac address */
  834. if (!qdf_is_macaddr_equal((struct qdf_mac_addr *)peer_mac_addr,
  835. (struct qdf_mac_addr *)peer->mac_addr.raw)) {
  836. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  837. "%s: Peer mac address mismatch\n", __func__);
  838. goto end;
  839. }
  840. /* Ast entry flow mapping not valid for self peer map */
  841. if (qdf_is_macaddr_equal((struct qdf_mac_addr *)peer_mac_addr,
  842. (struct qdf_mac_addr *)peer->vdev->mac_addr.raw)) {
  843. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  844. "%s: Ast flow mapping not valid for self peer \n", __func__);
  845. goto end;
  846. }
  847. /* Fill up ast index <---> flow id mapping table for this peer */
  848. for (i = 0; i < DP_MAX_AST_INDEX_PER_PEER; i++) {
  849. /* Check if this ast index is valid */
  850. peer->peer_ast_flowq_idx[i].is_valid =
  851. dp_peer_get_ast_valid(ast_info->ast_valid_mask, i);
  852. if (!peer->peer_ast_flowq_idx[i].is_valid)
  853. continue;
  854. /* Get the flow queue id which is mapped to this ast index */
  855. peer->peer_ast_flowq_idx[i].flowQ =
  856. dp_peer_get_flowid_from_flowmask(peer,
  857. ast_info->ast_flow_mask[i]);
  858. /*
  859. * Update tid valid mask only if flow id HIGH or
  860. * Low priority
  861. */
  862. if (peer->peer_ast_flowq_idx[i].flowQ ==
  863. DP_PEER_AST_FLOWQ_HI_PRIO) {
  864. peer->peer_ast_flowq_idx[i].valid_tid_mask =
  865. ast_info->tid_valid_hi_pri_mask;
  866. } else if (peer->peer_ast_flowq_idx[i].flowQ ==
  867. DP_PEER_AST_FLOWQ_LOW_PRIO) {
  868. peer->peer_ast_flowq_idx[i].valid_tid_mask =
  869. ast_info->tid_valid_low_pri_mask;
  870. }
  871. /* Save the ast index for this entry */
  872. peer->peer_ast_flowq_idx[i].ast_idx = ast_info->ast_idx[i];
  873. }
  874. if (soc->cdp_soc.ol_ops->peer_ast_flowid_map) {
  875. soc->cdp_soc.ol_ops->peer_ast_flowid_map(
  876. soc->ctrl_psoc, peer->peer_id,
  877. peer->vdev->vdev_id, peer_mac_addr);
  878. }
  879. end:
  880. /* Release peer reference */
  881. dp_peer_unref_delete(peer, DP_MOD_ID_AST);
  882. }
  883. /**
  884. * dp_peer_find_ast_index_by_flowq_id() - API to get ast idx for a given flowid
  885. * @soc - soc handle
  886. * @peer_mac_addr - mac address of the peer
  887. * @flow_id - flow id to find ast index
  888. *
  889. * Return: ast index for a given flow id, -1 for fail cases
  890. */
  891. int dp_peer_find_ast_index_by_flowq_id(struct cdp_soc_t *soc,
  892. uint16_t vdev_id, uint8_t *peer_mac_addr,
  893. uint8_t flow_id, uint8_t tid)
  894. {
  895. struct dp_peer *peer = NULL;
  896. uint8_t i;
  897. uint16_t ast_index;
  898. if (flow_id >= DP_PEER_AST_FLOWQ_MAX) {
  899. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  900. "Invalid Flow ID %d\n", flow_id);
  901. return -1;
  902. }
  903. peer = dp_peer_find_hash_find((struct dp_soc *)soc,
  904. peer_mac_addr, 0, vdev_id,
  905. DP_MOD_ID_AST);
  906. if (!peer) {
  907. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  908. "%s: Invalid peer\n", __func__);
  909. return -1;
  910. }
  911. /*
  912. * Loop over the ast entry <----> flow-id mapping to find
  913. * which ast index entry has this flow queue id enabled.
  914. */
  915. for (i = 0; i < DP_PEER_AST_FLOWQ_MAX; i++) {
  916. if (peer->peer_ast_flowq_idx[i].flowQ == flow_id)
  917. /*
  918. * Found the matching index for this flow id
  919. */
  920. break;
  921. }
  922. /*
  923. * No match found for this flow id
  924. */
  925. if (i == DP_PEER_AST_FLOWQ_MAX) {
  926. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  927. "%s: ast index not found for flow %d\n", __func__, flow_id);
  928. dp_peer_unref_delete(peer, DP_MOD_ID_AST);
  929. return -1;
  930. }
  931. /* Check whether this ast entry is valid */
  932. if (!peer->peer_ast_flowq_idx[i].is_valid) {
  933. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  934. "%s: ast index is invalid for flow %d\n", __func__, flow_id);
  935. dp_peer_unref_delete(peer, DP_MOD_ID_AST);
  936. return -1;
  937. }
  938. if (flow_id == DP_PEER_AST_FLOWQ_HI_PRIO ||
  939. flow_id == DP_PEER_AST_FLOWQ_LOW_PRIO) {
  940. /*
  941. * check if this tid is valid for Hi
  942. * and Low priority flow id
  943. */
  944. if ((peer->peer_ast_flowq_idx[i].valid_tid_mask
  945. & (1 << tid))) {
  946. /* Release peer reference */
  947. ast_index = peer->peer_ast_flowq_idx[i].ast_idx;
  948. dp_peer_unref_delete(peer, DP_MOD_ID_AST);
  949. return ast_index;
  950. } else {
  951. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  952. "%s: TID %d is not valid for flow %d\n",
  953. __func__, tid, flow_id);
  954. /*
  955. * TID is not valid for this flow
  956. * Return -1
  957. */
  958. dp_peer_unref_delete(peer, DP_MOD_ID_AST);
  959. return -1;
  960. }
  961. }
  962. /*
  963. * TID valid check not required for
  964. * UDP/NON UDP flow id
  965. */
  966. ast_index = peer->peer_ast_flowq_idx[i].ast_idx;
  967. dp_peer_unref_delete(peer, DP_MOD_ID_AST);
  968. return ast_index;
  969. }
  970. #endif
  971. void dp_hmwds_ast_add_notify(struct dp_peer *peer,
  972. uint8_t *mac_addr,
  973. enum cdp_txrx_ast_entry_type type,
  974. QDF_STATUS err,
  975. bool is_peer_map)
  976. {
  977. struct dp_vdev *dp_vdev = peer->vdev;
  978. struct dp_pdev *dp_pdev = dp_vdev->pdev;
  979. struct cdp_peer_hmwds_ast_add_status add_status;
  980. /* Ignore ast types other than HM */
  981. if ((type != CDP_TXRX_AST_TYPE_WDS_HM) &&
  982. (type != CDP_TXRX_AST_TYPE_WDS_HM_SEC))
  983. return;
  984. /* existing ast delete in progress, will be attempted
  985. * to add again after delete is complete. Send status then.
  986. */
  987. if (err == QDF_STATUS_E_AGAIN)
  988. return;
  989. /* peer map pending, notify actual status
  990. * when peer map is received.
  991. */
  992. if (!is_peer_map && (err == QDF_STATUS_SUCCESS))
  993. return;
  994. qdf_mem_zero(&add_status, sizeof(add_status));
  995. add_status.vdev_id = dp_vdev->vdev_id;
  996. /* For type CDP_TXRX_AST_TYPE_WDS_HM_SEC dp_peer_add_ast()
  997. * returns QDF_STATUS_E_FAILURE as it is host only entry.
  998. * In such cases set err as success. Also err code set to
  999. * QDF_STATUS_E_ALREADY indicates entry already exist in
  1000. * such cases set err as success too. Any other error code
  1001. * is actual error.
  1002. */
  1003. if (((type == CDP_TXRX_AST_TYPE_WDS_HM_SEC) &&
  1004. (err == QDF_STATUS_E_FAILURE)) ||
  1005. (err == QDF_STATUS_E_ALREADY)) {
  1006. err = QDF_STATUS_SUCCESS;
  1007. }
  1008. add_status.status = err;
  1009. qdf_mem_copy(add_status.peer_mac, peer->mac_addr.raw,
  1010. QDF_MAC_ADDR_SIZE);
  1011. qdf_mem_copy(add_status.ast_mac, mac_addr,
  1012. QDF_MAC_ADDR_SIZE);
  1013. #ifdef WDI_EVENT_ENABLE
  1014. dp_wdi_event_handler(WDI_EVENT_HMWDS_AST_ADD_STATUS, dp_pdev->soc,
  1015. (void *)&add_status, 0,
  1016. WDI_NO_VAL, dp_pdev->pdev_id);
  1017. #endif
  1018. }
  1019. #ifdef FEATURE_PERPKT_INFO
  1020. /**
  1021. * dp_get_completion_indication_for_stack() - send completion to stack
  1022. * @soc : dp_soc handle
  1023. * @pdev: dp_pdev handle
  1024. * @peer: dp peer handle
  1025. * @ts: transmit completion status structure
  1026. * @netbuf: Buffer pointer for free
  1027. *
  1028. * This function is used for indication whether buffer needs to be
  1029. * sent to stack for freeing or not
  1030. */
  1031. QDF_STATUS
  1032. dp_get_completion_indication_for_stack(struct dp_soc *soc,
  1033. struct dp_pdev *pdev,
  1034. struct dp_peer *peer,
  1035. struct hal_tx_completion_status *ts,
  1036. qdf_nbuf_t netbuf,
  1037. uint64_t time_latency)
  1038. {
  1039. struct tx_capture_hdr *ppdu_hdr;
  1040. uint16_t peer_id = ts->peer_id;
  1041. uint32_t ppdu_id = ts->ppdu_id;
  1042. uint8_t first_msdu = ts->first_msdu;
  1043. uint8_t last_msdu = ts->last_msdu;
  1044. uint32_t txcap_hdr_size = sizeof(struct tx_capture_hdr);
  1045. if (qdf_unlikely(!pdev->tx_sniffer_enable && !pdev->mcopy_mode &&
  1046. !pdev->latency_capture_enable))
  1047. return QDF_STATUS_E_NOSUPPORT;
  1048. if (!peer) {
  1049. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  1050. FL("Peer Invalid"));
  1051. return QDF_STATUS_E_INVAL;
  1052. }
  1053. if (pdev->mcopy_mode) {
  1054. /* If mcopy is enabled and mcopy_mode is M_COPY deliver 1st MSDU
  1055. * per PPDU. If mcopy_mode is M_COPY_EXTENDED deliver 1st MSDU
  1056. * for each MPDU
  1057. */
  1058. if (pdev->mcopy_mode == M_COPY) {
  1059. if ((pdev->m_copy_id.tx_ppdu_id == ppdu_id) &&
  1060. (pdev->m_copy_id.tx_peer_id == peer_id)) {
  1061. return QDF_STATUS_E_INVAL;
  1062. }
  1063. }
  1064. if (!first_msdu)
  1065. return QDF_STATUS_E_INVAL;
  1066. pdev->m_copy_id.tx_ppdu_id = ppdu_id;
  1067. pdev->m_copy_id.tx_peer_id = peer_id;
  1068. }
  1069. if (qdf_unlikely(qdf_nbuf_headroom(netbuf) < txcap_hdr_size)) {
  1070. netbuf = qdf_nbuf_realloc_headroom(netbuf, txcap_hdr_size);
  1071. if (!netbuf) {
  1072. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  1073. FL("No headroom"));
  1074. return QDF_STATUS_E_NOMEM;
  1075. }
  1076. }
  1077. if (!qdf_nbuf_push_head(netbuf, txcap_hdr_size)) {
  1078. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  1079. FL("No headroom"));
  1080. return QDF_STATUS_E_NOMEM;
  1081. }
  1082. ppdu_hdr = (struct tx_capture_hdr *)qdf_nbuf_data(netbuf);
  1083. qdf_mem_copy(ppdu_hdr->ta, peer->vdev->mac_addr.raw,
  1084. QDF_MAC_ADDR_SIZE);
  1085. qdf_mem_copy(ppdu_hdr->ra, peer->mac_addr.raw,
  1086. QDF_MAC_ADDR_SIZE);
  1087. ppdu_hdr->ppdu_id = ppdu_id;
  1088. ppdu_hdr->peer_id = peer_id;
  1089. ppdu_hdr->first_msdu = first_msdu;
  1090. ppdu_hdr->last_msdu = last_msdu;
  1091. if (qdf_unlikely(pdev->latency_capture_enable)) {
  1092. ppdu_hdr->tsf = ts->tsf;
  1093. ppdu_hdr->time_latency = time_latency;
  1094. }
  1095. return QDF_STATUS_SUCCESS;
  1096. }
  1097. /**
  1098. * dp_send_completion_to_stack() - send completion to stack
  1099. * @soc : dp_soc handle
  1100. * @pdev: dp_pdev handle
  1101. * @peer_id: peer_id of the peer for which completion came
  1102. * @ppdu_id: ppdu_id
  1103. * @netbuf: Buffer pointer for free
  1104. *
  1105. * This function is used to send completion to stack
  1106. * to free buffer
  1107. */
  1108. void dp_send_completion_to_stack(struct dp_soc *soc, struct dp_pdev *pdev,
  1109. uint16_t peer_id, uint32_t ppdu_id,
  1110. qdf_nbuf_t netbuf)
  1111. {
  1112. dp_wdi_event_handler(WDI_EVENT_TX_DATA, soc,
  1113. netbuf, peer_id,
  1114. WDI_NO_VAL, pdev->pdev_id);
  1115. }
  1116. #endif