summaryrefslogtreecommitdiffstats
path: root/src/vnet/adj/adj_mcast.c
blob: 4454afec630910fcbe3ad9d31aebab31ae7ba981 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
/*
 * Copyright (c) 2016 Cisco and/or its affiliates.
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at:
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#include <vnet/adj/adj_mcast.h>
#include <vnet/adj/adj_internal.h>
#include <vnet/fib/fib_walk.h>
#include <vnet/ip/ip.h>

/*
 * The 'DB' of all mcast adjs.
 * There is only one mcast per-interface per-protocol, so this is a per-interface
 * vector
 */
static adj_index_t *adj_mcasts[FIB_PROTOCOL_MAX];

static u32
adj_get_mcast_node (fib_protocol_t proto)
{
    switch (proto) {
    case FIB_PROTOCOL_IP4:
	return (ip4_rewrite_mcast_node.index);
    case FIB_PROTOCOL_IP6:
	return (ip6_rewrite_mcast_node.index);
    case FIB_PROTOCOL_MPLS:
	break;
    }
    ASSERT(0);
    return (0);
}

/*
 * adj_mcast_add_or_lock
 *
 * The next_hop address here is used for source address selection in the DP.
 * The mcast adj is added to an interface's connected prefix, the next-hop
 * passed here is the local prefix on the same interface.
 */
adj_index_t
adj_mcast_add_or_lock (fib_protocol_t proto,
                       vnet_link_t link_type,
		       u32 sw_if_index)
{
    ip_adjacency_t * adj;

    vec_validate_init_empty(adj_mcasts[proto], sw_if_index, ADJ_INDEX_INVALID);

    if (ADJ_INDEX_INVALID == adj_mcasts[proto][sw_if_index])
    {
        vnet_main_t *vnm;

        vnm = vnet_get_main();
	adj = adj_alloc(proto);

	adj->lookup_next_index = IP_LOOKUP_NEXT_MCAST;
	adj->ia_nh_proto = proto;
	adj->ia_link = link_type;
	adj_mcasts[proto][sw_if_index] = adj_get_index(adj);
        adj_lock(adj_get_index(adj));

	vnet_rewrite_init(vnm, sw_if_index, link_type,
			  adj_get_mcast_node(proto),
			  vnet_tx_node_index_for_sw_interface(vnm, sw_if_index),
			  &adj->rewrite_header);

	/*
	 * we need a rewrite where the destination IP address is converted
	 * to the appropriate link-layer address. This is interface specific.
	 * So ask the interface to do it.
	 */
	vnet_update_adjacency_for_sw_interface(vnm, sw_if_index,
                                               adj_get_index(adj));
    }
    else
    {
	adj = adj_get(adj_mcasts[proto][sw_if_index]);
        adj_lock(adj_get_index(adj));
    }

    return (adj_get_index(adj));
}

/**
 * adj_mcast_update_rewrite
 *
 * Update the adjacency's rewrite string. A NULL string implies the
 * rewrite is reset (i.e. when ARP/ND entry is gone).
 * NB: the adj being updated may be handling traffic in the DP.
 */
void
adj_mcast_update_rewrite (adj_index_t adj_index,
                          u8 *rewrite,
                          u8 offset)
{
    ip_adjacency_t *adj;

    ASSERT(ADJ_INDEX_INVALID != adj_index);

    adj = adj_get(adj_index);

    /*
     * update the adj's rewrite string and build the arc
     * from the rewrite node to the interface's TX node
     */
    adj_nbr_update_rewrite_internal(adj, IP_LOOKUP_NEXT_MCAST,
                                    adj_get_mcast_node(adj->ia_nh_proto),
                                    vnet_tx_node_index_for_sw_interface(
                                        vnet_get_main(),
                                        adj->rewrite_header.sw_if_index),
                                    rewrite);
    /*
     * set the offset corresponding to the mcast IP address rewrite
     */
    adj->rewrite_header.dst_mcast_offset = offset;
}

/**
 * adj_mcast_midchain_update_rewrite
 *
 * Update the adjacency's rewrite string. A NULL string implies the
 * rewrite is reset (i.e. when ARP/ND entry is gone).
 * NB: the adj being updated may be handling traffic in the DP.
 */
void
adj_mcast_midchain_update_rewrite (adj_index_t adj_index,
                                   adj_midchain_fixup_t fixup,
                                   const void *fixup_data,
                                   adj_flags_t flags,
                                   u8 *rewrite,
                                   u8 offset,
                                   u32 mask)
{
    ip_adjacency_t *adj;

    ASSERT(ADJ_INDEX_INVALID != adj_index);

    adj = adj_get(adj_index);

    /*
     * one time only update. since we don't support changing the tunnel
     * src,dst, this is all we need.
     */
    ASSERT(adj->lookup_next_index == IP_LOOKUP_NEXT_MCAST);
    /*
     * tunnels can always provide a rewrite.
     */
    ASSERT(NULL != rewrite);

    adj_midchain_setup(adj_index, fixup, fixup_data, flags);

    /*
     * update the adj's rewrite string and build the arc
     * from the rewrite node to the interface's TX node
     */
    adj_nbr_update_rewrite_internal(adj, IP_LOOKUP_NEXT_MCAST_MIDCHAIN,
                                    adj_get_mcast_node(adj->ia_nh_proto),
                                    vnet_tx_node_index_for_sw_interface(
                                        vnet_get_main(),
                                        adj->rewrite_header.sw_if_index),
                                    rewrite);

    adj->rewrite_header.dst_mcast_offset = offset;
}

void
adj_mcast_remove (fib_protocol_t proto,
		  u32 sw_if_index)
{
    ASSERT(sw_if_index < vec_len(adj_mcasts[proto]));

    adj_mcasts[proto][sw_if_index] = ADJ_INDEX_INVALID;
}

static clib_error_t *
adj_mcast_interface_state_change (vnet_main_t * vnm,
				  u32 sw_if_index,
				  u32 flags)
{
    /*
     * for each mcast on the interface trigger a walk back to the children
     */
    fib_protocol_t proto;
    ip_adjacency_t *adj;


    for (proto = FIB_PROTOCOL_IP4; proto <= FIB_PROTOCOL_IP6; proto++)
    {
	if (sw_if_index >= vec_len(adj_mcasts[proto]) ||
	    ADJ_INDEX_INVALID == adj_mcasts[proto][sw_if_index])
	    continue;

	adj = adj_get(adj_mcasts[proto][sw_if_index]);

	fib_node_back_walk_ctx_t bw_ctx = {
	    .fnbw_reason = (flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP ?
			    FIB_NODE_BW_REASON_FLAG_INTERFACE_UP :
			    FIB_NODE_BW_REASON_FLAG_INTERFACE_DOWN),
	};

	fib_walk_sync(FIB_NODE_TYPE_ADJ, adj_get_index(adj), &bw_ctx);
    }

    return (NULL);
}

VNET_SW_INTERFACE_ADMIN_UP_DOWN_FUNCTION(adj_mcast_interface_state_change);

/**
 * @brief Invoked on each SW interface of a HW interface when the
 * HW interface state changes
 */
static walk_rc_t
adj_mcast_hw_sw_interface_state_change (vnet_main_t * vnm,
                                        u32 sw_if_index,
                                        void *arg)
{
    adj_mcast_interface_state_change(vnm, sw_if_index, (uword) arg);

    return (WALK_CONTINUE);
}

/**
 * @brief Registered callback for HW interface state changes
 */
static clib_error_t *
adj_mcast_hw_interface_state_change (vnet_main_t * vnm,
                                     u32 hw_if_index,
                                     u32 flags)
{
    /*
     * walk SW interfaces on the HW
     */
    uword sw_flags;

    sw_flags = ((flags & VNET_HW_INTERFACE_FLAG_LINK_UP) ?
                VNET_SW_INTERFACE_FLAG_ADMIN_UP :
                0);

    vnet_hw_interface_walk_sw(vnm, hw_if_index,
                              adj_mcast_hw_sw_interface_state_change,
                              (void*) sw_flags);

    return (NULL);
}

VNET_HW_INTERFACE_LINK_UP_DOWN_FUNCTION(
    adj_mcast_hw_interface_state_change);

static clib_error_t *
adj_mcast_interface_delete (vnet_main_t * vnm,
			    u32 sw_if_index,
			    u32 is_add)
{
    /*
     * for each mcast on the interface trigger a walk back to the children
     */
    fib_protocol_t proto;
    ip_adjacency_t *adj;

    if (is_add)
    {
	/*
	 * not interested in interface additions. we will not back walk
	 * to resolve paths through newly added interfaces. Why? The control
	 * plane should have the brains to add interfaces first, then routes.
	 * So the case where there are paths with a interface that matches
	 * one just created is the case where the path resolved through an
	 * interface that was deleted, and still has not been removed. The
	 * new interface added, is NO GUARANTEE that the interface being
	 * added now, even though it may have the same sw_if_index, is the
	 * same interface that the path needs. So tough!
	 * If the control plane wants these routes to resolve it needs to
	 * remove and add them again.
	 */
	return (NULL);
    }

    for (proto = FIB_PROTOCOL_IP4; proto <= FIB_PROTOCOL_IP6; proto++)
    {
	if (sw_if_index >= vec_len(adj_mcasts[proto]) ||
	    ADJ_INDEX_INVALID == adj_mcasts[proto][sw_if_index])
	    continue;

	adj = adj_get(adj_mcasts[proto][sw_if_index]);

	fib_node_back_walk_ctx_t bw_ctx = {
	    .fnbw_reason =  FIB_NODE_BW_REASON_FLAG_INTERFACE_DELETE,
	};

	fib_walk_sync(FIB_NODE_TYPE_ADJ, adj_get_index(adj), &bw_ctx);
    }

    return (NULL);
}

VNET_SW_INTERFACE_ADD_DEL_FUNCTION(adj_mcast_interface_delete);

/**
 * @brief Walk the multicast Adjacencies on a given interface
 */
void
adj_mcast_walk (u32 sw_if_index,
                fib_protocol_t proto,
                adj_walk_cb_t cb,
                void *ctx)
{
    if (vec_len(adj_mcasts[proto]) > sw_if_index)
    {
        if (ADJ_INDEX_INVALID != adj_mcasts[proto][sw_if_index])
        {
            cb(adj_mcasts[proto][sw_if_index], ctx);
        }
    }
}

u8*
format_adj_mcast (u8* s, va_list *ap)
{
    index_t index = va_arg(*ap, index_t);
    CLIB_UNUSED(u32 indent) = va_arg(*ap, u32);
    ip_adjacency_t * adj = adj_get(index);

    s = format(s, "%U-mcast: ",
               format_fib_protocol, adj->ia_nh_proto);
    if (adj->rewrite_header.flags & VNET_REWRITE_HAS_FEATURES)
        s = format(s, "[features] ");
    s = format (s, "%U",
		format_vnet_rewrite,
                &adj->rewrite_header, sizeof (adj->rewrite_data), 0);

    return (s);
}

u8*
format_adj_mcast_midchain (u8* s, va_list *ap)
{
    index_t index = va_arg(*ap, index_t);
    CLIB_UNUSED(u32 indent) = va_arg(*ap, u32);
    ip_adjacency_t * adj = adj_get(index);

    s = format(s, "%U-mcast-midchain: ",
               format_fib_protocol, adj->ia_nh_proto);
    s = format (s, "%U",
		format_vnet_rewrite,
		&adj->rewrite_header,
                sizeof (adj->rewrite_data), 0);
    s = format (s, "\n%Ustacked-on:\n%U%U",
		format_white_space, indent,
		format_white_space, indent+2,
		format_dpo_id, &adj->sub_type.midchain.next_dpo, indent+2);

    return (s);
}


static void
adj_dpo_lock (dpo_id_t *dpo)
{
    adj_lock(dpo->dpoi_index);
}
static void
adj_dpo_unlock (dpo_id_t *dpo)
{
    adj_unlock(dpo->dpoi_index);
}

const static dpo_vft_t adj_mcast_dpo_vft = {
    .dv_lock = adj_dpo_lock,
    .dv_unlock = adj_dpo_unlock,
    .dv_format = format_adj_mcast,
    .dv_get_urpf = adj_dpo_get_urpf,
};
const static dpo_vft_t adj_mcast_midchain_dpo_vft = {
    .dv_lock = adj_dpo_lock,
    .dv_unlock = adj_dpo_unlock,
    .dv_format = format_adj_mcast_midchain,
    .dv_get_urpf = adj_dpo_get_urpf,
};

/**
 * @brief The per-protocol VLIB graph nodes that are assigned to a mcast
 *        object.
 *
 * this means that these graph nodes are ones from which a mcast is the
 * parent object in the DPO-graph.
 */
const static char* const adj_mcast_ip4_nodes[] =
{
    "ip4-rewrite-mcast",
    NULL,
};
const static char* const adj_mcast_ip6_nodes[] =
{
    "ip6-rewrite-mcast",
    NULL,
};

const static char* const * const adj_mcast_nodes[DPO_PROTO_NUM] =
{
    [DPO_PROTO_IP4]  = adj_mcast_ip4_nodes,
    [DPO_PROTO_IP6]  = adj_mcast_ip6_nodes,
    [DPO_PROTO_MPLS] = NULL,
};

/**
 * @brief The per-protocol VLIB graph nodes that are assigned to a mcast
 *        object.
 *
 * this means that these graph nodes are ones from which a mcast is the
 * parent object in the DPO-graph.
 */
const static char* const adj_mcast_midchain_ip4_nodes[] =
{
    "ip4-mcast-midchain",
    NULL,
};
const static char* const adj_mcast_midchain_ip6_nodes[] =
{
    "ip6-mcast-midchain",
    NULL,
};

const static char* const * const adj_mcast_midchain_nodes[DPO_PROTO_NUM] =
{
    [DPO_PROTO_IP4]  = adj_mcast_midchain_ip4_nodes,
    [DPO_PROTO_IP6]  = adj_mcast_midchain_ip6_nodes,
    [DPO_PROTO_MPLS] = NULL,
};

/**
 * @brief Return the size of the adj DB.
 * This is only for testing purposes so an efficient implementation is not needed
 */
u32
adj_mcast_db_size (void)
{
    u32 n_adjs, sw_if_index;
    fib_protocol_t proto;

    n_adjs = 0;
    for (proto = FIB_PROTOCOL_IP4; proto <= FIB_PROTOCOL_IP6; proto++)
    {
        for (sw_if_index = 0;
             sw_if_index < vec_len(adj_mcasts[proto]);
             sw_if_index++)
        {
            if (ADJ_INDEX_INVALID != adj_mcasts[proto][sw_if_index])
            {
                n_adjs++;
            }
        }
    }
    
    return (n_adjs);
}

void
adj_mcast_module_init (void)
{
    dpo_register(DPO_ADJACENCY_MCAST,
                 &adj_mcast_dpo_vft,
                 adj_mcast_nodes);
    dpo_register(DPO_ADJACENCY_MCAST_MIDCHAIN,
                 &adj_mcast_midchain_dpo_vft,
                 adj_mcast_midchain_nodes);
}
pan> format (s, "\n%Ugso_sz %d gso_l4_hdr_sz %d", format_white_space, indent + 2, t->gso_size, t->gso_l4_hdr_sz); } s = format (s, "\n%U%U", format_white_space, indent, node->format_buffer ? node->format_buffer : format_hex_bytes, t->data, sizeof (t->data)); } return s; } static void vnet_interface_output_trace (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame, uword n_buffers) { u32 n_left, *from; n_left = n_buffers; from = vlib_frame_vector_args (frame); while (n_left >= 4) { u32 bi0, bi1; vlib_buffer_t *b0, *b1; interface_output_trace_t *t0, *t1; /* Prefetch next iteration. */ vlib_prefetch_buffer_with_index (vm, from[2], LOAD); vlib_prefetch_buffer_with_index (vm, from[3], LOAD); bi0 = from[0]; bi1 = from[1]; b0 = vlib_get_buffer (vm, bi0); b1 = vlib_get_buffer (vm, bi1); if (b0->flags & VLIB_BUFFER_IS_TRACED) { t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0])); t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX]; t0->flags = b0->flags; t0->gso_size = vnet_buffer2 (b0)->gso_size; t0->gso_l4_hdr_sz = vnet_buffer2 (b0)->gso_l4_hdr_sz; clib_memcpy_fast (t0->data, vlib_buffer_get_current (b0), sizeof (t0->data)); } if (b1->flags & VLIB_BUFFER_IS_TRACED) { t1 = vlib_add_trace (vm, node, b1, sizeof (t1[0])); t1->sw_if_index = vnet_buffer (b1)->sw_if_index[VLIB_TX]; t1->flags = b1->flags; t1->gso_size = vnet_buffer2 (b1)->gso_size; t1->gso_l4_hdr_sz = vnet_buffer2 (b1)->gso_l4_hdr_sz; clib_memcpy_fast (t1->data, vlib_buffer_get_current (b1), sizeof (t1->data)); } from += 2; n_left -= 2; } while (n_left >= 1) { u32 bi0; vlib_buffer_t *b0; interface_output_trace_t *t0; bi0 = from[0]; b0 = vlib_get_buffer (vm, bi0); if (b0->flags & VLIB_BUFFER_IS_TRACED) { t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0])); t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX]; t0->flags = b0->flags; t0->gso_size = vnet_buffer2 (b0)->gso_size; t0->gso_l4_hdr_sz = vnet_buffer2 (b0)->gso_l4_hdr_sz; clib_memcpy_fast (t0->data, vlib_buffer_get_current (b0), sizeof (t0->data)); } from += 1; n_left -= 1; } } static_always_inline void calc_checksums (vlib_main_t * vm, vlib_buffer_t * b) { ip4_header_t *ip4; ip6_header_t *ip6; tcp_header_t *th; udp_header_t *uh; int is_ip4 = (b->flags & VNET_BUFFER_F_IS_IP4) != 0; int is_ip6 = (b->flags & VNET_BUFFER_F_IS_IP6) != 0; ASSERT (!(is_ip4 && is_ip6)); ip4 = (ip4_header_t *) (b->data + vnet_buffer (b)->l3_hdr_offset); ip6 = (ip6_header_t *) (b->data + vnet_buffer (b)->l3_hdr_offset); th = (tcp_header_t *) (b->data + vnet_buffer (b)->l4_hdr_offset); uh = (udp_header_t *) (b->data + vnet_buffer (b)->l4_hdr_offset); if (is_ip4) { ip4 = (ip4_header_t *) (b->data + vnet_buffer (b)->l3_hdr_offset); if (b->flags & VNET_BUFFER_F_OFFLOAD_IP_CKSUM) ip4->checksum = ip4_header_checksum (ip4); if (b->flags & VNET_BUFFER_F_OFFLOAD_TCP_CKSUM) { th->checksum = 0; th->checksum = ip4_tcp_udp_compute_checksum (vm, b, ip4); } if (b->flags & VNET_BUFFER_F_OFFLOAD_UDP_CKSUM) uh->checksum = ip4_tcp_udp_compute_checksum (vm, b, ip4); } if (is_ip6) { int bogus; if (b->flags & VNET_BUFFER_F_OFFLOAD_TCP_CKSUM) { th->checksum = 0; th->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, b, ip6, &bogus); } if (b->flags & VNET_BUFFER_F_OFFLOAD_UDP_CKSUM) { uh->checksum = 0; uh->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, b, ip6, &bogus); } } b->flags &= ~VNET_BUFFER_F_OFFLOAD_TCP_CKSUM; b->flags &= ~VNET_BUFFER_F_OFFLOAD_UDP_CKSUM; b->flags &= ~VNET_BUFFER_F_OFFLOAD_IP_CKSUM; } static_always_inline u16 tso_alloc_tx_bufs (vlib_main_t * vm, vnet_interface_per_thread_data_t * ptd, vlib_buffer_t * b0, u16 l4_hdr_sz) { u32 n_bytes_b0 = vlib_buffer_length_in_chain (vm, b0); u16 gso_size = vnet_buffer2 (b0)->gso_size; u16 l234_sz = vnet_buffer (b0)->l4_hdr_offset + l4_hdr_sz; /* rounded-up division */ u16 n_bufs = (n_bytes_b0 - l234_sz + (gso_size - 1)) / gso_size; u16 n_alloc; ASSERT (n_bufs > 0); vec_validate (ptd->split_buffers, n_bufs - 1); n_alloc = vlib_buffer_alloc (vm, ptd->split_buffers, n_bufs); if (n_alloc < n_bufs) { vlib_buffer_free (vm, ptd->split_buffers, n_alloc); return 0; } return 1; } static_always_inline void tso_init_buf_from_template_base (vlib_buffer_t * nb0, vlib_buffer_t * b0, u32 flags, u16 length) { nb0->current_data = 0; nb0->total_length_not_including_first_buffer = 0; nb0->flags = VLIB_BUFFER_TOTAL_LENGTH_VALID | flags; clib_memcpy_fast (&nb0->opaque, &b0->opaque, sizeof (nb0->opaque)); clib_memcpy_fast (nb0->data, b0->data, length); nb0->current_length = length; } static_always_inline void tso_init_buf_from_template (vlib_main_t * vm, vlib_buffer_t * nb0, vlib_buffer_t * b0, u16 template_data_sz, u16 gso_size, u8 ** p_dst_ptr, u16 * p_dst_left, u32 next_tcp_seq, u32 flags) { tso_init_buf_from_template_base (nb0, b0, flags, template_data_sz); *p_dst_left = clib_min (gso_size, vlib_buffer_get_default_data_size (vm) - template_data_sz); *p_dst_ptr = nb0->data + template_data_sz; tcp_header_t *tcp = (tcp_header_t *) (nb0->data + vnet_buffer (nb0)->l4_hdr_offset); tcp->seq_number = clib_host_to_net_u32 (next_tcp_seq); } static_always_inline void tso_fixup_segmented_buf (vlib_buffer_t * b0, u8 tcp_flags, int is_ip6) { u16 l3_hdr_offset = vnet_buffer (b0)->l3_hdr_offset; u16 l4_hdr_offset = vnet_buffer (b0)->l4_hdr_offset; ip4_header_t *ip4 = (ip4_header_t *) (b0->data + l3_hdr_offset); ip6_header_t *ip6 = (ip6_header_t *) (b0->data + l3_hdr_offset); tcp_header_t *tcp = (tcp_header_t *) (b0->data + l4_hdr_offset); tcp->flags = tcp_flags; if (is_ip6) ip6->payload_length = clib_host_to_net_u16 (b0->current_length - vnet_buffer (b0)->l4_hdr_offset); else ip4->length = clib_host_to_net_u16 (b0->current_length - vnet_buffer (b0)->l3_hdr_offset); } /** * Allocate the necessary number of ptd->split_buffers, * and segment the possibly chained buffer(s) from b0 into * there. * * Return the cumulative number of bytes sent or zero * if allocation failed. */ static_always_inline u32 tso_segment_buffer (vlib_main_t * vm, vnet_interface_per_thread_data_t * ptd, int do_tx_offloads, u32 sbi0, vlib_buffer_t * sb0, u32 n_bytes_b0) { u32 n_tx_bytes = 0; int is_ip4 = sb0->flags & VNET_BUFFER_F_IS_IP4; int is_ip6 = sb0->flags & VNET_BUFFER_F_IS_IP6; ASSERT (is_ip4 || is_ip6); ASSERT (sb0->flags & VNET_BUFFER_F_L2_HDR_OFFSET_VALID); ASSERT (sb0->flags & VNET_BUFFER_F_L3_HDR_OFFSET_VALID); ASSERT (sb0->flags & VNET_BUFFER_F_L4_HDR_OFFSET_VALID); u16 gso_size = vnet_buffer2 (sb0)->gso_size; int l4_hdr_sz = vnet_buffer2 (sb0)->gso_l4_hdr_sz; u8 save_tcp_flags = 0; u8 tcp_flags_no_fin_psh = 0; u32 next_tcp_seq = 0; tcp_header_t *tcp = (tcp_header_t *) (sb0->data + vnet_buffer (sb0)->l4_hdr_offset); next_tcp_seq = clib_net_to_host_u32 (tcp->seq_number); /* store original flags for last packet and reset FIN and PSH */ save_tcp_flags = tcp->flags; tcp_flags_no_fin_psh = tcp->flags & ~(TCP_FLAG_FIN | TCP_FLAG_PSH); tcp->checksum = 0; u32 default_bflags = sb0->flags & ~(VNET_BUFFER_F_GSO | VLIB_BUFFER_NEXT_PRESENT); u16 l234_sz = vnet_buffer (sb0)->l4_hdr_offset + l4_hdr_sz; int first_data_size = clib_min (gso_size, sb0->current_length - l234_sz); next_tcp_seq += first_data_size; if (PREDICT_FALSE (!tso_alloc_tx_bufs (vm, ptd, sb0, l4_hdr_sz))) return 0; vlib_buffer_t *b0 = vlib_get_buffer (vm, ptd->split_buffers[0]); tso_init_buf_from_template_base (b0, sb0, default_bflags, l4_hdr_sz + first_data_size); u32 total_src_left = n_bytes_b0 - l234_sz - first_data_size; if (total_src_left) { /* Need to copy more segments */ u8 *src_ptr, *dst_ptr; u16 src_left, dst_left; /* current source buffer */ vlib_buffer_t *csb0 = sb0; u32 csbi0 = sbi0; /* current dest buffer */ vlib_buffer_t *cdb0; u16 dbi = 1; /* the buffer [0] is b0 */ src_ptr = sb0->data + l234_sz + first_data_size; src_left = sb0->current_length - l234_sz - first_data_size; b0->current_length = l234_sz + first_data_size; tso_fixup_segmented_buf (b0, tcp_flags_no_fin_psh, is_ip6); if (do_tx_offloads) calc_checksums (vm, b0); /* grab a second buffer and prepare the loop */ ASSERT (dbi < vec_len (ptd->split_buffers)); cdb0 = vlib_get_buffer (vm, ptd->split_buffers[dbi++]); tso_init_buf_from_template (vm, cdb0, b0, l234_sz, gso_size, &dst_ptr, &dst_left, next_tcp_seq, default_bflags); /* an arbitrary large number to catch the runaway loops */ int nloops = 2000; while (total_src_left) { if (nloops-- <= 0) clib_panic ("infinite loop detected"); u16 bytes_to_copy = clib_min (src_left, dst_left); clib_memcpy_fast (dst_ptr, src_ptr, bytes_to_copy); src_left -= bytes_to_copy; src_ptr += bytes_to_copy; total_src_left -= bytes_to_copy; dst_left -= bytes_to_copy; dst_ptr += bytes_to_copy; next_tcp_seq += bytes_to_copy; cdb0->current_length += bytes_to_copy; if (0 == src_left) { int has_next = (csb0->flags & VLIB_BUFFER_NEXT_PRESENT); u32 next_bi = csb0->next_buffer; /* init src to the next buffer in chain */ if (has_next) { csbi0 = next_bi; csb0 = vlib_get_buffer (vm, csbi0); src_left = csb0->current_length; src_ptr = csb0->data; } else { ASSERT (total_src_left == 0); break; } } if (0 == dst_left && total_src_left) { if (do_tx_offloads) calc_checksums (vm, cdb0); n_tx_bytes += cdb0->current_length; ASSERT (dbi < vec_len (ptd->split_buffers)); cdb0 = vlib_get_buffer (vm, ptd->split_buffers[dbi++]); tso_init_buf_from_template (vm, cdb0, b0, l234_sz, gso_size, &dst_ptr, &dst_left, next_tcp_seq, default_bflags); } } tso_fixup_segmented_buf (cdb0, save_tcp_flags, is_ip6); if (do_tx_offloads) calc_checksums (vm, cdb0); n_tx_bytes += cdb0->current_length; } n_tx_bytes += b0->current_length; return n_tx_bytes; } static_always_inline void drop_one_buffer_and_count (vlib_main_t * vm, vnet_main_t * vnm, vlib_node_runtime_t * node, u32 * pbi0, u32 drop_error_code) { u32 thread_index = vm->thread_index; vnet_interface_output_runtime_t *rt = (void *) node->runtime_data; vlib_simple_counter_main_t *cm; cm = vec_elt_at_index (vnm->interface_main.sw_if_counters, VNET_INTERFACE_COUNTER_TX_ERROR); vlib_increment_simple_counter (cm, thread_index, rt->sw_if_index, 1); vlib_error_drop_buffers (vm, node, pbi0, /* buffer stride */ 1, /* n_buffers */ 1, VNET_INTERFACE_OUTPUT_NEXT_DROP, node->node_index, drop_error_code); } static_always_inline uword vnet_interface_output_node_inline_gso (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame, vnet_main_t * vnm, vnet_hw_interface_t * hi, int do_tx_offloads, int do_segmentation) { vnet_interface_output_runtime_t *rt = (void *) node->runtime_data; vnet_sw_interface_t *si; u32 n_left_to_tx, *from, *from_end, *to_tx; u32 n_bytes, n_buffers, n_packets; u32 n_bytes_b0, n_bytes_b1, n_bytes_b2, n_bytes_b3; u32 thread_index = vm->thread_index; vnet_interface_main_t *im = &vnm->interface_main; u32 next_index = VNET_INTERFACE_OUTPUT_NEXT_TX; u32 current_config_index = ~0; u8 arc = im->output_feature_arc_index; vnet_interface_per_thread_data_t *ptd = vec_elt_at_index (im->per_thread_data, thread_index); n_buffers = frame->n_vectors; if (node->flags & VLIB_NODE_FLAG_TRACE) vnet_interface_output_trace (vm, node, frame, n_buffers); from = vlib_frame_vector_args (frame); if (rt->is_deleted) return vlib_error_drop_buffers (vm, node, from, /* buffer stride */ 1, n_buffers, VNET_INTERFACE_OUTPUT_NEXT_DROP, node->node_index, VNET_INTERFACE_OUTPUT_ERROR_INTERFACE_DELETED); si = vnet_get_sw_interface (vnm, rt->sw_if_index); hi = vnet_get_sup_hw_interface (vnm, rt->sw_if_index); if (!(si->flags & (VNET_SW_INTERFACE_FLAG_ADMIN_UP | VNET_SW_INTERFACE_FLAG_BOND_SLAVE)) || !(hi->flags & VNET_HW_INTERFACE_FLAG_LINK_UP)) { vlib_simple_counter_main_t *cm; cm = vec_elt_at_index (vnm->interface_main.sw_if_counters, VNET_INTERFACE_COUNTER_TX_ERROR); vlib_increment_simple_counter (cm, thread_index, rt->sw_if_index, n_buffers); return vlib_error_drop_buffers (vm, node, from, /* buffer stride */ 1, n_buffers, VNET_INTERFACE_OUTPUT_NEXT_DROP, node->node_index, VNET_INTERFACE_OUTPUT_ERROR_INTERFACE_DOWN); } from_end = from + n_buffers; /* Total byte count of all buffers. */ n_bytes = 0; n_packets = 0; /* interface-output feature arc handling */ if (PREDICT_FALSE (vnet_have_features (arc, rt->sw_if_index))) { vnet_feature_config_main_t *fcm; fcm = vnet_feature_get_config_main (arc); current_config_index = vnet_get_feature_config_index (arc, rt->sw_if_index); vnet_get_config_data (&fcm->config_main, &current_config_index, &next_index, 0); } while (from < from_end) { /* Get new next frame since previous incomplete frame may have less than VNET_FRAME_SIZE vectors in it. */ vlib_get_new_next_frame (vm, node, next_index, to_tx, n_left_to_tx); while (from + 8 <= from_end && n_left_to_tx >= 4) { u32 bi0, bi1, bi2, bi3; vlib_buffer_t *b0, *b1, *b2, *b3; u32 tx_swif0, tx_swif1, tx_swif2, tx_swif3; u32 or_flags; /* Prefetch next iteration. */ vlib_prefetch_buffer_with_index (vm, from[4], LOAD); vlib_prefetch_buffer_with_index (vm, from[5], LOAD); vlib_prefetch_buffer_with_index (vm, from[6], LOAD); vlib_prefetch_buffer_with_index (vm, from[7], LOAD); bi0 = from[0]; bi1 = from[1]; bi2 = from[2]; bi3 = from[3]; to_tx[0] = bi0; to_tx[1] = bi1; to_tx[2] = bi2; to_tx[3] = bi3; if (!do_segmentation) { from += 4; to_tx += 4; n_left_to_tx -= 4; } b0 = vlib_get_buffer (vm, bi0); b1 = vlib_get_buffer (vm, bi1); b2 = vlib_get_buffer (vm, bi2); b3 = vlib_get_buffer (vm, bi3); if (do_segmentation) { or_flags = b0->flags | b1->flags | b2->flags | b3->flags; /* go to single loop if we need TSO segmentation */ if (PREDICT_FALSE (or_flags & VNET_BUFFER_F_GSO)) break; from += 4; to_tx += 4; n_left_to_tx -= 4; } /* Be grumpy about zero length buffers for benefit of driver tx function. */ ASSERT (b0->current_length > 0); ASSERT (b1->current_length > 0); ASSERT (b2->current_length > 0); ASSERT (b3->current_length > 0); n_bytes_b0 = vlib_buffer_length_in_chain (vm, b0); n_bytes_b1 = vlib_buffer_length_in_chain (vm, b1); n_bytes_b2 = vlib_buffer_length_in_chain (vm, b2); n_bytes_b3 = vlib_buffer_length_in_chain (vm, b3); tx_swif0 = vnet_buffer (b0)->sw_if_index[VLIB_TX]; tx_swif1 = vnet_buffer (b1)->sw_if_index[VLIB_TX]; tx_swif2 = vnet_buffer (b2)->sw_if_index[VLIB_TX]; tx_swif3 = vnet_buffer (b3)->sw_if_index[VLIB_TX]; n_bytes += n_bytes_b0 + n_bytes_b1; n_bytes += n_bytes_b2 + n_bytes_b3; n_packets += 4; if (PREDICT_FALSE (current_config_index != ~0)) { vnet_buffer (b0)->feature_arc_index = arc; vnet_buffer (b1)->feature_arc_index = arc; vnet_buffer (b2)->feature_arc_index = arc; vnet_buffer (b3)->feature_arc_index = arc; b0->current_config_index = current_config_index; b1->current_config_index = current_config_index; b2->current_config_index = current_config_index; b3->current_config_index = current_config_index; } /* update vlan subif tx counts, if required */ if (PREDICT_FALSE (tx_swif0 != rt->sw_if_index)) { vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_TX, thread_index, tx_swif0, 1, n_bytes_b0); } if (PREDICT_FALSE (tx_swif1 != rt->sw_if_index)) { vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_TX, thread_index, tx_swif1, 1, n_bytes_b1); } if (PREDICT_FALSE (tx_swif2 != rt->sw_if_index)) { vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_TX, thread_index, tx_swif2, 1, n_bytes_b2); } if (PREDICT_FALSE (tx_swif3 != rt->sw_if_index)) { vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_TX, thread_index, tx_swif3, 1, n_bytes_b3); } if (!do_segmentation) or_flags = b0->flags | b1->flags | b2->flags | b3->flags; if (do_tx_offloads) { if (or_flags & (VNET_BUFFER_F_OFFLOAD_TCP_CKSUM | VNET_BUFFER_F_OFFLOAD_UDP_CKSUM | VNET_BUFFER_F_OFFLOAD_IP_CKSUM)) { calc_checksums (vm, b0); calc_checksums (vm, b1); calc_checksums (vm, b2); calc_checksums (vm, b3); } } } while (from + 1 <= from_end && n_left_to_tx >= 1) { u32 bi0; vlib_buffer_t *b0; u32 tx_swif0; bi0 = from[0]; to_tx[0] = bi0; from += 1; to_tx += 1; n_left_to_tx -= 1; b0 = vlib_get_buffer (vm, bi0); /* Be grumpy about zero length buffers for benefit of driver tx function. */ ASSERT (b0->current_length > 0); n_bytes_b0 = vlib_buffer_length_in_chain (vm, b0); tx_swif0 = vnet_buffer (b0)->sw_if_index[VLIB_TX]; n_bytes += n_bytes_b0; n_packets += 1; if (PREDICT_FALSE (current_config_index != ~0)) { vnet_buffer (b0)->feature_arc_index = arc; b0->current_config_index = current_config_index; } if (do_segmentation) { if (PREDICT_FALSE (b0->flags & VNET_BUFFER_F_GSO)) { /* * Undo the enqueue of the b0 - it is not going anywhere, * and will be freed either after it's segmented or * when dropped, if there is no buffers to segment into. */ to_tx -= 1; n_left_to_tx += 1; /* undo the counting. */ n_bytes -= n_bytes_b0; n_packets -= 1; u32 n_tx_bytes = 0; n_tx_bytes = tso_segment_buffer (vm, ptd, do_tx_offloads, bi0, b0, n_bytes_b0); if (PREDICT_FALSE (n_tx_bytes == 0)) { drop_one_buffer_and_count (vm, vnm, node, from - 1, VNET_INTERFACE_OUTPUT_ERROR_NO_BUFFERS_FOR_GSO); continue; } u16 n_tx_bufs = vec_len (ptd->split_buffers); u32 *from_tx_seg = ptd->split_buffers; while (n_tx_bufs > 0) { if (n_tx_bufs >= n_left_to_tx) { while (n_left_to_tx > 0) { to_tx[0] = from_tx_seg[0]; to_tx += 1; from_tx_seg += 1; n_left_to_tx -= 1; n_tx_bufs -= 1; n_packets += 1; } vlib_put_next_frame (vm, node, next_index, n_left_to_tx); vlib_get_new_next_frame (vm, node, next_index, to_tx, n_left_to_tx); } else { while (n_tx_bufs > 0) { to_tx[0] = from_tx_seg[0]; to_tx += 1; from_tx_seg += 1; n_left_to_tx -= 1; n_tx_bufs -= 1; n_packets += 1; } } } n_bytes += n_tx_bytes; if (PREDICT_FALSE (tx_swif0 != rt->sw_if_index)) { vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_TX, thread_index, tx_swif0, _vec_len (ptd->split_buffers), n_tx_bytes); } /* The buffers were enqueued. Reset the length */ _vec_len (ptd->split_buffers) = 0; /* Free the now segmented buffer */ vlib_buffer_free_one (vm, bi0); continue; } } if (PREDICT_FALSE (tx_swif0 != rt->sw_if_index)) { vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_TX, thread_index, tx_swif0, 1, n_bytes_b0); } if (do_tx_offloads) calc_checksums (vm, b0); } vlib_put_next_frame (vm, node, next_index, n_left_to_tx); } /* Update main interface stats. */ vlib_increment_combined_counter (im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_TX, thread_index, rt->sw_if_index, n_packets, n_bytes); return n_buffers; } #endif /* CLIB_MARCH_VARIANT */ static_always_inline void vnet_interface_pcap_tx_trace (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame, int sw_if_index_from_buffer) { u32 n_left_from, *from; u32 sw_if_index; if (PREDICT_TRUE (vm->pcap[VLIB_TX].pcap_enable == 0)) return; if (sw_if_index_from_buffer == 0) { vnet_interface_output_runtime_t *rt = (void *) node->runtime_data; sw_if_index = rt->sw_if_index; } else sw_if_index = ~0; n_left_from = frame->n_vectors; from = vlib_frame_vector_args (frame); while (n_left_from > 0) { u32 bi0 = from[0]; vlib_buffer_t *b0 = vlib_get_buffer (vm, bi0); if (sw_if_index_from_buffer) sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX]; if (vm->pcap[VLIB_TX].pcap_sw_if_index == 0 || vm->pcap[VLIB_TX].pcap_sw_if_index == sw_if_index) pcap_add_buffer (&vm->pcap[VLIB_TX].pcap_main, vm, bi0, 512); from++; n_left_from--; } } #ifndef CLIB_MARCH_VARIANT static_always_inline uword vnet_interface_output_node_inline (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame, vnet_main_t * vnm, vnet_hw_interface_t * hi, int do_tx_offloads) { vnet_interface_pcap_tx_trace (vm, node, frame, 0 /* sw_if_index_from_buffer */ ); /* * The 3-headed "if" is here because we want to err on the side * of not impacting the non-GSO performance - so for the more * common case of no GSO interfaces we want to prevent the * segmentation codepath from being there altogether. */ if (PREDICT_TRUE (vnm->interface_main.gso_interface_count == 0)) return vnet_interface_output_node_inline_gso (vm, node, frame, vnm, hi, do_tx_offloads, /* do_segmentation */ 0); else if (hi->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) return vnet_interface_output_node_inline_gso (vm, node, frame, vnm, hi, do_tx_offloads, /* do_segmentation */ 0); else return vnet_interface_output_node_inline_gso (vm, node, frame, vnm, hi, do_tx_offloads, /* do_segmentation */ 1); } uword vnet_interface_output_node (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame) { vnet_main_t *vnm = vnet_get_main (); vnet_hw_interface_t *hi; vnet_interface_output_runtime_t *rt = (void *) node->runtime_data; hi = vnet_get_sup_hw_interface (vnm, rt->sw_if_index); vnet_interface_pcap_tx_trace (vm, node, frame, 0 /* sw_if_index_from_buffer */ ); if (hi->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_TX_L4_CKSUM_OFFLOAD) return vnet_interface_output_node_inline (vm, node, frame, vnm, hi, /* do_tx_offloads */ 0); else return vnet_interface_output_node_inline (vm, node, frame, vnm, hi, /* do_tx_offloads */ 1); } #endif /* CLIB_MARCH_VARIANT */ /* Use buffer's sw_if_index[VNET_TX] to choose output interface. */ VLIB_NODE_FN (vnet_per_buffer_interface_output_node) (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame) { vnet_main_t *vnm = vnet_get_main (); u32 n_left_to_next, *from, *to_next; u32 n_left_from, next_index; vnet_interface_pcap_tx_trace (vm, node, frame, 1 /* sw_if_index_from_buffer */ ); n_left_from = frame->n_vectors; from = vlib_frame_vector_args (frame); next_index = node->cached_next_index; while (n_left_from > 0) { vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next); while (n_left_from >= 4 && n_left_to_next >= 2) { u32 bi0, bi1, next0, next1; vlib_buffer_t *b0, *b1; vnet_hw_interface_t *hi0, *hi1; /* Prefetch next iteration. */ vlib_prefetch_buffer_with_index (vm, from[2], LOAD); vlib_prefetch_buffer_with_index (vm, from[3], LOAD); bi0 = from[0]; bi1 = from[1]; to_next[0] = bi0; to_next[1] = bi1; from += 2; to_next += 2; n_left_to_next -= 2; n_left_from -= 2; b0 = vlib_get_buffer (vm, bi0); b1 = vlib_get_buffer (vm, bi1); hi0 = vnet_get_sup_hw_interface (vnm, vnet_buffer (b0)->sw_if_index [VLIB_TX]); hi1 = vnet_get_sup_hw_interface (vnm, vnet_buffer (b1)->sw_if_index [VLIB_TX]); next0 = hi0->output_node_next_index; next1 = hi1->output_node_next_index; vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next, n_left_to_next, bi0, bi1, next0, next1); } while (n_left_from > 0 && n_left_to_next > 0) { u32 bi0, next0; vlib_buffer_t *b0; vnet_hw_interface_t *hi0; bi0 = from[0]; to_next[0] = bi0; from += 1; to_next += 1; n_left_to_next -= 1; n_left_from -= 1; b0 = vlib_get_buffer (vm, bi0); hi0 = vnet_get_sup_hw_interface (vnm, vnet_buffer (b0)->sw_if_index [VLIB_TX]); next0 = hi0->output_node_next_index; vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next, n_left_to_next, bi0, next0); } vlib_put_next_frame (vm, node, next_index, n_left_to_next); } return frame->n_vectors; } typedef struct vnet_error_trace_t_ { u32 sw_if_index; } vnet_error_trace_t; static u8 * format_vnet_error_trace (u8 * s, va_list * va) { CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *); CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *); vnet_error_trace_t *t = va_arg (*va, vnet_error_trace_t *); s = format (s, "rx:%U", format_vnet_sw_if_index_name, vnet_get_main (), t->sw_if_index); return s; } static void interface_trace_buffers (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame) { u32 n_left, *buffers; buffers = vlib_frame_vector_args (frame); n_left = frame->n_vectors; while (n_left >= 4) { u32 bi0, bi1; vlib_buffer_t *b0, *b1; vnet_error_trace_t *t0, *t1; /* Prefetch next iteration. */ vlib_prefetch_buffer_with_index (vm, buffers[2], LOAD); vlib_prefetch_buffer_with_index (vm, buffers[3], LOAD); bi0 = buffers[0]; bi1 = buffers[1]; b0 = vlib_get_buffer (vm, bi0); b1 = vlib_get_buffer (vm, bi1); if (b0->flags & VLIB_BUFFER_IS_TRACED) { t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0])); t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX]; } if (b1->flags & VLIB_BUFFER_IS_TRACED) { t1 = vlib_add_trace (vm, node, b1, sizeof (t1[0])); t1->sw_if_index = vnet_buffer (b1)->sw_if_index[VLIB_RX]; } buffers += 2; n_left -= 2; } while (n_left >= 1) { u32 bi0; vlib_buffer_t *b0; vnet_error_trace_t *t0; bi0 = buffers[0]; b0 = vlib_get_buffer (vm, bi0); if (b0->flags & VLIB_BUFFER_IS_TRACED) { t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0])); t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX]; } buffers += 1; n_left -= 1; } } typedef enum { VNET_ERROR_DISPOSITION_DROP, VNET_ERROR_DISPOSITION_PUNT, VNET_ERROR_N_DISPOSITION, } vnet_error_disposition_t; static_always_inline uword interface_drop_punt (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame, vnet_error_disposition_t disposition) { u32 *from, n_left, thread_index, *sw_if_index; vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b; u32 sw_if_indices[VLIB_FRAME_SIZE]; vlib_simple_counter_main_t *cm; u16 nexts[VLIB_FRAME_SIZE]; vnet_main_t *vnm; vnm = vnet_get_main (); thread_index = vm->thread_index; from = vlib_frame_vector_args (frame); n_left = frame->n_vectors; b = bufs; sw_if_index = sw_if_indices; vlib_get_buffers (vm, from, bufs, n_left); if (node->flags & VLIB_NODE_FLAG_TRACE) interface_trace_buffers (vm, node, frame); /* All going to drop regardless, this is just a counting exercise */ clib_memset (nexts, 0, sizeof (nexts)); cm = vec_elt_at_index (vnm->interface_main.sw_if_counters, (disposition == VNET_ERROR_DISPOSITION_PUNT ? VNET_INTERFACE_COUNTER_PUNT : VNET_INTERFACE_COUNTER_DROP)); /* collect the array of interfaces first ... */ while (n_left >= 4) { if (n_left >= 12) { /* Prefetch 8 ahead - there's not much going on in each iteration */ vlib_prefetch_buffer_header (b[4], LOAD); vlib_prefetch_buffer_header (b[5], LOAD); vlib_prefetch_buffer_header (b[6], LOAD); vlib_prefetch_buffer_header (b[7], LOAD); } sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_RX]; sw_if_index[1] = vnet_buffer (b[1])->sw_if_index[VLIB_RX]; sw_if_index[2] = vnet_buffer (b[2])->sw_if_index[VLIB_RX]; sw_if_index[3] = vnet_buffer (b[3])->sw_if_index[VLIB_RX]; sw_if_index += 4; n_left -= 4; b += 4; } while (n_left) { sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_RX]; sw_if_index += 1; n_left -= 1; b += 1; } /* ... then count against them in blocks */ n_left = frame->n_vectors; while (n_left) { vnet_sw_interface_t *sw_if0; u16 off, count; off = frame->n_vectors - n_left; sw_if_index = sw_if_indices + off; count = clib_count_equal_u32 (sw_if_index, n_left); n_left -= count; vlib_increment_simple_counter (cm, thread_index, sw_if_index[0], count); /* Increment super-interface drop/punt counters for sub-interfaces. */ sw_if0 = vnet_get_sw_interface (vnm, sw_if_index[0]); if (sw_if0->sup_sw_if_index != sw_if_index[0]) vlib_increment_simple_counter (cm, thread_index, sw_if0->sup_sw_if_index, count); } vlib_buffer_enqueue_to_next (vm, node, from, nexts, frame->n_vectors); return frame->n_vectors; } static inline void pcap_drop_trace (vlib_main_t * vm, vnet_interface_main_t * im, vlib_frame_t * f) { u32 *from; u32 n_left = f->n_vectors; vlib_buffer_t *b0, *p1; u32 bi0; i16 save_current_data; u16 save_current_length; from = vlib_frame_vector_args (f); while (n_left > 0) { if (PREDICT_TRUE (n_left > 1)) { p1 = vlib_get_buffer (vm, from[1]); vlib_prefetch_buffer_header (p1, LOAD); } bi0 = from[0]; b0 = vlib_get_buffer (vm, bi0); from++; n_left--; /* See if we're pointedly ignoring this specific error */ if (im->pcap_drop_filter_hash && hash_get (im->pcap_drop_filter_hash, b0->error)) continue; /* Trace all drops, or drops received on a specific interface */ if (im->pcap_sw_if_index == 0 || im->pcap_sw_if_index == vnet_buffer (b0)->sw_if_index[VLIB_RX]) { save_current_data = b0->current_data; save_current_length = b0->current_length; /* * Typically, we'll need to rewind the buffer */ if (b0->current_data > 0) vlib_buffer_advance (b0, (word) - b0->current_data); pcap_add_buffer (&im->pcap_main, vm, bi0, 512); b0->current_data = save_current_data; b0->current_length = save_current_length; } } } #ifndef CLIB_MARCH_VARIANT void vnet_pcap_drop_trace_filter_add_del (u32 error_index, int is_add) { vnet_interface_main_t *im = &vnet_get_main ()->interface_main; if (im->pcap_drop_filter_hash == 0) im->pcap_drop_filter_hash = hash_create (0, sizeof (uword)); if (is_add) hash_set (im->pcap_drop_filter_hash, error_index, 1); else hash_unset (im->pcap_drop_filter_hash, error_index); } #endif /* CLIB_MARCH_VARIANT */ VLIB_NODE_FN (interface_drop) (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame) { vnet_interface_main_t *im = &vnet_get_main ()->interface_main; if (PREDICT_FALSE (im->drop_pcap_enable)) pcap_drop_trace (vm, im, frame); return interface_drop_punt (vm, node, frame, VNET_ERROR_DISPOSITION_DROP); } VLIB_NODE_FN (interface_punt) (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame) { return interface_drop_punt (vm, node, frame, VNET_ERROR_DISPOSITION_PUNT); } /* *INDENT-OFF* */ VLIB_REGISTER_NODE (interface_drop) = { .name = "error-drop", .vector_size = sizeof (u32), .format_trace = format_vnet_error_trace, .n_next_nodes = 1, .next_nodes = { [0] = "drop", }, }; /* *INDENT-ON* */ /* *INDENT-OFF* */ VLIB_REGISTER_NODE (interface_punt) = { .name = "error-punt", .vector_size = sizeof (u32), .format_trace = format_vnet_error_trace, .n_next_nodes = 1, .next_nodes = { [0] = "punt", }, }; /* *INDENT-ON* */ /* *INDENT-OFF* */ VLIB_REGISTER_NODE (vnet_per_buffer_interface_output_node) = { .name = "interface-output", .vector_size = sizeof (u32), }; /* *INDENT-ON* */ static uword interface_tx_node_fn (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * from_frame) { vnet_main_t *vnm = vnet_get_main (); u32 last_sw_if_index = ~0; vlib_frame_t *to_frame = 0; vnet_hw_interface_t *hw = 0; u32 *from, *to_next = 0; u32 n_left_from; from = vlib_frame_vector_args (from_frame); n_left_from = from_frame->n_vectors; while (n_left_from > 0) { u32 bi0; vlib_buffer_t *b0; u32 sw_if_index0; bi0 = from[0]; from++; n_left_from--; b0 = vlib_get_buffer (vm, bi0); sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_TX]; if (PREDICT_FALSE ((last_sw_if_index != sw_if_index0) || to_frame == 0)) { if (to_frame) { hw = vnet_get_sup_hw_interface (vnm, last_sw_if_index); vlib_put_frame_to_node (vm, hw->tx_node_index, to_frame); } last_sw_if_index = sw_if_index0; hw = vnet_get_sup_hw_interface (vnm, sw_if_index0); to_frame = vlib_get_frame_to_node (vm, hw->tx_node_index); to_next = vlib_frame_vector_args (to_frame); } to_next[0] = bi0; to_next++; to_frame->n_vectors++; } vlib_put_frame_to_node (vm, hw->tx_node_index, to_frame); return from_frame->n_vectors; } /* *INDENT-OFF* */ VLIB_REGISTER_NODE (interface_tx, static) = { .function = interface_tx_node_fn, .name = "interface-tx", .vector_size = sizeof (u32), .n_next_nodes = 1, .next_nodes = { [0] = "error-drop", }, }; VNET_FEATURE_ARC_INIT (interface_output, static) = { .arc_name = "interface-output", .start_nodes = VNET_FEATURES (0), .last_in_arc = "interface-tx", .arc_index_ptr = &vnet_main.interface_main.output_feature_arc_index, }; VNET_FEATURE_INIT (span_tx, static) = { .arc_name = "interface-output", .node_name = "span-output", .runs_before = VNET_FEATURES ("interface-tx"), }; VNET_FEATURE_INIT (ipsec_if_tx, static) = { .arc_name = "interface-output", .node_name = "ipsec-if-output", .runs_before = VNET_FEATURES ("interface-tx"), }; VNET_FEATURE_INIT (interface_tx, static) = { .arc_name = "interface-output", .node_name = "interface-tx", .runs_before = 0, }; /* *INDENT-ON* */ #ifndef CLIB_MARCH_VARIANT clib_error_t * vnet_per_buffer_interface_output_hw_interface_add_del (vnet_main_t * vnm, u32 hw_if_index, u32 is_create) { vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index); u32 next_index; if (hi->output_node_index == 0) return 0; next_index = vlib_node_add_next (vnm->vlib_main, vnet_per_buffer_interface_output_node.index, hi->output_node_index); hi->output_node_next_index = next_index; return 0; } VNET_HW_INTERFACE_ADD_DEL_FUNCTION (vnet_per_buffer_interface_output_hw_interface_add_del); void vnet_set_interface_output_node (vnet_main_t * vnm, u32 hw_if_index, u32 node_index) { ASSERT (node_index); vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index); u32 next_index = vlib_node_add_next (vnm->vlib_main, vnet_per_buffer_interface_output_node.index, node_index); hi->output_node_next_index = next_index; hi->output_node_index = node_index; } #endif /* CLIB_MARCH_VARIANT */ static clib_error_t * pcap_drop_trace_command_fn (vlib_main_t * vm, unformat_input_t * input, vlib_cli_command_t * cmd) { vnet_main_t *vnm = vnet_get_main (); vnet_interface_main_t *im = &vnm->interface_main; u8 *filename; u32 max; int matched = 0; clib_error_t *error = 0; while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT) { if (unformat (input, "on")) { if (im->drop_pcap_enable == 0) { if (im->pcap_filename == 0) im->pcap_filename = format (0, "/tmp/drop.pcap%c", 0); clib_memset (&im->pcap_main, 0, sizeof (im->pcap_main)); im->pcap_main.file_name = (char *) im->pcap_filename; im->pcap_main.n_packets_to_capture = 100; if (im->pcap_pkts_to_capture) im->pcap_main.n_packets_to_capture = im->pcap_pkts_to_capture; im->pcap_main.packet_type = PCAP_PACKET_TYPE_ethernet; im->drop_pcap_enable = 1; matched = 1; vlib_cli_output (vm, "pcap drop capture on..."); } else { vlib_cli_output (vm, "pcap drop capture already on..."); } matched = 1; } else if (unformat (input, "off")) { matched = 1; if (im->drop_pcap_enable) { vlib_cli_output (vm, "captured %d pkts...", im->pcap_main.n_packets_captured); if (im->pcap_main.n_packets_captured) { im->pcap_main.n_packets_to_capture = im->pcap_main.n_packets_captured; error = pcap_write (&im->pcap_main); if (error) clib_error_report (error); else vlib_cli_output (vm, "saved to %s...", im->pcap_filename); } } else { vlib_cli_output (vm, "pcap drop capture already off..."); } im->drop_pcap_enable = 0; } else if (unformat (input, "max %d", &max)) { im->pcap_pkts_to_capture = max; matched = 1; } else if (unformat (input, "intfc %U", unformat_vnet_sw_interface, vnm, &im->pcap_sw_if_index)) matched = 1; else if (unformat (input, "intfc any")) { im->pcap_sw_if_index = 0; matched = 1; } else if (unformat (input, "file %s", &filename)) { u8 *chroot_filename; /* Brain-police user path input */ if (strstr ((char *) filename, "..") || index ((char *) filename, '/')) { vlib_cli_output (vm, "illegal characters in filename '%s'", filename); continue; } chroot_filename = format (0, "/tmp/%s%c", filename, 0); vec_free (filename); if (im->pcap_filename) vec_free (im->pcap_filename); im->pcap_filename = chroot_filename; im->pcap_main.file_name = (char *) im->pcap_filename; matched = 1; } else if (unformat (input, "status")) { if (im->drop_pcap_enable == 0) { vlib_cli_output (vm, "pcap drop capture is off..."); continue; } vlib_cli_output (vm, "pcap drop capture: %d of %d pkts...", im->pcap_main.n_packets_captured, im->pcap_main.n_packets_to_capture); matched = 1; } else break; } if (matched == 0) return clib_error_return (0, "unknown input `%U'", format_unformat_error, input); return 0; } /* *INDENT-OFF* */ VLIB_CLI_COMMAND (pcap_trace_command, static) = { .path = "pcap drop trace", .short_help = "pcap drop trace on off max <nn> intfc <intfc> file <name> status", .function = pcap_drop_trace_command_fn, }; /* *INDENT-ON* */ /* * fd.io coding-style-patch-verification: ON * * Local Variables: * eval: (c-set-style "gnu") * End: */