src/vlib/node.c

   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  * node.c: VLIB processing nodes
  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 #include <vlib/vlib.h>
  41 #include <vlib/threads.h>
  42
  43 /* Query node given name. */
  44 vlib_node_t *
  45 vlib_get_node_by_name (vlib_main_t * vm, u8 * name)
  46 {
  47   vlib_node_main_t *nm = &vm->node_main;
  48   uword *p;
  49   u8 *key = name;
  50   key = format (0, "%s", key);
  51   p = hash_get (nm->node_by_name, key);
  52   if (key != name)
  53     vec_free (key);
  54   return p ? vec_elt (nm->nodes, p[0]) : 0;
  55 }
  56
  57 static void
  58 node_set_elog_name (vlib_main_t * vm, uword node_index)
  59 {
  60   vlib_node_t *n = vlib_get_node (vm, node_index);
  61   elog_event_type_t *t;
  62
  63   t = vec_elt_at_index (vm->node_call_elog_event_types, node_index);
  64   vec_free (t->format);
  65   t->format = (char *) format (0, "%v-call: %%d%c", n->name, 0);
  66
  67   t = vec_elt_at_index (vm->node_return_elog_event_types, node_index);
  68   vec_free (t->format);
  69   t->format = (char *) format (0, "%v-return: %%d%c", n->name, 0);
  70
  71   n->name_elog_string =
  72     elog_string (&vlib_global_main.elog_main, "%v%c", n->name, 0);
  73 }
  74
  75 void
  76 vlib_node_rename (vlib_main_t * vm, u32 node_index, char *fmt, ...)
  77 {
  78   va_list va;
  79   vlib_node_main_t *nm = &vm->node_main;
  80   vlib_node_t *n = vlib_get_node (vm, node_index);
  81
  82   va_start (va, fmt);
  83   hash_unset (nm->node_by_name, n->name);
  84   vec_free (n->name);
  85   n->name = va_format (0, fmt, &va);
  86   va_end (va);
  87   hash_set (nm->node_by_name, n->name, n->index);
  88
  89   node_set_elog_name (vm, node_index);
  90
  91   /* Propagate the change to all worker threads */
  92   vlib_worker_thread_node_runtime_update ();
  93 }
  94
  95 static void
  96 vlib_node_runtime_update (vlib_main_t * vm, u32 node_index, u32 next_index)
  97 {
  98   vlib_node_main_t *nm = &vm->node_main;
  99   vlib_node_runtime_t *r, *s;
 100   vlib_node_t *node, *next_node;
 101   vlib_next_frame_t *nf;
 102   vlib_pending_frame_t *pf;
 103   i32 i, j, n_insert;
 104
 105   node = vec_elt (nm->nodes, node_index);
 106   r = vlib_node_get_runtime (vm, node_index);
 107
 108   n_insert = vec_len (node->next_nodes) - r->n_next_nodes;
 109   if (n_insert > 0)
 110     {
 111       i = r->next_frame_index + r->n_next_nodes;
 112       vec_insert (nm->next_frames, n_insert, i);
 113
 114       /* Initialize newly inserted next frames. */
 115       for (j = 0; j < n_insert; j++)
 116         vlib_next_frame_init (nm->next_frames + i + j);
 117
 118       /* Relocate other next frames at higher indices. */
 119       for (j = 0; j < vec_len (nm->nodes); j++)
 120         {
 121           s = vlib_node_get_runtime (vm, j);
 122           if (j != node_index && s->next_frame_index >= i)
 123             s->next_frame_index += n_insert;
 124         }
 125
 126       /* Pending frames may need to be relocated also. */
 127       vec_foreach (pf, nm->pending_frames)
 128       {
 129         if (pf->next_frame_index != VLIB_PENDING_FRAME_NO_NEXT_FRAME
 130             && pf->next_frame_index >= i)
 131           pf->next_frame_index += n_insert;
 132       }
 133       /* *INDENT-OFF* */
 134       pool_foreach (pf, nm->suspended_process_frames)  {
 135           if (pf->next_frame_index != ~0 && pf->next_frame_index >= i)
 136             pf->next_frame_index += n_insert;
 137       }
 138       /* *INDENT-ON* */
 139
 140       r->n_next_nodes = vec_len (node->next_nodes);
 141     }
 142
 143   /* Set frame's node runtime index. */
 144   next_node = vlib_get_node (vm, node->next_nodes[next_index]);
 145   nf = nm->next_frames + r->next_frame_index + next_index;
 146   nf->node_runtime_index = next_node->runtime_index;
 147
 148   vlib_worker_thread_node_runtime_update ();
 149 }
 150
 151 uword
 152 vlib_node_get_next (vlib_main_t * vm, uword node_index, uword next_node_index)
 153 {
 154   vlib_node_main_t *nm = &vm->node_main;
 155   vlib_node_t *node;
 156   uword *p;
 157
 158   node = vec_elt (nm->nodes, node_index);
 159
 160   /* Runtime has to be initialized. */
 161   ASSERT (nm->flags & VLIB_NODE_MAIN_RUNTIME_STARTED);
 162
 163   if ((p = hash_get (node->next_slot_by_node, next_node_index)))
 164     {
 165       return p[0];
 166     }
 167
 168   return (~0);
 169 }
 170
 171 /* Add next node to given node in given slot. */
 172 uword
 173 vlib_node_add_next_with_slot (vlib_main_t * vm,
 174                               uword node_index,
 175                               uword next_node_index, uword slot)
 176 {
 177   vlib_node_main_t *nm = &vm->node_main;
 178   vlib_node_t *node, *next, *old_next;
 179   u32 old_next_index;
 180   uword *p;
 181
 182   ASSERT (vlib_get_thread_index () == 0);
 183
 184   node = vec_elt (nm->nodes, node_index);
 185   next = vec_elt (nm->nodes, next_node_index);
 186
 187   /* Runtime has to be initialized. */
 188   ASSERT (nm->flags & VLIB_NODE_MAIN_RUNTIME_STARTED);
 189
 190   if ((p = hash_get (node->next_slot_by_node, next_node_index)))
 191     {
 192       /* Next already exists: slot must match. */
 193       if (slot != ~0)
 194         ASSERT (slot == p[0]);
 195       return p[0];
 196     }
 197
 198   vlib_worker_thread_barrier_sync (vm);
 199
 200   if (slot == ~0)
 201     slot = vec_len (node->next_nodes);
 202
 203   vec_validate_init_empty (node->next_nodes, slot, ~0);
 204   vec_validate (node->n_vectors_by_next_node, slot);
 205
 206   if ((old_next_index = node->next_nodes[slot]) != ~0u)
 207     {
 208       hash_unset (node->next_slot_by_node, old_next_index);
 209       old_next = vlib_get_node (vm, old_next_index);
 210       old_next->prev_node_bitmap =
 211         clib_bitmap_andnoti (old_next->prev_node_bitmap, node_index);
 212     }
 213
 214   node->next_nodes[slot] = next_node_index;
 215   hash_set (node->next_slot_by_node, next_node_index, slot);
 216
 217   vlib_node_runtime_update (vm, node_index, slot);
 218
 219   next->prev_node_bitmap = clib_bitmap_ori (next->prev_node_bitmap,
 220                                             node_index);
 221
 222   /* Siblings all get same node structure. */
 223   {
 224     uword sib_node_index, sib_slot;
 225     vlib_node_t *sib_node;
 226     /* *INDENT-OFF* */
 227     clib_bitmap_foreach (sib_node_index, node->sibling_bitmap)  {
 228       sib_node = vec_elt (nm->nodes, sib_node_index);
 229       if (sib_node != node)
 230         {
 231           sib_slot = vlib_node_add_next_with_slot (vm, sib_node_index, next_node_index, slot);
 232           ASSERT (sib_slot == slot);
 233         }
 234     }
 235     /* *INDENT-ON* */
 236   }
 237
 238   vlib_worker_thread_barrier_release (vm);
 239   return slot;
 240 }
 241
 242 /* Add named next node to given node in given slot. */
 243 uword
 244 vlib_node_add_named_next_with_slot (vlib_main_t * vm,
 245                                     uword node, char *name, uword slot)
 246 {
 247   vlib_node_main_t *nm;
 248   vlib_node_t *n, *n_next;
 249
 250   nm = &vm->node_main;
 251   n = vlib_get_node (vm, node);
 252
 253   n_next = vlib_get_node_by_name (vm, (u8 *) name);
 254   if (!n_next)
 255     {
 256       if (nm->flags & VLIB_NODE_MAIN_RUNTIME_STARTED)
 257         return ~0;
 258
 259       if (slot == ~0)
 260         slot = clib_max (vec_len (n->next_node_names),
 261                          vec_len (n->next_nodes));
 262       vec_validate (n->next_node_names, slot);
 263       n->next_node_names[slot] = name;
 264       return slot;
 265     }
 266
 267   return vlib_node_add_next_with_slot (vm, node, n_next->index, slot);
 268 }
 269
 270 static void
 271 node_elog_init (vlib_main_t * vm, uword ni)
 272 {
 273   elog_event_type_t t;
 274
 275   clib_memset (&t, 0, sizeof (t));
 276
 277   /* 2 event types for this node: one when node function is called.
 278      One when it returns. */
 279   vec_validate (vm->node_call_elog_event_types, ni);
 280   vm->node_call_elog_event_types[ni] = t;
 281
 282   vec_validate (vm->node_return_elog_event_types, ni);
 283   vm->node_return_elog_event_types[ni] = t;
 284
 285   node_set_elog_name (vm, ni);
 286 }
 287
 288 #ifdef CLIB_UNIX
 289 #define STACK_ALIGN (clib_mem_get_page_size())
 290 #else
 291 #define STACK_ALIGN CLIB_CACHE_LINE_BYTES
 292 #endif
 293
 294 vlib_node_function_t *
 295 vlib_node_get_preferred_node_fn_variant (vlib_main_t *vm,
 296                                          vlib_node_fn_registration_t *regs)
 297 {
 298   vlib_node_main_t *nm = &vm->node_main;
 299   vlib_node_fn_registration_t *r;
 300   vlib_node_fn_variant_t *v;
 301   vlib_node_function_t *fn = 0;
 302   int priority = -1;
 303
 304   if (nm->node_fn_default_march_variant != ~0)
 305     {
 306       r = regs;
 307       while (r)
 308         {
 309           if (r->march_variant == nm->node_fn_default_march_variant)
 310             return r->function;
 311           r = r->next_registration;
 312         }
 313     }
 314
 315   r = regs;
 316   while (r)
 317     {
 318       v = vec_elt_at_index (nm->variants, r->march_variant);
 319       if (v->priority > priority)
 320         {
 321           priority = v->priority;
 322           fn = r->function;
 323         }
 324       r = r->next_registration;
 325     }
 326
 327   ASSERT (fn);
 328   return fn;
 329 }
 330
 331 static void
 332 vlib_node_add_to_sibling_bitmap (vlib_main_t *vm, vlib_node_t *n,
 333                                  vlib_node_t *sib)
 334 {
 335   vlib_node_main_t *nm = &vm->node_main;
 336   u32 si;
 337
 338   clib_bitmap_foreach (si, sib->sibling_bitmap)
 339     {
 340       vlib_node_t *m = vec_elt (nm->nodes, si);
 341
 342       /* Connect all of sibling's siblings to us. */
 343       m->sibling_bitmap = clib_bitmap_ori (m->sibling_bitmap, n->index);
 344
 345       /* Connect us to all of sibling's siblings. */
 346       n->sibling_bitmap = clib_bitmap_ori (n->sibling_bitmap, si);
 347     }
 348
 349   /* Connect sibling to us. */
 350   sib->sibling_bitmap = clib_bitmap_ori (sib->sibling_bitmap, n->index);
 351
 352   /* Connect us to sibling. */
 353   n->sibling_bitmap = clib_bitmap_ori (n->sibling_bitmap, sib->index);
 354 }
 355
 356 u32
 357 vlib_register_node (vlib_main_t *vm, vlib_node_registration_t *r, char *fmt,
 358                     ...)
 359 {
 360   vlib_node_main_t *nm = &vm->node_main;
 361   vlib_node_t *n, *sib = 0;
 362   va_list va;
 363   u32 size;
 364   int i;
 365
 366   if (r->sibling_of)
 367     {
 368       if (r->n_next_nodes > 0)
 369         clib_error ("sibling node should not have any next nodes `%v'",
 370                     r->name);
 371       if (nm->flags & VLIB_NODE_MAIN_RUNTIME_STARTED)
 372         {
 373           sib = vlib_get_node_by_name (vm, (u8 *) r->sibling_of);
 374
 375           if (sib == 0)
 376             clib_error ("unknown sibling node '%s'", r->sibling_of);
 377         }
 378     }
 379
 380   if (CLIB_DEBUG > 0)
 381     {
 382       /* Default (0) type should match INTERNAL. */
 383       vlib_node_t zero = { 0 };
 384       ASSERT (VLIB_NODE_TYPE_INTERNAL == zero.type);
 385     }
 386
 387   if (r->node_fn_registrations)
 388     {
 389       /* to avoid confusion, please remove ".function " statiement from
 390          CLIB_NODE_REGISTRATION() if using function function candidates */
 391       ASSERT (r->function == 0);
 392
 393       r->function =
 394         vlib_node_get_preferred_node_fn_variant (vm, r->node_fn_registrations);
 395     }
 396
 397   ASSERT (r->function != 0);
 398
 399   n = clib_mem_alloc_no_fail (sizeof (n[0]));
 400   clib_memset (n, 0, sizeof (n[0]));
 401   n->index = vec_len (nm->nodes);
 402   n->node_fn_registrations = r->node_fn_registrations;
 403   n->protocol_hint = r->protocol_hint;
 404
 405   vec_add1 (nm->nodes, n);
 406
 407   va_start (va, fmt);
 408   n->name = va_format (0, fmt, &va);
 409   va_end (va);
 410
 411   if (!nm->node_by_name)
 412     nm->node_by_name = hash_create_vec ( /* size */ 32,
 413                                         sizeof (n->name[0]), sizeof (uword));
 414
 415   /* Node names must be unique. */
 416   {
 417     /* vlib_get_node_by_name() expects NULL-terminated strings */
 418     u8 *name = format (0, "%v%c", n->name, 0);
 419     vlib_node_t *o = vlib_get_node_by_name (vm, name);
 420     vec_free (name);
 421     if (o)
 422       clib_error ("more than one node named `%v'", n->name);
 423   }
 424
 425   hash_set (nm->node_by_name, n->name, n->index);
 426
 427   r->index = n->index;          /* save index in registration */
 428   n->function = r->function;
 429
 430   if (r->type == VLIB_NODE_TYPE_INTERNAL)
 431     ASSERT (r->vector_size > 0);
 432
 433 #define _(f) n->f = r->f
 434
 435   _(type);
 436   _(flags);
 437   _(state);
 438   _(format_buffer);
 439   _(unformat_buffer);
 440   _(format_trace);
 441   _(validate_frame);
 442
 443   size = round_pow2 (sizeof (vlib_frame_t), VLIB_FRAME_DATA_ALIGN);
 444
 445   /* scalar data size */
 446   if (r->scalar_size)
 447     {
 448       n->scalar_offset = size;
 449       size += round_pow2 (r->scalar_size, VLIB_FRAME_DATA_ALIGN);
 450     }
 451   else
 452     n->scalar_offset = 0;
 453
 454   /* Vecor data size */
 455   n->vector_offset = size;
 456   size += r->vector_size * VLIB_FRAME_SIZE;
 457
 458   /* Allocate a few extra slots of vector data to support
 459      speculative vector enqueues which overflow vector data in next frame. */
 460   size += r->vector_size * VLIB_FRAME_SIZE_EXTRA;
 461
 462   /* space for VLIB_FRAME_MAGIC */
 463   n->magic_offset = size;
 464   size += sizeof (u32);
 465
 466   /* round size to VLIB_FRAME_DATA_ALIGN */
 467   size = round_pow2 (size, VLIB_FRAME_DATA_ALIGN);
 468
 469   if (r->aux_size)
 470     {
 471       n->aux_offset = size;
 472       size += r->aux_size * VLIB_FRAME_SIZE;
 473     }
 474   else
 475     n->aux_offset = 0;
 476
 477   /* final size */
 478   n->frame_size = size = round_pow2 (size, CLIB_CACHE_LINE_BYTES);
 479   ASSERT (size <= __UINT16_MAX__);
 480
 481   vlib_frame_size_t *fs = 0;
 482
 483   n->frame_size_index = (u16) ~0;
 484   vec_foreach (fs, nm->frame_sizes)
 485     if (fs->frame_size == size)
 486       {
 487         n->frame_size_index = fs - nm->frame_sizes;
 488         break;
 489       }
 490
 491   if (n->frame_size_index == (u16) ~0)
 492     {
 493       vec_add2 (nm->frame_sizes, fs, 1);
 494       fs->frame_size = size;
 495       n->frame_size_index = fs - nm->frame_sizes;
 496     }
 497
 498   /* Register error counters. */
 499   vlib_register_errors (vm, n->index, r->n_errors, r->error_strings,
 500                         r->error_counters);
 501   node_elog_init (vm, n->index);
 502
 503   _(runtime_data_bytes);
 504   if (r->runtime_data_bytes > 0)
 505     {
 506       vec_resize (n->runtime_data, r->runtime_data_bytes);
 507       if (r->runtime_data)
 508         clib_memcpy (n->runtime_data, r->runtime_data, r->runtime_data_bytes);
 509     }
 510
 511   vec_resize (n->next_node_names, r->n_next_nodes);
 512   for (i = 0; i < r->n_next_nodes; i++)
 513     n->next_node_names[i] = r->next_nodes[i];
 514
 515   vec_validate_init_empty (n->next_nodes, r->n_next_nodes - 1, ~0);
 516   vec_validate (n->n_vectors_by_next_node, r->n_next_nodes - 1);
 517
 518   n->owner_node_index = n->owner_next_index = ~0;
 519
 520   /* Initialize node runtime. */
 521   {
 522     vlib_node_runtime_t *rt;
 523     u32 i;
 524
 525     if (n->type == VLIB_NODE_TYPE_PROCESS)
 526       {
 527         vlib_process_t *p;
 528         uword log2_n_stack_bytes;
 529
 530         log2_n_stack_bytes = clib_max (r->process_log2_n_stack_bytes,
 531                                        VLIB_PROCESS_LOG2_STACK_SIZE);
 532         log2_n_stack_bytes = clib_max (log2_n_stack_bytes,
 533                                        clib_mem_get_log2_page_size ());
 534
 535         p = clib_mem_alloc_aligned (sizeof (p[0]), CLIB_CACHE_LINE_BYTES);
 536         clib_memset (p, 0, sizeof (p[0]));
 537         p->log2_n_stack_bytes = log2_n_stack_bytes;
 538
 539         p->stack = clib_mem_vm_map_stack (1ULL << log2_n_stack_bytes,
 540                                           CLIB_MEM_PAGE_SZ_DEFAULT,
 541                                           "process stack: %U",
 542                                           format_vlib_node_name, vm,
 543                                           n->index);
 544
 545         if (p->stack == CLIB_MEM_VM_MAP_FAILED)
 546           clib_panic ("failed to allocate process stack (%d bytes)",
 547                       1ULL << log2_n_stack_bytes);
 548
 549         /* Process node's runtime index is really index into process
 550            pointer vector. */
 551         n->runtime_index = vec_len (nm->processes);
 552
 553         vec_add1 (nm->processes, p);
 554
 555         /* Paint first stack word with magic number so we can at least
 556            detect process stack overruns. */
 557         p->stack[0] = VLIB_PROCESS_STACK_MAGIC;
 558
 559         /* Node runtime is stored inside of process. */
 560         rt = &p->node_runtime;
 561       }
 562     else
 563       {
 564         vec_add2_aligned (nm->nodes_by_type[n->type], rt, 1,
 565                           /* align */ CLIB_CACHE_LINE_BYTES);
 566         if (n->type == VLIB_NODE_TYPE_INPUT)
 567           clib_interrupt_resize (&nm->input_node_interrupts,
 568                                  vec_len (nm->nodes_by_type[n->type]));
 569         else if (n->type == VLIB_NODE_TYPE_PRE_INPUT)
 570           clib_interrupt_resize (&nm->pre_input_node_interrupts,
 571                                  vec_len (nm->nodes_by_type[n->type]));
 572         n->runtime_index = rt - nm->nodes_by_type[n->type];
 573       }
 574
 575     if (n->type == VLIB_NODE_TYPE_INPUT)
 576       nm->input_node_counts_by_state[n->state] += 1;
 577
 578     rt->function = n->function;
 579     rt->flags = n->flags;
 580     rt->state = n->state;
 581     rt->node_index = n->index;
 582
 583     rt->n_next_nodes = r->n_next_nodes;
 584     rt->next_frame_index = vec_len (nm->next_frames);
 585
 586     vec_resize (nm->next_frames, rt->n_next_nodes);
 587     for (i = 0; i < rt->n_next_nodes; i++)
 588       vlib_next_frame_init (nm->next_frames + rt->next_frame_index + i);
 589
 590     vec_resize (rt->errors, r->n_errors);
 591     for (i = 0; i < vec_len (rt->errors); i++)
 592       rt->errors[i] = n->error_heap_index + i;
 593
 594     STATIC_ASSERT_SIZEOF (vlib_node_runtime_t, 128);
 595     ASSERT (vec_len (n->runtime_data) <= VLIB_NODE_RUNTIME_DATA_SIZE);
 596
 597     if (vec_len (n->runtime_data) > 0)
 598       clib_memcpy (rt->runtime_data, n->runtime_data,
 599                    vec_len (n->runtime_data));
 600     else
 601       clib_memset (rt->runtime_data, 0, VLIB_NODE_RUNTIME_DATA_SIZE);
 602
 603     vec_free (n->runtime_data);
 604   }
 605 #undef _
 606
 607   if (sib)
 608     {
 609       u32 slot, i;
 610
 611       vec_foreach_index (i, sib->next_nodes)
 612         {
 613           slot =
 614             vlib_node_add_next_with_slot (vm, n->index, sib->next_nodes[i], i);
 615           ASSERT (slot == i);
 616         }
 617
 618       vlib_node_add_to_sibling_bitmap (vm, n, sib);
 619
 620       r->n_next_nodes = vec_len (n->next_nodes);
 621     }
 622   n->sibling_of = r->sibling_of;
 623
 624   return r->index;
 625 }
 626
 627 static uword
 628 null_node_fn (vlib_main_t * vm,
 629               vlib_node_runtime_t * node, vlib_frame_t * frame)
 630 {
 631   u16 n_vectors = frame->n_vectors;
 632
 633   vlib_node_increment_counter (vm, node->node_index, 0, n_vectors);
 634   vlib_buffer_free (vm, vlib_frame_vector_args (frame), n_vectors);
 635   vlib_frame_free (vm, frame);
 636
 637   return n_vectors;
 638 }
 639
 640 void
 641 vlib_register_all_node_march_variants (vlib_main_t *vm)
 642 {
 643   vlib_node_main_t *nm = &vm->node_main;
 644   vlib_node_fn_variant_t *v;
 645   int prio = -1;
 646
 647   nm->node_fn_default_march_variant = ~0;
 648   ASSERT (nm->variants == 0);
 649   vec_add2 (nm->variants, v, 1);
 650   v->desc = v->suffix = "default";
 651   v->index = CLIB_MARCH_VARIANT_TYPE;
 652
 653 #define _(s, n)                                                               \
 654   vec_add2 (nm->variants, v, 1);                                              \
 655   v->suffix = #s;                                                             \
 656   v->index = CLIB_MARCH_VARIANT_TYPE_##s;                                     \
 657   v->priority = clib_cpu_march_priority_##s ();                               \
 658   v->desc = n;
 659
 660   foreach_march_variant;
 661 #undef _
 662
 663   nm->node_fn_march_variant_by_suffix = hash_create_string (0, sizeof (u32));
 664
 665   vec_foreach (v, nm->variants)
 666     {
 667       ASSERT (v->index == v - nm->variants);
 668       hash_set (nm->node_fn_march_variant_by_suffix, v->suffix, v->index);
 669       if (v->priority > prio)
 670         prio = v->priority;
 671     }
 672 }
 673
 674 void
 675 vlib_register_all_static_nodes (vlib_main_t * vm)
 676 {
 677   vlib_global_main_t *vgm = vlib_get_global_main ();
 678   vlib_node_registration_t *r;
 679
 680   static char *null_node_error_strings[] = {
 681     "blackholed packets",
 682   };
 683
 684   static vlib_node_registration_t null_node_reg = {
 685     .function = null_node_fn,
 686     .vector_size = sizeof (u32),
 687     .n_errors = 1,
 688     .error_strings = null_node_error_strings,
 689   };
 690
 691   /* make sure that node index 0 is not used by
 692      real node */
 693   vlib_register_node (vm, &null_node_reg, "null-node");
 694
 695   r = vgm->node_registrations;
 696   while (r)
 697     {
 698       vlib_register_node (vm, r, "%s", r->name);
 699       r = r->next_registration;
 700     }
 701 }
 702
 703 void
 704 vlib_node_get_nodes (vlib_main_t * vm, u32 max_threads, int include_stats,
 705                      int barrier_sync, vlib_node_t **** node_dupsp,
 706                      vlib_main_t *** stat_vmsp)
 707 {
 708   vlib_node_main_t *nm = &vm->node_main;
 709   vlib_node_t *n;
 710   vlib_node_t ***node_dups = *node_dupsp;
 711   vlib_node_t **nodes;
 712   vlib_main_t **stat_vms = *stat_vmsp;
 713   vlib_main_t *stat_vm;
 714   uword i, j;
 715   u32 threads_to_serialize;
 716
 717   if (vec_len (stat_vms) == 0)
 718     {
 719       for (i = 0; i < vlib_get_n_threads (); i++)
 720         {
 721           stat_vm = vlib_get_main_by_index (i);
 722           if (stat_vm)
 723             vec_add1 (stat_vms, stat_vm);
 724         }
 725     }
 726
 727   threads_to_serialize = clib_min (max_threads, vec_len (stat_vms));
 728
 729   vec_validate (node_dups, threads_to_serialize - 1);
 730
 731   /*
 732    * Barrier sync across stats scraping.
 733    * Otherwise, the counts will be grossly inaccurate.
 734    */
 735   if (barrier_sync)
 736     vlib_worker_thread_barrier_sync (vm);
 737
 738   for (j = 0; j < threads_to_serialize; j++)
 739     {
 740       stat_vm = stat_vms[j];
 741       nm = &stat_vm->node_main;
 742
 743       if (include_stats)
 744         {
 745           for (i = 0; i < vec_len (nm->nodes); i++)
 746             {
 747               n = nm->nodes[i];
 748               vlib_node_sync_stats (stat_vm, n);
 749             }
 750         }
 751
 752       nodes = node_dups[j];
 753       vec_validate (nodes, vec_len (nm->nodes) - 1);
 754       clib_memcpy (nodes, nm->nodes, vec_len (nm->nodes) * sizeof (nodes[0]));
 755       node_dups[j] = nodes;
 756     }
 757
 758   if (barrier_sync)
 759     vlib_worker_thread_barrier_release (vm);
 760
 761   *node_dupsp = node_dups;
 762   *stat_vmsp = stat_vms;
 763 }
 764
 765 clib_error_t *
 766 vlib_node_main_init (vlib_main_t * vm)
 767 {
 768   vlib_node_main_t *nm = &vm->node_main;
 769   clib_error_t *error = 0;
 770   vlib_node_t *n;
 771   uword ni;
 772
 773   nm->flags |= VLIB_NODE_MAIN_RUNTIME_STARTED;
 774
 775   /* Generate sibling relationships */
 776   {
 777     vlib_node_t *n, *sib;
 778
 779     for (ni = 0; ni < vec_len (nm->nodes); ni++)
 780       {
 781         n = vec_elt (nm->nodes, ni);
 782
 783         if (!n->sibling_of)
 784           continue;
 785
 786         sib = vlib_get_node_by_name (vm, (u8 *) n->sibling_of);
 787         if (!sib)
 788           {
 789             error = clib_error_create ("sibling `%s' not found for node `%v'",
 790                                        n->sibling_of, n->name);
 791             goto done;
 792           }
 793
 794         vlib_node_add_to_sibling_bitmap (vm, n, sib);
 795       }
 796   }
 797
 798   /* Resolve next names into next indices. */
 799   for (ni = 0; ni < vec_len (nm->nodes); ni++)
 800     {
 801       uword i;
 802
 803       n = vec_elt (nm->nodes, ni);
 804
 805       for (i = 0; i < vec_len (n->next_node_names); i++)
 806         {
 807           char *a = n->next_node_names[i];
 808
 809           if (!a)
 810             continue;
 811
 812           if (~0 == vlib_node_add_named_next_with_slot (vm, n->index, a, i))
 813             {
 814               error = clib_error_create
 815                 ("node `%v' refers to unknown node `%s'", n->name, a);
 816               goto done;
 817             }
 818         }
 819
 820       vec_free (n->next_node_names);
 821     }
 822
 823   /* Set previous node pointers. */
 824   for (ni = 0; ni < vec_len (nm->nodes); ni++)
 825     {
 826       vlib_node_t *n_next;
 827       uword i;
 828
 829       n = vec_elt (nm->nodes, ni);
 830
 831       for (i = 0; i < vec_len (n->next_nodes); i++)
 832         {
 833           if (n->next_nodes[i] >= vec_len (nm->nodes))
 834             continue;
 835
 836           n_next = vec_elt (nm->nodes, n->next_nodes[i]);
 837           n_next->prev_node_bitmap =
 838             clib_bitmap_ori (n_next->prev_node_bitmap, n->index);
 839         }
 840     }
 841
 842   {
 843     vlib_next_frame_t *nf;
 844     vlib_node_runtime_t *r;
 845     vlib_node_t *next;
 846     uword i;
 847
 848     vec_foreach (r, nm->nodes_by_type[VLIB_NODE_TYPE_INTERNAL])
 849     {
 850       if (r->n_next_nodes == 0)
 851         continue;
 852
 853       n = vlib_get_node (vm, r->node_index);
 854       nf = vec_elt_at_index (nm->next_frames, r->next_frame_index);
 855
 856       for (i = 0; i < vec_len (n->next_nodes); i++)
 857         {
 858           next = vlib_get_node (vm, n->next_nodes[i]);
 859
 860           /* Validate node runtime indices are correctly initialized. */
 861           ASSERT (nf[i].node_runtime_index == next->runtime_index);
 862
 863           nf[i].flags = 0;
 864           if (next->flags & VLIB_NODE_FLAG_FRAME_NO_FREE_AFTER_DISPATCH)
 865             nf[i].flags |= VLIB_FRAME_NO_FREE_AFTER_DISPATCH;
 866         }
 867     }
 868   }
 869
 870 done:
 871   return error;
 872 }
 873
 874 u32
 875 vlib_process_create (vlib_main_t * vm, char *name,
 876                      vlib_node_function_t * f, u32 log2_n_stack_bytes)
 877 {
 878   vlib_node_registration_t r;
 879   vlib_node_t *n;
 880
 881   memset (&r, 0, sizeof (r));
 882
 883   r.function = f;
 884   r.process_log2_n_stack_bytes = log2_n_stack_bytes;
 885   r.type = VLIB_NODE_TYPE_PROCESS;
 886
 887   vlib_worker_thread_barrier_sync (vm);
 888
 889   vlib_register_node (vm, &r, "%s", name);
 890   vec_free (r.name);
 891
 892   vlib_worker_thread_node_runtime_update ();
 893   vlib_worker_thread_barrier_release (vm);
 894
 895   n = vlib_get_node (vm, r.index);
 896   vlib_start_process (vm, n->runtime_index);
 897
 898   return (r.index);
 899 }
 900
 901 int
 902 vlib_node_set_march_variant (vlib_main_t *vm, u32 node_index,
 903                              clib_march_variant_type_t march_variant)
 904 {
 905   vlib_node_fn_registration_t *fnr;
 906   vlib_node_fn_variant_t *v;
 907   vlib_node_t *n = vlib_get_node (vm, node_index);
 908
 909   if (n->node_fn_registrations == 0)
 910     return -1;
 911
 912   fnr = n->node_fn_registrations;
 913   v = vec_elt_at_index (vm->node_main.variants, march_variant);
 914
 915   while (fnr)
 916     {
 917       if (fnr->march_variant == v->index)
 918         {
 919           n->function = fnr->function;
 920
 921           for (int i = 0; i < vlib_get_n_threads (); i++)
 922             {
 923               vlib_node_runtime_t *nrt;
 924               nrt =
 925                 vlib_node_get_runtime (vlib_get_main_by_index (i), n->index);
 926               nrt->function = fnr->function;
 927             }
 928           return 0;
 929         }
 930       fnr = fnr->next_registration;
 931     }
 932   return -1;
 933 }
 934 /*
 935  * fd.io coding-style-patch-verification: ON
 936  *
 937  * Local Variables:
 938  * eval: (c-set-style "gnu")
 939  * End:
 940  */