Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2015 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 | * buffer_funcs.h: VLIB buffer related functions/inlines |
| 17 | * |
| 18 | * Copyright (c) 2008 Eliot Dresselhaus |
| 19 | * |
| 20 | * Permission is hereby granted, free of charge, to any person obtaining |
| 21 | * a copy of this software and associated documentation files (the |
| 22 | * "Software"), to deal in the Software without restriction, including |
| 23 | * without limitation the rights to use, copy, modify, merge, publish, |
| 24 | * distribute, sublicense, and/or sell copies of the Software, and to |
| 25 | * permit persons to whom the Software is furnished to do so, subject to |
| 26 | * the following conditions: |
| 27 | * |
| 28 | * The above copyright notice and this permission notice shall be |
| 29 | * included in all copies or substantial portions of the Software. |
| 30 | * |
| 31 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
| 32 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
| 33 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| 34 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE |
| 35 | * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION |
| 36 | * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION |
| 37 | * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
| 38 | */ |
| 39 | |
| 40 | #ifndef included_vlib_buffer_funcs_h |
| 41 | #define included_vlib_buffer_funcs_h |
| 42 | |
| 43 | #include <vppinfra/hash.h> |
Dave Barach | c3a0655 | 2018-10-01 09:25:32 -0400 | [diff] [blame] | 44 | #include <vppinfra/fifo.h> |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 45 | |
| 46 | /** \file |
| 47 | vlib buffer access methods. |
| 48 | */ |
| 49 | |
| 50 | |
| 51 | /** \brief Translate buffer index into buffer pointer |
| 52 | |
| 53 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 54 | @param buffer_index - (u32) buffer index |
| 55 | @return - (vlib_buffer_t *) buffer pointer |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 56 | */ |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 57 | always_inline vlib_buffer_t * |
| 58 | vlib_get_buffer (vlib_main_t * vm, u32 buffer_index) |
| 59 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 60 | vlib_buffer_main_t *bm = &buffer_main; |
Damjan Marion | 04a7f05 | 2017-07-10 15:06:17 +0200 | [diff] [blame] | 61 | uword offset = ((uword) buffer_index) << CLIB_LOG2_CACHE_LINE_BYTES; |
| 62 | ASSERT (offset < bm->buffer_mem_size); |
| 63 | |
| 64 | return uword_to_pointer (bm->buffer_mem_start + offset, void *); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 65 | } |
| 66 | |
Damjan Marion | afe56de | 2018-05-17 12:44:00 +0200 | [diff] [blame] | 67 | /** \brief Translate array of buffer indices into buffer pointers with offset |
| 68 | |
| 69 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 70 | @param bi - (u32 *) array of buffer indices |
| 71 | @param b - (void **) array to store buffer pointers |
| 72 | @param count - (uword) number of elements |
| 73 | @param offset - (i32) offset applied to each pointer |
| 74 | */ |
| 75 | static_always_inline void |
| 76 | vlib_get_buffers_with_offset (vlib_main_t * vm, u32 * bi, void **b, int count, |
| 77 | i32 offset) |
| 78 | { |
| 79 | #ifdef CLIB_HAVE_VEC256 |
| 80 | u64x4 off = u64x4_splat (buffer_main.buffer_mem_start + offset); |
| 81 | /* if count is not const, compiler will not unroll while loop |
| 82 | se we maintain two-in-parallel variant */ |
| 83 | while (count >= 8) |
| 84 | { |
| 85 | u64x4 b0 = u32x4_extend_to_u64x4 (u32x4_load_unaligned (bi)); |
| 86 | u64x4 b1 = u32x4_extend_to_u64x4 (u32x4_load_unaligned (bi + 4)); |
| 87 | /* shift and add to get vlib_buffer_t pointer */ |
| 88 | u64x4_store_unaligned ((b0 << CLIB_LOG2_CACHE_LINE_BYTES) + off, b); |
| 89 | u64x4_store_unaligned ((b1 << CLIB_LOG2_CACHE_LINE_BYTES) + off, b + 4); |
| 90 | b += 8; |
| 91 | bi += 8; |
| 92 | count -= 8; |
| 93 | } |
| 94 | #endif |
| 95 | while (count >= 4) |
| 96 | { |
| 97 | #ifdef CLIB_HAVE_VEC256 |
| 98 | u64x4 b0 = u32x4_extend_to_u64x4 (u32x4_load_unaligned (bi)); |
| 99 | /* shift and add to get vlib_buffer_t pointer */ |
| 100 | u64x4_store_unaligned ((b0 << CLIB_LOG2_CACHE_LINE_BYTES) + off, b); |
Sirshak Das | 759226e | 2018-08-22 08:46:52 +0800 | [diff] [blame] | 101 | #elif defined (CLIB_HAVE_VEC128) |
Damjan Marion | 5df580e | 2018-07-27 01:47:57 +0200 | [diff] [blame] | 102 | u64x2 off = u64x2_splat (buffer_main.buffer_mem_start + offset); |
| 103 | u32x4 bi4 = u32x4_load_unaligned (bi); |
| 104 | u64x2 b0 = u32x4_extend_to_u64x2 ((u32x4) bi4); |
Sirshak Das | 759226e | 2018-08-22 08:46:52 +0800 | [diff] [blame] | 105 | #if defined (__aarch64__) |
| 106 | u64x2 b1 = u32x4_extend_to_u64x2_high ((u32x4) bi4); |
| 107 | #else |
Damjan Marion | 5df580e | 2018-07-27 01:47:57 +0200 | [diff] [blame] | 108 | bi4 = u32x4_shuffle (bi4, 2, 3, 0, 1); |
| 109 | u64x2 b1 = u32x4_extend_to_u64x2 ((u32x4) bi4); |
Sirshak Das | 759226e | 2018-08-22 08:46:52 +0800 | [diff] [blame] | 110 | #endif |
Damjan Marion | 5df580e | 2018-07-27 01:47:57 +0200 | [diff] [blame] | 111 | u64x2_store_unaligned ((b0 << CLIB_LOG2_CACHE_LINE_BYTES) + off, b); |
| 112 | u64x2_store_unaligned ((b1 << CLIB_LOG2_CACHE_LINE_BYTES) + off, b + 2); |
Damjan Marion | afe56de | 2018-05-17 12:44:00 +0200 | [diff] [blame] | 113 | #else |
| 114 | b[0] = ((u8 *) vlib_get_buffer (vm, bi[0])) + offset; |
| 115 | b[1] = ((u8 *) vlib_get_buffer (vm, bi[1])) + offset; |
| 116 | b[2] = ((u8 *) vlib_get_buffer (vm, bi[2])) + offset; |
| 117 | b[3] = ((u8 *) vlib_get_buffer (vm, bi[3])) + offset; |
| 118 | #endif |
| 119 | b += 4; |
| 120 | bi += 4; |
| 121 | count -= 4; |
| 122 | } |
| 123 | while (count) |
| 124 | { |
| 125 | b[0] = ((u8 *) vlib_get_buffer (vm, bi[0])) + offset; |
| 126 | b += 1; |
| 127 | bi += 1; |
| 128 | count -= 1; |
| 129 | } |
| 130 | } |
| 131 | |
| 132 | /** \brief Translate array of buffer indices into buffer pointers |
| 133 | |
| 134 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 135 | @param bi - (u32 *) array of buffer indices |
| 136 | @param b - (vlib_buffer_t **) array to store buffer pointers |
| 137 | @param count - (uword) number of elements |
| 138 | */ |
| 139 | |
| 140 | static_always_inline void |
| 141 | vlib_get_buffers (vlib_main_t * vm, u32 * bi, vlib_buffer_t ** b, int count) |
| 142 | { |
| 143 | vlib_get_buffers_with_offset (vm, bi, (void **) b, count, 0); |
| 144 | } |
| 145 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 146 | /** \brief Translate buffer pointer into buffer index |
| 147 | |
| 148 | @param vm - (vlib_main_t *) vlib main data structure pointer |
Chris Luke | d4024f5 | 2016-09-06 09:32:36 -0400 | [diff] [blame] | 149 | @param p - (void *) buffer pointer |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 150 | @return - (u32) buffer index |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 151 | */ |
Damjan Marion | 04a7f05 | 2017-07-10 15:06:17 +0200 | [diff] [blame] | 152 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 153 | always_inline u32 |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 154 | vlib_get_buffer_index (vlib_main_t * vm, void *p) |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 155 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 156 | vlib_buffer_main_t *bm = &buffer_main; |
Damjan Marion | 04a7f05 | 2017-07-10 15:06:17 +0200 | [diff] [blame] | 157 | uword offset = pointer_to_uword (p) - bm->buffer_mem_start; |
| 158 | ASSERT (pointer_to_uword (p) >= bm->buffer_mem_start); |
| 159 | ASSERT (offset < bm->buffer_mem_size); |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 160 | ASSERT ((offset % (1 << CLIB_LOG2_CACHE_LINE_BYTES)) == 0); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 161 | return offset >> CLIB_LOG2_CACHE_LINE_BYTES; |
| 162 | } |
| 163 | |
Damjan Marion | afe56de | 2018-05-17 12:44:00 +0200 | [diff] [blame] | 164 | /** \brief Translate array of buffer pointers into buffer indices with offset |
| 165 | |
| 166 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 167 | @param b - (void **) array of buffer pointers |
| 168 | @param bi - (u32 *) array to store buffer indices |
| 169 | @param count - (uword) number of elements |
| 170 | @param offset - (i32) offset applied to each pointer |
| 171 | */ |
| 172 | static_always_inline void |
| 173 | vlib_get_buffer_indices_with_offset (vlib_main_t * vm, void **b, u32 * bi, |
| 174 | uword count, i32 offset) |
| 175 | { |
| 176 | #ifdef CLIB_HAVE_VEC256 |
| 177 | u32x8 mask = { 0, 2, 4, 6, 1, 3, 5, 7 }; |
| 178 | u64x4 off4 = u64x4_splat (buffer_main.buffer_mem_start - offset); |
| 179 | |
| 180 | while (count >= 8) |
| 181 | { |
| 182 | /* load 4 pointers into 256-bit register */ |
| 183 | u64x4 v0 = u64x4_load_unaligned (b); |
| 184 | u64x4 v1 = u64x4_load_unaligned (b + 4); |
| 185 | u32x8 v2, v3; |
| 186 | |
| 187 | v0 -= off4; |
| 188 | v1 -= off4; |
| 189 | |
| 190 | v0 >>= CLIB_LOG2_CACHE_LINE_BYTES; |
| 191 | v1 >>= CLIB_LOG2_CACHE_LINE_BYTES; |
| 192 | |
| 193 | /* permute 256-bit register so lower u32s of each buffer index are |
| 194 | * placed into lower 128-bits */ |
| 195 | v2 = u32x8_permute ((u32x8) v0, mask); |
| 196 | v3 = u32x8_permute ((u32x8) v1, mask); |
| 197 | |
| 198 | /* extract lower 128-bits and save them to the array of buffer indices */ |
| 199 | u32x4_store_unaligned (u32x8_extract_lo (v2), bi); |
| 200 | u32x4_store_unaligned (u32x8_extract_lo (v3), bi + 4); |
| 201 | bi += 8; |
| 202 | b += 8; |
| 203 | count -= 8; |
| 204 | } |
| 205 | #endif |
| 206 | while (count >= 4) |
| 207 | { |
| 208 | /* equivalent non-nector implementation */ |
| 209 | bi[0] = vlib_get_buffer_index (vm, ((u8 *) b[0]) + offset); |
| 210 | bi[1] = vlib_get_buffer_index (vm, ((u8 *) b[1]) + offset); |
| 211 | bi[2] = vlib_get_buffer_index (vm, ((u8 *) b[2]) + offset); |
| 212 | bi[3] = vlib_get_buffer_index (vm, ((u8 *) b[3]) + offset); |
| 213 | bi += 4; |
| 214 | b += 4; |
| 215 | count -= 4; |
| 216 | } |
| 217 | while (count) |
| 218 | { |
Zhiyong Yang | 462072a | 2018-05-30 22:12:57 -0400 | [diff] [blame] | 219 | bi[0] = vlib_get_buffer_index (vm, ((u8 *) b[0]) + offset); |
Damjan Marion | afe56de | 2018-05-17 12:44:00 +0200 | [diff] [blame] | 220 | bi += 1; |
| 221 | b += 1; |
| 222 | count -= 1; |
| 223 | } |
| 224 | } |
| 225 | |
| 226 | /** \brief Translate array of buffer pointers into buffer indices |
| 227 | |
| 228 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 229 | @param b - (vlib_buffer_t **) array of buffer pointers |
| 230 | @param bi - (u32 *) array to store buffer indices |
| 231 | @param count - (uword) number of elements |
| 232 | */ |
| 233 | static_always_inline void |
| 234 | vlib_get_buffer_indices (vlib_main_t * vm, vlib_buffer_t ** b, u32 * bi, |
| 235 | uword count) |
| 236 | { |
| 237 | vlib_get_buffer_indices_with_offset (vm, (void **) b, bi, count, 0); |
| 238 | } |
| 239 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 240 | /** \brief Get next buffer in buffer linklist, or zero for end of list. |
| 241 | |
| 242 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 243 | @param b - (void *) buffer pointer |
| 244 | @return - (vlib_buffer_t *) next buffer, or NULL |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 245 | */ |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 246 | always_inline vlib_buffer_t * |
| 247 | vlib_get_next_buffer (vlib_main_t * vm, vlib_buffer_t * b) |
| 248 | { |
| 249 | return (b->flags & VLIB_BUFFER_NEXT_PRESENT |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 250 | ? vlib_get_buffer (vm, b->next_buffer) : 0); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 251 | } |
| 252 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 253 | uword vlib_buffer_length_in_chain_slow_path (vlib_main_t * vm, |
| 254 | vlib_buffer_t * b_first); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 255 | |
| 256 | /** \brief Get length in bytes of the buffer chain |
| 257 | |
| 258 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 259 | @param b - (void *) buffer pointer |
| 260 | @return - (uword) length of buffer chain |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 261 | */ |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 262 | always_inline uword |
| 263 | vlib_buffer_length_in_chain (vlib_main_t * vm, vlib_buffer_t * b) |
| 264 | { |
Damjan Marion | 072401e | 2017-07-13 18:53:27 +0200 | [diff] [blame] | 265 | uword len = b->current_length; |
| 266 | |
| 267 | if (PREDICT_TRUE ((b->flags & VLIB_BUFFER_NEXT_PRESENT) == 0)) |
| 268 | return len; |
| 269 | |
| 270 | if (PREDICT_TRUE (b->flags & VLIB_BUFFER_TOTAL_LENGTH_VALID)) |
| 271 | return len + b->total_length_not_including_first_buffer; |
| 272 | |
| 273 | return vlib_buffer_length_in_chain_slow_path (vm, b); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 274 | } |
| 275 | |
| 276 | /** \brief Get length in bytes of the buffer index buffer chain |
| 277 | |
| 278 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 279 | @param bi - (u32) buffer index |
| 280 | @return - (uword) length of buffer chain |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 281 | */ |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 282 | always_inline uword |
| 283 | vlib_buffer_index_length_in_chain (vlib_main_t * vm, u32 bi) |
| 284 | { |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 285 | vlib_buffer_t *b = vlib_get_buffer (vm, bi); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 286 | return vlib_buffer_length_in_chain (vm, b); |
| 287 | } |
| 288 | |
| 289 | /** \brief Copy buffer contents to memory |
| 290 | |
| 291 | @param vm - (vlib_main_t *) vlib main data structure pointer |
Chris Luke | d4024f5 | 2016-09-06 09:32:36 -0400 | [diff] [blame] | 292 | @param buffer_index - (u32) buffer index |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 293 | @param contents - (u8 *) memory, <strong>must be large enough</strong> |
| 294 | @return - (uword) length of buffer chain |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 295 | */ |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 296 | always_inline uword |
| 297 | vlib_buffer_contents (vlib_main_t * vm, u32 buffer_index, u8 * contents) |
| 298 | { |
| 299 | uword content_len = 0; |
| 300 | uword l; |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 301 | vlib_buffer_t *b; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 302 | |
| 303 | while (1) |
| 304 | { |
| 305 | b = vlib_get_buffer (vm, buffer_index); |
| 306 | l = b->current_length; |
Dave Barach | 178cf49 | 2018-11-13 16:34:13 -0500 | [diff] [blame] | 307 | clib_memcpy_fast (contents + content_len, b->data + b->current_data, l); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 308 | content_len += l; |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 309 | if (!(b->flags & VLIB_BUFFER_NEXT_PRESENT)) |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 310 | break; |
| 311 | buffer_index = b->next_buffer; |
| 312 | } |
| 313 | |
| 314 | return content_len; |
| 315 | } |
| 316 | |
Damjan Marion | 8f49936 | 2018-10-22 13:07:02 +0200 | [diff] [blame] | 317 | always_inline uword |
| 318 | vlib_buffer_get_pa (vlib_main_t * vm, vlib_buffer_t * b) |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 319 | { |
Damjan Marion | 68b4da6 | 2018-09-30 18:26:20 +0200 | [diff] [blame] | 320 | return vlib_physmem_get_pa (vm, b->data); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 321 | } |
| 322 | |
Damjan Marion | 8f49936 | 2018-10-22 13:07:02 +0200 | [diff] [blame] | 323 | always_inline uword |
| 324 | vlib_buffer_get_current_pa (vlib_main_t * vm, vlib_buffer_t * b) |
| 325 | { |
| 326 | return vlib_buffer_get_pa (vm, b) + b->current_data; |
| 327 | } |
| 328 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 329 | /** \brief Prefetch buffer metadata by buffer index |
| 330 | The first 64 bytes of buffer contains most header information |
| 331 | |
| 332 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 333 | @param bi - (u32) buffer index |
| 334 | @param type - LOAD, STORE. In most cases, STORE is the right answer |
| 335 | */ |
| 336 | /* Prefetch buffer header given index. */ |
| 337 | #define vlib_prefetch_buffer_with_index(vm,bi,type) \ |
| 338 | do { \ |
| 339 | vlib_buffer_t * _b = vlib_get_buffer (vm, bi); \ |
| 340 | vlib_prefetch_buffer_header (_b, type); \ |
| 341 | } while (0) |
| 342 | |
| 343 | #if 0 |
| 344 | /* Iterate over known allocated vlib bufs. You probably do not want |
| 345 | * to do this! |
| 346 | @param vm the vlib_main_t |
| 347 | @param bi found allocated buffer index |
| 348 | @param body operation to perform on buffer index |
| 349 | function executes body for each allocated buffer index |
| 350 | */ |
| 351 | #define vlib_buffer_foreach_allocated(vm,bi,body) \ |
| 352 | do { \ |
| 353 | vlib_main_t * _vmain = (vm); \ |
| 354 | vlib_buffer_main_t * _bmain = &_vmain->buffer_main; \ |
| 355 | hash_pair_t * _vbpair; \ |
| 356 | hash_foreach_pair(_vbpair, _bmain->buffer_known_hash, ({ \ |
| 357 | if (VLIB_BUFFER_KNOWN_ALLOCATED == _vbpair->value[0]) { \ |
| 358 | (bi) = _vbpair->key; \ |
| 359 | body; \ |
| 360 | } \ |
| 361 | })); \ |
| 362 | } while (0) |
| 363 | #endif |
| 364 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 365 | typedef enum |
| 366 | { |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 367 | /* Index is unknown. */ |
| 368 | VLIB_BUFFER_UNKNOWN, |
| 369 | |
| 370 | /* Index is known and free/allocated. */ |
| 371 | VLIB_BUFFER_KNOWN_FREE, |
| 372 | VLIB_BUFFER_KNOWN_ALLOCATED, |
| 373 | } vlib_buffer_known_state_t; |
| 374 | |
Damjan Marion | c8a26c6 | 2017-11-24 20:15:23 +0100 | [diff] [blame] | 375 | void vlib_buffer_validate_alloc_free (vlib_main_t * vm, u32 * buffers, |
| 376 | uword n_buffers, |
| 377 | vlib_buffer_known_state_t |
| 378 | expected_state); |
| 379 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 380 | always_inline vlib_buffer_known_state_t |
Steven | 899a84b | 2018-01-29 20:09:09 -0800 | [diff] [blame] | 381 | vlib_buffer_is_known (u32 buffer_index) |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 382 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 383 | vlib_buffer_main_t *bm = &buffer_main; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 384 | |
Damjan Marion | 6b0f589 | 2017-07-27 04:01:24 -0400 | [diff] [blame] | 385 | clib_spinlock_lock (&bm->buffer_known_hash_lockp); |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 386 | uword *p = hash_get (bm->buffer_known_hash, buffer_index); |
Damjan Marion | 6b0f589 | 2017-07-27 04:01:24 -0400 | [diff] [blame] | 387 | clib_spinlock_unlock (&bm->buffer_known_hash_lockp); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 388 | return p ? p[0] : VLIB_BUFFER_UNKNOWN; |
| 389 | } |
| 390 | |
| 391 | always_inline void |
Steven | 899a84b | 2018-01-29 20:09:09 -0800 | [diff] [blame] | 392 | vlib_buffer_set_known_state (u32 buffer_index, |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 393 | vlib_buffer_known_state_t state) |
| 394 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 395 | vlib_buffer_main_t *bm = &buffer_main; |
Steven | 899a84b | 2018-01-29 20:09:09 -0800 | [diff] [blame] | 396 | |
Damjan Marion | 6b0f589 | 2017-07-27 04:01:24 -0400 | [diff] [blame] | 397 | clib_spinlock_lock (&bm->buffer_known_hash_lockp); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 398 | hash_set (bm->buffer_known_hash, buffer_index, state); |
Damjan Marion | 6b0f589 | 2017-07-27 04:01:24 -0400 | [diff] [blame] | 399 | clib_spinlock_unlock (&bm->buffer_known_hash_lockp); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 400 | } |
| 401 | |
| 402 | /* Validates sanity of a single buffer. |
| 403 | Returns format'ed vector with error message if any. */ |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 404 | u8 *vlib_validate_buffer (vlib_main_t * vm, u32 buffer_index, |
| 405 | uword follow_chain); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 406 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 407 | always_inline u32 |
| 408 | vlib_buffer_round_size (u32 size) |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 409 | { |
| 410 | return round_pow2 (size, sizeof (vlib_buffer_t)); |
| 411 | } |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 412 | |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 413 | always_inline vlib_buffer_free_list_index_t |
Damjan Marion | 072401e | 2017-07-13 18:53:27 +0200 | [diff] [blame] | 414 | vlib_buffer_get_free_list_index (vlib_buffer_t * b) |
| 415 | { |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 416 | if (PREDICT_FALSE (b->flags & VLIB_BUFFER_NON_DEFAULT_FREELIST)) |
| 417 | return b->free_list_index; |
| 418 | |
| 419 | return 0; |
Damjan Marion | 072401e | 2017-07-13 18:53:27 +0200 | [diff] [blame] | 420 | } |
| 421 | |
| 422 | always_inline void |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 423 | vlib_buffer_set_free_list_index (vlib_buffer_t * b, |
| 424 | vlib_buffer_free_list_index_t index) |
Damjan Marion | 072401e | 2017-07-13 18:53:27 +0200 | [diff] [blame] | 425 | { |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 426 | if (PREDICT_FALSE (index)) |
| 427 | { |
| 428 | b->flags |= VLIB_BUFFER_NON_DEFAULT_FREELIST; |
| 429 | b->free_list_index = index; |
| 430 | } |
| 431 | else |
| 432 | b->flags &= ~VLIB_BUFFER_NON_DEFAULT_FREELIST; |
Damjan Marion | 072401e | 2017-07-13 18:53:27 +0200 | [diff] [blame] | 433 | } |
| 434 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 435 | /** \brief Allocate buffers from specific freelist into supplied array |
| 436 | |
| 437 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 438 | @param buffers - (u32 * ) buffer index array |
| 439 | @param n_buffers - (u32) number of buffers requested |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 440 | @return - (u32) number of buffers actually allocated, may be |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 441 | less than the number requested or zero |
| 442 | */ |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 443 | always_inline u32 |
| 444 | vlib_buffer_alloc_from_free_list (vlib_main_t * vm, |
| 445 | u32 * buffers, |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 446 | u32 n_buffers, |
| 447 | vlib_buffer_free_list_index_t index) |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 448 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 449 | vlib_buffer_main_t *bm = &buffer_main; |
Damjan Marion | c8a26c6 | 2017-11-24 20:15:23 +0100 | [diff] [blame] | 450 | vlib_buffer_free_list_t *fl; |
| 451 | u32 *src; |
| 452 | uword len; |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 453 | |
Damjan Marion | c8a26c6 | 2017-11-24 20:15:23 +0100 | [diff] [blame] | 454 | ASSERT (bm->cb.vlib_buffer_fill_free_list_cb); |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 455 | |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 456 | fl = pool_elt_at_index (vm->buffer_free_list_pool, index); |
Damjan Marion | c8a26c6 | 2017-11-24 20:15:23 +0100 | [diff] [blame] | 457 | |
| 458 | len = vec_len (fl->buffers); |
| 459 | |
| 460 | if (PREDICT_FALSE (len < n_buffers)) |
| 461 | { |
| 462 | bm->cb.vlib_buffer_fill_free_list_cb (vm, fl, n_buffers); |
Damjan Marion | c22fcba | 2018-03-06 18:46:54 +0100 | [diff] [blame] | 463 | if (PREDICT_FALSE ((len = vec_len (fl->buffers)) == 0)) |
| 464 | return 0; |
Damjan Marion | c8a26c6 | 2017-11-24 20:15:23 +0100 | [diff] [blame] | 465 | |
| 466 | /* even if fill free list didn't manage to refill free list |
| 467 | we should give what we have */ |
| 468 | n_buffers = clib_min (len, n_buffers); |
| 469 | |
| 470 | /* following code is intentionaly duplicated to allow compiler |
| 471 | to optimize fast path when n_buffers is constant value */ |
| 472 | src = fl->buffers + len - n_buffers; |
Dave Barach | 178cf49 | 2018-11-13 16:34:13 -0500 | [diff] [blame] | 473 | clib_memcpy_fast (buffers, src, n_buffers * sizeof (u32)); |
Damjan Marion | c8a26c6 | 2017-11-24 20:15:23 +0100 | [diff] [blame] | 474 | _vec_len (fl->buffers) -= n_buffers; |
| 475 | |
| 476 | /* Verify that buffers are known free. */ |
| 477 | vlib_buffer_validate_alloc_free (vm, buffers, n_buffers, |
| 478 | VLIB_BUFFER_KNOWN_FREE); |
| 479 | |
| 480 | return n_buffers; |
| 481 | } |
| 482 | |
| 483 | src = fl->buffers + len - n_buffers; |
Dave Barach | 178cf49 | 2018-11-13 16:34:13 -0500 | [diff] [blame] | 484 | clib_memcpy_fast (buffers, src, n_buffers * sizeof (u32)); |
Damjan Marion | c8a26c6 | 2017-11-24 20:15:23 +0100 | [diff] [blame] | 485 | _vec_len (fl->buffers) -= n_buffers; |
| 486 | |
| 487 | /* Verify that buffers are known free. */ |
| 488 | vlib_buffer_validate_alloc_free (vm, buffers, n_buffers, |
| 489 | VLIB_BUFFER_KNOWN_FREE); |
| 490 | |
| 491 | return n_buffers; |
| 492 | } |
| 493 | |
| 494 | /** \brief Allocate buffers into supplied array |
| 495 | |
| 496 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 497 | @param buffers - (u32 * ) buffer index array |
| 498 | @param n_buffers - (u32) number of buffers requested |
| 499 | @return - (u32) number of buffers actually allocated, may be |
| 500 | less than the number requested or zero |
| 501 | */ |
| 502 | always_inline u32 |
| 503 | vlib_buffer_alloc (vlib_main_t * vm, u32 * buffers, u32 n_buffers) |
| 504 | { |
| 505 | return vlib_buffer_alloc_from_free_list (vm, buffers, n_buffers, |
| 506 | VLIB_BUFFER_DEFAULT_FREE_LIST_INDEX); |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 507 | } |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 508 | |
Damjan Marion | c58408c | 2018-01-18 14:54:04 +0100 | [diff] [blame] | 509 | /** \brief Allocate buffers into ring |
| 510 | |
| 511 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 512 | @param buffers - (u32 * ) buffer index ring |
| 513 | @param start - (u32) first slot in the ring |
| 514 | @param ring_size - (u32) ring size |
| 515 | @param n_buffers - (u32) number of buffers requested |
| 516 | @return - (u32) number of buffers actually allocated, may be |
| 517 | less than the number requested or zero |
| 518 | */ |
| 519 | always_inline u32 |
| 520 | vlib_buffer_alloc_to_ring (vlib_main_t * vm, u32 * ring, u32 start, |
| 521 | u32 ring_size, u32 n_buffers) |
| 522 | { |
| 523 | u32 n_alloc; |
| 524 | |
| 525 | ASSERT (n_buffers <= ring_size); |
| 526 | |
| 527 | if (PREDICT_TRUE (start + n_buffers <= ring_size)) |
| 528 | return vlib_buffer_alloc (vm, ring + start, n_buffers); |
| 529 | |
| 530 | n_alloc = vlib_buffer_alloc (vm, ring + start, ring_size - start); |
| 531 | |
| 532 | if (PREDICT_TRUE (n_alloc == ring_size - start)) |
| 533 | n_alloc += vlib_buffer_alloc (vm, ring, n_buffers - n_alloc); |
| 534 | |
| 535 | return n_alloc; |
| 536 | } |
| 537 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 538 | /** \brief Free buffers |
| 539 | Frees the entire buffer chain for each buffer |
| 540 | |
| 541 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 542 | @param buffers - (u32 * ) buffer index array |
| 543 | @param n_buffers - (u32) number of buffers to free |
| 544 | |
| 545 | */ |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 546 | always_inline void |
| 547 | vlib_buffer_free (vlib_main_t * vm, |
| 548 | /* pointer to first buffer */ |
| 549 | u32 * buffers, |
| 550 | /* number of buffers to free */ |
| 551 | u32 n_buffers) |
| 552 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 553 | vlib_buffer_main_t *bm = &buffer_main; |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 554 | |
| 555 | ASSERT (bm->cb.vlib_buffer_free_cb); |
| 556 | |
| 557 | return bm->cb.vlib_buffer_free_cb (vm, buffers, n_buffers); |
| 558 | } |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 559 | |
| 560 | /** \brief Free buffers, does not free the buffer chain for each buffer |
| 561 | |
| 562 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 563 | @param buffers - (u32 * ) buffer index array |
| 564 | @param n_buffers - (u32) number of buffers to free |
| 565 | |
| 566 | */ |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 567 | always_inline void |
| 568 | vlib_buffer_free_no_next (vlib_main_t * vm, |
| 569 | /* pointer to first buffer */ |
| 570 | u32 * buffers, |
| 571 | /* number of buffers to free */ |
| 572 | u32 n_buffers) |
| 573 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 574 | vlib_buffer_main_t *bm = &buffer_main; |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 575 | |
| 576 | ASSERT (bm->cb.vlib_buffer_free_no_next_cb); |
| 577 | |
| 578 | return bm->cb.vlib_buffer_free_no_next_cb (vm, buffers, n_buffers); |
| 579 | } |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 580 | |
| 581 | /** \brief Free one buffer |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 582 | Shorthand to free a single buffer chain. |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 583 | |
| 584 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 585 | @param buffer_index - (u32) buffer index to free |
| 586 | */ |
| 587 | always_inline void |
| 588 | vlib_buffer_free_one (vlib_main_t * vm, u32 buffer_index) |
| 589 | { |
| 590 | vlib_buffer_free (vm, &buffer_index, /* n_buffers */ 1); |
| 591 | } |
| 592 | |
Damjan Marion | a373149 | 2018-02-25 22:50:39 +0100 | [diff] [blame] | 593 | /** \brief Free buffers from ring |
| 594 | |
| 595 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 596 | @param buffers - (u32 * ) buffer index ring |
| 597 | @param start - (u32) first slot in the ring |
| 598 | @param ring_size - (u32) ring size |
| 599 | @param n_buffers - (u32) number of buffers |
| 600 | */ |
| 601 | always_inline void |
| 602 | vlib_buffer_free_from_ring (vlib_main_t * vm, u32 * ring, u32 start, |
| 603 | u32 ring_size, u32 n_buffers) |
| 604 | { |
| 605 | ASSERT (n_buffers <= ring_size); |
| 606 | |
| 607 | if (PREDICT_TRUE (start + n_buffers <= ring_size)) |
| 608 | { |
| 609 | vlib_buffer_free (vm, ring + start, n_buffers); |
| 610 | } |
| 611 | else |
| 612 | { |
| 613 | vlib_buffer_free (vm, ring + start, ring_size - start); |
| 614 | vlib_buffer_free (vm, ring, n_buffers - (ring_size - start)); |
| 615 | } |
| 616 | } |
| 617 | |
Damjan Marion | cef1db9 | 2018-03-28 18:27:38 +0200 | [diff] [blame] | 618 | /** \brief Free buffers from ring without freeing tail buffers |
| 619 | |
| 620 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 621 | @param buffers - (u32 * ) buffer index ring |
| 622 | @param start - (u32) first slot in the ring |
| 623 | @param ring_size - (u32) ring size |
| 624 | @param n_buffers - (u32) number of buffers |
| 625 | */ |
| 626 | always_inline void |
| 627 | vlib_buffer_free_from_ring_no_next (vlib_main_t * vm, u32 * ring, u32 start, |
| 628 | u32 ring_size, u32 n_buffers) |
| 629 | { |
| 630 | ASSERT (n_buffers <= ring_size); |
| 631 | |
| 632 | if (PREDICT_TRUE (start + n_buffers <= ring_size)) |
| 633 | { |
Damjan Marion | 4a97393 | 2018-06-09 19:29:16 +0200 | [diff] [blame] | 634 | vlib_buffer_free_no_next (vm, ring + start, n_buffers); |
Damjan Marion | cef1db9 | 2018-03-28 18:27:38 +0200 | [diff] [blame] | 635 | } |
| 636 | else |
| 637 | { |
| 638 | vlib_buffer_free_no_next (vm, ring + start, ring_size - start); |
| 639 | vlib_buffer_free_no_next (vm, ring, n_buffers - (ring_size - start)); |
| 640 | } |
| 641 | } |
Damjan Marion | a373149 | 2018-02-25 22:50:39 +0100 | [diff] [blame] | 642 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 643 | /* Add/delete buffer free lists. */ |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 644 | vlib_buffer_free_list_index_t vlib_buffer_create_free_list (vlib_main_t * vm, |
| 645 | u32 n_data_bytes, |
| 646 | char *fmt, ...); |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 647 | always_inline void |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 648 | vlib_buffer_delete_free_list (vlib_main_t * vm, |
| 649 | vlib_buffer_free_list_index_t free_list_index) |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 650 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 651 | vlib_buffer_main_t *bm = &buffer_main; |
Damjan Marion | 878c609 | 2017-01-04 13:19:27 +0100 | [diff] [blame] | 652 | |
| 653 | ASSERT (bm->cb.vlib_buffer_delete_free_list_cb); |
| 654 | |
| 655 | bm->cb.vlib_buffer_delete_free_list_cb (vm, free_list_index); |
| 656 | } |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 657 | |
Damjan Marion | 8a6a3b2 | 2017-01-17 14:12:42 +0100 | [diff] [blame] | 658 | /* Make sure we have at least given number of unaligned buffers. */ |
| 659 | void vlib_buffer_free_list_fill_unaligned (vlib_main_t * vm, |
| 660 | vlib_buffer_free_list_t * |
| 661 | free_list, |
| 662 | uword n_unaligned_buffers); |
| 663 | |
Damjan Marion | 8a6a3b2 | 2017-01-17 14:12:42 +0100 | [diff] [blame] | 664 | always_inline vlib_buffer_free_list_t * |
| 665 | vlib_buffer_get_buffer_free_list (vlib_main_t * vm, vlib_buffer_t * b, |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 666 | vlib_buffer_free_list_index_t * index) |
Damjan Marion | 8a6a3b2 | 2017-01-17 14:12:42 +0100 | [diff] [blame] | 667 | { |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 668 | vlib_buffer_free_list_index_t i; |
Damjan Marion | 8a6a3b2 | 2017-01-17 14:12:42 +0100 | [diff] [blame] | 669 | |
Damjan Marion | 072401e | 2017-07-13 18:53:27 +0200 | [diff] [blame] | 670 | *index = i = vlib_buffer_get_free_list_index (b); |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 671 | return pool_elt_at_index (vm->buffer_free_list_pool, i); |
Damjan Marion | 8a6a3b2 | 2017-01-17 14:12:42 +0100 | [diff] [blame] | 672 | } |
| 673 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 674 | always_inline vlib_buffer_free_list_t * |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 675 | vlib_buffer_get_free_list (vlib_main_t * vm, |
| 676 | vlib_buffer_free_list_index_t free_list_index) |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 677 | { |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 678 | vlib_buffer_free_list_t *f; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 679 | |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 680 | f = pool_elt_at_index (vm->buffer_free_list_pool, free_list_index); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 681 | |
| 682 | /* Sanity: indices must match. */ |
| 683 | ASSERT (f->index == free_list_index); |
| 684 | |
| 685 | return f; |
| 686 | } |
| 687 | |
| 688 | always_inline u32 |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 689 | vlib_buffer_free_list_buffer_size (vlib_main_t * vm, |
| 690 | vlib_buffer_free_list_index_t index) |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 691 | { |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 692 | vlib_buffer_free_list_t *f = vlib_buffer_get_free_list (vm, index); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 693 | return f->n_data_bytes; |
| 694 | } |
| 695 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 696 | void vlib_aligned_memcpy (void *_dst, void *_src, int n_bytes); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 697 | |
| 698 | /* Reasonably fast buffer copy routine. */ |
| 699 | always_inline void |
| 700 | vlib_copy_buffers (u32 * dst, u32 * src, u32 n) |
| 701 | { |
| 702 | while (n >= 4) |
| 703 | { |
| 704 | dst[0] = src[0]; |
| 705 | dst[1] = src[1]; |
| 706 | dst[2] = src[2]; |
| 707 | dst[3] = src[3]; |
| 708 | dst += 4; |
| 709 | src += 4; |
| 710 | n -= 4; |
| 711 | } |
| 712 | while (n > 0) |
| 713 | { |
| 714 | dst[0] = src[0]; |
| 715 | dst += 1; |
| 716 | src += 1; |
| 717 | n -= 1; |
| 718 | } |
| 719 | } |
| 720 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 721 | /* Append given data to end of buffer, possibly allocating new buffers. */ |
| 722 | u32 vlib_buffer_add_data (vlib_main_t * vm, |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 723 | vlib_buffer_free_list_index_t free_list_index, |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 724 | u32 buffer_index, void *data, u32 n_data_bytes); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 725 | |
Damjan Marion | 05ab8cb | 2016-11-03 20:16:04 +0100 | [diff] [blame] | 726 | /* duplicate all buffers in chain */ |
| 727 | always_inline vlib_buffer_t * |
| 728 | vlib_buffer_copy (vlib_main_t * vm, vlib_buffer_t * b) |
| 729 | { |
| 730 | vlib_buffer_t *s, *d, *fd; |
| 731 | uword n_alloc, n_buffers = 1; |
Damjan Marion | 6765549 | 2016-11-15 12:50:28 +0100 | [diff] [blame] | 732 | u32 flag_mask = VLIB_BUFFER_NEXT_PRESENT | VLIB_BUFFER_TOTAL_LENGTH_VALID; |
Damjan Marion | 05ab8cb | 2016-11-03 20:16:04 +0100 | [diff] [blame] | 733 | int i; |
| 734 | |
| 735 | s = b; |
| 736 | while (s->flags & VLIB_BUFFER_NEXT_PRESENT) |
| 737 | { |
| 738 | n_buffers++; |
| 739 | s = vlib_get_buffer (vm, s->next_buffer); |
| 740 | } |
Neale Ranns | 9d676af | 2017-03-15 01:28:31 -0700 | [diff] [blame] | 741 | u32 new_buffers[n_buffers]; |
Damjan Marion | 05ab8cb | 2016-11-03 20:16:04 +0100 | [diff] [blame] | 742 | |
Damjan Marion | 05ab8cb | 2016-11-03 20:16:04 +0100 | [diff] [blame] | 743 | n_alloc = vlib_buffer_alloc (vm, new_buffers, n_buffers); |
Dave Barach | 26cd8c1 | 2017-02-23 17:11:26 -0500 | [diff] [blame] | 744 | |
| 745 | /* No guarantee that we'll get all the buffers we asked for */ |
| 746 | if (PREDICT_FALSE (n_alloc < n_buffers)) |
| 747 | { |
| 748 | if (n_alloc > 0) |
| 749 | vlib_buffer_free (vm, new_buffers, n_alloc); |
Dave Barach | 26cd8c1 | 2017-02-23 17:11:26 -0500 | [diff] [blame] | 750 | return 0; |
| 751 | } |
Damjan Marion | 05ab8cb | 2016-11-03 20:16:04 +0100 | [diff] [blame] | 752 | |
| 753 | /* 1st segment */ |
| 754 | s = b; |
| 755 | fd = d = vlib_get_buffer (vm, new_buffers[0]); |
Damjan Marion | 05ab8cb | 2016-11-03 20:16:04 +0100 | [diff] [blame] | 756 | d->current_data = s->current_data; |
| 757 | d->current_length = s->current_length; |
Damjan Marion | 6765549 | 2016-11-15 12:50:28 +0100 | [diff] [blame] | 758 | d->flags = s->flags & flag_mask; |
Damjan Marion | 05ab8cb | 2016-11-03 20:16:04 +0100 | [diff] [blame] | 759 | d->total_length_not_including_first_buffer = |
| 760 | s->total_length_not_including_first_buffer; |
Dave Barach | 178cf49 | 2018-11-13 16:34:13 -0500 | [diff] [blame] | 761 | clib_memcpy_fast (d->opaque, s->opaque, sizeof (s->opaque)); |
| 762 | clib_memcpy_fast (d->opaque2, s->opaque2, sizeof (s->opaque2)); |
| 763 | clib_memcpy_fast (vlib_buffer_get_current (d), |
| 764 | vlib_buffer_get_current (s), s->current_length); |
Damjan Marion | 05ab8cb | 2016-11-03 20:16:04 +0100 | [diff] [blame] | 765 | |
| 766 | /* next segments */ |
| 767 | for (i = 1; i < n_buffers; i++) |
| 768 | { |
| 769 | /* previous */ |
| 770 | d->next_buffer = new_buffers[i]; |
| 771 | /* current */ |
| 772 | s = vlib_get_buffer (vm, s->next_buffer); |
| 773 | d = vlib_get_buffer (vm, new_buffers[i]); |
| 774 | d->current_data = s->current_data; |
| 775 | d->current_length = s->current_length; |
Dave Barach | 178cf49 | 2018-11-13 16:34:13 -0500 | [diff] [blame] | 776 | clib_memcpy_fast (vlib_buffer_get_current (d), |
| 777 | vlib_buffer_get_current (s), s->current_length); |
Damjan Marion | 6765549 | 2016-11-15 12:50:28 +0100 | [diff] [blame] | 778 | d->flags = s->flags & flag_mask; |
Damjan Marion | 05ab8cb | 2016-11-03 20:16:04 +0100 | [diff] [blame] | 779 | } |
| 780 | |
| 781 | return fd; |
| 782 | } |
| 783 | |
Neale Ranns | 8f36e4a | 2018-01-11 09:02:01 -0800 | [diff] [blame] | 784 | /** \brief Create a maximum of 256 clones of buffer and store them |
| 785 | in the supplied array |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 786 | |
| 787 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 788 | @param src_buffer - (u32) source buffer index |
| 789 | @param buffers - (u32 * ) buffer index array |
Neale Ranns | 8f36e4a | 2018-01-11 09:02:01 -0800 | [diff] [blame] | 790 | @param n_buffers - (u16) number of buffer clones requested (<=256) |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 791 | @param head_end_offset - (u16) offset relative to current position |
| 792 | where packet head ends |
Neale Ranns | 8f36e4a | 2018-01-11 09:02:01 -0800 | [diff] [blame] | 793 | @return - (u16) number of buffers actually cloned, may be |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 794 | less than the number requested or zero |
| 795 | */ |
Neale Ranns | 8f36e4a | 2018-01-11 09:02:01 -0800 | [diff] [blame] | 796 | always_inline u16 |
| 797 | vlib_buffer_clone_256 (vlib_main_t * vm, u32 src_buffer, u32 * buffers, |
| 798 | u16 n_buffers, u16 head_end_offset) |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 799 | { |
Neale Ranns | 8f36e4a | 2018-01-11 09:02:01 -0800 | [diff] [blame] | 800 | u16 i; |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 801 | vlib_buffer_t *s = vlib_get_buffer (vm, src_buffer); |
| 802 | |
| 803 | ASSERT (s->n_add_refs == 0); |
| 804 | ASSERT (n_buffers); |
Neale Ranns | 8f36e4a | 2018-01-11 09:02:01 -0800 | [diff] [blame] | 805 | ASSERT (n_buffers <= 256); |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 806 | |
| 807 | if (s->current_length <= head_end_offset + CLIB_CACHE_LINE_BYTES * 2) |
| 808 | { |
| 809 | buffers[0] = src_buffer; |
| 810 | for (i = 1; i < n_buffers; i++) |
| 811 | { |
| 812 | vlib_buffer_t *d; |
| 813 | d = vlib_buffer_copy (vm, s); |
| 814 | if (d == 0) |
| 815 | return i; |
| 816 | buffers[i] = vlib_get_buffer_index (vm, d); |
| 817 | |
| 818 | } |
| 819 | return n_buffers; |
| 820 | } |
| 821 | |
Neale Ranns | 8f36e4a | 2018-01-11 09:02:01 -0800 | [diff] [blame] | 822 | if (PREDICT_FALSE (n_buffers == 1)) |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 823 | { |
| 824 | buffers[0] = src_buffer; |
| 825 | return 1; |
| 826 | } |
| 827 | |
Neale Ranns | 8f36e4a | 2018-01-11 09:02:01 -0800 | [diff] [blame] | 828 | n_buffers = vlib_buffer_alloc_from_free_list (vm, buffers, n_buffers, |
| 829 | vlib_buffer_get_free_list_index |
| 830 | (s)); |
| 831 | |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 832 | for (i = 0; i < n_buffers; i++) |
| 833 | { |
| 834 | vlib_buffer_t *d = vlib_get_buffer (vm, buffers[i]); |
| 835 | d->current_data = s->current_data; |
| 836 | d->current_length = head_end_offset; |
Damjan Marion | 072401e | 2017-07-13 18:53:27 +0200 | [diff] [blame] | 837 | vlib_buffer_set_free_list_index (d, |
| 838 | vlib_buffer_get_free_list_index (s)); |
Yoann Desmouceaux | 1977a34 | 2018-05-29 13:38:44 +0200 | [diff] [blame] | 839 | |
| 840 | d->total_length_not_including_first_buffer = s->current_length - |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 841 | head_end_offset; |
Yoann Desmouceaux | 1977a34 | 2018-05-29 13:38:44 +0200 | [diff] [blame] | 842 | if (PREDICT_FALSE (s->flags & VLIB_BUFFER_NEXT_PRESENT)) |
| 843 | { |
| 844 | d->total_length_not_including_first_buffer += |
| 845 | s->total_length_not_including_first_buffer; |
| 846 | } |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 847 | d->flags = s->flags | VLIB_BUFFER_NEXT_PRESENT; |
| 848 | d->flags &= ~VLIB_BUFFER_EXT_HDR_VALID; |
Dave Barach | 178cf49 | 2018-11-13 16:34:13 -0500 | [diff] [blame] | 849 | clib_memcpy_fast (d->opaque, s->opaque, sizeof (s->opaque)); |
| 850 | clib_memcpy_fast (d->opaque2, s->opaque2, sizeof (s->opaque2)); |
| 851 | clib_memcpy_fast (vlib_buffer_get_current (d), |
| 852 | vlib_buffer_get_current (s), head_end_offset); |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 853 | d->next_buffer = src_buffer; |
| 854 | } |
| 855 | vlib_buffer_advance (s, head_end_offset); |
| 856 | s->n_add_refs = n_buffers - 1; |
| 857 | while (s->flags & VLIB_BUFFER_NEXT_PRESENT) |
| 858 | { |
| 859 | s = vlib_get_buffer (vm, s->next_buffer); |
| 860 | s->n_add_refs = n_buffers - 1; |
| 861 | } |
| 862 | |
| 863 | return n_buffers; |
| 864 | } |
| 865 | |
Neale Ranns | 8f36e4a | 2018-01-11 09:02:01 -0800 | [diff] [blame] | 866 | /** \brief Create multiple clones of buffer and store them |
| 867 | in the supplied array |
| 868 | |
| 869 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 870 | @param src_buffer - (u32) source buffer index |
| 871 | @param buffers - (u32 * ) buffer index array |
| 872 | @param n_buffers - (u16) number of buffer clones requested (<=256) |
| 873 | @param head_end_offset - (u16) offset relative to current position |
| 874 | where packet head ends |
| 875 | @return - (u16) number of buffers actually cloned, may be |
| 876 | less than the number requested or zero |
| 877 | */ |
| 878 | always_inline u16 |
| 879 | vlib_buffer_clone (vlib_main_t * vm, u32 src_buffer, u32 * buffers, |
| 880 | u16 n_buffers, u16 head_end_offset) |
| 881 | { |
| 882 | vlib_buffer_t *s = vlib_get_buffer (vm, src_buffer); |
| 883 | u16 n_cloned = 0; |
| 884 | |
| 885 | while (n_buffers > 256) |
| 886 | { |
| 887 | vlib_buffer_t *copy; |
| 888 | copy = vlib_buffer_copy (vm, s); |
| 889 | n_cloned += vlib_buffer_clone_256 (vm, |
| 890 | vlib_get_buffer_index (vm, copy), |
| 891 | (buffers + n_cloned), |
| 892 | 256, head_end_offset); |
| 893 | n_buffers -= 256; |
| 894 | } |
| 895 | n_cloned += vlib_buffer_clone_256 (vm, src_buffer, |
| 896 | buffers + n_cloned, |
| 897 | n_buffers, head_end_offset); |
| 898 | |
| 899 | return n_cloned; |
| 900 | } |
| 901 | |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 902 | /** \brief Attach cloned tail to the buffer |
| 903 | |
| 904 | @param vm - (vlib_main_t *) vlib main data structure pointer |
| 905 | @param head - (vlib_buffer_t *) head buffer |
| 906 | @param tail - (Vlib buffer_t *) tail buffer to clone and attach to head |
| 907 | */ |
| 908 | |
| 909 | always_inline void |
| 910 | vlib_buffer_attach_clone (vlib_main_t * vm, vlib_buffer_t * head, |
| 911 | vlib_buffer_t * tail) |
| 912 | { |
| 913 | ASSERT ((head->flags & VLIB_BUFFER_NEXT_PRESENT) == 0); |
Damjan Marion | 072401e | 2017-07-13 18:53:27 +0200 | [diff] [blame] | 914 | ASSERT (vlib_buffer_get_free_list_index (head) == |
| 915 | vlib_buffer_get_free_list_index (tail)); |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 916 | |
| 917 | head->flags |= VLIB_BUFFER_NEXT_PRESENT; |
| 918 | head->flags &= ~VLIB_BUFFER_TOTAL_LENGTH_VALID; |
| 919 | head->flags &= ~VLIB_BUFFER_EXT_HDR_VALID; |
| 920 | head->flags |= (tail->flags & VLIB_BUFFER_TOTAL_LENGTH_VALID); |
| 921 | head->next_buffer = vlib_get_buffer_index (vm, tail); |
| 922 | head->total_length_not_including_first_buffer = tail->current_length + |
| 923 | tail->total_length_not_including_first_buffer; |
| 924 | |
| 925 | next_segment: |
Sirshak Das | 2f6d7bb | 2018-10-03 22:53:51 +0000 | [diff] [blame] | 926 | clib_atomic_add_fetch (&tail->n_add_refs, 1); |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 927 | |
| 928 | if (tail->flags & VLIB_BUFFER_NEXT_PRESENT) |
| 929 | { |
| 930 | tail = vlib_get_buffer (vm, tail->next_buffer); |
| 931 | goto next_segment; |
| 932 | } |
| 933 | } |
| 934 | |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 935 | /* Initializes the buffer as an empty packet with no chained buffers. */ |
| 936 | always_inline void |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 937 | vlib_buffer_chain_init (vlib_buffer_t * first) |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 938 | { |
| 939 | first->total_length_not_including_first_buffer = 0; |
| 940 | first->current_length = 0; |
| 941 | first->flags &= ~VLIB_BUFFER_NEXT_PRESENT; |
| 942 | first->flags |= VLIB_BUFFER_TOTAL_LENGTH_VALID; |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 943 | } |
| 944 | |
| 945 | /* The provided next_bi buffer index is appended to the end of the packet. */ |
| 946 | always_inline vlib_buffer_t * |
Eyal Bari | b688fb1 | 2018-11-12 16:13:49 +0200 | [diff] [blame] | 947 | vlib_buffer_chain_buffer (vlib_main_t * vm, vlib_buffer_t * last, u32 next_bi) |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 948 | { |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 949 | vlib_buffer_t *next_buffer = vlib_get_buffer (vm, next_bi); |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 950 | last->next_buffer = next_bi; |
| 951 | last->flags |= VLIB_BUFFER_NEXT_PRESENT; |
| 952 | next_buffer->current_length = 0; |
| 953 | next_buffer->flags &= ~VLIB_BUFFER_NEXT_PRESENT; |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 954 | return next_buffer; |
| 955 | } |
| 956 | |
| 957 | /* Increases or decreases the packet length. |
| 958 | * It does not allocate or deallocate new buffers. |
| 959 | * Therefore, the added length must be compatible |
| 960 | * with the last buffer. */ |
| 961 | always_inline void |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 962 | vlib_buffer_chain_increase_length (vlib_buffer_t * first, |
| 963 | vlib_buffer_t * last, i32 len) |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 964 | { |
| 965 | last->current_length += len; |
| 966 | if (first != last) |
| 967 | first->total_length_not_including_first_buffer += len; |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 968 | } |
| 969 | |
| 970 | /* Copy data to the end of the packet and increases its length. |
| 971 | * It does not allocate new buffers. |
| 972 | * Returns the number of copied bytes. */ |
| 973 | always_inline u16 |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 974 | vlib_buffer_chain_append_data (vlib_main_t * vm, |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 975 | vlib_buffer_free_list_index_t free_list_index, |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 976 | vlib_buffer_t * first, |
| 977 | vlib_buffer_t * last, void *data, u16 data_len) |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 978 | { |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 979 | u32 n_buffer_bytes = |
| 980 | vlib_buffer_free_list_buffer_size (vm, free_list_index); |
| 981 | ASSERT (n_buffer_bytes >= last->current_length + last->current_data); |
| 982 | u16 len = clib_min (data_len, |
| 983 | n_buffer_bytes - last->current_length - |
| 984 | last->current_data); |
Dave Barach | 178cf49 | 2018-11-13 16:34:13 -0500 | [diff] [blame] | 985 | clib_memcpy_fast (vlib_buffer_get_current (last) + last->current_length, |
| 986 | data, len); |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 987 | vlib_buffer_chain_increase_length (first, last, len); |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 988 | return len; |
| 989 | } |
| 990 | |
| 991 | /* Copy data to the end of the packet and increases its length. |
| 992 | * Allocates additional buffers from the free list if necessary. |
| 993 | * Returns the number of copied bytes. |
| 994 | * 'last' value is modified whenever new buffers are allocated and |
| 995 | * chained and points to the last buffer in the chain. */ |
| 996 | u16 |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 997 | vlib_buffer_chain_append_data_with_alloc (vlib_main_t * vm, |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 998 | vlib_buffer_free_list_index_t |
| 999 | free_list_index, |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1000 | vlib_buffer_t * first, |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 1001 | vlib_buffer_t ** last, void *data, |
| 1002 | u16 data_len); |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1003 | void vlib_buffer_chain_validate (vlib_main_t * vm, vlib_buffer_t * first); |
Pierre Pfister | 328e99b | 2016-02-12 13:18:42 +0000 | [diff] [blame] | 1004 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1005 | format_function_t format_vlib_buffer, format_vlib_buffer_and_data, |
| 1006 | format_vlib_buffer_contents; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1007 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1008 | typedef struct |
| 1009 | { |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1010 | /* Vector of packet data. */ |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1011 | u8 *packet_data; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1012 | |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 1013 | /* Number of buffers to allocate in each call to allocator. */ |
| 1014 | u32 min_n_buffers_each_alloc; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1015 | |
| 1016 | /* Buffer free list for this template. */ |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 1017 | vlib_buffer_free_list_index_t free_list_index; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1018 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1019 | u32 *free_buffers; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1020 | } vlib_packet_template_t; |
| 1021 | |
| 1022 | void vlib_packet_template_get_packet_helper (vlib_main_t * vm, |
| 1023 | vlib_packet_template_t * t); |
| 1024 | |
| 1025 | void vlib_packet_template_init (vlib_main_t * vm, |
| 1026 | vlib_packet_template_t * t, |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1027 | void *packet_data, |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1028 | uword n_packet_data_bytes, |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 1029 | uword min_n_buffers_each_alloc, |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1030 | char *fmt, ...); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1031 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1032 | void *vlib_packet_template_get_packet (vlib_main_t * vm, |
| 1033 | vlib_packet_template_t * t, |
| 1034 | u32 * bi_result); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1035 | |
| 1036 | always_inline void |
| 1037 | vlib_packet_template_free (vlib_main_t * vm, vlib_packet_template_t * t) |
| 1038 | { |
| 1039 | vec_free (t->packet_data); |
| 1040 | } |
| 1041 | |
| 1042 | always_inline u32 |
| 1043 | unserialize_vlib_buffer_n_bytes (serialize_main_t * m) |
| 1044 | { |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1045 | serialize_stream_t *s = &m->stream; |
| 1046 | vlib_serialize_buffer_main_t *sm |
| 1047 | = uword_to_pointer (m->stream.data_function_opaque, |
| 1048 | vlib_serialize_buffer_main_t *); |
| 1049 | vlib_main_t *vm = sm->vlib_main; |
| 1050 | u32 n, *f; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1051 | |
| 1052 | n = s->n_buffer_bytes - s->current_buffer_index; |
| 1053 | if (sm->last_buffer != ~0) |
| 1054 | { |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1055 | vlib_buffer_t *b = vlib_get_buffer (vm, sm->last_buffer); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1056 | while (b->flags & VLIB_BUFFER_NEXT_PRESENT) |
| 1057 | { |
| 1058 | b = vlib_get_buffer (vm, b->next_buffer); |
| 1059 | n += b->current_length; |
| 1060 | } |
| 1061 | } |
| 1062 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1063 | /* *INDENT-OFF* */ |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1064 | clib_fifo_foreach (f, sm->rx.buffer_fifo, ({ |
| 1065 | n += vlib_buffer_index_length_in_chain (vm, f[0]); |
| 1066 | })); |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1067 | /* *INDENT-ON* */ |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1068 | |
| 1069 | return n; |
| 1070 | } |
| 1071 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1072 | /* Set a buffer quickly into "uninitialized" state. We want this to |
| 1073 | be extremely cheap and arrange for all fields that need to be |
| 1074 | initialized to be in the first 128 bits of the buffer. */ |
| 1075 | always_inline void |
Damjan Marion | bd69a5f | 2017-02-05 23:44:42 +0100 | [diff] [blame] | 1076 | vlib_buffer_init_for_free_list (vlib_buffer_t * dst, |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1077 | vlib_buffer_free_list_t * fl) |
| 1078 | { |
Damjan Marion | bd69a5f | 2017-02-05 23:44:42 +0100 | [diff] [blame] | 1079 | vlib_buffer_t *src = &fl->buffer_init_template; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1080 | |
Damjan Marion | 1901020 | 2016-03-24 17:17:47 +0100 | [diff] [blame] | 1081 | /* Make sure vlib_buffer_t is cacheline aligned and sized */ |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1082 | ASSERT (STRUCT_OFFSET_OF (vlib_buffer_t, cacheline0) == 0); |
| 1083 | ASSERT (STRUCT_OFFSET_OF (vlib_buffer_t, cacheline1) == |
| 1084 | CLIB_CACHE_LINE_BYTES); |
| 1085 | ASSERT (STRUCT_OFFSET_OF (vlib_buffer_t, cacheline2) == |
| 1086 | CLIB_CACHE_LINE_BYTES * 2); |
Damjan Marion | 1901020 | 2016-03-24 17:17:47 +0100 | [diff] [blame] | 1087 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1088 | /* Make sure buffer template is sane. */ |
Damjan Marion | 072401e | 2017-07-13 18:53:27 +0200 | [diff] [blame] | 1089 | ASSERT (fl->index == vlib_buffer_get_free_list_index (src)); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1090 | |
Dave Barach | 178cf49 | 2018-11-13 16:34:13 -0500 | [diff] [blame] | 1091 | clib_memcpy_fast (STRUCT_MARK_PTR (dst, template_start), |
| 1092 | STRUCT_MARK_PTR (src, template_start), |
| 1093 | STRUCT_OFFSET_OF (vlib_buffer_t, template_end) - |
| 1094 | STRUCT_OFFSET_OF (vlib_buffer_t, template_start)); |
Dave Barach | f869028 | 2017-03-01 11:38:02 -0500 | [diff] [blame] | 1095 | |
| 1096 | /* Not in the first 16 octets. */ |
| 1097 | dst->n_add_refs = src->n_add_refs; |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 1098 | vlib_buffer_set_free_list_index (dst, fl->index); |
Dave Barach | f869028 | 2017-03-01 11:38:02 -0500 | [diff] [blame] | 1099 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1100 | /* Make sure it really worked. */ |
Dave Barach | f869028 | 2017-03-01 11:38:02 -0500 | [diff] [blame] | 1101 | #define _(f) ASSERT (dst->f == src->f); |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1102 | _(current_data); |
| 1103 | _(current_length); |
| 1104 | _(flags); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1105 | #undef _ |
Florin Coras | b2215d6 | 2017-08-01 16:56:58 -0700 | [diff] [blame] | 1106 | /* ASSERT (dst->total_length_not_including_first_buffer == 0); */ |
| 1107 | /* total_length_not_including_first_buffer is not in the template anymore |
| 1108 | * so it may actually not zeroed for some buffers. One option is to |
| 1109 | * uncomment the line lower (comes at a cost), the other, is to just not |
| 1110 | * care */ |
| 1111 | /* dst->total_length_not_including_first_buffer = 0; */ |
Damjan Marion | c47ed03 | 2017-01-25 14:18:03 +0100 | [diff] [blame] | 1112 | ASSERT (dst->n_add_refs == 0); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1113 | } |
| 1114 | |
| 1115 | always_inline void |
Damjan Marion | 8a6a3b2 | 2017-01-17 14:12:42 +0100 | [diff] [blame] | 1116 | vlib_buffer_add_to_free_list (vlib_main_t * vm, |
| 1117 | vlib_buffer_free_list_t * f, |
| 1118 | u32 buffer_index, u8 do_init) |
| 1119 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 1120 | vlib_buffer_pool_t *bp = vlib_buffer_pool_get (f->buffer_pool_index); |
Damjan Marion | 8a6a3b2 | 2017-01-17 14:12:42 +0100 | [diff] [blame] | 1121 | vlib_buffer_t *b; |
| 1122 | b = vlib_get_buffer (vm, buffer_index); |
| 1123 | if (PREDICT_TRUE (do_init)) |
| 1124 | vlib_buffer_init_for_free_list (b, f); |
Damjan Marion | bd69a5f | 2017-02-05 23:44:42 +0100 | [diff] [blame] | 1125 | vec_add1_aligned (f->buffers, buffer_index, CLIB_CACHE_LINE_BYTES); |
Damjan Marion | 6b0f589 | 2017-07-27 04:01:24 -0400 | [diff] [blame] | 1126 | |
Damjan Marion | b6a8ed7 | 2017-08-29 00:15:35 +0200 | [diff] [blame] | 1127 | if (vec_len (f->buffers) > 4 * VLIB_FRAME_SIZE) |
Damjan Marion | 6b0f589 | 2017-07-27 04:01:24 -0400 | [diff] [blame] | 1128 | { |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 1129 | clib_spinlock_lock (&bp->lock); |
Damjan Marion | 6b0f589 | 2017-07-27 04:01:24 -0400 | [diff] [blame] | 1130 | /* keep last stored buffers, as they are more likely hot in the cache */ |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 1131 | vec_add_aligned (bp->buffers, f->buffers, VLIB_FRAME_SIZE, |
Damjan Marion | b6a8ed7 | 2017-08-29 00:15:35 +0200 | [diff] [blame] | 1132 | CLIB_CACHE_LINE_BYTES); |
Damjan Marion | 6b0f589 | 2017-07-27 04:01:24 -0400 | [diff] [blame] | 1133 | vec_delete (f->buffers, VLIB_FRAME_SIZE, 0); |
Klement Sekera | 75e974b | 2017-11-09 09:12:12 +0100 | [diff] [blame] | 1134 | f->n_alloc -= VLIB_FRAME_SIZE; |
Damjan Marion | d1274cb | 2018-03-13 21:32:17 +0100 | [diff] [blame] | 1135 | clib_spinlock_unlock (&bp->lock); |
Damjan Marion | 6b0f589 | 2017-07-27 04:01:24 -0400 | [diff] [blame] | 1136 | } |
Damjan Marion | 8a6a3b2 | 2017-01-17 14:12:42 +0100 | [diff] [blame] | 1137 | } |
| 1138 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1139 | #if CLIB_DEBUG > 0 |
Damjan Marion | 6a7acc2 | 2016-12-19 16:28:36 +0100 | [diff] [blame] | 1140 | extern u32 *vlib_buffer_state_validation_lock; |
| 1141 | extern uword *vlib_buffer_state_validation_hash; |
| 1142 | extern void *vlib_buffer_state_heap; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1143 | #endif |
| 1144 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1145 | static inline void |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1146 | vlib_validate_buffer_in_use (vlib_buffer_t * b, u32 expected) |
| 1147 | { |
| 1148 | #if CLIB_DEBUG > 0 |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1149 | uword *p; |
| 1150 | void *oldheap; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1151 | |
| 1152 | oldheap = clib_mem_set_heap (vlib_buffer_state_heap); |
| 1153 | |
Sirshak Das | 2f6d7bb | 2018-10-03 22:53:51 +0000 | [diff] [blame] | 1154 | while (clib_atomic_test_and_set (vlib_buffer_state_validation_lock)) |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1155 | ; |
| 1156 | |
| 1157 | p = hash_get (vlib_buffer_state_validation_hash, b); |
| 1158 | |
| 1159 | /* If we don't know about b, declare it to be in the expected state */ |
| 1160 | if (!p) |
| 1161 | { |
| 1162 | hash_set (vlib_buffer_state_validation_hash, b, expected); |
| 1163 | goto out; |
| 1164 | } |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1165 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1166 | if (p[0] != expected) |
| 1167 | { |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1168 | void cj_stop (void); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1169 | u32 bi; |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1170 | vlib_main_t *vm = &vlib_global_main; |
| 1171 | |
| 1172 | cj_stop (); |
| 1173 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1174 | bi = vlib_get_buffer_index (vm, b); |
| 1175 | |
| 1176 | clib_mem_set_heap (oldheap); |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1177 | clib_warning ("%.6f buffer %llx (%d): %s, not %s", |
| 1178 | vlib_time_now (vm), bi, |
| 1179 | p[0] ? "busy" : "free", expected ? "busy" : "free"); |
| 1180 | os_panic (); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1181 | } |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1182 | out: |
| 1183 | CLIB_MEMORY_BARRIER (); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1184 | *vlib_buffer_state_validation_lock = 0; |
| 1185 | clib_mem_set_heap (oldheap); |
| 1186 | #endif |
| 1187 | } |
| 1188 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1189 | static inline void |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1190 | vlib_validate_buffer_set_in_use (vlib_buffer_t * b, u32 expected) |
| 1191 | { |
| 1192 | #if CLIB_DEBUG > 0 |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1193 | void *oldheap; |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1194 | |
| 1195 | oldheap = clib_mem_set_heap (vlib_buffer_state_heap); |
| 1196 | |
Sirshak Das | 2f6d7bb | 2018-10-03 22:53:51 +0000 | [diff] [blame] | 1197 | while (clib_atomic_test_and_set (vlib_buffer_state_validation_lock)) |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1198 | ; |
| 1199 | |
| 1200 | hash_set (vlib_buffer_state_validation_hash, b, expected); |
| 1201 | |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1202 | CLIB_MEMORY_BARRIER (); |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1203 | *vlib_buffer_state_validation_lock = 0; |
| 1204 | clib_mem_set_heap (oldheap); |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1205 | #endif |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1206 | } |
| 1207 | |
Klement Sekera | 75e7d13 | 2017-09-20 08:26:30 +0200 | [diff] [blame] | 1208 | /** minimum data size of first buffer in a buffer chain */ |
| 1209 | #define VLIB_BUFFER_CHAIN_MIN_FIRST_DATA_SIZE (256) |
| 1210 | |
| 1211 | /** |
| 1212 | * @brief compress buffer chain in a way where the first buffer is at least |
| 1213 | * VLIB_BUFFER_CHAIN_MIN_FIRST_DATA_SIZE long |
| 1214 | * |
| 1215 | * @param[in] vm - vlib_main |
| 1216 | * @param[in,out] first - first buffer in chain |
| 1217 | * @param[in,out] discard_vector - vector of buffer indexes which were removed |
| 1218 | * from the chain |
| 1219 | */ |
| 1220 | always_inline void |
| 1221 | vlib_buffer_chain_compress (vlib_main_t * vm, |
| 1222 | vlib_buffer_t * first, u32 ** discard_vector) |
| 1223 | { |
| 1224 | if (first->current_length >= VLIB_BUFFER_CHAIN_MIN_FIRST_DATA_SIZE || |
| 1225 | !(first->flags & VLIB_BUFFER_NEXT_PRESENT)) |
| 1226 | { |
| 1227 | /* this is already big enough or not a chain */ |
| 1228 | return; |
| 1229 | } |
| 1230 | /* probe free list to find allocated buffer size to avoid overfill */ |
Damjan Marion | dac0352 | 2018-02-01 15:30:13 +0100 | [diff] [blame] | 1231 | vlib_buffer_free_list_index_t index; |
Klement Sekera | 75e7d13 | 2017-09-20 08:26:30 +0200 | [diff] [blame] | 1232 | vlib_buffer_free_list_t *free_list = |
| 1233 | vlib_buffer_get_buffer_free_list (vm, first, &index); |
| 1234 | |
| 1235 | u32 want_first_size = clib_min (VLIB_BUFFER_CHAIN_MIN_FIRST_DATA_SIZE, |
| 1236 | free_list->n_data_bytes - |
| 1237 | first->current_data); |
| 1238 | do |
| 1239 | { |
| 1240 | vlib_buffer_t *second = vlib_get_buffer (vm, first->next_buffer); |
| 1241 | u32 need = want_first_size - first->current_length; |
| 1242 | u32 amount_to_copy = clib_min (need, second->current_length); |
Dave Barach | 178cf49 | 2018-11-13 16:34:13 -0500 | [diff] [blame] | 1243 | clib_memcpy_fast (((u8 *) vlib_buffer_get_current (first)) + |
| 1244 | first->current_length, |
| 1245 | vlib_buffer_get_current (second), amount_to_copy); |
Klement Sekera | 75e7d13 | 2017-09-20 08:26:30 +0200 | [diff] [blame] | 1246 | first->current_length += amount_to_copy; |
| 1247 | vlib_buffer_advance (second, amount_to_copy); |
| 1248 | if (first->flags & VLIB_BUFFER_TOTAL_LENGTH_VALID) |
| 1249 | { |
| 1250 | first->total_length_not_including_first_buffer -= amount_to_copy; |
| 1251 | } |
| 1252 | if (!second->current_length) |
| 1253 | { |
| 1254 | vec_add1 (*discard_vector, first->next_buffer); |
| 1255 | if (second->flags & VLIB_BUFFER_NEXT_PRESENT) |
| 1256 | { |
| 1257 | first->next_buffer = second->next_buffer; |
| 1258 | } |
| 1259 | else |
| 1260 | { |
| 1261 | first->flags &= ~VLIB_BUFFER_NEXT_PRESENT; |
| 1262 | } |
| 1263 | second->flags &= ~VLIB_BUFFER_NEXT_PRESENT; |
| 1264 | } |
| 1265 | } |
| 1266 | while ((first->current_length < want_first_size) && |
| 1267 | (first->flags & VLIB_BUFFER_NEXT_PRESENT)); |
| 1268 | } |
| 1269 | |
Eyal Bari | d3d4241 | 2018-11-05 13:29:25 +0200 | [diff] [blame^] | 1270 | /** |
| 1271 | * @brief linearize buffer chain - the first buffer is filled, if needed, |
| 1272 | * buffers are allocated and filled, returns free space in last buffer or |
| 1273 | * negative on failure |
| 1274 | * |
| 1275 | * @param[in] vm - vlib_main |
| 1276 | * @param[in,out] first - first buffer in chain |
| 1277 | */ |
| 1278 | always_inline int |
| 1279 | vlib_buffer_chain_linearize (vlib_main_t * vm, vlib_buffer_t * first) |
| 1280 | { |
| 1281 | vlib_buffer_t *b = first; |
| 1282 | vlib_buffer_free_list_t *fl = |
| 1283 | vlib_buffer_get_free_list (vm, vlib_buffer_get_free_list_index (b)); |
| 1284 | u32 buf_len = fl->n_data_bytes; |
| 1285 | // free buffer chain starting from the second buffer |
| 1286 | int free_count = (b->flags & VLIB_BUFFER_NEXT_PRESENT) != 0; |
| 1287 | u32 chain_to_free = b->next_buffer; |
| 1288 | |
| 1289 | u32 len = vlib_buffer_length_in_chain (vm, b); |
| 1290 | u32 free_len = buf_len - b->current_data - b->current_length; |
| 1291 | int alloc_len = clib_max (len - free_len, 0); //use the free len in the first buffer |
| 1292 | int n_buffers = (alloc_len + buf_len - 1) / buf_len; |
| 1293 | u32 new_buffers[n_buffers]; |
| 1294 | |
| 1295 | u32 n_alloc = vlib_buffer_alloc (vm, new_buffers, n_buffers); |
| 1296 | if (n_alloc != n_buffers) |
| 1297 | { |
| 1298 | vlib_buffer_free_no_next (vm, new_buffers, n_alloc); |
| 1299 | return -1; |
| 1300 | } |
| 1301 | |
| 1302 | vlib_buffer_t *s = b; |
| 1303 | while (s->flags & VLIB_BUFFER_NEXT_PRESENT) |
| 1304 | { |
| 1305 | s = vlib_get_buffer (vm, s->next_buffer); |
| 1306 | int d_free_len = buf_len - b->current_data - b->current_length; |
| 1307 | ASSERT (d_free_len >= 0); |
| 1308 | // chain buf and split write |
| 1309 | u32 copy_len = clib_min (d_free_len, s->current_length); |
| 1310 | u8 *d = vlib_buffer_put_uninit (b, copy_len); |
| 1311 | clib_memcpy (d, vlib_buffer_get_current (s), copy_len); |
| 1312 | int rest = s->current_length - copy_len; |
| 1313 | if (rest > 0) |
| 1314 | { |
| 1315 | //prev buf is full |
| 1316 | ASSERT (vlib_buffer_get_tail (b) == b->data + buf_len); |
| 1317 | ASSERT (n_buffers > 0); |
| 1318 | b = vlib_buffer_chain_buffer (vm, b, new_buffers[--n_buffers]); |
| 1319 | //make full use of the new buffers |
| 1320 | b->current_data = 0; |
| 1321 | d = vlib_buffer_put_uninit (b, rest); |
| 1322 | clib_memcpy (d, vlib_buffer_get_current (s) + copy_len, rest); |
| 1323 | } |
| 1324 | } |
| 1325 | vlib_buffer_free (vm, &chain_to_free, free_count); |
| 1326 | b->flags &= ~VLIB_BUFFER_TOTAL_LENGTH_VALID; |
| 1327 | if (b == first) /* no buffers addeed */ |
| 1328 | b->flags &= ~VLIB_BUFFER_NEXT_PRESENT; |
| 1329 | ASSERT (len == vlib_buffer_length_in_chain (vm, first)); |
| 1330 | ASSERT (n_buffers == 0); |
| 1331 | return buf_len - b->current_data - b->current_length; |
| 1332 | } |
| 1333 | |
Ed Warnicke | cb9cada | 2015-12-08 15:45:58 -0700 | [diff] [blame] | 1334 | #endif /* included_vlib_buffer_funcs_h */ |
Dave Barach | 9b8ffd9 | 2016-07-08 08:13:45 -0400 | [diff] [blame] | 1335 | |
| 1336 | /* |
| 1337 | * fd.io coding-style-patch-verification: ON |
| 1338 | * |
| 1339 | * Local Variables: |
| 1340 | * eval: (c-set-style "gnu") |
| 1341 | * End: |
| 1342 | */ |