vlib: clean up r2 plugin registration relocator
[vpp.git] / src / vlib / node_funcs.h
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_funcs.h: processing nodes global 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 /** \file
41     vlib node functions
42 */
43
44
45 #ifndef included_vlib_node_funcs_h
46 #define included_vlib_node_funcs_h
47
48 #include <vppinfra/clib.h>
49 #include <vppinfra/fifo.h>
50 #include <vppinfra/tw_timer_1t_3w_1024sl_ov.h>
51 #include <vppinfra/interrupt.h>
52
53 #ifdef CLIB_SANITIZE_ADDR
54 #include <sanitizer/asan_interface.h>
55 #endif
56
57 static_always_inline void
58 vlib_process_start_switch_stack (vlib_main_t * vm, vlib_process_t * p)
59 {
60 #ifdef CLIB_SANITIZE_ADDR
61   void *stack = p ? (void *) p->stack : vlib_thread_stacks[vm->thread_index];
62   u32 stack_bytes =
63     p ? (1ULL < p->log2_n_stack_bytes) : VLIB_THREAD_STACK_SIZE;
64   __sanitizer_start_switch_fiber (&vm->asan_stack_save, stack, stack_bytes);
65 #endif
66 }
67
68 static_always_inline void
69 vlib_process_finish_switch_stack (vlib_main_t * vm)
70 {
71 #ifdef CLIB_SANITIZE_ADDR
72   const void *bottom_old;
73   size_t size_old;
74
75   __sanitizer_finish_switch_fiber (&vm->asan_stack_save, &bottom_old,
76                                    &size_old);
77 #endif
78 }
79
80 /** \brief Get vlib node by index.
81  @warning This function will ASSERT if @c i is out of range.
82  @param vm vlib_main_t pointer, varies by thread
83  @param i node index.
84  @return pointer to the requested vlib_node_t.
85 */
86
87 always_inline vlib_node_t *
88 vlib_get_node (vlib_main_t * vm, u32 i)
89 {
90   return vec_elt (vm->node_main.nodes, i);
91 }
92
93 /** \brief Get vlib node by graph arc (next) index.
94  @param vm vlib_main_t pointer, varies by thread
95  @param node_index index of original node
96  @param next_index graph arc index
97  @return pointer to the vlib_node_t at the end of the indicated arc
98 */
99
100 always_inline vlib_node_t *
101 vlib_get_next_node (vlib_main_t * vm, u32 node_index, u32 next_index)
102 {
103   vlib_node_main_t *nm = &vm->node_main;
104   vlib_node_t *n;
105
106   n = vec_elt (nm->nodes, node_index);
107   ASSERT (next_index < vec_len (n->next_nodes));
108   return vlib_get_node (vm, n->next_nodes[next_index]);
109 }
110
111 /** \brief Get node runtime by node index.
112  @param vm vlib_main_t pointer, varies by thread
113  @param node_index index of node
114  @return pointer to the indicated vlib_node_runtime_t
115 */
116
117 always_inline vlib_node_runtime_t *
118 vlib_node_get_runtime (vlib_main_t * vm, u32 node_index)
119 {
120   vlib_node_main_t *nm = &vm->node_main;
121   vlib_node_t *n = vec_elt (nm->nodes, node_index);
122   vlib_process_t *p;
123   if (n->type != VLIB_NODE_TYPE_PROCESS)
124     return vec_elt_at_index (nm->nodes_by_type[n->type], n->runtime_index);
125   else
126     {
127       p = vec_elt (nm->processes, n->runtime_index);
128       return &p->node_runtime;
129     }
130 }
131
132 /** \brief Get node runtime private data by node index.
133  @param vm vlib_main_t pointer, varies by thread
134  @param node_index index of the node
135  @return pointer to the indicated vlib_node_runtime_t private data
136 */
137
138 always_inline void *
139 vlib_node_get_runtime_data (vlib_main_t * vm, u32 node_index)
140 {
141   vlib_node_runtime_t *r = vlib_node_get_runtime (vm, node_index);
142   return r->runtime_data;
143 }
144
145 /** \brief Set node runtime private data.
146  @param vm vlib_main_t pointer, varies by thread
147  @param node_index index of the node
148  @param runtime_data arbitrary runtime private data
149  @param n_runtime_data_bytes size of runtime private data
150 */
151
152 always_inline void
153 vlib_node_set_runtime_data (vlib_main_t * vm, u32 node_index,
154                             void *runtime_data, u32 n_runtime_data_bytes)
155 {
156   vlib_node_t *n = vlib_get_node (vm, node_index);
157   vlib_node_runtime_t *r = vlib_node_get_runtime (vm, node_index);
158
159   n->runtime_data_bytes = n_runtime_data_bytes;
160   vec_free (n->runtime_data);
161   vec_add (n->runtime_data, runtime_data, n_runtime_data_bytes);
162
163   ASSERT (vec_len (n->runtime_data) <= sizeof (vlib_node_runtime_t) -
164           STRUCT_OFFSET_OF (vlib_node_runtime_t, runtime_data));
165
166   if (vec_len (n->runtime_data) > 0)
167     clib_memcpy_fast (r->runtime_data, n->runtime_data,
168                       vec_len (n->runtime_data));
169 }
170
171 /** \brief Set node dispatch state.
172  @param vm vlib_main_t pointer, varies by thread
173  @param node_index index of the node
174  @param new_state new state for node, see vlib_node_state_t
175 */
176 always_inline void
177 vlib_node_set_state (vlib_main_t * vm, u32 node_index,
178                      vlib_node_state_t new_state)
179 {
180   vlib_node_main_t *nm = &vm->node_main;
181   vlib_node_t *n;
182   vlib_node_runtime_t *r;
183
184   n = vec_elt (nm->nodes, node_index);
185   if (n->type == VLIB_NODE_TYPE_PROCESS)
186     {
187       vlib_process_t *p = vec_elt (nm->processes, n->runtime_index);
188       r = &p->node_runtime;
189
190       /* When disabling make sure flags are cleared. */
191       p->flags &= ~(VLIB_PROCESS_RESUME_PENDING
192                     | VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_CLOCK
193                     | VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_EVENT);
194     }
195   else
196     r = vec_elt_at_index (nm->nodes_by_type[n->type], n->runtime_index);
197
198   ASSERT (new_state < VLIB_N_NODE_STATE);
199
200   if (n->type == VLIB_NODE_TYPE_INPUT)
201     {
202       ASSERT (nm->input_node_counts_by_state[n->state] > 0);
203       nm->input_node_counts_by_state[n->state] -= 1;
204       nm->input_node_counts_by_state[new_state] += 1;
205     }
206
207   if (PREDICT_FALSE (r->state == VLIB_NODE_STATE_DISABLED))
208     vlib_node_runtime_perf_counter (vm, r, 0, 0, 0,
209                                     VLIB_NODE_RUNTIME_PERF_RESET);
210
211   n->state = new_state;
212   r->state = new_state;
213 }
214
215 /** \brief Get node dispatch state.
216  @param vm vlib_main_t pointer, varies by thread
217  @param node_index index of the node
218  @return state for node, see vlib_node_state_t
219 */
220 always_inline vlib_node_state_t
221 vlib_node_get_state (vlib_main_t * vm, u32 node_index)
222 {
223   vlib_node_main_t *nm = &vm->node_main;
224   vlib_node_t *n;
225   n = vec_elt (nm->nodes, node_index);
226   return n->state;
227 }
228
229 always_inline void
230 vlib_node_set_flag (vlib_main_t *vm, u32 node_index, u16 flag, u8 enable)
231 {
232   vlib_node_runtime_t *r;
233   vlib_node_t *n;
234
235   n = vlib_get_node (vm, node_index);
236   r = vlib_node_get_runtime (vm, node_index);
237
238   if (enable)
239     {
240       n->flags |= flag;
241       r->flags |= flag;
242     }
243   else
244     {
245       n->flags &= ~flag;
246       r->flags &= ~flag;
247     }
248 }
249
250 always_inline void
251 vlib_node_set_interrupt_pending (vlib_main_t *vm, u32 node_index)
252 {
253   vlib_node_main_t *nm = &vm->node_main;
254   vlib_node_t *n = vec_elt (nm->nodes, node_index);
255   void *interrupts = 0;
256
257   if (n->type == VLIB_NODE_TYPE_INPUT)
258     interrupts = nm->input_node_interrupts;
259   else if (n->type == VLIB_NODE_TYPE_PRE_INPUT)
260     interrupts = nm->pre_input_node_interrupts;
261   else
262     {
263       ASSERT (0);
264       return;
265     }
266
267   if (vm != vlib_get_main ())
268     clib_interrupt_set_atomic (interrupts, n->runtime_index);
269   else
270     clib_interrupt_set (interrupts, n->runtime_index);
271 }
272
273 always_inline vlib_process_t *
274 vlib_get_process_from_node (vlib_main_t * vm, vlib_node_t * node)
275 {
276   vlib_node_main_t *nm = &vm->node_main;
277   ASSERT (node->type == VLIB_NODE_TYPE_PROCESS);
278   return vec_elt (nm->processes, node->runtime_index);
279 }
280
281 always_inline vlib_frame_t *
282 vlib_get_frame (vlib_main_t * vm, vlib_frame_t * f)
283 {
284   ASSERT (f != NULL);
285   ASSERT (f->frame_flags & VLIB_FRAME_IS_ALLOCATED);
286   return f;
287 }
288
289 always_inline void
290 vlib_frame_no_append (vlib_frame_t * f)
291 {
292   f->frame_flags |= VLIB_FRAME_NO_APPEND;
293 }
294
295 /** \brief Get pointer to frame vector data.
296  @param f vlib_frame_t pointer
297  @return pointer to first vector element in frame
298 */
299 always_inline void *
300 vlib_frame_vector_args (vlib_frame_t * f)
301 {
302   ASSERT (f->vector_offset);
303   return (void *) f + f->vector_offset;
304 }
305
306 /** \brief Get pointer to frame vector aux data.
307  @param f vlib_frame_t pointer
308  @return pointer to first vector aux data element in frame
309 */
310 always_inline void *
311 vlib_frame_aux_args (vlib_frame_t *f)
312 {
313   ASSERT (f->aux_offset);
314   return (void *) f + f->aux_offset;
315 }
316
317 /** \brief Get pointer to frame scalar data.
318
319  @param f vlib_frame_t pointer
320
321  @return arbitrary node scalar data
322
323  @sa vlib_frame_vector_args
324 */
325 always_inline void *
326 vlib_frame_scalar_args (vlib_frame_t * f)
327 {
328   ASSERT (f->scalar_offset);
329   return (void *) f + f->scalar_offset;
330 }
331
332 always_inline vlib_next_frame_t *
333 vlib_node_runtime_get_next_frame (vlib_main_t * vm,
334                                   vlib_node_runtime_t * n, u32 next_index)
335 {
336   vlib_node_main_t *nm = &vm->node_main;
337   vlib_next_frame_t *nf;
338
339   ASSERT (next_index < n->n_next_nodes);
340   nf = vec_elt_at_index (nm->next_frames, n->next_frame_index + next_index);
341
342   if (CLIB_DEBUG > 0)
343     {
344       vlib_node_t *node, *next;
345       node = vec_elt (nm->nodes, n->node_index);
346       next = vec_elt (nm->nodes, node->next_nodes[next_index]);
347       ASSERT (nf->node_runtime_index == next->runtime_index);
348     }
349
350   return nf;
351 }
352
353 /** \brief Get pointer to frame by (@c node_index, @c next_index).
354
355  @warning This is not a function that you should call directly.
356  See @ref vlib_get_next_frame instead.
357
358  @param vm vlib_main_t pointer, varies by thread
359  @param node_index index of the node
360  @param next_index graph arc index
361
362  @return pointer to the requested vlib_next_frame_t
363
364  @sa vlib_get_next_frame
365 */
366
367 always_inline vlib_next_frame_t *
368 vlib_node_get_next_frame (vlib_main_t * vm, u32 node_index, u32 next_index)
369 {
370   vlib_node_main_t *nm = &vm->node_main;
371   vlib_node_t *n;
372   vlib_node_runtime_t *r;
373
374   n = vec_elt (nm->nodes, node_index);
375   r = vec_elt_at_index (nm->nodes_by_type[n->type], n->runtime_index);
376   return vlib_node_runtime_get_next_frame (vm, r, next_index);
377 }
378
379 vlib_frame_t *vlib_get_next_frame_internal (vlib_main_t * vm,
380                                             vlib_node_runtime_t * node,
381                                             u32 next_index,
382                                             u32 alloc_new_frame);
383
384 #define vlib_get_next_frame_macro(vm, node, next_index, vectors,              \
385                                   n_vectors_left, alloc_new_frame)            \
386   do                                                                          \
387     {                                                                         \
388       vlib_frame_t *_f = vlib_get_next_frame_internal (                       \
389         (vm), (node), (next_index), (alloc_new_frame));                       \
390       u32 _n = _f->n_vectors;                                                 \
391       (vectors) = vlib_frame_vector_args (_f) + _n * sizeof ((vectors)[0]);   \
392       (n_vectors_left) = VLIB_FRAME_SIZE - _n;                                \
393     }                                                                         \
394   while (0)
395
396 #define vlib_get_next_frame_macro_with_aux(vm, node, next_index, vectors,     \
397                                            n_vectors_left, alloc_new_frame,   \
398                                            aux_data, maybe_no_aux)            \
399   do                                                                          \
400     {                                                                         \
401       vlib_frame_t *_f = vlib_get_next_frame_internal (                       \
402         (vm), (node), (next_index), (alloc_new_frame));                       \
403       u32 _n = _f->n_vectors;                                                 \
404       (vectors) = vlib_frame_vector_args (_f) + _n * sizeof ((vectors)[0]);   \
405       if ((maybe_no_aux) && (_f)->aux_offset == 0)                            \
406         (aux_data) = NULL;                                                    \
407       else                                                                    \
408         (aux_data) = vlib_frame_aux_args (_f) + _n * sizeof ((aux_data)[0]);  \
409       (n_vectors_left) = VLIB_FRAME_SIZE - _n;                                \
410     }                                                                         \
411   while (0)
412
413 /** \brief Get pointer to next frame vector data by
414     (@c vlib_node_runtime_t, @c next_index).
415  Standard single/dual loop boilerplate element.
416  @attention This is a MACRO, with SIDE EFFECTS.
417
418  @param vm vlib_main_t pointer, varies by thread
419  @param node current node vlib_node_runtime_t pointer
420  @param next_index requested graph arc index
421
422  @return @c vectors -- pointer to next available vector slot
423  @return @c n_vectors_left -- number of vector slots available
424 */
425 #define vlib_get_next_frame(vm, node, next_index, vectors, n_vectors_left)    \
426   vlib_get_next_frame_macro (vm, node, next_index, vectors, n_vectors_left,   \
427                              /* alloc new frame */ 0)
428
429 #define vlib_get_new_next_frame(vm, node, next_index, vectors,                \
430                                 n_vectors_left)                               \
431   vlib_get_next_frame_macro (vm, node, next_index, vectors, n_vectors_left,   \
432                              /* alloc new frame */ 1)
433
434 /** \brief Get pointer to next frame vector data and next frame aux data by
435     (@c vlib_node_runtime_t, @c next_index).
436  Standard single/dual loop boilerplate element.
437  @attention This is a MACRO, with SIDE EFFECTS.
438  @attention This MACRO is unsafe in case the next node does not support
439  aux_data
440
441  @param vm vlib_main_t pointer, varies by thread
442  @param node current node vlib_node_runtime_t pointer
443  @param next_index requested graph arc index
444
445  @return @c vectors -- pointer to next available vector slot
446  @return @c aux_data -- pointer to next available aux data slot
447  @return @c n_vectors_left -- number of vector slots available
448 */
449 #define vlib_get_next_frame_with_aux(vm, node, next_index, vectors, aux_data, \
450                                      n_vectors_left)                          \
451   vlib_get_next_frame_macro_with_aux (                                        \
452     vm, node, next_index, vectors, n_vectors_left, /* alloc new frame */ 0,   \
453     aux_data, /* maybe_no_aux */ 0)
454
455 #define vlib_get_new_next_frame_with_aux(vm, node, next_index, vectors,       \
456                                          aux_data, n_vectors_left)            \
457   vlib_get_next_frame_macro_with_aux (                                        \
458     vm, node, next_index, vectors, n_vectors_left, /* alloc new frame */ 1,   \
459     aux_data, /* maybe_no_aux */ 0)
460
461 /** \brief Get pointer to next frame vector data and next frame aux data by
462     (@c vlib_node_runtime_t, @c next_index).
463  Standard single/dual loop boilerplate element.
464  @attention This is a MACRO, with SIDE EFFECTS.
465  @attention This MACRO is safe in case the next node does not support aux_data.
466  In that case aux_data is set to NULL.
467
468  @param vm vlib_main_t pointer, varies by thread
469  @param node current node vlib_node_runtime_t pointer
470  @param next_index requested graph arc index
471
472  @return @c vectors -- pointer to next available vector slot
473  @return @c aux_data -- pointer to next available aux data slot
474  @return @c n_vectors_left -- number of vector slots available
475 */
476 #define vlib_get_next_frame_with_aux_safe(vm, node, next_index, vectors,      \
477                                           aux_data, n_vectors_left)           \
478   vlib_get_next_frame_macro_with_aux (                                        \
479     vm, node, next_index, vectors, n_vectors_left, /* alloc new frame */ 0,   \
480     aux_data, /* maybe_no_aux */ 1)
481
482 #define vlib_get_new_next_frame_with_aux_safe(vm, node, next_index, vectors,  \
483                                               aux_data, n_vectors_left)       \
484   vlib_get_next_frame_macro_with_aux (                                        \
485     vm, node, next_index, vectors, n_vectors_left, /* alloc new frame */ 1,   \
486     aux_data, /* maybe_no_aux */ 1)
487
488 /** \brief Release pointer to next frame vector data.
489  Standard single/dual loop boilerplate element.
490  @param vm vlib_main_t pointer, varies by thread
491  @param r current node vlib_node_runtime_t pointer
492  @param next_index graph arc index
493  @param n_packets_left number of slots still available in vector
494 */
495 void
496 vlib_put_next_frame (vlib_main_t * vm,
497                      vlib_node_runtime_t * r,
498                      u32 next_index, u32 n_packets_left);
499
500 /* Combination get plus put.  Returns vector argument just added. */
501 #define vlib_set_next_frame(vm,node,next_index,v)                       \
502 ({                                                                      \
503   uword _n_left;                                                        \
504   vlib_get_next_frame ((vm), (node), (next_index), (v), _n_left);       \
505   ASSERT (_n_left > 0);                                                 \
506   vlib_put_next_frame ((vm), (node), (next_index), _n_left - 1);        \
507   (v);                                                                  \
508 })
509
510 #define vlib_set_next_frame_with_aux_safe(vm, node, next_index, v, aux)       \
511   ({                                                                          \
512     uword _n_left;                                                            \
513     vlib_get_next_frame_with_aux_safe ((vm), (node), (next_index), (v),       \
514                                        (aux), _n_left);                       \
515     ASSERT (_n_left > 0);                                                     \
516     vlib_put_next_frame ((vm), (node), (next_index), _n_left - 1);            \
517     (v);                                                                      \
518   })
519
520 always_inline void
521 vlib_set_next_frame_buffer (vlib_main_t * vm,
522                             vlib_node_runtime_t * node,
523                             u32 next_index, u32 buffer_index)
524 {
525   u32 *p;
526   p = vlib_set_next_frame (vm, node, next_index, p);
527   p[0] = buffer_index;
528 }
529
530 always_inline void
531 vlib_set_next_frame_buffer_with_aux_safe (vlib_main_t *vm,
532                                           vlib_node_runtime_t *node,
533                                           u32 next_index, u32 buffer_index,
534                                           u32 aux)
535 {
536   u32 *p;
537   u32 *a;
538   p = vlib_set_next_frame_with_aux_safe (vm, node, next_index, p, a);
539   p[0] = buffer_index;
540   if (a)
541     a[0] = aux;
542 }
543
544 vlib_frame_t *vlib_get_frame_to_node (vlib_main_t * vm, u32 to_node_index);
545 void vlib_put_frame_to_node (vlib_main_t * vm, u32 to_node_index,
546                              vlib_frame_t * f);
547
548 always_inline uword
549 vlib_in_process_context (vlib_main_t * vm)
550 {
551   return vm->node_main.current_process_index != ~0;
552 }
553
554 always_inline vlib_process_t *
555 vlib_get_current_process (vlib_main_t * vm)
556 {
557   vlib_node_main_t *nm = &vm->node_main;
558   if (vlib_in_process_context (vm))
559     return vec_elt (nm->processes, nm->current_process_index);
560   return 0;
561 }
562
563 always_inline uword
564 vlib_current_process (vlib_main_t * vm)
565 {
566   return vlib_get_current_process (vm)->node_runtime.node_index;
567 }
568
569 always_inline u32
570 vlib_get_current_process_node_index (vlib_main_t * vm)
571 {
572   vlib_process_t *process = vlib_get_current_process (vm);
573   return process->node_runtime.node_index;
574 }
575
576 /** Returns TRUE if a process suspend time is less than 10us
577     @param dt - remaining poll time in seconds
578     @returns 1 if dt < 10e-6, 0 otherwise
579 */
580 always_inline uword
581 vlib_process_suspend_time_is_zero (f64 dt)
582 {
583   return dt < 10e-6;
584 }
585
586 /** Suspend a vlib cooperative multi-tasking thread for a period of time
587     @param vm - vlib_main_t *
588     @param dt - suspend interval in seconds
589     @returns VLIB_PROCESS_RESUME_LONGJMP_RESUME, routinely ignored
590 */
591
592 always_inline uword
593 vlib_process_suspend (vlib_main_t * vm, f64 dt)
594 {
595   uword r;
596   vlib_node_main_t *nm = &vm->node_main;
597   vlib_process_t *p = vec_elt (nm->processes, nm->current_process_index);
598
599   if (vlib_process_suspend_time_is_zero (dt))
600     return VLIB_PROCESS_RESUME_LONGJMP_RESUME;
601
602   p->flags |= VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_CLOCK;
603   r = clib_setjmp (&p->resume_longjmp, VLIB_PROCESS_RESUME_LONGJMP_SUSPEND);
604   if (r == VLIB_PROCESS_RESUME_LONGJMP_SUSPEND)
605     {
606       /* expiration time in 10us ticks */
607       p->resume_clock_interval = dt * 1e5;
608       vlib_process_start_switch_stack (vm, 0);
609       clib_longjmp (&p->return_longjmp, VLIB_PROCESS_RETURN_LONGJMP_SUSPEND);
610     }
611   else
612     vlib_process_finish_switch_stack (vm);
613
614   return r;
615 }
616
617 always_inline void
618 vlib_process_free_event_type (vlib_process_t * p, uword t,
619                               uword is_one_time_event)
620 {
621   ASSERT (!pool_is_free_index (p->event_type_pool, t));
622   pool_put_index (p->event_type_pool, t);
623   if (is_one_time_event)
624     p->one_time_event_type_bitmap =
625       clib_bitmap_andnoti (p->one_time_event_type_bitmap, t);
626 }
627
628 always_inline void
629 vlib_process_maybe_free_event_type (vlib_process_t * p, uword t)
630 {
631   ASSERT (!pool_is_free_index (p->event_type_pool, t));
632   if (clib_bitmap_get (p->one_time_event_type_bitmap, t))
633     vlib_process_free_event_type (p, t, /* is_one_time_event */ 1);
634 }
635
636 always_inline void *
637 vlib_process_get_event_data (vlib_main_t * vm,
638                              uword * return_event_type_opaque)
639 {
640   vlib_node_main_t *nm = &vm->node_main;
641   vlib_process_t *p;
642   vlib_process_event_type_t *et;
643   uword t;
644   void *event_data_vector;
645
646   p = vec_elt (nm->processes, nm->current_process_index);
647
648   /* Find first type with events ready.
649      Return invalid type when there's nothing there. */
650   t = clib_bitmap_first_set (p->non_empty_event_type_bitmap);
651   if (t == ~0)
652     return 0;
653
654   p->non_empty_event_type_bitmap =
655     clib_bitmap_andnoti (p->non_empty_event_type_bitmap, t);
656
657   ASSERT (_vec_len (p->pending_event_data_by_type_index[t]) > 0);
658   event_data_vector = p->pending_event_data_by_type_index[t];
659   p->pending_event_data_by_type_index[t] = 0;
660
661   et = pool_elt_at_index (p->event_type_pool, t);
662
663   /* Return user's opaque value and possibly index. */
664   *return_event_type_opaque = et->opaque;
665
666   vlib_process_maybe_free_event_type (p, t);
667
668   return event_data_vector;
669 }
670
671 /* Return event data vector for later reuse.  We reuse event data to avoid
672    repeatedly allocating event vectors in cases where we care about speed. */
673 always_inline void
674 vlib_process_put_event_data (vlib_main_t * vm, void *event_data)
675 {
676   vlib_node_main_t *nm = &vm->node_main;
677   vec_add1 (nm->recycled_event_data_vectors, event_data);
678 }
679
680 /** Return the first event type which has occurred and a vector of per-event
681     data of that type, or a timeout indication
682
683     @param vm - vlib_main_t pointer
684     @param data_vector - pointer to a (uword *) vector to receive event data
685     @returns either an event type and a vector of per-event instance data,
686     or ~0 to indicate a timeout.
687 */
688
689 always_inline uword
690 vlib_process_get_events (vlib_main_t * vm, uword ** data_vector)
691 {
692   vlib_node_main_t *nm = &vm->node_main;
693   vlib_process_t *p;
694   vlib_process_event_type_t *et;
695   uword r, t, l;
696
697   p = vec_elt (nm->processes, nm->current_process_index);
698
699   /* Find first type with events ready.
700      Return invalid type when there's nothing there. */
701   t = clib_bitmap_first_set (p->non_empty_event_type_bitmap);
702   if (t == ~0)
703     return t;
704
705   p->non_empty_event_type_bitmap =
706     clib_bitmap_andnoti (p->non_empty_event_type_bitmap, t);
707
708   l = _vec_len (p->pending_event_data_by_type_index[t]);
709   if (data_vector)
710     vec_add (*data_vector, p->pending_event_data_by_type_index[t], l);
711   vec_set_len (p->pending_event_data_by_type_index[t], 0);
712
713   et = pool_elt_at_index (p->event_type_pool, t);
714
715   /* Return user's opaque value. */
716   r = et->opaque;
717
718   vlib_process_maybe_free_event_type (p, t);
719
720   return r;
721 }
722
723 always_inline uword
724 vlib_process_get_events_helper (vlib_process_t * p, uword t,
725                                 uword ** data_vector)
726 {
727   uword l;
728
729   p->non_empty_event_type_bitmap =
730     clib_bitmap_andnoti (p->non_empty_event_type_bitmap, t);
731
732   l = _vec_len (p->pending_event_data_by_type_index[t]);
733   if (data_vector)
734     vec_add (*data_vector, p->pending_event_data_by_type_index[t], l);
735   vec_set_len (p->pending_event_data_by_type_index[t], 0);
736
737   vlib_process_maybe_free_event_type (p, t);
738
739   return l;
740 }
741
742 /* As above but query as specified type of event.  Returns number of
743    events found. */
744 always_inline uword
745 vlib_process_get_events_with_type (vlib_main_t * vm, uword ** data_vector,
746                                    uword with_type_opaque)
747 {
748   vlib_node_main_t *nm = &vm->node_main;
749   vlib_process_t *p;
750   uword t, *h;
751
752   p = vec_elt (nm->processes, nm->current_process_index);
753   h = hash_get (p->event_type_index_by_type_opaque, with_type_opaque);
754   if (!h)
755     /* This can happen when an event has not yet been
756        signaled with given opaque type. */
757     return 0;
758
759   t = h[0];
760   if (!clib_bitmap_get (p->non_empty_event_type_bitmap, t))
761     return 0;
762
763   return vlib_process_get_events_helper (p, t, data_vector);
764 }
765
766 always_inline uword *
767 vlib_process_wait_for_event (vlib_main_t * vm)
768 {
769   vlib_node_main_t *nm = &vm->node_main;
770   vlib_process_t *p;
771   uword r;
772
773   p = vec_elt (nm->processes, nm->current_process_index);
774   if (clib_bitmap_is_zero (p->non_empty_event_type_bitmap))
775     {
776       p->flags |= VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_EVENT;
777       r =
778         clib_setjmp (&p->resume_longjmp, VLIB_PROCESS_RESUME_LONGJMP_SUSPEND);
779       if (r == VLIB_PROCESS_RESUME_LONGJMP_SUSPEND)
780         {
781           vlib_process_start_switch_stack (vm, 0);
782           clib_longjmp (&p->return_longjmp,
783                         VLIB_PROCESS_RETURN_LONGJMP_SUSPEND);
784         }
785       else
786         vlib_process_finish_switch_stack (vm);
787     }
788
789   return p->non_empty_event_type_bitmap;
790 }
791
792 always_inline uword
793 vlib_process_wait_for_one_time_event (vlib_main_t * vm,
794                                       uword ** data_vector,
795                                       uword with_type_index)
796 {
797   vlib_node_main_t *nm = &vm->node_main;
798   vlib_process_t *p;
799   uword r;
800
801   p = vec_elt (nm->processes, nm->current_process_index);
802   ASSERT (!pool_is_free_index (p->event_type_pool, with_type_index));
803   while (!clib_bitmap_get (p->non_empty_event_type_bitmap, with_type_index))
804     {
805       p->flags |= VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_EVENT;
806       r =
807         clib_setjmp (&p->resume_longjmp, VLIB_PROCESS_RESUME_LONGJMP_SUSPEND);
808       if (r == VLIB_PROCESS_RESUME_LONGJMP_SUSPEND)
809         {
810           vlib_process_start_switch_stack (vm, 0);
811           clib_longjmp (&p->return_longjmp,
812                         VLIB_PROCESS_RETURN_LONGJMP_SUSPEND);
813         }
814       else
815         vlib_process_finish_switch_stack (vm);
816     }
817
818   return vlib_process_get_events_helper (p, with_type_index, data_vector);
819 }
820
821 always_inline uword
822 vlib_process_wait_for_event_with_type (vlib_main_t * vm,
823                                        uword ** data_vector,
824                                        uword with_type_opaque)
825 {
826   vlib_node_main_t *nm = &vm->node_main;
827   vlib_process_t *p;
828   uword r, *h;
829
830   p = vec_elt (nm->processes, nm->current_process_index);
831   h = hash_get (p->event_type_index_by_type_opaque, with_type_opaque);
832   while (!h || !clib_bitmap_get (p->non_empty_event_type_bitmap, h[0]))
833     {
834       p->flags |= VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_EVENT;
835       r =
836         clib_setjmp (&p->resume_longjmp, VLIB_PROCESS_RESUME_LONGJMP_SUSPEND);
837       if (r == VLIB_PROCESS_RESUME_LONGJMP_SUSPEND)
838         {
839           vlib_process_start_switch_stack (vm, 0);
840           clib_longjmp (&p->return_longjmp,
841                         VLIB_PROCESS_RETURN_LONGJMP_SUSPEND);
842         }
843       else
844         vlib_process_finish_switch_stack (vm);
845
846       /* See if unknown event type has been signaled now. */
847       if (!h)
848         h = hash_get (p->event_type_index_by_type_opaque, with_type_opaque);
849     }
850
851   return vlib_process_get_events_helper (p, h[0], data_vector);
852 }
853
854 /** Suspend a cooperative multi-tasking thread
855     Waits for an event, or for the indicated number of seconds to elapse
856     @param vm - vlib_main_t pointer
857     @param dt - timeout, in seconds.
858     @returns the remaining time interval
859 */
860
861 always_inline f64
862 vlib_process_wait_for_event_or_clock (vlib_main_t * vm, f64 dt)
863 {
864   vlib_node_main_t *nm = &vm->node_main;
865   vlib_process_t *p;
866   f64 wakeup_time;
867   uword r;
868
869   p = vec_elt (nm->processes, nm->current_process_index);
870
871   if (vlib_process_suspend_time_is_zero (dt)
872       || !clib_bitmap_is_zero (p->non_empty_event_type_bitmap))
873     return dt;
874
875   wakeup_time = vlib_time_now (vm) + dt;
876
877   /* Suspend waiting for both clock and event to occur. */
878   p->flags |= (VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_EVENT
879                | VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_CLOCK);
880
881   r = clib_setjmp (&p->resume_longjmp, VLIB_PROCESS_RESUME_LONGJMP_SUSPEND);
882   if (r == VLIB_PROCESS_RESUME_LONGJMP_SUSPEND)
883     {
884       p->resume_clock_interval = dt * 1e5;
885       vlib_process_start_switch_stack (vm, 0);
886       clib_longjmp (&p->return_longjmp, VLIB_PROCESS_RETURN_LONGJMP_SUSPEND);
887     }
888   else
889     vlib_process_finish_switch_stack (vm);
890
891   /* Return amount of time still left to sleep.
892      If <= 0 then we've been waken up by the clock (and not an event). */
893   return wakeup_time - vlib_time_now (vm);
894 }
895
896 always_inline vlib_process_event_type_t *
897 vlib_process_new_event_type (vlib_process_t * p, uword with_type_opaque)
898 {
899   vlib_process_event_type_t *et;
900   pool_get (p->event_type_pool, et);
901   et->opaque = with_type_opaque;
902   return et;
903 }
904
905 always_inline uword
906 vlib_process_create_one_time_event (vlib_main_t * vm, uword node_index,
907                                     uword with_type_opaque)
908 {
909   vlib_node_main_t *nm = &vm->node_main;
910   vlib_node_t *n = vlib_get_node (vm, node_index);
911   vlib_process_t *p = vec_elt (nm->processes, n->runtime_index);
912   vlib_process_event_type_t *et;
913   uword t;
914
915   et = vlib_process_new_event_type (p, with_type_opaque);
916   t = et - p->event_type_pool;
917   p->one_time_event_type_bitmap =
918     clib_bitmap_ori (p->one_time_event_type_bitmap, t);
919   return t;
920 }
921
922 always_inline void
923 vlib_process_delete_one_time_event (vlib_main_t * vm, uword node_index,
924                                     uword t)
925 {
926   vlib_node_main_t *nm = &vm->node_main;
927   vlib_node_t *n = vlib_get_node (vm, node_index);
928   vlib_process_t *p = vec_elt (nm->processes, n->runtime_index);
929
930   ASSERT (clib_bitmap_get (p->one_time_event_type_bitmap, t));
931   vlib_process_free_event_type (p, t, /* is_one_time_event */ 1);
932 }
933
934 always_inline void *
935 vlib_process_signal_event_helper (vlib_node_main_t * nm,
936                                   vlib_node_t * n,
937                                   vlib_process_t * p,
938                                   uword t,
939                                   uword n_data_elts, uword n_data_elt_bytes)
940 {
941   uword p_flags, add_to_pending, delete_from_wheel;
942   u8 *data_to_be_written_by_caller;
943   vec_attr_t va = { .elt_sz = n_data_elt_bytes };
944
945   ASSERT (n->type == VLIB_NODE_TYPE_PROCESS);
946
947   ASSERT (!pool_is_free_index (p->event_type_pool, t));
948
949   vec_validate (p->pending_event_data_by_type_index, t);
950
951   /* Resize data vector and return caller's data to be written. */
952   {
953     u8 *data_vec = p->pending_event_data_by_type_index[t];
954     uword l;
955
956     if (!data_vec && vec_len (nm->recycled_event_data_vectors))
957       {
958         data_vec = vec_pop (nm->recycled_event_data_vectors);
959         vec_reset_length (data_vec);
960       }
961
962     l = vec_len (data_vec);
963
964     data_vec = _vec_realloc_internal (data_vec, l + n_data_elts, &va);
965
966     p->pending_event_data_by_type_index[t] = data_vec;
967     data_to_be_written_by_caller = data_vec + l * n_data_elt_bytes;
968   }
969
970   p->non_empty_event_type_bitmap =
971     clib_bitmap_ori (p->non_empty_event_type_bitmap, t);
972
973   p_flags = p->flags;
974
975   /* Event was already signalled? */
976   add_to_pending = (p_flags & VLIB_PROCESS_RESUME_PENDING) == 0;
977
978   /* Process will resume when suspend time elapses? */
979   delete_from_wheel = 0;
980   if (p_flags & VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_CLOCK)
981     {
982       /* Waiting for both event and clock? */
983       if (p_flags & VLIB_PROCESS_IS_SUSPENDED_WAITING_FOR_EVENT)
984         {
985           if (!TW (tw_timer_handle_is_free)
986               ((TWT (tw_timer_wheel) *) nm->timing_wheel,
987                p->stop_timer_handle))
988             delete_from_wheel = 1;
989           else
990             /* timer just popped so process should already be on the list */
991             add_to_pending = 0;
992         }
993       else
994         /* Waiting only for clock.  Event will be queue and may be
995            handled when timer expires. */
996         add_to_pending = 0;
997     }
998
999   /* Never add current process to pending vector since current process is
1000      already running. */
1001   add_to_pending &= nm->current_process_index != n->runtime_index;
1002
1003   if (add_to_pending)
1004     {
1005       u32 x = vlib_timing_wheel_data_set_suspended_process (n->runtime_index);
1006       p->flags = p_flags | VLIB_PROCESS_RESUME_PENDING;
1007       vec_add1 (nm->data_from_advancing_timing_wheel, x);
1008       if (delete_from_wheel)
1009         {
1010           TW (tw_timer_stop)
1011           ((TWT (tw_timer_wheel) *) nm->timing_wheel, p->stop_timer_handle);
1012           p->stop_timer_handle = ~0;
1013         }
1014     }
1015
1016   return data_to_be_written_by_caller;
1017 }
1018
1019 always_inline void *
1020 vlib_process_signal_event_data (vlib_main_t * vm,
1021                                 uword node_index,
1022                                 uword type_opaque,
1023                                 uword n_data_elts, uword n_data_elt_bytes)
1024 {
1025   vlib_node_main_t *nm = &vm->node_main;
1026   vlib_node_t *n = vlib_get_node (vm, node_index);
1027   vlib_process_t *p = vec_elt (nm->processes, n->runtime_index);
1028   uword *h, t;
1029
1030   /* Must be in main thread */
1031   ASSERT (vlib_get_thread_index () == 0);
1032
1033   h = hash_get (p->event_type_index_by_type_opaque, type_opaque);
1034   if (!h)
1035     {
1036       vlib_process_event_type_t *et =
1037         vlib_process_new_event_type (p, type_opaque);
1038       t = et - p->event_type_pool;
1039       hash_set (p->event_type_index_by_type_opaque, type_opaque, t);
1040     }
1041   else
1042     t = h[0];
1043
1044   return vlib_process_signal_event_helper (nm, n, p, t, n_data_elts,
1045                                            n_data_elt_bytes);
1046 }
1047
1048 always_inline void *
1049 vlib_process_signal_event_at_time (vlib_main_t * vm,
1050                                    f64 dt,
1051                                    uword node_index,
1052                                    uword type_opaque,
1053                                    uword n_data_elts, uword n_data_elt_bytes)
1054 {
1055   vlib_node_main_t *nm = &vm->node_main;
1056   vlib_node_t *n = vlib_get_node (vm, node_index);
1057   vlib_process_t *p = vec_elt (nm->processes, n->runtime_index);
1058   uword *h, t;
1059
1060   h = hash_get (p->event_type_index_by_type_opaque, type_opaque);
1061   if (!h)
1062     {
1063       vlib_process_event_type_t *et =
1064         vlib_process_new_event_type (p, type_opaque);
1065       t = et - p->event_type_pool;
1066       hash_set (p->event_type_index_by_type_opaque, type_opaque, t);
1067     }
1068   else
1069     t = h[0];
1070
1071   if (vlib_process_suspend_time_is_zero (dt))
1072     return vlib_process_signal_event_helper (nm, n, p, t, n_data_elts,
1073                                              n_data_elt_bytes);
1074   else
1075     {
1076       vlib_signal_timed_event_data_t *te;
1077
1078       pool_get_aligned (nm->signal_timed_event_data_pool, te, sizeof (te[0]));
1079
1080       te->n_data_elts = n_data_elts;
1081       te->n_data_elt_bytes = n_data_elt_bytes;
1082       te->n_data_bytes = n_data_elts * n_data_elt_bytes;
1083
1084       /* Assert that structure fields are big enough. */
1085       ASSERT (te->n_data_elts == n_data_elts);
1086       ASSERT (te->n_data_elt_bytes == n_data_elt_bytes);
1087       ASSERT (te->n_data_bytes == n_data_elts * n_data_elt_bytes);
1088
1089       te->process_node_index = n->runtime_index;
1090       te->event_type_index = t;
1091
1092       p->stop_timer_handle =
1093         TW (tw_timer_start) ((TWT (tw_timer_wheel) *) nm->timing_wheel,
1094                              vlib_timing_wheel_data_set_timed_event
1095                              (te - nm->signal_timed_event_data_pool),
1096                              0 /* timer_id */ ,
1097                              (vlib_time_now (vm) + dt) * 1e5);
1098
1099       /* Inline data big enough to hold event? */
1100       if (te->n_data_bytes < sizeof (te->inline_event_data))
1101         return te->inline_event_data;
1102       else
1103         {
1104           te->event_data_as_vector = 0;
1105           vec_resize (te->event_data_as_vector, te->n_data_bytes);
1106           return te->event_data_as_vector;
1107         }
1108     }
1109 }
1110
1111 always_inline void *
1112 vlib_process_signal_one_time_event_data (vlib_main_t * vm,
1113                                          uword node_index,
1114                                          uword type_index,
1115                                          uword n_data_elts,
1116                                          uword n_data_elt_bytes)
1117 {
1118   vlib_node_main_t *nm = &vm->node_main;
1119   vlib_node_t *n = vlib_get_node (vm, node_index);
1120   vlib_process_t *p = vec_elt (nm->processes, n->runtime_index);
1121   return vlib_process_signal_event_helper (nm, n, p, type_index, n_data_elts,
1122                                            n_data_elt_bytes);
1123 }
1124
1125 always_inline void
1126 vlib_process_signal_event (vlib_main_t * vm,
1127                            uword node_index, uword type_opaque, uword data)
1128 {
1129   uword *d = vlib_process_signal_event_data (vm, node_index, type_opaque,
1130                                              1 /* elts */ , sizeof (uword));
1131   d[0] = data;
1132 }
1133
1134 always_inline void
1135 vlib_process_signal_event_pointer (vlib_main_t * vm,
1136                                    uword node_index,
1137                                    uword type_opaque, void *data)
1138 {
1139   void **d = vlib_process_signal_event_data (vm, node_index, type_opaque,
1140                                              1 /* elts */ , sizeof (data));
1141   d[0] = data;
1142 }
1143
1144 /**
1145  * Signal event to process from any thread.
1146  *
1147  * When in doubt, use this.
1148  */
1149 always_inline void
1150 vlib_process_signal_event_mt (vlib_main_t * vm,
1151                               uword node_index, uword type_opaque, uword data)
1152 {
1153   if (vlib_get_thread_index () != 0)
1154     {
1155       vlib_process_signal_event_mt_args_t args = {
1156         .node_index = node_index,
1157         .type_opaque = type_opaque,
1158         .data = data,
1159       };
1160       vlib_rpc_call_main_thread (vlib_process_signal_event_mt_helper,
1161                                  (u8 *) & args, sizeof (args));
1162     }
1163   else
1164     vlib_process_signal_event (vm, node_index, type_opaque, data);
1165 }
1166
1167 always_inline void
1168 vlib_process_signal_one_time_event (vlib_main_t * vm,
1169                                     uword node_index,
1170                                     uword type_index, uword data)
1171 {
1172   uword *d =
1173     vlib_process_signal_one_time_event_data (vm, node_index, type_index,
1174                                              1 /* elts */ , sizeof (uword));
1175   d[0] = data;
1176 }
1177
1178 always_inline void
1179 vlib_signal_one_time_waiting_process (vlib_main_t * vm,
1180                                       vlib_one_time_waiting_process_t * p)
1181 {
1182   vlib_process_signal_one_time_event (vm, p->node_index, p->one_time_event,
1183                                       /* data */ ~0);
1184   clib_memset (p, ~0, sizeof (p[0]));
1185 }
1186
1187 always_inline void
1188 vlib_signal_one_time_waiting_process_vector (vlib_main_t * vm,
1189                                              vlib_one_time_waiting_process_t
1190                                              ** wps)
1191 {
1192   vlib_one_time_waiting_process_t *wp;
1193   vec_foreach (wp, *wps) vlib_signal_one_time_waiting_process (vm, wp);
1194   vec_free (*wps);
1195 }
1196
1197 always_inline void
1198 vlib_current_process_wait_for_one_time_event (vlib_main_t * vm,
1199                                               vlib_one_time_waiting_process_t
1200                                               * p)
1201 {
1202   p->node_index = vlib_current_process (vm);
1203   p->one_time_event = vlib_process_create_one_time_event (vm, p->node_index,    /* type opaque */
1204                                                           ~0);
1205   vlib_process_wait_for_one_time_event (vm,
1206                                         /* don't care about data */ 0,
1207                                         p->one_time_event);
1208 }
1209
1210 always_inline void
1211 vlib_current_process_wait_for_one_time_event_vector (vlib_main_t * vm,
1212                                                      vlib_one_time_waiting_process_t
1213                                                      ** wps)
1214 {
1215   vlib_one_time_waiting_process_t *wp;
1216   vec_add2 (*wps, wp, 1);
1217   vlib_current_process_wait_for_one_time_event (vm, wp);
1218 }
1219
1220 always_inline u32
1221 vlib_node_runtime_update_main_loop_vector_stats (vlib_main_t * vm,
1222                                                  vlib_node_runtime_t * node,
1223                                                  uword n_vectors)
1224 {
1225   u32 i, d, vi0, vi1;
1226   u32 i0, i1;
1227
1228   ASSERT (is_pow2 (ARRAY_LEN (node->main_loop_vector_stats)));
1229   i = ((vm->main_loop_count >> VLIB_LOG2_MAIN_LOOPS_PER_STATS_UPDATE)
1230        & (ARRAY_LEN (node->main_loop_vector_stats) - 1));
1231   i0 = i ^ 0;
1232   i1 = i ^ 1;
1233   d = ((vm->main_loop_count >> VLIB_LOG2_MAIN_LOOPS_PER_STATS_UPDATE)
1234        -
1235        (node->main_loop_count_last_dispatch >>
1236         VLIB_LOG2_MAIN_LOOPS_PER_STATS_UPDATE));
1237   vi0 = node->main_loop_vector_stats[i0];
1238   vi1 = node->main_loop_vector_stats[i1];
1239   vi0 = d == 0 ? vi0 : 0;
1240   vi1 = d <= 1 ? vi1 : 0;
1241   vi0 += n_vectors;
1242   node->main_loop_vector_stats[i0] = vi0;
1243   node->main_loop_vector_stats[i1] = vi1;
1244   node->main_loop_count_last_dispatch = vm->main_loop_count;
1245   /* Return previous counter. */
1246   return node->main_loop_vector_stats[i1];
1247 }
1248
1249 always_inline f64
1250 vlib_node_vectors_per_main_loop_as_float (vlib_main_t * vm, u32 node_index)
1251 {
1252   vlib_node_runtime_t *rt = vlib_node_get_runtime (vm, node_index);
1253   u32 v;
1254
1255   v = vlib_node_runtime_update_main_loop_vector_stats (vm, rt,  /* n_vectors */
1256                                                        0);
1257   return (f64) v / (1 << VLIB_LOG2_MAIN_LOOPS_PER_STATS_UPDATE);
1258 }
1259
1260 always_inline u32
1261 vlib_node_vectors_per_main_loop_as_integer (vlib_main_t * vm, u32 node_index)
1262 {
1263   vlib_node_runtime_t *rt = vlib_node_get_runtime (vm, node_index);
1264   u32 v;
1265
1266   v = vlib_node_runtime_update_main_loop_vector_stats (vm, rt,  /* n_vectors */
1267                                                        0);
1268   return v >> VLIB_LOG2_MAIN_LOOPS_PER_STATS_UPDATE;
1269 }
1270
1271 void vlib_frame_free (vlib_main_t *vm, vlib_frame_t *f);
1272
1273 /* Return the edge index if present, ~0 otherwise */
1274 uword vlib_node_get_next (vlib_main_t * vm, uword node, uword next_node);
1275
1276 /* Add next node to given node in given slot. */
1277 uword
1278 vlib_node_add_next_with_slot (vlib_main_t * vm,
1279                               uword node, uword next_node, uword slot);
1280
1281 /* As above but adds to end of node's next vector. */
1282 always_inline uword
1283 vlib_node_add_next (vlib_main_t * vm, uword node, uword next_node)
1284 {
1285   return vlib_node_add_next_with_slot (vm, node, next_node, ~0);
1286 }
1287
1288 /* Add next node to given node in given slot. */
1289 uword
1290 vlib_node_add_named_next_with_slot (vlib_main_t * vm,
1291                                     uword node, char *next_name, uword slot);
1292
1293 /* As above but adds to end of node's next vector. */
1294 always_inline uword
1295 vlib_node_add_named_next (vlib_main_t * vm, uword node, char *name)
1296 {
1297   return vlib_node_add_named_next_with_slot (vm, node, name, ~0);
1298 }
1299
1300 /**
1301  * Get list of nodes
1302  */
1303 void
1304 vlib_node_get_nodes (vlib_main_t * vm, u32 max_threads, int include_stats,
1305                      int barrier_sync, vlib_node_t **** node_dupsp,
1306                      vlib_main_t *** stat_vmsp);
1307
1308 /* Query node given name. */
1309 vlib_node_t *vlib_get_node_by_name (vlib_main_t * vm, u8 * name);
1310
1311 /* Rename a node. */
1312 void vlib_node_rename (vlib_main_t * vm, u32 node_index, char *fmt, ...);
1313
1314 /* Register new packet processing node.  Nodes can be registered
1315    dynamically via this call or statically via the VLIB_REGISTER_NODE
1316    macro. */
1317 u32 vlib_register_node (vlib_main_t *vm, vlib_node_registration_t *r,
1318                         char *fmt, ...);
1319
1320 /* Register all node function variants */
1321 void vlib_register_all_node_march_variants (vlib_main_t *vm);
1322
1323 /* Register all static nodes registered via VLIB_REGISTER_NODE. */
1324 void vlib_register_all_static_nodes (vlib_main_t * vm);
1325
1326 /* Start a process. */
1327 void vlib_start_process (vlib_main_t * vm, uword process_index);
1328
1329 /* Sync up runtime and main node stats. */
1330 void vlib_node_sync_stats (vlib_main_t * vm, vlib_node_t * n);
1331 void vlib_node_runtime_sync_stats (vlib_main_t *vm, vlib_node_runtime_t *r,
1332                                    uword n_calls, uword n_vectors,
1333                                    uword n_clocks);
1334 void vlib_node_runtime_sync_stats_node (vlib_node_t *n, vlib_node_runtime_t *r,
1335                                         uword n_calls, uword n_vectors,
1336                                         uword n_clocks);
1337
1338 /* Node graph initialization function. */
1339 clib_error_t *vlib_node_main_init (vlib_main_t * vm);
1340
1341 format_function_t format_vlib_node_graph;
1342 format_function_t format_vlib_node_name;
1343 format_function_t format_vlib_next_node_name;
1344 format_function_t format_vlib_node_and_next;
1345 format_function_t format_vlib_cpu_time;
1346 format_function_t format_vlib_time;
1347 /* Parse node name -> node index. */
1348 unformat_function_t unformat_vlib_node;
1349
1350 always_inline void
1351 vlib_node_increment_counter (vlib_main_t * vm, u32 node_index,
1352                              u32 counter_index, u64 increment)
1353 {
1354   vlib_node_t *n = vlib_get_node (vm, node_index);
1355   vlib_error_main_t *em = &vm->error_main;
1356   u32 node_counter_base_index = n->error_heap_index;
1357   em->counters[node_counter_base_index + counter_index] += increment;
1358 }
1359
1360 /** @brief Create a vlib process
1361  *  @param vm &vlib_global_main
1362  *  @param f the process node function
1363  *  @param log2_n_stack_bytes size of the process stack, defaults to 16K
1364  *  @return newly-create node index
1365  *  @warning call only on the main thread. Barrier sync required
1366  */
1367 u32 vlib_process_create (vlib_main_t * vm, char *name,
1368                          vlib_node_function_t * f, u32 log2_n_stack_bytes);
1369
1370 always_inline int
1371 vlib_node_set_dispatch_wrapper (vlib_main_t *vm, vlib_node_function_t *fn)
1372 {
1373   if (fn && vm->dispatch_wrapper_fn)
1374     return 1;
1375   vm->dispatch_wrapper_fn = fn;
1376   return 0;
1377 }
1378
1379 int vlib_node_set_march_variant (vlib_main_t *vm, u32 node_index,
1380                                  clib_march_variant_type_t march_variant);
1381
1382 vlib_node_function_t *
1383 vlib_node_get_preferred_node_fn_variant (vlib_main_t *vm,
1384                                          vlib_node_fn_registration_t *regs);
1385
1386 /*
1387  * vlib_frame_bitmap functions
1388  */
1389
1390 #define VLIB_FRAME_BITMAP_N_UWORDS                                            \
1391   (((VLIB_FRAME_SIZE + uword_bits - 1) & ~(uword_bits - 1)) / uword_bits)
1392
1393 typedef uword vlib_frame_bitmap_t[VLIB_FRAME_BITMAP_N_UWORDS];
1394
1395 static_always_inline void
1396 vlib_frame_bitmap_init (uword *bmp, u32 n_first_bits_set)
1397 {
1398   u32 n_left = VLIB_FRAME_BITMAP_N_UWORDS;
1399   while (n_first_bits_set >= (sizeof (uword) * 8) && n_left)
1400     {
1401       bmp++[0] = ~0;
1402       n_first_bits_set -= sizeof (uword) * 8;
1403       n_left--;
1404     }
1405
1406   if (n_first_bits_set && n_left)
1407     {
1408       bmp++[0] = pow2_mask (n_first_bits_set);
1409       n_left--;
1410     }
1411
1412   while (n_left--)
1413     bmp++[0] = 0;
1414 }
1415
1416 static_always_inline void
1417 vlib_frame_bitmap_set_bit_at_index (uword *bmp, uword bit_index)
1418 {
1419   uword_bitmap_set_bits_at_index (bmp, bit_index, 1);
1420 }
1421
1422 static_always_inline void
1423 _vlib_frame_bitmap_clear_bit_at_index (uword *bmp, uword bit_index)
1424 {
1425   uword_bitmap_clear_bits_at_index (bmp, bit_index, 1);
1426 }
1427
1428 static_always_inline void
1429 vlib_frame_bitmap_set_bits_at_index (uword *bmp, uword bit_index, uword n_bits)
1430 {
1431   uword_bitmap_set_bits_at_index (bmp, bit_index, n_bits);
1432 }
1433
1434 static_always_inline void
1435 vlib_frame_bitmap_clear_bits_at_index (uword *bmp, uword bit_index,
1436                                        uword n_bits)
1437 {
1438   uword_bitmap_clear_bits_at_index (bmp, bit_index, n_bits);
1439 }
1440
1441 static_always_inline void
1442 vlib_frame_bitmap_clear (uword *bmp)
1443 {
1444   u32 n_left = VLIB_FRAME_BITMAP_N_UWORDS;
1445   while (n_left--)
1446     bmp++[0] = 0;
1447 }
1448
1449 static_always_inline void
1450 vlib_frame_bitmap_xor (uword *bmp, uword *bmp2)
1451 {
1452   u32 n_left = VLIB_FRAME_BITMAP_N_UWORDS;
1453   while (n_left--)
1454     bmp++[0] ^= bmp2++[0];
1455 }
1456
1457 static_always_inline void
1458 vlib_frame_bitmap_or (uword *bmp, uword *bmp2)
1459 {
1460   u32 n_left = VLIB_FRAME_BITMAP_N_UWORDS;
1461   while (n_left--)
1462     bmp++[0] |= bmp2++[0];
1463 }
1464
1465 static_always_inline void
1466 vlib_frame_bitmap_and (uword *bmp, uword *bmp2)
1467 {
1468   u32 n_left = VLIB_FRAME_BITMAP_N_UWORDS;
1469   while (n_left--)
1470     bmp++[0] &= bmp2++[0];
1471 }
1472
1473 static_always_inline uword
1474 vlib_frame_bitmap_count_set_bits (uword *bmp)
1475 {
1476   return uword_bitmap_count_set_bits (bmp, VLIB_FRAME_BITMAP_N_UWORDS);
1477 }
1478
1479 static_always_inline uword
1480 vlib_frame_bitmap_is_bit_set (uword *bmp, uword bit_index)
1481 {
1482   return uword_bitmap_is_bit_set (bmp, bit_index);
1483 }
1484
1485 static_always_inline uword
1486 vlib_frame_bitmap_find_first_set (uword *bmp)
1487 {
1488   uword rv = uword_bitmap_find_first_set (bmp);
1489   ASSERT (rv < VLIB_FRAME_BITMAP_N_UWORDS * uword_bits);
1490   return rv;
1491 }
1492
1493 #define foreach_vlib_frame_bitmap_set_bit_index(i, v)                         \
1494   for (uword _off = 0; _off < ARRAY_LEN (v); _off++)                          \
1495     for (uword _tmp =                                                         \
1496            (v[_off]) + 0 * (uword) (i = _off * uword_bits +                   \
1497                                         get_lowest_set_bit_index (v[_off]));  \
1498          _tmp; i = _off * uword_bits + get_lowest_set_bit_index (             \
1499                                          _tmp = clear_lowest_set_bit (_tmp)))
1500
1501 #endif /* included_vlib_node_funcs_h */
1502
1503 /*
1504  * fd.io coding-style-patch-verification: ON
1505  *
1506  * Local Variables:
1507  * eval: (c-set-style "gnu")
1508  * End:
1509  */