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 register_node (vlib_main_t * vm, vlib_node_registration_t * r)
 333 {
 334   vlib_node_main_t *nm = &vm->node_main;
 335   vlib_node_t *n;
 336   int i;
 337
 338   if (CLIB_DEBUG > 0)
 339     {
 340       /* Default (0) type should match INTERNAL. */
 341       vlib_node_t zero = { 0 };
 342       ASSERT (VLIB_NODE_TYPE_INTERNAL == zero.type);
 343     }
 344
 345   if (r->node_fn_registrations)
 346     {
 347       /* to avoid confusion, please remove ".function " statiement from
 348          CLIB_NODE_REGISTRATION() if using function function candidates */
 349       ASSERT (r->function == 0);
 350
 351       r->function =
 352         vlib_node_get_preferred_node_fn_variant (vm, r->node_fn_registrations);
 353     }
 354
 355   ASSERT (r->function != 0);
 356
 357   n = clib_mem_alloc_no_fail (sizeof (n[0]));
 358   clib_memset (n, 0, sizeof (n[0]));
 359   n->index = vec_len (nm->nodes);
 360   n->node_fn_registrations = r->node_fn_registrations;
 361   n->protocol_hint = r->protocol_hint;
 362
 363   vec_add1 (nm->nodes, n);
 364
 365   /* Name is always a vector so it can be formatted with %v. */
 366   if (clib_mem_is_heap_object (vec_header (r->name, 0)))
 367     n->name = vec_dup ((u8 *) r->name);
 368   else
 369     n->name = format (0, "%s", r->name);
 370
 371   if (!nm->node_by_name)
 372     nm->node_by_name = hash_create_vec ( /* size */ 32,
 373                                         sizeof (n->name[0]), sizeof (uword));
 374
 375   /* Node names must be unique. */
 376   {
 377     /* vlib_get_node_by_name() expects NULL-terminated strings */
 378     u8 *name = format (0, "%v%c", n->name, 0);
 379     vlib_node_t *o = vlib_get_node_by_name (vm, name);
 380     vec_free (name);
 381     if (o)
 382       clib_error ("more than one node named `%v'", n->name);
 383   }
 384
 385   hash_set (nm->node_by_name, n->name, n->index);
 386
 387   r->index = n->index;          /* save index in registration */
 388   n->function = r->function;
 389
 390   /* Node index of next sibling will be filled in by vlib_node_main_init. */
 391   n->sibling_of = r->sibling_of;
 392   if (r->sibling_of && r->n_next_nodes > 0)
 393     clib_error ("sibling node should not have any next nodes `%v'", n->name);
 394
 395   if (r->type == VLIB_NODE_TYPE_INTERNAL)
 396     ASSERT (r->vector_size > 0);
 397
 398 #define _(f) n->f = r->f
 399
 400   _(type);
 401   _(flags);
 402   _(state);
 403   _(scalar_size);
 404   _(vector_size);
 405   _(format_buffer);
 406   _(unformat_buffer);
 407   _(format_trace);
 408   _(validate_frame);
 409
 410   /* Register error counters. */
 411   vlib_register_errors (vm, n->index, r->n_errors, r->error_strings,
 412                         r->error_counters);
 413   node_elog_init (vm, n->index);
 414
 415   _(runtime_data_bytes);
 416   if (r->runtime_data_bytes > 0)
 417     {
 418       vec_resize (n->runtime_data, r->runtime_data_bytes);
 419       if (r->runtime_data)
 420         clib_memcpy (n->runtime_data, r->runtime_data, r->runtime_data_bytes);
 421     }
 422
 423   vec_resize (n->next_node_names, r->n_next_nodes);
 424   for (i = 0; i < r->n_next_nodes; i++)
 425     n->next_node_names[i] = r->next_nodes[i];
 426
 427   vec_validate_init_empty (n->next_nodes, r->n_next_nodes - 1, ~0);
 428   vec_validate (n->n_vectors_by_next_node, r->n_next_nodes - 1);
 429
 430   n->owner_node_index = n->owner_next_index = ~0;
 431
 432   /* Initialize node runtime. */
 433   {
 434     vlib_node_runtime_t *rt;
 435     u32 i;
 436
 437     if (n->type == VLIB_NODE_TYPE_PROCESS)
 438       {
 439         vlib_process_t *p;
 440         uword log2_n_stack_bytes;
 441
 442         log2_n_stack_bytes = clib_max (r->process_log2_n_stack_bytes,
 443                                        VLIB_PROCESS_LOG2_STACK_SIZE);
 444         log2_n_stack_bytes = clib_max (log2_n_stack_bytes,
 445                                        clib_mem_get_log2_page_size ());
 446
 447         p = clib_mem_alloc_aligned (sizeof (p[0]), CLIB_CACHE_LINE_BYTES);
 448         clib_memset (p, 0, sizeof (p[0]));
 449         p->log2_n_stack_bytes = log2_n_stack_bytes;
 450
 451         p->stack = clib_mem_vm_map_stack (1ULL << log2_n_stack_bytes,
 452                                           CLIB_MEM_PAGE_SZ_DEFAULT,
 453                                           "process stack: %U",
 454                                           format_vlib_node_name, vm,
 455                                           n->index);
 456
 457         if (p->stack == CLIB_MEM_VM_MAP_FAILED)
 458           clib_panic ("failed to allocate process stack (%d bytes)",
 459                       1ULL << log2_n_stack_bytes);
 460
 461         /* Process node's runtime index is really index into process
 462            pointer vector. */
 463         n->runtime_index = vec_len (nm->processes);
 464
 465         vec_add1 (nm->processes, p);
 466
 467         /* Paint first stack word with magic number so we can at least
 468            detect process stack overruns. */
 469         p->stack[0] = VLIB_PROCESS_STACK_MAGIC;
 470
 471         /* Node runtime is stored inside of process. */
 472         rt = &p->node_runtime;
 473       }
 474     else
 475       {
 476         vec_add2_aligned (nm->nodes_by_type[n->type], rt, 1,
 477                           /* align */ CLIB_CACHE_LINE_BYTES);
 478         if (n->type == VLIB_NODE_TYPE_INPUT)
 479           clib_interrupt_resize (&nm->interrupts,
 480                                  vec_len (nm->nodes_by_type[n->type]));
 481         n->runtime_index = rt - nm->nodes_by_type[n->type];
 482       }
 483
 484     if (n->type == VLIB_NODE_TYPE_INPUT)
 485       nm->input_node_counts_by_state[n->state] += 1;
 486
 487     rt->function = n->function;
 488     rt->flags = n->flags;
 489     rt->state = n->state;
 490     rt->node_index = n->index;
 491
 492     rt->n_next_nodes = r->n_next_nodes;
 493     rt->next_frame_index = vec_len (nm->next_frames);
 494
 495     vec_resize (nm->next_frames, rt->n_next_nodes);
 496     for (i = 0; i < rt->n_next_nodes; i++)
 497       vlib_next_frame_init (nm->next_frames + rt->next_frame_index + i);
 498
 499     vec_resize (rt->errors, r->n_errors);
 500     for (i = 0; i < vec_len (rt->errors); i++)
 501       rt->errors[i] = n->error_heap_index + i;
 502
 503     STATIC_ASSERT_SIZEOF (vlib_node_runtime_t, 128);
 504     ASSERT (vec_len (n->runtime_data) <= VLIB_NODE_RUNTIME_DATA_SIZE);
 505
 506     if (vec_len (n->runtime_data) > 0)
 507       clib_memcpy (rt->runtime_data, n->runtime_data,
 508                    vec_len (n->runtime_data));
 509     else
 510       clib_memset (rt->runtime_data, 0, VLIB_NODE_RUNTIME_DATA_SIZE);
 511
 512     vec_free (n->runtime_data);
 513   }
 514 #undef _
 515 }
 516
 517 /* Register new packet processing node. */
 518 u32
 519 vlib_register_node (vlib_main_t * vm, vlib_node_registration_t * r)
 520 {
 521   register_node (vm, r);
 522   return r->index;
 523 }
 524
 525 static uword
 526 null_node_fn (vlib_main_t * vm,
 527               vlib_node_runtime_t * node, vlib_frame_t * frame)
 528 {
 529   u16 n_vectors = frame->n_vectors;
 530
 531   vlib_node_increment_counter (vm, node->node_index, 0, n_vectors);
 532   vlib_buffer_free (vm, vlib_frame_vector_args (frame), n_vectors);
 533   vlib_frame_free (vm, node, frame);
 534
 535   return n_vectors;
 536 }
 537
 538 void
 539 vlib_register_all_node_march_variants (vlib_main_t *vm)
 540 {
 541   vlib_node_main_t *nm = &vm->node_main;
 542   vlib_node_fn_variant_t *v;
 543   int prio = -1;
 544
 545   nm->node_fn_default_march_variant = ~0;
 546   ASSERT (nm->variants == 0);
 547   vec_add2 (nm->variants, v, 1);
 548   v->desc = v->suffix = "default";
 549   v->index = CLIB_MARCH_VARIANT_TYPE;
 550
 551 #define _(s, n)                                                               \
 552   vec_add2 (nm->variants, v, 1);                                              \
 553   v->suffix = #s;                                                             \
 554   v->index = CLIB_MARCH_VARIANT_TYPE_##s;                                     \
 555   v->priority = clib_cpu_march_priority_##s ();                               \
 556   v->desc = n;
 557
 558   foreach_march_variant;
 559 #undef _
 560
 561   nm->node_fn_march_variant_by_suffix = hash_create_string (0, sizeof (u32));
 562
 563   vec_foreach (v, nm->variants)
 564     {
 565       ASSERT (v->index == v - nm->variants);
 566       hash_set (nm->node_fn_march_variant_by_suffix, v->suffix, v->index);
 567       if (v->priority > prio)
 568         prio = v->priority;
 569     }
 570 }
 571
 572 void
 573 vlib_register_all_static_nodes (vlib_main_t * vm)
 574 {
 575   vlib_node_registration_t *r;
 576
 577   static char *null_node_error_strings[] = {
 578     "blackholed packets",
 579   };
 580
 581   static vlib_node_registration_t null_node_reg = {
 582     .function = null_node_fn,
 583     .vector_size = sizeof (u32),
 584     .name = "null-node",
 585     .n_errors = 1,
 586     .error_strings = null_node_error_strings,
 587   };
 588
 589   /* make sure that node index 0 is not used by
 590      real node */
 591   register_node (vm, &null_node_reg);
 592
 593   r = vm->node_main.node_registrations;
 594   while (r)
 595     {
 596       register_node (vm, r);
 597       r = r->next_registration;
 598     }
 599 }
 600
 601 void
 602 vlib_node_get_nodes (vlib_main_t * vm, u32 max_threads, int include_stats,
 603                      int barrier_sync, vlib_node_t **** node_dupsp,
 604                      vlib_main_t *** stat_vmsp)
 605 {
 606   vlib_node_main_t *nm = &vm->node_main;
 607   vlib_node_t *n;
 608   vlib_node_t ***node_dups = *node_dupsp;
 609   vlib_node_t **nodes;
 610   vlib_main_t **stat_vms = *stat_vmsp;
 611   vlib_main_t *stat_vm;
 612   uword i, j;
 613   u32 threads_to_serialize;
 614
 615   if (vec_len (stat_vms) == 0)
 616     {
 617       for (i = 0; i < vlib_get_n_threads (); i++)
 618         {
 619           stat_vm = vlib_get_main_by_index (i);
 620           if (stat_vm)
 621             vec_add1 (stat_vms, stat_vm);
 622         }
 623     }
 624
 625   threads_to_serialize = clib_min (max_threads, vec_len (stat_vms));
 626
 627   vec_validate (node_dups, threads_to_serialize - 1);
 628
 629   /*
 630    * Barrier sync across stats scraping.
 631    * Otherwise, the counts will be grossly inaccurate.
 632    */
 633   if (barrier_sync)
 634     vlib_worker_thread_barrier_sync (vm);
 635
 636   for (j = 0; j < threads_to_serialize; j++)
 637     {
 638       stat_vm = stat_vms[j];
 639       nm = &stat_vm->node_main;
 640
 641       if (include_stats)
 642         {
 643           for (i = 0; i < vec_len (nm->nodes); i++)
 644             {
 645               n = nm->nodes[i];
 646               vlib_node_sync_stats (stat_vm, n);
 647             }
 648         }
 649
 650       nodes = node_dups[j];
 651       vec_validate (nodes, vec_len (nm->nodes) - 1);
 652       clib_memcpy (nodes, nm->nodes, vec_len (nm->nodes) * sizeof (nodes[0]));
 653       node_dups[j] = nodes;
 654     }
 655
 656   if (barrier_sync)
 657     vlib_worker_thread_barrier_release (vm);
 658
 659   *node_dupsp = node_dups;
 660   *stat_vmsp = stat_vms;
 661 }
 662
 663 clib_error_t *
 664 vlib_node_main_init (vlib_main_t * vm)
 665 {
 666   vlib_node_main_t *nm = &vm->node_main;
 667   clib_error_t *error = 0;
 668   vlib_node_t *n;
 669   uword ni;
 670
 671   nm->frame_sizes = vec_new (vlib_frame_size_t, 1);
 672 #ifdef VLIB_SUPPORTS_ARBITRARY_SCALAR_SIZES
 673   nm->frame_size_hash = hash_create (0, sizeof (uword));
 674 #endif
 675   nm->flags |= VLIB_NODE_MAIN_RUNTIME_STARTED;
 676
 677   /* Generate sibling relationships */
 678   {
 679     vlib_node_t *n, *sib;
 680     uword si;
 681
 682     for (ni = 0; ni < vec_len (nm->nodes); ni++)
 683       {
 684         n = vec_elt (nm->nodes, ni);
 685
 686         if (!n->sibling_of)
 687           continue;
 688
 689         sib = vlib_get_node_by_name (vm, (u8 *) n->sibling_of);
 690         if (!sib)
 691           {
 692             error = clib_error_create ("sibling `%s' not found for node `%v'",
 693                                        n->sibling_of, n->name);
 694             goto done;
 695           }
 696
 697         /* *INDENT-OFF* */
 698         clib_bitmap_foreach (si, sib->sibling_bitmap)  {
 699               vlib_node_t * m = vec_elt (nm->nodes, si);
 700
 701               /* Connect all of sibling's siblings to us. */
 702               m->sibling_bitmap = clib_bitmap_ori (m->sibling_bitmap, n->index);
 703
 704               /* Connect us to all of sibling's siblings. */
 705               n->sibling_bitmap = clib_bitmap_ori (n->sibling_bitmap, si);
 706             }
 707         /* *INDENT-ON* */
 708
 709         /* Connect sibling to us. */
 710         sib->sibling_bitmap = clib_bitmap_ori (sib->sibling_bitmap, n->index);
 711
 712         /* Connect us to sibling. */
 713         n->sibling_bitmap = clib_bitmap_ori (n->sibling_bitmap, sib->index);
 714       }
 715   }
 716
 717   /* Resolve next names into next indices. */
 718   for (ni = 0; ni < vec_len (nm->nodes); ni++)
 719     {
 720       uword i;
 721
 722       n = vec_elt (nm->nodes, ni);
 723
 724       for (i = 0; i < vec_len (n->next_node_names); i++)
 725         {
 726           char *a = n->next_node_names[i];
 727
 728           if (!a)
 729             continue;
 730
 731           if (~0 == vlib_node_add_named_next_with_slot (vm, n->index, a, i))
 732             {
 733               error = clib_error_create
 734                 ("node `%v' refers to unknown node `%s'", n->name, a);
 735               goto done;
 736             }
 737         }
 738
 739       vec_free (n->next_node_names);
 740     }
 741
 742   /* Set previous node pointers. */
 743   for (ni = 0; ni < vec_len (nm->nodes); ni++)
 744     {
 745       vlib_node_t *n_next;
 746       uword i;
 747
 748       n = vec_elt (nm->nodes, ni);
 749
 750       for (i = 0; i < vec_len (n->next_nodes); i++)
 751         {
 752           if (n->next_nodes[i] >= vec_len (nm->nodes))
 753             continue;
 754
 755           n_next = vec_elt (nm->nodes, n->next_nodes[i]);
 756           n_next->prev_node_bitmap =
 757             clib_bitmap_ori (n_next->prev_node_bitmap, n->index);
 758         }
 759     }
 760
 761   {
 762     vlib_next_frame_t *nf;
 763     vlib_node_runtime_t *r;
 764     vlib_node_t *next;
 765     uword i;
 766
 767     vec_foreach (r, nm->nodes_by_type[VLIB_NODE_TYPE_INTERNAL])
 768     {
 769       if (r->n_next_nodes == 0)
 770         continue;
 771
 772       n = vlib_get_node (vm, r->node_index);
 773       nf = vec_elt_at_index (nm->next_frames, r->next_frame_index);
 774
 775       for (i = 0; i < vec_len (n->next_nodes); i++)
 776         {
 777           next = vlib_get_node (vm, n->next_nodes[i]);
 778
 779           /* Validate node runtime indices are correctly initialized. */
 780           ASSERT (nf[i].node_runtime_index == next->runtime_index);
 781
 782           nf[i].flags = 0;
 783           if (next->flags & VLIB_NODE_FLAG_FRAME_NO_FREE_AFTER_DISPATCH)
 784             nf[i].flags |= VLIB_FRAME_NO_FREE_AFTER_DISPATCH;
 785         }
 786     }
 787   }
 788
 789 done:
 790   return error;
 791 }
 792
 793 u32
 794 vlib_process_create (vlib_main_t * vm, char *name,
 795                      vlib_node_function_t * f, u32 log2_n_stack_bytes)
 796 {
 797   vlib_node_registration_t r;
 798   vlib_node_t *n;
 799
 800   memset (&r, 0, sizeof (r));
 801
 802   r.name = (char *) format (0, "%s", name, 0);
 803   r.function = f;
 804   r.process_log2_n_stack_bytes = log2_n_stack_bytes;
 805   r.type = VLIB_NODE_TYPE_PROCESS;
 806
 807   vlib_worker_thread_barrier_sync (vm);
 808
 809   vlib_register_node (vm, &r);
 810   vec_free (r.name);
 811
 812   vlib_worker_thread_node_runtime_update ();
 813   vlib_worker_thread_barrier_release (vm);
 814
 815   n = vlib_get_node (vm, r.index);
 816   vlib_start_process (vm, n->runtime_index);
 817
 818   return (r.index);
 819 }
 820
 821 int
 822 vlib_node_set_march_variant (vlib_main_t *vm, u32 node_index,
 823                              clib_march_variant_type_t march_variant)
 824 {
 825   vlib_node_fn_registration_t *fnr;
 826   vlib_node_fn_variant_t *v;
 827   vlib_node_t *n = vlib_get_node (vm, node_index);
 828
 829   if (n->node_fn_registrations == 0)
 830     return -1;
 831
 832   fnr = n->node_fn_registrations;
 833   v = vec_elt_at_index (vm->node_main.variants, march_variant);
 834
 835   while (fnr)
 836     {
 837       if (fnr->march_variant == v->index)
 838         {
 839           n->function = fnr->function;
 840
 841           for (int i = 0; i < vlib_get_n_threads (); i++)
 842             {
 843               vlib_node_runtime_t *nrt;
 844               nrt =
 845                 vlib_node_get_runtime (vlib_get_main_by_index (i), n->index);
 846               nrt->function = fnr->function;
 847             }
 848           return 0;
 849         }
 850       fnr = fnr->next_registration;
 851     }
 852   return -1;
 853 }
 854 /*
 855  * fd.io coding-style-patch-verification: ON
 856  *
 857  * Local Variables:
 858  * eval: (c-set-style "gnu")
 859  * End:
 860  */