hal_srng.c 38 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356
  1. /*
  2. * Copyright (c) 2016-2020 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_QCN9100
  42. void hal_qcn9100_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. QDF_STATUS hal_set_one_shadow_config(void *hal_soc,
  144. int ring_type,
  145. int ring_num)
  146. {
  147. uint32_t target_register;
  148. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  149. struct hal_hw_srng_config *srng_config = &hal->hw_srng_table[ring_type];
  150. int shadow_config_index = hal->num_shadow_registers_configured;
  151. if (shadow_config_index >= MAX_SHADOW_REGISTERS) {
  152. QDF_ASSERT(0);
  153. return QDF_STATUS_E_RESOURCES;
  154. }
  155. hal->num_shadow_registers_configured++;
  156. target_register = srng_config->reg_start[HP_OFFSET_IN_REG_START];
  157. target_register += (srng_config->reg_size[HP_OFFSET_IN_REG_START]
  158. *ring_num);
  159. /* if the ring is a dst ring, we need to shadow the tail pointer */
  160. if (srng_config->ring_dir == HAL_SRNG_DST_RING)
  161. target_register += OFFSET_FROM_HP_TO_TP;
  162. hal->shadow_config[shadow_config_index].addr = target_register;
  163. /* update hp/tp addr in the hal_soc structure*/
  164. hal_update_srng_hp_tp_address(hal_soc, shadow_config_index, ring_type,
  165. ring_num);
  166. hal_debug("target_reg %x, shadow register 0x%x shadow_index 0x%x, ring_type %d, ring num %d",
  167. target_register,
  168. SHADOW_REGISTER(shadow_config_index),
  169. shadow_config_index,
  170. ring_type, ring_num);
  171. return QDF_STATUS_SUCCESS;
  172. }
  173. qdf_export_symbol(hal_set_one_shadow_config);
  174. QDF_STATUS hal_construct_shadow_config(void *hal_soc)
  175. {
  176. int ring_type, ring_num;
  177. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  178. for (ring_type = 0; ring_type < MAX_RING_TYPES; ring_type++) {
  179. struct hal_hw_srng_config *srng_config =
  180. &hal->hw_srng_table[ring_type];
  181. if (ring_type == CE_SRC ||
  182. ring_type == CE_DST ||
  183. ring_type == CE_DST_STATUS)
  184. continue;
  185. if (srng_config->lmac_ring)
  186. continue;
  187. for (ring_num = 0; ring_num < srng_config->max_rings;
  188. ring_num++)
  189. hal_set_one_shadow_config(hal_soc, ring_type, ring_num);
  190. }
  191. return QDF_STATUS_SUCCESS;
  192. }
  193. qdf_export_symbol(hal_construct_shadow_config);
  194. void hal_get_shadow_config(void *hal_soc,
  195. struct pld_shadow_reg_v2_cfg **shadow_config,
  196. int *num_shadow_registers_configured)
  197. {
  198. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  199. *shadow_config = hal->shadow_config;
  200. *num_shadow_registers_configured =
  201. hal->num_shadow_registers_configured;
  202. }
  203. qdf_export_symbol(hal_get_shadow_config);
  204. static void hal_validate_shadow_register(struct hal_soc *hal,
  205. uint32_t *destination,
  206. uint32_t *shadow_address)
  207. {
  208. unsigned int index;
  209. uint32_t *shadow_0_offset = SHADOW_REGISTER(0) + hal->dev_base_addr;
  210. int destination_ba_offset =
  211. ((char *)destination) - (char *)hal->dev_base_addr;
  212. index = shadow_address - shadow_0_offset;
  213. if (index >= MAX_SHADOW_REGISTERS) {
  214. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  215. "%s: index %x out of bounds", __func__, index);
  216. goto error;
  217. } else if (hal->shadow_config[index].addr != destination_ba_offset) {
  218. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  219. "%s: sanity check failure, expected %x, found %x",
  220. __func__, destination_ba_offset,
  221. hal->shadow_config[index].addr);
  222. goto error;
  223. }
  224. return;
  225. error:
  226. qdf_print("baddr %pK, desination %pK, shadow_address %pK s0offset %pK index %x",
  227. hal->dev_base_addr, destination, shadow_address,
  228. shadow_0_offset, index);
  229. QDF_BUG(0);
  230. return;
  231. }
  232. static void hal_target_based_configure(struct hal_soc *hal)
  233. {
  234. /**
  235. * Indicate Initialization of srngs to avoid force wake
  236. * as umac power collapse is not enabled yet
  237. */
  238. hal->init_phase = true;
  239. switch (hal->target_type) {
  240. #ifdef QCA_WIFI_QCA6290
  241. case TARGET_TYPE_QCA6290:
  242. hal->use_register_windowing = true;
  243. hal_qca6290_attach(hal);
  244. break;
  245. #endif
  246. #ifdef QCA_WIFI_QCA6390
  247. case TARGET_TYPE_QCA6390:
  248. hal->use_register_windowing = true;
  249. hal_qca6390_attach(hal);
  250. break;
  251. #endif
  252. #ifdef QCA_WIFI_QCA6490
  253. case TARGET_TYPE_QCA6490:
  254. hal->use_register_windowing = true;
  255. hal_qca6490_attach(hal);
  256. hal->init_phase = false;
  257. break;
  258. #endif
  259. #ifdef QCA_WIFI_QCA6750
  260. case TARGET_TYPE_QCA6750:
  261. hal->use_register_windowing = true;
  262. hal->static_window_map = true;
  263. hal_qca6750_attach(hal);
  264. break;
  265. #endif
  266. #if defined(QCA_WIFI_QCA8074) && defined(WIFI_TARGET_TYPE_3_0)
  267. case TARGET_TYPE_QCA8074:
  268. hal_qca8074_attach(hal);
  269. break;
  270. #endif
  271. #if defined(QCA_WIFI_QCA8074V2)
  272. case TARGET_TYPE_QCA8074V2:
  273. hal_qca8074v2_attach(hal);
  274. break;
  275. #endif
  276. #if defined(QCA_WIFI_QCA6018)
  277. case TARGET_TYPE_QCA6018:
  278. hal_qca8074v2_attach(hal);
  279. break;
  280. #endif
  281. #if defined(QCA_WIFI_QCN9100)
  282. case TARGET_TYPE_QCN9100:
  283. hal->use_register_windowing = true;
  284. /*
  285. * Static window map is enabled for qcn9000 to use 2mb bar
  286. * size and use multiple windows to write into registers.
  287. */
  288. hal->static_window_map = true;
  289. hal_qcn9100_attach(hal);
  290. break;
  291. #endif
  292. #ifdef QCA_WIFI_QCN9000
  293. case TARGET_TYPE_QCN9000:
  294. hal->use_register_windowing = true;
  295. /*
  296. * Static window map is enabled for qcn9000 to use 2mb bar
  297. * size and use multiple windows to write into registers.
  298. */
  299. hal->static_window_map = true;
  300. hal_qcn9000_attach(hal);
  301. break;
  302. #endif
  303. #ifdef QCA_WIFI_QCA5018
  304. case TARGET_TYPE_QCA5018:
  305. hal->use_register_windowing = true;
  306. hal->static_window_map = true;
  307. hal_qca5018_attach(hal);
  308. break;
  309. #endif
  310. default:
  311. break;
  312. }
  313. }
  314. uint32_t hal_get_target_type(hal_soc_handle_t hal_soc_hdl)
  315. {
  316. struct hal_soc *hal_soc = (struct hal_soc *)hal_soc_hdl;
  317. struct hif_target_info *tgt_info =
  318. hif_get_target_info_handle(hal_soc->hif_handle);
  319. return tgt_info->target_type;
  320. }
  321. qdf_export_symbol(hal_get_target_type);
  322. #ifdef FEATURE_HAL_DELAYED_REG_WRITE
  323. #ifdef MEMORY_DEBUG
  324. /*
  325. * Length of the queue(array) used to hold delayed register writes.
  326. * Must be a multiple of 2.
  327. */
  328. #define HAL_REG_WRITE_QUEUE_LEN 128
  329. #else
  330. #define HAL_REG_WRITE_QUEUE_LEN 32
  331. #endif
  332. /**
  333. * hal_is_reg_write_tput_level_high() - throughput level for delayed reg writes
  334. * @hal: hal_soc pointer
  335. *
  336. * Return: true if throughput is high, else false.
  337. */
  338. static inline bool hal_is_reg_write_tput_level_high(struct hal_soc *hal)
  339. {
  340. int bw_level = hif_get_bandwidth_level(hal->hif_handle);
  341. return (bw_level >= PLD_BUS_WIDTH_MEDIUM) ? true : false;
  342. }
  343. /**
  344. * hal_process_reg_write_q_elem() - process a regiter write queue element
  345. * @hal: hal_soc pointer
  346. * @q_elem: pointer to hal regiter write queue element
  347. *
  348. * Return: The value which was written to the address
  349. */
  350. static uint32_t
  351. hal_process_reg_write_q_elem(struct hal_soc *hal,
  352. struct hal_reg_write_q_elem *q_elem)
  353. {
  354. struct hal_srng *srng = q_elem->srng;
  355. uint32_t write_val;
  356. SRNG_LOCK(&srng->lock);
  357. srng->reg_write_in_progress = false;
  358. srng->wstats.dequeues++;
  359. if (srng->ring_dir == HAL_SRNG_SRC_RING) {
  360. q_elem->dequeue_val = srng->u.src_ring.hp;
  361. hal_write_address_32_mb(hal,
  362. srng->u.src_ring.hp_addr,
  363. srng->u.src_ring.hp, false);
  364. write_val = srng->u.src_ring.hp;
  365. } else {
  366. q_elem->dequeue_val = srng->u.dst_ring.tp;
  367. hal_write_address_32_mb(hal,
  368. srng->u.dst_ring.tp_addr,
  369. srng->u.dst_ring.tp, false);
  370. write_val = srng->u.dst_ring.tp;
  371. }
  372. q_elem->valid = 0;
  373. SRNG_UNLOCK(&srng->lock);
  374. return write_val;
  375. }
  376. /**
  377. * hal_reg_write_fill_sched_delay_hist() - fill reg write delay histogram in hal
  378. * @hal: hal_soc pointer
  379. * @delay: delay in us
  380. *
  381. * Return: None
  382. */
  383. static inline void hal_reg_write_fill_sched_delay_hist(struct hal_soc *hal,
  384. uint64_t delay_us)
  385. {
  386. uint32_t *hist;
  387. hist = hal->stats.wstats.sched_delay;
  388. if (delay_us < 100)
  389. hist[REG_WRITE_SCHED_DELAY_SUB_100us]++;
  390. else if (delay_us < 1000)
  391. hist[REG_WRITE_SCHED_DELAY_SUB_1000us]++;
  392. else if (delay_us < 5000)
  393. hist[REG_WRITE_SCHED_DELAY_SUB_5000us]++;
  394. else
  395. hist[REG_WRITE_SCHED_DELAY_GT_5000us]++;
  396. }
  397. /**
  398. * hal_reg_write_work() - Worker to process delayed writes
  399. * @arg: hal_soc pointer
  400. *
  401. * Return: None
  402. */
  403. static void hal_reg_write_work(void *arg)
  404. {
  405. int32_t q_depth, write_val;
  406. struct hal_soc *hal = arg;
  407. struct hal_reg_write_q_elem *q_elem;
  408. uint64_t delta_us;
  409. uint8_t ring_id;
  410. uint32_t *addr;
  411. q_elem = &hal->reg_write_queue[(hal->read_idx)];
  412. q_elem->work_scheduled_time = qdf_get_log_timestamp();
  413. /* Make sure q_elem consistent in the memory for multi-cores */
  414. qdf_rmb();
  415. if (!q_elem->valid)
  416. return;
  417. q_depth = qdf_atomic_read(&hal->stats.wstats.q_depth);
  418. if (q_depth > hal->stats.wstats.max_q_depth)
  419. hal->stats.wstats.max_q_depth = q_depth;
  420. if (hif_prevent_link_low_power_states(hal->hif_handle)) {
  421. hal->stats.wstats.prevent_l1_fails++;
  422. return;
  423. }
  424. while (true) {
  425. qdf_rmb();
  426. if (!q_elem->valid)
  427. break;
  428. q_elem->dequeue_time = qdf_get_log_timestamp();
  429. ring_id = q_elem->srng->ring_id;
  430. addr = q_elem->addr;
  431. delta_us = qdf_log_timestamp_to_usecs(q_elem->dequeue_time -
  432. q_elem->enqueue_time);
  433. hal_reg_write_fill_sched_delay_hist(hal, delta_us);
  434. hal->stats.wstats.dequeues++;
  435. qdf_atomic_dec(&hal->stats.wstats.q_depth);
  436. write_val = hal_process_reg_write_q_elem(hal, q_elem);
  437. hal_verbose_debug("read_idx %u srng 0x%x, addr 0x%pK dequeue_val %u sched delay %llu us",
  438. hal->read_idx, ring_id, addr, write_val, delta_us);
  439. qdf_atomic_dec(&hal->active_work_cnt);
  440. hal->read_idx = (hal->read_idx + 1) &
  441. (HAL_REG_WRITE_QUEUE_LEN - 1);
  442. q_elem = &hal->reg_write_queue[(hal->read_idx)];
  443. }
  444. hif_allow_link_low_power_states(hal->hif_handle);
  445. }
  446. /**
  447. * hal_flush_reg_write_work() - flush all writes from regiter write queue
  448. * @arg: hal_soc pointer
  449. *
  450. * Return: None
  451. */
  452. static inline void hal_flush_reg_write_work(struct hal_soc *hal)
  453. {
  454. qdf_cancel_work(&hal->reg_write_work);
  455. qdf_flush_work(&hal->reg_write_work);
  456. qdf_flush_workqueue(0, hal->reg_write_wq);
  457. }
  458. /**
  459. * hal_reg_write_enqueue() - enqueue register writes into kworker
  460. * @hal_soc: hal_soc pointer
  461. * @srng: srng pointer
  462. * @addr: iomem address of regiter
  463. * @value: value to be written to iomem address
  464. *
  465. * This function executes from within the SRNG LOCK
  466. *
  467. * Return: None
  468. */
  469. static void hal_reg_write_enqueue(struct hal_soc *hal_soc,
  470. struct hal_srng *srng,
  471. void __iomem *addr,
  472. uint32_t value)
  473. {
  474. struct hal_reg_write_q_elem *q_elem;
  475. uint32_t write_idx;
  476. if (srng->reg_write_in_progress) {
  477. hal_verbose_debug("Already in progress srng ring id 0x%x addr 0x%pK val %u",
  478. srng->ring_id, addr, value);
  479. qdf_atomic_inc(&hal_soc->stats.wstats.coalesces);
  480. srng->wstats.coalesces++;
  481. return;
  482. }
  483. write_idx = qdf_atomic_inc_return(&hal_soc->write_idx);
  484. write_idx = write_idx & (HAL_REG_WRITE_QUEUE_LEN - 1);
  485. q_elem = &hal_soc->reg_write_queue[write_idx];
  486. if (q_elem->valid) {
  487. hal_err("queue full");
  488. QDF_BUG(0);
  489. return;
  490. }
  491. qdf_atomic_inc(&hal_soc->stats.wstats.enqueues);
  492. srng->wstats.enqueues++;
  493. qdf_atomic_inc(&hal_soc->stats.wstats.q_depth);
  494. q_elem->srng = srng;
  495. q_elem->addr = addr;
  496. q_elem->enqueue_val = value;
  497. q_elem->enqueue_time = qdf_get_log_timestamp();
  498. /*
  499. * Before the valid flag is set to true, all the other
  500. * fields in the q_elem needs to be updated in memory.
  501. * Else there is a chance that the dequeuing worker thread
  502. * might read stale entries and process incorrect srng.
  503. */
  504. qdf_wmb();
  505. q_elem->valid = true;
  506. /*
  507. * After all other fields in the q_elem has been updated
  508. * in memory successfully, the valid flag needs to be updated
  509. * in memory in time too.
  510. * Else there is a chance that the dequeuing worker thread
  511. * might read stale valid flag and the work will be bypassed
  512. * for this round. And if there is no other work scheduled
  513. * later, this hal register writing won't be updated any more.
  514. */
  515. qdf_wmb();
  516. srng->reg_write_in_progress = true;
  517. qdf_atomic_inc(&hal_soc->active_work_cnt);
  518. hal_verbose_debug("write_idx %u srng ring id 0x%x addr 0x%pK val %u",
  519. write_idx, srng->ring_id, addr, value);
  520. qdf_queue_work(hal_soc->qdf_dev, hal_soc->reg_write_wq,
  521. &hal_soc->reg_write_work);
  522. }
  523. void hal_delayed_reg_write(struct hal_soc *hal_soc,
  524. struct hal_srng *srng,
  525. void __iomem *addr,
  526. uint32_t value)
  527. {
  528. if (pld_is_device_awake(hal_soc->qdf_dev->dev) ||
  529. hal_is_reg_write_tput_level_high(hal_soc)) {
  530. qdf_atomic_inc(&hal_soc->stats.wstats.direct);
  531. srng->wstats.direct++;
  532. hal_write_address_32_mb(hal_soc, addr, value, false);
  533. } else {
  534. hal_reg_write_enqueue(hal_soc, srng, addr, value);
  535. }
  536. }
  537. /**
  538. * hal_delayed_reg_write_init() - Initialization function for delayed reg writes
  539. * @hal_soc: hal_soc pointer
  540. *
  541. * Initialize main data structures to process register writes in a delayed
  542. * workqueue.
  543. *
  544. * Return: QDF_STATUS_SUCCESS on success else a QDF error.
  545. */
  546. static QDF_STATUS hal_delayed_reg_write_init(struct hal_soc *hal)
  547. {
  548. hal->reg_write_wq =
  549. qdf_alloc_high_prior_ordered_workqueue("hal_register_write_wq");
  550. qdf_create_work(0, &hal->reg_write_work, hal_reg_write_work, hal);
  551. hal->reg_write_queue = qdf_mem_malloc(HAL_REG_WRITE_QUEUE_LEN *
  552. sizeof(*hal->reg_write_queue));
  553. if (!hal->reg_write_queue) {
  554. hal_err("unable to allocate memory");
  555. QDF_BUG(0);
  556. return QDF_STATUS_E_NOMEM;
  557. }
  558. /* Initial value of indices */
  559. hal->read_idx = 0;
  560. qdf_atomic_set(&hal->write_idx, -1);
  561. return QDF_STATUS_SUCCESS;
  562. }
  563. /**
  564. * hal_delayed_reg_write_deinit() - De-Initialize delayed reg write processing
  565. * @hal_soc: hal_soc pointer
  566. *
  567. * De-initialize main data structures to process register writes in a delayed
  568. * workqueue.
  569. *
  570. * Return: None
  571. */
  572. static void hal_delayed_reg_write_deinit(struct hal_soc *hal)
  573. {
  574. hal_flush_reg_write_work(hal);
  575. qdf_destroy_workqueue(0, hal->reg_write_wq);
  576. qdf_mem_free(hal->reg_write_queue);
  577. }
  578. static inline
  579. char *hal_fill_reg_write_srng_stats(struct hal_srng *srng,
  580. char *buf, qdf_size_t size)
  581. {
  582. qdf_scnprintf(buf, size, "enq %u deq %u coal %u direct %u",
  583. srng->wstats.enqueues, srng->wstats.dequeues,
  584. srng->wstats.coalesces, srng->wstats.direct);
  585. return buf;
  586. }
  587. /* bytes for local buffer */
  588. #define HAL_REG_WRITE_SRNG_STATS_LEN 100
  589. void hal_dump_reg_write_srng_stats(hal_soc_handle_t hal_soc_hdl)
  590. {
  591. struct hal_srng *srng;
  592. char buf[HAL_REG_WRITE_SRNG_STATS_LEN];
  593. struct hal_soc *hal = (struct hal_soc *)hal_soc_hdl;
  594. srng = hal_get_srng(hal, HAL_SRNG_SW2TCL1);
  595. hal_debug("SW2TCL1: %s",
  596. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  597. srng = hal_get_srng(hal, HAL_SRNG_WBM2SW0_RELEASE);
  598. hal_debug("WBM2SW0: %s",
  599. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  600. srng = hal_get_srng(hal, HAL_SRNG_REO2SW1);
  601. hal_debug("REO2SW1: %s",
  602. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  603. srng = hal_get_srng(hal, HAL_SRNG_REO2SW2);
  604. hal_debug("REO2SW2: %s",
  605. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  606. srng = hal_get_srng(hal, HAL_SRNG_REO2SW3);
  607. hal_debug("REO2SW3: %s",
  608. hal_fill_reg_write_srng_stats(srng, buf, sizeof(buf)));
  609. }
  610. void hal_dump_reg_write_stats(hal_soc_handle_t hal_soc_hdl)
  611. {
  612. uint32_t *hist;
  613. struct hal_soc *hal = (struct hal_soc *)hal_soc_hdl;
  614. hist = hal->stats.wstats.sched_delay;
  615. hal_debug("enq %u deq %u coal %u direct %u q_depth %u max_q %u sched-delay hist %u %u %u %u",
  616. qdf_atomic_read(&hal->stats.wstats.enqueues),
  617. hal->stats.wstats.dequeues,
  618. qdf_atomic_read(&hal->stats.wstats.coalesces),
  619. qdf_atomic_read(&hal->stats.wstats.direct),
  620. qdf_atomic_read(&hal->stats.wstats.q_depth),
  621. hal->stats.wstats.max_q_depth,
  622. hist[REG_WRITE_SCHED_DELAY_SUB_100us],
  623. hist[REG_WRITE_SCHED_DELAY_SUB_1000us],
  624. hist[REG_WRITE_SCHED_DELAY_SUB_5000us],
  625. hist[REG_WRITE_SCHED_DELAY_GT_5000us]);
  626. }
  627. int hal_get_reg_write_pending_work(void *hal_soc)
  628. {
  629. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  630. return qdf_atomic_read(&hal->active_work_cnt);
  631. }
  632. #else
  633. static inline QDF_STATUS hal_delayed_reg_write_init(struct hal_soc *hal)
  634. {
  635. return QDF_STATUS_SUCCESS;
  636. }
  637. static inline void hal_delayed_reg_write_deinit(struct hal_soc *hal)
  638. {
  639. }
  640. #endif
  641. /**
  642. * hal_attach - Initialize HAL layer
  643. * @hif_handle: Opaque HIF handle
  644. * @qdf_dev: QDF device
  645. *
  646. * Return: Opaque HAL SOC handle
  647. * NULL on failure (if given ring is not available)
  648. *
  649. * This function should be called as part of HIF initialization (for accessing
  650. * copy engines). DP layer will get hal_soc handle using hif_get_hal_handle()
  651. *
  652. */
  653. void *hal_attach(struct hif_opaque_softc *hif_handle, qdf_device_t qdf_dev)
  654. {
  655. struct hal_soc *hal;
  656. int i;
  657. hal = qdf_mem_malloc(sizeof(*hal));
  658. if (!hal) {
  659. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  660. "%s: hal_soc allocation failed", __func__);
  661. goto fail0;
  662. }
  663. hal->hif_handle = hif_handle;
  664. hal->dev_base_addr = hif_get_dev_ba(hif_handle); /* UMAC */
  665. hal->dev_base_addr_ce = hif_get_dev_ba_ce(hif_handle); /* CE */
  666. hal->qdf_dev = qdf_dev;
  667. hal->shadow_rdptr_mem_vaddr = (uint32_t *)qdf_mem_alloc_consistent(
  668. qdf_dev, qdf_dev->dev, sizeof(*(hal->shadow_rdptr_mem_vaddr)) *
  669. HAL_SRNG_ID_MAX, &(hal->shadow_rdptr_mem_paddr));
  670. if (!hal->shadow_rdptr_mem_paddr) {
  671. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  672. "%s: hal->shadow_rdptr_mem_paddr allocation failed",
  673. __func__);
  674. goto fail1;
  675. }
  676. qdf_mem_zero(hal->shadow_rdptr_mem_vaddr,
  677. sizeof(*(hal->shadow_rdptr_mem_vaddr)) * HAL_SRNG_ID_MAX);
  678. hal->shadow_wrptr_mem_vaddr =
  679. (uint32_t *)qdf_mem_alloc_consistent(qdf_dev, qdf_dev->dev,
  680. sizeof(*(hal->shadow_wrptr_mem_vaddr)) * HAL_MAX_LMAC_RINGS,
  681. &(hal->shadow_wrptr_mem_paddr));
  682. if (!hal->shadow_wrptr_mem_vaddr) {
  683. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  684. "%s: hal->shadow_wrptr_mem_vaddr allocation failed",
  685. __func__);
  686. goto fail2;
  687. }
  688. qdf_mem_zero(hal->shadow_wrptr_mem_vaddr,
  689. sizeof(*(hal->shadow_wrptr_mem_vaddr)) * HAL_MAX_LMAC_RINGS);
  690. for (i = 0; i < HAL_SRNG_ID_MAX; i++) {
  691. hal->srng_list[i].initialized = 0;
  692. hal->srng_list[i].ring_id = i;
  693. }
  694. qdf_spinlock_create(&hal->register_access_lock);
  695. hal->register_window = 0;
  696. hal->target_type = hal_get_target_type(hal_soc_to_hal_soc_handle(hal));
  697. hal_target_based_configure(hal);
  698. hal_reg_write_fail_history_init(hal);
  699. qdf_minidump_log(hal, sizeof(*hal), "hal_soc");
  700. qdf_atomic_init(&hal->active_work_cnt);
  701. hal_delayed_reg_write_init(hal);
  702. return (void *)hal;
  703. fail2:
  704. qdf_mem_free_consistent(qdf_dev, qdf_dev->dev,
  705. sizeof(*(hal->shadow_rdptr_mem_vaddr)) * HAL_SRNG_ID_MAX,
  706. hal->shadow_rdptr_mem_vaddr, hal->shadow_rdptr_mem_paddr, 0);
  707. fail1:
  708. qdf_mem_free(hal);
  709. fail0:
  710. return NULL;
  711. }
  712. qdf_export_symbol(hal_attach);
  713. /**
  714. * hal_mem_info - Retrieve hal memory base address
  715. *
  716. * @hal_soc: Opaque HAL SOC handle
  717. * @mem: pointer to structure to be updated with hal mem info
  718. */
  719. void hal_get_meminfo(hal_soc_handle_t hal_soc_hdl, struct hal_mem_info *mem)
  720. {
  721. struct hal_soc *hal = (struct hal_soc *)hal_soc_hdl;
  722. mem->dev_base_addr = (void *)hal->dev_base_addr;
  723. mem->shadow_rdptr_mem_vaddr = (void *)hal->shadow_rdptr_mem_vaddr;
  724. mem->shadow_wrptr_mem_vaddr = (void *)hal->shadow_wrptr_mem_vaddr;
  725. mem->shadow_rdptr_mem_paddr = (void *)hal->shadow_rdptr_mem_paddr;
  726. mem->shadow_wrptr_mem_paddr = (void *)hal->shadow_wrptr_mem_paddr;
  727. hif_read_phy_mem_base((void *)hal->hif_handle,
  728. (qdf_dma_addr_t *)&mem->dev_base_paddr);
  729. return;
  730. }
  731. qdf_export_symbol(hal_get_meminfo);
  732. /**
  733. * hal_detach - Detach HAL layer
  734. * @hal_soc: HAL SOC handle
  735. *
  736. * Return: Opaque HAL SOC handle
  737. * NULL on failure (if given ring is not available)
  738. *
  739. * This function should be called as part of HIF initialization (for accessing
  740. * copy engines). DP layer will get hal_soc handle using hif_get_hal_handle()
  741. *
  742. */
  743. extern void hal_detach(void *hal_soc)
  744. {
  745. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  746. hal_delayed_reg_write_deinit(hal);
  747. qdf_mem_free_consistent(hal->qdf_dev, hal->qdf_dev->dev,
  748. sizeof(*(hal->shadow_rdptr_mem_vaddr)) * HAL_SRNG_ID_MAX,
  749. hal->shadow_rdptr_mem_vaddr, hal->shadow_rdptr_mem_paddr, 0);
  750. qdf_mem_free_consistent(hal->qdf_dev, hal->qdf_dev->dev,
  751. sizeof(*(hal->shadow_wrptr_mem_vaddr)) * HAL_MAX_LMAC_RINGS,
  752. hal->shadow_wrptr_mem_vaddr, hal->shadow_wrptr_mem_paddr, 0);
  753. qdf_minidump_remove(hal);
  754. qdf_mem_free(hal);
  755. return;
  756. }
  757. qdf_export_symbol(hal_detach);
  758. /**
  759. * hal_ce_dst_setup - Initialize CE destination ring registers
  760. * @hal_soc: HAL SOC handle
  761. * @srng: SRNG ring pointer
  762. */
  763. static inline void hal_ce_dst_setup(struct hal_soc *hal, struct hal_srng *srng,
  764. int ring_num)
  765. {
  766. uint32_t reg_val = 0;
  767. uint32_t reg_addr;
  768. struct hal_hw_srng_config *ring_config =
  769. HAL_SRNG_CONFIG(hal, CE_DST);
  770. /* set DEST_MAX_LENGTH according to ce assignment */
  771. reg_addr = HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_CTRL_ADDR(
  772. ring_config->reg_start[R0_INDEX] +
  773. (ring_num * ring_config->reg_size[R0_INDEX]));
  774. reg_val = HAL_REG_READ(hal, reg_addr);
  775. reg_val &= ~HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_CTRL_DEST_MAX_LENGTH_BMSK;
  776. reg_val |= srng->u.dst_ring.max_buffer_length &
  777. HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_CTRL_DEST_MAX_LENGTH_BMSK;
  778. HAL_REG_WRITE(hal, reg_addr, reg_val);
  779. if (srng->prefetch_timer) {
  780. reg_addr = HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_RING_CONSUMER_PREFETCH_TIMER_ADDR(
  781. ring_config->reg_start[R0_INDEX] +
  782. (ring_num * ring_config->reg_size[R0_INDEX]));
  783. reg_val = HAL_REG_READ(hal, reg_addr);
  784. reg_val &= ~HWIO_WFSS_CE_CHANNEL_DST_R0_DEST_RING_CONSUMER_PREFETCH_TIMER_RMSK;
  785. reg_val |= srng->prefetch_timer;
  786. HAL_REG_WRITE(hal, reg_addr, reg_val);
  787. reg_val = HAL_REG_READ(hal, reg_addr);
  788. }
  789. }
  790. /**
  791. * hal_reo_read_write_ctrl_ix - Read or write REO_DESTINATION_RING_CTRL_IX
  792. * @hal: HAL SOC handle
  793. * @read: boolean value to indicate if read or write
  794. * @ix0: pointer to store IX0 reg value
  795. * @ix1: pointer to store IX1 reg value
  796. * @ix2: pointer to store IX2 reg value
  797. * @ix3: pointer to store IX3 reg value
  798. */
  799. void hal_reo_read_write_ctrl_ix(hal_soc_handle_t hal_soc_hdl, bool read,
  800. uint32_t *ix0, uint32_t *ix1,
  801. uint32_t *ix2, uint32_t *ix3)
  802. {
  803. uint32_t reg_offset;
  804. struct hal_soc *hal = (struct hal_soc *)hal_soc_hdl;
  805. if (read) {
  806. if (ix0) {
  807. reg_offset =
  808. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_0_ADDR(
  809. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  810. *ix0 = HAL_REG_READ(hal, reg_offset);
  811. }
  812. if (ix1) {
  813. reg_offset =
  814. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_1_ADDR(
  815. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  816. *ix1 = HAL_REG_READ(hal, reg_offset);
  817. }
  818. if (ix2) {
  819. reg_offset =
  820. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_2_ADDR(
  821. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  822. *ix2 = HAL_REG_READ(hal, reg_offset);
  823. }
  824. if (ix3) {
  825. reg_offset =
  826. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_3_ADDR(
  827. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  828. *ix3 = HAL_REG_READ(hal, reg_offset);
  829. }
  830. } else {
  831. if (ix0) {
  832. reg_offset =
  833. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_0_ADDR(
  834. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  835. HAL_REG_WRITE_CONFIRM_RETRY(hal, reg_offset,
  836. *ix0, true);
  837. }
  838. if (ix1) {
  839. reg_offset =
  840. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_1_ADDR(
  841. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  842. HAL_REG_WRITE_CONFIRM_RETRY(hal, reg_offset,
  843. *ix1, true);
  844. }
  845. if (ix2) {
  846. reg_offset =
  847. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_2_ADDR(
  848. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  849. HAL_REG_WRITE_CONFIRM_RETRY(hal, reg_offset,
  850. *ix2, true);
  851. }
  852. if (ix3) {
  853. reg_offset =
  854. HWIO_REO_R0_DESTINATION_RING_CTRL_IX_3_ADDR(
  855. SEQ_WCSS_UMAC_REO_REG_OFFSET);
  856. HAL_REG_WRITE_CONFIRM_RETRY(hal, reg_offset,
  857. *ix3, true);
  858. }
  859. }
  860. }
  861. /**
  862. * hal_srng_dst_set_hp_paddr() - Set physical address to dest ring head pointer
  863. * @srng: sring pointer
  864. * @paddr: physical address
  865. */
  866. void hal_srng_dst_set_hp_paddr(struct hal_srng *srng,
  867. uint64_t paddr)
  868. {
  869. SRNG_DST_REG_WRITE(srng, HP_ADDR_LSB,
  870. paddr & 0xffffffff);
  871. SRNG_DST_REG_WRITE(srng, HP_ADDR_MSB,
  872. paddr >> 32);
  873. }
  874. /**
  875. * hal_srng_dst_init_hp() - Initilaize destination ring head pointer
  876. * @srng: sring pointer
  877. * @vaddr: virtual address
  878. */
  879. void hal_srng_dst_init_hp(struct hal_srng *srng,
  880. uint32_t *vaddr)
  881. {
  882. if (!srng)
  883. return;
  884. srng->u.dst_ring.hp_addr = vaddr;
  885. SRNG_DST_REG_WRITE_CONFIRM(srng, HP, srng->u.dst_ring.cached_hp);
  886. if (vaddr) {
  887. *srng->u.dst_ring.hp_addr = srng->u.dst_ring.cached_hp;
  888. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
  889. "hp_addr=%pK, cached_hp=%d, hp=%d",
  890. (void *)srng->u.dst_ring.hp_addr,
  891. srng->u.dst_ring.cached_hp,
  892. *srng->u.dst_ring.hp_addr);
  893. }
  894. }
  895. /**
  896. * hal_srng_hw_init - Private function to initialize SRNG HW
  897. * @hal_soc: HAL SOC handle
  898. * @srng: SRNG ring pointer
  899. */
  900. static inline void hal_srng_hw_init(struct hal_soc *hal,
  901. struct hal_srng *srng)
  902. {
  903. if (srng->ring_dir == HAL_SRNG_SRC_RING)
  904. hal_srng_src_hw_init(hal, srng);
  905. else
  906. hal_srng_dst_hw_init(hal, srng);
  907. }
  908. #ifdef CONFIG_SHADOW_V2
  909. #define ignore_shadow false
  910. #define CHECK_SHADOW_REGISTERS true
  911. #else
  912. #define ignore_shadow true
  913. #define CHECK_SHADOW_REGISTERS false
  914. #endif
  915. /**
  916. * hal_srng_setup - Initialize HW SRNG ring.
  917. * @hal_soc: Opaque HAL SOC handle
  918. * @ring_type: one of the types from hal_ring_type
  919. * @ring_num: Ring number if there are multiple rings of same type (staring
  920. * from 0)
  921. * @mac_id: valid MAC Id should be passed if ring type is one of lmac rings
  922. * @ring_params: SRNG ring params in hal_srng_params structure.
  923. * Callers are expected to allocate contiguous ring memory of size
  924. * 'num_entries * entry_size' bytes and pass the physical and virtual base
  925. * addresses through 'ring_base_paddr' and 'ring_base_vaddr' in
  926. * hal_srng_params structure. Ring base address should be 8 byte aligned
  927. * and size of each ring entry should be queried using the API
  928. * hal_srng_get_entrysize
  929. *
  930. * Return: Opaque pointer to ring on success
  931. * NULL on failure (if given ring is not available)
  932. */
  933. void *hal_srng_setup(void *hal_soc, int ring_type, int ring_num,
  934. int mac_id, struct hal_srng_params *ring_params)
  935. {
  936. int ring_id;
  937. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  938. struct hal_srng *srng;
  939. struct hal_hw_srng_config *ring_config =
  940. HAL_SRNG_CONFIG(hal, ring_type);
  941. void *dev_base_addr;
  942. int i;
  943. ring_id = hal_get_srng_ring_id(hal_soc, ring_type, ring_num, mac_id);
  944. if (ring_id < 0)
  945. return NULL;
  946. hal_verbose_debug("mac_id %d ring_id %d", mac_id, ring_id);
  947. srng = hal_get_srng(hal_soc, ring_id);
  948. if (srng->initialized) {
  949. hal_verbose_debug("Ring (ring_type, ring_num) already initialized");
  950. return NULL;
  951. }
  952. dev_base_addr = hal->dev_base_addr;
  953. srng->ring_id = ring_id;
  954. srng->ring_dir = ring_config->ring_dir;
  955. srng->ring_base_paddr = ring_params->ring_base_paddr;
  956. srng->ring_base_vaddr = ring_params->ring_base_vaddr;
  957. srng->entry_size = ring_config->entry_size;
  958. srng->num_entries = ring_params->num_entries;
  959. srng->ring_size = srng->num_entries * srng->entry_size;
  960. srng->ring_size_mask = srng->ring_size - 1;
  961. srng->msi_addr = ring_params->msi_addr;
  962. srng->msi_data = ring_params->msi_data;
  963. srng->intr_timer_thres_us = ring_params->intr_timer_thres_us;
  964. srng->intr_batch_cntr_thres_entries =
  965. ring_params->intr_batch_cntr_thres_entries;
  966. srng->prefetch_timer = ring_params->prefetch_timer;
  967. srng->hal_soc = hal_soc;
  968. for (i = 0 ; i < MAX_SRNG_REG_GROUPS; i++) {
  969. srng->hwreg_base[i] = dev_base_addr + ring_config->reg_start[i]
  970. + (ring_num * ring_config->reg_size[i]);
  971. }
  972. /* Zero out the entire ring memory */
  973. qdf_mem_zero(srng->ring_base_vaddr, (srng->entry_size *
  974. srng->num_entries) << 2);
  975. srng->flags = ring_params->flags;
  976. #ifdef BIG_ENDIAN_HOST
  977. /* TODO: See if we should we get these flags from caller */
  978. srng->flags |= HAL_SRNG_DATA_TLV_SWAP;
  979. srng->flags |= HAL_SRNG_MSI_SWAP;
  980. srng->flags |= HAL_SRNG_RING_PTR_SWAP;
  981. #endif
  982. if (srng->ring_dir == HAL_SRNG_SRC_RING) {
  983. srng->u.src_ring.hp = 0;
  984. srng->u.src_ring.reap_hp = srng->ring_size -
  985. srng->entry_size;
  986. srng->u.src_ring.tp_addr =
  987. &(hal->shadow_rdptr_mem_vaddr[ring_id]);
  988. srng->u.src_ring.low_threshold =
  989. ring_params->low_threshold * srng->entry_size;
  990. if (ring_config->lmac_ring) {
  991. /* For LMAC rings, head pointer updates will be done
  992. * through FW by writing to a shared memory location
  993. */
  994. srng->u.src_ring.hp_addr =
  995. &(hal->shadow_wrptr_mem_vaddr[ring_id -
  996. HAL_SRNG_LMAC1_ID_START]);
  997. srng->flags |= HAL_SRNG_LMAC_RING;
  998. } else if (ignore_shadow || (srng->u.src_ring.hp_addr == 0)) {
  999. srng->u.src_ring.hp_addr =
  1000. hal_get_window_address(hal,
  1001. SRNG_SRC_ADDR(srng, HP));
  1002. if (CHECK_SHADOW_REGISTERS) {
  1003. QDF_TRACE(QDF_MODULE_ID_TXRX,
  1004. QDF_TRACE_LEVEL_ERROR,
  1005. "%s: Ring (%d, %d) missing shadow config",
  1006. __func__, ring_type, ring_num);
  1007. }
  1008. } else {
  1009. hal_validate_shadow_register(hal,
  1010. SRNG_SRC_ADDR(srng, HP),
  1011. srng->u.src_ring.hp_addr);
  1012. }
  1013. } else {
  1014. /* During initialization loop count in all the descriptors
  1015. * will be set to zero, and HW will set it to 1 on completing
  1016. * descriptor update in first loop, and increments it by 1 on
  1017. * subsequent loops (loop count wraps around after reaching
  1018. * 0xffff). The 'loop_cnt' in SW ring state is the expected
  1019. * loop count in descriptors updated by HW (to be processed
  1020. * by SW).
  1021. */
  1022. srng->u.dst_ring.loop_cnt = 1;
  1023. srng->u.dst_ring.tp = 0;
  1024. srng->u.dst_ring.hp_addr =
  1025. &(hal->shadow_rdptr_mem_vaddr[ring_id]);
  1026. if (ring_config->lmac_ring) {
  1027. /* For LMAC rings, tail pointer updates will be done
  1028. * through FW by writing to a shared memory location
  1029. */
  1030. srng->u.dst_ring.tp_addr =
  1031. &(hal->shadow_wrptr_mem_vaddr[ring_id -
  1032. HAL_SRNG_LMAC1_ID_START]);
  1033. srng->flags |= HAL_SRNG_LMAC_RING;
  1034. } else if (ignore_shadow || srng->u.dst_ring.tp_addr == 0) {
  1035. srng->u.dst_ring.tp_addr =
  1036. hal_get_window_address(hal,
  1037. SRNG_DST_ADDR(srng, TP));
  1038. if (CHECK_SHADOW_REGISTERS) {
  1039. QDF_TRACE(QDF_MODULE_ID_TXRX,
  1040. QDF_TRACE_LEVEL_ERROR,
  1041. "%s: Ring (%d, %d) missing shadow config",
  1042. __func__, ring_type, ring_num);
  1043. }
  1044. } else {
  1045. hal_validate_shadow_register(hal,
  1046. SRNG_DST_ADDR(srng, TP),
  1047. srng->u.dst_ring.tp_addr);
  1048. }
  1049. }
  1050. if (!(ring_config->lmac_ring)) {
  1051. hal_srng_hw_init(hal, srng);
  1052. if (ring_type == CE_DST) {
  1053. srng->u.dst_ring.max_buffer_length = ring_params->max_buffer_length;
  1054. hal_ce_dst_setup(hal, srng, ring_num);
  1055. }
  1056. }
  1057. SRNG_LOCK_INIT(&srng->lock);
  1058. srng->srng_event = 0;
  1059. srng->initialized = true;
  1060. return (void *)srng;
  1061. }
  1062. qdf_export_symbol(hal_srng_setup);
  1063. /**
  1064. * hal_srng_cleanup - Deinitialize HW SRNG ring.
  1065. * @hal_soc: Opaque HAL SOC handle
  1066. * @hal_srng: Opaque HAL SRNG pointer
  1067. */
  1068. void hal_srng_cleanup(void *hal_soc, hal_ring_handle_t hal_ring_hdl)
  1069. {
  1070. struct hal_srng *srng = (struct hal_srng *)hal_ring_hdl;
  1071. SRNG_LOCK_DESTROY(&srng->lock);
  1072. srng->initialized = 0;
  1073. }
  1074. qdf_export_symbol(hal_srng_cleanup);
  1075. /**
  1076. * hal_srng_get_entrysize - Returns size of ring entry in bytes
  1077. * @hal_soc: Opaque HAL SOC handle
  1078. * @ring_type: one of the types from hal_ring_type
  1079. *
  1080. */
  1081. uint32_t hal_srng_get_entrysize(void *hal_soc, int ring_type)
  1082. {
  1083. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  1084. struct hal_hw_srng_config *ring_config =
  1085. HAL_SRNG_CONFIG(hal, ring_type);
  1086. return ring_config->entry_size << 2;
  1087. }
  1088. qdf_export_symbol(hal_srng_get_entrysize);
  1089. /**
  1090. * hal_srng_max_entries - Returns maximum possible number of ring entries
  1091. * @hal_soc: Opaque HAL SOC handle
  1092. * @ring_type: one of the types from hal_ring_type
  1093. *
  1094. * Return: Maximum number of entries for the given ring_type
  1095. */
  1096. uint32_t hal_srng_max_entries(void *hal_soc, int ring_type)
  1097. {
  1098. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  1099. struct hal_hw_srng_config *ring_config =
  1100. HAL_SRNG_CONFIG(hal, ring_type);
  1101. return ring_config->max_size / ring_config->entry_size;
  1102. }
  1103. qdf_export_symbol(hal_srng_max_entries);
  1104. enum hal_srng_dir hal_srng_get_dir(void *hal_soc, int ring_type)
  1105. {
  1106. struct hal_soc *hal = (struct hal_soc *)hal_soc;
  1107. struct hal_hw_srng_config *ring_config =
  1108. HAL_SRNG_CONFIG(hal, ring_type);
  1109. return ring_config->ring_dir;
  1110. }
  1111. /**
  1112. * hal_srng_dump - Dump ring status
  1113. * @srng: hal srng pointer
  1114. */
  1115. void hal_srng_dump(struct hal_srng *srng)
  1116. {
  1117. if (srng->ring_dir == HAL_SRNG_SRC_RING) {
  1118. hal_debug("=== SRC RING %d ===", srng->ring_id);
  1119. hal_debug("hp %u, reap_hp %u, tp %u, cached tp %u",
  1120. srng->u.src_ring.hp,
  1121. srng->u.src_ring.reap_hp,
  1122. *srng->u.src_ring.tp_addr,
  1123. srng->u.src_ring.cached_tp);
  1124. } else {
  1125. hal_debug("=== DST RING %d ===", srng->ring_id);
  1126. hal_debug("tp %u, hp %u, cached tp %u, loop_cnt %u",
  1127. srng->u.dst_ring.tp,
  1128. *srng->u.dst_ring.hp_addr,
  1129. srng->u.dst_ring.cached_hp,
  1130. srng->u.dst_ring.loop_cnt);
  1131. }
  1132. }
  1133. /**
  1134. * hal_get_srng_params - Retrieve SRNG parameters for a given ring from HAL
  1135. *
  1136. * @hal_soc: Opaque HAL SOC handle
  1137. * @hal_ring: Ring pointer (Source or Destination ring)
  1138. * @ring_params: SRNG parameters will be returned through this structure
  1139. */
  1140. extern void hal_get_srng_params(hal_soc_handle_t hal_soc_hdl,
  1141. hal_ring_handle_t hal_ring_hdl,
  1142. struct hal_srng_params *ring_params)
  1143. {
  1144. struct hal_srng *srng = (struct hal_srng *)hal_ring_hdl;
  1145. int i =0;
  1146. ring_params->ring_id = srng->ring_id;
  1147. ring_params->ring_dir = srng->ring_dir;
  1148. ring_params->entry_size = srng->entry_size;
  1149. ring_params->ring_base_paddr = srng->ring_base_paddr;
  1150. ring_params->ring_base_vaddr = srng->ring_base_vaddr;
  1151. ring_params->num_entries = srng->num_entries;
  1152. ring_params->msi_addr = srng->msi_addr;
  1153. ring_params->msi_data = srng->msi_data;
  1154. ring_params->intr_timer_thres_us = srng->intr_timer_thres_us;
  1155. ring_params->intr_batch_cntr_thres_entries =
  1156. srng->intr_batch_cntr_thres_entries;
  1157. ring_params->low_threshold = srng->u.src_ring.low_threshold;
  1158. ring_params->flags = srng->flags;
  1159. ring_params->ring_id = srng->ring_id;
  1160. for (i = 0 ; i < MAX_SRNG_REG_GROUPS; i++)
  1161. ring_params->hwreg_base[i] = srng->hwreg_base[i];
  1162. }
  1163. qdf_export_symbol(hal_get_srng_params);
  1164. void hal_set_low_threshold(hal_ring_handle_t hal_ring_hdl,
  1165. uint32_t low_threshold)
  1166. {
  1167. struct hal_srng *srng = (struct hal_srng *)hal_ring_hdl;
  1168. srng->u.src_ring.low_threshold = low_threshold * srng->entry_size;
  1169. }
  1170. qdf_export_symbol(hal_set_low_threshold);
  1171. #ifdef FORCE_WAKE
  1172. void hal_set_init_phase(hal_soc_handle_t soc, bool init_phase)
  1173. {
  1174. struct hal_soc *hal_soc = (struct hal_soc *)soc;
  1175. hal_soc->init_phase = init_phase;
  1176. }
  1177. #endif /* FORCE_WAKE */