mempool/dpaa: prepare to remove register memory area op
[dpdk.git] / drivers / mempool / dpaa / dpaa_mempool.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  *
3  *   Copyright 2017 NXP
4  *
5  */
6
7 /* System headers */
8 #include <stdio.h>
9 #include <inttypes.h>
10 #include <unistd.h>
11 #include <limits.h>
12 #include <sched.h>
13 #include <signal.h>
14 #include <pthread.h>
15 #include <sys/types.h>
16 #include <sys/syscall.h>
17
18 #include <rte_byteorder.h>
19 #include <rte_common.h>
20 #include <rte_log.h>
21 #include <rte_debug.h>
22 #include <rte_memory.h>
23 #include <rte_tailq.h>
24 #include <rte_eal.h>
25 #include <rte_malloc.h>
26 #include <rte_ring.h>
27
28 #include <dpaa_mempool.h>
29
30 struct dpaa_bp_info rte_dpaa_bpid_info[DPAA_MAX_BPOOLS];
31
32 static int
33 dpaa_mbuf_create_pool(struct rte_mempool *mp)
34 {
35         struct bman_pool *bp;
36         struct bm_buffer bufs[8];
37         struct dpaa_bp_info *bp_info;
38         uint8_t bpid;
39         int num_bufs = 0, ret = 0;
40         struct bman_pool_params params = {
41                 .flags = BMAN_POOL_FLAG_DYNAMIC_BPID
42         };
43
44         MEMPOOL_INIT_FUNC_TRACE();
45
46         bp = bman_new_pool(&params);
47         if (!bp) {
48                 DPAA_MEMPOOL_ERR("bman_new_pool() failed");
49                 return -ENODEV;
50         }
51         bpid = bman_get_params(bp)->bpid;
52
53         /* Drain the pool of anything already in it. */
54         do {
55                 /* Acquire is all-or-nothing, so we drain in 8s,
56                  * then in 1s for the remainder.
57                  */
58                 if (ret != 1)
59                         ret = bman_acquire(bp, bufs, 8, 0);
60                 if (ret < 8)
61                         ret = bman_acquire(bp, bufs, 1, 0);
62                 if (ret > 0)
63                         num_bufs += ret;
64         } while (ret > 0);
65         if (num_bufs)
66                 DPAA_MEMPOOL_WARN("drained %u bufs from BPID %d",
67                                   num_bufs, bpid);
68
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;
78
79         bp_info = rte_malloc(NULL,
80                              sizeof(struct dpaa_bp_info),
81                              RTE_CACHE_LINE_SIZE);
82         if (!bp_info) {
83                 DPAA_MEMPOOL_WARN("Memory allocation failed for bp_info");
84                 bman_free_pool(bp);
85                 return -ENOMEM;
86         }
87
88         rte_memcpy(bp_info, (void *)&rte_dpaa_bpid_info[bpid],
89                    sizeof(struct dpaa_bp_info));
90         mp->pool_data = (void *)bp_info;
91
92         DPAA_MEMPOOL_INFO("BMAN pool created for bpid =%d", bpid);
93         return 0;
94 }
95
96 static void
97 dpaa_mbuf_free_pool(struct rte_mempool *mp)
98 {
99         struct dpaa_bp_info *bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
100
101         MEMPOOL_INIT_FUNC_TRACE();
102
103         if (bp_info) {
104                 bman_free_pool(bp_info->bp);
105                 DPAA_MEMPOOL_INFO("BMAN pool freed for bpid =%d",
106                                   bp_info->bpid);
107                 rte_free(mp->pool_data);
108                 mp->pool_data = NULL;
109         }
110 }
111
112 static void
113 dpaa_buf_free(struct dpaa_bp_info *bp_info, uint64_t addr)
114 {
115         struct bm_buffer buf;
116         int ret;
117
118         DPAA_MEMPOOL_DEBUG("Free 0x%" PRIx64 " to bpid: %d",
119                            addr, bp_info->bpid);
120
121         bm_buffer_set64(&buf, addr);
122 retry:
123         ret = bman_release(bp_info->bp, &buf, 1, 0);
124         if (ret) {
125                 DPAA_MEMPOOL_DEBUG("BMAN busy. Retrying...");
126                 cpu_spin(CPU_SPIN_BACKOFF_CYCLES);
127                 goto retry;
128         }
129 }
130
131 static int
132 dpaa_mbuf_free_bulk(struct rte_mempool *pool,
133                     void *const *obj_table,
134                     unsigned int n)
135 {
136         struct dpaa_bp_info *bp_info = DPAA_MEMPOOL_TO_POOL_INFO(pool);
137         int ret;
138         unsigned int i = 0;
139
140         DPAA_MEMPOOL_DPDEBUG("Request to free %d buffers in bpid = %d",
141                              n, bp_info->bpid);
142
143         if (unlikely(!RTE_PER_LCORE(dpaa_io))) {
144                 ret = rte_dpaa_portal_init((void *)0);
145                 if (ret) {
146                         DPAA_MEMPOOL_ERR("rte_dpaa_portal_init failed with ret: %d",
147                                          ret);
148                         return 0;
149                 }
150         }
151
152         while (i < n) {
153                 uint64_t phy = rte_mempool_virt2iova(obj_table[i]);
154
155                 if (unlikely(!bp_info->ptov_off)) {
156                         /* buffers are from single mem segment */
157                         if (bp_info->flags & DPAA_MPOOL_SINGLE_SEGMENT) {
158                                 bp_info->ptov_off = (size_t)obj_table[i] - phy;
159                                 rte_dpaa_bpid_info[bp_info->bpid].ptov_off
160                                                 = bp_info->ptov_off;
161                         }
162                 }
163
164                 dpaa_buf_free(bp_info,
165                               (uint64_t)phy + bp_info->meta_data_size);
166                 i = i + 1;
167         }
168
169         DPAA_MEMPOOL_DPDEBUG("freed %d buffers in bpid =%d",
170                              n, bp_info->bpid);
171
172         return 0;
173 }
174
175 static int
176 dpaa_mbuf_alloc_bulk(struct rte_mempool *pool,
177                      void **obj_table,
178                      unsigned int count)
179 {
180         struct rte_mbuf **m = (struct rte_mbuf **)obj_table;
181         struct bm_buffer bufs[DPAA_MBUF_MAX_ACQ_REL];
182         struct dpaa_bp_info *bp_info;
183         void *bufaddr;
184         int i, ret;
185         unsigned int n = 0;
186
187         bp_info = DPAA_MEMPOOL_TO_POOL_INFO(pool);
188
189         DPAA_MEMPOOL_DPDEBUG("Request to alloc %d buffers in bpid = %d",
190                              count, bp_info->bpid);
191
192         if (unlikely(count >= (RTE_MEMPOOL_CACHE_MAX_SIZE * 2))) {
193                 DPAA_MEMPOOL_ERR("Unable to allocate requested (%u) buffers",
194                                  count);
195                 return -1;
196         }
197
198         if (unlikely(!RTE_PER_LCORE(dpaa_io))) {
199                 ret = rte_dpaa_portal_init((void *)0);
200                 if (ret) {
201                         DPAA_MEMPOOL_ERR("rte_dpaa_portal_init failed with ret: %d",
202                                          ret);
203                         return -1;
204                 }
205         }
206
207         while (n < count) {
208                 /* Acquire is all-or-nothing, so we drain in 7s,
209                  * then the remainder.
210                  */
211                 if ((count - n) > DPAA_MBUF_MAX_ACQ_REL) {
212                         ret = bman_acquire(bp_info->bp, bufs,
213                                            DPAA_MBUF_MAX_ACQ_REL, 0);
214                 } else {
215                         ret = bman_acquire(bp_info->bp, bufs, count - n, 0);
216                 }
217                 /* In case of less than requested number of buffers available
218                  * in pool, qbman_swp_acquire returns 0
219                  */
220                 if (ret <= 0) {
221                         DPAA_MEMPOOL_DPDEBUG("Buffer acquire failed (%d)",
222                                              ret);
223                         /* The API expect the exact number of requested
224                          * buffers. Releasing all buffers allocated
225                          */
226                         dpaa_mbuf_free_bulk(pool, obj_table, n);
227                         return -ENOBUFS;
228                 }
229                 /* assigning mbuf from the acquired objects */
230                 for (i = 0; (i < ret) && bufs[i].addr; i++) {
231                         /* TODO-errata - objerved that bufs may be null
232                          * i.e. first buffer is valid, remaining 6 buffers
233                          * may be null.
234                          */
235                         bufaddr = DPAA_MEMPOOL_PTOV(bp_info, bufs[i].addr);
236                         m[n] = (struct rte_mbuf *)((char *)bufaddr
237                                                 - bp_info->meta_data_size);
238                         DPAA_MEMPOOL_DPDEBUG("Paddr (%p), FD (%p) from BMAN",
239                                              (void *)bufaddr, (void *)m[n]);
240                         n++;
241                 }
242         }
243
244         DPAA_MEMPOOL_DPDEBUG("Allocated %d buffers from bpid=%d",
245                              n, bp_info->bpid);
246         return 0;
247 }
248
249 static unsigned int
250 dpaa_mbuf_get_count(const struct rte_mempool *mp)
251 {
252         struct dpaa_bp_info *bp_info;
253
254         MEMPOOL_INIT_FUNC_TRACE();
255
256         if (!mp || !mp->pool_data) {
257                 DPAA_MEMPOOL_ERR("Invalid mempool provided\n");
258                 return 0;
259         }
260
261         bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
262
263         return bman_query_free_buffers(bp_info->bp);
264 }
265
266 static int
267 dpaa_populate(struct rte_mempool *mp, unsigned int max_objs,
268               void *vaddr, rte_iova_t paddr, size_t len,
269               rte_mempool_populate_obj_cb_t *obj_cb, void *obj_cb_arg)
270 {
271         struct dpaa_bp_info *bp_info;
272         unsigned int total_elt_sz;
273
274         MEMPOOL_INIT_FUNC_TRACE();
275
276         if (!mp || !mp->pool_data) {
277                 DPAA_MEMPOOL_ERR("Invalid mempool provided\n");
278                 return 0;
279         }
280
281         bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
282         total_elt_sz = mp->header_size + mp->elt_size + mp->trailer_size;
283
284         DPAA_MEMPOOL_DEBUG("Req size %" PRIx64 " vs Available %u\n",
285                            (uint64_t)len, total_elt_sz * mp->size);
286
287         /* Detect pool area has sufficient space for elements in this memzone */
288         if (len >= total_elt_sz * mp->size)
289                 bp_info->flags |= DPAA_MPOOL_SINGLE_SEGMENT;
290
291         return rte_mempool_op_populate_default(mp, max_objs, vaddr, paddr, len,
292                                                obj_cb, obj_cb_arg);
293
294 }
295
296 struct rte_mempool_ops dpaa_mpool_ops = {
297         .name = DPAA_MEMPOOL_OPS_NAME,
298         .alloc = dpaa_mbuf_create_pool,
299         .free = dpaa_mbuf_free_pool,
300         .enqueue = dpaa_mbuf_free_bulk,
301         .dequeue = dpaa_mbuf_alloc_bulk,
302         .get_count = dpaa_mbuf_get_count,
303         .populate = dpaa_populate,
304 };
305
306 MEMPOOL_REGISTER_OPS(dpaa_mpool_ops);