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:
7 * http://www.apache.org/licenses/LICENSE-2.0
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.
16 #include <svm/fifo_segment.h>
19 * Fifo segment free space
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
25 * @param fs fifo segment
26 * @return number of free bytes
29 fs_free_space (fifo_segment_t * fs)
31 struct dlmallinfo dlminfo;
33 dlminfo = mspace_mallinfo (fs->ssvm.sh->heap);
34 return dlminfo.fordblks;
38 * Initialize fifo segment shared header
41 fifo_segment_init (fifo_segment_t * fs)
43 fifo_segment_header_t *fsh;
44 ssvm_shared_header_t *sh;
48 oldheap = ssvm_push_heap (sh);
50 fsh = clib_mem_alloc (sizeof (*fsh));
51 clib_memset (fsh, 0, sizeof (*fsh));
52 fs->h = sh->opaque[0] = fsh;
54 ssvm_pop_heap (oldheap);
56 fsh->n_free_bytes = fs_free_space (fs);
62 * Create a fifo segment and initialize as master
65 fifo_segment_create (fifo_segment_main_t * sm, fifo_segment_create_args_t * a)
71 /* Allocate a fresh segment */
72 pool_get_zero (sm->segments, fs);
74 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;
81 if ((rv = ssvm_master_init (&fs->ssvm, a->segment_type)))
83 pool_put (sm->segments, fs);
87 /* Note: requested_va updated due to seg base addr randomization */
88 sm->next_baseva = fs->ssvm.sh->ssvm_va + fs->ssvm.ssvm_size;
90 fifo_segment_init (fs);
91 vec_add1 (a->new_segment_indices, fs - sm->segments);
96 * Attach as slave to a fifo segment
99 fifo_segment_attach (fifo_segment_main_t * sm, fifo_segment_create_args_t * a)
104 pool_get_zero (sm->segments, s);
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;
113 s->ssvm.attach_timeout = sm->timeout_in_seconds;
115 if ((rv = ssvm_slave_init (&s->ssvm, a->segment_type)))
117 _vec_len (s) = vec_len (s) - 1;
121 /* Fish the segment header */
122 s->h = s->ssvm.sh->opaque[0];
124 vec_add1 (a->new_segment_indices, s - sm->segments);
129 fifo_segment_delete (fifo_segment_main_t * sm, fifo_segment_t * s)
131 ssvm_delete (&s->ssvm);
132 clib_memset (s, 0xfe, sizeof (*s));
133 pool_put (sm->segments, s);
137 fifo_segment_index (fifo_segment_main_t * sm, fifo_segment_t * s)
139 return s - sm->segments;
143 svm_fifo_segment_heap (fifo_segment_t * seg)
145 return seg->ssvm.sh->heap;
149 fifo_segment_get_segment (fifo_segment_main_t * sm, u32 segment_index)
151 return pool_elt_at_index (sm->segments, segment_index);
155 fifo_segment_info (fifo_segment_t * seg, char **address, size_t * size)
157 *address = (char *) seg->ssvm.sh->ssvm_va;
158 *size = seg->ssvm.ssvm_size;
162 fifo_segment_main_init (fifo_segment_main_t * sm, u64 baseva,
163 u32 timeout_in_seconds)
165 sm->next_baseva = baseva;
166 sm->timeout_in_seconds = timeout_in_seconds;
170 fs_freelist_for_size (u32 size)
172 return max_log2 (size) - max_log2 (FIFO_SEGMENT_MIN_FIFO_SIZE);
176 fs_freelist_index_to_size (u32 fl_index)
178 return 1 << (fl_index + max_log2 (FIFO_SEGMENT_MIN_FIFO_SIZE));
182 fs_chunk_size_is_valid (u32 size)
185 * 4K minimum. It's not likely that anything good will happen
186 * with a smaller FIFO.
188 return size >= FIFO_SEGMENT_MIN_FIFO_SIZE
189 && size <= FIFO_SEGMENT_MAX_FIFO_SIZE;
193 fs_try_alloc_fifo_freelist (fifo_segment_t * fs, u32 fl_index, u32 data_bytes)
195 fifo_segment_header_t *fsh = fs->h;
200 c = fsh->free_chunks[fl_index];
205 fsh->free_fifos = f->next;
206 fsh->free_chunks[fl_index] = c->next;
209 c->length = data_bytes;
210 memset (f, 0, sizeof (*f));
214 fsh->n_fl_chunk_bytes -= fs_freelist_index_to_size (fl_index);
219 fs_try_alloc_fifo_freelist_multi_chunk (fifo_segment_t * fs, u32 data_bytes)
221 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;
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);
234 memset (f, 0, sizeof (*f));
238 fsh->free_fifos = f->next;
241 fl_index = fs_freelist_for_size (data_bytes) - 1;
242 vec_validate_init_empty (fsh->free_chunks, fl_index, 0);
243 fl_size = fs_freelist_index_to_size (fl_index);
247 c = fsh->free_chunks[fl_index];
250 fsh->free_chunks[fl_index] = c->next;
256 c->length = clib_min (fl_size, data_bytes);
257 data_bytes -= c->length;
261 ASSERT (fl_index > 0);
263 fl_size = fl_size >> 1;
266 f->start_chunk = first;
269 fsh->n_fl_chunk_bytes -= n_alloc;
274 fs_try_alloc_fifo_batch (fifo_segment_t * fs, u32 fl_index, u32 batch_size)
276 fifo_segment_header_t *fsh = fs->h;
277 u32 size, hdrs, rounded_data_size;
284 vec_validate_init_empty (fsh->free_chunks, fl_index, 0);
285 rounded_data_size = fs_freelist_index_to_size (fl_index);
286 hdrs = sizeof (*f) + sizeof (*c);
287 size = (hdrs + rounded_data_size) * batch_size;
289 oldheap = ssvm_push_heap (fs->ssvm.sh);
290 fmem = clib_mem_alloc_aligned_at_offset (size, CLIB_CACHE_LINE_BYTES,
291 0 /* align_offset */ ,
292 0 /* os_out_of_memory */ );
293 ssvm_pop_heap (oldheap);
299 /* Carve fifo + chunk space */
300 for (i = 0; i < batch_size; i++)
302 f = (svm_fifo_t *) fmem;
303 memset (f, 0, sizeof (*f));
304 f->next = fsh->free_fifos;
306 c = (svm_fifo_chunk_t *) (fmem + sizeof (*f));
308 c->length = rounded_data_size;
309 c->next = fsh->free_chunks[fl_index];
310 fsh->free_chunks[fl_index] = c;
311 fmem += hdrs + rounded_data_size;
314 fsh->n_fl_chunk_bytes += batch_size * rounded_data_size;
315 fsh->n_free_bytes -= size;
321 * Try to allocate new fifo
323 * Tries the following steps in order:
324 * - grab fifo and chunk from freelists
325 * - batch fifo and chunk allocation
326 * - single fifo allocation
327 * - grab multiple fifo chunks from freelists
330 fs_try_alloc_fifo (fifo_segment_t * fs, u32 data_bytes)
332 fifo_segment_header_t *fsh = fs->h;
333 u32 fifo_sz, fl_index;
336 fl_index = fs_freelist_for_size (data_bytes);
337 vec_validate_init_empty (fsh->free_chunks, fl_index, 0);
338 fifo_sz = sizeof (svm_fifo_t) + sizeof (svm_fifo_chunk_t);
339 fifo_sz += 1 << max_log2 (data_bytes);
341 if (fsh->free_fifos && fsh->free_chunks[fl_index])
343 f = fs_try_alloc_fifo_freelist (fs, fl_index, data_bytes);
347 if (fifo_sz * FIFO_SEGMENT_ALLOC_BATCH_SIZE < fsh->n_free_bytes)
349 if (fs_try_alloc_fifo_batch (fs, fl_index,
350 FIFO_SEGMENT_ALLOC_BATCH_SIZE))
353 f = fs_try_alloc_fifo_freelist (fs, fl_index, data_bytes);
356 if (fifo_sz <= fsh->n_free_bytes)
358 void *oldheap = ssvm_push_heap (fs->ssvm.sh);
359 f = svm_fifo_create (data_bytes);
360 ssvm_pop_heap (oldheap);
363 fsh->n_free_bytes -= fifo_sz;
367 if (data_bytes <= fsh->n_fl_chunk_bytes)
368 f = fs_try_alloc_fifo_freelist_multi_chunk (fs, data_bytes);
376 * Allocate fifo in fifo segment
379 fifo_segment_alloc_fifo (fifo_segment_t * fs, u32 data_bytes,
380 fifo_segment_ftype_t ftype)
382 fifo_segment_header_t *fsh;
385 if (!fs_chunk_size_is_valid (data_bytes))
387 clib_warning ("fifo size out of range %d", data_bytes);
392 ssvm_lock_non_recursive (fs->ssvm.sh, 1);
394 f = fs_try_alloc_fifo (fs, data_bytes);
398 /* (re)initialize the fifo, as in svm_fifo_create */
399 svm_fifo_init (f, data_bytes);
401 /* Initialize chunks and rbtree for multi-chunk fifos */
402 if (f->start_chunk->next != f->start_chunk)
404 void *oldheap = ssvm_push_heap (fs->ssvm.sh);
405 svm_fifo_init_chunks (f);
406 ssvm_pop_heap (oldheap);
409 /* If rx fifo type add to active fifos list. When cleaning up segment,
410 * we need a list of active sessions that should be disconnected. Since
411 * both rx and tx fifos keep pointers to the session, it's enough to track
413 if (ftype == FIFO_SEGMENT_RX_FIFO)
417 fsh->fifos->prev = f;
418 f->next = fsh->fifos;
421 f->flags |= SVM_FIFO_F_LL_TRACKED;
423 fsh->n_active_fifos++;
426 ssvm_unlock_non_recursive (fs->ssvm.sh);
431 * Free fifo allocated in fifo segment
434 fifo_segment_free_fifo (fifo_segment_t * fs, svm_fifo_t * f)
436 svm_fifo_chunk_t *cur, *next;
437 fifo_segment_header_t *fsh;
438 ssvm_shared_header_t *sh;
442 ASSERT (f->refcnt > 0);
450 ssvm_lock_non_recursive (sh, 2);
452 /* Remove from active list. Only rx fifos are tracked */
453 if (f->flags & SVM_FIFO_F_LL_TRACKED)
456 f->prev->next = f->next;
458 fsh->fifos = f->next;
460 f->next->prev = f->prev;
461 f->flags &= ~SVM_FIFO_F_LL_TRACKED;
464 /* Add to free list */
465 f->next = fsh->free_fifos;
469 /* Free fifo chunks */
470 cur = f->start_chunk;
474 fl_index = fs_freelist_for_size (cur->length);
475 ASSERT (fl_index < vec_len (fsh->free_chunks));
476 cur->next = fsh->free_chunks[fl_index];
477 fsh->free_chunks[fl_index] = cur;
478 fsh->n_fl_chunk_bytes += fs_freelist_index_to_size (fl_index);
481 while (cur != f->start_chunk);
483 f->start_chunk = f->end_chunk = f->new_chunks = 0;
484 f->head_chunk = f->tail_chunk = f->ooo_enq = f->ooo_deq = 0;
486 oldheap = ssvm_push_heap (sh);
487 svm_fifo_free_chunk_lookup (f);
488 ssvm_pop_heap (oldheap);
490 /* not allocated on segment heap */
491 svm_fifo_free_ooo_data (f);
495 f->master_session_index = ~0;
496 f->master_thread_index = ~0;
499 fsh->n_active_fifos--;
500 ssvm_unlock_non_recursive (sh);
504 fifo_segment_prealloc_fifo_hdrs (fifo_segment_t * fs, u32 batch_size)
506 fifo_segment_header_t *fsh = fs->h;
513 size = (sizeof (*f)) * batch_size;
515 oldheap = ssvm_push_heap (fs->ssvm.sh);
516 fmem = clib_mem_alloc_aligned_at_offset (size, CLIB_CACHE_LINE_BYTES,
517 0 /* align_offset */ ,
518 0 /* os_out_of_memory */ );
519 ssvm_pop_heap (oldheap);
525 /* Carve fifo + chunk space */
526 for (i = 0; i < batch_size; i++)
528 f = (svm_fifo_t *) fmem;
529 memset (f, 0, sizeof (*f));
530 f->next = fsh->free_fifos;
535 fsh->n_free_bytes -= size;
541 fifo_segment_prealloc_fifo_chunks (fifo_segment_t * fs, u32 chunk_size,
544 fifo_segment_header_t *fsh = fs->h;
545 u32 size, rounded_data_size, fl_index;
551 if (!fs_chunk_size_is_valid (chunk_size))
553 clib_warning ("chunk size out of range %d", chunk_size);
557 fl_index = fs_freelist_for_size (chunk_size);
558 vec_validate_init_empty (fsh->free_chunks, fl_index, 0);
559 rounded_data_size = fs_freelist_index_to_size (fl_index);
560 size = (sizeof (*c) + rounded_data_size) * batch_size;
562 oldheap = ssvm_push_heap (fs->ssvm.sh);
563 cmem = clib_mem_alloc_aligned_at_offset (size, CLIB_CACHE_LINE_BYTES,
564 0 /* align_offset */ ,
565 0 /* os_out_of_memory */ );
566 ssvm_pop_heap (oldheap);
572 /* Carve fifo + chunk space */
573 for (i = 0; i < batch_size; i++)
575 c = (svm_fifo_chunk_t *) cmem;
577 c->length = rounded_data_size;
578 c->next = fsh->free_chunks[fl_index];
579 fsh->free_chunks[fl_index] = c;
580 cmem += sizeof (*c) + rounded_data_size;
583 fsh->n_fl_chunk_bytes += batch_size * rounded_data_size;
584 fsh->n_free_bytes -= size;
590 * Pre-allocates fifo pairs in fifo segment
593 fifo_segment_preallocate_fifo_pairs (fifo_segment_t * fs,
594 u32 rx_fifo_size, u32 tx_fifo_size,
597 u32 rx_rounded_data_size, tx_rounded_data_size, pair_size, pairs_to_alloc;
598 int rx_fl_index, tx_fl_index;
599 uword space_available;
602 /* Parameter check */
603 if (rx_fifo_size == 0 || tx_fifo_size == 0 || *n_fifo_pairs == 0)
606 if (!fs_chunk_size_is_valid (rx_fifo_size))
608 clib_warning ("rx fifo_size out of range %d", rx_fifo_size);
612 if (!fs_chunk_size_is_valid (tx_fifo_size))
614 clib_warning ("tx fifo_size out of range %d", tx_fifo_size);
618 rx_rounded_data_size = (1 << (max_log2 (rx_fifo_size)));
619 rx_fl_index = fs_freelist_for_size (rx_fifo_size);
620 tx_rounded_data_size = (1 << (max_log2 (tx_fifo_size)));
621 tx_fl_index = fs_freelist_for_size (tx_fifo_size);
623 hdrs = sizeof (svm_fifo_t) + sizeof (svm_fifo_chunk_t);
625 /* Calculate space requirements */
626 pair_size = 2 * hdrs + rx_rounded_data_size + tx_rounded_data_size;
627 space_available = fs_free_space (fs);
628 pairs_to_alloc = space_available / pair_size;
629 pairs_to_alloc = clib_min (pairs_to_alloc, *n_fifo_pairs);
634 if (fs_try_alloc_fifo_batch (fs, rx_fl_index, pairs_to_alloc))
635 clib_warning ("rx prealloc failed: pairs %u", pairs_to_alloc);
636 if (fs_try_alloc_fifo_batch (fs, tx_fl_index, pairs_to_alloc))
637 clib_warning ("tx prealloc failed: pairs %u", pairs_to_alloc);
639 /* Account for the pairs allocated */
640 *n_fifo_pairs -= pairs_to_alloc;
644 fifo_segment_grow_fifo (fifo_segment_t * fs, svm_fifo_t * f, u32 chunk_size)
646 ssvm_shared_header_t *sh;
651 if (!fs_chunk_size_is_valid (chunk_size))
653 clib_warning ("chunk size out of range %d", chunk_size);
657 fl_index = fs_freelist_for_size (chunk_size);
660 ssvm_lock_non_recursive (sh, 1);
662 vec_validate_init_empty (fs->h->free_chunks, fl_index, 0);
663 c = fs->h->free_chunks[fl_index];
665 oldheap = ssvm_push_heap (sh);
669 c = svm_fifo_chunk_alloc (chunk_size);
672 ssvm_pop_heap (oldheap);
673 ssvm_unlock_non_recursive (sh);
679 fs->h->free_chunks[fl_index] = c->next;
681 fs->h->n_fl_chunk_bytes -= fs_freelist_index_to_size (fl_index);
684 svm_fifo_add_chunk (f, c);
686 ssvm_pop_heap (oldheap);
687 ssvm_unlock_non_recursive (sh);
692 fifo_segment_collect_fifo_chunks (fifo_segment_t * fs, svm_fifo_t * f)
694 svm_fifo_chunk_t *cur, *next;
695 ssvm_shared_header_t *sh;
700 ssvm_lock_non_recursive (sh, 1);
702 oldheap = ssvm_push_heap (sh);
703 cur = svm_fifo_collect_chunks (f);
708 fl_index = fs_freelist_for_size (cur->length);
709 cur->next = fs->h->free_chunks[fl_index];
710 fs->h->free_chunks[fl_index] = cur;
714 ssvm_pop_heap (oldheap);
715 ssvm_unlock_non_recursive (sh);
721 * Get number of active fifos
724 fifo_segment_num_fifos (fifo_segment_t * fs)
726 return fs->h->n_active_fifos;
730 fifo_segment_num_free_fifos (fifo_segment_t * fs)
732 fifo_segment_header_t *fsh = fs->h;
749 fifo_segment_num_free_chunks (fifo_segment_t * fs, u32 size)
751 u32 count = 0, rounded_size, fl_index;
752 fifo_segment_header_t *fsh;
758 /* Count all free chunks? */
761 for (i = 0; i < vec_len (fsh->free_chunks); i++)
763 c = fsh->free_chunks[i];
776 rounded_size = (1 << (max_log2 (size)));
777 fl_index = fs_freelist_for_size (rounded_size);
779 if (fl_index >= vec_len (fsh->free_chunks))
782 c = fsh->free_chunks[fl_index];
795 fifo_segment_update_free_bytes (fifo_segment_t * fs)
797 fs->h->n_free_bytes = fs_free_space (fs);
801 fifo_segment_free_bytes (fifo_segment_t * fs)
803 return fs->h->n_free_bytes;
807 fifo_segment_fl_chunk_bytes (fifo_segment_t * fs)
809 return fs->h->n_fl_chunk_bytes;
813 fifo_segment_has_fifos (fifo_segment_t * fs)
815 return fs->h->fifos != 0;
819 fifo_segment_get_fifo_list (fifo_segment_t * fs)
825 format_fifo_segment_type (u8 * s, va_list * args)
828 sp = va_arg (*args, fifo_segment_t *);
829 ssvm_segment_type_t st = ssvm_type (&sp->ssvm);
831 if (st == SSVM_SEGMENT_PRIVATE)
832 s = format (s, "%s", "private-heap");
833 else if (st == SSVM_SEGMENT_MEMFD)
834 s = format (s, "%s", "memfd");
835 else if (st == SSVM_SEGMENT_SHM)
836 s = format (s, "%s", "shm");
838 s = format (s, "%s", "unknown");
843 * Segment format function
846 format_fifo_segment (u8 * s, va_list * args)
848 fifo_segment_t *fs = va_arg (*args, fifo_segment_t *);
849 int verbose __attribute__ ((unused)) = va_arg (*args, int);
850 fifo_segment_header_t *fsh;
859 indent = format_get_indent (s) + 2;
860 #if USE_DLMALLOC == 0
861 s = format (s, "%U segment heap: %U\n", format_white_space, indent,
862 format_mheap, svm_fifo_segment_heap (fs), verbose);
863 s = format (s, "%U segment has %u active fifos\n",
864 format_white_space, indent, fifo_segment_num_fifos (fs));
869 s = format (s, "%-15s%15s%15s%15s%15s%15s", "Name", "Type",
870 "HeapSize (M)", "ActiveFifos", "FreeFifos", "Address");
875 fifo_segment_info (fs, &address, &size);
876 active_fifos = fifo_segment_num_fifos (fs);
877 free_fifos = fifo_segment_num_free_fifos (fs);
879 s = format (s, "%-15v%15U%15llu%15u%15u%15llx", ssvm_name (&fs->ssvm),
880 format_fifo_segment_type, fs, size >> 20ULL, active_fifos,
881 free_fifos, address);
886 s = format (s, "\n");
887 for (i = 0; i < vec_len (fsh->free_chunks); i++)
889 c = fsh->free_chunks[i];
899 s = format (s, "%U%-5u Kb: %u free", format_white_space, indent + 2,
900 1 << (i + max_log2 (FIFO_SEGMENT_MIN_FIFO_SIZE) - 10),
903 s = format (s, "%Ufree bytes %U", format_white_space, indent + 2,
904 format_memory_size, fsh->n_free_bytes);
910 * fd.io coding-style-patch-verification: ON
913 * eval: (c-set-style "gnu")