blob: 698a422127d62c737f7df0ad7d4a548340cc9c31 [file] [log] [blame]
Florin Coras88001c62019-04-24 14:44:46 -07001/*
2 * Copyright (c) 2016-2019 Cisco and/or its affiliates.
3 * Licensed under the Apache License, Version 2.0 (the "License");
4 * you may not use this file except in compliance with the License.
5 * You may obtain a copy of the License at:
6 *
7 * http://www.apache.org/licenses/LICENSE-2.0
8 *
9 * Unless required by applicable law or agreed to in writing, software
10 * distributed under the License is distributed on an "AS IS" BASIS,
11 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 * See the License for the specific language governing permissions and
13 * limitations under the License.
14 */
15
16#include <svm/fifo_segment.h>
17
18/**
Florin Corasf9d4ab42019-05-11 16:55:53 -070019 * Fifo segment free space
20 *
21 * Queries the underlying memory manager, dlmalloc, for free space. Since this
22 * ends up walking the internal data structures, it should not be called
23 * indiscriminately.
24 *
25 * @param fs fifo segment
26 * @return number of free bytes
27 */
28static u32
29fs_free_space (fifo_segment_t * fs)
30{
31 struct dlmallinfo dlminfo;
32
33 dlminfo = mspace_mallinfo (fs->ssvm.sh->heap);
34 return dlminfo.fordblks;
35}
36
37/**
Florin Coras88001c62019-04-24 14:44:46 -070038 * Initialize fifo segment shared header
39 */
40int
41fifo_segment_init (fifo_segment_t * fs)
42{
43 fifo_segment_header_t *fsh;
44 ssvm_shared_header_t *sh;
45 void *oldheap;
46
47 sh = fs->ssvm.sh;
48 oldheap = ssvm_push_heap (sh);
49
50 fsh = clib_mem_alloc (sizeof (*fsh));
51 clib_memset (fsh, 0, sizeof (*fsh));
52 fs->h = sh->opaque[0] = fsh;
53
54 ssvm_pop_heap (oldheap);
55
Florin Corasf9d4ab42019-05-11 16:55:53 -070056 fsh->n_free_bytes = fs_free_space (fs);
Florin Coras88001c62019-04-24 14:44:46 -070057 sh->ready = 1;
58 return (0);
59}
60
61/**
Florin Coras88001c62019-04-24 14:44:46 -070062 * Create a fifo segment and initialize as master
63 */
64int
65fifo_segment_create (fifo_segment_main_t * sm, fifo_segment_create_args_t * a)
66{
Florin Corasf9d4ab42019-05-11 16:55:53 -070067 fifo_segment_t *fs;
68 uword baseva;
Florin Coras88001c62019-04-24 14:44:46 -070069 int rv;
70
Florin Coras88001c62019-04-24 14:44:46 -070071 /* Allocate a fresh segment */
Florin Corasf9d4ab42019-05-11 16:55:53 -070072 pool_get_zero (sm->segments, fs);
Florin Coras88001c62019-04-24 14:44:46 -070073
Florin Corasf9d4ab42019-05-11 16:55:53 -070074 baseva = a->segment_type == SSVM_SEGMENT_PRIVATE ? ~0ULL : sm->next_baseva;
75 fs->ssvm.ssvm_size = a->segment_size;
76 fs->ssvm.i_am_master = 1;
77 fs->ssvm.my_pid = getpid ();
78 fs->ssvm.name = format (0, "%s%c", a->segment_name, 0);
79 fs->ssvm.requested_va = baseva;
Florin Coras88001c62019-04-24 14:44:46 -070080
Florin Corasf9d4ab42019-05-11 16:55:53 -070081 if ((rv = ssvm_master_init (&fs->ssvm, a->segment_type)))
Florin Coras88001c62019-04-24 14:44:46 -070082 {
Florin Corasf9d4ab42019-05-11 16:55:53 -070083 pool_put (sm->segments, fs);
Florin Coras88001c62019-04-24 14:44:46 -070084 return (rv);
85 }
86
87 /* Note: requested_va updated due to seg base addr randomization */
Florin Corasf9d4ab42019-05-11 16:55:53 -070088 sm->next_baseva = fs->ssvm.sh->ssvm_va + fs->ssvm.ssvm_size;
Florin Coras88001c62019-04-24 14:44:46 -070089
Florin Corasf9d4ab42019-05-11 16:55:53 -070090 fifo_segment_init (fs);
91 vec_add1 (a->new_segment_indices, fs - sm->segments);
Florin Coras88001c62019-04-24 14:44:46 -070092 return (0);
93}
94
95/**
96 * Attach as slave to a fifo segment
97 */
98int
99fifo_segment_attach (fifo_segment_main_t * sm, fifo_segment_create_args_t * a)
100{
101 fifo_segment_t *s;
102 int rv;
103
104 pool_get_zero (sm->segments, s);
105
106 s->ssvm.ssvm_size = a->segment_size;
107 s->ssvm.my_pid = getpid ();
108 s->ssvm.name = format (0, "%s%c", a->segment_name, 0);
109 s->ssvm.requested_va = sm->next_baseva;
110 if (a->segment_type == SSVM_SEGMENT_MEMFD)
111 s->ssvm.fd = a->memfd_fd;
112 else
113 s->ssvm.attach_timeout = sm->timeout_in_seconds;
114
115 if ((rv = ssvm_slave_init (&s->ssvm, a->segment_type)))
116 {
117 _vec_len (s) = vec_len (s) - 1;
118 return (rv);
119 }
120
121 /* Fish the segment header */
122 s->h = s->ssvm.sh->opaque[0];
123
124 vec_add1 (a->new_segment_indices, s - sm->segments);
125 return (0);
126}
127
128void
129fifo_segment_delete (fifo_segment_main_t * sm, fifo_segment_t * s)
130{
131 ssvm_delete (&s->ssvm);
132 clib_memset (s, 0xfe, sizeof (*s));
133 pool_put (sm->segments, s);
134}
135
136u32
137fifo_segment_index (fifo_segment_main_t * sm, fifo_segment_t * s)
138{
139 return s - sm->segments;
140}
141
142void *
143svm_fifo_segment_heap (fifo_segment_t * seg)
144{
145 return seg->ssvm.sh->heap;
146}
147
148fifo_segment_t *
149fifo_segment_get_segment (fifo_segment_main_t * sm, u32 segment_index)
150{
151 return pool_elt_at_index (sm->segments, segment_index);
152}
153
154void
155fifo_segment_info (fifo_segment_t * seg, char **address, size_t * size)
156{
Florin Coras404b8a32019-05-09 12:08:06 -0700157 *address = (char *) seg->ssvm.sh->ssvm_va;
158 *size = seg->ssvm.ssvm_size;
Florin Coras88001c62019-04-24 14:44:46 -0700159}
160
161void
162fifo_segment_main_init (fifo_segment_main_t * sm, u64 baseva,
163 u32 timeout_in_seconds)
164{
165 sm->next_baseva = baseva;
166 sm->timeout_in_seconds = timeout_in_seconds;
167}
168
Florin Corasf9d4ab42019-05-11 16:55:53 -0700169static inline u32
170fs_freelist_for_size (u32 size)
Florin Coras88001c62019-04-24 14:44:46 -0700171{
172 return max_log2 (size) - max_log2 (FIFO_SEGMENT_MIN_FIFO_SIZE);
173}
174
Florin Corasf9d4ab42019-05-11 16:55:53 -0700175static inline u32
176fs_freelist_index_to_size (u32 fl_index)
177{
178 return 1 << (fl_index + max_log2 (FIFO_SEGMENT_MIN_FIFO_SIZE));
179}
180
Florin Coras88001c62019-04-24 14:44:46 -0700181static inline int
Florin Corasb095a3c2019-04-25 12:58:46 -0700182fs_chunk_size_is_valid (u32 size)
Florin Coras88001c62019-04-24 14:44:46 -0700183{
184 /*
185 * 4K minimum. It's not likely that anything good will happen
186 * with a smaller FIFO.
187 */
188 return size >= FIFO_SEGMENT_MIN_FIFO_SIZE
189 && size <= FIFO_SEGMENT_MAX_FIFO_SIZE;
190}
191
Florin Corascefd5d82019-05-05 13:19:57 -0700192static svm_fifo_t *
Florin Corasf9d4ab42019-05-11 16:55:53 -0700193fs_try_alloc_fifo_freelist (fifo_segment_t * fs, u32 fl_index, u32 data_bytes)
Florin Corascefd5d82019-05-05 13:19:57 -0700194{
Florin Corasf9d4ab42019-05-11 16:55:53 -0700195 fifo_segment_header_t *fsh = fs->h;
Florin Corascefd5d82019-05-05 13:19:57 -0700196 svm_fifo_chunk_t *c;
197 svm_fifo_t *f;
Florin Corascefd5d82019-05-05 13:19:57 -0700198
199 f = fsh->free_fifos;
Florin Corascefd5d82019-05-05 13:19:57 -0700200 c = fsh->free_chunks[fl_index];
201
202 if (!f || !c)
203 return 0;
204
205 fsh->free_fifos = f->next;
206 fsh->free_chunks[fl_index] = c->next;
207 c->next = c;
208 c->start_byte = 0;
209 c->length = data_bytes;
210 memset (f, 0, sizeof (*f));
211 f->start_chunk = c;
212 f->end_chunk = c;
Florin Corasf9d4ab42019-05-11 16:55:53 -0700213
214 fsh->n_fl_chunk_bytes -= fs_freelist_index_to_size (fl_index);
Florin Corascefd5d82019-05-05 13:19:57 -0700215 return f;
216}
217
218static svm_fifo_t *
Florin Corasf9d4ab42019-05-11 16:55:53 -0700219fs_try_alloc_fifo_freelist_multi_chunk (fifo_segment_t * fs, u32 data_bytes)
Florin Coras88001c62019-04-24 14:44:46 -0700220{
Florin Corasf9d4ab42019-05-11 16:55:53 -0700221 svm_fifo_chunk_t *c, *first = 0, *last = 0;
222 fifo_segment_header_t *fsh = fs->h;
223 u32 fl_index, fl_size, n_alloc = 0;
224 svm_fifo_t *f;
225
226 f = fsh->free_fifos;
227 if (!f)
228 {
229 void *oldheap = ssvm_push_heap (fs->ssvm.sh);
230 f = clib_mem_alloc_aligned (sizeof (*f), CLIB_CACHE_LINE_BYTES);
231 ssvm_pop_heap (oldheap);
232 if (!f)
233 return 0;
234 memset (f, 0, sizeof (*f));
Florin Corasc9dff182019-11-06 16:24:29 -0800235 fsh->n_free_bytes -= sizeof (*f);
Florin Corasf9d4ab42019-05-11 16:55:53 -0700236 }
Florin Coras73cad332019-08-28 17:12:32 -0700237 else
238 {
239 fsh->free_fifos = f->next;
240 }
Florin Corasf9d4ab42019-05-11 16:55:53 -0700241
242 fl_index = fs_freelist_for_size (data_bytes) - 1;
243 vec_validate_init_empty (fsh->free_chunks, fl_index, 0);
244 fl_size = fs_freelist_index_to_size (fl_index);
245
246 while (data_bytes)
247 {
248 c = fsh->free_chunks[fl_index];
249 if (c)
250 {
251 fsh->free_chunks[fl_index] = c->next;
252 if (!last)
253 last = c;
254 c->next = first;
255 first = c;
Florin Coras1c91c772019-06-25 18:14:13 -0700256 n_alloc += fl_size;
Florin Corasf9d4ab42019-05-11 16:55:53 -0700257 c->length = clib_min (fl_size, data_bytes);
258 data_bytes -= c->length;
259 }
260 else
261 {
262 ASSERT (fl_index > 0);
263 fl_index -= 1;
264 fl_size = fl_size >> 1;
265 }
266 }
267 f->start_chunk = first;
268 f->end_chunk = last;
269 last->next = first;
270 fsh->n_fl_chunk_bytes -= n_alloc;
271 return f;
272}
273
274static int
275fs_try_alloc_fifo_batch (fifo_segment_t * fs, u32 fl_index, u32 batch_size)
276{
277 fifo_segment_header_t *fsh = fs->h;
278 u32 size, hdrs, rounded_data_size;
Florin Corascefd5d82019-05-05 13:19:57 -0700279 svm_fifo_chunk_t *c;
Florin Coras88001c62019-04-24 14:44:46 -0700280 svm_fifo_t *f;
Florin Corascefd5d82019-05-05 13:19:57 -0700281 void *oldheap;
282 u8 *fmem;
283 int i;
Florin Coras88001c62019-04-24 14:44:46 -0700284
Florin Corascefd5d82019-05-05 13:19:57 -0700285 vec_validate_init_empty (fsh->free_chunks, fl_index, 0);
Florin Corasf9d4ab42019-05-11 16:55:53 -0700286 rounded_data_size = fs_freelist_index_to_size (fl_index);
Florin Corascefd5d82019-05-05 13:19:57 -0700287 hdrs = sizeof (*f) + sizeof (*c);
Florin Corasf9d4ab42019-05-11 16:55:53 -0700288 size = (hdrs + rounded_data_size) * batch_size;
289
290 oldheap = ssvm_push_heap (fs->ssvm.sh);
Florin Corascefd5d82019-05-05 13:19:57 -0700291 fmem = clib_mem_alloc_aligned_at_offset (size, CLIB_CACHE_LINE_BYTES,
292 0 /* align_offset */ ,
293 0 /* os_out_of_memory */ );
294 ssvm_pop_heap (oldheap);
Florin Coras88001c62019-04-24 14:44:46 -0700295
296 /* Out of space.. */
Florin Corascefd5d82019-05-05 13:19:57 -0700297 if (fmem == 0)
Florin Corasf9d4ab42019-05-11 16:55:53 -0700298 return -1;
Florin Coras88001c62019-04-24 14:44:46 -0700299
Florin Corascefd5d82019-05-05 13:19:57 -0700300 /* Carve fifo + chunk space */
Florin Corasf9d4ab42019-05-11 16:55:53 -0700301 for (i = 0; i < batch_size; i++)
Florin Coras88001c62019-04-24 14:44:46 -0700302 {
Florin Corascefd5d82019-05-05 13:19:57 -0700303 f = (svm_fifo_t *) fmem;
304 memset (f, 0, sizeof (*f));
305 f->next = fsh->free_fifos;
306 fsh->free_fifos = f;
307 c = (svm_fifo_chunk_t *) (fmem + sizeof (*f));
308 c->start_byte = 0;
309 c->length = rounded_data_size;
310 c->next = fsh->free_chunks[fl_index];
311 fsh->free_chunks[fl_index] = c;
312 fmem += hdrs + rounded_data_size;
Florin Coras88001c62019-04-24 14:44:46 -0700313 }
Florin Corascefd5d82019-05-05 13:19:57 -0700314
Florin Corasf9d4ab42019-05-11 16:55:53 -0700315 fsh->n_fl_chunk_bytes += batch_size * rounded_data_size;
316 fsh->n_free_bytes -= size;
317
318 return 0;
319}
320
321/**
322 * Try to allocate new fifo
323 *
324 * Tries the following steps in order:
325 * - grab fifo and chunk from freelists
326 * - batch fifo and chunk allocation
327 * - single fifo allocation
328 * - grab multiple fifo chunks from freelists
329 */
330static svm_fifo_t *
331fs_try_alloc_fifo (fifo_segment_t * fs, u32 data_bytes)
332{
333 fifo_segment_header_t *fsh = fs->h;
334 u32 fifo_sz, fl_index;
335 svm_fifo_t *f = 0;
336
337 fl_index = fs_freelist_for_size (data_bytes);
338 vec_validate_init_empty (fsh->free_chunks, fl_index, 0);
339 fifo_sz = sizeof (svm_fifo_t) + sizeof (svm_fifo_chunk_t);
340 fifo_sz += 1 << max_log2 (data_bytes);
341
342 if (fsh->free_fifos && fsh->free_chunks[fl_index])
343 {
344 f = fs_try_alloc_fifo_freelist (fs, fl_index, data_bytes);
345 if (f)
346 goto done;
347 }
348 if (fifo_sz * FIFO_SEGMENT_ALLOC_BATCH_SIZE < fsh->n_free_bytes)
349 {
350 if (fs_try_alloc_fifo_batch (fs, fl_index,
351 FIFO_SEGMENT_ALLOC_BATCH_SIZE))
352 goto done;
353
354 f = fs_try_alloc_fifo_freelist (fs, fl_index, data_bytes);
355 goto done;
356 }
357 if (fifo_sz <= fsh->n_free_bytes)
358 {
359 void *oldheap = ssvm_push_heap (fs->ssvm.sh);
360 f = svm_fifo_create (data_bytes);
361 ssvm_pop_heap (oldheap);
362 if (f)
363 {
364 fsh->n_free_bytes -= fifo_sz;
365 goto done;
366 }
367 }
368 if (data_bytes <= fsh->n_fl_chunk_bytes)
369 f = fs_try_alloc_fifo_freelist_multi_chunk (fs, data_bytes);
370
371done:
372
373 return f;
Florin Coras88001c62019-04-24 14:44:46 -0700374}
375
376/**
377 * Allocate fifo in fifo segment
378 */
379svm_fifo_t *
380fifo_segment_alloc_fifo (fifo_segment_t * fs, u32 data_bytes,
381 fifo_segment_ftype_t ftype)
382{
383 fifo_segment_header_t *fsh;
Florin Coras88001c62019-04-24 14:44:46 -0700384 svm_fifo_t *f = 0;
Florin Coras88001c62019-04-24 14:44:46 -0700385
Florin Corasb095a3c2019-04-25 12:58:46 -0700386 if (!fs_chunk_size_is_valid (data_bytes))
Florin Coras88001c62019-04-24 14:44:46 -0700387 {
388 clib_warning ("fifo size out of range %d", data_bytes);
389 return 0;
390 }
391
Florin Corasb095a3c2019-04-25 12:58:46 -0700392 fsh = fs->h;
Florin Corasf9d4ab42019-05-11 16:55:53 -0700393 ssvm_lock_non_recursive (fs->ssvm.sh, 1);
Florin Coras88001c62019-04-24 14:44:46 -0700394
Florin Corasf9d4ab42019-05-11 16:55:53 -0700395 f = fs_try_alloc_fifo (fs, data_bytes);
Florin Corascefd5d82019-05-05 13:19:57 -0700396 if (!f)
Florin Corasf9d4ab42019-05-11 16:55:53 -0700397 goto done;
Florin Coras88001c62019-04-24 14:44:46 -0700398
Florin Corascefd5d82019-05-05 13:19:57 -0700399 /* (re)initialize the fifo, as in svm_fifo_create */
400 svm_fifo_init (f, data_bytes);
Florin Coras88001c62019-04-24 14:44:46 -0700401
Florin Coraseaacce42019-07-02 13:07:37 -0700402 /* Initialize chunks and rbtree for multi-chunk fifos */
403 if (f->start_chunk->next != f->start_chunk)
404 {
405 void *oldheap = ssvm_push_heap (fs->ssvm.sh);
406 svm_fifo_init_chunks (f);
407 ssvm_pop_heap (oldheap);
408 }
409
Florin Coras88001c62019-04-24 14:44:46 -0700410 /* If rx fifo type add to active fifos list. When cleaning up segment,
411 * we need a list of active sessions that should be disconnected. Since
412 * both rx and tx fifos keep pointers to the session, it's enough to track
413 * only one. */
414 if (ftype == FIFO_SEGMENT_RX_FIFO)
415 {
416 if (fsh->fifos)
417 {
418 fsh->fifos->prev = f;
419 f->next = fsh->fifos;
420 }
421 fsh->fifos = f;
422 f->flags |= SVM_FIFO_F_LL_TRACKED;
423 }
424 fsh->n_active_fifos++;
425
426done:
Florin Corasf9d4ab42019-05-11 16:55:53 -0700427 ssvm_unlock_non_recursive (fs->ssvm.sh);
Florin Coras88001c62019-04-24 14:44:46 -0700428 return (f);
429}
430
431/**
432 * Free fifo allocated in fifo segment
433 */
434void
Florin Corasb095a3c2019-04-25 12:58:46 -0700435fifo_segment_free_fifo (fifo_segment_t * fs, svm_fifo_t * f)
Florin Coras88001c62019-04-24 14:44:46 -0700436{
Florin Corascefd5d82019-05-05 13:19:57 -0700437 svm_fifo_chunk_t *cur, *next;
Florin Coras88001c62019-04-24 14:44:46 -0700438 fifo_segment_header_t *fsh;
439 ssvm_shared_header_t *sh;
Florin Corascefd5d82019-05-05 13:19:57 -0700440 void *oldheap;
Florin Coras88001c62019-04-24 14:44:46 -0700441 int fl_index;
442
443 ASSERT (f->refcnt > 0);
444
445 if (--f->refcnt > 0)
446 return;
447
Florin Corasb095a3c2019-04-25 12:58:46 -0700448 sh = fs->ssvm.sh;
449 fsh = fs->h;
Florin Coras88001c62019-04-24 14:44:46 -0700450
451 ssvm_lock_non_recursive (sh, 2);
452
453 /* Remove from active list. Only rx fifos are tracked */
454 if (f->flags & SVM_FIFO_F_LL_TRACKED)
455 {
456 if (f->prev)
457 f->prev->next = f->next;
458 else
459 fsh->fifos = f->next;
460 if (f->next)
461 f->next->prev = f->prev;
462 f->flags &= ~SVM_FIFO_F_LL_TRACKED;
463 }
464
465 /* Add to free list */
Florin Corascefd5d82019-05-05 13:19:57 -0700466 f->next = fsh->free_fifos;
Florin Coras88001c62019-04-24 14:44:46 -0700467 f->prev = 0;
Florin Corascefd5d82019-05-05 13:19:57 -0700468 fsh->free_fifos = f;
Florin Coras88001c62019-04-24 14:44:46 -0700469
Florin Corascefd5d82019-05-05 13:19:57 -0700470 /* Free fifo chunks */
471 cur = f->start_chunk;
472 do
Florin Corasb095a3c2019-04-25 12:58:46 -0700473 {
Florin Corascefd5d82019-05-05 13:19:57 -0700474 next = cur->next;
Florin Corasf9d4ab42019-05-11 16:55:53 -0700475 fl_index = fs_freelist_for_size (cur->length);
Florin Corascefd5d82019-05-05 13:19:57 -0700476 ASSERT (fl_index < vec_len (fsh->free_chunks));
477 cur->next = fsh->free_chunks[fl_index];
478 fsh->free_chunks[fl_index] = cur;
Florin Corasf9d4ab42019-05-11 16:55:53 -0700479 fsh->n_fl_chunk_bytes += fs_freelist_index_to_size (fl_index);
Florin Corascefd5d82019-05-05 13:19:57 -0700480 cur = next;
Florin Corasb095a3c2019-04-25 12:58:46 -0700481 }
Florin Corascefd5d82019-05-05 13:19:57 -0700482 while (cur != f->start_chunk);
483
Florin Coras1c91c772019-06-25 18:14:13 -0700484 f->start_chunk = f->end_chunk = f->new_chunks = 0;
485 f->head_chunk = f->tail_chunk = f->ooo_enq = f->ooo_deq = 0;
486
Florin Corascefd5d82019-05-05 13:19:57 -0700487 oldheap = ssvm_push_heap (sh);
488 svm_fifo_free_chunk_lookup (f);
489 ssvm_pop_heap (oldheap);
Florin Corasb095a3c2019-04-25 12:58:46 -0700490
491 /* not allocated on segment heap */
492 svm_fifo_free_ooo_data (f);
493
Florin Coras88001c62019-04-24 14:44:46 -0700494 if (CLIB_DEBUG)
495 {
496 f->master_session_index = ~0;
497 f->master_thread_index = ~0;
498 }
499
500 fsh->n_active_fifos--;
501 ssvm_unlock_non_recursive (sh);
502}
503
Florin Corasf9d4ab42019-05-11 16:55:53 -0700504int
505fifo_segment_prealloc_fifo_hdrs (fifo_segment_t * fs, u32 batch_size)
506{
507 fifo_segment_header_t *fsh = fs->h;
508 svm_fifo_t *f;
509 void *oldheap;
510 u32 size;
511 u8 *fmem;
512 int i;
513
514 size = (sizeof (*f)) * batch_size;
515
516 oldheap = ssvm_push_heap (fs->ssvm.sh);
517 fmem = clib_mem_alloc_aligned_at_offset (size, CLIB_CACHE_LINE_BYTES,
518 0 /* align_offset */ ,
519 0 /* os_out_of_memory */ );
520 ssvm_pop_heap (oldheap);
521
522 /* Out of space.. */
523 if (fmem == 0)
524 return -1;
525
526 /* Carve fifo + chunk space */
527 for (i = 0; i < batch_size; i++)
528 {
529 f = (svm_fifo_t *) fmem;
530 memset (f, 0, sizeof (*f));
531 f->next = fsh->free_fifos;
532 fsh->free_fifos = f;
533 fmem += sizeof (*f);
534 }
535
536 fsh->n_free_bytes -= size;
537
538 return 0;
539}
540
541int
542fifo_segment_prealloc_fifo_chunks (fifo_segment_t * fs, u32 chunk_size,
543 u32 batch_size)
544{
545 fifo_segment_header_t *fsh = fs->h;
546 u32 size, rounded_data_size, fl_index;
547 svm_fifo_chunk_t *c;
548 void *oldheap;
549 u8 *cmem;
550 int i;
551
552 if (!fs_chunk_size_is_valid (chunk_size))
553 {
554 clib_warning ("chunk size out of range %d", chunk_size);
555 return -1;
556 }
557
558 fl_index = fs_freelist_for_size (chunk_size);
559 vec_validate_init_empty (fsh->free_chunks, fl_index, 0);
560 rounded_data_size = fs_freelist_index_to_size (fl_index);
561 size = (sizeof (*c) + rounded_data_size) * batch_size;
562
563 oldheap = ssvm_push_heap (fs->ssvm.sh);
564 cmem = clib_mem_alloc_aligned_at_offset (size, CLIB_CACHE_LINE_BYTES,
565 0 /* align_offset */ ,
566 0 /* os_out_of_memory */ );
567 ssvm_pop_heap (oldheap);
568
569 /* Out of space.. */
570 if (cmem == 0)
571 return -1;
572
573 /* Carve fifo + chunk space */
574 for (i = 0; i < batch_size; i++)
575 {
576 c = (svm_fifo_chunk_t *) cmem;
577 c->start_byte = 0;
578 c->length = rounded_data_size;
579 c->next = fsh->free_chunks[fl_index];
580 fsh->free_chunks[fl_index] = c;
581 cmem += sizeof (*c) + rounded_data_size;
582 }
583
584 fsh->n_fl_chunk_bytes += batch_size * rounded_data_size;
585 fsh->n_free_bytes -= size;
586
587 return 0;
588}
589
Florin Coras88001c62019-04-24 14:44:46 -0700590/**
591 * Pre-allocates fifo pairs in fifo segment
592 */
593void
594fifo_segment_preallocate_fifo_pairs (fifo_segment_t * fs,
595 u32 rx_fifo_size, u32 tx_fifo_size,
596 u32 * n_fifo_pairs)
597{
Florin Corasf9d4ab42019-05-11 16:55:53 -0700598 u32 rx_rounded_data_size, tx_rounded_data_size, pair_size, pairs_to_alloc;
599 int rx_fl_index, tx_fl_index;
Florin Coras88001c62019-04-24 14:44:46 -0700600 uword space_available;
Florin Corascefd5d82019-05-05 13:19:57 -0700601 u32 hdrs;
Florin Coras88001c62019-04-24 14:44:46 -0700602
603 /* Parameter check */
604 if (rx_fifo_size == 0 || tx_fifo_size == 0 || *n_fifo_pairs == 0)
605 return;
606
Florin Corasb095a3c2019-04-25 12:58:46 -0700607 if (!fs_chunk_size_is_valid (rx_fifo_size))
Florin Coras88001c62019-04-24 14:44:46 -0700608 {
609 clib_warning ("rx fifo_size out of range %d", rx_fifo_size);
610 return;
611 }
612
Florin Corasb095a3c2019-04-25 12:58:46 -0700613 if (!fs_chunk_size_is_valid (tx_fifo_size))
Florin Coras88001c62019-04-24 14:44:46 -0700614 {
615 clib_warning ("tx fifo_size out of range %d", tx_fifo_size);
616 return;
617 }
618
619 rx_rounded_data_size = (1 << (max_log2 (rx_fifo_size)));
Florin Corasf9d4ab42019-05-11 16:55:53 -0700620 rx_fl_index = fs_freelist_for_size (rx_fifo_size);
Florin Coras88001c62019-04-24 14:44:46 -0700621 tx_rounded_data_size = (1 << (max_log2 (tx_fifo_size)));
Florin Corasf9d4ab42019-05-11 16:55:53 -0700622 tx_fl_index = fs_freelist_for_size (tx_fifo_size);
Florin Coras88001c62019-04-24 14:44:46 -0700623
Florin Corasf9d4ab42019-05-11 16:55:53 -0700624 hdrs = sizeof (svm_fifo_t) + sizeof (svm_fifo_chunk_t);
Florin Corascefd5d82019-05-05 13:19:57 -0700625
Florin Coras88001c62019-04-24 14:44:46 -0700626 /* Calculate space requirements */
Florin Corascefd5d82019-05-05 13:19:57 -0700627 pair_size = 2 * hdrs + rx_rounded_data_size + tx_rounded_data_size;
Florin Corasf9d4ab42019-05-11 16:55:53 -0700628 space_available = fs_free_space (fs);
Florin Coraseaacce42019-07-02 13:07:37 -0700629 pairs_to_alloc = space_available / pair_size;
630 pairs_to_alloc = clib_min (pairs_to_alloc, *n_fifo_pairs);
631
632 if (!pairs_to_alloc)
633 return;
Florin Coras88001c62019-04-24 14:44:46 -0700634
Florin Corasf9d4ab42019-05-11 16:55:53 -0700635 if (fs_try_alloc_fifo_batch (fs, rx_fl_index, pairs_to_alloc))
Florin Coraseaacce42019-07-02 13:07:37 -0700636 clib_warning ("rx prealloc failed: pairs %u", pairs_to_alloc);
Florin Corasf9d4ab42019-05-11 16:55:53 -0700637 if (fs_try_alloc_fifo_batch (fs, tx_fl_index, pairs_to_alloc))
Florin Coraseaacce42019-07-02 13:07:37 -0700638 clib_warning ("tx prealloc failed: pairs %u", pairs_to_alloc);
Florin Coras88001c62019-04-24 14:44:46 -0700639
640 /* Account for the pairs allocated */
Florin Corasf9d4ab42019-05-11 16:55:53 -0700641 *n_fifo_pairs -= pairs_to_alloc;
Florin Coras88001c62019-04-24 14:44:46 -0700642}
643
Florin Corasb095a3c2019-04-25 12:58:46 -0700644int
645fifo_segment_grow_fifo (fifo_segment_t * fs, svm_fifo_t * f, u32 chunk_size)
646{
647 ssvm_shared_header_t *sh;
648 svm_fifo_chunk_t *c;
649 void *oldheap;
650 int fl_index;
651
652 if (!fs_chunk_size_is_valid (chunk_size))
653 {
654 clib_warning ("chunk size out of range %d", chunk_size);
Florin Coras1c91c772019-06-25 18:14:13 -0700655 return -1;
Florin Corasb095a3c2019-04-25 12:58:46 -0700656 }
657
Florin Corasf9d4ab42019-05-11 16:55:53 -0700658 fl_index = fs_freelist_for_size (chunk_size);
Florin Corasb095a3c2019-04-25 12:58:46 -0700659
660 sh = fs->ssvm.sh;
661 ssvm_lock_non_recursive (sh, 1);
662
663 vec_validate_init_empty (fs->h->free_chunks, fl_index, 0);
664 c = fs->h->free_chunks[fl_index];
665
666 oldheap = ssvm_push_heap (sh);
667
668 if (!c)
669 {
670 c = svm_fifo_chunk_alloc (chunk_size);
671 if (!c)
672 {
673 ssvm_pop_heap (oldheap);
Florin Coras1c91c772019-06-25 18:14:13 -0700674 ssvm_unlock_non_recursive (sh);
Florin Corasb095a3c2019-04-25 12:58:46 -0700675 return -1;
676 }
Florin Corasf8461bf2019-11-07 17:00:15 -0800677 fs->h->n_free_bytes -= chunk_size + sizeof (*c);
Florin Corasb095a3c2019-04-25 12:58:46 -0700678 }
679 else
680 {
681 fs->h->free_chunks[fl_index] = c->next;
Florin Corascefd5d82019-05-05 13:19:57 -0700682 c->next = 0;
Florin Coras1c91c772019-06-25 18:14:13 -0700683 fs->h->n_fl_chunk_bytes -= fs_freelist_index_to_size (fl_index);
Florin Corasb095a3c2019-04-25 12:58:46 -0700684 }
685
686 svm_fifo_add_chunk (f, c);
687
688 ssvm_pop_heap (oldheap);
689 ssvm_unlock_non_recursive (sh);
690 return 0;
691}
692
Florin Coras344ce422019-05-03 11:46:55 -0700693int
694fifo_segment_collect_fifo_chunks (fifo_segment_t * fs, svm_fifo_t * f)
695{
696 svm_fifo_chunk_t *cur, *next;
697 ssvm_shared_header_t *sh;
698 void *oldheap;
699 int fl_index;
700
701 sh = fs->ssvm.sh;
702 ssvm_lock_non_recursive (sh, 1);
703
704 oldheap = ssvm_push_heap (sh);
705 cur = svm_fifo_collect_chunks (f);
706
707 while (cur)
708 {
709 next = cur->next;
Florin Corasf9d4ab42019-05-11 16:55:53 -0700710 fl_index = fs_freelist_for_size (cur->length);
Florin Coras344ce422019-05-03 11:46:55 -0700711 cur->next = fs->h->free_chunks[fl_index];
712 fs->h->free_chunks[fl_index] = cur;
713 cur = next;
714 }
715
716 ssvm_pop_heap (oldheap);
717 ssvm_unlock_non_recursive (sh);
718
719 return 0;
720}
721
Florin Coras88001c62019-04-24 14:44:46 -0700722/**
723 * Get number of active fifos
724 */
725u32
726fifo_segment_num_fifos (fifo_segment_t * fs)
727{
728 return fs->h->n_active_fifos;
729}
730
731u32
Florin Corasf9d4ab42019-05-11 16:55:53 -0700732fifo_segment_num_free_fifos (fifo_segment_t * fs)
Florin Coras88001c62019-04-24 14:44:46 -0700733{
Florin Corasf9d4ab42019-05-11 16:55:53 -0700734 fifo_segment_header_t *fsh = fs->h;
Florin Coras88001c62019-04-24 14:44:46 -0700735 svm_fifo_t *f;
Florin Corascefd5d82019-05-05 13:19:57 -0700736 u32 count = 0;
Florin Coras88001c62019-04-24 14:44:46 -0700737
Florin Corascefd5d82019-05-05 13:19:57 -0700738 f = fsh->free_fifos;
Florin Coras88001c62019-04-24 14:44:46 -0700739 if (f == 0)
740 return 0;
741
742 while (f)
743 {
744 f = f->next;
745 count++;
746 }
747 return count;
748}
749
Florin Corasb095a3c2019-04-25 12:58:46 -0700750u32
751fifo_segment_num_free_chunks (fifo_segment_t * fs, u32 size)
752{
753 u32 count = 0, rounded_size, fl_index;
754 fifo_segment_header_t *fsh;
755 svm_fifo_chunk_t *c;
756 int i;
757
758 fsh = fs->h;
759
760 /* Count all free chunks? */
761 if (size == ~0)
762 {
763 for (i = 0; i < vec_len (fsh->free_chunks); i++)
764 {
765 c = fsh->free_chunks[i];
766 if (c == 0)
767 continue;
768
769 while (c)
770 {
771 c = c->next;
772 count++;
773 }
774 }
775 return count;
776 }
777
778 rounded_size = (1 << (max_log2 (size)));
Florin Corasf9d4ab42019-05-11 16:55:53 -0700779 fl_index = fs_freelist_for_size (rounded_size);
Florin Corasb095a3c2019-04-25 12:58:46 -0700780
781 if (fl_index >= vec_len (fsh->free_chunks))
782 return 0;
783
784 c = fsh->free_chunks[fl_index];
785 if (c == 0)
786 return 0;
787
788 while (c)
789 {
790 c = c->next;
791 count++;
792 }
793 return count;
794}
795
Florin Corasf9d4ab42019-05-11 16:55:53 -0700796void
797fifo_segment_update_free_bytes (fifo_segment_t * fs)
798{
799 fs->h->n_free_bytes = fs_free_space (fs);
800}
801
802u32
803fifo_segment_free_bytes (fifo_segment_t * fs)
804{
805 return fs->h->n_free_bytes;
806}
807
808u32
Florin Coras1c91c772019-06-25 18:14:13 -0700809fifo_segment_fl_chunk_bytes (fifo_segment_t * fs)
Florin Corasf9d4ab42019-05-11 16:55:53 -0700810{
811 return fs->h->n_fl_chunk_bytes;
812}
813
Florin Coras88001c62019-04-24 14:44:46 -0700814u8
815fifo_segment_has_fifos (fifo_segment_t * fs)
816{
817 return fs->h->fifos != 0;
818}
819
820svm_fifo_t *
821fifo_segment_get_fifo_list (fifo_segment_t * fs)
822{
823 return fs->h->fifos;
824}
825
826u8 *
827format_fifo_segment_type (u8 * s, va_list * args)
828{
829 fifo_segment_t *sp;
830 sp = va_arg (*args, fifo_segment_t *);
831 ssvm_segment_type_t st = ssvm_type (&sp->ssvm);
832
833 if (st == SSVM_SEGMENT_PRIVATE)
834 s = format (s, "%s", "private-heap");
835 else if (st == SSVM_SEGMENT_MEMFD)
836 s = format (s, "%s", "memfd");
837 else if (st == SSVM_SEGMENT_SHM)
838 s = format (s, "%s", "shm");
839 else
840 s = format (s, "%s", "unknown");
841 return s;
842}
843
844/**
845 * Segment format function
846 */
847u8 *
848format_fifo_segment (u8 * s, va_list * args)
849{
Florin Corasf8461bf2019-11-07 17:00:15 -0800850 u32 count, indent, active_fifos, free_fifos, fifo_hdr = 0, chunk_size;
Florin Coras5368bb02019-06-09 09:24:33 -0700851 fifo_segment_t *fs = va_arg (*args, fifo_segment_t *);
Florin Coras88001c62019-04-24 14:44:46 -0700852 int verbose __attribute__ ((unused)) = va_arg (*args, int);
Florin Corasf8461bf2019-11-07 17:00:15 -0800853 u32 est_chunk_bytes, est_free_seg_bytes;
Florin Coras5368bb02019-06-09 09:24:33 -0700854 fifo_segment_header_t *fsh;
Florin Corascefd5d82019-05-05 13:19:57 -0700855 svm_fifo_chunk_t *c;
Florin Corasf8461bf2019-11-07 17:00:15 -0800856 u64 chunk_bytes = 0;
Florin Coras5368bb02019-06-09 09:24:33 -0700857 char *address;
858 size_t size;
Florin Coras88001c62019-04-24 14:44:46 -0700859 int i;
860
861 indent = format_get_indent (s) + 2;
862#if USE_DLMALLOC == 0
863 s = format (s, "%U segment heap: %U\n", format_white_space, indent,
Florin Coras5368bb02019-06-09 09:24:33 -0700864 format_mheap, svm_fifo_segment_heap (fs), verbose);
Florin Coras88001c62019-04-24 14:44:46 -0700865 s = format (s, "%U segment has %u active fifos\n",
Florin Coras5368bb02019-06-09 09:24:33 -0700866 format_white_space, indent, fifo_segment_num_fifos (fs));
Florin Coras88001c62019-04-24 14:44:46 -0700867#endif
868
Florin Coras5368bb02019-06-09 09:24:33 -0700869 if (fs == 0)
870 {
871 s = format (s, "%-15s%15s%15s%15s%15s%15s", "Name", "Type",
872 "HeapSize (M)", "ActiveFifos", "FreeFifos", "Address");
873 return s;
874 }
875
876 fsh = fs->h;
877 fifo_segment_info (fs, &address, &size);
878 active_fifos = fifo_segment_num_fifos (fs);
879 free_fifos = fifo_segment_num_free_fifos (fs);
880
881 s = format (s, "%-15v%15U%15llu%15u%15u%15llx", ssvm_name (&fs->ssvm),
882 format_fifo_segment_type, fs, size >> 20ULL, active_fifos,
883 free_fifos, address);
884
885 if (!verbose)
886 return s;
887
Florin Corasf8461bf2019-11-07 17:00:15 -0800888 if (fsh->free_chunks)
889 s = format (s, "\n\n%UFree chunks by size:\n", format_white_space,
890 indent + 2);
891 else
892 s = format (s, "\n");
893
Florin Corascefd5d82019-05-05 13:19:57 -0700894 for (i = 0; i < vec_len (fsh->free_chunks); i++)
Florin Coras88001c62019-04-24 14:44:46 -0700895 {
Florin Corascefd5d82019-05-05 13:19:57 -0700896 c = fsh->free_chunks[i];
897 if (c == 0)
Florin Coras88001c62019-04-24 14:44:46 -0700898 continue;
899 count = 0;
Florin Corascefd5d82019-05-05 13:19:57 -0700900 while (c)
Florin Coras88001c62019-04-24 14:44:46 -0700901 {
Florin Corascefd5d82019-05-05 13:19:57 -0700902 c = c->next;
Florin Coras88001c62019-04-24 14:44:46 -0700903 count++;
904 }
905
Florin Corasf8461bf2019-11-07 17:00:15 -0800906 chunk_size = fs_freelist_index_to_size (i);
907 s = format (s, "%U%-5u kB: %u\n", format_white_space, indent + 2,
908 chunk_size >> 10, count);
909
910 chunk_bytes += count * chunk_size;
Florin Coras88001c62019-04-24 14:44:46 -0700911 }
Florin Corasf8461bf2019-11-07 17:00:15 -0800912
913 fifo_hdr = free_fifos * sizeof (svm_fifo_t);
914 est_chunk_bytes = fifo_segment_fl_chunk_bytes (fs);
915 est_free_seg_bytes = fsh->n_free_bytes;
916 fifo_segment_update_free_bytes (fs);
917
918 s = format (s, "\n%Useg free bytes: %U (%u) estimated: %U (%u)\n",
919 format_white_space, indent + 2, format_memory_size,
920 fsh->n_free_bytes, fsh->n_free_bytes, format_memory_size,
921 est_free_seg_bytes, est_free_seg_bytes);
922 s = format (s, "%Uchunk free bytes: %U (%lu) estimated: %U (%u)\n",
923 format_white_space, indent + 2, format_memory_size, chunk_bytes,
924 chunk_bytes, format_memory_size, est_chunk_bytes,
925 est_chunk_bytes);
926 s = format (s, "%Ufifo hdr free bytes: %U (%u)\n", format_white_space,
927 indent + 2, format_memory_size, fifo_hdr, fifo_hdr);
928 s = format (s, "\n");
Florin Coras5368bb02019-06-09 09:24:33 -0700929
Florin Coras88001c62019-04-24 14:44:46 -0700930 return s;
931}
932
933/*
934 * fd.io coding-style-patch-verification: ON
935 *
936 * Local Variables:
937 * eval: (c-set-style "gnu")
938 * End:
939 */