htt_tx.c 49 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840
  1. // SPDX-License-Identifier: ISC
  2. /*
  3. * Copyright (c) 2005-2011 Atheros Communications Inc.
  4. * Copyright (c) 2011-2017 Qualcomm Atheros, Inc.
  5. * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  6. */
  7. #include <linux/etherdevice.h>
  8. #include "htt.h"
  9. #include "mac.h"
  10. #include "hif.h"
  11. #include "txrx.h"
  12. #include "debug.h"
  13. static u8 ath10k_htt_tx_txq_calc_size(size_t count)
  14. {
  15. int exp;
  16. int factor;
  17. exp = 0;
  18. factor = count >> 7;
  19. while (factor >= 64 && exp < 4) {
  20. factor >>= 3;
  21. exp++;
  22. }
  23. if (exp == 4)
  24. return 0xff;
  25. if (count > 0)
  26. factor = max(1, factor);
  27. return SM(exp, HTT_TX_Q_STATE_ENTRY_EXP) |
  28. SM(factor, HTT_TX_Q_STATE_ENTRY_FACTOR);
  29. }
  30. static void __ath10k_htt_tx_txq_recalc(struct ieee80211_hw *hw,
  31. struct ieee80211_txq *txq)
  32. {
  33. struct ath10k *ar = hw->priv;
  34. struct ath10k_sta *arsta;
  35. struct ath10k_vif *arvif = (void *)txq->vif->drv_priv;
  36. unsigned long byte_cnt;
  37. int idx;
  38. u32 bit;
  39. u16 peer_id;
  40. u8 tid;
  41. u8 count;
  42. lockdep_assert_held(&ar->htt.tx_lock);
  43. if (!ar->htt.tx_q_state.enabled)
  44. return;
  45. if (ar->htt.tx_q_state.mode != HTT_TX_MODE_SWITCH_PUSH_PULL)
  46. return;
  47. if (txq->sta) {
  48. arsta = (void *)txq->sta->drv_priv;
  49. peer_id = arsta->peer_id;
  50. } else {
  51. peer_id = arvif->peer_id;
  52. }
  53. tid = txq->tid;
  54. bit = BIT(peer_id % 32);
  55. idx = peer_id / 32;
  56. ieee80211_txq_get_depth(txq, NULL, &byte_cnt);
  57. count = ath10k_htt_tx_txq_calc_size(byte_cnt);
  58. if (unlikely(peer_id >= ar->htt.tx_q_state.num_peers) ||
  59. unlikely(tid >= ar->htt.tx_q_state.num_tids)) {
  60. ath10k_warn(ar, "refusing to update txq for peer_id %u tid %u due to out of bounds\n",
  61. peer_id, tid);
  62. return;
  63. }
  64. ar->htt.tx_q_state.vaddr->count[tid][peer_id] = count;
  65. ar->htt.tx_q_state.vaddr->map[tid][idx] &= ~bit;
  66. ar->htt.tx_q_state.vaddr->map[tid][idx] |= count ? bit : 0;
  67. ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx txq state update peer_id %u tid %u count %u\n",
  68. peer_id, tid, count);
  69. }
  70. static void __ath10k_htt_tx_txq_sync(struct ath10k *ar)
  71. {
  72. u32 seq;
  73. size_t size;
  74. lockdep_assert_held(&ar->htt.tx_lock);
  75. if (!ar->htt.tx_q_state.enabled)
  76. return;
  77. if (ar->htt.tx_q_state.mode != HTT_TX_MODE_SWITCH_PUSH_PULL)
  78. return;
  79. seq = le32_to_cpu(ar->htt.tx_q_state.vaddr->seq);
  80. seq++;
  81. ar->htt.tx_q_state.vaddr->seq = cpu_to_le32(seq);
  82. ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx txq state update commit seq %u\n",
  83. seq);
  84. size = sizeof(*ar->htt.tx_q_state.vaddr);
  85. dma_sync_single_for_device(ar->dev,
  86. ar->htt.tx_q_state.paddr,
  87. size,
  88. DMA_TO_DEVICE);
  89. }
  90. void ath10k_htt_tx_txq_recalc(struct ieee80211_hw *hw,
  91. struct ieee80211_txq *txq)
  92. {
  93. struct ath10k *ar = hw->priv;
  94. spin_lock_bh(&ar->htt.tx_lock);
  95. __ath10k_htt_tx_txq_recalc(hw, txq);
  96. spin_unlock_bh(&ar->htt.tx_lock);
  97. }
  98. void ath10k_htt_tx_txq_sync(struct ath10k *ar)
  99. {
  100. spin_lock_bh(&ar->htt.tx_lock);
  101. __ath10k_htt_tx_txq_sync(ar);
  102. spin_unlock_bh(&ar->htt.tx_lock);
  103. }
  104. void ath10k_htt_tx_txq_update(struct ieee80211_hw *hw,
  105. struct ieee80211_txq *txq)
  106. {
  107. struct ath10k *ar = hw->priv;
  108. spin_lock_bh(&ar->htt.tx_lock);
  109. __ath10k_htt_tx_txq_recalc(hw, txq);
  110. __ath10k_htt_tx_txq_sync(ar);
  111. spin_unlock_bh(&ar->htt.tx_lock);
  112. }
  113. void ath10k_htt_tx_dec_pending(struct ath10k_htt *htt)
  114. {
  115. lockdep_assert_held(&htt->tx_lock);
  116. htt->num_pending_tx--;
  117. if (htt->num_pending_tx == htt->max_num_pending_tx - 1)
  118. ath10k_mac_tx_unlock(htt->ar, ATH10K_TX_PAUSE_Q_FULL);
  119. if (htt->num_pending_tx == 0)
  120. wake_up(&htt->empty_tx_wq);
  121. }
  122. int ath10k_htt_tx_inc_pending(struct ath10k_htt *htt)
  123. {
  124. lockdep_assert_held(&htt->tx_lock);
  125. if (htt->num_pending_tx >= htt->max_num_pending_tx)
  126. return -EBUSY;
  127. htt->num_pending_tx++;
  128. if (htt->num_pending_tx == htt->max_num_pending_tx)
  129. ath10k_mac_tx_lock(htt->ar, ATH10K_TX_PAUSE_Q_FULL);
  130. return 0;
  131. }
  132. int ath10k_htt_tx_mgmt_inc_pending(struct ath10k_htt *htt, bool is_mgmt,
  133. bool is_presp)
  134. {
  135. struct ath10k *ar = htt->ar;
  136. lockdep_assert_held(&htt->tx_lock);
  137. if (!is_mgmt || !ar->hw_params.max_probe_resp_desc_thres)
  138. return 0;
  139. if (is_presp &&
  140. ar->hw_params.max_probe_resp_desc_thres < htt->num_pending_mgmt_tx)
  141. return -EBUSY;
  142. htt->num_pending_mgmt_tx++;
  143. return 0;
  144. }
  145. void ath10k_htt_tx_mgmt_dec_pending(struct ath10k_htt *htt)
  146. {
  147. lockdep_assert_held(&htt->tx_lock);
  148. if (!htt->ar->hw_params.max_probe_resp_desc_thres)
  149. return;
  150. htt->num_pending_mgmt_tx--;
  151. }
  152. int ath10k_htt_tx_alloc_msdu_id(struct ath10k_htt *htt, struct sk_buff *skb)
  153. {
  154. struct ath10k *ar = htt->ar;
  155. int ret;
  156. spin_lock_bh(&htt->tx_lock);
  157. ret = idr_alloc(&htt->pending_tx, skb, 0,
  158. htt->max_num_pending_tx, GFP_ATOMIC);
  159. spin_unlock_bh(&htt->tx_lock);
  160. ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx alloc msdu_id %d\n", ret);
  161. return ret;
  162. }
  163. void ath10k_htt_tx_free_msdu_id(struct ath10k_htt *htt, u16 msdu_id)
  164. {
  165. struct ath10k *ar = htt->ar;
  166. lockdep_assert_held(&htt->tx_lock);
  167. ath10k_dbg(ar, ATH10K_DBG_HTT, "htt tx free msdu_id %u\n", msdu_id);
  168. idr_remove(&htt->pending_tx, msdu_id);
  169. }
  170. static void ath10k_htt_tx_free_cont_txbuf_32(struct ath10k_htt *htt)
  171. {
  172. struct ath10k *ar = htt->ar;
  173. size_t size;
  174. if (!htt->txbuf.vaddr_txbuff_32)
  175. return;
  176. size = htt->txbuf.size;
  177. dma_free_coherent(ar->dev, size, htt->txbuf.vaddr_txbuff_32,
  178. htt->txbuf.paddr);
  179. htt->txbuf.vaddr_txbuff_32 = NULL;
  180. }
  181. static int ath10k_htt_tx_alloc_cont_txbuf_32(struct ath10k_htt *htt)
  182. {
  183. struct ath10k *ar = htt->ar;
  184. size_t size;
  185. size = htt->max_num_pending_tx *
  186. sizeof(struct ath10k_htt_txbuf_32);
  187. htt->txbuf.vaddr_txbuff_32 = dma_alloc_coherent(ar->dev, size,
  188. &htt->txbuf.paddr,
  189. GFP_KERNEL);
  190. if (!htt->txbuf.vaddr_txbuff_32)
  191. return -ENOMEM;
  192. htt->txbuf.size = size;
  193. return 0;
  194. }
  195. static void ath10k_htt_tx_free_cont_txbuf_64(struct ath10k_htt *htt)
  196. {
  197. struct ath10k *ar = htt->ar;
  198. size_t size;
  199. if (!htt->txbuf.vaddr_txbuff_64)
  200. return;
  201. size = htt->txbuf.size;
  202. dma_free_coherent(ar->dev, size, htt->txbuf.vaddr_txbuff_64,
  203. htt->txbuf.paddr);
  204. htt->txbuf.vaddr_txbuff_64 = NULL;
  205. }
  206. static int ath10k_htt_tx_alloc_cont_txbuf_64(struct ath10k_htt *htt)
  207. {
  208. struct ath10k *ar = htt->ar;
  209. size_t size;
  210. size = htt->max_num_pending_tx *
  211. sizeof(struct ath10k_htt_txbuf_64);
  212. htt->txbuf.vaddr_txbuff_64 = dma_alloc_coherent(ar->dev, size,
  213. &htt->txbuf.paddr,
  214. GFP_KERNEL);
  215. if (!htt->txbuf.vaddr_txbuff_64)
  216. return -ENOMEM;
  217. htt->txbuf.size = size;
  218. return 0;
  219. }
  220. static void ath10k_htt_tx_free_cont_frag_desc_32(struct ath10k_htt *htt)
  221. {
  222. size_t size;
  223. if (!htt->frag_desc.vaddr_desc_32)
  224. return;
  225. size = htt->max_num_pending_tx *
  226. sizeof(struct htt_msdu_ext_desc);
  227. dma_free_coherent(htt->ar->dev,
  228. size,
  229. htt->frag_desc.vaddr_desc_32,
  230. htt->frag_desc.paddr);
  231. htt->frag_desc.vaddr_desc_32 = NULL;
  232. }
  233. static int ath10k_htt_tx_alloc_cont_frag_desc_32(struct ath10k_htt *htt)
  234. {
  235. struct ath10k *ar = htt->ar;
  236. size_t size;
  237. if (!ar->hw_params.continuous_frag_desc)
  238. return 0;
  239. size = htt->max_num_pending_tx *
  240. sizeof(struct htt_msdu_ext_desc);
  241. htt->frag_desc.vaddr_desc_32 = dma_alloc_coherent(ar->dev, size,
  242. &htt->frag_desc.paddr,
  243. GFP_KERNEL);
  244. if (!htt->frag_desc.vaddr_desc_32) {
  245. ath10k_err(ar, "failed to alloc fragment desc memory\n");
  246. return -ENOMEM;
  247. }
  248. htt->frag_desc.size = size;
  249. return 0;
  250. }
  251. static void ath10k_htt_tx_free_cont_frag_desc_64(struct ath10k_htt *htt)
  252. {
  253. size_t size;
  254. if (!htt->frag_desc.vaddr_desc_64)
  255. return;
  256. size = htt->max_num_pending_tx *
  257. sizeof(struct htt_msdu_ext_desc_64);
  258. dma_free_coherent(htt->ar->dev,
  259. size,
  260. htt->frag_desc.vaddr_desc_64,
  261. htt->frag_desc.paddr);
  262. htt->frag_desc.vaddr_desc_64 = NULL;
  263. }
  264. static int ath10k_htt_tx_alloc_cont_frag_desc_64(struct ath10k_htt *htt)
  265. {
  266. struct ath10k *ar = htt->ar;
  267. size_t size;
  268. if (!ar->hw_params.continuous_frag_desc)
  269. return 0;
  270. size = htt->max_num_pending_tx *
  271. sizeof(struct htt_msdu_ext_desc_64);
  272. htt->frag_desc.vaddr_desc_64 = dma_alloc_coherent(ar->dev, size,
  273. &htt->frag_desc.paddr,
  274. GFP_KERNEL);
  275. if (!htt->frag_desc.vaddr_desc_64) {
  276. ath10k_err(ar, "failed to alloc fragment desc memory\n");
  277. return -ENOMEM;
  278. }
  279. htt->frag_desc.size = size;
  280. return 0;
  281. }
  282. static void ath10k_htt_tx_free_txq(struct ath10k_htt *htt)
  283. {
  284. struct ath10k *ar = htt->ar;
  285. size_t size;
  286. if (!test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
  287. ar->running_fw->fw_file.fw_features))
  288. return;
  289. size = sizeof(*htt->tx_q_state.vaddr);
  290. dma_unmap_single(ar->dev, htt->tx_q_state.paddr, size, DMA_TO_DEVICE);
  291. kfree(htt->tx_q_state.vaddr);
  292. }
  293. static int ath10k_htt_tx_alloc_txq(struct ath10k_htt *htt)
  294. {
  295. struct ath10k *ar = htt->ar;
  296. size_t size;
  297. int ret;
  298. if (!test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
  299. ar->running_fw->fw_file.fw_features))
  300. return 0;
  301. htt->tx_q_state.num_peers = HTT_TX_Q_STATE_NUM_PEERS;
  302. htt->tx_q_state.num_tids = HTT_TX_Q_STATE_NUM_TIDS;
  303. htt->tx_q_state.type = HTT_Q_DEPTH_TYPE_BYTES;
  304. size = sizeof(*htt->tx_q_state.vaddr);
  305. htt->tx_q_state.vaddr = kzalloc(size, GFP_KERNEL);
  306. if (!htt->tx_q_state.vaddr)
  307. return -ENOMEM;
  308. htt->tx_q_state.paddr = dma_map_single(ar->dev, htt->tx_q_state.vaddr,
  309. size, DMA_TO_DEVICE);
  310. ret = dma_mapping_error(ar->dev, htt->tx_q_state.paddr);
  311. if (ret) {
  312. ath10k_warn(ar, "failed to dma map tx_q_state: %d\n", ret);
  313. kfree(htt->tx_q_state.vaddr);
  314. return -EIO;
  315. }
  316. return 0;
  317. }
  318. static void ath10k_htt_tx_free_txdone_fifo(struct ath10k_htt *htt)
  319. {
  320. WARN_ON(!kfifo_is_empty(&htt->txdone_fifo));
  321. kfifo_free(&htt->txdone_fifo);
  322. }
  323. static int ath10k_htt_tx_alloc_txdone_fifo(struct ath10k_htt *htt)
  324. {
  325. int ret;
  326. size_t size;
  327. size = roundup_pow_of_two(htt->max_num_pending_tx);
  328. ret = kfifo_alloc(&htt->txdone_fifo, size, GFP_KERNEL);
  329. return ret;
  330. }
  331. static int ath10k_htt_tx_alloc_buf(struct ath10k_htt *htt)
  332. {
  333. struct ath10k *ar = htt->ar;
  334. int ret;
  335. ret = ath10k_htt_alloc_txbuff(htt);
  336. if (ret) {
  337. ath10k_err(ar, "failed to alloc cont tx buffer: %d\n", ret);
  338. return ret;
  339. }
  340. ret = ath10k_htt_alloc_frag_desc(htt);
  341. if (ret) {
  342. ath10k_err(ar, "failed to alloc cont frag desc: %d\n", ret);
  343. goto free_txbuf;
  344. }
  345. ret = ath10k_htt_tx_alloc_txq(htt);
  346. if (ret) {
  347. ath10k_err(ar, "failed to alloc txq: %d\n", ret);
  348. goto free_frag_desc;
  349. }
  350. ret = ath10k_htt_tx_alloc_txdone_fifo(htt);
  351. if (ret) {
  352. ath10k_err(ar, "failed to alloc txdone fifo: %d\n", ret);
  353. goto free_txq;
  354. }
  355. return 0;
  356. free_txq:
  357. ath10k_htt_tx_free_txq(htt);
  358. free_frag_desc:
  359. ath10k_htt_free_frag_desc(htt);
  360. free_txbuf:
  361. ath10k_htt_free_txbuff(htt);
  362. return ret;
  363. }
  364. int ath10k_htt_tx_start(struct ath10k_htt *htt)
  365. {
  366. struct ath10k *ar = htt->ar;
  367. int ret;
  368. ath10k_dbg(ar, ATH10K_DBG_BOOT, "htt tx max num pending tx %d\n",
  369. htt->max_num_pending_tx);
  370. spin_lock_init(&htt->tx_lock);
  371. idr_init(&htt->pending_tx);
  372. if (htt->tx_mem_allocated)
  373. return 0;
  374. if (ar->bus_param.dev_type == ATH10K_DEV_TYPE_HL)
  375. return 0;
  376. ret = ath10k_htt_tx_alloc_buf(htt);
  377. if (ret)
  378. goto free_idr_pending_tx;
  379. htt->tx_mem_allocated = true;
  380. return 0;
  381. free_idr_pending_tx:
  382. idr_destroy(&htt->pending_tx);
  383. return ret;
  384. }
  385. static int ath10k_htt_tx_clean_up_pending(int msdu_id, void *skb, void *ctx)
  386. {
  387. struct ath10k *ar = ctx;
  388. struct ath10k_htt *htt = &ar->htt;
  389. struct htt_tx_done tx_done = {0};
  390. ath10k_dbg(ar, ATH10K_DBG_HTT, "force cleanup msdu_id %u\n", msdu_id);
  391. tx_done.msdu_id = msdu_id;
  392. tx_done.status = HTT_TX_COMPL_STATE_DISCARD;
  393. ath10k_txrx_tx_unref(htt, &tx_done);
  394. return 0;
  395. }
  396. void ath10k_htt_tx_destroy(struct ath10k_htt *htt)
  397. {
  398. if (!htt->tx_mem_allocated)
  399. return;
  400. ath10k_htt_free_txbuff(htt);
  401. ath10k_htt_tx_free_txq(htt);
  402. ath10k_htt_free_frag_desc(htt);
  403. ath10k_htt_tx_free_txdone_fifo(htt);
  404. htt->tx_mem_allocated = false;
  405. }
  406. static void ath10k_htt_flush_tx_queue(struct ath10k_htt *htt)
  407. {
  408. ath10k_htc_stop_hl(htt->ar);
  409. idr_for_each(&htt->pending_tx, ath10k_htt_tx_clean_up_pending, htt->ar);
  410. }
  411. void ath10k_htt_tx_stop(struct ath10k_htt *htt)
  412. {
  413. ath10k_htt_flush_tx_queue(htt);
  414. idr_destroy(&htt->pending_tx);
  415. }
  416. void ath10k_htt_tx_free(struct ath10k_htt *htt)
  417. {
  418. ath10k_htt_tx_stop(htt);
  419. ath10k_htt_tx_destroy(htt);
  420. }
  421. void ath10k_htt_op_ep_tx_credits(struct ath10k *ar)
  422. {
  423. queue_work(ar->workqueue, &ar->bundle_tx_work);
  424. }
  425. void ath10k_htt_htc_tx_complete(struct ath10k *ar, struct sk_buff *skb)
  426. {
  427. struct ath10k_htt *htt = &ar->htt;
  428. struct htt_tx_done tx_done = {0};
  429. struct htt_cmd_hdr *htt_hdr;
  430. struct htt_data_tx_desc *desc_hdr = NULL;
  431. u16 flags1 = 0;
  432. u8 msg_type = 0;
  433. if (htt->disable_tx_comp) {
  434. htt_hdr = (struct htt_cmd_hdr *)skb->data;
  435. msg_type = htt_hdr->msg_type;
  436. if (msg_type == HTT_H2T_MSG_TYPE_TX_FRM) {
  437. desc_hdr = (struct htt_data_tx_desc *)
  438. (skb->data + sizeof(*htt_hdr));
  439. flags1 = __le16_to_cpu(desc_hdr->flags1);
  440. skb_pull(skb, sizeof(struct htt_cmd_hdr));
  441. skb_pull(skb, sizeof(struct htt_data_tx_desc));
  442. }
  443. }
  444. dev_kfree_skb_any(skb);
  445. if ((!htt->disable_tx_comp) || (msg_type != HTT_H2T_MSG_TYPE_TX_FRM))
  446. return;
  447. ath10k_dbg(ar, ATH10K_DBG_HTT,
  448. "htt tx complete msdu id:%u ,flags1:%x\n",
  449. __le16_to_cpu(desc_hdr->id), flags1);
  450. if (flags1 & HTT_DATA_TX_DESC_FLAGS1_TX_COMPLETE)
  451. return;
  452. tx_done.status = HTT_TX_COMPL_STATE_ACK;
  453. tx_done.msdu_id = __le16_to_cpu(desc_hdr->id);
  454. ath10k_txrx_tx_unref(&ar->htt, &tx_done);
  455. }
  456. void ath10k_htt_hif_tx_complete(struct ath10k *ar, struct sk_buff *skb)
  457. {
  458. dev_kfree_skb_any(skb);
  459. }
  460. EXPORT_SYMBOL(ath10k_htt_hif_tx_complete);
  461. int ath10k_htt_h2t_ver_req_msg(struct ath10k_htt *htt)
  462. {
  463. struct ath10k *ar = htt->ar;
  464. struct sk_buff *skb;
  465. struct htt_cmd *cmd;
  466. int len = 0;
  467. int ret;
  468. len += sizeof(cmd->hdr);
  469. len += sizeof(cmd->ver_req);
  470. skb = ath10k_htc_alloc_skb(ar, len);
  471. if (!skb)
  472. return -ENOMEM;
  473. skb_put(skb, len);
  474. cmd = (struct htt_cmd *)skb->data;
  475. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_VERSION_REQ;
  476. ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
  477. if (ret) {
  478. dev_kfree_skb_any(skb);
  479. return ret;
  480. }
  481. return 0;
  482. }
  483. int ath10k_htt_h2t_stats_req(struct ath10k_htt *htt, u32 mask, u32 reset_mask,
  484. u64 cookie)
  485. {
  486. struct ath10k *ar = htt->ar;
  487. struct htt_stats_req *req;
  488. struct sk_buff *skb;
  489. struct htt_cmd *cmd;
  490. int len = 0, ret;
  491. len += sizeof(cmd->hdr);
  492. len += sizeof(cmd->stats_req);
  493. skb = ath10k_htc_alloc_skb(ar, len);
  494. if (!skb)
  495. return -ENOMEM;
  496. skb_put(skb, len);
  497. cmd = (struct htt_cmd *)skb->data;
  498. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_STATS_REQ;
  499. req = &cmd->stats_req;
  500. memset(req, 0, sizeof(*req));
  501. /* currently we support only max 24 bit masks so no need to worry
  502. * about endian support
  503. */
  504. memcpy(req->upload_types, &mask, 3);
  505. memcpy(req->reset_types, &reset_mask, 3);
  506. req->stat_type = HTT_STATS_REQ_CFG_STAT_TYPE_INVALID;
  507. req->cookie_lsb = cpu_to_le32(cookie & 0xffffffff);
  508. req->cookie_msb = cpu_to_le32((cookie & 0xffffffff00000000ULL) >> 32);
  509. ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
  510. if (ret) {
  511. ath10k_warn(ar, "failed to send htt type stats request: %d",
  512. ret);
  513. dev_kfree_skb_any(skb);
  514. return ret;
  515. }
  516. return 0;
  517. }
  518. static int ath10k_htt_send_frag_desc_bank_cfg_32(struct ath10k_htt *htt)
  519. {
  520. struct ath10k *ar = htt->ar;
  521. struct sk_buff *skb;
  522. struct htt_cmd *cmd;
  523. struct htt_frag_desc_bank_cfg32 *cfg;
  524. int ret, size;
  525. u8 info;
  526. if (!ar->hw_params.continuous_frag_desc)
  527. return 0;
  528. if (!htt->frag_desc.paddr) {
  529. ath10k_warn(ar, "invalid frag desc memory\n");
  530. return -EINVAL;
  531. }
  532. size = sizeof(cmd->hdr) + sizeof(cmd->frag_desc_bank_cfg32);
  533. skb = ath10k_htc_alloc_skb(ar, size);
  534. if (!skb)
  535. return -ENOMEM;
  536. skb_put(skb, size);
  537. cmd = (struct htt_cmd *)skb->data;
  538. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_FRAG_DESC_BANK_CFG;
  539. info = 0;
  540. info |= SM(htt->tx_q_state.type,
  541. HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_DEPTH_TYPE);
  542. if (test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
  543. ar->running_fw->fw_file.fw_features))
  544. info |= HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_VALID;
  545. cfg = &cmd->frag_desc_bank_cfg32;
  546. cfg->info = info;
  547. cfg->num_banks = 1;
  548. cfg->desc_size = sizeof(struct htt_msdu_ext_desc);
  549. cfg->bank_base_addrs[0] = __cpu_to_le32(htt->frag_desc.paddr);
  550. cfg->bank_id[0].bank_min_id = 0;
  551. cfg->bank_id[0].bank_max_id = __cpu_to_le16(htt->max_num_pending_tx -
  552. 1);
  553. cfg->q_state.paddr = cpu_to_le32(htt->tx_q_state.paddr);
  554. cfg->q_state.num_peers = cpu_to_le16(htt->tx_q_state.num_peers);
  555. cfg->q_state.num_tids = cpu_to_le16(htt->tx_q_state.num_tids);
  556. cfg->q_state.record_size = HTT_TX_Q_STATE_ENTRY_SIZE;
  557. cfg->q_state.record_multiplier = HTT_TX_Q_STATE_ENTRY_MULTIPLIER;
  558. ath10k_dbg(ar, ATH10K_DBG_HTT, "htt frag desc bank cmd\n");
  559. ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
  560. if (ret) {
  561. ath10k_warn(ar, "failed to send frag desc bank cfg request: %d\n",
  562. ret);
  563. dev_kfree_skb_any(skb);
  564. return ret;
  565. }
  566. return 0;
  567. }
  568. static int ath10k_htt_send_frag_desc_bank_cfg_64(struct ath10k_htt *htt)
  569. {
  570. struct ath10k *ar = htt->ar;
  571. struct sk_buff *skb;
  572. struct htt_cmd *cmd;
  573. struct htt_frag_desc_bank_cfg64 *cfg;
  574. int ret, size;
  575. u8 info;
  576. if (!ar->hw_params.continuous_frag_desc)
  577. return 0;
  578. if (!htt->frag_desc.paddr) {
  579. ath10k_warn(ar, "invalid frag desc memory\n");
  580. return -EINVAL;
  581. }
  582. size = sizeof(cmd->hdr) + sizeof(cmd->frag_desc_bank_cfg64);
  583. skb = ath10k_htc_alloc_skb(ar, size);
  584. if (!skb)
  585. return -ENOMEM;
  586. skb_put(skb, size);
  587. cmd = (struct htt_cmd *)skb->data;
  588. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_FRAG_DESC_BANK_CFG;
  589. info = 0;
  590. info |= SM(htt->tx_q_state.type,
  591. HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_DEPTH_TYPE);
  592. if (test_bit(ATH10K_FW_FEATURE_PEER_FLOW_CONTROL,
  593. ar->running_fw->fw_file.fw_features))
  594. info |= HTT_FRAG_DESC_BANK_CFG_INFO_Q_STATE_VALID;
  595. cfg = &cmd->frag_desc_bank_cfg64;
  596. cfg->info = info;
  597. cfg->num_banks = 1;
  598. cfg->desc_size = sizeof(struct htt_msdu_ext_desc_64);
  599. cfg->bank_base_addrs[0] = __cpu_to_le64(htt->frag_desc.paddr);
  600. cfg->bank_id[0].bank_min_id = 0;
  601. cfg->bank_id[0].bank_max_id = __cpu_to_le16(htt->max_num_pending_tx -
  602. 1);
  603. cfg->q_state.paddr = cpu_to_le32(htt->tx_q_state.paddr);
  604. cfg->q_state.num_peers = cpu_to_le16(htt->tx_q_state.num_peers);
  605. cfg->q_state.num_tids = cpu_to_le16(htt->tx_q_state.num_tids);
  606. cfg->q_state.record_size = HTT_TX_Q_STATE_ENTRY_SIZE;
  607. cfg->q_state.record_multiplier = HTT_TX_Q_STATE_ENTRY_MULTIPLIER;
  608. ath10k_dbg(ar, ATH10K_DBG_HTT, "htt frag desc bank cmd\n");
  609. ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
  610. if (ret) {
  611. ath10k_warn(ar, "failed to send frag desc bank cfg request: %d\n",
  612. ret);
  613. dev_kfree_skb_any(skb);
  614. return ret;
  615. }
  616. return 0;
  617. }
  618. static void ath10k_htt_fill_rx_desc_offset_32(struct ath10k_hw_params *hw,
  619. struct htt_rx_ring_setup_ring32 *rx_ring)
  620. {
  621. ath10k_htt_rx_desc_get_offsets(hw, &rx_ring->offsets);
  622. }
  623. static void ath10k_htt_fill_rx_desc_offset_64(struct ath10k_hw_params *hw,
  624. struct htt_rx_ring_setup_ring64 *rx_ring)
  625. {
  626. ath10k_htt_rx_desc_get_offsets(hw, &rx_ring->offsets);
  627. }
  628. static int ath10k_htt_send_rx_ring_cfg_32(struct ath10k_htt *htt)
  629. {
  630. struct ath10k *ar = htt->ar;
  631. struct ath10k_hw_params *hw = &ar->hw_params;
  632. struct sk_buff *skb;
  633. struct htt_cmd *cmd;
  634. struct htt_rx_ring_setup_ring32 *ring;
  635. const int num_rx_ring = 1;
  636. u16 flags;
  637. u32 fw_idx;
  638. int len;
  639. int ret;
  640. /*
  641. * the HW expects the buffer to be an integral number of 4-byte
  642. * "words"
  643. */
  644. BUILD_BUG_ON(!IS_ALIGNED(HTT_RX_BUF_SIZE, 4));
  645. BUILD_BUG_ON((HTT_RX_BUF_SIZE & HTT_MAX_CACHE_LINE_SIZE_MASK) != 0);
  646. len = sizeof(cmd->hdr) + sizeof(cmd->rx_setup_32.hdr)
  647. + (sizeof(*ring) * num_rx_ring);
  648. skb = ath10k_htc_alloc_skb(ar, len);
  649. if (!skb)
  650. return -ENOMEM;
  651. skb_put(skb, len);
  652. cmd = (struct htt_cmd *)skb->data;
  653. ring = &cmd->rx_setup_32.rings[0];
  654. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_RX_RING_CFG;
  655. cmd->rx_setup_32.hdr.num_rings = 1;
  656. /* FIXME: do we need all of this? */
  657. flags = 0;
  658. flags |= HTT_RX_RING_FLAGS_MAC80211_HDR;
  659. flags |= HTT_RX_RING_FLAGS_MSDU_PAYLOAD;
  660. flags |= HTT_RX_RING_FLAGS_PPDU_START;
  661. flags |= HTT_RX_RING_FLAGS_PPDU_END;
  662. flags |= HTT_RX_RING_FLAGS_MPDU_START;
  663. flags |= HTT_RX_RING_FLAGS_MPDU_END;
  664. flags |= HTT_RX_RING_FLAGS_MSDU_START;
  665. flags |= HTT_RX_RING_FLAGS_MSDU_END;
  666. flags |= HTT_RX_RING_FLAGS_RX_ATTENTION;
  667. flags |= HTT_RX_RING_FLAGS_FRAG_INFO;
  668. flags |= HTT_RX_RING_FLAGS_UNICAST_RX;
  669. flags |= HTT_RX_RING_FLAGS_MULTICAST_RX;
  670. flags |= HTT_RX_RING_FLAGS_CTRL_RX;
  671. flags |= HTT_RX_RING_FLAGS_MGMT_RX;
  672. flags |= HTT_RX_RING_FLAGS_NULL_RX;
  673. flags |= HTT_RX_RING_FLAGS_PHY_DATA_RX;
  674. fw_idx = __le32_to_cpu(*htt->rx_ring.alloc_idx.vaddr);
  675. ring->fw_idx_shadow_reg_paddr =
  676. __cpu_to_le32(htt->rx_ring.alloc_idx.paddr);
  677. ring->rx_ring_base_paddr = __cpu_to_le32(htt->rx_ring.base_paddr);
  678. ring->rx_ring_len = __cpu_to_le16(htt->rx_ring.size);
  679. ring->rx_ring_bufsize = __cpu_to_le16(HTT_RX_BUF_SIZE);
  680. ring->flags = __cpu_to_le16(flags);
  681. ring->fw_idx_init_val = __cpu_to_le16(fw_idx);
  682. ath10k_htt_fill_rx_desc_offset_32(hw, ring);
  683. ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
  684. if (ret) {
  685. dev_kfree_skb_any(skb);
  686. return ret;
  687. }
  688. return 0;
  689. }
  690. static int ath10k_htt_send_rx_ring_cfg_64(struct ath10k_htt *htt)
  691. {
  692. struct ath10k *ar = htt->ar;
  693. struct ath10k_hw_params *hw = &ar->hw_params;
  694. struct sk_buff *skb;
  695. struct htt_cmd *cmd;
  696. struct htt_rx_ring_setup_ring64 *ring;
  697. const int num_rx_ring = 1;
  698. u16 flags;
  699. u32 fw_idx;
  700. int len;
  701. int ret;
  702. /* HW expects the buffer to be an integral number of 4-byte
  703. * "words"
  704. */
  705. BUILD_BUG_ON(!IS_ALIGNED(HTT_RX_BUF_SIZE, 4));
  706. BUILD_BUG_ON((HTT_RX_BUF_SIZE & HTT_MAX_CACHE_LINE_SIZE_MASK) != 0);
  707. len = sizeof(cmd->hdr) + sizeof(cmd->rx_setup_64.hdr)
  708. + (sizeof(*ring) * num_rx_ring);
  709. skb = ath10k_htc_alloc_skb(ar, len);
  710. if (!skb)
  711. return -ENOMEM;
  712. skb_put(skb, len);
  713. cmd = (struct htt_cmd *)skb->data;
  714. ring = &cmd->rx_setup_64.rings[0];
  715. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_RX_RING_CFG;
  716. cmd->rx_setup_64.hdr.num_rings = 1;
  717. flags = 0;
  718. flags |= HTT_RX_RING_FLAGS_MAC80211_HDR;
  719. flags |= HTT_RX_RING_FLAGS_MSDU_PAYLOAD;
  720. flags |= HTT_RX_RING_FLAGS_PPDU_START;
  721. flags |= HTT_RX_RING_FLAGS_PPDU_END;
  722. flags |= HTT_RX_RING_FLAGS_MPDU_START;
  723. flags |= HTT_RX_RING_FLAGS_MPDU_END;
  724. flags |= HTT_RX_RING_FLAGS_MSDU_START;
  725. flags |= HTT_RX_RING_FLAGS_MSDU_END;
  726. flags |= HTT_RX_RING_FLAGS_RX_ATTENTION;
  727. flags |= HTT_RX_RING_FLAGS_FRAG_INFO;
  728. flags |= HTT_RX_RING_FLAGS_UNICAST_RX;
  729. flags |= HTT_RX_RING_FLAGS_MULTICAST_RX;
  730. flags |= HTT_RX_RING_FLAGS_CTRL_RX;
  731. flags |= HTT_RX_RING_FLAGS_MGMT_RX;
  732. flags |= HTT_RX_RING_FLAGS_NULL_RX;
  733. flags |= HTT_RX_RING_FLAGS_PHY_DATA_RX;
  734. fw_idx = __le32_to_cpu(*htt->rx_ring.alloc_idx.vaddr);
  735. ring->fw_idx_shadow_reg_paddr = __cpu_to_le64(htt->rx_ring.alloc_idx.paddr);
  736. ring->rx_ring_base_paddr = __cpu_to_le64(htt->rx_ring.base_paddr);
  737. ring->rx_ring_len = __cpu_to_le16(htt->rx_ring.size);
  738. ring->rx_ring_bufsize = __cpu_to_le16(HTT_RX_BUF_SIZE);
  739. ring->flags = __cpu_to_le16(flags);
  740. ring->fw_idx_init_val = __cpu_to_le16(fw_idx);
  741. ath10k_htt_fill_rx_desc_offset_64(hw, ring);
  742. ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
  743. if (ret) {
  744. dev_kfree_skb_any(skb);
  745. return ret;
  746. }
  747. return 0;
  748. }
  749. static int ath10k_htt_send_rx_ring_cfg_hl(struct ath10k_htt *htt)
  750. {
  751. struct ath10k *ar = htt->ar;
  752. struct sk_buff *skb;
  753. struct htt_cmd *cmd;
  754. struct htt_rx_ring_setup_ring32 *ring;
  755. const int num_rx_ring = 1;
  756. u16 flags;
  757. int len;
  758. int ret;
  759. /*
  760. * the HW expects the buffer to be an integral number of 4-byte
  761. * "words"
  762. */
  763. BUILD_BUG_ON(!IS_ALIGNED(HTT_RX_BUF_SIZE, 4));
  764. BUILD_BUG_ON((HTT_RX_BUF_SIZE & HTT_MAX_CACHE_LINE_SIZE_MASK) != 0);
  765. len = sizeof(cmd->hdr) + sizeof(cmd->rx_setup_32.hdr)
  766. + (sizeof(*ring) * num_rx_ring);
  767. skb = ath10k_htc_alloc_skb(ar, len);
  768. if (!skb)
  769. return -ENOMEM;
  770. skb_put(skb, len);
  771. cmd = (struct htt_cmd *)skb->data;
  772. ring = &cmd->rx_setup_32.rings[0];
  773. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_RX_RING_CFG;
  774. cmd->rx_setup_32.hdr.num_rings = 1;
  775. flags = 0;
  776. flags |= HTT_RX_RING_FLAGS_MSDU_PAYLOAD;
  777. flags |= HTT_RX_RING_FLAGS_UNICAST_RX;
  778. flags |= HTT_RX_RING_FLAGS_MULTICAST_RX;
  779. memset(ring, 0, sizeof(*ring));
  780. ring->rx_ring_len = __cpu_to_le16(HTT_RX_RING_SIZE_MIN);
  781. ring->rx_ring_bufsize = __cpu_to_le16(HTT_RX_BUF_SIZE);
  782. ring->flags = __cpu_to_le16(flags);
  783. ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
  784. if (ret) {
  785. dev_kfree_skb_any(skb);
  786. return ret;
  787. }
  788. return 0;
  789. }
  790. static int ath10k_htt_h2t_aggr_cfg_msg_32(struct ath10k_htt *htt,
  791. u8 max_subfrms_ampdu,
  792. u8 max_subfrms_amsdu)
  793. {
  794. struct ath10k *ar = htt->ar;
  795. struct htt_aggr_conf *aggr_conf;
  796. struct sk_buff *skb;
  797. struct htt_cmd *cmd;
  798. int len;
  799. int ret;
  800. /* Firmware defaults are: amsdu = 3 and ampdu = 64 */
  801. if (max_subfrms_ampdu == 0 || max_subfrms_ampdu > 64)
  802. return -EINVAL;
  803. if (max_subfrms_amsdu == 0 || max_subfrms_amsdu > 31)
  804. return -EINVAL;
  805. len = sizeof(cmd->hdr);
  806. len += sizeof(cmd->aggr_conf);
  807. skb = ath10k_htc_alloc_skb(ar, len);
  808. if (!skb)
  809. return -ENOMEM;
  810. skb_put(skb, len);
  811. cmd = (struct htt_cmd *)skb->data;
  812. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_AGGR_CFG;
  813. aggr_conf = &cmd->aggr_conf;
  814. aggr_conf->max_num_ampdu_subframes = max_subfrms_ampdu;
  815. aggr_conf->max_num_amsdu_subframes = max_subfrms_amsdu;
  816. ath10k_dbg(ar, ATH10K_DBG_HTT, "htt h2t aggr cfg msg amsdu %d ampdu %d",
  817. aggr_conf->max_num_amsdu_subframes,
  818. aggr_conf->max_num_ampdu_subframes);
  819. ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
  820. if (ret) {
  821. dev_kfree_skb_any(skb);
  822. return ret;
  823. }
  824. return 0;
  825. }
  826. static int ath10k_htt_h2t_aggr_cfg_msg_v2(struct ath10k_htt *htt,
  827. u8 max_subfrms_ampdu,
  828. u8 max_subfrms_amsdu)
  829. {
  830. struct ath10k *ar = htt->ar;
  831. struct htt_aggr_conf_v2 *aggr_conf;
  832. struct sk_buff *skb;
  833. struct htt_cmd *cmd;
  834. int len;
  835. int ret;
  836. /* Firmware defaults are: amsdu = 3 and ampdu = 64 */
  837. if (max_subfrms_ampdu == 0 || max_subfrms_ampdu > 64)
  838. return -EINVAL;
  839. if (max_subfrms_amsdu == 0 || max_subfrms_amsdu > 31)
  840. return -EINVAL;
  841. len = sizeof(cmd->hdr);
  842. len += sizeof(cmd->aggr_conf_v2);
  843. skb = ath10k_htc_alloc_skb(ar, len);
  844. if (!skb)
  845. return -ENOMEM;
  846. skb_put(skb, len);
  847. cmd = (struct htt_cmd *)skb->data;
  848. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_AGGR_CFG;
  849. aggr_conf = &cmd->aggr_conf_v2;
  850. aggr_conf->max_num_ampdu_subframes = max_subfrms_ampdu;
  851. aggr_conf->max_num_amsdu_subframes = max_subfrms_amsdu;
  852. ath10k_dbg(ar, ATH10K_DBG_HTT, "htt h2t aggr cfg msg amsdu %d ampdu %d",
  853. aggr_conf->max_num_amsdu_subframes,
  854. aggr_conf->max_num_ampdu_subframes);
  855. ret = ath10k_htc_send(&htt->ar->htc, htt->eid, skb);
  856. if (ret) {
  857. dev_kfree_skb_any(skb);
  858. return ret;
  859. }
  860. return 0;
  861. }
  862. int ath10k_htt_tx_fetch_resp(struct ath10k *ar,
  863. __le32 token,
  864. __le16 fetch_seq_num,
  865. struct htt_tx_fetch_record *records,
  866. size_t num_records)
  867. {
  868. struct sk_buff *skb;
  869. struct htt_cmd *cmd;
  870. const u16 resp_id = 0;
  871. int len = 0;
  872. int ret;
  873. /* Response IDs are echo-ed back only for host driver convenience
  874. * purposes. They aren't used for anything in the driver yet so use 0.
  875. */
  876. len += sizeof(cmd->hdr);
  877. len += sizeof(cmd->tx_fetch_resp);
  878. len += sizeof(cmd->tx_fetch_resp.records[0]) * num_records;
  879. skb = ath10k_htc_alloc_skb(ar, len);
  880. if (!skb)
  881. return -ENOMEM;
  882. skb_put(skb, len);
  883. cmd = (struct htt_cmd *)skb->data;
  884. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_TX_FETCH_RESP;
  885. cmd->tx_fetch_resp.resp_id = cpu_to_le16(resp_id);
  886. cmd->tx_fetch_resp.fetch_seq_num = fetch_seq_num;
  887. cmd->tx_fetch_resp.num_records = cpu_to_le16(num_records);
  888. cmd->tx_fetch_resp.token = token;
  889. memcpy(cmd->tx_fetch_resp.records, records,
  890. sizeof(records[0]) * num_records);
  891. ret = ath10k_htc_send(&ar->htc, ar->htt.eid, skb);
  892. if (ret) {
  893. ath10k_warn(ar, "failed to submit htc command: %d\n", ret);
  894. goto err_free_skb;
  895. }
  896. return 0;
  897. err_free_skb:
  898. dev_kfree_skb_any(skb);
  899. return ret;
  900. }
  901. static u8 ath10k_htt_tx_get_vdev_id(struct ath10k *ar, struct sk_buff *skb)
  902. {
  903. struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
  904. struct ath10k_skb_cb *cb = ATH10K_SKB_CB(skb);
  905. struct ath10k_vif *arvif;
  906. if (info->flags & IEEE80211_TX_CTL_TX_OFFCHAN) {
  907. return ar->scan.vdev_id;
  908. } else if (cb->vif) {
  909. arvif = (void *)cb->vif->drv_priv;
  910. return arvif->vdev_id;
  911. } else if (ar->monitor_started) {
  912. return ar->monitor_vdev_id;
  913. } else {
  914. return 0;
  915. }
  916. }
  917. static u8 ath10k_htt_tx_get_tid(struct sk_buff *skb, bool is_eth)
  918. {
  919. struct ieee80211_hdr *hdr = (void *)skb->data;
  920. struct ath10k_skb_cb *cb = ATH10K_SKB_CB(skb);
  921. if (!is_eth && ieee80211_is_mgmt(hdr->frame_control))
  922. return HTT_DATA_TX_EXT_TID_MGMT;
  923. else if (cb->flags & ATH10K_SKB_F_QOS)
  924. return skb->priority & IEEE80211_QOS_CTL_TID_MASK;
  925. else
  926. return HTT_DATA_TX_EXT_TID_NON_QOS_MCAST_BCAST;
  927. }
  928. int ath10k_htt_mgmt_tx(struct ath10k_htt *htt, struct sk_buff *msdu)
  929. {
  930. struct ath10k *ar = htt->ar;
  931. struct device *dev = ar->dev;
  932. struct sk_buff *txdesc = NULL;
  933. struct htt_cmd *cmd;
  934. struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
  935. u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
  936. int len = 0;
  937. int msdu_id = -1;
  938. int res;
  939. const u8 *peer_addr;
  940. struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
  941. len += sizeof(cmd->hdr);
  942. len += sizeof(cmd->mgmt_tx);
  943. res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
  944. if (res < 0)
  945. goto err;
  946. msdu_id = res;
  947. if ((ieee80211_is_action(hdr->frame_control) ||
  948. ieee80211_is_deauth(hdr->frame_control) ||
  949. ieee80211_is_disassoc(hdr->frame_control)) &&
  950. ieee80211_has_protected(hdr->frame_control)) {
  951. peer_addr = hdr->addr1;
  952. if (is_multicast_ether_addr(peer_addr)) {
  953. skb_put(msdu, sizeof(struct ieee80211_mmie_16));
  954. } else {
  955. if (skb_cb->ucast_cipher == WLAN_CIPHER_SUITE_GCMP ||
  956. skb_cb->ucast_cipher == WLAN_CIPHER_SUITE_GCMP_256)
  957. skb_put(msdu, IEEE80211_GCMP_MIC_LEN);
  958. else
  959. skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
  960. }
  961. }
  962. txdesc = ath10k_htc_alloc_skb(ar, len);
  963. if (!txdesc) {
  964. res = -ENOMEM;
  965. goto err_free_msdu_id;
  966. }
  967. skb_cb->paddr = dma_map_single(dev, msdu->data, msdu->len,
  968. DMA_TO_DEVICE);
  969. res = dma_mapping_error(dev, skb_cb->paddr);
  970. if (res) {
  971. res = -EIO;
  972. goto err_free_txdesc;
  973. }
  974. skb_put(txdesc, len);
  975. cmd = (struct htt_cmd *)txdesc->data;
  976. memset(cmd, 0, len);
  977. cmd->hdr.msg_type = HTT_H2T_MSG_TYPE_MGMT_TX;
  978. cmd->mgmt_tx.msdu_paddr = __cpu_to_le32(ATH10K_SKB_CB(msdu)->paddr);
  979. cmd->mgmt_tx.len = __cpu_to_le32(msdu->len);
  980. cmd->mgmt_tx.desc_id = __cpu_to_le32(msdu_id);
  981. cmd->mgmt_tx.vdev_id = __cpu_to_le32(vdev_id);
  982. memcpy(cmd->mgmt_tx.hdr, msdu->data,
  983. min_t(int, msdu->len, HTT_MGMT_FRM_HDR_DOWNLOAD_LEN));
  984. res = ath10k_htc_send(&htt->ar->htc, htt->eid, txdesc);
  985. if (res)
  986. goto err_unmap_msdu;
  987. return 0;
  988. err_unmap_msdu:
  989. if (ar->bus_param.dev_type != ATH10K_DEV_TYPE_HL)
  990. dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
  991. err_free_txdesc:
  992. dev_kfree_skb_any(txdesc);
  993. err_free_msdu_id:
  994. spin_lock_bh(&htt->tx_lock);
  995. ath10k_htt_tx_free_msdu_id(htt, msdu_id);
  996. spin_unlock_bh(&htt->tx_lock);
  997. err:
  998. return res;
  999. }
  1000. #define HTT_TX_HL_NEEDED_HEADROOM \
  1001. (unsigned int)(sizeof(struct htt_cmd_hdr) + \
  1002. sizeof(struct htt_data_tx_desc) + \
  1003. sizeof(struct ath10k_htc_hdr))
  1004. static int ath10k_htt_tx_hl(struct ath10k_htt *htt, enum ath10k_hw_txrx_mode txmode,
  1005. struct sk_buff *msdu)
  1006. {
  1007. struct ath10k *ar = htt->ar;
  1008. int res, data_len;
  1009. struct htt_cmd_hdr *cmd_hdr;
  1010. struct htt_data_tx_desc *tx_desc;
  1011. struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
  1012. struct sk_buff *tmp_skb;
  1013. bool is_eth = (txmode == ATH10K_HW_TXRX_ETHERNET);
  1014. u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
  1015. u8 tid = ath10k_htt_tx_get_tid(msdu, is_eth);
  1016. u8 flags0 = 0;
  1017. u16 flags1 = 0;
  1018. u16 msdu_id = 0;
  1019. if (!is_eth) {
  1020. struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
  1021. if ((ieee80211_is_action(hdr->frame_control) ||
  1022. ieee80211_is_deauth(hdr->frame_control) ||
  1023. ieee80211_is_disassoc(hdr->frame_control)) &&
  1024. ieee80211_has_protected(hdr->frame_control)) {
  1025. skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
  1026. }
  1027. }
  1028. data_len = msdu->len;
  1029. switch (txmode) {
  1030. case ATH10K_HW_TXRX_RAW:
  1031. case ATH10K_HW_TXRX_NATIVE_WIFI:
  1032. flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
  1033. fallthrough;
  1034. case ATH10K_HW_TXRX_ETHERNET:
  1035. flags0 |= SM(txmode, HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
  1036. break;
  1037. case ATH10K_HW_TXRX_MGMT:
  1038. flags0 |= SM(ATH10K_HW_TXRX_MGMT,
  1039. HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
  1040. flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
  1041. if (htt->disable_tx_comp)
  1042. flags1 |= HTT_DATA_TX_DESC_FLAGS1_TX_COMPLETE;
  1043. break;
  1044. }
  1045. if (skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT)
  1046. flags0 |= HTT_DATA_TX_DESC_FLAGS0_NO_ENCRYPT;
  1047. flags1 |= SM((u16)vdev_id, HTT_DATA_TX_DESC_FLAGS1_VDEV_ID);
  1048. flags1 |= SM((u16)tid, HTT_DATA_TX_DESC_FLAGS1_EXT_TID);
  1049. if (msdu->ip_summed == CHECKSUM_PARTIAL &&
  1050. !test_bit(ATH10K_FLAG_RAW_MODE, &ar->dev_flags)) {
  1051. flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L3_OFFLOAD;
  1052. flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L4_OFFLOAD;
  1053. }
  1054. /* Prepend the HTT header and TX desc struct to the data message
  1055. * and realloc the skb if it does not have enough headroom.
  1056. */
  1057. if (skb_headroom(msdu) < HTT_TX_HL_NEEDED_HEADROOM) {
  1058. tmp_skb = msdu;
  1059. ath10k_dbg(htt->ar, ATH10K_DBG_HTT,
  1060. "Not enough headroom in skb. Current headroom: %u, needed: %u. Reallocating...\n",
  1061. skb_headroom(msdu), HTT_TX_HL_NEEDED_HEADROOM);
  1062. msdu = skb_realloc_headroom(msdu, HTT_TX_HL_NEEDED_HEADROOM);
  1063. kfree_skb(tmp_skb);
  1064. if (!msdu) {
  1065. ath10k_warn(htt->ar, "htt hl tx: Unable to realloc skb!\n");
  1066. res = -ENOMEM;
  1067. goto out;
  1068. }
  1069. }
  1070. if (ar->bus_param.hl_msdu_ids) {
  1071. flags1 |= HTT_DATA_TX_DESC_FLAGS1_POSTPONED;
  1072. res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
  1073. if (res < 0) {
  1074. ath10k_err(ar, "msdu_id allocation failed %d\n", res);
  1075. goto out;
  1076. }
  1077. msdu_id = res;
  1078. }
  1079. /* As msdu is freed by mac80211 (in ieee80211_tx_status()) and by
  1080. * ath10k (in ath10k_htt_htc_tx_complete()) we have to increase
  1081. * reference by one to avoid a use-after-free case and a double
  1082. * free.
  1083. */
  1084. skb_get(msdu);
  1085. skb_push(msdu, sizeof(*cmd_hdr));
  1086. skb_push(msdu, sizeof(*tx_desc));
  1087. cmd_hdr = (struct htt_cmd_hdr *)msdu->data;
  1088. tx_desc = (struct htt_data_tx_desc *)(msdu->data + sizeof(*cmd_hdr));
  1089. cmd_hdr->msg_type = HTT_H2T_MSG_TYPE_TX_FRM;
  1090. tx_desc->flags0 = flags0;
  1091. tx_desc->flags1 = __cpu_to_le16(flags1);
  1092. tx_desc->len = __cpu_to_le16(data_len);
  1093. tx_desc->id = __cpu_to_le16(msdu_id);
  1094. tx_desc->frags_paddr = 0; /* always zero */
  1095. /* Initialize peer_id to INVALID_PEER because this is NOT
  1096. * Reinjection path
  1097. */
  1098. tx_desc->peerid = __cpu_to_le32(HTT_INVALID_PEERID);
  1099. res = ath10k_htc_send_hl(&htt->ar->htc, htt->eid, msdu);
  1100. out:
  1101. return res;
  1102. }
  1103. static int ath10k_htt_tx_32(struct ath10k_htt *htt,
  1104. enum ath10k_hw_txrx_mode txmode,
  1105. struct sk_buff *msdu)
  1106. {
  1107. struct ath10k *ar = htt->ar;
  1108. struct device *dev = ar->dev;
  1109. struct ieee80211_tx_info *info = IEEE80211_SKB_CB(msdu);
  1110. struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
  1111. struct ath10k_hif_sg_item sg_items[2];
  1112. struct ath10k_htt_txbuf_32 *txbuf;
  1113. struct htt_data_tx_desc_frag *frags;
  1114. bool is_eth = (txmode == ATH10K_HW_TXRX_ETHERNET);
  1115. u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
  1116. u8 tid = ath10k_htt_tx_get_tid(msdu, is_eth);
  1117. int prefetch_len;
  1118. int res;
  1119. u8 flags0 = 0;
  1120. u16 msdu_id, flags1 = 0;
  1121. u16 freq = 0;
  1122. u32 frags_paddr = 0;
  1123. u32 txbuf_paddr;
  1124. struct htt_msdu_ext_desc *ext_desc = NULL;
  1125. struct htt_msdu_ext_desc *ext_desc_t = NULL;
  1126. res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
  1127. if (res < 0)
  1128. goto err;
  1129. msdu_id = res;
  1130. prefetch_len = min(htt->prefetch_len, msdu->len);
  1131. prefetch_len = roundup(prefetch_len, 4);
  1132. txbuf = htt->txbuf.vaddr_txbuff_32 + msdu_id;
  1133. txbuf_paddr = htt->txbuf.paddr +
  1134. (sizeof(struct ath10k_htt_txbuf_32) * msdu_id);
  1135. if (!is_eth) {
  1136. struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
  1137. if ((ieee80211_is_action(hdr->frame_control) ||
  1138. ieee80211_is_deauth(hdr->frame_control) ||
  1139. ieee80211_is_disassoc(hdr->frame_control)) &&
  1140. ieee80211_has_protected(hdr->frame_control)) {
  1141. skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
  1142. } else if (!(skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT) &&
  1143. txmode == ATH10K_HW_TXRX_RAW &&
  1144. ieee80211_has_protected(hdr->frame_control)) {
  1145. skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
  1146. }
  1147. }
  1148. skb_cb->paddr = dma_map_single(dev, msdu->data, msdu->len,
  1149. DMA_TO_DEVICE);
  1150. res = dma_mapping_error(dev, skb_cb->paddr);
  1151. if (res) {
  1152. res = -EIO;
  1153. goto err_free_msdu_id;
  1154. }
  1155. if (unlikely(info->flags & IEEE80211_TX_CTL_TX_OFFCHAN))
  1156. freq = ar->scan.roc_freq;
  1157. switch (txmode) {
  1158. case ATH10K_HW_TXRX_RAW:
  1159. case ATH10K_HW_TXRX_NATIVE_WIFI:
  1160. flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
  1161. fallthrough;
  1162. case ATH10K_HW_TXRX_ETHERNET:
  1163. if (ar->hw_params.continuous_frag_desc) {
  1164. ext_desc_t = htt->frag_desc.vaddr_desc_32;
  1165. memset(&ext_desc_t[msdu_id], 0,
  1166. sizeof(struct htt_msdu_ext_desc));
  1167. frags = (struct htt_data_tx_desc_frag *)
  1168. &ext_desc_t[msdu_id].frags;
  1169. ext_desc = &ext_desc_t[msdu_id];
  1170. frags[0].tword_addr.paddr_lo =
  1171. __cpu_to_le32(skb_cb->paddr);
  1172. frags[0].tword_addr.paddr_hi = 0;
  1173. frags[0].tword_addr.len_16 = __cpu_to_le16(msdu->len);
  1174. frags_paddr = htt->frag_desc.paddr +
  1175. (sizeof(struct htt_msdu_ext_desc) * msdu_id);
  1176. } else {
  1177. frags = txbuf->frags;
  1178. frags[0].dword_addr.paddr =
  1179. __cpu_to_le32(skb_cb->paddr);
  1180. frags[0].dword_addr.len = __cpu_to_le32(msdu->len);
  1181. frags[1].dword_addr.paddr = 0;
  1182. frags[1].dword_addr.len = 0;
  1183. frags_paddr = txbuf_paddr;
  1184. }
  1185. flags0 |= SM(txmode, HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
  1186. break;
  1187. case ATH10K_HW_TXRX_MGMT:
  1188. flags0 |= SM(ATH10K_HW_TXRX_MGMT,
  1189. HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
  1190. flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
  1191. frags_paddr = skb_cb->paddr;
  1192. break;
  1193. }
  1194. /* Normally all commands go through HTC which manages tx credits for
  1195. * each endpoint and notifies when tx is completed.
  1196. *
  1197. * HTT endpoint is creditless so there's no need to care about HTC
  1198. * flags. In that case it is trivial to fill the HTC header here.
  1199. *
  1200. * MSDU transmission is considered completed upon HTT event. This
  1201. * implies no relevant resources can be freed until after the event is
  1202. * received. That's why HTC tx completion handler itself is ignored by
  1203. * setting NULL to transfer_context for all sg items.
  1204. *
  1205. * There is simply no point in pushing HTT TX_FRM through HTC tx path
  1206. * as it's a waste of resources. By bypassing HTC it is possible to
  1207. * avoid extra memory allocations, compress data structures and thus
  1208. * improve performance.
  1209. */
  1210. txbuf->htc_hdr.eid = htt->eid;
  1211. txbuf->htc_hdr.len = __cpu_to_le16(sizeof(txbuf->cmd_hdr) +
  1212. sizeof(txbuf->cmd_tx) +
  1213. prefetch_len);
  1214. txbuf->htc_hdr.flags = 0;
  1215. if (skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT)
  1216. flags0 |= HTT_DATA_TX_DESC_FLAGS0_NO_ENCRYPT;
  1217. flags1 |= SM((u16)vdev_id, HTT_DATA_TX_DESC_FLAGS1_VDEV_ID);
  1218. flags1 |= SM((u16)tid, HTT_DATA_TX_DESC_FLAGS1_EXT_TID);
  1219. if (msdu->ip_summed == CHECKSUM_PARTIAL &&
  1220. !test_bit(ATH10K_FLAG_RAW_MODE, &ar->dev_flags)) {
  1221. flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L3_OFFLOAD;
  1222. flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L4_OFFLOAD;
  1223. if (ar->hw_params.continuous_frag_desc)
  1224. ext_desc->flags |= HTT_MSDU_CHECKSUM_ENABLE;
  1225. }
  1226. /* Prevent firmware from sending up tx inspection requests. There's
  1227. * nothing ath10k can do with frames requested for inspection so force
  1228. * it to simply rely a regular tx completion with discard status.
  1229. */
  1230. flags1 |= HTT_DATA_TX_DESC_FLAGS1_POSTPONED;
  1231. txbuf->cmd_hdr.msg_type = HTT_H2T_MSG_TYPE_TX_FRM;
  1232. txbuf->cmd_tx.flags0 = flags0;
  1233. txbuf->cmd_tx.flags1 = __cpu_to_le16(flags1);
  1234. txbuf->cmd_tx.len = __cpu_to_le16(msdu->len);
  1235. txbuf->cmd_tx.id = __cpu_to_le16(msdu_id);
  1236. txbuf->cmd_tx.frags_paddr = __cpu_to_le32(frags_paddr);
  1237. if (ath10k_mac_tx_frm_has_freq(ar)) {
  1238. txbuf->cmd_tx.offchan_tx.peerid =
  1239. __cpu_to_le16(HTT_INVALID_PEERID);
  1240. txbuf->cmd_tx.offchan_tx.freq =
  1241. __cpu_to_le16(freq);
  1242. } else {
  1243. txbuf->cmd_tx.peerid =
  1244. __cpu_to_le32(HTT_INVALID_PEERID);
  1245. }
  1246. trace_ath10k_htt_tx(ar, msdu_id, msdu->len, vdev_id, tid);
  1247. ath10k_dbg(ar, ATH10K_DBG_HTT,
  1248. "htt tx flags0 %u flags1 %u len %d id %u frags_paddr %pad, msdu_paddr %pad vdev %u tid %u freq %u\n",
  1249. flags0, flags1, msdu->len, msdu_id, &frags_paddr,
  1250. &skb_cb->paddr, vdev_id, tid, freq);
  1251. ath10k_dbg_dump(ar, ATH10K_DBG_HTT_DUMP, NULL, "htt tx msdu: ",
  1252. msdu->data, msdu->len);
  1253. trace_ath10k_tx_hdr(ar, msdu->data, msdu->len);
  1254. trace_ath10k_tx_payload(ar, msdu->data, msdu->len);
  1255. sg_items[0].transfer_id = 0;
  1256. sg_items[0].transfer_context = NULL;
  1257. sg_items[0].vaddr = &txbuf->htc_hdr;
  1258. sg_items[0].paddr = txbuf_paddr +
  1259. sizeof(txbuf->frags);
  1260. sg_items[0].len = sizeof(txbuf->htc_hdr) +
  1261. sizeof(txbuf->cmd_hdr) +
  1262. sizeof(txbuf->cmd_tx);
  1263. sg_items[1].transfer_id = 0;
  1264. sg_items[1].transfer_context = NULL;
  1265. sg_items[1].vaddr = msdu->data;
  1266. sg_items[1].paddr = skb_cb->paddr;
  1267. sg_items[1].len = prefetch_len;
  1268. res = ath10k_hif_tx_sg(htt->ar,
  1269. htt->ar->htc.endpoint[htt->eid].ul_pipe_id,
  1270. sg_items, ARRAY_SIZE(sg_items));
  1271. if (res)
  1272. goto err_unmap_msdu;
  1273. return 0;
  1274. err_unmap_msdu:
  1275. dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
  1276. err_free_msdu_id:
  1277. spin_lock_bh(&htt->tx_lock);
  1278. ath10k_htt_tx_free_msdu_id(htt, msdu_id);
  1279. spin_unlock_bh(&htt->tx_lock);
  1280. err:
  1281. return res;
  1282. }
  1283. static int ath10k_htt_tx_64(struct ath10k_htt *htt,
  1284. enum ath10k_hw_txrx_mode txmode,
  1285. struct sk_buff *msdu)
  1286. {
  1287. struct ath10k *ar = htt->ar;
  1288. struct device *dev = ar->dev;
  1289. struct ieee80211_tx_info *info = IEEE80211_SKB_CB(msdu);
  1290. struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(msdu);
  1291. struct ath10k_hif_sg_item sg_items[2];
  1292. struct ath10k_htt_txbuf_64 *txbuf;
  1293. struct htt_data_tx_desc_frag *frags;
  1294. bool is_eth = (txmode == ATH10K_HW_TXRX_ETHERNET);
  1295. u8 vdev_id = ath10k_htt_tx_get_vdev_id(ar, msdu);
  1296. u8 tid = ath10k_htt_tx_get_tid(msdu, is_eth);
  1297. int prefetch_len;
  1298. int res;
  1299. u8 flags0 = 0;
  1300. u16 msdu_id, flags1 = 0;
  1301. u16 freq = 0;
  1302. dma_addr_t frags_paddr = 0;
  1303. dma_addr_t txbuf_paddr;
  1304. struct htt_msdu_ext_desc_64 *ext_desc = NULL;
  1305. struct htt_msdu_ext_desc_64 *ext_desc_t = NULL;
  1306. res = ath10k_htt_tx_alloc_msdu_id(htt, msdu);
  1307. if (res < 0)
  1308. goto err;
  1309. msdu_id = res;
  1310. prefetch_len = min(htt->prefetch_len, msdu->len);
  1311. prefetch_len = roundup(prefetch_len, 4);
  1312. txbuf = htt->txbuf.vaddr_txbuff_64 + msdu_id;
  1313. txbuf_paddr = htt->txbuf.paddr +
  1314. (sizeof(struct ath10k_htt_txbuf_64) * msdu_id);
  1315. if (!is_eth) {
  1316. struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)msdu->data;
  1317. if ((ieee80211_is_action(hdr->frame_control) ||
  1318. ieee80211_is_deauth(hdr->frame_control) ||
  1319. ieee80211_is_disassoc(hdr->frame_control)) &&
  1320. ieee80211_has_protected(hdr->frame_control)) {
  1321. skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
  1322. } else if (!(skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT) &&
  1323. txmode == ATH10K_HW_TXRX_RAW &&
  1324. ieee80211_has_protected(hdr->frame_control)) {
  1325. skb_put(msdu, IEEE80211_CCMP_MIC_LEN);
  1326. }
  1327. }
  1328. skb_cb->paddr = dma_map_single(dev, msdu->data, msdu->len,
  1329. DMA_TO_DEVICE);
  1330. res = dma_mapping_error(dev, skb_cb->paddr);
  1331. if (res) {
  1332. res = -EIO;
  1333. goto err_free_msdu_id;
  1334. }
  1335. if (unlikely(info->flags & IEEE80211_TX_CTL_TX_OFFCHAN))
  1336. freq = ar->scan.roc_freq;
  1337. switch (txmode) {
  1338. case ATH10K_HW_TXRX_RAW:
  1339. case ATH10K_HW_TXRX_NATIVE_WIFI:
  1340. flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
  1341. fallthrough;
  1342. case ATH10K_HW_TXRX_ETHERNET:
  1343. if (ar->hw_params.continuous_frag_desc) {
  1344. ext_desc_t = htt->frag_desc.vaddr_desc_64;
  1345. memset(&ext_desc_t[msdu_id], 0,
  1346. sizeof(struct htt_msdu_ext_desc_64));
  1347. frags = (struct htt_data_tx_desc_frag *)
  1348. &ext_desc_t[msdu_id].frags;
  1349. ext_desc = &ext_desc_t[msdu_id];
  1350. frags[0].tword_addr.paddr_lo =
  1351. __cpu_to_le32(skb_cb->paddr);
  1352. frags[0].tword_addr.paddr_hi =
  1353. __cpu_to_le16(upper_32_bits(skb_cb->paddr));
  1354. frags[0].tword_addr.len_16 = __cpu_to_le16(msdu->len);
  1355. frags_paddr = htt->frag_desc.paddr +
  1356. (sizeof(struct htt_msdu_ext_desc_64) * msdu_id);
  1357. } else {
  1358. frags = txbuf->frags;
  1359. frags[0].tword_addr.paddr_lo =
  1360. __cpu_to_le32(skb_cb->paddr);
  1361. frags[0].tword_addr.paddr_hi =
  1362. __cpu_to_le16(upper_32_bits(skb_cb->paddr));
  1363. frags[0].tword_addr.len_16 = __cpu_to_le16(msdu->len);
  1364. frags[1].tword_addr.paddr_lo = 0;
  1365. frags[1].tword_addr.paddr_hi = 0;
  1366. frags[1].tword_addr.len_16 = 0;
  1367. }
  1368. flags0 |= SM(txmode, HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
  1369. break;
  1370. case ATH10K_HW_TXRX_MGMT:
  1371. flags0 |= SM(ATH10K_HW_TXRX_MGMT,
  1372. HTT_DATA_TX_DESC_FLAGS0_PKT_TYPE);
  1373. flags0 |= HTT_DATA_TX_DESC_FLAGS0_MAC_HDR_PRESENT;
  1374. frags_paddr = skb_cb->paddr;
  1375. break;
  1376. }
  1377. /* Normally all commands go through HTC which manages tx credits for
  1378. * each endpoint and notifies when tx is completed.
  1379. *
  1380. * HTT endpoint is creditless so there's no need to care about HTC
  1381. * flags. In that case it is trivial to fill the HTC header here.
  1382. *
  1383. * MSDU transmission is considered completed upon HTT event. This
  1384. * implies no relevant resources can be freed until after the event is
  1385. * received. That's why HTC tx completion handler itself is ignored by
  1386. * setting NULL to transfer_context for all sg items.
  1387. *
  1388. * There is simply no point in pushing HTT TX_FRM through HTC tx path
  1389. * as it's a waste of resources. By bypassing HTC it is possible to
  1390. * avoid extra memory allocations, compress data structures and thus
  1391. * improve performance.
  1392. */
  1393. txbuf->htc_hdr.eid = htt->eid;
  1394. txbuf->htc_hdr.len = __cpu_to_le16(sizeof(txbuf->cmd_hdr) +
  1395. sizeof(txbuf->cmd_tx) +
  1396. prefetch_len);
  1397. txbuf->htc_hdr.flags = 0;
  1398. if (skb_cb->flags & ATH10K_SKB_F_NO_HWCRYPT)
  1399. flags0 |= HTT_DATA_TX_DESC_FLAGS0_NO_ENCRYPT;
  1400. flags1 |= SM((u16)vdev_id, HTT_DATA_TX_DESC_FLAGS1_VDEV_ID);
  1401. flags1 |= SM((u16)tid, HTT_DATA_TX_DESC_FLAGS1_EXT_TID);
  1402. if (msdu->ip_summed == CHECKSUM_PARTIAL &&
  1403. !test_bit(ATH10K_FLAG_RAW_MODE, &ar->dev_flags)) {
  1404. flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L3_OFFLOAD;
  1405. flags1 |= HTT_DATA_TX_DESC_FLAGS1_CKSUM_L4_OFFLOAD;
  1406. if (ar->hw_params.continuous_frag_desc) {
  1407. memset(ext_desc->tso_flag, 0, sizeof(ext_desc->tso_flag));
  1408. ext_desc->tso_flag[3] |=
  1409. __cpu_to_le32(HTT_MSDU_CHECKSUM_ENABLE_64);
  1410. }
  1411. }
  1412. /* Prevent firmware from sending up tx inspection requests. There's
  1413. * nothing ath10k can do with frames requested for inspection so force
  1414. * it to simply rely a regular tx completion with discard status.
  1415. */
  1416. flags1 |= HTT_DATA_TX_DESC_FLAGS1_POSTPONED;
  1417. txbuf->cmd_hdr.msg_type = HTT_H2T_MSG_TYPE_TX_FRM;
  1418. txbuf->cmd_tx.flags0 = flags0;
  1419. txbuf->cmd_tx.flags1 = __cpu_to_le16(flags1);
  1420. txbuf->cmd_tx.len = __cpu_to_le16(msdu->len);
  1421. txbuf->cmd_tx.id = __cpu_to_le16(msdu_id);
  1422. /* fill fragment descriptor */
  1423. txbuf->cmd_tx.frags_paddr = __cpu_to_le64(frags_paddr);
  1424. if (ath10k_mac_tx_frm_has_freq(ar)) {
  1425. txbuf->cmd_tx.offchan_tx.peerid =
  1426. __cpu_to_le16(HTT_INVALID_PEERID);
  1427. txbuf->cmd_tx.offchan_tx.freq =
  1428. __cpu_to_le16(freq);
  1429. } else {
  1430. txbuf->cmd_tx.peerid =
  1431. __cpu_to_le32(HTT_INVALID_PEERID);
  1432. }
  1433. trace_ath10k_htt_tx(ar, msdu_id, msdu->len, vdev_id, tid);
  1434. ath10k_dbg(ar, ATH10K_DBG_HTT,
  1435. "htt tx flags0 %u flags1 %u len %d id %u frags_paddr %pad, msdu_paddr %pad vdev %u tid %u freq %u\n",
  1436. flags0, flags1, msdu->len, msdu_id, &frags_paddr,
  1437. &skb_cb->paddr, vdev_id, tid, freq);
  1438. ath10k_dbg_dump(ar, ATH10K_DBG_HTT_DUMP, NULL, "htt tx msdu: ",
  1439. msdu->data, msdu->len);
  1440. trace_ath10k_tx_hdr(ar, msdu->data, msdu->len);
  1441. trace_ath10k_tx_payload(ar, msdu->data, msdu->len);
  1442. sg_items[0].transfer_id = 0;
  1443. sg_items[0].transfer_context = NULL;
  1444. sg_items[0].vaddr = &txbuf->htc_hdr;
  1445. sg_items[0].paddr = txbuf_paddr +
  1446. sizeof(txbuf->frags);
  1447. sg_items[0].len = sizeof(txbuf->htc_hdr) +
  1448. sizeof(txbuf->cmd_hdr) +
  1449. sizeof(txbuf->cmd_tx);
  1450. sg_items[1].transfer_id = 0;
  1451. sg_items[1].transfer_context = NULL;
  1452. sg_items[1].vaddr = msdu->data;
  1453. sg_items[1].paddr = skb_cb->paddr;
  1454. sg_items[1].len = prefetch_len;
  1455. res = ath10k_hif_tx_sg(htt->ar,
  1456. htt->ar->htc.endpoint[htt->eid].ul_pipe_id,
  1457. sg_items, ARRAY_SIZE(sg_items));
  1458. if (res)
  1459. goto err_unmap_msdu;
  1460. return 0;
  1461. err_unmap_msdu:
  1462. dma_unmap_single(dev, skb_cb->paddr, msdu->len, DMA_TO_DEVICE);
  1463. err_free_msdu_id:
  1464. spin_lock_bh(&htt->tx_lock);
  1465. ath10k_htt_tx_free_msdu_id(htt, msdu_id);
  1466. spin_unlock_bh(&htt->tx_lock);
  1467. err:
  1468. return res;
  1469. }
  1470. static const struct ath10k_htt_tx_ops htt_tx_ops_32 = {
  1471. .htt_send_rx_ring_cfg = ath10k_htt_send_rx_ring_cfg_32,
  1472. .htt_send_frag_desc_bank_cfg = ath10k_htt_send_frag_desc_bank_cfg_32,
  1473. .htt_alloc_frag_desc = ath10k_htt_tx_alloc_cont_frag_desc_32,
  1474. .htt_free_frag_desc = ath10k_htt_tx_free_cont_frag_desc_32,
  1475. .htt_tx = ath10k_htt_tx_32,
  1476. .htt_alloc_txbuff = ath10k_htt_tx_alloc_cont_txbuf_32,
  1477. .htt_free_txbuff = ath10k_htt_tx_free_cont_txbuf_32,
  1478. .htt_h2t_aggr_cfg_msg = ath10k_htt_h2t_aggr_cfg_msg_32,
  1479. };
  1480. static const struct ath10k_htt_tx_ops htt_tx_ops_64 = {
  1481. .htt_send_rx_ring_cfg = ath10k_htt_send_rx_ring_cfg_64,
  1482. .htt_send_frag_desc_bank_cfg = ath10k_htt_send_frag_desc_bank_cfg_64,
  1483. .htt_alloc_frag_desc = ath10k_htt_tx_alloc_cont_frag_desc_64,
  1484. .htt_free_frag_desc = ath10k_htt_tx_free_cont_frag_desc_64,
  1485. .htt_tx = ath10k_htt_tx_64,
  1486. .htt_alloc_txbuff = ath10k_htt_tx_alloc_cont_txbuf_64,
  1487. .htt_free_txbuff = ath10k_htt_tx_free_cont_txbuf_64,
  1488. .htt_h2t_aggr_cfg_msg = ath10k_htt_h2t_aggr_cfg_msg_v2,
  1489. };
  1490. static const struct ath10k_htt_tx_ops htt_tx_ops_hl = {
  1491. .htt_send_rx_ring_cfg = ath10k_htt_send_rx_ring_cfg_hl,
  1492. .htt_send_frag_desc_bank_cfg = ath10k_htt_send_frag_desc_bank_cfg_32,
  1493. .htt_tx = ath10k_htt_tx_hl,
  1494. .htt_h2t_aggr_cfg_msg = ath10k_htt_h2t_aggr_cfg_msg_32,
  1495. .htt_flush_tx = ath10k_htt_flush_tx_queue,
  1496. };
  1497. void ath10k_htt_set_tx_ops(struct ath10k_htt *htt)
  1498. {
  1499. struct ath10k *ar = htt->ar;
  1500. if (ar->bus_param.dev_type == ATH10K_DEV_TYPE_HL)
  1501. htt->tx_ops = &htt_tx_ops_hl;
  1502. else if (ar->hw_params.target_64bit)
  1503. htt->tx_ops = &htt_tx_ops_64;
  1504. else
  1505. htt->tx_ops = &htt_tx_ops_32;
  1506. }