dp_reo.c 5.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204
  1. /*
  2. * Copyright (c) 2016-2021 The Linux Foundation. All rights reserved.
  3. * Copyright (c) 2021-2023 Qualcomm Innovation Center, Inc. All rights reserved.
  4. *
  5. * Permission to use, copy, modify, and/or distribute this software for
  6. * any purpose with or without fee is hereby granted, provided that the
  7. * above copyright notice and this permission notice appear in all
  8. * copies.
  9. *
  10. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  11. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  12. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  13. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  14. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  15. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  16. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  17. * PERFORMANCE OF THIS SOFTWARE.
  18. */
  19. #include "dp_types.h"
  20. #include "hal_reo.h"
  21. #include "dp_internal.h"
  22. #include <qdf_time.h>
  23. #define dp_reo_alert(params...) QDF_TRACE_FATAL(QDF_MODULE_ID_DP_REO, params)
  24. #define dp_reo_err(params...) QDF_TRACE_ERROR(QDF_MODULE_ID_DP_REO, params)
  25. #define dp_reo_warn(params...) QDF_TRACE_WARN(QDF_MODULE_ID_DP_REO, params)
  26. #define dp_reo_info(params...) \
  27. __QDF_TRACE_FL(QDF_TRACE_LEVEL_INFO_HIGH, QDF_MODULE_ID_DP_REO, ## params)
  28. #define dp_reo_debug(params...) QDF_TRACE_DEBUG(QDF_MODULE_ID_DP_REO, params)
  29. #ifdef WLAN_FEATURE_DP_EVENT_HISTORY
  30. /**
  31. * dp_reo_cmd_srng_event_record() - Record reo cmds posted
  32. * to the reo cmd ring
  33. * @soc: dp soc handle
  34. * @type: reo cmd type
  35. * @post_status: command error status
  36. *
  37. * Return: None
  38. */
  39. static
  40. void dp_reo_cmd_srng_event_record(struct dp_soc *soc,
  41. enum hal_reo_cmd_type type,
  42. int post_status)
  43. {
  44. struct reo_cmd_event_history *cmd_event_history =
  45. &soc->stats.cmd_event_history;
  46. struct reo_cmd_event_record *record = cmd_event_history->cmd_record;
  47. int record_index;
  48. record_index = (qdf_atomic_inc_return(&cmd_event_history->index)) &
  49. (REO_CMD_EVENT_HIST_MAX - 1);
  50. record[record_index].cmd_type = type;
  51. record[record_index].cmd_return_status = post_status;
  52. record[record_index].timestamp = qdf_get_log_timestamp();
  53. }
  54. #else
  55. static inline
  56. void dp_reo_cmd_srng_event_record(struct dp_soc *soc,
  57. enum hal_reo_cmd_type type,
  58. int post_status)
  59. {
  60. }
  61. #endif /*WLAN_FEATURE_DP_EVENT_HISTORY */
  62. #ifdef DP_UMAC_HW_RESET_SUPPORT
  63. void dp_pause_reo_send_cmd(struct dp_soc *soc)
  64. {
  65. hal_unregister_reo_send_cmd(soc->hal_soc);
  66. }
  67. void dp_resume_reo_send_cmd(struct dp_soc *soc)
  68. {
  69. hal_register_reo_send_cmd(soc->hal_soc);
  70. }
  71. void
  72. dp_reset_rx_reo_tid_queue(struct dp_soc *soc, void *hw_qdesc_vaddr,
  73. uint32_t size)
  74. {
  75. hal_reset_rx_reo_tid_queue(soc->hal_soc, hw_qdesc_vaddr, size);
  76. }
  77. #endif
  78. QDF_STATUS dp_reo_send_cmd(struct dp_soc *soc, enum hal_reo_cmd_type type,
  79. struct hal_reo_cmd_params *params,
  80. void (*callback_fn), void *data)
  81. {
  82. struct dp_reo_cmd_info *reo_cmd;
  83. int num;
  84. num = hal_reo_send_cmd(soc->hal_soc, soc->reo_cmd_ring.hal_srng, type,
  85. params);
  86. if (num < 0)
  87. return QDF_STATUS_E_INVAL;
  88. dp_reo_cmd_srng_event_record(soc, type, num);
  89. if (num < 0) {
  90. return QDF_STATUS_E_FAILURE;
  91. }
  92. if (callback_fn) {
  93. reo_cmd = qdf_mem_malloc(sizeof(*reo_cmd));
  94. if (!reo_cmd) {
  95. dp_err_log("alloc failed for REO cmd:%d!!",
  96. type);
  97. return QDF_STATUS_E_NOMEM;
  98. }
  99. reo_cmd->cmd = num;
  100. reo_cmd->cmd_type = type;
  101. reo_cmd->handler = callback_fn;
  102. reo_cmd->data = data;
  103. qdf_spin_lock_bh(&soc->rx.reo_cmd_lock);
  104. TAILQ_INSERT_TAIL(&soc->rx.reo_cmd_list, reo_cmd,
  105. reo_cmd_list_elem);
  106. qdf_spin_unlock_bh(&soc->rx.reo_cmd_lock);
  107. }
  108. return QDF_STATUS_SUCCESS;
  109. }
  110. uint32_t dp_reo_status_ring_handler(struct dp_intr *int_ctx, struct dp_soc *soc)
  111. {
  112. hal_ring_desc_t reo_desc;
  113. struct dp_reo_cmd_info *reo_cmd = NULL;
  114. union hal_reo_status reo_status;
  115. int num;
  116. int processed_count = 0;
  117. if (dp_srng_access_start(int_ctx, soc, soc->reo_status_ring.hal_srng)) {
  118. return processed_count;
  119. }
  120. reo_desc = hal_srng_dst_get_next(soc->hal_soc,
  121. soc->reo_status_ring.hal_srng);
  122. while (reo_desc) {
  123. uint16_t tlv = HAL_GET_TLV(reo_desc);
  124. QDF_STATUS status;
  125. processed_count++;
  126. status = hal_reo_status_update(soc->hal_soc,
  127. reo_desc,
  128. &reo_status, tlv, &num);
  129. if (status != QDF_STATUS_SUCCESS)
  130. goto next;
  131. qdf_spin_lock_bh(&soc->rx.reo_cmd_lock);
  132. TAILQ_FOREACH(reo_cmd, &soc->rx.reo_cmd_list,
  133. reo_cmd_list_elem) {
  134. if (reo_cmd->cmd == num) {
  135. TAILQ_REMOVE(&soc->rx.reo_cmd_list, reo_cmd,
  136. reo_cmd_list_elem);
  137. break;
  138. }
  139. }
  140. qdf_spin_unlock_bh(&soc->rx.reo_cmd_lock);
  141. if (reo_cmd) {
  142. reo_cmd->handler(soc, reo_cmd->data,
  143. &reo_status);
  144. qdf_mem_free(reo_cmd);
  145. }
  146. next:
  147. reo_desc = hal_srng_dst_get_next(soc,
  148. soc->reo_status_ring.hal_srng);
  149. } /* while */
  150. dp_srng_access_end(int_ctx, soc, soc->reo_status_ring.hal_srng);
  151. return processed_count;
  152. }
  153. void dp_reo_cmdlist_destroy(struct dp_soc *soc)
  154. {
  155. struct dp_reo_cmd_info *reo_cmd = NULL;
  156. struct dp_reo_cmd_info *tmp_cmd = NULL;
  157. union hal_reo_status reo_status;
  158. reo_status.queue_status.header.status =
  159. HAL_REO_CMD_DRAIN;
  160. qdf_spin_lock_bh(&soc->rx.reo_cmd_lock);
  161. TAILQ_FOREACH_SAFE(reo_cmd, &soc->rx.reo_cmd_list,
  162. reo_cmd_list_elem, tmp_cmd) {
  163. TAILQ_REMOVE(&soc->rx.reo_cmd_list, reo_cmd,
  164. reo_cmd_list_elem);
  165. reo_cmd->handler(soc, reo_cmd->data, &reo_status);
  166. qdf_mem_free(reo_cmd);
  167. }
  168. qdf_spin_unlock_bh(&soc->rx.reo_cmd_lock);
  169. }
  170. #ifdef DP_UMAC_HW_RESET_SUPPORT
  171. void dp_cleanup_reo_cmd_module(struct dp_soc *soc)
  172. {
  173. dp_reo_cmdlist_destroy(soc);
  174. dp_reo_desc_freelist_destroy(soc);
  175. }
  176. #endif