1 /* SPDX-License-Identifier: BSD-3-Clause
15 #include <sys/types.h>
16 #include <sys/syscall.h>
18 #include <rte_byteorder.h>
19 #include <rte_common.h>
21 #include <rte_debug.h>
22 #include <rte_memory.h>
23 #include <rte_tailq.h>
25 #include <rte_malloc.h>
28 #include <dpaa_mempool.h>
30 struct dpaa_bp_info rte_dpaa_bpid_info[DPAA_MAX_BPOOLS];
33 dpaa_mbuf_create_pool(struct rte_mempool *mp)
36 struct bm_buffer bufs[8];
37 struct dpaa_bp_info *bp_info;
39 int num_bufs = 0, ret = 0;
40 struct bman_pool_params params = {
41 .flags = BMAN_POOL_FLAG_DYNAMIC_BPID
44 MEMPOOL_INIT_FUNC_TRACE();
46 bp = bman_new_pool(¶ms);
48 DPAA_MEMPOOL_ERR("bman_new_pool() failed");
51 bpid = bman_get_params(bp)->bpid;
53 /* Drain the pool of anything already in it. */
55 /* Acquire is all-or-nothing, so we drain in 8s,
56 * then in 1s for the remainder.
59 ret = bman_acquire(bp, bufs, 8, 0);
61 ret = bman_acquire(bp, bufs, 1, 0);
66 DPAA_MEMPOOL_WARN("drained %u bufs from BPID %d",
69 rte_dpaa_bpid_info[bpid].mp = mp;
70 rte_dpaa_bpid_info[bpid].bpid = bpid;
71 rte_dpaa_bpid_info[bpid].size = mp->elt_size;
72 rte_dpaa_bpid_info[bpid].bp = bp;
73 rte_dpaa_bpid_info[bpid].meta_data_size =
74 sizeof(struct rte_mbuf) + rte_pktmbuf_priv_size(mp);
75 rte_dpaa_bpid_info[bpid].dpaa_ops_index = mp->ops_index;
76 rte_dpaa_bpid_info[bpid].ptov_off = 0;
77 rte_dpaa_bpid_info[bpid].flags = 0;
79 bp_info = rte_malloc(NULL,
80 sizeof(struct dpaa_bp_info),
83 DPAA_MEMPOOL_WARN("Memory allocation failed for bp_info");
88 rte_memcpy(bp_info, (void *)&rte_dpaa_bpid_info[bpid],
89 sizeof(struct dpaa_bp_info));
90 mp->pool_data = (void *)bp_info;
92 DPAA_MEMPOOL_INFO("BMAN pool created for bpid =%d", bpid);
97 dpaa_mbuf_free_pool(struct rte_mempool *mp)
99 struct dpaa_bp_info *bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
101 MEMPOOL_INIT_FUNC_TRACE();
104 bman_free_pool(bp_info->bp);
105 DPAA_MEMPOOL_INFO("BMAN pool freed for bpid =%d",
107 rte_free(mp->pool_data);
108 mp->pool_data = NULL;
113 dpaa_buf_free(struct dpaa_bp_info *bp_info, uint64_t addr)
115 struct bm_buffer buf;
118 DPAA_MEMPOOL_DEBUG("Free 0x%lx to bpid: %d", addr, bp_info->bpid);
120 bm_buffer_set64(&buf, addr);
122 ret = bman_release(bp_info->bp, &buf, 1, 0);
124 DPAA_MEMPOOL_DEBUG("BMAN busy. Retrying...");
125 cpu_spin(CPU_SPIN_BACKOFF_CYCLES);
131 dpaa_mbuf_free_bulk(struct rte_mempool *pool,
132 void *const *obj_table,
135 struct dpaa_bp_info *bp_info = DPAA_MEMPOOL_TO_POOL_INFO(pool);
139 DPAA_MEMPOOL_DPDEBUG("Request to free %d buffers in bpid = %d",
142 ret = rte_dpaa_portal_init((void *)0);
144 DPAA_MEMPOOL_ERR("rte_dpaa_portal_init failed with ret: %d",
150 uint64_t phy = rte_mempool_virt2iova(obj_table[i]);
152 if (unlikely(!bp_info->ptov_off)) {
153 /* buffers are not from multiple memzones */
154 if (!(bp_info->flags & DPAA_MPOOL_MULTI_MEMZONE)) {
156 = (uint64_t)obj_table[i] - phy;
157 rte_dpaa_bpid_info[bp_info->bpid].ptov_off
162 dpaa_buf_free(bp_info,
163 (uint64_t)phy + bp_info->meta_data_size);
167 DPAA_MEMPOOL_DPDEBUG("freed %d buffers in bpid =%d",
174 dpaa_mbuf_alloc_bulk(struct rte_mempool *pool,
178 struct rte_mbuf **m = (struct rte_mbuf **)obj_table;
179 struct bm_buffer bufs[DPAA_MBUF_MAX_ACQ_REL];
180 struct dpaa_bp_info *bp_info;
185 bp_info = DPAA_MEMPOOL_TO_POOL_INFO(pool);
187 DPAA_MEMPOOL_DPDEBUG("Request to alloc %d buffers in bpid = %d",
188 count, bp_info->bpid);
190 if (unlikely(count >= (RTE_MEMPOOL_CACHE_MAX_SIZE * 2))) {
191 DPAA_MEMPOOL_ERR("Unable to allocate requested (%u) buffers",
196 ret = rte_dpaa_portal_init((void *)0);
198 DPAA_MEMPOOL_ERR("rte_dpaa_portal_init failed with ret: %d",
204 /* Acquire is all-or-nothing, so we drain in 7s,
205 * then the remainder.
207 if ((count - n) > DPAA_MBUF_MAX_ACQ_REL) {
208 ret = bman_acquire(bp_info->bp, bufs,
209 DPAA_MBUF_MAX_ACQ_REL, 0);
211 ret = bman_acquire(bp_info->bp, bufs, count - n, 0);
213 /* In case of less than requested number of buffers available
214 * in pool, qbman_swp_acquire returns 0
217 DPAA_MEMPOOL_DPDEBUG("Buffer acquire failed (%d)",
219 /* The API expect the exact number of requested
220 * buffers. Releasing all buffers allocated
222 dpaa_mbuf_free_bulk(pool, obj_table, n);
225 /* assigning mbuf from the acquired objects */
226 for (i = 0; (i < ret) && bufs[i].addr; i++) {
227 /* TODO-errata - objerved that bufs may be null
228 * i.e. first buffer is valid, remaining 6 buffers
231 bufaddr = DPAA_MEMPOOL_PTOV(bp_info, bufs[i].addr);
232 m[n] = (struct rte_mbuf *)((char *)bufaddr
233 - bp_info->meta_data_size);
234 DPAA_MEMPOOL_DPDEBUG("Paddr (%p), FD (%p) from BMAN",
235 (void *)bufaddr, (void *)m[n]);
240 DPAA_MEMPOOL_DPDEBUG("Allocated %d buffers from bpid=%d",
246 dpaa_mbuf_get_count(const struct rte_mempool *mp)
248 struct dpaa_bp_info *bp_info;
250 MEMPOOL_INIT_FUNC_TRACE();
252 if (!mp || !mp->pool_data) {
253 DPAA_MEMPOOL_ERR("Invalid mempool provided\n");
257 bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
259 return bman_query_free_buffers(bp_info->bp);
263 dpaa_register_memory_area(const struct rte_mempool *mp,
264 char *vaddr __rte_unused,
265 rte_iova_t paddr __rte_unused,
268 struct dpaa_bp_info *bp_info;
269 unsigned int total_elt_sz;
271 MEMPOOL_INIT_FUNC_TRACE();
273 if (!mp || !mp->pool_data) {
274 DPAA_MEMPOOL_ERR("Invalid mempool provided\n");
278 bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
279 total_elt_sz = mp->header_size + mp->elt_size + mp->trailer_size;
281 DPAA_MEMPOOL_DEBUG("Req size %lu vs Available %u\n",
282 len, total_elt_sz * mp->size);
284 /* Detect pool area has sufficient space for elements in this memzone */
285 if (len < total_elt_sz * mp->size)
286 /* Else, Memory will be allocated from multiple memzones */
287 bp_info->flags |= DPAA_MPOOL_MULTI_MEMZONE;
292 struct rte_mempool_ops dpaa_mpool_ops = {
293 .name = DPAA_MEMPOOL_OPS_NAME,
294 .alloc = dpaa_mbuf_create_pool,
295 .free = dpaa_mbuf_free_pool,
296 .enqueue = dpaa_mbuf_free_bulk,
297 .dequeue = dpaa_mbuf_alloc_bulk,
298 .get_count = dpaa_mbuf_get_count,
299 .register_memory_area = dpaa_register_memory_area,
302 MEMPOOL_REGISTER_OPS(dpaa_mpool_ops);