Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2016 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 | #ifndef __included_ssvm_fifo_h__ |
| 16 | #define __included_ssvm_fifo_h__ |
| 17 | |
| 18 | #include <vppinfra/clib.h> |
| 19 | #include <vppinfra/vec.h> |
| 20 | #include <vppinfra/mheap.h> |
| 21 | #include <vppinfra/heap.h> |
| 22 | #include <vppinfra/pool.h> |
| 23 | #include <vppinfra/format.h> |
| 24 | #include <pthread.h> |
| 25 | |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 26 | /** Out-of-order segment */ |
| 27 | typedef struct |
| 28 | { |
| 29 | u32 next; /**< Next linked-list element pool index */ |
| 30 | u32 prev; /**< Previous linked-list element pool index */ |
| 31 | |
Dave Barach | 1f75cfd | 2017-04-14 16:46:44 -0400 | [diff] [blame] | 32 | u32 start; /**< Start of segment, normalized*/ |
Florin Coras | a546481 | 2017-04-19 13:00:05 -0700 | [diff] [blame] | 33 | u32 length; /**< Length of segment */ |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 34 | } ooo_segment_t; |
| 35 | |
Dave Barach | 1f75cfd | 2017-04-14 16:46:44 -0400 | [diff] [blame] | 36 | format_function_t format_ooo_segment; |
| 37 | format_function_t format_ooo_list; |
| 38 | |
Florin Coras | 3eb5062 | 2017-07-13 01:24:57 -0400 | [diff] [blame] | 39 | #define SVM_FIFO_TRACE (0) |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 40 | #define OOO_SEGMENT_INVALID_INDEX ((u32)~0) |
| 41 | |
Florin Coras | 3eb5062 | 2017-07-13 01:24:57 -0400 | [diff] [blame] | 42 | typedef struct |
| 43 | { |
| 44 | u32 offset; |
| 45 | u32 len; |
| 46 | u32 action; |
| 47 | } svm_fifo_trace_elem_t; |
| 48 | |
Dave Barach | 10d8cc6 | 2017-05-30 09:30:07 -0400 | [diff] [blame] | 49 | typedef struct _svm_fifo |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 50 | { |
Florin Coras | 3e350af | 2017-03-30 02:54:28 -0700 | [diff] [blame] | 51 | volatile u32 cursize; /**< current fifo size */ |
| 52 | u32 nitems; |
| 53 | CLIB_CACHE_LINE_ALIGN_MARK (end_cursize); |
| 54 | |
Dave Barach | acd2a6a | 2017-05-16 17:41:34 -0400 | [diff] [blame] | 55 | volatile u32 has_event; /**< non-zero if deq event exists */ |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 56 | |
| 57 | /* Backpointers */ |
Florin Coras | a546481 | 2017-04-19 13:00:05 -0700 | [diff] [blame] | 58 | u32 master_session_index; |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 59 | u32 client_session_index; |
Florin Coras | a546481 | 2017-04-19 13:00:05 -0700 | [diff] [blame] | 60 | u8 master_thread_index; |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 61 | u8 client_thread_index; |
Florin Coras | 6cf30ad | 2017-04-04 23:08:23 -0700 | [diff] [blame] | 62 | u32 segment_manager; |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 63 | CLIB_CACHE_LINE_ALIGN_MARK (end_shared); |
| 64 | u32 head; |
| 65 | CLIB_CACHE_LINE_ALIGN_MARK (end_consumer); |
| 66 | |
| 67 | /* producer */ |
| 68 | u32 tail; |
| 69 | |
| 70 | ooo_segment_t *ooo_segments; /**< Pool of ooo segments */ |
| 71 | u32 ooos_list_head; /**< Head of out-of-order linked-list */ |
| 72 | u32 ooos_newest; /**< Last segment to have been updated */ |
Dave Barach | 10d8cc6 | 2017-05-30 09:30:07 -0400 | [diff] [blame] | 73 | struct _svm_fifo *next; /**< next in freelist/active chain */ |
| 74 | struct _svm_fifo *prev; /**< prev in active chain */ |
Florin Coras | 3eb5062 | 2017-07-13 01:24:57 -0400 | [diff] [blame] | 75 | #if SVM_FIFO_TRACE |
| 76 | svm_fifo_trace_elem_t *trace; |
| 77 | #endif |
Dave Barach | 818eb54 | 2017-08-02 13:56:13 -0400 | [diff] [blame] | 78 | u32 freelist_index; /**< aka log2(allocated_size) - const. */ |
| 79 | i8 refcnt; /**< reference count */ |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 80 | CLIB_CACHE_LINE_ALIGN_MARK (data); |
| 81 | } svm_fifo_t; |
| 82 | |
Florin Coras | 3eb5062 | 2017-07-13 01:24:57 -0400 | [diff] [blame] | 83 | #if SVM_FIFO_TRACE |
| 84 | #define svm_fifo_trace_add(_f, _s, _l, _t) \ |
| 85 | { \ |
| 86 | svm_fifo_trace_elem_t *trace_elt; \ |
| 87 | vec_add2(_f->trace, trace_elt, 1); \ |
| 88 | trace_elt->offset = _s; \ |
| 89 | trace_elt->len = _l; \ |
| 90 | trace_elt->action = _t; \ |
| 91 | } |
| 92 | #else |
| 93 | #define svm_fifo_trace_add(_f, _s, _l, _t) |
| 94 | #endif |
| 95 | |
| 96 | u8 *svm_fifo_dump_trace (u8 * s, svm_fifo_t * f); |
| 97 | u8 *svm_fifo_replay (u8 * s, svm_fifo_t * f, u8 no_read, u8 verbose); |
| 98 | |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 99 | static inline u32 |
| 100 | svm_fifo_max_dequeue (svm_fifo_t * f) |
| 101 | { |
| 102 | return f->cursize; |
| 103 | } |
| 104 | |
| 105 | static inline u32 |
| 106 | svm_fifo_max_enqueue (svm_fifo_t * f) |
| 107 | { |
Florin Coras | 3e350af | 2017-03-30 02:54:28 -0700 | [diff] [blame] | 108 | return f->nitems - svm_fifo_max_dequeue (f); |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 109 | } |
| 110 | |
| 111 | static inline u8 |
| 112 | svm_fifo_has_ooo_data (svm_fifo_t * f) |
| 113 | { |
| 114 | return f->ooos_list_head != OOO_SEGMENT_INVALID_INDEX; |
| 115 | } |
| 116 | |
Florin Coras | 6792ec0 | 2017-03-13 03:49:51 -0700 | [diff] [blame] | 117 | /** |
| 118 | * Sets fifo event flag. |
| 119 | * |
| 120 | * @return 1 if flag was not set. |
| 121 | */ |
| 122 | always_inline u8 |
| 123 | svm_fifo_set_event (svm_fifo_t * f) |
| 124 | { |
| 125 | /* Probably doesn't need to be atomic. Still, better avoid surprises */ |
| 126 | return __sync_lock_test_and_set (&f->has_event, 1) == 0; |
| 127 | } |
| 128 | |
| 129 | /** |
| 130 | * Unsets fifo event flag. |
| 131 | */ |
| 132 | always_inline void |
| 133 | svm_fifo_unset_event (svm_fifo_t * f) |
| 134 | { |
| 135 | /* Probably doesn't need to be atomic. Still, better avoid surprises */ |
Dave Barach | acd2a6a | 2017-05-16 17:41:34 -0400 | [diff] [blame] | 136 | __sync_lock_release (&f->has_event); |
Florin Coras | 6792ec0 | 2017-03-13 03:49:51 -0700 | [diff] [blame] | 137 | } |
| 138 | |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 139 | svm_fifo_t *svm_fifo_create (u32 data_size_in_bytes); |
Florin Coras | 6cf30ad | 2017-04-04 23:08:23 -0700 | [diff] [blame] | 140 | void svm_fifo_free (svm_fifo_t * f); |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 141 | |
Florin Coras | a546481 | 2017-04-19 13:00:05 -0700 | [diff] [blame] | 142 | int svm_fifo_enqueue_nowait (svm_fifo_t * f, u32 max_bytes, |
Florin Coras | 371ca50 | 2018-02-21 12:07:41 -0800 | [diff] [blame] | 143 | const u8 * copy_from_here); |
Florin Coras | a546481 | 2017-04-19 13:00:05 -0700 | [diff] [blame] | 144 | int svm_fifo_enqueue_with_offset (svm_fifo_t * f, u32 offset, |
| 145 | u32 required_bytes, u8 * copy_from_here); |
| 146 | int svm_fifo_dequeue_nowait (svm_fifo_t * f, u32 max_bytes, u8 * copy_here); |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 147 | |
Florin Coras | a546481 | 2017-04-19 13:00:05 -0700 | [diff] [blame] | 148 | int svm_fifo_peek (svm_fifo_t * f, u32 offset, u32 max_bytes, u8 * copy_here); |
| 149 | int svm_fifo_dequeue_drop (svm_fifo_t * f, u32 max_bytes); |
Dave Barach | 1f75cfd | 2017-04-14 16:46:44 -0400 | [diff] [blame] | 150 | u32 svm_fifo_number_ooo_segments (svm_fifo_t * f); |
| 151 | ooo_segment_t *svm_fifo_first_ooo_segment (svm_fifo_t * f); |
Florin Coras | c28764f | 2017-04-26 00:08:42 -0700 | [diff] [blame] | 152 | void svm_fifo_init_pointers (svm_fifo_t * f, u32 pointer); |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 153 | |
Florin Coras | 6cf30ad | 2017-04-04 23:08:23 -0700 | [diff] [blame] | 154 | format_function_t format_svm_fifo; |
| 155 | |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 156 | always_inline ooo_segment_t * |
| 157 | svm_fifo_newest_ooo_segment (svm_fifo_t * f) |
| 158 | { |
Florin Coras | f03a59a | 2017-06-09 21:07:32 -0700 | [diff] [blame] | 159 | if (f->ooos_newest == OOO_SEGMENT_INVALID_INDEX) |
| 160 | return 0; |
| 161 | return pool_elt_at_index (f->ooo_segments, f->ooos_newest); |
| 162 | } |
| 163 | |
Florin Coras | 3eb5062 | 2017-07-13 01:24:57 -0400 | [diff] [blame] | 164 | always_inline void |
| 165 | svm_fifo_newest_ooo_segment_reset (svm_fifo_t * f) |
| 166 | { |
| 167 | f->ooos_newest = OOO_SEGMENT_INVALID_INDEX; |
| 168 | } |
| 169 | |
Florin Coras | 58d36f0 | 2018-03-09 13:05:53 -0800 | [diff] [blame] | 170 | /** |
| 171 | * Max contiguous chunk of data that can be read |
| 172 | */ |
| 173 | always_inline u32 |
| 174 | svm_fifo_max_read_chunk (svm_fifo_t * f) |
| 175 | { |
| 176 | return ((f->tail > f->head) ? (f->tail - f->head) : (f->nitems - f->head)); |
| 177 | } |
| 178 | |
| 179 | /** |
| 180 | * Max contiguous chunk of data that can be written |
| 181 | */ |
| 182 | always_inline u32 |
| 183 | svm_fifo_max_write_chunk (svm_fifo_t * f) |
| 184 | { |
| 185 | return ((f->tail >= f->head) ? (f->nitems - f->tail) : (f->head - f->tail)); |
| 186 | } |
| 187 | |
| 188 | /** |
| 189 | * Advance tail pointer |
| 190 | * |
| 191 | * Useful for moving tail pointer after external enqueue. |
| 192 | */ |
| 193 | always_inline void |
| 194 | svm_fifo_enqueue_nocopy (svm_fifo_t * f, u32 bytes) |
| 195 | { |
| 196 | ASSERT (bytes <= svm_fifo_max_enqueue (f)); |
| 197 | f->tail = (f->tail + bytes) % f->nitems; |
| 198 | f->cursize += bytes; |
| 199 | } |
| 200 | |
| 201 | always_inline u8 * |
| 202 | svm_fifo_head (svm_fifo_t * f) |
| 203 | { |
| 204 | return (f->data + f->head); |
| 205 | } |
| 206 | |
| 207 | always_inline u8 * |
| 208 | svm_fifo_tail (svm_fifo_t * f) |
| 209 | { |
| 210 | return (f->data + f->tail); |
| 211 | } |
| 212 | |
Florin Coras | f03a59a | 2017-06-09 21:07:32 -0700 | [diff] [blame] | 213 | always_inline u32 |
Dave Barach | 2c25a62 | 2017-06-26 11:35:07 -0400 | [diff] [blame] | 214 | ooo_segment_distance_from_tail (svm_fifo_t * f, u32 pos) |
Florin Coras | f03a59a | 2017-06-09 21:07:32 -0700 | [diff] [blame] | 215 | { |
| 216 | /* Ambiguous. Assumption is that ooo segments don't touch tail */ |
Dave Barach | 2c25a62 | 2017-06-26 11:35:07 -0400 | [diff] [blame] | 217 | if (PREDICT_FALSE (pos == f->tail && f->tail == f->head)) |
Florin Coras | f03a59a | 2017-06-09 21:07:32 -0700 | [diff] [blame] | 218 | return f->nitems; |
| 219 | |
Dave Barach | 2c25a62 | 2017-06-26 11:35:07 -0400 | [diff] [blame] | 220 | return (((f->nitems + pos) - f->tail) % f->nitems); |
| 221 | } |
| 222 | |
| 223 | always_inline u32 |
| 224 | ooo_segment_distance_to_tail (svm_fifo_t * f, u32 pos) |
| 225 | { |
| 226 | return (((f->nitems + f->tail) - pos) % f->nitems); |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 227 | } |
| 228 | |
| 229 | always_inline u32 |
| 230 | ooo_segment_offset (svm_fifo_t * f, ooo_segment_t * s) |
| 231 | { |
Dave Barach | 2c25a62 | 2017-06-26 11:35:07 -0400 | [diff] [blame] | 232 | return ooo_segment_distance_from_tail (f, s->start); |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 233 | } |
| 234 | |
| 235 | always_inline u32 |
| 236 | ooo_segment_end_offset (svm_fifo_t * f, ooo_segment_t * s) |
| 237 | { |
Dave Barach | 2c25a62 | 2017-06-26 11:35:07 -0400 | [diff] [blame] | 238 | return ooo_segment_distance_from_tail (f, s->start) + s->length; |
Florin Coras | f03a59a | 2017-06-09 21:07:32 -0700 | [diff] [blame] | 239 | } |
| 240 | |
| 241 | always_inline u32 |
| 242 | ooo_segment_length (svm_fifo_t * f, ooo_segment_t * s) |
| 243 | { |
| 244 | return s->length; |
Dave Barach | 1f75cfd | 2017-04-14 16:46:44 -0400 | [diff] [blame] | 245 | } |
| 246 | |
| 247 | always_inline ooo_segment_t * |
| 248 | ooo_segment_get_prev (svm_fifo_t * f, ooo_segment_t * s) |
| 249 | { |
| 250 | if (s->prev == OOO_SEGMENT_INVALID_INDEX) |
| 251 | return 0; |
| 252 | return pool_elt_at_index (f->ooo_segments, s->prev); |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 253 | } |
| 254 | |
Florin Coras | 3eb5062 | 2017-07-13 01:24:57 -0400 | [diff] [blame] | 255 | always_inline ooo_segment_t * |
| 256 | ooo_segment_next (svm_fifo_t * f, ooo_segment_t * s) |
| 257 | { |
| 258 | if (s->next == OOO_SEGMENT_INVALID_INDEX) |
| 259 | return 0; |
| 260 | return pool_elt_at_index (f->ooo_segments, s->next); |
| 261 | } |
| 262 | |
Dave Barach | 68b0fb0 | 2017-02-28 15:15:56 -0500 | [diff] [blame] | 263 | #endif /* __included_ssvm_fifo_h__ */ |
| 264 | |
| 265 | /* |
| 266 | * fd.io coding-style-patch-verification: ON |
| 267 | * |
| 268 | * Local Variables: |
| 269 | * eval: (c-set-style "gnu") |
| 270 | * End: |
| 271 | */ |