hal_reo.c 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965
  1. /*
  2. * Copyright (c) 2016-2017 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 "hal_reo.h"
  19. #include "hal_tx.h"
  20. #define BLOCK_RES_MASK 0xF
  21. static inline uint8_t hal_find_one_bit(uint8_t x)
  22. {
  23. uint8_t y = (x & (~x + 1)) & BLOCK_RES_MASK;
  24. uint8_t pos;
  25. for (pos = 0; y; y >>= 1)
  26. pos++;
  27. return pos-1;
  28. }
  29. static inline uint8_t hal_find_zero_bit(uint8_t x)
  30. {
  31. uint8_t y = (~x & (x+1)) & BLOCK_RES_MASK;
  32. uint8_t pos;
  33. for (pos = 0; y; y >>= 1)
  34. pos++;
  35. return pos-1;
  36. }
  37. inline void hal_reo_cmd_set_descr_addr(uint32_t *reo_desc,
  38. enum hal_reo_cmd_type type,
  39. uint32_t paddr_lo,
  40. uint8_t paddr_hi)
  41. {
  42. switch (type) {
  43. case CMD_GET_QUEUE_STATS:
  44. HAL_DESC_SET_FIELD(reo_desc, REO_GET_QUEUE_STATS_1,
  45. RX_REO_QUEUE_DESC_ADDR_31_0, paddr_lo);
  46. HAL_DESC_SET_FIELD(reo_desc, REO_GET_QUEUE_STATS_2,
  47. RX_REO_QUEUE_DESC_ADDR_39_32, paddr_hi);
  48. break;
  49. case CMD_FLUSH_QUEUE:
  50. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_QUEUE_1,
  51. FLUSH_DESC_ADDR_31_0, paddr_lo);
  52. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_QUEUE_2,
  53. FLUSH_DESC_ADDR_39_32, paddr_hi);
  54. break;
  55. case CMD_FLUSH_CACHE:
  56. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_CACHE_1,
  57. FLUSH_ADDR_31_0, paddr_lo);
  58. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_CACHE_2,
  59. FLUSH_ADDR_39_32, paddr_hi);
  60. break;
  61. case CMD_UPDATE_RX_REO_QUEUE:
  62. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_1,
  63. RX_REO_QUEUE_DESC_ADDR_31_0, paddr_lo);
  64. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  65. RX_REO_QUEUE_DESC_ADDR_39_32, paddr_hi);
  66. break;
  67. default:
  68. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  69. "%s: Invalid REO command type\n", __func__);
  70. break;
  71. }
  72. }
  73. inline int hal_reo_cmd_queue_stats(void *reo_ring, struct hal_soc *soc,
  74. struct hal_reo_cmd_params *cmd)
  75. {
  76. uint32_t *reo_desc, val;
  77. hal_srng_access_start(soc, reo_ring);
  78. reo_desc = hal_srng_src_get_next(soc, reo_ring);
  79. if (!reo_desc) {
  80. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_DEBUG,
  81. "%s: Out of cmd ring entries\n", __func__);
  82. hal_srng_access_end(soc, reo_ring);
  83. return -EBUSY;
  84. }
  85. HAL_SET_TLV_HDR(reo_desc, WIFIREO_GET_QUEUE_STATS_E,
  86. sizeof(struct reo_get_queue_stats));
  87. /* Offsets of descriptor fields defined in HW headers start from
  88. * the field after TLV header */
  89. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  90. qdf_mem_zero((void *)reo_desc, sizeof(struct reo_get_queue_stats));
  91. HAL_DESC_SET_FIELD(reo_desc, UNIFORM_REO_CMD_HEADER_0,
  92. REO_STATUS_REQUIRED, cmd->std.need_status);
  93. hal_reo_cmd_set_descr_addr(reo_desc, CMD_GET_QUEUE_STATS,
  94. cmd->std.addr_lo,
  95. cmd->std.addr_hi);
  96. HAL_DESC_SET_FIELD(reo_desc, REO_GET_QUEUE_STATS_2, CLEAR_STATS,
  97. cmd->u.stats_params.clear);
  98. hal_srng_access_end(soc, reo_ring);
  99. val = reo_desc[CMD_HEADER_DW_OFFSET];
  100. return HAL_GET_FIELD(UNIFORM_REO_CMD_HEADER_0, REO_CMD_NUMBER,
  101. val);
  102. }
  103. inline int hal_reo_cmd_flush_queue(void *reo_ring, struct hal_soc *soc,
  104. struct hal_reo_cmd_params *cmd)
  105. {
  106. uint32_t *reo_desc, val;
  107. hal_srng_access_start(soc, reo_ring);
  108. reo_desc = hal_srng_src_get_next(soc, reo_ring);
  109. if (!reo_desc) {
  110. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_DEBUG,
  111. "%s: Out of cmd ring entries\n", __func__);
  112. hal_srng_access_end(soc, reo_ring);
  113. return -EBUSY;
  114. }
  115. HAL_SET_TLV_HDR(reo_desc, WIFIREO_FLUSH_QUEUE_E,
  116. sizeof(struct reo_flush_queue));
  117. /* Offsets of descriptor fields defined in HW headers start from
  118. * the field after TLV header */
  119. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  120. qdf_mem_zero((void *)reo_desc, sizeof(struct reo_flush_queue));
  121. HAL_DESC_SET_FIELD(reo_desc, UNIFORM_REO_CMD_HEADER_0,
  122. REO_STATUS_REQUIRED, cmd->std.need_status);
  123. hal_reo_cmd_set_descr_addr(reo_desc, CMD_FLUSH_QUEUE, cmd->std.addr_lo,
  124. cmd->std.addr_hi);
  125. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_QUEUE_2,
  126. BLOCK_DESC_ADDR_USAGE_AFTER_FLUSH,
  127. cmd->u.fl_queue_params.block_use_after_flush);
  128. if (cmd->u.fl_queue_params.block_use_after_flush) {
  129. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_QUEUE_2,
  130. BLOCK_RESOURCE_INDEX, cmd->u.fl_queue_params.index);
  131. }
  132. hal_srng_access_end(soc, reo_ring);
  133. val = reo_desc[CMD_HEADER_DW_OFFSET];
  134. return HAL_GET_FIELD(UNIFORM_REO_CMD_HEADER_0, REO_CMD_NUMBER,
  135. val);
  136. }
  137. inline int hal_reo_cmd_flush_cache(void *reo_ring, struct hal_soc *soc,
  138. struct hal_reo_cmd_params *cmd)
  139. {
  140. uint32_t *reo_desc, val;
  141. struct hal_reo_cmd_flush_cache_params *cp;
  142. uint8_t index = 0;
  143. cp = &cmd->u.fl_cache_params;
  144. hal_srng_access_start(soc, reo_ring);
  145. /* We need a cache block resource for this operation, and REO HW has
  146. * only 4 such blocking resources. These resources are managed using
  147. * reo_res_bitmap, and we return failure if none is available.
  148. */
  149. if (cp->block_use_after_flush) {
  150. index = hal_find_zero_bit(soc->reo_res_bitmap);
  151. if (index > 3) {
  152. qdf_print("%s, No blocking resource available!\n", __func__);
  153. hal_srng_access_end(soc, reo_ring);
  154. return -EBUSY;
  155. }
  156. soc->index = index;
  157. }
  158. reo_desc = hal_srng_src_get_next(soc, reo_ring);
  159. if (!reo_desc) {
  160. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_DEBUG,
  161. "%s: Out of cmd ring entries\n", __func__);
  162. hal_srng_access_end(soc, reo_ring);
  163. return -EBUSY;
  164. }
  165. HAL_SET_TLV_HDR(reo_desc, WIFIREO_FLUSH_CACHE_E,
  166. sizeof(struct reo_flush_cache));
  167. /* Offsets of descriptor fields defined in HW headers start from
  168. * the field after TLV header */
  169. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  170. qdf_mem_zero((void *)reo_desc, sizeof(struct reo_flush_cache));
  171. HAL_DESC_SET_FIELD(reo_desc, UNIFORM_REO_CMD_HEADER_0,
  172. REO_STATUS_REQUIRED, cmd->std.need_status);
  173. hal_reo_cmd_set_descr_addr(reo_desc, CMD_FLUSH_CACHE, cmd->std.addr_lo,
  174. cmd->std.addr_hi);
  175. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_CACHE_2,
  176. FORWARD_ALL_MPDUS_IN_QUEUE, cp->fwd_mpdus_in_queue);
  177. /* set it to 0 for now */
  178. cp->rel_block_index = 0;
  179. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_CACHE_2,
  180. RELEASE_CACHE_BLOCK_INDEX, cp->rel_block_index);
  181. if (cp->block_use_after_flush) {
  182. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_CACHE_2,
  183. CACHE_BLOCK_RESOURCE_INDEX, index);
  184. }
  185. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_CACHE_2,
  186. FLUSH_WITHOUT_INVALIDATE, cp->flush_no_inval);
  187. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_CACHE_2,
  188. BLOCK_CACHE_USAGE_AFTER_FLUSH, cp->block_use_after_flush);
  189. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_CACHE_2, FLUSH_ENTIRE_CACHE,
  190. cp->flush_all);
  191. hal_srng_access_end(soc, reo_ring);
  192. val = reo_desc[CMD_HEADER_DW_OFFSET];
  193. return HAL_GET_FIELD(UNIFORM_REO_CMD_HEADER_0, REO_CMD_NUMBER,
  194. val);
  195. }
  196. inline int hal_reo_cmd_unblock_cache(void *reo_ring, struct hal_soc *soc,
  197. struct hal_reo_cmd_params *cmd)
  198. {
  199. uint32_t *reo_desc, val;
  200. uint8_t index = 0;
  201. hal_srng_access_start(soc, reo_ring);
  202. if (cmd->u.unblk_cache_params.type == UNBLOCK_RES_INDEX) {
  203. index = hal_find_one_bit(soc->reo_res_bitmap);
  204. if (index > 3) {
  205. hal_srng_access_end(soc, reo_ring);
  206. qdf_print("%s: No blocking resource to unblock!\n",
  207. __func__);
  208. return -EBUSY;
  209. }
  210. }
  211. reo_desc = hal_srng_src_get_next(soc, reo_ring);
  212. if (!reo_desc) {
  213. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_DEBUG,
  214. "%s: Out of cmd ring entries\n", __func__);
  215. hal_srng_access_end(soc, reo_ring);
  216. return -EBUSY;
  217. }
  218. HAL_SET_TLV_HDR(reo_desc, WIFIREO_UNBLOCK_CACHE_E,
  219. sizeof(struct reo_unblock_cache));
  220. /* Offsets of descriptor fields defined in HW headers start from
  221. * the field after TLV header */
  222. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  223. qdf_mem_zero((void *)reo_desc, sizeof(struct reo_unblock_cache));
  224. HAL_DESC_SET_FIELD(reo_desc, UNIFORM_REO_CMD_HEADER_0,
  225. REO_STATUS_REQUIRED, cmd->std.need_status);
  226. HAL_DESC_SET_FIELD(reo_desc, REO_UNBLOCK_CACHE_1,
  227. UNBLOCK_TYPE, cmd->u.unblk_cache_params.type);
  228. if (cmd->u.unblk_cache_params.type == UNBLOCK_RES_INDEX) {
  229. HAL_DESC_SET_FIELD(reo_desc, REO_UNBLOCK_CACHE_1,
  230. CACHE_BLOCK_RESOURCE_INDEX,
  231. cmd->u.unblk_cache_params.index);
  232. }
  233. hal_srng_access_end(soc, reo_ring);
  234. val = reo_desc[CMD_HEADER_DW_OFFSET];
  235. return HAL_GET_FIELD(UNIFORM_REO_CMD_HEADER_0, REO_CMD_NUMBER,
  236. val);
  237. }
  238. inline int hal_reo_cmd_flush_timeout_list(void *reo_ring, struct hal_soc *soc,
  239. struct hal_reo_cmd_params *cmd)
  240. {
  241. uint32_t *reo_desc, val;
  242. hal_srng_access_start(soc, reo_ring);
  243. reo_desc = hal_srng_src_get_next(soc, reo_ring);
  244. if (!reo_desc) {
  245. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_DEBUG,
  246. "%s: Out of cmd ring entries\n", __func__);
  247. hal_srng_access_end(soc, reo_ring);
  248. return -EBUSY;
  249. }
  250. HAL_SET_TLV_HDR(reo_desc, WIFIREO_FLUSH_TIMEOUT_LIST_E,
  251. sizeof(struct reo_flush_timeout_list));
  252. /* Offsets of descriptor fields defined in HW headers start from
  253. * the field after TLV header */
  254. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  255. qdf_mem_zero((void *)reo_desc, sizeof(struct reo_flush_timeout_list));
  256. HAL_DESC_SET_FIELD(reo_desc, UNIFORM_REO_CMD_HEADER_0,
  257. REO_STATUS_REQUIRED, cmd->std.need_status);
  258. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_TIMEOUT_LIST_1, AC_TIMOUT_LIST,
  259. cmd->u.fl_tim_list_params.ac_list);
  260. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_TIMEOUT_LIST_2,
  261. MINIMUM_RELEASE_DESC_COUNT,
  262. cmd->u.fl_tim_list_params.min_rel_desc);
  263. HAL_DESC_SET_FIELD(reo_desc, REO_FLUSH_TIMEOUT_LIST_2,
  264. MINIMUM_FORWARD_BUF_COUNT,
  265. cmd->u.fl_tim_list_params.min_fwd_buf);
  266. hal_srng_access_end(soc, reo_ring);
  267. val = reo_desc[CMD_HEADER_DW_OFFSET];
  268. return HAL_GET_FIELD(UNIFORM_REO_CMD_HEADER_0, REO_CMD_NUMBER,
  269. val);
  270. }
  271. inline int hal_reo_cmd_update_rx_queue(void *reo_ring, struct hal_soc *soc,
  272. struct hal_reo_cmd_params *cmd)
  273. {
  274. uint32_t *reo_desc, val;
  275. struct hal_reo_cmd_update_queue_params *p;
  276. p = &cmd->u.upd_queue_params;
  277. hal_srng_access_start(soc, reo_ring);
  278. reo_desc = hal_srng_src_get_next(soc, reo_ring);
  279. if (!reo_desc) {
  280. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_DEBUG,
  281. "%s: Out of cmd ring entries\n", __func__);
  282. hal_srng_access_end(soc, reo_ring);
  283. return -EBUSY;
  284. }
  285. HAL_SET_TLV_HDR(reo_desc, WIFIREO_UPDATE_RX_REO_QUEUE_E,
  286. sizeof(struct reo_update_rx_reo_queue));
  287. /* Offsets of descriptor fields defined in HW headers start from
  288. * the field after TLV header */
  289. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  290. qdf_mem_zero((void *)reo_desc, sizeof(struct reo_update_rx_reo_queue));
  291. HAL_DESC_SET_FIELD(reo_desc, UNIFORM_REO_CMD_HEADER_0,
  292. REO_STATUS_REQUIRED, cmd->std.need_status);
  293. hal_reo_cmd_set_descr_addr(reo_desc, CMD_UPDATE_RX_REO_QUEUE,
  294. cmd->std.addr_lo, cmd->std.addr_hi);
  295. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  296. UPDATE_RECEIVE_QUEUE_NUMBER, p->update_rx_queue_num);
  297. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2, UPDATE_VLD,
  298. p->update_vld);
  299. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  300. UPDATE_ASSOCIATED_LINK_DESCRIPTOR_COUNTER,
  301. p->update_assoc_link_desc);
  302. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  303. UPDATE_DISABLE_DUPLICATE_DETECTION,
  304. p->update_disable_dup_detect);
  305. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  306. UPDATE_DISABLE_DUPLICATE_DETECTION,
  307. p->update_disable_dup_detect);
  308. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  309. UPDATE_SOFT_REORDER_ENABLE,
  310. p->update_soft_reorder_enab);
  311. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  312. UPDATE_AC, p->update_ac);
  313. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  314. UPDATE_BAR, p->update_bar);
  315. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  316. UPDATE_BAR, p->update_bar);
  317. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  318. UPDATE_RTY, p->update_rty);
  319. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  320. UPDATE_CHK_2K_MODE, p->update_chk_2k_mode);
  321. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  322. UPDATE_OOR_MODE, p->update_oor_mode);
  323. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  324. UPDATE_BA_WINDOW_SIZE, p->update_ba_window_size);
  325. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  326. UPDATE_PN_CHECK_NEEDED, p->update_pn_check_needed);
  327. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  328. UPDATE_PN_SHALL_BE_EVEN, p->update_pn_even);
  329. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  330. UPDATE_PN_SHALL_BE_UNEVEN, p->update_pn_uneven);
  331. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  332. UPDATE_PN_HANDLING_ENABLE, p->update_pn_hand_enab);
  333. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  334. UPDATE_PN_SIZE, p->update_pn_size);
  335. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  336. UPDATE_IGNORE_AMPDU_FLAG, p->update_ignore_ampdu);
  337. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  338. UPDATE_SVLD, p->update_svld);
  339. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  340. UPDATE_SSN, p->update_ssn);
  341. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  342. UPDATE_SEQ_2K_ERROR_DETECTED_FLAG,
  343. p->update_seq_2k_err_detect);
  344. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  345. UPDATE_PN_VALID, p->update_pn_valid);
  346. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_2,
  347. UPDATE_PN, p->update_pn);
  348. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  349. RECEIVE_QUEUE_NUMBER, p->rx_queue_num);
  350. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  351. VLD, p->vld);
  352. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  353. ASSOCIATED_LINK_DESCRIPTOR_COUNTER,
  354. p->assoc_link_desc);
  355. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  356. DISABLE_DUPLICATE_DETECTION, p->disable_dup_detect);
  357. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  358. SOFT_REORDER_ENABLE, p->soft_reorder_enab);
  359. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3, AC, p->ac);
  360. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  361. BAR, p->bar);
  362. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  363. CHK_2K_MODE, p->chk_2k_mode);
  364. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  365. RTY, p->rty);
  366. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  367. OOR_MODE, p->oor_mode);
  368. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  369. PN_CHECK_NEEDED, p->pn_check_needed);
  370. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  371. PN_SHALL_BE_EVEN, p->pn_even);
  372. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  373. PN_SHALL_BE_UNEVEN, p->pn_uneven);
  374. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  375. PN_HANDLING_ENABLE, p->pn_hand_enab);
  376. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_3,
  377. IGNORE_AMPDU_FLAG, p->ignore_ampdu);
  378. if (p->ba_window_size < 1)
  379. p->ba_window_size = 1;
  380. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_4,
  381. BA_WINDOW_SIZE, p->ba_window_size - 1);
  382. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_4,
  383. PN_SIZE, p->pn_size);
  384. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_4,
  385. SVLD, p->svld);
  386. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_4,
  387. SSN, p->ssn);
  388. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_4,
  389. SEQ_2K_ERROR_DETECTED_FLAG, p->seq_2k_err_detect);
  390. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_4,
  391. PN_ERROR_DETECTED_FLAG, p->pn_err_detect);
  392. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_5,
  393. PN_31_0, p->pn_31_0);
  394. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_6,
  395. PN_63_32, p->pn_63_32);
  396. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_7,
  397. PN_95_64, p->pn_95_64);
  398. HAL_DESC_SET_FIELD(reo_desc, REO_UPDATE_RX_REO_QUEUE_8,
  399. PN_127_96, p->pn_127_96);
  400. hal_srng_access_end(soc, reo_ring);
  401. val = reo_desc[CMD_HEADER_DW_OFFSET];
  402. return HAL_GET_FIELD(UNIFORM_REO_CMD_HEADER_0, REO_CMD_NUMBER,
  403. val);
  404. }
  405. inline void hal_reo_queue_stats_status(uint32_t *reo_desc,
  406. struct hal_reo_queue_status *st)
  407. {
  408. uint32_t val;
  409. /* Offsets of descriptor fields defined in HW headers start
  410. * from the field after TLV header */
  411. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  412. /* header */
  413. HAL_REO_STATUS_GET_HEADER(reo_desc, REO_GET_QUEUE_STATS, st->header);
  414. /* SSN */
  415. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_2, SSN)];
  416. st->ssn = HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_2, SSN, val);
  417. /* current index */
  418. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_2,
  419. CURRENT_INDEX)];
  420. st->curr_idx =
  421. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_2,
  422. CURRENT_INDEX, val);
  423. /* PN bits */
  424. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_3,
  425. PN_31_0)];
  426. st->pn_31_0 =
  427. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_3,
  428. PN_31_0, val);
  429. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_4,
  430. PN_63_32)];
  431. st->pn_63_32 =
  432. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_4,
  433. PN_63_32, val);
  434. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_5,
  435. PN_95_64)];
  436. st->pn_95_64 =
  437. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_5,
  438. PN_95_64, val);
  439. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_6,
  440. PN_127_96)];
  441. st->pn_127_96 =
  442. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_6,
  443. PN_127_96, val);
  444. /* timestamps */
  445. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_7,
  446. LAST_RX_ENQUEUE_TIMESTAMP)];
  447. st->last_rx_enq_tstamp =
  448. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_7,
  449. LAST_RX_ENQUEUE_TIMESTAMP, val);
  450. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_8,
  451. LAST_RX_DEQUEUE_TIMESTAMP)];
  452. st->last_rx_deq_tstamp =
  453. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_8,
  454. LAST_RX_DEQUEUE_TIMESTAMP, val);
  455. /* rx bitmap */
  456. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_9,
  457. RX_BITMAP_31_0)];
  458. st->rx_bitmap_31_0 =
  459. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_9,
  460. RX_BITMAP_31_0, val);
  461. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_10,
  462. RX_BITMAP_63_32)];
  463. st->rx_bitmap_63_32 =
  464. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_10,
  465. RX_BITMAP_63_32, val);
  466. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_11,
  467. RX_BITMAP_95_64)];
  468. st->rx_bitmap_95_64 =
  469. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_11,
  470. RX_BITMAP_95_64, val);
  471. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_12,
  472. RX_BITMAP_127_96)];
  473. st->rx_bitmap_127_96 =
  474. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_12,
  475. RX_BITMAP_127_96, val);
  476. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_13,
  477. RX_BITMAP_159_128)];
  478. st->rx_bitmap_159_128 =
  479. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_13,
  480. RX_BITMAP_159_128, val);
  481. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_14,
  482. RX_BITMAP_191_160)];
  483. st->rx_bitmap_191_160 =
  484. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_14,
  485. RX_BITMAP_191_160, val);
  486. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_15,
  487. RX_BITMAP_223_192)];
  488. st->rx_bitmap_223_192 =
  489. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_15,
  490. RX_BITMAP_223_192, val);
  491. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_16,
  492. RX_BITMAP_255_224)];
  493. st->rx_bitmap_255_224 =
  494. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_16,
  495. RX_BITMAP_255_224, val);
  496. /* various counts */
  497. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_17,
  498. CURRENT_MPDU_COUNT)];
  499. st->curr_mpdu_cnt =
  500. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_17,
  501. CURRENT_MPDU_COUNT, val);
  502. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_17,
  503. CURRENT_MSDU_COUNT)];
  504. st->curr_msdu_cnt =
  505. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_17,
  506. CURRENT_MSDU_COUNT, val);
  507. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_18,
  508. TIMEOUT_COUNT)];
  509. st->fwd_timeout_cnt =
  510. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_18,
  511. TIMEOUT_COUNT, val);
  512. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_18,
  513. FORWARD_DUE_TO_BAR_COUNT)];
  514. st->fwd_bar_cnt =
  515. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_18,
  516. FORWARD_DUE_TO_BAR_COUNT, val);
  517. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_18,
  518. DUPLICATE_COUNT)];
  519. st->dup_cnt =
  520. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_18,
  521. DUPLICATE_COUNT, val);
  522. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_19,
  523. FRAMES_IN_ORDER_COUNT)];
  524. st->frms_in_order_cnt =
  525. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_19,
  526. FRAMES_IN_ORDER_COUNT, val);
  527. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_19,
  528. BAR_RECEIVED_COUNT)];
  529. st->bar_rcvd_cnt =
  530. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_19,
  531. BAR_RECEIVED_COUNT, val);
  532. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_20,
  533. MPDU_FRAMES_PROCESSED_COUNT)];
  534. st->mpdu_frms_cnt =
  535. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_20,
  536. MPDU_FRAMES_PROCESSED_COUNT, val);
  537. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_21,
  538. MSDU_FRAMES_PROCESSED_COUNT)];
  539. st->msdu_frms_cnt =
  540. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_21,
  541. MSDU_FRAMES_PROCESSED_COUNT, val);
  542. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_22,
  543. TOTAL_PROCESSED_BYTE_COUNT)];
  544. st->total_cnt =
  545. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_22,
  546. TOTAL_PROCESSED_BYTE_COUNT, val);
  547. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_23,
  548. LATE_RECEIVE_MPDU_COUNT)];
  549. st->late_recv_mpdu_cnt =
  550. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_23,
  551. LATE_RECEIVE_MPDU_COUNT, val);
  552. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_23,
  553. WINDOW_JUMP_2K)];
  554. st->win_jump_2k =
  555. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_23,
  556. WINDOW_JUMP_2K, val);
  557. val = reo_desc[HAL_OFFSET_DW(REO_GET_QUEUE_STATS_STATUS_23,
  558. HOLE_COUNT)];
  559. st->hole_cnt =
  560. HAL_GET_FIELD(REO_GET_QUEUE_STATS_STATUS_23,
  561. HOLE_COUNT, val);
  562. }
  563. inline void hal_reo_flush_queue_status(uint32_t *reo_desc,
  564. struct hal_reo_flush_queue_status *st)
  565. {
  566. uint32_t val;
  567. /* Offsets of descriptor fields defined in HW headers start
  568. * from the field after TLV header */
  569. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  570. /* header */
  571. HAL_REO_STATUS_GET_HEADER(reo_desc, REO_FLUSH_QUEUE, st->header);
  572. /* error bit */
  573. val = reo_desc[HAL_OFFSET(REO_FLUSH_QUEUE_STATUS_2,
  574. ERROR_DETECTED)];
  575. st->error = HAL_GET_FIELD(REO_FLUSH_QUEUE_STATUS_2, ERROR_DETECTED,
  576. val);
  577. }
  578. inline void hal_reo_flush_cache_status(uint32_t *reo_desc, struct hal_soc *soc,
  579. struct hal_reo_flush_cache_status *st)
  580. {
  581. uint32_t val;
  582. /* Offsets of descriptor fields defined in HW headers start
  583. * from the field after TLV header */
  584. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  585. /* header */
  586. HAL_REO_STATUS_GET_HEADER(reo_desc, REO_FLUSH_CACHE, st->header);
  587. /* error bit */
  588. val = reo_desc[HAL_OFFSET_DW(REO_FLUSH_CACHE_STATUS_2,
  589. ERROR_DETECTED)];
  590. st->error = HAL_GET_FIELD(REO_FLUSH_QUEUE_STATUS_2, ERROR_DETECTED,
  591. val);
  592. /* block error */
  593. val = reo_desc[HAL_OFFSET_DW(REO_FLUSH_CACHE_STATUS_2,
  594. BLOCK_ERROR_DETAILS)];
  595. st->block_error = HAL_GET_FIELD(REO_FLUSH_CACHE_STATUS_2,
  596. BLOCK_ERROR_DETAILS,
  597. val);
  598. if (!st->block_error)
  599. qdf_set_bit(soc->index, (unsigned long *)&soc->reo_res_bitmap);
  600. /* cache flush status */
  601. val = reo_desc[HAL_OFFSET_DW(REO_FLUSH_CACHE_STATUS_2,
  602. CACHE_CONTROLLER_FLUSH_STATUS_HIT)];
  603. st->cache_flush_status = HAL_GET_FIELD(REO_FLUSH_CACHE_STATUS_2,
  604. CACHE_CONTROLLER_FLUSH_STATUS_HIT,
  605. val);
  606. /* cache flush descriptor type */
  607. val = reo_desc[HAL_OFFSET_DW(REO_FLUSH_CACHE_STATUS_2,
  608. CACHE_CONTROLLER_FLUSH_STATUS_DESC_TYPE)];
  609. st->cache_flush_status_desc_type =
  610. HAL_GET_FIELD(REO_FLUSH_CACHE_STATUS_2,
  611. CACHE_CONTROLLER_FLUSH_STATUS_DESC_TYPE,
  612. val);
  613. /* cache flush count */
  614. val = reo_desc[HAL_OFFSET_DW(REO_FLUSH_CACHE_STATUS_2,
  615. CACHE_CONTROLLER_FLUSH_COUNT)];
  616. st->cache_flush_cnt =
  617. HAL_GET_FIELD(REO_FLUSH_CACHE_STATUS_2,
  618. CACHE_CONTROLLER_FLUSH_COUNT,
  619. val);
  620. }
  621. inline void hal_reo_unblock_cache_status(uint32_t *reo_desc,
  622. struct hal_soc *soc,
  623. struct hal_reo_unblk_cache_status *st)
  624. {
  625. uint32_t val;
  626. /* Offsets of descriptor fields defined in HW headers start
  627. * from the field after TLV header */
  628. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  629. /* header */
  630. HAL_REO_STATUS_GET_HEADER(reo_desc, REO_UNBLOCK_CACHE, st->header);
  631. /* error bit */
  632. val = reo_desc[HAL_OFFSET_DW(REO_UNBLOCK_CACHE_STATUS_2,
  633. ERROR_DETECTED)];
  634. st->error = HAL_GET_FIELD(REO_UNBLOCK_CACHE_STATUS_2,
  635. ERROR_DETECTED,
  636. val);
  637. /* unblock type */
  638. val = reo_desc[HAL_OFFSET_DW(REO_UNBLOCK_CACHE_STATUS_2,
  639. UNBLOCK_TYPE)];
  640. st->unblock_type = HAL_GET_FIELD(REO_UNBLOCK_CACHE_STATUS_2,
  641. UNBLOCK_TYPE,
  642. val);
  643. if (!st->error && (st->unblock_type == UNBLOCK_RES_INDEX))
  644. qdf_clear_bit(soc->index,
  645. (unsigned long *)&soc->reo_res_bitmap);
  646. }
  647. inline void hal_reo_flush_timeout_list_status(
  648. uint32_t *reo_desc,
  649. struct hal_reo_flush_timeout_list_status *st)
  650. {
  651. uint32_t val;
  652. /* Offsets of descriptor fields defined in HW headers start
  653. * from the field after TLV header */
  654. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  655. /* header */
  656. HAL_REO_STATUS_GET_HEADER(reo_desc, REO_FLUSH_TIMEOUT_LIST, st->header);
  657. /* error bit */
  658. val = reo_desc[HAL_OFFSET_DW(REO_FLUSH_TIMEOUT_LIST_STATUS_2,
  659. ERROR_DETECTED)];
  660. st->error = HAL_GET_FIELD(REO_FLUSH_TIMEOUT_LIST_STATUS_2,
  661. ERROR_DETECTED,
  662. val);
  663. /* list empty */
  664. val = reo_desc[HAL_OFFSET_DW(REO_FLUSH_TIMEOUT_LIST_STATUS_2,
  665. TIMOUT_LIST_EMPTY)];
  666. st->list_empty = HAL_GET_FIELD(REO_FLUSH_TIMEOUT_LIST_STATUS_2,
  667. TIMOUT_LIST_EMPTY,
  668. val);
  669. /* release descriptor count */
  670. val = reo_desc[HAL_OFFSET_DW(REO_FLUSH_TIMEOUT_LIST_STATUS_3,
  671. RELEASE_DESC_COUNT)];
  672. st->rel_desc_cnt = HAL_GET_FIELD(REO_FLUSH_TIMEOUT_LIST_STATUS_3,
  673. RELEASE_DESC_COUNT,
  674. val);
  675. /* forward buf count */
  676. val = reo_desc[HAL_OFFSET_DW(REO_FLUSH_TIMEOUT_LIST_STATUS_3,
  677. FORWARD_BUF_COUNT)];
  678. st->fwd_buf_cnt = HAL_GET_FIELD(REO_FLUSH_TIMEOUT_LIST_STATUS_3,
  679. FORWARD_BUF_COUNT,
  680. val);
  681. }
  682. inline void hal_reo_desc_thres_reached_status(
  683. uint32_t *reo_desc,
  684. struct hal_reo_desc_thres_reached_status *st)
  685. {
  686. uint32_t val;
  687. /* Offsets of descriptor fields defined in HW headers start
  688. * from the field after TLV header */
  689. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  690. /* header */
  691. HAL_REO_STATUS_GET_HEADER(reo_desc,
  692. REO_DESCRIPTOR_THRESHOLD_REACHED, st->header);
  693. /* threshold index */
  694. val = reo_desc[HAL_OFFSET_DW(
  695. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_2,
  696. THRESHOLD_INDEX)];
  697. st->thres_index = HAL_GET_FIELD(
  698. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_2,
  699. THRESHOLD_INDEX,
  700. val);
  701. /* link desc counters */
  702. val = reo_desc[HAL_OFFSET_DW(
  703. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_3,
  704. LINK_DESCRIPTOR_COUNTER0)];
  705. st->link_desc_counter0 = HAL_GET_FIELD(
  706. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_3,
  707. LINK_DESCRIPTOR_COUNTER0,
  708. val);
  709. val = reo_desc[HAL_OFFSET_DW(
  710. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_4,
  711. LINK_DESCRIPTOR_COUNTER1)];
  712. st->link_desc_counter1 = HAL_GET_FIELD(
  713. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_4,
  714. LINK_DESCRIPTOR_COUNTER1,
  715. val);
  716. val = reo_desc[HAL_OFFSET_DW(
  717. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_5,
  718. LINK_DESCRIPTOR_COUNTER2)];
  719. st->link_desc_counter2 = HAL_GET_FIELD(
  720. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_5,
  721. LINK_DESCRIPTOR_COUNTER2,
  722. val);
  723. val = reo_desc[HAL_OFFSET_DW(
  724. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_6,
  725. LINK_DESCRIPTOR_COUNTER_SUM)];
  726. st->link_desc_counter_sum = HAL_GET_FIELD(
  727. REO_DESCRIPTOR_THRESHOLD_REACHED_STATUS_6,
  728. LINK_DESCRIPTOR_COUNTER_SUM,
  729. val);
  730. }
  731. inline void hal_reo_rx_update_queue_status(uint32_t *reo_desc,
  732. struct hal_reo_update_rx_queue_status *st)
  733. {
  734. /* Offsets of descriptor fields defined in HW headers start
  735. * from the field after TLV header */
  736. reo_desc += (sizeof(struct tlv_32_hdr) >> 2);
  737. /* header */
  738. HAL_REO_STATUS_GET_HEADER(reo_desc,
  739. REO_UPDATE_RX_REO_QUEUE, st->header);
  740. }
  741. /**
  742. * hal_reo_init_cmd_ring() - Initialize descriptors of REO command SRNG
  743. * with command number
  744. * @hal_soc: Handle to HAL SoC structure
  745. * @hal_ring: Handle to HAL SRNG structure
  746. *
  747. * Return: none
  748. */
  749. inline void hal_reo_init_cmd_ring(struct hal_soc *soc, void *hal_srng)
  750. {
  751. int cmd_num;
  752. uint32_t *desc_addr;
  753. struct hal_srng_params srng_params;
  754. uint32_t desc_size;
  755. uint32_t num_desc;
  756. hal_get_srng_params(soc, hal_srng, &srng_params);
  757. desc_addr = (uint32_t *)(srng_params.ring_base_vaddr);
  758. desc_addr += (sizeof(struct tlv_32_hdr) >> 2);
  759. desc_size = hal_srng_get_entrysize(soc, REO_CMD) >> 2;
  760. num_desc = srng_params.num_entries;
  761. cmd_num = 1;
  762. while (num_desc) {
  763. /* Offsets of descriptor fields defined in HW headers start
  764. * from the field after TLV header */
  765. HAL_DESC_SET_FIELD(desc_addr, UNIFORM_REO_CMD_HEADER_0,
  766. REO_CMD_NUMBER, cmd_num);
  767. desc_addr += desc_size;
  768. num_desc--; cmd_num++;
  769. }
  770. soc->reo_res_bitmap = 0;
  771. }