dp_rx_desc.c 5.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163
  1. /*
  2. * Copyright (c) 2016-2017 The Linux Foundation. All rights reserved.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for
  5. * any purpose with or without fee is hereby granted, provided that the
  6. * above copyright notice and this permission notice appear in all
  7. * copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  10. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  11. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  12. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  13. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  14. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  15. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  16. * PERFORMANCE OF THIS SOFTWARE.
  17. */
  18. #include "dp_types.h"
  19. #include "dp_rx.h"
  20. /*
  21. * dp_rx_desc_pool_alloc() - create a pool of software rx_descs
  22. * at the time of dp rx initialization
  23. *
  24. * @soc: core txrx main context
  25. * @pool_id: pool_id which is one of 3 mac_ids
  26. * @pool_size: number of Rx descriptor in the pool
  27. * @rx_desc_pool: rx descriptor pool pointer
  28. *
  29. * return success or failure
  30. */
  31. QDF_STATUS dp_rx_desc_pool_alloc(struct dp_soc *soc, uint32_t pool_id,
  32. uint32_t pool_size, struct rx_desc_pool *rx_desc_pool)
  33. {
  34. uint32_t i;
  35. rx_desc_pool->array =
  36. qdf_mem_malloc(pool_size*sizeof(union dp_rx_desc_list_elem_t));
  37. if (!(rx_desc_pool->array)) {
  38. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_FATAL,
  39. "%s: RX Desc Pool[%d] allocation failed\n",
  40. __func__, pool_id);
  41. return QDF_STATUS_E_NOMEM;
  42. }
  43. qdf_spin_lock_bh(&soc->rx_desc_mutex[pool_id]);
  44. rx_desc_pool->pool_size = pool_size;
  45. /* link SW rx descs into a freelist */
  46. rx_desc_pool->freelist = &rx_desc_pool->array[0];
  47. for (i = 0; i < rx_desc_pool->pool_size-1; i++) {
  48. rx_desc_pool->array[i].next = &rx_desc_pool->array[i+1];
  49. rx_desc_pool->array[i].rx_desc.cookie = i | (pool_id << 18);
  50. rx_desc_pool->array[i].rx_desc.pool_id = pool_id;
  51. rx_desc_pool->array[i].rx_desc.nbuf = NULL;
  52. }
  53. rx_desc_pool->array[i].next = NULL;
  54. rx_desc_pool->array[i].rx_desc.cookie = i | (pool_id << 18);
  55. rx_desc_pool->array[i].rx_desc.pool_id = pool_id;
  56. rx_desc_pool->array[i].rx_desc.nbuf = NULL;
  57. qdf_spin_unlock_bh(&soc->rx_desc_mutex[pool_id]);
  58. return QDF_STATUS_SUCCESS;
  59. }
  60. /*
  61. * dp_rx_desc_pool_free() - free the sw rx desc pool called during
  62. * de-initialization of wifi module.
  63. *
  64. * @soc: core txrx main context
  65. * @pool_id: pool_id which is one of 3 mac_ids
  66. * @rx_desc_pool: rx descriptor pool pointer
  67. */
  68. void dp_rx_desc_pool_free(struct dp_soc *soc, uint32_t pool_id,
  69. struct rx_desc_pool *rx_desc_pool)
  70. {
  71. int i;
  72. qdf_spin_lock_bh(&soc->rx_desc_mutex[pool_id]);
  73. for (i = 0; i < rx_desc_pool->pool_size; i++) {
  74. if (rx_desc_pool->array[i].rx_desc.nbuf)
  75. qdf_nbuf_free(rx_desc_pool->array[i].rx_desc.nbuf);
  76. }
  77. qdf_mem_free(rx_desc_pool->array);
  78. qdf_spin_unlock_bh(&soc->rx_desc_mutex[pool_id]);
  79. }
  80. /*
  81. * dp_rx_get_free_desc_list() - provide a list of descriptors from
  82. * the free rx desc pool.
  83. *
  84. * @soc: core txrx main context
  85. * @pool_id: pool_id which is one of 3 mac_ids
  86. * @rx_desc_pool: rx descriptor pool pointer
  87. * @num_descs: number of descs requested from freelist
  88. * @desc_list: attach the descs to this list (output parameter)
  89. * @tail: attach the point to last desc of free list (output parameter)
  90. *
  91. * Return: number of descs allocated from free list.
  92. */
  93. uint16_t dp_rx_get_free_desc_list(struct dp_soc *soc, uint32_t pool_id,
  94. struct rx_desc_pool *rx_desc_pool,
  95. uint16_t num_descs,
  96. union dp_rx_desc_list_elem_t **desc_list,
  97. union dp_rx_desc_list_elem_t **tail)
  98. {
  99. uint16_t count;
  100. qdf_spin_lock_bh(&soc->rx_desc_mutex[pool_id]);
  101. *desc_list = rx_desc_pool->freelist;
  102. if (!(*desc_list)) {
  103. qdf_spin_unlock_bh(&soc->rx_desc_mutex[pool_id]);
  104. return 0;
  105. }
  106. for (count = 0; count < num_descs; count++) {
  107. *tail = rx_desc_pool->freelist;
  108. rx_desc_pool->freelist = rx_desc_pool->freelist->next;
  109. if (qdf_unlikely(!rx_desc_pool->freelist)) {
  110. qdf_spin_unlock_bh(&soc->rx_desc_mutex[pool_id]);
  111. return count;
  112. }
  113. }
  114. qdf_spin_unlock_bh(&soc->rx_desc_mutex[pool_id]);
  115. return count;
  116. }
  117. /*
  118. * dp_rx_add_desc_list_to_free_list() - append unused desc_list back to
  119. * freelist.
  120. *
  121. * @soc: core txrx main context
  122. * @local_desc_list: local desc list provided by the caller
  123. * @tail: attach the point to last desc of local desc list
  124. * @pool_id: pool_id which is one of 3 mac_ids
  125. * @rx_desc_pool: rx descriptor pool pointer
  126. */
  127. void dp_rx_add_desc_list_to_free_list(struct dp_soc *soc,
  128. union dp_rx_desc_list_elem_t **local_desc_list,
  129. union dp_rx_desc_list_elem_t **tail,
  130. uint16_t pool_id,
  131. struct rx_desc_pool *rx_desc_pool)
  132. {
  133. union dp_rx_desc_list_elem_t *temp_list = NULL;
  134. qdf_spin_lock_bh(&soc->rx_desc_mutex[pool_id]);
  135. temp_list = rx_desc_pool->freelist;
  136. qdf_print(
  137. "temp_list: %p, *local_desc_list: %p, *tail: %p (*tail)->next: %p\n",
  138. temp_list, *local_desc_list, *tail, (*tail)->next);
  139. rx_desc_pool->freelist = *local_desc_list;
  140. (*tail)->next = temp_list;
  141. qdf_spin_unlock_bh(&soc->rx_desc_mutex[pool_id]);
  142. }