hal_srng.c 53 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912
  1. /*
  2. * Copyright (c) 2016-2021 The Linux Foundation. All rights reserved.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for
  5. * any purpose with or without fee is hereby granted, provided that the
  6. * above copyright notice and this permission notice appear in all
  7. * copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  10. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  11. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  12. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  13. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  14. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  15. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  16. * PERFORMANCE OF THIS SOFTWARE.
  17. */
  18. #include "hal_hw_headers.h"
  19. #include "hal_api.h"
  20. #include "target_type.h"
  21. #include "wcss_version.h"
  22. #include "qdf_module.h"
  23. #ifdef QCA_WIFI_QCA8074
  24. void hal_qca6290_attach(struct hal_soc *hal);
  25. #endif
  26. #ifdef QCA_WIFI_QCA8074
  27. void hal_qca8074_attach(struct hal_soc *hal);
  28. #endif
  29. #if defined(QCA_WIFI_QCA8074V2) || defined(QCA_WIFI_QCA6018)
  30. void hal_qca8074v2_attach(struct hal_soc *hal);
  31. #endif
  32. #ifdef QCA_WIFI_QCA6390
  33. void hal_qca6390_attach(struct hal_soc *hal);
  34. #endif
  35. #ifdef QCA_WIFI_QCA6490
  36. void hal_qca6490_attach(struct hal_soc *hal);
  37. #endif
  38. #ifdef QCA_WIFI_QCN9000
  39. void hal_qcn9000_attach(struct hal_soc *hal);
  40. #endif
  41. #ifdef QCA_WIFI_QCN6122
  42. void hal_qcn6122_attach(struct hal_soc *hal);
  43. #endif
  44. #ifdef QCA_WIFI_QCA6750
  45. void hal_qca6750_attach(struct hal_soc *hal);
  46. #endif
  47. #ifdef QCA_WIFI_QCA5018
  48. void hal_qca5018_attach(struct hal_soc *hal);
  49. #endif
  50. #ifdef ENABLE_VERBOSE_DEBUG
  51. bool is_hal_verbose_debug_enabled;
  52. #endif
  53. #ifdef ENABLE_HAL_REG_WR_HISTORY
  54. struct hal_reg_write_fail_history hal_reg_wr_hist;
  55. void hal_reg_wr_fail_history_add(struct hal_soc *hal_soc,
  56. uint32_t offset,
  57. uint32_t wr_val, uint32_t rd_val)
  58. {
  59. struct hal_reg_write_fail_entry *record;
  60. int idx;
  61. idx = hal_history_get_next_index(&hal_soc->reg_wr_fail_hist->index,
  62. HAL_REG_WRITE_HIST_SIZE);
  63. record = &hal_soc->reg_wr_fail_hist->record[idx];
  64. record->timestamp = qdf_get_log_timestamp();
  65. record->reg_offset = offset;
  66. record->write_val = wr_val;
  67. record->read_val = rd_val;
  68. }
  69. static void hal_reg_write_fail_history_init(struct hal_soc *hal)
  70. {
  71. hal->reg_wr_fail_hist = &hal_reg_wr_hist;
  72. qdf_atomic_set(&hal->reg_wr_fail_hist->index, -1);
  73. }
  74. #else
  75. static void hal_reg_write_fail_history_init(struct hal_soc *hal)
  76. {
  77. }
  78. #endif
  79. /**
  80. * hal_get_srng_ring_id() - get the ring id of a descriped ring
  81. * @hal: hal_soc data structure
  82. * @ring_type: type enum describing the ring
  83. * @ring_num: which ring of the ring type
  84. * @mac_id: which mac does the ring belong to (or 0 for non-lmac rings)
  85. *
  86. * Return: the ring id or -EINVAL if the ring does not exist.
  87. */
  88. static int hal_get_srng_ring_id(struct hal_soc *hal, int ring_type,
  89. int ring_num, int mac_id)
  90. {
  91. struct hal_hw_srng_config *ring_config =
  92. HAL_SRNG_CONFIG(hal, ring_type);
  93. int ring_id;
  94. if (ring_num >= ring_config->max_rings) {
  95. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO,
  96. "%s: ring_num exceeded maximum no. of supported rings",
  97. __func__);
  98. /* TODO: This is a programming error. Assert if this happens */
  99. return -EINVAL;
  100. }
  101. if (ring_config->lmac_ring) {
  102. ring_id = ring_config->start_ring_id + ring_num +
  103. (mac_id * HAL_MAX_RINGS_PER_LMAC);
  104. } else {
  105. ring_id = ring_config->start_ring_id + ring_num;
  106. }
  107. return ring_id;
  108. }
  109. static struct hal_srng *hal_get_srng(struct hal_soc *hal, int ring_id)
  110. {
  111. /* TODO: Should we allocate srng structures dynamically? */
  112. return &(hal->srng_list[ring_id]);
  113. }
  114. #define HP_OFFSET_IN_REG_START 1
  115. #define OFFSET_FROM_HP_TO_TP 4
  116. static void hal_update_srng_hp_tp_address(struct hal_soc *hal_soc,
  117. int shadow_config_index,
  118. int ring_type,
  119. int ring_num)
  120. {
  121. struct hal_srng *srng;
  122. int ring_id;
  123. struct hal_hw_srng_config *ring_config =
  124. HAL_SRNG_CONFIG(hal_soc, ring_type);
  125. ring_id = hal_get_srng_ring_id(hal_soc, ring_type, ring_num, 0);
  126. if (ring_id < 0)
  127. return;
  128. srng = hal_get_srng(hal_soc, ring_id);
  129. if (ring_config->ring_dir == HAL_SRNG_DST_RING) {
  130. srng->u.dst_ring.tp_addr = SHADOW_REGISTER(shadow_config_index)
  131. + hal_soc->dev_base_addr;
  132. hal_debug("tp_addr=%pK dev base addr %pK index %u",
  133. srng->u.dst_ring.tp_addr, hal_soc->dev_base_addr,
  134. shadow_config_index);
  135. } else {
  136. srng->u.src_ring.hp_addr = SHADOW_REGISTER(shadow_config_index)
  137. + hal_soc->dev_base_addr;
  138. hal_debug("hp_addr=%pK dev base addr %pK index %u",
  139. srng->u.src_ring.hp_addr,
  140. hal_soc->dev_base_addr, shadow_config_index);
  141. }
  142. }
  143. #ifdef GENERIC_SHADOW_REGISTER_ACCESS_ENABLE
  144. void hal_set_one_target_reg_config(struct hal_soc *hal,
  145. uint32_t target_reg_offset,
  146. int list_index)
  147. {
  148. int i = list_index;
  149. qdf_assert_always(i < MAX_GENERIC_SHADOW_REG);
  150. hal->list_shadow_reg_config[i].target_register =
  151. target_reg_offset;
  152. hal->num_generic_shadow_regs_configured++;
  153. }
  154. qdf_export_symbol(hal_set_one_target_reg_config);
  155. #define REO_R0_DESTINATION_RING_CTRL_ADDR_OFFSET 0x4
  156. #define MAX_REO_REMAP_SHADOW_REGS 4
  157. QDF_STATUS hal_set_shadow_regs(void *hal_soc)
  158. {
  159. uint32_t target_reg_offset;
  160. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  161. int i;
  162. struct hal_hw_srng_config *srng_config =
  163. &hal->hw_srng_table[WBM2SW_RELEASE];
  164. target_reg_offset =
  165. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_0_ADDR(
  166. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  167. for (i = 0; i < MAX_REO_REMAP_SHADOW_REGS; i++) {
  168. hal_set_one_target_reg_config(hal, target_reg_offset, i);
  169. target_reg_offset += REO_R0_DESTINATION_RING_CTRL_ADDR_OFFSET;
  170. }
  171. target_reg_offset = srng_config->reg_start[HP_OFFSET_IN_REG_START];
  172. target_reg_offset += (srng_config->reg_size[HP_OFFSET_IN_REG_START]
  173. * HAL_IPA_TX_COMP_RING_IDX);
  174. hal_set_one_target_reg_config(hal, target_reg_offset, i);
  175. return QDF_STATUS_SUCCESS;
  176. }
  177. qdf_export_symbol(hal_set_shadow_regs);
  178. QDF_STATUS hal_construct_shadow_regs(void *hal_soc)
  179. {
  180. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  181. int shadow_config_index = hal->num_shadow_registers_configured;
  182. int i;
  183. int num_regs = hal->num_generic_shadow_regs_configured;
  184. for (i = 0; i < num_regs; i++) {
  185. qdf_assert_always(shadow_config_index < MAX_SHADOW_REGISTERS);
  186. hal->shadow_config[shadow_config_index].addr =
  187. hal->list_shadow_reg_config[i].target_register;
  188. hal->list_shadow_reg_config[i].shadow_config_index =
  189. shadow_config_index;
  190. hal->list_shadow_reg_config[i].va =
  191. SHADOW_REGISTER(shadow_config_index) +
  192. (uintptr_t)hal->dev_base_addr;
  193. hal_debug("target_reg %x, shadow register 0x%x shadow_index 0x%x",
  194. hal->shadow_config[shadow_config_index].addr,
  195. SHADOW_REGISTER(shadow_config_index),
  196. shadow_config_index);
  197. shadow_config_index++;
  198. hal->num_shadow_registers_configured++;
  199. }
  200. return QDF_STATUS_SUCCESS;
  201. }
  202. qdf_export_symbol(hal_construct_shadow_regs);
  203. #endif
  204. QDF_STATUS hal_set_one_shadow_config(void *hal_soc,
  205. int ring_type,
  206. int ring_num)
  207. {
  208. uint32_t target_register;
  209. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  210. struct hal_hw_srng_config *srng_config = &hal->hw_srng_table[ring_type];
  211. int shadow_config_index = hal->num_shadow_registers_configured;
  212. if (shadow_config_index >= MAX_SHADOW_REGISTERS) {
  213. QDF_ASSERT(0);
  214. return QDF_STATUS_E_RESOURCES;
  215. }
  216. hal->num_shadow_registers_configured++;
  217. target_register = srng_config->reg_start[HP_OFFSET_IN_REG_START];
  218. target_register += (srng_config->reg_size[HP_OFFSET_IN_REG_START]
  219. *ring_num);
  220. /* if the ring is a dst ring, we need to shadow the tail pointer */
  221. if (srng_config->ring_dir == HAL_SRNG_DST_RING)
  222. target_register += OFFSET_FROM_HP_TO_TP;
  223. hal->shadow_config[shadow_config_index].addr = target_register;
  224. /* update hp/tp addr in the hal_soc structure*/
  225. hal_update_srng_hp_tp_address(hal_soc, shadow_config_index, ring_type,
  226. ring_num);
  227. hal_debug("target_reg %x, shadow register 0x%x shadow_index 0x%x, ring_type %d, ring num %d",
  228. target_register,
  229. SHADOW_REGISTER(shadow_config_index),
  230. shadow_config_index,
  231. ring_type, ring_num);
  232. return QDF_STATUS_SUCCESS;
  233. }
  234. qdf_export_symbol(hal_set_one_shadow_config);
  235. QDF_STATUS hal_construct_srng_shadow_regs(void *hal_soc)
  236. {
  237. int ring_type, ring_num;
  238. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  239. for (ring_type = 0; ring_type < MAX_RING_TYPES; ring_type++) {
  240. struct hal_hw_srng_config *srng_config =
  241. &hal->hw_srng_table[ring_type];
  242. if (ring_type == CE_SRC ||
  243. ring_type == CE_DST ||
  244. ring_type == CE_DST_STATUS)
  245. continue;
  246. if (srng_config->lmac_ring)
  247. continue;
  248. for (ring_num = 0; ring_num < srng_config->max_rings;
  249. ring_num++)
  250. hal_set_one_shadow_config(hal_soc, ring_type, ring_num);
  251. }
  252. return QDF_STATUS_SUCCESS;
  253. }
  254. qdf_export_symbol(hal_construct_srng_shadow_regs);
  255. void hal_get_shadow_config(void *hal_soc,
  256. struct pld_shadow_reg_v2_cfg **shadow_config,
  257. int *num_shadow_registers_configured)
  258. {
  259. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  260. *shadow_config = hal->shadow_config;
  261. *num_shadow_registers_configured =
  262. hal->num_shadow_registers_configured;
  263. }
  264. qdf_export_symbol(hal_get_shadow_config);
  265. static void hal_validate_shadow_register(struct hal_soc *hal,
  266. uint32_t *destination,
  267. uint32_t *shadow_address)
  268. {
  269. unsigned int index;
  270. uint32_t *shadow_0_offset = SHADOW_REGISTER(0) + hal->dev_base_addr;
  271. int destination_ba_offset =
  272. ((char *)destination) - (char *)hal->dev_base_addr;
  273. index = shadow_address - shadow_0_offset;
  274. if (index >= MAX_SHADOW_REGISTERS) {
  275. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  276. "%s: index %x out of bounds", __func__, index);
  277. goto error;
  278. } else if (hal->shadow_config[index].addr != destination_ba_offset) {
  279. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  280. "%s: sanity check failure, expected %x, found %x",
  281. __func__, destination_ba_offset,
  282. hal->shadow_config[index].addr);
  283. goto error;
  284. }
  285. return;
  286. error:
  287. qdf_print("baddr %pK, desination %pK, shadow_address %pK s0offset %pK index %x",
  288. hal->dev_base_addr, destination, shadow_address,
  289. shadow_0_offset, index);
  290. QDF_BUG(0);
  291. return;
  292. }
  293. static void hal_target_based_configure(struct hal_soc *hal)
  294. {
  295. /**
  296. * Indicate Initialization of srngs to avoid force wake
  297. * as umac power collapse is not enabled yet
  298. */
  299. hal->init_phase = true;
  300. switch (hal->target_type) {
  301. #ifdef QCA_WIFI_QCA6290
  302. case TARGET_TYPE_QCA6290:
  303. hal->use_register_windowing = true;
  304. hal_qca6290_attach(hal);
  305. break;
  306. #endif
  307. #ifdef QCA_WIFI_QCA6390
  308. case TARGET_TYPE_QCA6390:
  309. hal->use_register_windowing = true;
  310. hal_qca6390_attach(hal);
  311. break;
  312. #endif
  313. #ifdef QCA_WIFI_QCA6490
  314. case TARGET_TYPE_QCA6490:
  315. hal->use_register_windowing = true;
  316. hal_qca6490_attach(hal);
  317. break;
  318. #endif
  319. #ifdef QCA_WIFI_QCA6750
  320. case TARGET_TYPE_QCA6750:
  321. hal->use_register_windowing = true;
  322. hal->static_window_map = true;
  323. hal_qca6750_attach(hal);
  324. break;
  325. #endif
  326. #if defined(QCA_WIFI_QCA8074) && defined(WIFI_TARGET_TYPE_3_0)
  327. case TARGET_TYPE_QCA8074:
  328. hal_qca8074_attach(hal);
  329. break;
  330. #endif
  331. #if defined(QCA_WIFI_QCA8074V2)
  332. case TARGET_TYPE_QCA8074V2:
  333. hal_qca8074v2_attach(hal);
  334. break;
  335. #endif
  336. #if defined(QCA_WIFI_QCA6018)
  337. case TARGET_TYPE_QCA6018:
  338. hal_qca8074v2_attach(hal);
  339. break;
  340. #endif
  341. #if defined(QCA_WIFI_QCN6122)
  342. case TARGET_TYPE_QCN6122:
  343. hal->use_register_windowing = true;
  344. /*
  345. * Static window map is enabled for qcn9000 to use 2mb bar
  346. * size and use multiple windows to write into registers.
  347. */
  348. hal->static_window_map = true;
  349. hal_qcn6122_attach(hal);
  350. break;
  351. #endif
  352. #ifdef QCA_WIFI_QCN9000
  353. case TARGET_TYPE_QCN9000:
  354. hal->use_register_windowing = true;
  355. /*
  356. * Static window map is enabled for qcn9000 to use 2mb bar
  357. * size and use multiple windows to write into registers.
  358. */
  359. hal->static_window_map = true;
  360. hal_qcn9000_attach(hal);
  361. break;
  362. #endif
  363. #ifdef QCA_WIFI_QCA5018
  364. case TARGET_TYPE_QCA5018:
  365. hal->use_register_windowing = true;
  366. hal->static_window_map = true;
  367. hal_qca5018_attach(hal);
  368. break;
  369. #endif
  370. default:
  371. break;
  372. }
  373. }
  374. uint32_t hal_get_target_type(hal_soc_handle_t hal_soc_hdl)
  375. {
  376. struct hal_soc *hal_soc = (struct hal_soc *)hal_soc_hdl;
  377. struct hif_target_info *tgt_info =
  378. hif_get_target_info_handle(hal_soc->hif_handle);
  379. return tgt_info->target_type;
  380. }
  381. qdf_export_symbol(hal_get_target_type);
  382. #if defined(FEATURE_HAL_DELAYED_REG_WRITE) || \
  383. defined(FEATURE_HAL_DELAYED_REG_WRITE_V2)
  384. /**
  385. * hal_is_reg_write_tput_level_high() - throughput level for delayed reg writes
  386. * @hal: hal_soc pointer
  387. *
  388. * Return: true if throughput is high, else false.
  389. */
  390. static inline bool hal_is_reg_write_tput_level_high(struct hal_soc *hal)
  391. {
  392. int bw_level = hif_get_bandwidth_level(hal->hif_handle);
  393. return (bw_level >= PLD_BUS_WIDTH_MEDIUM) ? true : false;
  394. }
  395. static inline
  396. char *hal_fill_reg_write_srng_stats(struct hal_srng *srng,
  397. char *buf, qdf_size_t size)
  398. {
  399. qdf_scnprintf(buf, size, "enq %u deq %u coal %u direct %u",
  400. srng->wstats.enqueues, srng->wstats.dequeues,
  401. srng->wstats.coalesces, srng->wstats.direct);
  402. return buf;
  403. }
  404. /* bytes for local buffer */
  405. #define HAL_REG_WRITE_SRNG_STATS_LEN 100
  406. void hal_dump_reg_write_srng_stats(hal_soc_handle_t hal_soc_hdl)
  407. {
  408. struct hal_srng *srng;
  409. char buf[HAL_REG_WRITE_SRNG_STATS_LEN];
  410. struct hal_soc *hal = (struct hal_soc *)hal_soc_hdl;
  411. srng = hal_get_srng(hal, HAL_SRNG_SW2TCL1);
  412. hal_debug("SW2TCL1: %s",
  413. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  414. srng = hal_get_srng(hal, HAL_SRNG_WBM2SW0_RELEASE);
  415. hal_debug("WBM2SW0: %s",
  416. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  417. srng = hal_get_srng(hal, HAL_SRNG_REO2SW1);
  418. hal_debug("REO2SW1: %s",
  419. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  420. srng = hal_get_srng(hal, HAL_SRNG_REO2SW2);
  421. hal_debug("REO2SW2: %s",
  422. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  423. srng = hal_get_srng(hal, HAL_SRNG_REO2SW3);
  424. hal_debug("REO2SW3: %s",
  425. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  426. }
  427. #ifdef FEATURE_HAL_DELAYED_REG_WRITE_V2
  428. /**
  429. * hal_dump_tcl_stats() - dump the TCL reg write stats
  430. * @hal: hal_soc pointer
  431. *
  432. * Return: None
  433. */
  434. static inline void hal_dump_tcl_stats(struct hal_soc *hal)
  435. {
  436. struct hal_srng *srng = hal_get_srng(hal, HAL_SRNG_SW2TCL1);
  437. uint32_t *hist = hal->tcl_stats.sched_delay;
  438. char buf[HAL_REG_WRITE_SRNG_STATS_LEN];
  439. hal_debug("TCL: %s sched-delay hist %u %u %u %u",
  440. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)),
  441. hist[REG_WRITE_SCHED_DELAY_SUB_100us],
  442. hist[REG_WRITE_SCHED_DELAY_SUB_1000us],
  443. hist[REG_WRITE_SCHED_DELAY_SUB_5000us],
  444. hist[REG_WRITE_SCHED_DELAY_GT_5000us]);
  445. hal_debug("wq_dly %u wq_dir %u tim_enq %u tim_dir %u enq_tim_cnt %u dir_tim_cnt %u rst_tim_cnt %u",
  446. hal->tcl_stats.wq_delayed,
  447. hal->tcl_stats.wq_direct,
  448. hal->tcl_stats.timer_enq,
  449. hal->tcl_stats.timer_direct,
  450. hal->tcl_stats.enq_timer_set,
  451. hal->tcl_stats.direct_timer_set,
  452. hal->tcl_stats.timer_reset);
  453. }
  454. #else
  455. static inline void hal_dump_tcl_stats(struct hal_soc *hal)
  456. {
  457. }
  458. #endif
  459. void hal_dump_reg_write_stats(hal_soc_handle_t hal_soc_hdl)
  460. {
  461. uint32_t *hist;
  462. struct hal_soc *hal = (struct hal_soc *)hal_soc_hdl;
  463. hist = hal->stats.wstats.sched_delay;
  464. hal_debug("wstats: enq %u deq %u coal %u direct %u q_depth %u max_q %u sched-delay hist %u %u %u %u",
  465. qdf_atomic_read(&hal->stats.wstats.enqueues),
  466. hal->stats.wstats.dequeues,
  467. qdf_atomic_read(&hal->stats.wstats.coalesces),
  468. qdf_atomic_read(&hal->stats.wstats.direct),
  469. qdf_atomic_read(&hal->stats.wstats.q_depth),
  470. hal->stats.wstats.max_q_depth,
  471. hist[REG_WRITE_SCHED_DELAY_SUB_100us],
  472. hist[REG_WRITE_SCHED_DELAY_SUB_1000us],
  473. hist[REG_WRITE_SCHED_DELAY_SUB_5000us],
  474. hist[REG_WRITE_SCHED_DELAY_GT_5000us]);
  475. hal_dump_tcl_stats(hal);
  476. }
  477. int hal_get_reg_write_pending_work(void *hal_soc)
  478. {
  479. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  480. return qdf_atomic_read(&hal->active_work_cnt);
  481. }
  482. #endif
  483. #ifdef FEATURE_HAL_DELAYED_REG_WRITE
  484. #ifdef MEMORY_DEBUG
  485. /*
  486. * Length of the queue(array) used to hold delayed register writes.
  487. * Must be a multiple of 2.
  488. */
  489. #define HAL_REG_WRITE_QUEUE_LEN 128
  490. #else
  491. #define HAL_REG_WRITE_QUEUE_LEN 32
  492. #endif
  493. #ifdef FEATURE_HAL_DELAYED_REG_WRITE_V2
  494. /**
  495. * hal_process_reg_write_q_elem() - process a regiter write queue element
  496. * @hal: hal_soc pointer
  497. * @q_elem: pointer to hal regiter write queue element
  498. *
  499. * Return: The value which was written to the address
  500. */
  501. static uint32_t
  502. hal_process_reg_write_q_elem(struct hal_soc *hal,
  503. struct hal_reg_write_q_elem *q_elem)
  504. {
  505. struct hal_srng *srng = q_elem->srng;
  506. uint32_t write_val;
  507. SRNG_LOCK(&srng->lock);
  508. srng->reg_write_in_progress = false;
  509. srng->wstats.dequeues++;
  510. if (srng->ring_dir == HAL_SRNG_SRC_RING) {
  511. write_val = srng->u.src_ring.hp;
  512. q_elem->dequeue_val = write_val;
  513. q_elem->valid = 0;
  514. SRNG_UNLOCK(&srng->lock);
  515. hal_write_address_32_mb(hal,
  516. srng->u.src_ring.hp_addr,
  517. write_val, false);
  518. } else {
  519. write_val = srng->u.dst_ring.tp;
  520. q_elem->dequeue_val = write_val;
  521. q_elem->valid = 0;
  522. SRNG_UNLOCK(&srng->lock);
  523. hal_write_address_32_mb(hal,
  524. srng->u.dst_ring.tp_addr,
  525. write_val, false);
  526. }
  527. return write_val;
  528. }
  529. #else
  530. /**
  531. * hal_process_reg_write_q_elem() - process a regiter write queue element
  532. * @hal: hal_soc pointer
  533. * @q_elem: pointer to hal regiter write queue element
  534. *
  535. * Return: The value which was written to the address
  536. */
  537. static uint32_t
  538. hal_process_reg_write_q_elem(struct hal_soc *hal,
  539. struct hal_reg_write_q_elem *q_elem)
  540. {
  541. struct hal_srng *srng = q_elem->srng;
  542. uint32_t write_val;
  543. SRNG_LOCK(&srng->lock);
  544. srng->reg_write_in_progress = false;
  545. srng->wstats.dequeues++;
  546. if (srng->ring_dir == HAL_SRNG_SRC_RING) {
  547. q_elem->dequeue_val = srng->u.src_ring.hp;
  548. hal_write_address_32_mb(hal,
  549. srng->u.src_ring.hp_addr,
  550. srng->u.src_ring.hp, false);
  551. write_val = srng->u.src_ring.hp;
  552. } else {
  553. q_elem->dequeue_val = srng->u.dst_ring.tp;
  554. hal_write_address_32_mb(hal,
  555. srng->u.dst_ring.tp_addr,
  556. srng->u.dst_ring.tp, false);
  557. write_val = srng->u.dst_ring.tp;
  558. }
  559. q_elem->valid = 0;
  560. SRNG_UNLOCK(&srng->lock);
  561. return write_val;
  562. }
  563. #endif
  564. /**
  565. * hal_reg_write_fill_sched_delay_hist() - fill reg write delay histogram in hal
  566. * @hal: hal_soc pointer
  567. * @delay: delay in us
  568. *
  569. * Return: None
  570. */
  571. static inline void hal_reg_write_fill_sched_delay_hist(struct hal_soc *hal,
  572. uint64_t delay_us)
  573. {
  574. uint32_t *hist;
  575. hist = hal->stats.wstats.sched_delay;
  576. if (delay_us < 100)
  577. hist[REG_WRITE_SCHED_DELAY_SUB_100us]++;
  578. else if (delay_us < 1000)
  579. hist[REG_WRITE_SCHED_DELAY_SUB_1000us]++;
  580. else if (delay_us < 5000)
  581. hist[REG_WRITE_SCHED_DELAY_SUB_5000us]++;
  582. else
  583. hist[REG_WRITE_SCHED_DELAY_GT_5000us]++;
  584. }
  585. /**
  586. * hal_reg_write_work() - Worker to process delayed writes
  587. * @arg: hal_soc pointer
  588. *
  589. * Return: None
  590. */
  591. static void hal_reg_write_work(void *arg)
  592. {
  593. int32_t q_depth, write_val;
  594. struct hal_soc *hal = arg;
  595. struct hal_reg_write_q_elem *q_elem;
  596. uint64_t delta_us;
  597. uint8_t ring_id;
  598. uint32_t *addr;
  599. uint32_t num_processed = 0;
  600. q_elem = &hal->reg_write_queue[(hal->read_idx)];
  601. q_elem->work_scheduled_time = qdf_get_log_timestamp();
  602. /* Make sure q_elem consistent in the memory for multi-cores */
  603. qdf_rmb();
  604. if (!q_elem->valid)
  605. return;
  606. q_depth = qdf_atomic_read(&hal->stats.wstats.q_depth);
  607. if (q_depth > hal->stats.wstats.max_q_depth)
  608. hal->stats.wstats.max_q_depth = q_depth;
  609. if (hif_prevent_link_low_power_states(hal->hif_handle)) {
  610. hal->stats.wstats.prevent_l1_fails++;
  611. return;
  612. }
  613. while (true) {
  614. qdf_rmb();
  615. if (!q_elem->valid)
  616. break;
  617. q_elem->dequeue_time = qdf_get_log_timestamp();
  618. ring_id = q_elem->srng->ring_id;
  619. addr = q_elem->addr;
  620. delta_us = qdf_log_timestamp_to_usecs(q_elem->dequeue_time -
  621. q_elem->enqueue_time);
  622. hal_reg_write_fill_sched_delay_hist(hal, delta_us);
  623. hal->stats.wstats.dequeues++;
  624. qdf_atomic_dec(&hal->stats.wstats.q_depth);
  625. write_val = hal_process_reg_write_q_elem(hal, q_elem);
  626. hal_verbose_debug("read_idx %u srng 0x%x, addr 0x%pK dequeue_val %u sched delay %llu us",
  627. hal->read_idx, ring_id, addr, write_val, delta_us);
  628. num_processed++;
  629. hal->read_idx = (hal->read_idx + 1) &
  630. (HAL_REG_WRITE_QUEUE_LEN - 1);
  631. q_elem = &hal->reg_write_queue[(hal->read_idx)];
  632. }
  633. hif_allow_link_low_power_states(hal->hif_handle);
  634. /*
  635. * Decrement active_work_cnt by the number of elements dequeued after
  636. * hif_allow_link_low_power_states.
  637. * This makes sure that hif_try_complete_tasks will wait till we make
  638. * the bus access in hif_allow_link_low_power_states. This will avoid
  639. * race condition between delayed register worker and bus suspend
  640. * (system suspend or runtime suspend).
  641. *
  642. * The following decrement should be done at the end!
  643. */
  644. qdf_atomic_sub(num_processed, &hal->active_work_cnt);
  645. }
  646. static void __hal_flush_reg_write_work(struct hal_soc *hal)
  647. {
  648. qdf_cancel_work(&hal->reg_write_work);
  649. }
  650. void hal_flush_reg_write_work(hal_soc_handle_t hal_handle)
  651. { __hal_flush_reg_write_work((struct hal_soc *)hal_handle);
  652. }
  653. /**
  654. * hal_reg_write_enqueue() - enqueue register writes into kworker
  655. * @hal_soc: hal_soc pointer
  656. * @srng: srng pointer
  657. * @addr: iomem address of regiter
  658. * @value: value to be written to iomem address
  659. *
  660. * This function executes from within the SRNG LOCK
  661. *
  662. * Return: None
  663. */
  664. static void hal_reg_write_enqueue(struct hal_soc *hal_soc,
  665. struct hal_srng *srng,
  666. void __iomem *addr,
  667. uint32_t value)
  668. {
  669. struct hal_reg_write_q_elem *q_elem;
  670. uint32_t write_idx;
  671. if (srng->reg_write_in_progress) {
  672. hal_verbose_debug("Already in progress srng ring id 0x%x addr 0x%pK val %u",
  673. srng->ring_id, addr, value);
  674. qdf_atomic_inc(&hal_soc->stats.wstats.coalesces);
  675. srng->wstats.coalesces++;
  676. return;
  677. }
  678. write_idx = qdf_atomic_inc_return(&hal_soc->write_idx);
  679. write_idx = write_idx & (HAL_REG_WRITE_QUEUE_LEN - 1);
  680. q_elem = &hal_soc->reg_write_queue[write_idx];
  681. if (q_elem->valid) {
  682. hal_err("queue full");
  683. QDF_BUG(0);
  684. return;
  685. }
  686. qdf_atomic_inc(&hal_soc->stats.wstats.enqueues);
  687. srng->wstats.enqueues++;
  688. qdf_atomic_inc(&hal_soc->stats.wstats.q_depth);
  689. q_elem->srng = srng;
  690. q_elem->addr = addr;
  691. q_elem->enqueue_val = value;
  692. q_elem->enqueue_time = qdf_get_log_timestamp();
  693. /*
  694. * Before the valid flag is set to true, all the other
  695. * fields in the q_elem needs to be updated in memory.
  696. * Else there is a chance that the dequeuing worker thread
  697. * might read stale entries and process incorrect srng.
  698. */
  699. qdf_wmb();
  700. q_elem->valid = true;
  701. /*
  702. * After all other fields in the q_elem has been updated
  703. * in memory successfully, the valid flag needs to be updated
  704. * in memory in time too.
  705. * Else there is a chance that the dequeuing worker thread
  706. * might read stale valid flag and the work will be bypassed
  707. * for this round. And if there is no other work scheduled
  708. * later, this hal register writing won't be updated any more.
  709. */
  710. qdf_wmb();
  711. srng->reg_write_in_progress = true;
  712. qdf_atomic_inc(&hal_soc->active_work_cnt);
  713. hal_verbose_debug("write_idx %u srng ring id 0x%x addr 0x%pK val %u",
  714. write_idx, srng->ring_id, addr, value);
  715. qdf_queue_work(hal_soc->qdf_dev, hal_soc->reg_write_wq,
  716. &hal_soc->reg_write_work);
  717. }
  718. /**
  719. * hal_delayed_reg_write_init() - Initialization function for delayed reg writes
  720. * @hal_soc: hal_soc pointer
  721. *
  722. * Initialize main data structures to process register writes in a delayed
  723. * workqueue.
  724. *
  725. * Return: QDF_STATUS_SUCCESS on success else a QDF error.
  726. */
  727. static QDF_STATUS hal_delayed_reg_write_init(struct hal_soc *hal)
  728. {
  729. hal->reg_write_wq =
  730. qdf_alloc_high_prior_ordered_workqueue("hal_register_write_wq");
  731. qdf_create_work(0, &hal->reg_write_work, hal_reg_write_work, hal);
  732. hal->reg_write_queue = qdf_mem_malloc(HAL_REG_WRITE_QUEUE_LEN *
  733. sizeof(*hal->reg_write_queue));
  734. if (!hal->reg_write_queue) {
  735. hal_err("unable to allocate memory");
  736. QDF_BUG(0);
  737. return QDF_STATUS_E_NOMEM;
  738. }
  739. /* Initial value of indices */
  740. hal->read_idx = 0;
  741. qdf_atomic_set(&hal->write_idx, -1);
  742. return QDF_STATUS_SUCCESS;
  743. }
  744. /**
  745. * hal_delayed_reg_write_deinit() - De-Initialize delayed reg write processing
  746. * @hal_soc: hal_soc pointer
  747. *
  748. * De-initialize main data structures to process register writes in a delayed
  749. * workqueue.
  750. *
  751. * Return: None
  752. */
  753. static void hal_delayed_reg_write_deinit(struct hal_soc *hal)
  754. {
  755. __hal_flush_reg_write_work(hal);
  756. qdf_flush_workqueue(0, hal->reg_write_wq);
  757. qdf_destroy_workqueue(0, hal->reg_write_wq);
  758. qdf_mem_free(hal->reg_write_queue);
  759. }
  760. #else
  761. static inline QDF_STATUS hal_delayed_reg_write_init(struct hal_soc *hal)
  762. {
  763. return QDF_STATUS_SUCCESS;
  764. }
  765. static inline void hal_delayed_reg_write_deinit(struct hal_soc *hal)
  766. {
  767. }
  768. #endif
  769. #ifdef FEATURE_HAL_DELAYED_REG_WRITE_V2
  770. #ifdef MEMORY_DEBUG
  771. /**
  772. * hal_reg_write_get_timestamp() - Function to get the timestamp
  773. *
  774. * Return: return present simestamp
  775. */
  776. static inline qdf_time_t hal_del_reg_write_get_ts(void)
  777. {
  778. return qdf_get_log_timestamp();
  779. }
  780. /**
  781. * hal_del_reg_write_ts_usecs() - Convert the timestamp to micro secs
  782. * @ts: timestamp value to be converted
  783. *
  784. * Return: return the timestamp in micro secs
  785. */
  786. static inline qdf_time_t hal_del_reg_write_ts_usecs(qdf_time_t ts)
  787. {
  788. return qdf_log_timestamp_to_usecs(ts);
  789. }
  790. /**
  791. * hal_tcl_write_fill_sched_delay_hist() - fill TCL reg write delay histogram
  792. * @hal: hal_soc pointer
  793. * @delay: delay in us
  794. *
  795. * Return: None
  796. */
  797. static inline void hal_tcl_write_fill_sched_delay_hist(struct hal_soc *hal)
  798. {
  799. uint32_t *hist;
  800. uint32_t delay_us;
  801. hal->tcl_stats.deq_time = hal_del_reg_write_get_ts();
  802. delay_us = hal_del_reg_write_ts_usecs(hal->tcl_stats.deq_time -
  803. hal->tcl_stats.enq_time);
  804. hist = hal->tcl_stats.sched_delay;
  805. if (delay_us < 100)
  806. hist[REG_WRITE_SCHED_DELAY_SUB_100us]++;
  807. else if (delay_us < 1000)
  808. hist[REG_WRITE_SCHED_DELAY_SUB_1000us]++;
  809. else if (delay_us < 5000)
  810. hist[REG_WRITE_SCHED_DELAY_SUB_5000us]++;
  811. else
  812. hist[REG_WRITE_SCHED_DELAY_GT_5000us]++;
  813. }
  814. #else
  815. static inline qdf_time_t hal_del_reg_write_get_ts(void)
  816. {
  817. return 0;
  818. }
  819. static inline qdf_time_t hal_del_reg_write_ts_usecs(qdf_time_t ts)
  820. {
  821. return 0;
  822. }
  823. static inline void hal_tcl_write_fill_sched_delay_hist(struct hal_soc *hal)
  824. {
  825. }
  826. #endif
  827. /**
  828. * hal_tcl_reg_write_work() - Worker to process delayed SW2TCL1 writes
  829. * @arg: hal_soc pointer
  830. *
  831. * Return: None
  832. */
  833. static void hal_tcl_reg_write_work(void *arg)
  834. {
  835. struct hal_soc *hal = arg;
  836. struct hal_srng *srng = hal_get_srng(hal, HAL_SRNG_SW2TCL1);
  837. SRNG_LOCK(&srng->lock);
  838. srng->wstats.dequeues++;
  839. hal_tcl_write_fill_sched_delay_hist(hal);
  840. /*
  841. * During the tranition of low to high tput scenario, reg write moves
  842. * from delayed to direct write context, there is a little chance that
  843. * worker thread gets scheduled later than direct context write which
  844. * already wrote the latest HP value. This check can catch that case
  845. * and avoid the repetitive writing of the same HP value.
  846. */
  847. if (srng->last_reg_wr_val != srng->u.src_ring.hp) {
  848. srng->last_reg_wr_val = srng->u.src_ring.hp;
  849. if (hal->tcl_direct) {
  850. /*
  851. * TCL reg writes have been moved to direct context and
  852. * the assumption is that PCIe bus stays in Active state
  853. * during high tput, hence its fine to write the HP
  854. * while the SRNG_LOCK is being held.
  855. */
  856. hal->tcl_stats.wq_direct++;
  857. hal_write_address_32_mb(hal, srng->u.src_ring.hp_addr,
  858. srng->last_reg_wr_val, false);
  859. srng->reg_write_in_progress = false;
  860. SRNG_UNLOCK(&srng->lock);
  861. } else {
  862. /*
  863. * TCL reg write to happen in delayed context,
  864. * write operation might take time due to possibility of
  865. * PCIe bus stays in low power state during low tput,
  866. * Hence release the SRNG_LOCK before writing.
  867. */
  868. hal->tcl_stats.wq_delayed++;
  869. srng->reg_write_in_progress = false;
  870. SRNG_UNLOCK(&srng->lock);
  871. hal_write_address_32_mb(hal, srng->u.src_ring.hp_addr,
  872. srng->last_reg_wr_val, false);
  873. }
  874. } else {
  875. srng->reg_write_in_progress = false;
  876. SRNG_UNLOCK(&srng->lock);
  877. }
  878. /*
  879. * Decrement active_work_cnt to make sure that hif_try_complete_tasks
  880. * will wait. This will avoid race condition between delayed register
  881. * worker and bus suspend (system suspend or runtime suspend).
  882. *
  883. * The following decrement should be done at the end!
  884. */
  885. qdf_atomic_dec(&hal->active_work_cnt);
  886. qdf_atomic_set(&hal->tcl_work_active, false);
  887. }
  888. static void __hal_flush_tcl_reg_write_work(struct hal_soc *hal)
  889. {
  890. qdf_cancel_work(&hal->tcl_reg_write_work);
  891. }
  892. /**
  893. * hal_tcl_reg_write_enqueue() - enqueue TCL register writes into kworker
  894. * @hal_soc: hal_soc pointer
  895. * @srng: srng pointer
  896. * @addr: iomem address of regiter
  897. * @value: value to be written to iomem address
  898. *
  899. * This function executes from within the SRNG LOCK
  900. *
  901. * Return: None
  902. */
  903. static void hal_tcl_reg_write_enqueue(struct hal_soc *hal_soc,
  904. struct hal_srng *srng,
  905. void __iomem *addr,
  906. uint32_t value)
  907. {
  908. hal_soc->tcl_stats.enq_time = hal_del_reg_write_get_ts();
  909. if (qdf_queue_work(hal_soc->qdf_dev, hal_soc->tcl_reg_write_wq,
  910. &hal_soc->tcl_reg_write_work)) {
  911. srng->reg_write_in_progress = true;
  912. qdf_atomic_inc(&hal_soc->active_work_cnt);
  913. qdf_atomic_set(&hal_soc->tcl_work_active, true);
  914. srng->wstats.enqueues++;
  915. } else {
  916. hal_soc->tcl_stats.enq_timer_set++;
  917. qdf_timer_mod(&hal_soc->tcl_reg_write_timer, 1);
  918. }
  919. }
  920. /**
  921. * hal_tcl_reg_write_timer() - timer handler to take care of pending TCL writes
  922. * @arg: srng handle
  923. *
  924. * This function handles the pending TCL reg writes missed due to the previous
  925. * scheduled worker running.
  926. *
  927. * Return: None
  928. */
  929. static void hal_tcl_reg_write_timer(void *arg)
  930. {
  931. hal_ring_handle_t srng_hdl = arg;
  932. struct hal_srng *srng;
  933. struct hal_soc *hal;
  934. srng = (struct hal_srng *)srng_hdl;
  935. hal = srng->hal_soc;
  936. if (hif_pm_runtime_get(hal->hif_handle, RTPM_ID_DW_TX_HW_ENQUEUE,
  937. true)) {
  938. hal_srng_set_event(srng_hdl, HAL_SRNG_FLUSH_EVENT);
  939. hal_srng_inc_flush_cnt(srng_hdl);
  940. goto fail;
  941. }
  942. SRNG_LOCK(&srng->lock);
  943. if (hal->tcl_direct) {
  944. /*
  945. * Due to the previous scheduled worker still running,
  946. * direct reg write cannot be performed, so posted the
  947. * pending writes to timer context.
  948. */
  949. if (srng->last_reg_wr_val != srng->u.src_ring.hp) {
  950. srng->last_reg_wr_val = srng->u.src_ring.hp;
  951. srng->wstats.direct++;
  952. hal->tcl_stats.timer_direct++;
  953. hal_write_address_32_mb(hal, srng->u.src_ring.hp_addr,
  954. srng->last_reg_wr_val, false);
  955. }
  956. } else {
  957. /*
  958. * Due to the previous scheduled worker still running,
  959. * queue_work from delayed context would fail,
  960. * so retry from timer context.
  961. */
  962. if (qdf_queue_work(hal->qdf_dev, hal->tcl_reg_write_wq,
  963. &hal->tcl_reg_write_work)) {
  964. srng->reg_write_in_progress = true;
  965. qdf_atomic_inc(&hal->active_work_cnt);
  966. qdf_atomic_set(&hal->tcl_work_active, true);
  967. srng->wstats.enqueues++;
  968. hal->tcl_stats.timer_enq++;
  969. } else {
  970. if (srng->last_reg_wr_val != srng->u.src_ring.hp) {
  971. hal->tcl_stats.timer_reset++;
  972. qdf_timer_mod(&hal->tcl_reg_write_timer, 1);
  973. }
  974. }
  975. }
  976. SRNG_UNLOCK(&srng->lock);
  977. hif_pm_runtime_put(hal->hif_handle, RTPM_ID_DW_TX_HW_ENQUEUE);
  978. fail:
  979. return;
  980. }
  981. /**
  982. * hal_delayed_tcl_reg_write_init() - Initialization for delayed TCL reg writes
  983. * @hal_soc: hal_soc pointer
  984. *
  985. * Initialize main data structures to process TCL register writes in a delayed
  986. * workqueue.
  987. *
  988. * Return: QDF_STATUS_SUCCESS on success else a QDF error.
  989. */
  990. static QDF_STATUS hal_delayed_tcl_reg_write_init(struct hal_soc *hal)
  991. {
  992. struct hal_srng *srng = hal_get_srng(hal, HAL_SRNG_SW2TCL1);
  993. QDF_STATUS status;
  994. hal->tcl_reg_write_wq =
  995. qdf_alloc_high_prior_ordered_workqueue("hal_tcl_reg_write_wq");
  996. if (!hal->tcl_reg_write_wq) {
  997. hal_err("hal_tcl_reg_write_wq alloc failed");
  998. return QDF_STATUS_E_NOMEM;
  999. }
  1000. status = qdf_create_work(0, &hal->tcl_reg_write_work,
  1001. hal_tcl_reg_write_work, hal);
  1002. if (status != QDF_STATUS_SUCCESS) {
  1003. hal_err("tcl_reg_write_work create failed");
  1004. goto fail;
  1005. }
  1006. status = qdf_timer_init(hal->qdf_dev, &hal->tcl_reg_write_timer,
  1007. hal_tcl_reg_write_timer, (void *)srng,
  1008. QDF_TIMER_TYPE_WAKE_APPS);
  1009. if (status != QDF_STATUS_SUCCESS) {
  1010. hal_err("tcl_reg_write_timer init failed");
  1011. goto fail;
  1012. }
  1013. qdf_atomic_init(&hal->tcl_work_active);
  1014. return QDF_STATUS_SUCCESS;
  1015. fail:
  1016. qdf_destroy_workqueue(0, hal->tcl_reg_write_wq);
  1017. return status;
  1018. }
  1019. /**
  1020. * hal_delayed_tcl_reg_write_deinit() - De-Initialize delayed TCL reg writes
  1021. * @hal_soc: hal_soc pointer
  1022. *
  1023. * De-initialize main data structures to process TCL register writes in a
  1024. * delayed workqueue.
  1025. *
  1026. * Return: None
  1027. */
  1028. static void hal_delayed_tcl_reg_write_deinit(struct hal_soc *hal)
  1029. {
  1030. qdf_timer_stop(&hal->tcl_reg_write_timer);
  1031. qdf_timer_free(&hal->tcl_reg_write_timer);
  1032. __hal_flush_tcl_reg_write_work(hal);
  1033. qdf_flush_workqueue(0, hal->tcl_reg_write_wq);
  1034. qdf_destroy_workqueue(0, hal->tcl_reg_write_wq);
  1035. }
  1036. #else
  1037. static inline QDF_STATUS hal_delayed_tcl_reg_write_init(struct hal_soc *hal)
  1038. {
  1039. return QDF_STATUS_SUCCESS;
  1040. }
  1041. static inline void hal_delayed_tcl_reg_write_deinit(struct hal_soc *hal)
  1042. {
  1043. }
  1044. #endif
  1045. #ifdef FEATURE_HAL_DELAYED_REG_WRITE_V2
  1046. #ifdef FEATURE_HAL_DELAYED_REG_WRITE
  1047. static inline void hal_reg_write_enqueue_v2(struct hal_soc *hal_soc,
  1048. struct hal_srng *srng,
  1049. void __iomem *addr,
  1050. uint32_t value)
  1051. {
  1052. hal_reg_write_enqueue(hal_soc, srng, addr, value);
  1053. }
  1054. #else
  1055. static inline void hal_reg_write_enqueue_v2(struct hal_soc *hal_soc,
  1056. struct hal_srng *srng,
  1057. void __iomem *addr,
  1058. uint32_t value)
  1059. {
  1060. qdf_atomic_inc(&hal_soc->stats.wstats.direct);
  1061. srng->wstats.direct++;
  1062. hal_write_address_32_mb(hal_soc, addr, value, false);
  1063. }
  1064. #endif
  1065. void hal_delayed_reg_write(struct hal_soc *hal_soc,
  1066. struct hal_srng *srng,
  1067. void __iomem *addr,
  1068. uint32_t value)
  1069. {
  1070. switch (srng->ring_type) {
  1071. case TCL_DATA:
  1072. if (hal_is_reg_write_tput_level_high(hal_soc)) {
  1073. hal_soc->tcl_direct = true;
  1074. if (srng->reg_write_in_progress ||
  1075. !qdf_atomic_read(&hal_soc->tcl_work_active)) {
  1076. /*
  1077. * Now the delayed work have either completed
  1078. * the writing or not even scheduled and would
  1079. * be blocked by SRNG_LOCK, hence it is fine to
  1080. * do direct write here.
  1081. */
  1082. srng->last_reg_wr_val = srng->u.src_ring.hp;
  1083. srng->wstats.direct++;
  1084. hal_write_address_32_mb(hal_soc, addr,
  1085. srng->last_reg_wr_val,
  1086. false);
  1087. } else {
  1088. hal_soc->tcl_stats.direct_timer_set++;
  1089. qdf_timer_mod(&hal_soc->tcl_reg_write_timer, 1);
  1090. }
  1091. } else {
  1092. hal_soc->tcl_direct = false;
  1093. if (srng->reg_write_in_progress) {
  1094. srng->wstats.coalesces++;
  1095. } else {
  1096. hal_tcl_reg_write_enqueue(hal_soc, srng,
  1097. addr, value);
  1098. }
  1099. }
  1100. break;
  1101. case CE_SRC:
  1102. case CE_DST:
  1103. case CE_DST_STATUS:
  1104. hal_reg_write_enqueue_v2(hal_soc, srng, addr, value);
  1105. break;
  1106. default:
  1107. qdf_atomic_inc(&hal_soc->stats.wstats.direct);
  1108. srng->wstats.direct++;
  1109. hal_write_address_32_mb(hal_soc, addr, value, false);
  1110. break;
  1111. }
  1112. }
  1113. #else
  1114. #ifdef FEATURE_HAL_DELAYED_REG_WRITE
  1115. void hal_delayed_reg_write(struct hal_soc *hal_soc,
  1116. struct hal_srng *srng,
  1117. void __iomem *addr,
  1118. uint32_t value)
  1119. {
  1120. if (pld_is_device_awake(hal_soc->qdf_dev->dev) ||
  1121. hal_is_reg_write_tput_level_high(hal_soc)) {
  1122. qdf_atomic_inc(&hal_soc->stats.wstats.direct);
  1123. srng->wstats.direct++;
  1124. hal_write_address_32_mb(hal_soc, addr, value, false);
  1125. } else {
  1126. hal_reg_write_enqueue(hal_soc, srng, addr, value);
  1127. }
  1128. }
  1129. #endif
  1130. #endif
  1131. /**
  1132. * hal_attach - Initialize HAL layer
  1133. * @hif_handle: Opaque HIF handle
  1134. * @qdf_dev: QDF device
  1135. *
  1136. * Return: Opaque HAL SOC handle
  1137. * NULL on failure (if given ring is not available)
  1138. *
  1139. * This function should be called as part of HIF initialization (for accessing
  1140. * copy engines). DP layer will get hal_soc handle using hif_get_hal_handle()
  1141. *
  1142. */
  1143. void *hal_attach(struct hif_opaque_softc *hif_handle, qdf_device_t qdf_dev)
  1144. {
  1145. struct hal_soc *hal;
  1146. int i;
  1147. hal = qdf_mem_malloc(sizeof(*hal));
  1148. if (!hal) {
  1149. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  1150. "%s: hal_soc allocation failed", __func__);
  1151. goto fail0;
  1152. }
  1153. hal->hif_handle = hif_handle;
  1154. hal->dev_base_addr = hif_get_dev_ba(hif_handle); /* UMAC */
  1155. hal->dev_base_addr_ce = hif_get_dev_ba_ce(hif_handle); /* CE */
  1156. hal->qdf_dev = qdf_dev;
  1157. hal->shadow_rdptr_mem_vaddr = (uint32_t *)qdf_mem_alloc_consistent(
  1158. qdf_dev, qdf_dev->dev, sizeof(*(hal->shadow_rdptr_mem_vaddr)) *
  1159. HAL_SRNG_ID_MAX, &(hal->shadow_rdptr_mem_paddr));
  1160. if (!hal->shadow_rdptr_mem_paddr) {
  1161. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  1162. "%s: hal->shadow_rdptr_mem_paddr allocation failed",
  1163. __func__);
  1164. goto fail1;
  1165. }
  1166. qdf_mem_zero(hal->shadow_rdptr_mem_vaddr,
  1167. sizeof(*(hal->shadow_rdptr_mem_vaddr)) * HAL_SRNG_ID_MAX);
  1168. hal->shadow_wrptr_mem_vaddr =
  1169. (uint32_t *)qdf_mem_alloc_consistent(qdf_dev, qdf_dev->dev,
  1170. sizeof(*(hal->shadow_wrptr_mem_vaddr)) * HAL_MAX_LMAC_RINGS,
  1171. &(hal->shadow_wrptr_mem_paddr));
  1172. if (!hal->shadow_wrptr_mem_vaddr) {
  1173. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  1174. "%s: hal->shadow_wrptr_mem_vaddr allocation failed",
  1175. __func__);
  1176. goto fail2;
  1177. }
  1178. qdf_mem_zero(hal->shadow_wrptr_mem_vaddr,
  1179. sizeof(*(hal->shadow_wrptr_mem_vaddr)) * HAL_MAX_LMAC_RINGS);
  1180. for (i = 0; i < HAL_SRNG_ID_MAX; i++) {
  1181. hal->srng_list[i].initialized = 0;
  1182. hal->srng_list[i].ring_id = i;
  1183. }
  1184. qdf_spinlock_create(&hal->register_access_lock);
  1185. hal->register_window = 0;
  1186. hal->target_type = hal_get_target_type(hal_soc_to_hal_soc_handle(hal));
  1187. hal_target_based_configure(hal);
  1188. hal_reg_write_fail_history_init(hal);
  1189. qdf_minidump_log(hal, sizeof(*hal), "hal_soc");
  1190. qdf_atomic_init(&hal->active_work_cnt);
  1191. hal_delayed_reg_write_init(hal);
  1192. hal_delayed_tcl_reg_write_init(hal);
  1193. return (void *)hal;
  1194. fail2:
  1195. qdf_mem_free_consistent(qdf_dev, qdf_dev->dev,
  1196. sizeof(*(hal->shadow_rdptr_mem_vaddr)) * HAL_SRNG_ID_MAX,
  1197. hal->shadow_rdptr_mem_vaddr, hal->shadow_rdptr_mem_paddr, 0);
  1198. fail1:
  1199. qdf_mem_free(hal);
  1200. fail0:
  1201. return NULL;
  1202. }
  1203. qdf_export_symbol(hal_attach);
  1204. /**
  1205. * hal_mem_info - Retrieve hal memory base address
  1206. *
  1207. * @hal_soc: Opaque HAL SOC handle
  1208. * @mem: pointer to structure to be updated with hal mem info
  1209. */
  1210. void hal_get_meminfo(hal_soc_handle_t hal_soc_hdl, struct hal_mem_info *mem)
  1211. {
  1212. struct hal_soc *hal = (struct hal_soc *)hal_soc_hdl;
  1213. mem->dev_base_addr = (void *)hal->dev_base_addr;
  1214. mem->shadow_rdptr_mem_vaddr = (void *)hal->shadow_rdptr_mem_vaddr;
  1215. mem->shadow_wrptr_mem_vaddr = (void *)hal->shadow_wrptr_mem_vaddr;
  1216. mem->shadow_rdptr_mem_paddr = (void *)hal->shadow_rdptr_mem_paddr;
  1217. mem->shadow_wrptr_mem_paddr = (void *)hal->shadow_wrptr_mem_paddr;
  1218. hif_read_phy_mem_base((void *)hal->hif_handle,
  1219. (qdf_dma_addr_t *)&mem->dev_base_paddr);
  1220. return;
  1221. }
  1222. qdf_export_symbol(hal_get_meminfo);
  1223. /**
  1224. * hal_detach - Detach HAL layer
  1225. * @hal_soc: HAL SOC handle
  1226. *
  1227. * Return: Opaque HAL SOC handle
  1228. * NULL on failure (if given ring is not available)
  1229. *
  1230. * This function should be called as part of HIF initialization (for accessing
  1231. * copy engines). DP layer will get hal_soc handle using hif_get_hal_handle()
  1232. *
  1233. */
  1234. extern void hal_detach(void *hal_soc)
  1235. {
  1236. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  1237. hal_delayed_reg_write_deinit(hal);
  1238. hal_delayed_tcl_reg_write_deinit(hal);
  1239. qdf_mem_free_consistent(hal->qdf_dev, hal->qdf_dev->dev,
  1240. sizeof(*(hal->shadow_rdptr_mem_vaddr)) * HAL_SRNG_ID_MAX,
  1241. hal->shadow_rdptr_mem_vaddr, hal->shadow_rdptr_mem_paddr, 0);
  1242. qdf_mem_free_consistent(hal->qdf_dev, hal->qdf_dev->dev,
  1243. sizeof(*(hal->shadow_wrptr_mem_vaddr)) * HAL_MAX_LMAC_RINGS,
  1244. hal->shadow_wrptr_mem_vaddr, hal->shadow_wrptr_mem_paddr, 0);
  1245. qdf_minidump_remove(hal, sizeof(*hal), "hal_soc");
  1246. qdf_mem_free(hal);
  1247. return;
  1248. }
  1249. qdf_export_symbol(hal_detach);
  1250. /**
  1251. * hal_ce_dst_setup - Initialize CE destination ring registers
  1252. * @hal_soc: HAL SOC handle
  1253. * @srng: SRNG ring pointer
  1254. */
  1255. static inline void hal_ce_dst_setup(struct hal_soc *hal, struct hal_srng *srng,
  1256. int ring_num)
  1257. {
  1258. uint32_t reg_val = 0;
  1259. uint32_t reg_addr;
  1260. struct hal_hw_srng_config *ring_config =
  1261. HAL_SRNG_CONFIG(hal, CE_DST);
  1262. /* set DEST_MAX_LENGTH according to ce assignment */
  1263. reg_addr = HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_CTRL_ADDR(
  1264. ring_config->reg_start[R0_INDEX] +
  1265. (ring_num * ring_config->reg_size[R0_INDEX]));
  1266. reg_val = HAL_REG_READ(hal, reg_addr);
  1267. reg_val &= ~HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_CTRL_DEST_MAX_LENGTH_BMSK;
  1268. reg_val |= srng->u.dst_ring.max_buffer_length &
  1269. HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_CTRL_DEST_MAX_LENGTH_BMSK;
  1270. HAL_REG_WRITE(hal, reg_addr, reg_val);
  1271. if (srng->prefetch_timer) {
  1272. reg_addr = HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_RING_CONSUMER_PREFETCH_TIMER_ADDR(
  1273. ring_config->reg_start[R0_INDEX] +
  1274. (ring_num * ring_config->reg_size[R0_INDEX]));
  1275. reg_val = HAL_REG_READ(hal, reg_addr);
  1276. reg_val &= ~HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_RING_CONSUMER_PREFETCH_TIMER_RMSK;
  1277. reg_val |= srng->prefetch_timer;
  1278. HAL_REG_WRITE(hal, reg_addr, reg_val);
  1279. reg_val = HAL_REG_READ(hal, reg_addr);
  1280. }
  1281. }
  1282. /**
  1283. * hal_reo_read_write_ctrl_ix - Read or write REO_DESTINATION_RING_CTRL_IX
  1284. * @hal: HAL SOC handle
  1285. * @read: boolean value to indicate if read or write
  1286. * @ix0: pointer to store IX0 reg value
  1287. * @ix1: pointer to store IX1 reg value
  1288. * @ix2: pointer to store IX2 reg value
  1289. * @ix3: pointer to store IX3 reg value
  1290. */
  1291. void hal_reo_read_write_ctrl_ix(hal_soc_handle_t hal_soc_hdl, bool read,
  1292. uint32_t *ix0, uint32_t *ix1,
  1293. uint32_t *ix2, uint32_t *ix3)
  1294. {
  1295. uint32_t reg_offset;
  1296. struct hal_soc *hal = (struct hal_soc *)hal_soc_hdl;
  1297. if (read) {
  1298. if (ix0) {
  1299. reg_offset =
  1300. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_0_ADDR(
  1301. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  1302. *ix0 = HAL_REG_READ(hal, reg_offset);
  1303. }
  1304. if (ix1) {
  1305. reg_offset =
  1306. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_1_ADDR(
  1307. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  1308. *ix1 = HAL_REG_READ(hal, reg_offset);
  1309. }
  1310. if (ix2) {
  1311. reg_offset =
  1312. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_2_ADDR(
  1313. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  1314. *ix2 = HAL_REG_READ(hal, reg_offset);
  1315. }
  1316. if (ix3) {
  1317. reg_offset =
  1318. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_3_ADDR(
  1319. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  1320. *ix3 = HAL_REG_READ(hal, reg_offset);
  1321. }
  1322. } else {
  1323. if (ix0) {
  1324. reg_offset =
  1325. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_0_ADDR(
  1326. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  1327. HAL_REG_WRITE_CONFIRM_RETRY(hal, reg_offset,
  1328. *ix0, true);
  1329. }
  1330. if (ix1) {
  1331. reg_offset =
  1332. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_1_ADDR(
  1333. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  1334. HAL_REG_WRITE_CONFIRM_RETRY(hal, reg_offset,
  1335. *ix1, true);
  1336. }
  1337. if (ix2) {
  1338. reg_offset =
  1339. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_2_ADDR(
  1340. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  1341. HAL_REG_WRITE_CONFIRM_RETRY(hal, reg_offset,
  1342. *ix2, true);
  1343. }
  1344. if (ix3) {
  1345. reg_offset =
  1346. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_3_ADDR(
  1347. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  1348. HAL_REG_WRITE_CONFIRM_RETRY(hal, reg_offset,
  1349. *ix3, true);
  1350. }
  1351. }
  1352. }
  1353. /**
  1354. * hal_srng_dst_set_hp_paddr_confirm() - Set physical address to dest ring head
  1355. * pointer and confirm that write went through by reading back the value
  1356. * @srng: sring pointer
  1357. * @paddr: physical address
  1358. *
  1359. * Return: None
  1360. */
  1361. void hal_srng_dst_set_hp_paddr_confirm(struct hal_srng *srng, uint64_t paddr)
  1362. {
  1363. SRNG_DST_REG_WRITE_CONFIRM(srng, HP_ADDR_LSB, paddr & 0xffffffff);
  1364. SRNG_DST_REG_WRITE_CONFIRM(srng, HP_ADDR_MSB, paddr >> 32);
  1365. }
  1366. /**
  1367. * hal_srng_dst_init_hp() - Initialize destination ring head
  1368. * pointer
  1369. * @hal_soc: hal_soc handle
  1370. * @srng: sring pointer
  1371. * @vaddr: virtual address
  1372. */
  1373. void hal_srng_dst_init_hp(struct hal_soc_handle *hal_soc,
  1374. struct hal_srng *srng,
  1375. uint32_t *vaddr)
  1376. {
  1377. uint32_t reg_offset;
  1378. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  1379. if (!srng)
  1380. return;
  1381. srng->u.dst_ring.hp_addr = vaddr;
  1382. reg_offset = SRNG_DST_ADDR(srng, HP) - hal->dev_base_addr;
  1383. HAL_REG_WRITE_CONFIRM_RETRY(
  1384. hal, reg_offset, srng->u.dst_ring.cached_hp, true);
  1385. if (vaddr) {
  1386. *srng->u.dst_ring.hp_addr = srng->u.dst_ring.cached_hp;
  1387. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  1388. "hp_addr=%pK, cached_hp=%d, hp=%d",
  1389. (void *)srng->u.dst_ring.hp_addr,
  1390. srng->u.dst_ring.cached_hp,
  1391. *srng->u.dst_ring.hp_addr);
  1392. }
  1393. }
  1394. /**
  1395. * hal_srng_hw_init - Private function to initialize SRNG HW
  1396. * @hal_soc: HAL SOC handle
  1397. * @srng: SRNG ring pointer
  1398. */
  1399. static inline void hal_srng_hw_init(struct hal_soc *hal,
  1400. struct hal_srng *srng)
  1401. {
  1402. if (srng->ring_dir == HAL_SRNG_SRC_RING)
  1403. hal_srng_src_hw_init(hal, srng);
  1404. else
  1405. hal_srng_dst_hw_init(hal, srng);
  1406. }
  1407. #ifdef CONFIG_SHADOW_V2
  1408. #define ignore_shadow false
  1409. #define CHECK_SHADOW_REGISTERS true
  1410. #else
  1411. #define ignore_shadow true
  1412. #define CHECK_SHADOW_REGISTERS false
  1413. #endif
  1414. /**
  1415. * hal_srng_setup - Initialize HW SRNG ring.
  1416. * @hal_soc: Opaque HAL SOC handle
  1417. * @ring_type: one of the types from hal_ring_type
  1418. * @ring_num: Ring number if there are multiple rings of same type (staring
  1419. * from 0)
  1420. * @mac_id: valid MAC Id should be passed if ring type is one of lmac rings
  1421. * @ring_params: SRNG ring params in hal_srng_params structure.
  1422. * Callers are expected to allocate contiguous ring memory of size
  1423. * 'num_entries * entry_size' bytes and pass the physical and virtual base
  1424. * addresses through 'ring_base_paddr' and 'ring_base_vaddr' in
  1425. * hal_srng_params structure. Ring base address should be 8 byte aligned
  1426. * and size of each ring entry should be queried using the API
  1427. * hal_srng_get_entrysize
  1428. *
  1429. * Return: Opaque pointer to ring on success
  1430. * NULL on failure (if given ring is not available)
  1431. */
  1432. void *hal_srng_setup(void *hal_soc, int ring_type, int ring_num,
  1433. int mac_id, struct hal_srng_params *ring_params)
  1434. {
  1435. int ring_id;
  1436. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  1437. struct hal_srng *srng;
  1438. struct hal_hw_srng_config *ring_config =
  1439. HAL_SRNG_CONFIG(hal, ring_type);
  1440. void *dev_base_addr;
  1441. int i;
  1442. ring_id = hal_get_srng_ring_id(hal_soc, ring_type, ring_num, mac_id);
  1443. if (ring_id < 0)
  1444. return NULL;
  1445. hal_verbose_debug("mac_id %d ring_id %d", mac_id, ring_id);
  1446. srng = hal_get_srng(hal_soc, ring_id);
  1447. if (srng->initialized) {
  1448. hal_verbose_debug("Ring (ring_type, ring_num) already initialized");
  1449. return NULL;
  1450. }
  1451. dev_base_addr = hal->dev_base_addr;
  1452. srng->ring_id = ring_id;
  1453. srng->ring_type = ring_type;
  1454. srng->ring_dir = ring_config->ring_dir;
  1455. srng->ring_base_paddr = ring_params->ring_base_paddr;
  1456. srng->ring_base_vaddr = ring_params->ring_base_vaddr;
  1457. srng->entry_size = ring_config->entry_size;
  1458. srng->num_entries = ring_params->num_entries;
  1459. srng->ring_size = srng->num_entries * srng->entry_size;
  1460. srng->ring_size_mask = srng->ring_size - 1;
  1461. srng->msi_addr = ring_params->msi_addr;
  1462. srng->msi_data = ring_params->msi_data;
  1463. srng->intr_timer_thres_us = ring_params->intr_timer_thres_us;
  1464. srng->intr_batch_cntr_thres_entries =
  1465. ring_params->intr_batch_cntr_thres_entries;
  1466. srng->prefetch_timer = ring_params->prefetch_timer;
  1467. srng->hal_soc = hal_soc;
  1468. for (i = 0 ; i < MAX_SRNG_REG_GROUPS; i++) {
  1469. srng->hwreg_base[i] = dev_base_addr + ring_config->reg_start[i]
  1470. + (ring_num * ring_config->reg_size[i]);
  1471. }
  1472. /* Zero out the entire ring memory */
  1473. qdf_mem_zero(srng->ring_base_vaddr, (srng->entry_size *
  1474. srng->num_entries) << 2);
  1475. srng->flags = ring_params->flags;
  1476. #ifdef BIG_ENDIAN_HOST
  1477. /* TODO: See if we should we get these flags from caller */
  1478. srng->flags |= HAL_SRNG_DATA_TLV_SWAP;
  1479. srng->flags |= HAL_SRNG_MSI_SWAP;
  1480. srng->flags |= HAL_SRNG_RING_PTR_SWAP;
  1481. #endif
  1482. if (srng->ring_dir == HAL_SRNG_SRC_RING) {
  1483. srng->u.src_ring.hp = 0;
  1484. srng->u.src_ring.reap_hp = srng->ring_size -
  1485. srng->entry_size;
  1486. srng->u.src_ring.tp_addr =
  1487. &(hal->shadow_rdptr_mem_vaddr[ring_id]);
  1488. srng->u.src_ring.low_threshold =
  1489. ring_params->low_threshold * srng->entry_size;
  1490. if (ring_config->lmac_ring) {
  1491. /* For LMAC rings, head pointer updates will be done
  1492. * through FW by writing to a shared memory location
  1493. */
  1494. srng->u.src_ring.hp_addr =
  1495. &(hal->shadow_wrptr_mem_vaddr[ring_id -
  1496. HAL_SRNG_LMAC1_ID_START]);
  1497. srng->flags |= HAL_SRNG_LMAC_RING;
  1498. } else if (ignore_shadow || (srng->u.src_ring.hp_addr == 0)) {
  1499. srng->u.src_ring.hp_addr =
  1500. hal_get_window_address(hal,
  1501. SRNG_SRC_ADDR(srng, HP));
  1502. if (CHECK_SHADOW_REGISTERS) {
  1503. QDF_TRACE(QDF_MODULE_ID_TXRX,
  1504. QDF_TRACE_LEVEL_ERROR,
  1505. "%s: Ring (%d, %d) missing shadow config",
  1506. __func__, ring_type, ring_num);
  1507. }
  1508. } else {
  1509. hal_validate_shadow_register(hal,
  1510. SRNG_SRC_ADDR(srng, HP),
  1511. srng->u.src_ring.hp_addr);
  1512. }
  1513. } else {
  1514. /* During initialization loop count in all the descriptors
  1515. * will be set to zero, and HW will set it to 1 on completing
  1516. * descriptor update in first loop, and increments it by 1 on
  1517. * subsequent loops (loop count wraps around after reaching
  1518. * 0xffff). The 'loop_cnt' in SW ring state is the expected
  1519. * loop count in descriptors updated by HW (to be processed
  1520. * by SW).
  1521. */
  1522. srng->u.dst_ring.loop_cnt = 1;
  1523. srng->u.dst_ring.tp = 0;
  1524. srng->u.dst_ring.hp_addr =
  1525. &(hal->shadow_rdptr_mem_vaddr[ring_id]);
  1526. if (ring_config->lmac_ring) {
  1527. /* For LMAC rings, tail pointer updates will be done
  1528. * through FW by writing to a shared memory location
  1529. */
  1530. srng->u.dst_ring.tp_addr =
  1531. &(hal->shadow_wrptr_mem_vaddr[ring_id -
  1532. HAL_SRNG_LMAC1_ID_START]);
  1533. srng->flags |= HAL_SRNG_LMAC_RING;
  1534. } else if (ignore_shadow || srng->u.dst_ring.tp_addr == 0) {
  1535. srng->u.dst_ring.tp_addr =
  1536. hal_get_window_address(hal,
  1537. SRNG_DST_ADDR(srng, TP));
  1538. if (CHECK_SHADOW_REGISTERS) {
  1539. QDF_TRACE(QDF_MODULE_ID_TXRX,
  1540. QDF_TRACE_LEVEL_ERROR,
  1541. "%s: Ring (%d, %d) missing shadow config",
  1542. __func__, ring_type, ring_num);
  1543. }
  1544. } else {
  1545. hal_validate_shadow_register(hal,
  1546. SRNG_DST_ADDR(srng, TP),
  1547. srng->u.dst_ring.tp_addr);
  1548. }
  1549. }
  1550. if (!(ring_config->lmac_ring)) {
  1551. hal_srng_hw_init(hal, srng);
  1552. if (ring_type == CE_DST) {
  1553. srng->u.dst_ring.max_buffer_length = ring_params->max_buffer_length;
  1554. hal_ce_dst_setup(hal, srng, ring_num);
  1555. }
  1556. }
  1557. SRNG_LOCK_INIT(&srng->lock);
  1558. srng->srng_event = 0;
  1559. srng->initialized = true;
  1560. return (void *)srng;
  1561. }
  1562. qdf_export_symbol(hal_srng_setup);
  1563. /**
  1564. * hal_srng_cleanup - Deinitialize HW SRNG ring.
  1565. * @hal_soc: Opaque HAL SOC handle
  1566. * @hal_srng: Opaque HAL SRNG pointer
  1567. */
  1568. void hal_srng_cleanup(void *hal_soc, hal_ring_handle_t hal_ring_hdl)
  1569. {
  1570. struct hal_srng *srng = (struct hal_srng *)hal_ring_hdl;
  1571. SRNG_LOCK_DESTROY(&srng->lock);
  1572. srng->initialized = 0;
  1573. }
  1574. qdf_export_symbol(hal_srng_cleanup);
  1575. /**
  1576. * hal_srng_get_entrysize - Returns size of ring entry in bytes
  1577. * @hal_soc: Opaque HAL SOC handle
  1578. * @ring_type: one of the types from hal_ring_type
  1579. *
  1580. */
  1581. uint32_t hal_srng_get_entrysize(void *hal_soc, int ring_type)
  1582. {
  1583. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  1584. struct hal_hw_srng_config *ring_config =
  1585. HAL_SRNG_CONFIG(hal, ring_type);
  1586. return ring_config->entry_size << 2;
  1587. }
  1588. qdf_export_symbol(hal_srng_get_entrysize);
  1589. /**
  1590. * hal_srng_max_entries - Returns maximum possible number of ring entries
  1591. * @hal_soc: Opaque HAL SOC handle
  1592. * @ring_type: one of the types from hal_ring_type
  1593. *
  1594. * Return: Maximum number of entries for the given ring_type
  1595. */
  1596. uint32_t hal_srng_max_entries(void *hal_soc, int ring_type)
  1597. {
  1598. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  1599. struct hal_hw_srng_config *ring_config =
  1600. HAL_SRNG_CONFIG(hal, ring_type);
  1601. return ring_config->max_size / ring_config->entry_size;
  1602. }
  1603. qdf_export_symbol(hal_srng_max_entries);
  1604. enum hal_srng_dir hal_srng_get_dir(void *hal_soc, int ring_type)
  1605. {
  1606. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  1607. struct hal_hw_srng_config *ring_config =
  1608. HAL_SRNG_CONFIG(hal, ring_type);
  1609. return ring_config->ring_dir;
  1610. }
  1611. /**
  1612. * hal_srng_dump - Dump ring status
  1613. * @srng: hal srng pointer
  1614. */
  1615. void hal_srng_dump(struct hal_srng *srng)
  1616. {
  1617. if (srng->ring_dir == HAL_SRNG_SRC_RING) {
  1618. hal_debug("=== SRC RING %d ===", srng->ring_id);
  1619. hal_debug("hp %u, reap_hp %u, tp %u, cached tp %u",
  1620. srng->u.src_ring.hp,
  1621. srng->u.src_ring.reap_hp,
  1622. *srng->u.src_ring.tp_addr,
  1623. srng->u.src_ring.cached_tp);
  1624. } else {
  1625. hal_debug("=== DST RING %d ===", srng->ring_id);
  1626. hal_debug("tp %u, hp %u, cached tp %u, loop_cnt %u",
  1627. srng->u.dst_ring.tp,
  1628. *srng->u.dst_ring.hp_addr,
  1629. srng->u.dst_ring.cached_hp,
  1630. srng->u.dst_ring.loop_cnt);
  1631. }
  1632. }
  1633. /**
  1634. * hal_get_srng_params - Retrieve SRNG parameters for a given ring from HAL
  1635. *
  1636. * @hal_soc: Opaque HAL SOC handle
  1637. * @hal_ring: Ring pointer (Source or Destination ring)
  1638. * @ring_params: SRNG parameters will be returned through this structure
  1639. */
  1640. extern void hal_get_srng_params(hal_soc_handle_t hal_soc_hdl,
  1641. hal_ring_handle_t hal_ring_hdl,
  1642. struct hal_srng_params *ring_params)
  1643. {
  1644. struct hal_srng *srng = (struct hal_srng *)hal_ring_hdl;
  1645. int i =0;
  1646. ring_params->ring_id = srng->ring_id;
  1647. ring_params->ring_dir = srng->ring_dir;
  1648. ring_params->entry_size = srng->entry_size;
  1649. ring_params->ring_base_paddr = srng->ring_base_paddr;
  1650. ring_params->ring_base_vaddr = srng->ring_base_vaddr;
  1651. ring_params->num_entries = srng->num_entries;
  1652. ring_params->msi_addr = srng->msi_addr;
  1653. ring_params->msi_data = srng->msi_data;
  1654. ring_params->intr_timer_thres_us = srng->intr_timer_thres_us;
  1655. ring_params->intr_batch_cntr_thres_entries =
  1656. srng->intr_batch_cntr_thres_entries;
  1657. ring_params->low_threshold = srng->u.src_ring.low_threshold;
  1658. ring_params->flags = srng->flags;
  1659. ring_params->ring_id = srng->ring_id;
  1660. for (i = 0 ; i < MAX_SRNG_REG_GROUPS; i++)
  1661. ring_params->hwreg_base[i] = srng->hwreg_base[i];
  1662. }
  1663. qdf_export_symbol(hal_get_srng_params);
  1664. void hal_set_low_threshold(hal_ring_handle_t hal_ring_hdl,
  1665. uint32_t low_threshold)
  1666. {
  1667. struct hal_srng *srng = (struct hal_srng *)hal_ring_hdl;
  1668. srng->u.src_ring.low_threshold = low_threshold * srng->entry_size;
  1669. }
  1670. qdf_export_symbol(hal_set_low_threshold);
  1671. #ifdef FORCE_WAKE
  1672. void hal_set_init_phase(hal_soc_handle_t soc, bool init_phase)
  1673. {
  1674. struct hal_soc *hal_soc = (struct hal_soc *)soc;
  1675. hal_soc->init_phase = init_phase;
  1676. }
  1677. #endif /* FORCE_WAKE */