vlib: fix trace number accounting
[vpp.git] / src / vnet / interface_output.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  * interface_output.c: interface output node
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 <vnet/vnet.h>
41 #include <vnet/ip/icmp46_packet.h>
42 #include <vnet/ethernet/packet.h>
43 #include <vnet/ip/format.h>
44 #include <vnet/ip/ip4.h>
45 #include <vnet/ip/ip6.h>
46 #include <vnet/udp/udp_packet.h>
47 #include <vnet/feature/feature.h>
48 #include <vnet/classify/trace_classify.h>
49 #include <vnet/interface_output.h>
50
51 typedef struct
52 {
53   u32 sw_if_index;
54   u32 flags;
55   u8 data[128 - 2 * sizeof (u32)];
56 }
57 interface_output_trace_t;
58
59 #ifndef CLIB_MARCH_VARIANT
60 u8 *
61 format_vnet_interface_output_trace (u8 * s, va_list * va)
62 {
63   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
64   vlib_node_t *node = va_arg (*va, vlib_node_t *);
65   interface_output_trace_t *t = va_arg (*va, interface_output_trace_t *);
66   vnet_main_t *vnm = vnet_get_main ();
67   vnet_sw_interface_t *si;
68   u32 indent;
69
70   if (t->sw_if_index != (u32) ~ 0)
71     {
72       indent = format_get_indent (s);
73
74       if (pool_is_free_index
75           (vnm->interface_main.sw_interfaces, t->sw_if_index))
76         {
77           /* the interface may have been deleted by the time the trace is printed */
78           s = format (s, "sw_if_index: %d ", t->sw_if_index);
79         }
80       else
81         {
82           si = vnet_get_sw_interface (vnm, t->sw_if_index);
83           s =
84             format (s, "%U ", format_vnet_sw_interface_name, vnm, si,
85                     t->flags);
86         }
87       s =
88         format (s, "\n%U%U", format_white_space, indent,
89                 node->format_buffer ? node->format_buffer : format_hex_bytes,
90                 t->data, sizeof (t->data));
91     }
92   return s;
93 }
94
95 static void
96 vnet_interface_output_trace (vlib_main_t * vm,
97                              vlib_node_runtime_t * node,
98                              vlib_frame_t * frame, uword n_buffers)
99 {
100   u32 n_left, *from;
101
102   n_left = n_buffers;
103   from = vlib_frame_vector_args (frame);
104
105   while (n_left >= 4)
106     {
107       u32 bi0, bi1;
108       vlib_buffer_t *b0, *b1;
109       interface_output_trace_t *t0, *t1;
110
111       /* Prefetch next iteration. */
112       vlib_prefetch_buffer_with_index (vm, from[2], LOAD);
113       vlib_prefetch_buffer_with_index (vm, from[3], LOAD);
114
115       bi0 = from[0];
116       bi1 = from[1];
117
118       b0 = vlib_get_buffer (vm, bi0);
119       b1 = vlib_get_buffer (vm, bi1);
120
121       if (b0->flags & VLIB_BUFFER_IS_TRACED)
122         {
123           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
124           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX];
125           t0->flags = b0->flags;
126           clib_memcpy_fast (t0->data, vlib_buffer_get_current (b0),
127                             sizeof (t0->data));
128         }
129       if (b1->flags & VLIB_BUFFER_IS_TRACED)
130         {
131           t1 = vlib_add_trace (vm, node, b1, sizeof (t1[0]));
132           t1->sw_if_index = vnet_buffer (b1)->sw_if_index[VLIB_TX];
133           t1->flags = b1->flags;
134           clib_memcpy_fast (t1->data, vlib_buffer_get_current (b1),
135                             sizeof (t1->data));
136         }
137       from += 2;
138       n_left -= 2;
139     }
140
141   while (n_left >= 1)
142     {
143       u32 bi0;
144       vlib_buffer_t *b0;
145       interface_output_trace_t *t0;
146
147       bi0 = from[0];
148
149       b0 = vlib_get_buffer (vm, bi0);
150
151       if (b0->flags & VLIB_BUFFER_IS_TRACED)
152         {
153           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
154           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX];
155           t0->flags = b0->flags;
156           clib_memcpy_fast (t0->data, vlib_buffer_get_current (b0),
157                             sizeof (t0->data));
158         }
159       from += 1;
160       n_left -= 1;
161     }
162 }
163
164 static_always_inline uword
165 vnet_interface_output_node_inline (vlib_main_t * vm,
166                                    vlib_node_runtime_t * node,
167                                    vlib_frame_t * frame,
168                                    vnet_main_t * vnm,
169                                    vnet_hw_interface_t * hi,
170                                    int do_tx_offloads)
171 {
172   vnet_interface_output_runtime_t *rt = (void *) node->runtime_data;
173   vnet_sw_interface_t *si;
174   u32 n_left_to_tx, *from, *from_end, *to_tx;
175   u32 n_bytes, n_buffers, n_packets;
176   u32 n_bytes_b0, n_bytes_b1, n_bytes_b2, n_bytes_b3;
177   u32 thread_index = vm->thread_index;
178   vnet_interface_main_t *im = &vnm->interface_main;
179   u32 next_index = VNET_INTERFACE_OUTPUT_NEXT_TX;
180   u32 current_config_index = ~0;
181   u8 arc = im->output_feature_arc_index;
182   vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b = bufs;
183
184   n_buffers = frame->n_vectors;
185
186   if (node->flags & VLIB_NODE_FLAG_TRACE)
187     vnet_interface_output_trace (vm, node, frame, n_buffers);
188
189   from = vlib_frame_vector_args (frame);
190   vlib_get_buffers (vm, from, b, n_buffers);
191
192   if (rt->is_deleted)
193     return vlib_error_drop_buffers (vm, node, from,
194                                     /* buffer stride */ 1,
195                                     n_buffers,
196                                     VNET_INTERFACE_OUTPUT_NEXT_DROP,
197                                     node->node_index,
198                                     VNET_INTERFACE_OUTPUT_ERROR_INTERFACE_DELETED);
199
200   si = vnet_get_sw_interface (vnm, rt->sw_if_index);
201   hi = vnet_get_sup_hw_interface (vnm, rt->sw_if_index);
202   if (!(si->flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) ||
203       !(hi->flags & VNET_HW_INTERFACE_FLAG_LINK_UP))
204     {
205       vlib_simple_counter_main_t *cm;
206
207       cm = vec_elt_at_index (vnm->interface_main.sw_if_counters,
208                              VNET_INTERFACE_COUNTER_TX_ERROR);
209       vlib_increment_simple_counter (cm, thread_index,
210                                      rt->sw_if_index, n_buffers);
211
212       return vlib_error_drop_buffers (vm, node, from,
213                                       /* buffer stride */ 1,
214                                       n_buffers,
215                                       VNET_INTERFACE_OUTPUT_NEXT_DROP,
216                                       node->node_index,
217                                       VNET_INTERFACE_OUTPUT_ERROR_INTERFACE_DOWN);
218     }
219
220   from_end = from + n_buffers;
221
222   /* Total byte count of all buffers. */
223   n_bytes = 0;
224   n_packets = 0;
225
226   /* interface-output feature arc handling */
227   if (PREDICT_FALSE (vnet_have_features (arc, rt->sw_if_index)))
228     {
229       vnet_feature_config_main_t *fcm;
230       fcm = vnet_feature_get_config_main (arc);
231       current_config_index = vnet_get_feature_config_index (arc,
232                                                             rt->sw_if_index);
233       vnet_get_config_data (&fcm->config_main, &current_config_index,
234                             &next_index, 0);
235     }
236
237   while (from < from_end)
238     {
239       /* Get new next frame since previous incomplete frame may have less
240          than VNET_FRAME_SIZE vectors in it. */
241       vlib_get_new_next_frame (vm, node, next_index, to_tx, n_left_to_tx);
242
243       while (from + 8 <= from_end && n_left_to_tx >= 4)
244         {
245           u32 bi0, bi1, bi2, bi3;
246           u32 tx_swif0, tx_swif1, tx_swif2, tx_swif3;
247           u32 or_flags;
248
249           /* Prefetch next iteration. */
250           vlib_prefetch_buffer_header (b[4], LOAD);
251           vlib_prefetch_buffer_header (b[5], LOAD);
252           vlib_prefetch_buffer_header (b[6], LOAD);
253           vlib_prefetch_buffer_header (b[7], LOAD);
254
255           bi0 = from[0];
256           bi1 = from[1];
257           bi2 = from[2];
258           bi3 = from[3];
259           to_tx[0] = bi0;
260           to_tx[1] = bi1;
261           to_tx[2] = bi2;
262           to_tx[3] = bi3;
263
264           or_flags = b[0]->flags | b[1]->flags | b[2]->flags | b[3]->flags;
265
266           from += 4;
267           to_tx += 4;
268           n_left_to_tx -= 4;
269
270           /* Be grumpy about zero length buffers for benefit of
271              driver tx function. */
272           ASSERT (b[0]->current_length > 0);
273           ASSERT (b[1]->current_length > 0);
274           ASSERT (b[2]->current_length > 0);
275           ASSERT (b[3]->current_length > 0);
276
277           n_bytes_b0 = vlib_buffer_length_in_chain (vm, b[0]);
278           n_bytes_b1 = vlib_buffer_length_in_chain (vm, b[1]);
279           n_bytes_b2 = vlib_buffer_length_in_chain (vm, b[2]);
280           n_bytes_b3 = vlib_buffer_length_in_chain (vm, b[3]);
281           tx_swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
282           tx_swif1 = vnet_buffer (b[1])->sw_if_index[VLIB_TX];
283           tx_swif2 = vnet_buffer (b[2])->sw_if_index[VLIB_TX];
284           tx_swif3 = vnet_buffer (b[3])->sw_if_index[VLIB_TX];
285
286           n_bytes += n_bytes_b0 + n_bytes_b1;
287           n_bytes += n_bytes_b2 + n_bytes_b3;
288           n_packets += 4;
289
290           if (PREDICT_FALSE (current_config_index != ~0))
291             {
292               vnet_buffer (b[0])->feature_arc_index = arc;
293               vnet_buffer (b[1])->feature_arc_index = arc;
294               vnet_buffer (b[2])->feature_arc_index = arc;
295               vnet_buffer (b[3])->feature_arc_index = arc;
296               b[0]->current_config_index = current_config_index;
297               b[1]->current_config_index = current_config_index;
298               b[2]->current_config_index = current_config_index;
299               b[3]->current_config_index = current_config_index;
300             }
301
302           /* update vlan subif tx counts, if required */
303           if (PREDICT_FALSE (tx_swif0 != rt->sw_if_index))
304             {
305               vlib_increment_combined_counter (im->combined_sw_if_counters +
306                                                VNET_INTERFACE_COUNTER_TX,
307                                                thread_index, tx_swif0, 1,
308                                                n_bytes_b0);
309             }
310
311           if (PREDICT_FALSE (tx_swif1 != rt->sw_if_index))
312             {
313
314               vlib_increment_combined_counter (im->combined_sw_if_counters +
315                                                VNET_INTERFACE_COUNTER_TX,
316                                                thread_index, tx_swif1, 1,
317                                                n_bytes_b1);
318             }
319
320           if (PREDICT_FALSE (tx_swif2 != rt->sw_if_index))
321             {
322
323               vlib_increment_combined_counter (im->combined_sw_if_counters +
324                                                VNET_INTERFACE_COUNTER_TX,
325                                                thread_index, tx_swif2, 1,
326                                                n_bytes_b2);
327             }
328           if (PREDICT_FALSE (tx_swif3 != rt->sw_if_index))
329             {
330
331               vlib_increment_combined_counter (im->combined_sw_if_counters +
332                                                VNET_INTERFACE_COUNTER_TX,
333                                                thread_index, tx_swif3, 1,
334                                                n_bytes_b3);
335             }
336
337           if (do_tx_offloads)
338             {
339               u32 vnet_buffer_offload_flags =
340                 (VNET_BUFFER_F_OFFLOAD_TCP_CKSUM |
341                  VNET_BUFFER_F_OFFLOAD_UDP_CKSUM |
342                  VNET_BUFFER_F_OFFLOAD_IP_CKSUM);
343               if (or_flags & vnet_buffer_offload_flags)
344                 {
345                   if (b[0]->flags & vnet_buffer_offload_flags)
346                     vnet_calc_checksums_inline
347                       (vm, b[0],
348                        b[0]->flags & VNET_BUFFER_F_IS_IP4,
349                        b[0]->flags & VNET_BUFFER_F_IS_IP6);
350                   if (b[1]->flags & vnet_buffer_offload_flags)
351                     vnet_calc_checksums_inline
352                       (vm, b[1],
353                        b[1]->flags & VNET_BUFFER_F_IS_IP4,
354                        b[1]->flags & VNET_BUFFER_F_IS_IP6);
355                   if (b[2]->flags & vnet_buffer_offload_flags)
356                     vnet_calc_checksums_inline
357                       (vm, b[2],
358                        b[2]->flags & VNET_BUFFER_F_IS_IP4,
359                        b[2]->flags & VNET_BUFFER_F_IS_IP6);
360                   if (b[3]->flags & vnet_buffer_offload_flags)
361                     vnet_calc_checksums_inline
362                       (vm, b[3],
363                        b[3]->flags & VNET_BUFFER_F_IS_IP4,
364                        b[3]->flags & VNET_BUFFER_F_IS_IP6);
365                 }
366             }
367           b += 4;
368
369         }
370
371       while (from + 1 <= from_end && n_left_to_tx >= 1)
372         {
373           u32 bi0;
374           u32 tx_swif0;
375
376           bi0 = from[0];
377           to_tx[0] = bi0;
378           from += 1;
379           to_tx += 1;
380           n_left_to_tx -= 1;
381
382           /* Be grumpy about zero length buffers for benefit of
383              driver tx function. */
384           ASSERT (b[0]->current_length > 0);
385
386           n_bytes_b0 = vlib_buffer_length_in_chain (vm, b[0]);
387           tx_swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
388           n_bytes += n_bytes_b0;
389           n_packets += 1;
390
391           if (PREDICT_FALSE (current_config_index != ~0))
392             {
393               vnet_buffer (b[0])->feature_arc_index = arc;
394               b[0]->current_config_index = current_config_index;
395             }
396
397           if (PREDICT_FALSE (tx_swif0 != rt->sw_if_index))
398             {
399
400               vlib_increment_combined_counter (im->combined_sw_if_counters +
401                                                VNET_INTERFACE_COUNTER_TX,
402                                                thread_index, tx_swif0, 1,
403                                                n_bytes_b0);
404             }
405
406           if (do_tx_offloads)
407             {
408               if (b[0]->flags &
409                   (VNET_BUFFER_F_OFFLOAD_TCP_CKSUM |
410                    VNET_BUFFER_F_OFFLOAD_UDP_CKSUM |
411                    VNET_BUFFER_F_OFFLOAD_IP_CKSUM))
412                 vnet_calc_checksums_inline
413                   (vm, b[0],
414                    b[0]->flags & VNET_BUFFER_F_IS_IP4,
415                    b[0]->flags & VNET_BUFFER_F_IS_IP6);
416             }
417           b += 1;
418         }
419
420       vlib_put_next_frame (vm, node, next_index, n_left_to_tx);
421     }
422
423   /* Update main interface stats. */
424   vlib_increment_combined_counter (im->combined_sw_if_counters
425                                    + VNET_INTERFACE_COUNTER_TX,
426                                    thread_index,
427                                    rt->sw_if_index, n_packets, n_bytes);
428   return n_buffers;
429 }
430 #endif /* CLIB_MARCH_VARIANT */
431
432 static_always_inline void vnet_interface_pcap_tx_trace
433   (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame,
434    int sw_if_index_from_buffer)
435 {
436   u32 n_left_from, *from;
437   u32 sw_if_index;
438   vnet_pcap_t *pp = &vlib_global_main.pcap;
439
440   if (PREDICT_TRUE (pp->pcap_tx_enable == 0))
441     return;
442
443   if (sw_if_index_from_buffer == 0)
444     {
445       vnet_interface_output_runtime_t *rt = (void *) node->runtime_data;
446       sw_if_index = rt->sw_if_index;
447     }
448   else
449     sw_if_index = ~0;
450
451   n_left_from = frame->n_vectors;
452   from = vlib_frame_vector_args (frame);
453
454   while (n_left_from > 0)
455     {
456       int classify_filter_result;
457       u32 bi0 = from[0];
458       vlib_buffer_t *b0 = vlib_get_buffer (vm, bi0);
459       from++;
460       n_left_from--;
461
462       if (pp->filter_classify_table_index != ~0)
463         {
464           classify_filter_result =
465             vnet_is_packet_traced_inline
466             (b0, pp->filter_classify_table_index, 0 /* full classify */ );
467           if (classify_filter_result)
468             pcap_add_buffer (&pp->pcap_main, vm, bi0, pp->max_bytes_per_pkt);
469           continue;
470         }
471
472       if (sw_if_index_from_buffer)
473         sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX];
474
475       if (pp->pcap_sw_if_index == 0 || pp->pcap_sw_if_index == sw_if_index)
476         {
477           vnet_main_t *vnm = vnet_get_main ();
478           vnet_hw_interface_t *hi =
479             vnet_get_sup_hw_interface (vnm, sw_if_index);
480           /* Capture pkt if not filtered, or if filter hits */
481           if (hi->trace_classify_table_index == ~0 ||
482               vnet_is_packet_traced_inline
483               (b0, hi->trace_classify_table_index, 0 /* full classify */ ))
484             pcap_add_buffer (&pp->pcap_main, vm, bi0, pp->max_bytes_per_pkt);
485         }
486     }
487 }
488
489 #ifndef CLIB_MARCH_VARIANT
490
491 uword
492 vnet_interface_output_node (vlib_main_t * vm, vlib_node_runtime_t * node,
493                             vlib_frame_t * frame)
494 {
495   vnet_main_t *vnm = vnet_get_main ();
496   vnet_hw_interface_t *hi;
497   vnet_interface_output_runtime_t *rt = (void *) node->runtime_data;
498   hi = vnet_get_sup_hw_interface (vnm, rt->sw_if_index);
499
500   vnet_interface_pcap_tx_trace (vm, node, frame,
501                                 0 /* sw_if_index_from_buffer */ );
502
503   if (hi->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_TX_L4_CKSUM_OFFLOAD)
504     return vnet_interface_output_node_inline (vm, node, frame, vnm, hi,
505                                               /* do_tx_offloads */ 0);
506   else
507     return vnet_interface_output_node_inline (vm, node, frame, vnm, hi,
508                                               /* do_tx_offloads */ 1);
509 }
510 #endif /* CLIB_MARCH_VARIANT */
511
512 /* Use buffer's sw_if_index[VNET_TX] to choose output interface. */
513 VLIB_NODE_FN (vnet_per_buffer_interface_output_node) (vlib_main_t * vm,
514                                                       vlib_node_runtime_t *
515                                                       node,
516                                                       vlib_frame_t * frame)
517 {
518   vnet_main_t *vnm = vnet_get_main ();
519   u32 n_left_to_next, *from, *to_next;
520   u32 n_left_from, next_index;
521
522   vnet_interface_pcap_tx_trace (vm, node, frame,
523                                 1 /* sw_if_index_from_buffer */ );
524
525   n_left_from = frame->n_vectors;
526
527   from = vlib_frame_vector_args (frame);
528   next_index = node->cached_next_index;
529
530   while (n_left_from > 0)
531     {
532       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
533
534       while (n_left_from >= 4 && n_left_to_next >= 2)
535         {
536           u32 bi0, bi1, next0, next1;
537           vlib_buffer_t *b0, *b1;
538           vnet_hw_interface_t *hi0, *hi1;
539
540           /* Prefetch next iteration. */
541           vlib_prefetch_buffer_with_index (vm, from[2], LOAD);
542           vlib_prefetch_buffer_with_index (vm, from[3], LOAD);
543
544           bi0 = from[0];
545           bi1 = from[1];
546           to_next[0] = bi0;
547           to_next[1] = bi1;
548           from += 2;
549           to_next += 2;
550           n_left_to_next -= 2;
551           n_left_from -= 2;
552
553           b0 = vlib_get_buffer (vm, bi0);
554           b1 = vlib_get_buffer (vm, bi1);
555
556           hi0 =
557             vnet_get_sup_hw_interface (vnm,
558                                        vnet_buffer (b0)->sw_if_index
559                                        [VLIB_TX]);
560           hi1 =
561             vnet_get_sup_hw_interface (vnm,
562                                        vnet_buffer (b1)->sw_if_index
563                                        [VLIB_TX]);
564
565           next0 = hi0->output_node_next_index;
566           next1 = hi1->output_node_next_index;
567
568           vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next,
569                                            n_left_to_next, bi0, bi1, next0,
570                                            next1);
571         }
572
573       while (n_left_from > 0 && n_left_to_next > 0)
574         {
575           u32 bi0, next0;
576           vlib_buffer_t *b0;
577           vnet_hw_interface_t *hi0;
578
579           bi0 = from[0];
580           to_next[0] = bi0;
581           from += 1;
582           to_next += 1;
583           n_left_to_next -= 1;
584           n_left_from -= 1;
585
586           b0 = vlib_get_buffer (vm, bi0);
587
588           hi0 =
589             vnet_get_sup_hw_interface (vnm,
590                                        vnet_buffer (b0)->sw_if_index
591                                        [VLIB_TX]);
592
593           next0 = hi0->output_node_next_index;
594
595           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
596                                            n_left_to_next, bi0, next0);
597         }
598
599       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
600     }
601
602   return frame->n_vectors;
603 }
604
605 typedef struct vnet_error_trace_t_
606 {
607   u32 sw_if_index;
608   i8 details_valid;
609   u8 is_ip6;
610   u8 pad[2];
611   u16 mactype;
612   ip46_address_t src, dst;
613 } vnet_error_trace_t;
614
615 static u8 *
616 format_vnet_error_trace (u8 * s, va_list * va)
617 {
618   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
619   CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *);
620   vnet_error_trace_t *t = va_arg (*va, vnet_error_trace_t *);
621
622   /* Normal, non-catchup trace */
623   if (t->details_valid == 0)
624     {
625       s = format (s, "rx:%U", format_vnet_sw_if_index_name,
626                   vnet_get_main (), t->sw_if_index);
627     }
628   else if (t->details_valid == 1)
629     {
630       /* The trace capture code didn't understant the mactype */
631       s = format (s, "mactype 0x%4x (not decoded)", t->mactype);
632     }
633   else if (t->details_valid == 2)
634     {
635       /* Dump the src/dst addresses */
636       if (t->is_ip6 == 0)
637         s = format (s, "IP4: %U -> %U",
638                     format_ip4_address, &t->src.ip4,
639                     format_ip4_address, &t->dst.ip4);
640       else
641         s = format (s, "IP6: %U -> %U",
642                     format_ip6_address, &t->src.ip6,
643                     format_ip6_address, &t->dst.ip6);
644     }
645   return s;
646 }
647
648 static void
649 interface_trace_buffers (vlib_main_t * vm,
650                          vlib_node_runtime_t * node, vlib_frame_t * frame)
651 {
652   u32 n_left, *buffers;
653
654   buffers = vlib_frame_vector_args (frame);
655   n_left = frame->n_vectors;
656
657   while (n_left >= 4)
658     {
659       u32 bi0, bi1;
660       vlib_buffer_t *b0, *b1;
661       vnet_error_trace_t *t0, *t1;
662
663       /* Prefetch next iteration. */
664       vlib_prefetch_buffer_with_index (vm, buffers[2], LOAD);
665       vlib_prefetch_buffer_with_index (vm, buffers[3], LOAD);
666
667       bi0 = buffers[0];
668       bi1 = buffers[1];
669
670       b0 = vlib_get_buffer (vm, bi0);
671       b1 = vlib_get_buffer (vm, bi1);
672
673       if (b0->flags & VLIB_BUFFER_IS_TRACED)
674         {
675           t0 = vlib_add_trace (vm, node, b0,
676                                STRUCT_OFFSET_OF (vnet_error_trace_t, pad));
677           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX];
678           t0->details_valid = 0;
679         }
680       if (b1->flags & VLIB_BUFFER_IS_TRACED)
681         {
682           t1 = vlib_add_trace (vm, node, b1,
683                                STRUCT_OFFSET_OF (vnet_error_trace_t, pad));
684           t1->sw_if_index = vnet_buffer (b1)->sw_if_index[VLIB_RX];
685           t1->details_valid = 0;
686         }
687       buffers += 2;
688       n_left -= 2;
689     }
690
691   while (n_left >= 1)
692     {
693       u32 bi0;
694       vlib_buffer_t *b0;
695       vnet_error_trace_t *t0;
696
697       bi0 = buffers[0];
698
699       b0 = vlib_get_buffer (vm, bi0);
700
701       if (b0->flags & VLIB_BUFFER_IS_TRACED)
702         {
703           t0 = vlib_add_trace (vm, node, b0,
704                                STRUCT_OFFSET_OF (vnet_error_trace_t, pad));
705           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX];
706           t0->details_valid = 0;
707         }
708       buffers += 1;
709       n_left -= 1;
710     }
711 }
712
713 typedef enum
714 {
715   VNET_ERROR_DISPOSITION_DROP,
716   VNET_ERROR_DISPOSITION_PUNT,
717   VNET_ERROR_N_DISPOSITION,
718 } vnet_error_disposition_t;
719
720 static void
721 drop_catchup_trace (vlib_main_t * vm,
722                     vlib_node_runtime_t * node, vlib_buffer_t * b)
723 {
724   /* Can we safely rewind the buffer? If not, fagedaboudit */
725   if (b->flags & VNET_BUFFER_F_L2_HDR_OFFSET_VALID)
726     {
727       vnet_error_trace_t *t;
728       ip4_header_t *ip4;
729       ip6_header_t *ip6;
730       ethernet_header_t *eh;
731       i16 delta;
732
733       t = vlib_add_trace (vm, node, b, sizeof (*t));
734       delta = vnet_buffer (b)->l2_hdr_offset - b->current_data;
735       vlib_buffer_advance (b, delta);
736
737       eh = vlib_buffer_get_current (b);
738       /* Save mactype */
739       t->mactype = clib_net_to_host_u16 (eh->type);
740       t->details_valid = 1;
741       switch (t->mactype)
742         {
743         case ETHERNET_TYPE_IP4:
744           ip4 = (void *) (eh + 1);
745           t->details_valid = 2;
746           t->is_ip6 = 0;
747           t->src.ip4.as_u32 = ip4->src_address.as_u32;
748           t->dst.ip4.as_u32 = ip4->dst_address.as_u32;
749           break;
750
751         case ETHERNET_TYPE_IP6:
752           ip6 = (void *) (eh + 1);
753           t->details_valid = 2;
754           t->is_ip6 = 1;
755           clib_memcpy_fast (t->src.as_u8, ip6->src_address.as_u8,
756                             sizeof (ip6_address_t));
757           clib_memcpy_fast (t->dst.as_u8, ip6->dst_address.as_u8,
758                             sizeof (ip6_address_t));
759           break;
760
761         default:
762           /* Dunno, do nothing, leave details_valid alone */
763           break;
764         }
765       /* Restore current data (probably unnecessary) */
766       vlib_buffer_advance (b, -delta);
767     }
768 }
769
770 static_always_inline uword
771 interface_drop_punt (vlib_main_t * vm,
772                      vlib_node_runtime_t * node,
773                      vlib_frame_t * frame,
774                      vnet_error_disposition_t disposition)
775 {
776   u32 *from, n_left, thread_index, *sw_if_index;
777   vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b;
778   u32 sw_if_indices[VLIB_FRAME_SIZE];
779   vlib_simple_counter_main_t *cm;
780   u16 nexts[VLIB_FRAME_SIZE];
781   u32 n_trace;
782   vnet_main_t *vnm;
783
784   vnm = vnet_get_main ();
785   thread_index = vm->thread_index;
786   from = vlib_frame_vector_args (frame);
787   n_left = frame->n_vectors;
788   b = bufs;
789   sw_if_index = sw_if_indices;
790
791   vlib_get_buffers (vm, from, bufs, n_left);
792
793   /* "trace add error-drop NNN?" */
794   if (PREDICT_FALSE ((n_trace = vlib_get_trace_count (vm, node))))
795     {
796       /* If pkts aren't otherwise traced... */
797       if ((node->flags & VLIB_NODE_FLAG_TRACE) == 0)
798         {
799           /* Trace them from here */
800           node->flags |= VLIB_NODE_FLAG_TRACE;
801           while (n_trace && n_left)
802             {
803               if (PREDICT_TRUE
804                   (vlib_trace_buffer (vm, node, 0 /* next_index */ , b[0],
805                                       0 /* follow chain */ )))
806                 {
807                   /*
808                    * Here we have a wireshark dissector problem.
809                    * Packets may be well-formed, or not. We
810                    * must not blow chunks in any case.
811                    *
812                    * Try to produce trace records which will help
813                    * folks understand what's going on.
814                    */
815                   drop_catchup_trace (vm, node, b[0]);
816                   n_trace--;
817                 }
818               n_left--;
819               b++;
820             }
821         }
822
823       vlib_set_trace_count (vm, node, n_trace);
824       b = bufs;
825       n_left = frame->n_vectors;
826     }
827
828   if (node->flags & VLIB_NODE_FLAG_TRACE)
829     interface_trace_buffers (vm, node, frame);
830
831   /* All going to drop regardless, this is just a counting exercise */
832   clib_memset (nexts, 0, sizeof (nexts));
833
834   cm = vec_elt_at_index (vnm->interface_main.sw_if_counters,
835                          (disposition == VNET_ERROR_DISPOSITION_PUNT
836                           ? VNET_INTERFACE_COUNTER_PUNT
837                           : VNET_INTERFACE_COUNTER_DROP));
838
839   /* collect the array of interfaces first ... */
840   while (n_left >= 4)
841     {
842       if (n_left >= 12)
843         {
844           /* Prefetch 8 ahead - there's not much going on in each iteration */
845           vlib_prefetch_buffer_header (b[4], LOAD);
846           vlib_prefetch_buffer_header (b[5], LOAD);
847           vlib_prefetch_buffer_header (b[6], LOAD);
848           vlib_prefetch_buffer_header (b[7], LOAD);
849         }
850       sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_RX];
851       sw_if_index[1] = vnet_buffer (b[1])->sw_if_index[VLIB_RX];
852       sw_if_index[2] = vnet_buffer (b[2])->sw_if_index[VLIB_RX];
853       sw_if_index[3] = vnet_buffer (b[3])->sw_if_index[VLIB_RX];
854
855       sw_if_index += 4;
856       n_left -= 4;
857       b += 4;
858     }
859   while (n_left)
860     {
861       sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_RX];
862
863       sw_if_index += 1;
864       n_left -= 1;
865       b += 1;
866     }
867
868   /* ... then count against them in blocks */
869   n_left = frame->n_vectors;
870
871   while (n_left)
872     {
873       vnet_sw_interface_t *sw_if0;
874       u16 off, count;
875
876       off = frame->n_vectors - n_left;
877
878       sw_if_index = sw_if_indices + off;
879
880       count = clib_count_equal_u32 (sw_if_index, n_left);
881       n_left -= count;
882
883       vlib_increment_simple_counter (cm, thread_index, sw_if_index[0], count);
884
885       /* Increment super-interface drop/punt counters for
886          sub-interfaces. */
887       sw_if0 = vnet_get_sw_interface (vnm, sw_if_index[0]);
888       if (sw_if0->sup_sw_if_index != sw_if_index[0])
889         vlib_increment_simple_counter
890           (cm, thread_index, sw_if0->sup_sw_if_index, count);
891     }
892
893   vlib_buffer_enqueue_to_next (vm, node, from, nexts, frame->n_vectors);
894
895   return frame->n_vectors;
896 }
897
898 static inline void
899 pcap_drop_trace (vlib_main_t * vm,
900                  vnet_interface_main_t * im,
901                  vnet_pcap_t * pp, vlib_frame_t * f)
902 {
903   u32 *from;
904   u32 n_left = f->n_vectors;
905   vlib_buffer_t *b0, *p1;
906   u32 bi0;
907   i16 save_current_data;
908   u16 save_current_length;
909   vlib_error_main_t *em = &vm->error_main;
910   int do_trace = 0;
911
912
913   from = vlib_frame_vector_args (f);
914
915   while (n_left > 0)
916     {
917       if (PREDICT_TRUE (n_left > 1))
918         {
919           p1 = vlib_get_buffer (vm, from[1]);
920           vlib_prefetch_buffer_header (p1, LOAD);
921         }
922
923       bi0 = from[0];
924       b0 = vlib_get_buffer (vm, bi0);
925       from++;
926       n_left--;
927
928       /* See if we're pointedly ignoring this specific error */
929       if (im->pcap_drop_filter_hash
930           && hash_get (im->pcap_drop_filter_hash, b0->error))
931         continue;
932
933       do_trace = (pp->pcap_sw_if_index == 0) ||
934         pp->pcap_sw_if_index == vnet_buffer (b0)->sw_if_index[VLIB_RX];
935
936       if (PREDICT_FALSE
937           (do_trace == 0 && pp->filter_classify_table_index != ~0))
938         {
939           do_trace = vnet_is_packet_traced_inline
940             (b0, pp->filter_classify_table_index, 0 /* full classify */ );
941         }
942
943       /* Trace all drops, or drops received on a specific interface */
944       if (do_trace)
945         {
946           save_current_data = b0->current_data;
947           save_current_length = b0->current_length;
948
949           /*
950            * Typically, we'll need to rewind the buffer
951            * if l2_hdr_offset is valid, make sure to rewind to the start of
952            * the L2 header. This may not be the buffer start in case we pop-ed
953            * vlan tags.
954            * Otherwise, rewind to buffer start and hope for the best.
955            */
956           if (b0->flags & VNET_BUFFER_F_L2_HDR_OFFSET_VALID)
957             {
958               if (b0->current_data > vnet_buffer (b0)->l2_hdr_offset)
959                 vlib_buffer_advance (b0,
960                                      vnet_buffer (b0)->l2_hdr_offset -
961                                      b0->current_data);
962             }
963           else if (b0->current_data > 0)
964             vlib_buffer_advance (b0, (word) - b0->current_data);
965
966           {
967             vlib_buffer_t *last = b0;
968             u32 error_node_index;
969             int drop_string_len;
970             vlib_node_t *n;
971             /* Length of the error string */
972             int error_string_len =
973               clib_strnlen (em->counters_heap[b0->error].name, 128);
974
975             /* Dig up the drop node */
976             error_node_index = vm->node_main.node_by_error[b0->error];
977             n = vlib_get_node (vm, error_node_index);
978
979             /* Length of full drop string, w/ "nodename: " prepended */
980             drop_string_len = error_string_len + vec_len (n->name) + 2;
981
982             /* Find the last buffer in the chain */
983             while (last->flags & VLIB_BUFFER_NEXT_PRESENT)
984               last = vlib_get_buffer (vm, last->next_buffer);
985
986             /*
987              * Append <nodename>: <error-string> to the capture,
988              * only if we can do that without allocating a new buffer.
989              */
990             if (PREDICT_TRUE ((last->current_data + last->current_length)
991                               < (VLIB_BUFFER_DEFAULT_DATA_SIZE
992                                  - drop_string_len)))
993               {
994                 clib_memcpy_fast (last->data + last->current_data +
995                                   last->current_length, n->name,
996                                   vec_len (n->name));
997                 clib_memcpy_fast (last->data + last->current_data +
998                                   last->current_length + vec_len (n->name),
999                                   ": ", 2);
1000                 clib_memcpy_fast (last->data + last->current_data +
1001                                   last->current_length + vec_len (n->name) +
1002                                   2, em->counters_heap[b0->error].name,
1003                                   error_string_len);
1004                 last->current_length += drop_string_len;
1005                 b0->flags &= ~(VLIB_BUFFER_TOTAL_LENGTH_VALID);
1006                 pcap_add_buffer (&pp->pcap_main, vm, bi0,
1007                                  pp->max_bytes_per_pkt);
1008                 last->current_length -= drop_string_len;
1009                 b0->current_data = save_current_data;
1010                 b0->current_length = save_current_length;
1011                 continue;
1012               }
1013           }
1014
1015           /*
1016            * Didn't have space in the last buffer, here's the dropped
1017            * packet as-is
1018            */
1019           pcap_add_buffer (&pp->pcap_main, vm, bi0, pp->max_bytes_per_pkt);
1020
1021           b0->current_data = save_current_data;
1022           b0->current_length = save_current_length;
1023         }
1024     }
1025 }
1026
1027 #ifndef CLIB_MARCH_VARIANT
1028 void
1029 vnet_pcap_drop_trace_filter_add_del (u32 error_index, int is_add)
1030 {
1031   vnet_interface_main_t *im = &vnet_get_main ()->interface_main;
1032
1033   if (im->pcap_drop_filter_hash == 0)
1034     im->pcap_drop_filter_hash = hash_create (0, sizeof (uword));
1035
1036   if (is_add)
1037     hash_set (im->pcap_drop_filter_hash, error_index, 1);
1038   else
1039     hash_unset (im->pcap_drop_filter_hash, error_index);
1040 }
1041 #endif /* CLIB_MARCH_VARIANT */
1042
1043 VLIB_NODE_FN (interface_drop) (vlib_main_t * vm,
1044                                vlib_node_runtime_t * node,
1045                                vlib_frame_t * frame)
1046 {
1047   vnet_interface_main_t *im = &vnet_get_main ()->interface_main;
1048   vnet_pcap_t *pp = &vlib_global_main.pcap;
1049
1050   if (PREDICT_FALSE (pp->pcap_drop_enable))
1051     pcap_drop_trace (vm, im, pp, frame);
1052
1053   return interface_drop_punt (vm, node, frame, VNET_ERROR_DISPOSITION_DROP);
1054 }
1055
1056 VLIB_NODE_FN (interface_punt) (vlib_main_t * vm,
1057                                vlib_node_runtime_t * node,
1058                                vlib_frame_t * frame)
1059 {
1060   return interface_drop_punt (vm, node, frame, VNET_ERROR_DISPOSITION_PUNT);
1061 }
1062
1063 /* *INDENT-OFF* */
1064 VLIB_REGISTER_NODE (interface_drop) = {
1065   .name = "error-drop",
1066   .vector_size = sizeof (u32),
1067   .format_trace = format_vnet_error_trace,
1068   .flags = VLIB_NODE_FLAG_TRACE_SUPPORTED,
1069   .n_next_nodes = 1,
1070   .next_nodes = {
1071     [0] = "drop",
1072   },
1073 };
1074 /* *INDENT-ON* */
1075
1076 /* *INDENT-OFF* */
1077 VLIB_REGISTER_NODE (interface_punt) = {
1078   .name = "error-punt",
1079   .vector_size = sizeof (u32),
1080   .format_trace = format_vnet_error_trace,
1081   .flags = VLIB_NODE_FLAG_TRACE_SUPPORTED,
1082   .n_next_nodes = 1,
1083   .next_nodes = {
1084     [0] = "punt",
1085   },
1086 };
1087 /* *INDENT-ON* */
1088
1089 /* *INDENT-OFF* */
1090 VLIB_REGISTER_NODE (vnet_per_buffer_interface_output_node) = {
1091   .name = "interface-output",
1092   .vector_size = sizeof (u32),
1093 };
1094 /* *INDENT-ON* */
1095
1096 static uword
1097 interface_tx_node_fn (vlib_main_t * vm, vlib_node_runtime_t * node,
1098                       vlib_frame_t * from_frame)
1099 {
1100   vnet_main_t *vnm = vnet_get_main ();
1101   u32 last_sw_if_index = ~0;
1102   vlib_frame_t *to_frame = 0;
1103   vnet_hw_interface_t *hw = 0;
1104   u32 *from, *to_next = 0;
1105   u32 n_left_from;
1106
1107   from = vlib_frame_vector_args (from_frame);
1108   n_left_from = from_frame->n_vectors;
1109   while (n_left_from > 0)
1110     {
1111       u32 bi0;
1112       vlib_buffer_t *b0;
1113       u32 sw_if_index0;
1114
1115       bi0 = from[0];
1116       from++;
1117       n_left_from--;
1118       b0 = vlib_get_buffer (vm, bi0);
1119       sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_TX];
1120
1121       if (PREDICT_FALSE ((last_sw_if_index != sw_if_index0) || to_frame == 0))
1122         {
1123           if (to_frame)
1124             {
1125               hw = vnet_get_sup_hw_interface (vnm, last_sw_if_index);
1126               vlib_put_frame_to_node (vm, hw->tx_node_index, to_frame);
1127             }
1128           last_sw_if_index = sw_if_index0;
1129           hw = vnet_get_sup_hw_interface (vnm, sw_if_index0);
1130           to_frame = vlib_get_frame_to_node (vm, hw->tx_node_index);
1131           to_next = vlib_frame_vector_args (to_frame);
1132         }
1133
1134       to_next[0] = bi0;
1135       to_next++;
1136       to_frame->n_vectors++;
1137     }
1138   vlib_put_frame_to_node (vm, hw->tx_node_index, to_frame);
1139   return from_frame->n_vectors;
1140 }
1141
1142 /* *INDENT-OFF* */
1143 VLIB_REGISTER_NODE (interface_tx) = {
1144   .function = interface_tx_node_fn,
1145   .name = "interface-tx",
1146   .vector_size = sizeof (u32),
1147   .n_next_nodes = 1,
1148   .next_nodes = {
1149     [0] = "error-drop",
1150   },
1151 };
1152
1153 VNET_FEATURE_ARC_INIT (interface_output, static) =
1154 {
1155   .arc_name  = "interface-output",
1156   .start_nodes = VNET_FEATURES (0),
1157   .last_in_arc = "interface-tx",
1158   .arc_index_ptr = &vnet_main.interface_main.output_feature_arc_index,
1159 };
1160
1161 VNET_FEATURE_INIT (span_tx, static) = {
1162   .arc_name = "interface-output",
1163   .node_name = "span-output",
1164   .runs_before = VNET_FEATURES ("interface-tx"),
1165 };
1166
1167 VNET_FEATURE_INIT (ipsec_if_tx, static) = {
1168   .arc_name = "interface-output",
1169   .node_name = "ipsec-if-output",
1170   .runs_before = VNET_FEATURES ("interface-tx"),
1171 };
1172
1173 VNET_FEATURE_INIT (interface_tx, static) = {
1174   .arc_name = "interface-output",
1175   .node_name = "interface-tx",
1176   .runs_before = 0,
1177 };
1178 /* *INDENT-ON* */
1179
1180 #ifndef CLIB_MARCH_VARIANT
1181 clib_error_t *
1182 vnet_per_buffer_interface_output_hw_interface_add_del (vnet_main_t * vnm,
1183                                                        u32 hw_if_index,
1184                                                        u32 is_create)
1185 {
1186   vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index);
1187   u32 next_index;
1188
1189   if (hi->output_node_index == 0)
1190     return 0;
1191
1192   next_index = vlib_node_add_next
1193     (vnm->vlib_main, vnet_per_buffer_interface_output_node.index,
1194      hi->output_node_index);
1195   hi->output_node_next_index = next_index;
1196
1197   return 0;
1198 }
1199
1200 VNET_HW_INTERFACE_ADD_DEL_FUNCTION
1201   (vnet_per_buffer_interface_output_hw_interface_add_del);
1202
1203 void
1204 vnet_set_interface_output_node (vnet_main_t * vnm,
1205                                 u32 hw_if_index, u32 node_index)
1206 {
1207   ASSERT (node_index);
1208   vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index);
1209   u32 next_index = vlib_node_add_next
1210     (vnm->vlib_main, vnet_per_buffer_interface_output_node.index, node_index);
1211   hi->output_node_next_index = next_index;
1212   hi->output_node_index = node_index;
1213 }
1214 #endif /* CLIB_MARCH_VARIANT */
1215
1216 /*
1217  * fd.io coding-style-patch-verification: ON
1218  *
1219  * Local Variables:
1220  * eval: (c-set-style "gnu")
1221  * End:
1222  */