f4ecc395ab130c25acc6a28da0309ba35e65e55f
[vpp.git] / src / vnet / ip / ip4_forward.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  * ip/ip4_forward.c: IP v4 forwarding
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/ip.h>
42 #include <vnet/ethernet/ethernet.h>     /* for ethernet_header_t */
43 #include <vnet/ethernet/arp_packet.h>   /* for ethernet_arp_header_t */
44 #include <vnet/ppp/ppp.h>
45 #include <vnet/srp/srp.h>       /* for srp_hw_interface_class */
46 #include <vnet/api_errno.h>     /* for API error numbers */
47 #include <vnet/fib/fib_table.h> /* for FIB table and entry creation */
48 #include <vnet/fib/fib_entry.h> /* for FIB table and entry creation */
49 #include <vnet/fib/fib_urpf_list.h>     /* for FIB uRPF check */
50 #include <vnet/fib/ip4_fib.h>
51 #include <vnet/dpo/load_balance.h>
52 #include <vnet/dpo/load_balance_map.h>
53 #include <vnet/dpo/classify_dpo.h>
54 #include <vnet/mfib/mfib_table.h>       /* for mFIB table and entry creation */
55
56 /**
57  * @file
58  * @brief IPv4 Forwarding.
59  *
60  * This file contains the source code for IPv4 forwarding.
61  */
62
63 void
64 ip4_forward_next_trace (vlib_main_t * vm,
65                         vlib_node_runtime_t * node,
66                         vlib_frame_t * frame,
67                         vlib_rx_or_tx_t which_adj_index);
68
69 always_inline uword
70 ip4_lookup_inline (vlib_main_t * vm,
71                    vlib_node_runtime_t * node,
72                    vlib_frame_t * frame,
73                    int lookup_for_responses_to_locally_received_packets)
74 {
75   ip4_main_t *im = &ip4_main;
76   vlib_combined_counter_main_t *cm = &load_balance_main.lbm_to_counters;
77   u32 n_left_from, n_left_to_next, *from, *to_next;
78   ip_lookup_next_t next;
79   u32 thread_index = vlib_get_thread_index ();
80
81   from = vlib_frame_vector_args (frame);
82   n_left_from = frame->n_vectors;
83   next = node->cached_next_index;
84
85   while (n_left_from > 0)
86     {
87       vlib_get_next_frame (vm, node, next, to_next, n_left_to_next);
88
89       while (n_left_from >= 8 && n_left_to_next >= 4)
90         {
91           vlib_buffer_t *p0, *p1, *p2, *p3;
92           ip4_header_t *ip0, *ip1, *ip2, *ip3;
93           ip_lookup_next_t next0, next1, next2, next3;
94           const load_balance_t *lb0, *lb1, *lb2, *lb3;
95           ip4_fib_mtrie_t *mtrie0, *mtrie1, *mtrie2, *mtrie3;
96           ip4_fib_mtrie_leaf_t leaf0, leaf1, leaf2, leaf3;
97           ip4_address_t *dst_addr0, *dst_addr1, *dst_addr2, *dst_addr3;
98           u32 pi0, fib_index0, lb_index0;
99           u32 pi1, fib_index1, lb_index1;
100           u32 pi2, fib_index2, lb_index2;
101           u32 pi3, fib_index3, lb_index3;
102           flow_hash_config_t flow_hash_config0, flow_hash_config1;
103           flow_hash_config_t flow_hash_config2, flow_hash_config3;
104           u32 hash_c0, hash_c1, hash_c2, hash_c3;
105           const dpo_id_t *dpo0, *dpo1, *dpo2, *dpo3;
106
107           /* Prefetch next iteration. */
108           {
109             vlib_buffer_t *p4, *p5, *p6, *p7;
110
111             p4 = vlib_get_buffer (vm, from[4]);
112             p5 = vlib_get_buffer (vm, from[5]);
113             p6 = vlib_get_buffer (vm, from[6]);
114             p7 = vlib_get_buffer (vm, from[7]);
115
116             vlib_prefetch_buffer_header (p4, LOAD);
117             vlib_prefetch_buffer_header (p5, LOAD);
118             vlib_prefetch_buffer_header (p6, LOAD);
119             vlib_prefetch_buffer_header (p7, LOAD);
120
121             CLIB_PREFETCH (p4->data, sizeof (ip0[0]), LOAD);
122             CLIB_PREFETCH (p5->data, sizeof (ip0[0]), LOAD);
123             CLIB_PREFETCH (p6->data, sizeof (ip0[0]), LOAD);
124             CLIB_PREFETCH (p7->data, sizeof (ip0[0]), LOAD);
125           }
126
127           pi0 = to_next[0] = from[0];
128           pi1 = to_next[1] = from[1];
129           pi2 = to_next[2] = from[2];
130           pi3 = to_next[3] = from[3];
131
132           from += 4;
133           to_next += 4;
134           n_left_to_next -= 4;
135           n_left_from -= 4;
136
137           p0 = vlib_get_buffer (vm, pi0);
138           p1 = vlib_get_buffer (vm, pi1);
139           p2 = vlib_get_buffer (vm, pi2);
140           p3 = vlib_get_buffer (vm, pi3);
141
142           ip0 = vlib_buffer_get_current (p0);
143           ip1 = vlib_buffer_get_current (p1);
144           ip2 = vlib_buffer_get_current (p2);
145           ip3 = vlib_buffer_get_current (p3);
146
147           dst_addr0 = &ip0->dst_address;
148           dst_addr1 = &ip1->dst_address;
149           dst_addr2 = &ip2->dst_address;
150           dst_addr3 = &ip3->dst_address;
151
152           fib_index0 =
153             vec_elt (im->fib_index_by_sw_if_index,
154                      vnet_buffer (p0)->sw_if_index[VLIB_RX]);
155           fib_index1 =
156             vec_elt (im->fib_index_by_sw_if_index,
157                      vnet_buffer (p1)->sw_if_index[VLIB_RX]);
158           fib_index2 =
159             vec_elt (im->fib_index_by_sw_if_index,
160                      vnet_buffer (p2)->sw_if_index[VLIB_RX]);
161           fib_index3 =
162             vec_elt (im->fib_index_by_sw_if_index,
163                      vnet_buffer (p3)->sw_if_index[VLIB_RX]);
164           fib_index0 =
165             (vnet_buffer (p0)->sw_if_index[VLIB_TX] ==
166              (u32) ~ 0) ? fib_index0 : vnet_buffer (p0)->sw_if_index[VLIB_TX];
167           fib_index1 =
168             (vnet_buffer (p1)->sw_if_index[VLIB_TX] ==
169              (u32) ~ 0) ? fib_index1 : vnet_buffer (p1)->sw_if_index[VLIB_TX];
170           fib_index2 =
171             (vnet_buffer (p2)->sw_if_index[VLIB_TX] ==
172              (u32) ~ 0) ? fib_index2 : vnet_buffer (p2)->sw_if_index[VLIB_TX];
173           fib_index3 =
174             (vnet_buffer (p3)->sw_if_index[VLIB_TX] ==
175              (u32) ~ 0) ? fib_index3 : vnet_buffer (p3)->sw_if_index[VLIB_TX];
176
177
178           if (!lookup_for_responses_to_locally_received_packets)
179             {
180               mtrie0 = &ip4_fib_get (fib_index0)->mtrie;
181               mtrie1 = &ip4_fib_get (fib_index1)->mtrie;
182               mtrie2 = &ip4_fib_get (fib_index2)->mtrie;
183               mtrie3 = &ip4_fib_get (fib_index3)->mtrie;
184
185               leaf0 = ip4_fib_mtrie_lookup_step_one (mtrie0, dst_addr0);
186               leaf1 = ip4_fib_mtrie_lookup_step_one (mtrie1, dst_addr1);
187               leaf2 = ip4_fib_mtrie_lookup_step_one (mtrie2, dst_addr2);
188               leaf3 = ip4_fib_mtrie_lookup_step_one (mtrie3, dst_addr3);
189             }
190
191           if (!lookup_for_responses_to_locally_received_packets)
192             {
193               leaf0 = ip4_fib_mtrie_lookup_step (mtrie0, leaf0, dst_addr0, 2);
194               leaf1 = ip4_fib_mtrie_lookup_step (mtrie1, leaf1, dst_addr1, 2);
195               leaf2 = ip4_fib_mtrie_lookup_step (mtrie2, leaf2, dst_addr2, 2);
196               leaf3 = ip4_fib_mtrie_lookup_step (mtrie3, leaf3, dst_addr3, 2);
197             }
198
199           if (!lookup_for_responses_to_locally_received_packets)
200             {
201               leaf0 = ip4_fib_mtrie_lookup_step (mtrie0, leaf0, dst_addr0, 3);
202               leaf1 = ip4_fib_mtrie_lookup_step (mtrie1, leaf1, dst_addr1, 3);
203               leaf2 = ip4_fib_mtrie_lookup_step (mtrie2, leaf2, dst_addr2, 3);
204               leaf3 = ip4_fib_mtrie_lookup_step (mtrie3, leaf3, dst_addr3, 3);
205             }
206
207           if (lookup_for_responses_to_locally_received_packets)
208             {
209               lb_index0 = vnet_buffer (p0)->ip.adj_index[VLIB_RX];
210               lb_index1 = vnet_buffer (p1)->ip.adj_index[VLIB_RX];
211               lb_index2 = vnet_buffer (p2)->ip.adj_index[VLIB_RX];
212               lb_index3 = vnet_buffer (p3)->ip.adj_index[VLIB_RX];
213             }
214           else
215             {
216               lb_index0 = ip4_fib_mtrie_leaf_get_adj_index (leaf0);
217               lb_index1 = ip4_fib_mtrie_leaf_get_adj_index (leaf1);
218               lb_index2 = ip4_fib_mtrie_leaf_get_adj_index (leaf2);
219               lb_index3 = ip4_fib_mtrie_leaf_get_adj_index (leaf3);
220             }
221
222           ASSERT (lb_index0 && lb_index1 && lb_index2 && lb_index3);
223           lb0 = load_balance_get (lb_index0);
224           lb1 = load_balance_get (lb_index1);
225           lb2 = load_balance_get (lb_index2);
226           lb3 = load_balance_get (lb_index3);
227
228           ASSERT (lb0->lb_n_buckets > 0);
229           ASSERT (is_pow2 (lb0->lb_n_buckets));
230           ASSERT (lb1->lb_n_buckets > 0);
231           ASSERT (is_pow2 (lb1->lb_n_buckets));
232           ASSERT (lb2->lb_n_buckets > 0);
233           ASSERT (is_pow2 (lb2->lb_n_buckets));
234           ASSERT (lb3->lb_n_buckets > 0);
235           ASSERT (is_pow2 (lb3->lb_n_buckets));
236
237           /* Use flow hash to compute multipath adjacency. */
238           hash_c0 = vnet_buffer (p0)->ip.flow_hash = 0;
239           hash_c1 = vnet_buffer (p1)->ip.flow_hash = 0;
240           hash_c2 = vnet_buffer (p2)->ip.flow_hash = 0;
241           hash_c3 = vnet_buffer (p3)->ip.flow_hash = 0;
242           if (PREDICT_FALSE (lb0->lb_n_buckets > 1))
243             {
244               flow_hash_config0 = lb0->lb_hash_config;
245               hash_c0 = vnet_buffer (p0)->ip.flow_hash =
246                 ip4_compute_flow_hash (ip0, flow_hash_config0);
247               dpo0 =
248                 load_balance_get_fwd_bucket (lb0,
249                                              (hash_c0 &
250                                               (lb0->lb_n_buckets_minus_1)));
251             }
252           else
253             {
254               dpo0 = load_balance_get_bucket_i (lb0, 0);
255             }
256           if (PREDICT_FALSE (lb1->lb_n_buckets > 1))
257             {
258               flow_hash_config1 = lb1->lb_hash_config;
259               hash_c1 = vnet_buffer (p1)->ip.flow_hash =
260                 ip4_compute_flow_hash (ip1, flow_hash_config1);
261               dpo1 =
262                 load_balance_get_fwd_bucket (lb1,
263                                              (hash_c1 &
264                                               (lb1->lb_n_buckets_minus_1)));
265             }
266           else
267             {
268               dpo1 = load_balance_get_bucket_i (lb1, 0);
269             }
270           if (PREDICT_FALSE (lb2->lb_n_buckets > 1))
271             {
272               flow_hash_config2 = lb2->lb_hash_config;
273               hash_c2 = vnet_buffer (p2)->ip.flow_hash =
274                 ip4_compute_flow_hash (ip2, flow_hash_config2);
275               dpo2 =
276                 load_balance_get_fwd_bucket (lb2,
277                                              (hash_c2 &
278                                               (lb2->lb_n_buckets_minus_1)));
279             }
280           else
281             {
282               dpo2 = load_balance_get_bucket_i (lb2, 0);
283             }
284           if (PREDICT_FALSE (lb3->lb_n_buckets > 1))
285             {
286               flow_hash_config3 = lb3->lb_hash_config;
287               hash_c3 = vnet_buffer (p3)->ip.flow_hash =
288                 ip4_compute_flow_hash (ip3, flow_hash_config3);
289               dpo3 =
290                 load_balance_get_fwd_bucket (lb3,
291                                              (hash_c3 &
292                                               (lb3->lb_n_buckets_minus_1)));
293             }
294           else
295             {
296               dpo3 = load_balance_get_bucket_i (lb3, 0);
297             }
298
299           next0 = dpo0->dpoi_next_node;
300           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = dpo0->dpoi_index;
301           next1 = dpo1->dpoi_next_node;
302           vnet_buffer (p1)->ip.adj_index[VLIB_TX] = dpo1->dpoi_index;
303           next2 = dpo2->dpoi_next_node;
304           vnet_buffer (p2)->ip.adj_index[VLIB_TX] = dpo2->dpoi_index;
305           next3 = dpo3->dpoi_next_node;
306           vnet_buffer (p3)->ip.adj_index[VLIB_TX] = dpo3->dpoi_index;
307
308           vlib_increment_combined_counter
309             (cm, thread_index, lb_index0, 1,
310              vlib_buffer_length_in_chain (vm, p0));
311           vlib_increment_combined_counter
312             (cm, thread_index, lb_index1, 1,
313              vlib_buffer_length_in_chain (vm, p1));
314           vlib_increment_combined_counter
315             (cm, thread_index, lb_index2, 1,
316              vlib_buffer_length_in_chain (vm, p2));
317           vlib_increment_combined_counter
318             (cm, thread_index, lb_index3, 1,
319              vlib_buffer_length_in_chain (vm, p3));
320
321           vlib_validate_buffer_enqueue_x4 (vm, node, next,
322                                            to_next, n_left_to_next,
323                                            pi0, pi1, pi2, pi3,
324                                            next0, next1, next2, next3);
325         }
326
327       while (n_left_from > 0 && n_left_to_next > 0)
328         {
329           vlib_buffer_t *p0;
330           ip4_header_t *ip0;
331           ip_lookup_next_t next0;
332           const load_balance_t *lb0;
333           ip4_fib_mtrie_t *mtrie0;
334           ip4_fib_mtrie_leaf_t leaf0;
335           ip4_address_t *dst_addr0;
336           u32 pi0, fib_index0, lbi0;
337           flow_hash_config_t flow_hash_config0;
338           const dpo_id_t *dpo0;
339           u32 hash_c0;
340
341           pi0 = from[0];
342           to_next[0] = pi0;
343
344           p0 = vlib_get_buffer (vm, pi0);
345
346           ip0 = vlib_buffer_get_current (p0);
347
348           dst_addr0 = &ip0->dst_address;
349
350           fib_index0 =
351             vec_elt (im->fib_index_by_sw_if_index,
352                      vnet_buffer (p0)->sw_if_index[VLIB_RX]);
353           fib_index0 =
354             (vnet_buffer (p0)->sw_if_index[VLIB_TX] ==
355              (u32) ~ 0) ? fib_index0 : vnet_buffer (p0)->sw_if_index[VLIB_TX];
356
357           if (!lookup_for_responses_to_locally_received_packets)
358             {
359               mtrie0 = &ip4_fib_get (fib_index0)->mtrie;
360
361               leaf0 = ip4_fib_mtrie_lookup_step_one (mtrie0, dst_addr0);
362             }
363
364           if (!lookup_for_responses_to_locally_received_packets)
365             leaf0 = ip4_fib_mtrie_lookup_step (mtrie0, leaf0, dst_addr0, 2);
366
367           if (!lookup_for_responses_to_locally_received_packets)
368             leaf0 = ip4_fib_mtrie_lookup_step (mtrie0, leaf0, dst_addr0, 3);
369
370           if (lookup_for_responses_to_locally_received_packets)
371             lbi0 = vnet_buffer (p0)->ip.adj_index[VLIB_RX];
372           else
373             {
374               /* Handle default route. */
375               lbi0 = ip4_fib_mtrie_leaf_get_adj_index (leaf0);
376             }
377
378           ASSERT (lbi0);
379           lb0 = load_balance_get (lbi0);
380
381           ASSERT (lb0->lb_n_buckets > 0);
382           ASSERT (is_pow2 (lb0->lb_n_buckets));
383
384           /* Use flow hash to compute multipath adjacency. */
385           hash_c0 = vnet_buffer (p0)->ip.flow_hash = 0;
386           if (PREDICT_FALSE (lb0->lb_n_buckets > 1))
387             {
388               flow_hash_config0 = lb0->lb_hash_config;
389
390               hash_c0 = vnet_buffer (p0)->ip.flow_hash =
391                 ip4_compute_flow_hash (ip0, flow_hash_config0);
392               dpo0 =
393                 load_balance_get_fwd_bucket (lb0,
394                                              (hash_c0 &
395                                               (lb0->lb_n_buckets_minus_1)));
396             }
397           else
398             {
399               dpo0 = load_balance_get_bucket_i (lb0, 0);
400             }
401
402           next0 = dpo0->dpoi_next_node;
403           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = dpo0->dpoi_index;
404
405           vlib_increment_combined_counter (cm, thread_index, lbi0, 1,
406                                            vlib_buffer_length_in_chain (vm,
407                                                                         p0));
408
409           from += 1;
410           to_next += 1;
411           n_left_to_next -= 1;
412           n_left_from -= 1;
413
414           if (PREDICT_FALSE (next0 != next))
415             {
416               n_left_to_next += 1;
417               vlib_put_next_frame (vm, node, next, n_left_to_next);
418               next = next0;
419               vlib_get_next_frame (vm, node, next, to_next, n_left_to_next);
420               to_next[0] = pi0;
421               to_next += 1;
422               n_left_to_next -= 1;
423             }
424         }
425
426       vlib_put_next_frame (vm, node, next, n_left_to_next);
427     }
428
429   if (node->flags & VLIB_NODE_FLAG_TRACE)
430     ip4_forward_next_trace (vm, node, frame, VLIB_TX);
431
432   return frame->n_vectors;
433 }
434
435 /** @brief IPv4 lookup node.
436     @node ip4-lookup
437
438     This is the main IPv4 lookup dispatch node.
439
440     @param vm vlib_main_t corresponding to the current thread
441     @param node vlib_node_runtime_t
442     @param frame vlib_frame_t whose contents should be dispatched
443
444     @par Graph mechanics: buffer metadata, next index usage
445
446     @em Uses:
447     - <code>vnet_buffer(b)->sw_if_index[VLIB_RX]</code>
448         - Indicates the @c sw_if_index value of the interface that the
449           packet was received on.
450     - <code>vnet_buffer(b)->sw_if_index[VLIB_TX]</code>
451         - When the value is @c ~0 then the node performs a longest prefix
452           match (LPM) for the packet destination address in the FIB attached
453           to the receive interface.
454         - Otherwise perform LPM for the packet destination address in the
455           indicated FIB. In this case <code>[VLIB_TX]</code> is a FIB index
456           value (0, 1, ...) and not a VRF id.
457
458     @em Sets:
459     - <code>vnet_buffer(b)->ip.adj_index[VLIB_TX]</code>
460         - The lookup result adjacency index.
461
462     <em>Next Index:</em>
463     - Dispatches the packet to the node index found in
464       ip_adjacency_t @c adj->lookup_next_index
465       (where @c adj is the lookup result adjacency).
466 */
467 static uword
468 ip4_lookup (vlib_main_t * vm,
469             vlib_node_runtime_t * node, vlib_frame_t * frame)
470 {
471   return ip4_lookup_inline (vm, node, frame,
472                             /* lookup_for_responses_to_locally_received_packets */
473                             0);
474
475 }
476
477 static u8 *format_ip4_lookup_trace (u8 * s, va_list * args);
478
479 VLIB_REGISTER_NODE (ip4_lookup_node) =
480 {
481 .function = ip4_lookup,.name = "ip4-lookup",.vector_size =
482     sizeof (u32),.format_trace = format_ip4_lookup_trace,.n_next_nodes =
483     IP_LOOKUP_N_NEXT,.next_nodes = IP4_LOOKUP_NEXT_NODES,};
484
485 VLIB_NODE_FUNCTION_MULTIARCH (ip4_lookup_node, ip4_lookup);
486
487 always_inline uword
488 ip4_load_balance (vlib_main_t * vm,
489                   vlib_node_runtime_t * node, vlib_frame_t * frame)
490 {
491   vlib_combined_counter_main_t *cm = &load_balance_main.lbm_via_counters;
492   u32 n_left_from, n_left_to_next, *from, *to_next;
493   ip_lookup_next_t next;
494   u32 thread_index = vlib_get_thread_index ();
495
496   from = vlib_frame_vector_args (frame);
497   n_left_from = frame->n_vectors;
498   next = node->cached_next_index;
499
500   if (node->flags & VLIB_NODE_FLAG_TRACE)
501     ip4_forward_next_trace (vm, node, frame, VLIB_TX);
502
503   while (n_left_from > 0)
504     {
505       vlib_get_next_frame (vm, node, next, to_next, n_left_to_next);
506
507
508       while (n_left_from >= 4 && n_left_to_next >= 2)
509         {
510           ip_lookup_next_t next0, next1;
511           const load_balance_t *lb0, *lb1;
512           vlib_buffer_t *p0, *p1;
513           u32 pi0, lbi0, hc0, pi1, lbi1, hc1;
514           const ip4_header_t *ip0, *ip1;
515           const dpo_id_t *dpo0, *dpo1;
516
517           /* Prefetch next iteration. */
518           {
519             vlib_buffer_t *p2, *p3;
520
521             p2 = vlib_get_buffer (vm, from[2]);
522             p3 = vlib_get_buffer (vm, from[3]);
523
524             vlib_prefetch_buffer_header (p2, STORE);
525             vlib_prefetch_buffer_header (p3, STORE);
526
527             CLIB_PREFETCH (p2->data, sizeof (ip0[0]), STORE);
528             CLIB_PREFETCH (p3->data, sizeof (ip0[0]), STORE);
529           }
530
531           pi0 = to_next[0] = from[0];
532           pi1 = to_next[1] = from[1];
533
534           from += 2;
535           n_left_from -= 2;
536           to_next += 2;
537           n_left_to_next -= 2;
538
539           p0 = vlib_get_buffer (vm, pi0);
540           p1 = vlib_get_buffer (vm, pi1);
541
542           ip0 = vlib_buffer_get_current (p0);
543           ip1 = vlib_buffer_get_current (p1);
544           lbi0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
545           lbi1 = vnet_buffer (p1)->ip.adj_index[VLIB_TX];
546
547           lb0 = load_balance_get (lbi0);
548           lb1 = load_balance_get (lbi1);
549
550           /*
551            * this node is for via FIBs we can re-use the hash value from the
552            * to node if present.
553            * We don't want to use the same hash value at each level in the recursion
554            * graph as that would lead to polarisation
555            */
556           hc0 = hc1 = 0;
557
558           if (PREDICT_FALSE (lb0->lb_n_buckets > 1))
559             {
560               if (PREDICT_TRUE (vnet_buffer (p0)->ip.flow_hash))
561                 {
562                   hc0 = vnet_buffer (p0)->ip.flow_hash =
563                     vnet_buffer (p0)->ip.flow_hash >> 1;
564                 }
565               else
566                 {
567                   hc0 = vnet_buffer (p0)->ip.flow_hash =
568                     ip4_compute_flow_hash (ip0, lb0->lb_hash_config);
569                 }
570               dpo0 = load_balance_get_fwd_bucket
571                 (lb0, (hc0 & (lb0->lb_n_buckets_minus_1)));
572             }
573           else
574             {
575               dpo0 = load_balance_get_bucket_i (lb0, 0);
576             }
577           if (PREDICT_FALSE (lb1->lb_n_buckets > 1))
578             {
579               if (PREDICT_TRUE (vnet_buffer (p1)->ip.flow_hash))
580                 {
581                   hc1 = vnet_buffer (p1)->ip.flow_hash =
582                     vnet_buffer (p1)->ip.flow_hash >> 1;
583                 }
584               else
585                 {
586                   hc1 = vnet_buffer (p1)->ip.flow_hash =
587                     ip4_compute_flow_hash (ip1, lb1->lb_hash_config);
588                 }
589               dpo1 = load_balance_get_fwd_bucket
590                 (lb1, (hc1 & (lb1->lb_n_buckets_minus_1)));
591             }
592           else
593             {
594               dpo1 = load_balance_get_bucket_i (lb1, 0);
595             }
596
597           next0 = dpo0->dpoi_next_node;
598           next1 = dpo1->dpoi_next_node;
599
600           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = dpo0->dpoi_index;
601           vnet_buffer (p1)->ip.adj_index[VLIB_TX] = dpo1->dpoi_index;
602
603           vlib_increment_combined_counter
604             (cm, thread_index, lbi0, 1, vlib_buffer_length_in_chain (vm, p0));
605           vlib_increment_combined_counter
606             (cm, thread_index, lbi1, 1, vlib_buffer_length_in_chain (vm, p1));
607
608           vlib_validate_buffer_enqueue_x2 (vm, node, next,
609                                            to_next, n_left_to_next,
610                                            pi0, pi1, next0, next1);
611         }
612
613       while (n_left_from > 0 && n_left_to_next > 0)
614         {
615           ip_lookup_next_t next0;
616           const load_balance_t *lb0;
617           vlib_buffer_t *p0;
618           u32 pi0, lbi0, hc0;
619           const ip4_header_t *ip0;
620           const dpo_id_t *dpo0;
621
622           pi0 = from[0];
623           to_next[0] = pi0;
624           from += 1;
625           to_next += 1;
626           n_left_to_next -= 1;
627           n_left_from -= 1;
628
629           p0 = vlib_get_buffer (vm, pi0);
630
631           ip0 = vlib_buffer_get_current (p0);
632           lbi0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
633
634           lb0 = load_balance_get (lbi0);
635
636           hc0 = 0;
637           if (PREDICT_FALSE (lb0->lb_n_buckets > 1))
638             {
639               if (PREDICT_TRUE (vnet_buffer (p0)->ip.flow_hash))
640                 {
641                   hc0 = vnet_buffer (p0)->ip.flow_hash =
642                     vnet_buffer (p0)->ip.flow_hash >> 1;
643                 }
644               else
645                 {
646                   hc0 = vnet_buffer (p0)->ip.flow_hash =
647                     ip4_compute_flow_hash (ip0, lb0->lb_hash_config);
648                 }
649               dpo0 = load_balance_get_fwd_bucket
650                 (lb0, (hc0 & (lb0->lb_n_buckets_minus_1)));
651             }
652           else
653             {
654               dpo0 = load_balance_get_bucket_i (lb0, 0);
655             }
656
657           next0 = dpo0->dpoi_next_node;
658           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = dpo0->dpoi_index;
659
660           vlib_increment_combined_counter
661             (cm, thread_index, lbi0, 1, vlib_buffer_length_in_chain (vm, p0));
662
663           vlib_validate_buffer_enqueue_x1 (vm, node, next,
664                                            to_next, n_left_to_next,
665                                            pi0, next0);
666         }
667
668       vlib_put_next_frame (vm, node, next, n_left_to_next);
669     }
670
671   return frame->n_vectors;
672 }
673
674 VLIB_REGISTER_NODE (ip4_load_balance_node) =
675 {
676 .function = ip4_load_balance,.name = "ip4-load-balance",.vector_size =
677     sizeof (u32),.sibling_of = "ip4-lookup",.format_trace =
678     format_ip4_lookup_trace,};
679
680 VLIB_NODE_FUNCTION_MULTIARCH (ip4_load_balance_node, ip4_load_balance);
681
682 /* get first interface address */
683 ip4_address_t *
684 ip4_interface_first_address (ip4_main_t * im, u32 sw_if_index,
685                              ip_interface_address_t ** result_ia)
686 {
687   ip_lookup_main_t *lm = &im->lookup_main;
688   ip_interface_address_t *ia = 0;
689   ip4_address_t *result = 0;
690
691   /* *INDENT-OFF* */
692   foreach_ip_interface_address
693     (lm, ia, sw_if_index,
694      1 /* honor unnumbered */ ,
695      ({
696        ip4_address_t * a =
697          ip_interface_address_get_address (lm, ia);
698        result = a;
699        break;
700      }));
701   /* *INDENT-OFF* */
702   if (result_ia)
703     *result_ia = result ? ia : 0;
704   return result;
705 }
706
707 static void
708 ip4_add_interface_routes (u32 sw_if_index,
709                           ip4_main_t * im, u32 fib_index,
710                           ip_interface_address_t * a)
711 {
712   ip_lookup_main_t *lm = &im->lookup_main;
713   ip4_address_t *address = ip_interface_address_get_address (lm, a);
714   fib_prefix_t pfx = {
715     .fp_len = a->address_length,
716     .fp_proto = FIB_PROTOCOL_IP4,
717     .fp_addr.ip4 = *address,
718   };
719
720   if (pfx.fp_len <= 30)
721     {
722       /* a /30 or shorter - add a glean for the network address */
723       fib_table_entry_update_one_path (fib_index, &pfx,
724                                        FIB_SOURCE_INTERFACE,
725                                        (FIB_ENTRY_FLAG_CONNECTED |
726                                         FIB_ENTRY_FLAG_ATTACHED),
727                                        FIB_PROTOCOL_IP4,
728                                        /* No next-hop address */
729                                        NULL,
730                                        sw_if_index,
731                                        // invalid FIB index
732                                        ~0,
733                                        1,
734                                        // no out-label stack
735                                        NULL,
736                                        FIB_ROUTE_PATH_FLAG_NONE);
737
738       /* Add the two broadcast addresses as drop */
739       fib_prefix_t net_pfx = {
740         .fp_len = 32,
741         .fp_proto = FIB_PROTOCOL_IP4,
742         .fp_addr.ip4.as_u32 = address->as_u32 & im->fib_masks[pfx.fp_len],
743       };
744       if (net_pfx.fp_addr.ip4.as_u32 != pfx.fp_addr.ip4.as_u32)
745         fib_table_entry_special_add(fib_index,
746                                     &net_pfx,
747                                     FIB_SOURCE_INTERFACE,
748                                     (FIB_ENTRY_FLAG_DROP |
749                                      FIB_ENTRY_FLAG_LOOSE_URPF_EXEMPT));
750       net_pfx.fp_addr.ip4.as_u32 |= ~im->fib_masks[pfx.fp_len];
751       if (net_pfx.fp_addr.ip4.as_u32 != pfx.fp_addr.ip4.as_u32)
752         fib_table_entry_special_add(fib_index,
753                                     &net_pfx,
754                                     FIB_SOURCE_INTERFACE,
755                                     (FIB_ENTRY_FLAG_DROP |
756                                      FIB_ENTRY_FLAG_LOOSE_URPF_EXEMPT));
757     }
758   else if (pfx.fp_len == 31)
759     {
760       u32 mask = clib_host_to_net_u32(1);
761       fib_prefix_t net_pfx = pfx;
762
763       net_pfx.fp_len = 32;
764       net_pfx.fp_addr.ip4.as_u32 ^= mask;
765
766       /* a /31 - add the other end as an attached host */
767       fib_table_entry_update_one_path (fib_index, &net_pfx,
768                                        FIB_SOURCE_INTERFACE,
769                                        (FIB_ENTRY_FLAG_ATTACHED),
770                                        FIB_PROTOCOL_IP4,
771                                        &net_pfx.fp_addr,
772                                        sw_if_index,
773                                        // invalid FIB index
774                                        ~0,
775                                        1,
776                                        NULL,
777                                        FIB_ROUTE_PATH_FLAG_NONE);
778     }
779   pfx.fp_len = 32;
780
781   if (sw_if_index < vec_len (lm->classify_table_index_by_sw_if_index))
782     {
783       u32 classify_table_index =
784         lm->classify_table_index_by_sw_if_index[sw_if_index];
785       if (classify_table_index != (u32) ~ 0)
786         {
787           dpo_id_t dpo = DPO_INVALID;
788
789           dpo_set (&dpo,
790                    DPO_CLASSIFY,
791                    DPO_PROTO_IP4,
792                    classify_dpo_create (DPO_PROTO_IP4, classify_table_index));
793
794           fib_table_entry_special_dpo_add (fib_index,
795                                            &pfx,
796                                            FIB_SOURCE_CLASSIFY,
797                                            FIB_ENTRY_FLAG_NONE, &dpo);
798           dpo_reset (&dpo);
799         }
800     }
801
802   fib_table_entry_update_one_path (fib_index, &pfx,
803                                    FIB_SOURCE_INTERFACE,
804                                    (FIB_ENTRY_FLAG_CONNECTED |
805                                     FIB_ENTRY_FLAG_LOCAL),
806                                    FIB_PROTOCOL_IP4,
807                                    &pfx.fp_addr,
808                                    sw_if_index,
809                                    // invalid FIB index
810                                    ~0,
811                                    1, NULL,
812                                    FIB_ROUTE_PATH_FLAG_NONE);
813 }
814
815 static void
816 ip4_del_interface_routes (ip4_main_t * im,
817                           u32 fib_index,
818                           ip4_address_t * address, u32 address_length)
819 {
820   fib_prefix_t pfx = {
821     .fp_len = address_length,
822     .fp_proto = FIB_PROTOCOL_IP4,
823     .fp_addr.ip4 = *address,
824   };
825
826   if (pfx.fp_len <= 30)
827     {
828       fib_prefix_t net_pfx = {
829         .fp_len = 32,
830         .fp_proto = FIB_PROTOCOL_IP4,
831         .fp_addr.ip4.as_u32 = address->as_u32 & im->fib_masks[pfx.fp_len],
832       };
833       if (net_pfx.fp_addr.ip4.as_u32 != pfx.fp_addr.ip4.as_u32)
834         fib_table_entry_special_remove(fib_index,
835                                        &net_pfx,
836                                        FIB_SOURCE_INTERFACE);
837       net_pfx.fp_addr.ip4.as_u32 |= ~im->fib_masks[pfx.fp_len];
838       if (net_pfx.fp_addr.ip4.as_u32 != pfx.fp_addr.ip4.as_u32)
839         fib_table_entry_special_remove(fib_index,
840                                        &net_pfx,
841                                        FIB_SOURCE_INTERFACE);
842       fib_table_entry_delete (fib_index, &pfx, FIB_SOURCE_INTERFACE);
843     }
844     else if (pfx.fp_len == 31)
845     {
846       u32 mask = clib_host_to_net_u32(1);
847       fib_prefix_t net_pfx = pfx;
848
849       net_pfx.fp_len = 32;
850       net_pfx.fp_addr.ip4.as_u32 ^= mask;
851
852       fib_table_entry_delete (fib_index, &net_pfx, FIB_SOURCE_INTERFACE);
853     }
854
855   pfx.fp_len = 32;
856   fib_table_entry_delete (fib_index, &pfx, FIB_SOURCE_INTERFACE);
857 }
858
859 void
860 ip4_sw_interface_enable_disable (u32 sw_if_index, u32 is_enable)
861 {
862   ip4_main_t *im = &ip4_main;
863
864   vec_validate_init_empty (im->ip_enabled_by_sw_if_index, sw_if_index, 0);
865
866   /*
867    * enable/disable only on the 1<->0 transition
868    */
869   if (is_enable)
870     {
871       if (1 != ++im->ip_enabled_by_sw_if_index[sw_if_index])
872         return;
873     }
874   else
875     {
876       ASSERT (im->ip_enabled_by_sw_if_index[sw_if_index] > 0);
877       if (0 != --im->ip_enabled_by_sw_if_index[sw_if_index])
878         return;
879     }
880   vnet_feature_enable_disable ("ip4-unicast", "ip4-drop", sw_if_index,
881                                !is_enable, 0, 0);
882
883
884   vnet_feature_enable_disable ("ip4-multicast", "ip4-drop",
885                                sw_if_index, !is_enable, 0, 0);
886 }
887
888 static clib_error_t *
889 ip4_add_del_interface_address_internal (vlib_main_t * vm,
890                                         u32 sw_if_index,
891                                         ip4_address_t * address,
892                                         u32 address_length, u32 is_del)
893 {
894   vnet_main_t *vnm = vnet_get_main ();
895   ip4_main_t *im = &ip4_main;
896   ip_lookup_main_t *lm = &im->lookup_main;
897   clib_error_t *error = 0;
898   u32 if_address_index, elts_before;
899   ip4_address_fib_t ip4_af, *addr_fib = 0;
900
901   vec_validate (im->fib_index_by_sw_if_index, sw_if_index);
902   ip4_addr_fib_init (&ip4_af, address,
903                      vec_elt (im->fib_index_by_sw_if_index, sw_if_index));
904   vec_add1 (addr_fib, ip4_af);
905
906   /* FIXME-LATER
907    * there is no support for adj-fib handling in the presence of overlapping
908    * subnets on interfaces. Easy fix - disallow overlapping subnets, like
909    * most routers do.
910    */
911   /* *INDENT-OFF* */
912   if (!is_del)
913     {
914       /* When adding an address check that it does not conflict
915          with an existing address. */
916       ip_interface_address_t *ia;
917       foreach_ip_interface_address
918         (&im->lookup_main, ia, sw_if_index,
919          0 /* honor unnumbered */ ,
920          ({
921            ip4_address_t * x =
922              ip_interface_address_get_address
923              (&im->lookup_main, ia);
924            if (ip4_destination_matches_route
925                (im, address, x, ia->address_length) ||
926                ip4_destination_matches_route (im,
927                                               x,
928                                               address,
929                                               address_length))
930              return
931                clib_error_create
932                ("failed to add %U which conflicts with %U for interface %U",
933                 format_ip4_address_and_length, address,
934                 address_length,
935                 format_ip4_address_and_length, x,
936                 ia->address_length,
937                 format_vnet_sw_if_index_name, vnm,
938                 sw_if_index);
939          }));
940     }
941   /* *INDENT-ON* */
942
943   elts_before = pool_elts (lm->if_address_pool);
944
945   error = ip_interface_address_add_del
946     (lm, sw_if_index, addr_fib, address_length, is_del, &if_address_index);
947   if (error)
948     goto done;
949
950   ip4_sw_interface_enable_disable (sw_if_index, !is_del);
951
952   if (is_del)
953     ip4_del_interface_routes (im, ip4_af.fib_index, address, address_length);
954   else
955     ip4_add_interface_routes (sw_if_index,
956                               im, ip4_af.fib_index,
957                               pool_elt_at_index
958                               (lm->if_address_pool, if_address_index));
959
960   /* If pool did not grow/shrink: add duplicate address. */
961   if (elts_before != pool_elts (lm->if_address_pool))
962     {
963       ip4_add_del_interface_address_callback_t *cb;
964       vec_foreach (cb, im->add_del_interface_address_callbacks)
965         cb->function (im, cb->function_opaque, sw_if_index,
966                       address, address_length, if_address_index, is_del);
967     }
968
969 done:
970   vec_free (addr_fib);
971   return error;
972 }
973
974 clib_error_t *
975 ip4_add_del_interface_address (vlib_main_t * vm,
976                                u32 sw_if_index,
977                                ip4_address_t * address,
978                                u32 address_length, u32 is_del)
979 {
980   return ip4_add_del_interface_address_internal
981     (vm, sw_if_index, address, address_length, is_del);
982 }
983
984 /* Built-in ip4 unicast rx feature path definition */
985 /* *INDENT-OFF* */
986 VNET_FEATURE_ARC_INIT (ip4_unicast, static) =
987 {
988   .arc_name = "ip4-unicast",
989   .start_nodes = VNET_FEATURES ("ip4-input", "ip4-input-no-checksum"),
990   .arc_index_ptr = &ip4_main.lookup_main.ucast_feature_arc_index,
991 };
992
993 VNET_FEATURE_INIT (ip4_flow_classify, static) =
994 {
995   .arc_name = "ip4-unicast",
996   .node_name = "ip4-flow-classify",
997   .runs_before = VNET_FEATURES ("ip4-inacl"),
998 };
999
1000 VNET_FEATURE_INIT (ip4_inacl, static) =
1001 {
1002   .arc_name = "ip4-unicast",
1003   .node_name = "ip4-inacl",
1004   .runs_before = VNET_FEATURES ("ip4-source-check-via-rx"),
1005 };
1006
1007 VNET_FEATURE_INIT (ip4_source_check_1, static) =
1008 {
1009   .arc_name = "ip4-unicast",
1010   .node_name = "ip4-source-check-via-rx",
1011   .runs_before = VNET_FEATURES ("ip4-source-check-via-any"),
1012 };
1013
1014 VNET_FEATURE_INIT (ip4_source_check_2, static) =
1015 {
1016   .arc_name = "ip4-unicast",
1017   .node_name = "ip4-source-check-via-any",
1018   .runs_before = VNET_FEATURES ("ip4-policer-classify"),
1019 };
1020
1021 VNET_FEATURE_INIT (ip4_source_and_port_range_check_rx, static) =
1022 {
1023   .arc_name = "ip4-unicast",
1024   .node_name = "ip4-source-and-port-range-check-rx",
1025   .runs_before = VNET_FEATURES ("ip4-policer-classify"),
1026 };
1027
1028 VNET_FEATURE_INIT (ip4_policer_classify, static) =
1029 {
1030   .arc_name = "ip4-unicast",
1031   .node_name = "ip4-policer-classify",
1032   .runs_before = VNET_FEATURES ("ipsec-input-ip4"),
1033 };
1034
1035 VNET_FEATURE_INIT (ip4_ipsec, static) =
1036 {
1037   .arc_name = "ip4-unicast",
1038   .node_name = "ipsec-input-ip4",
1039   .runs_before = VNET_FEATURES ("vpath-input-ip4"),
1040 };
1041
1042 VNET_FEATURE_INIT (ip4_vpath, static) =
1043 {
1044   .arc_name = "ip4-unicast",
1045   .node_name = "vpath-input-ip4",
1046   .runs_before = VNET_FEATURES ("ip4-vxlan-bypass"),
1047 };
1048
1049 VNET_FEATURE_INIT (ip4_vxlan_bypass, static) =
1050 {
1051   .arc_name = "ip4-unicast",
1052   .node_name = "ip4-vxlan-bypass",
1053   .runs_before = VNET_FEATURES ("ip4-lookup"),
1054 };
1055
1056 VNET_FEATURE_INIT (ip4_drop, static) =
1057 {
1058   .arc_name = "ip4-unicast",
1059   .node_name = "ip4-drop",
1060   .runs_before = VNET_FEATURES ("ip4-lookup"),
1061 };
1062
1063 VNET_FEATURE_INIT (ip4_lookup, static) =
1064 {
1065   .arc_name = "ip4-unicast",
1066   .node_name = "ip4-lookup",
1067   .runs_before = 0,     /* not before any other features */
1068 };
1069
1070 /* Built-in ip4 multicast rx feature path definition */
1071 VNET_FEATURE_ARC_INIT (ip4_multicast, static) =
1072 {
1073   .arc_name = "ip4-multicast",
1074   .start_nodes = VNET_FEATURES ("ip4-input", "ip4-input-no-checksum"),
1075   .arc_index_ptr = &ip4_main.lookup_main.mcast_feature_arc_index,
1076 };
1077
1078 VNET_FEATURE_INIT (ip4_vpath_mc, static) =
1079 {
1080   .arc_name = "ip4-multicast",
1081   .node_name = "vpath-input-ip4",
1082   .runs_before = VNET_FEATURES ("ip4-mfib-forward-lookup"),
1083 };
1084
1085 VNET_FEATURE_INIT (ip4_mc_drop, static) =
1086 {
1087   .arc_name = "ip4-multicast",
1088   .node_name = "ip4-drop",
1089   .runs_before = VNET_FEATURES ("ip4-mfib-forward-lookup"),
1090 };
1091
1092 VNET_FEATURE_INIT (ip4_lookup_mc, static) =
1093 {
1094   .arc_name = "ip4-multicast",
1095   .node_name = "ip4-mfib-forward-lookup",
1096   .runs_before = 0,     /* last feature */
1097 };
1098
1099 /* Source and port-range check ip4 tx feature path definition */
1100 VNET_FEATURE_ARC_INIT (ip4_output, static) =
1101 {
1102   .arc_name = "ip4-output",
1103   .start_nodes = VNET_FEATURES ("ip4-rewrite", "ip4-midchain"),
1104   .arc_index_ptr = &ip4_main.lookup_main.output_feature_arc_index,
1105 };
1106
1107 VNET_FEATURE_INIT (ip4_source_and_port_range_check_tx, static) =
1108 {
1109   .arc_name = "ip4-output",
1110   .node_name = "ip4-source-and-port-range-check-tx",
1111   .runs_before = VNET_FEATURES ("ipsec-output-ip4"),
1112 };
1113
1114 VNET_FEATURE_INIT (ip4_ipsec_output, static) =
1115 {
1116   .arc_name = "ip4-output",
1117   .node_name = "ipsec-output-ip4",
1118   .runs_before = VNET_FEATURES ("interface-output"),
1119 };
1120
1121 /* Built-in ip4 tx feature path definition */
1122 VNET_FEATURE_INIT (ip4_interface_output, static) =
1123 {
1124   .arc_name = "ip4-output",
1125   .node_name = "interface-output",
1126   .runs_before = 0,     /* not before any other features */
1127 };
1128 /* *INDENT-ON* */
1129
1130 static clib_error_t *
1131 ip4_sw_interface_add_del (vnet_main_t * vnm, u32 sw_if_index, u32 is_add)
1132 {
1133   ip4_main_t *im = &ip4_main;
1134
1135   /* Fill in lookup tables with default table (0). */
1136   vec_validate (im->fib_index_by_sw_if_index, sw_if_index);
1137   vec_validate (im->mfib_index_by_sw_if_index, sw_if_index);
1138
1139   vnet_feature_enable_disable ("ip4-unicast", "ip4-drop", sw_if_index,
1140                                is_add, 0, 0);
1141
1142   vnet_feature_enable_disable ("ip4-multicast", "ip4-drop", sw_if_index,
1143                                is_add, 0, 0);
1144
1145   return /* no error */ 0;
1146 }
1147
1148 VNET_SW_INTERFACE_ADD_DEL_FUNCTION (ip4_sw_interface_add_del);
1149
1150 /* Global IP4 main. */
1151 ip4_main_t ip4_main;
1152
1153 clib_error_t *
1154 ip4_lookup_init (vlib_main_t * vm)
1155 {
1156   ip4_main_t *im = &ip4_main;
1157   clib_error_t *error;
1158   uword i;
1159
1160   if ((error = vlib_call_init_function (vm, vnet_feature_init)))
1161     return error;
1162
1163   for (i = 0; i < ARRAY_LEN (im->fib_masks); i++)
1164     {
1165       u32 m;
1166
1167       if (i < 32)
1168         m = pow2_mask (i) << (32 - i);
1169       else
1170         m = ~0;
1171       im->fib_masks[i] = clib_host_to_net_u32 (m);
1172     }
1173
1174   ip_lookup_init (&im->lookup_main, /* is_ip6 */ 0);
1175
1176   /* Create FIB with index 0 and table id of 0. */
1177   fib_table_find_or_create_and_lock (FIB_PROTOCOL_IP4, 0);
1178   mfib_table_find_or_create_and_lock (FIB_PROTOCOL_IP4, 0);
1179
1180   {
1181     pg_node_t *pn;
1182     pn = pg_get_node (ip4_lookup_node.index);
1183     pn->unformat_edit = unformat_pg_ip4_header;
1184   }
1185
1186   {
1187     ethernet_arp_header_t h;
1188
1189     memset (&h, 0, sizeof (h));
1190
1191     /* Set target ethernet address to all zeros. */
1192     memset (h.ip4_over_ethernet[1].ethernet, 0,
1193             sizeof (h.ip4_over_ethernet[1].ethernet));
1194
1195 #define _16(f,v) h.f = clib_host_to_net_u16 (v);
1196 #define _8(f,v) h.f = v;
1197     _16 (l2_type, ETHERNET_ARP_HARDWARE_TYPE_ethernet);
1198     _16 (l3_type, ETHERNET_TYPE_IP4);
1199     _8 (n_l2_address_bytes, 6);
1200     _8 (n_l3_address_bytes, 4);
1201     _16 (opcode, ETHERNET_ARP_OPCODE_request);
1202 #undef _16
1203 #undef _8
1204
1205     vlib_packet_template_init (vm, &im->ip4_arp_request_packet_template,
1206                                /* data */ &h,
1207                                sizeof (h),
1208                                /* alloc chunk size */ 8,
1209                                "ip4 arp");
1210   }
1211
1212   return error;
1213 }
1214
1215 VLIB_INIT_FUNCTION (ip4_lookup_init);
1216
1217 typedef struct
1218 {
1219   /* Adjacency taken. */
1220   u32 dpo_index;
1221   u32 flow_hash;
1222   u32 fib_index;
1223
1224   /* Packet data, possibly *after* rewrite. */
1225   u8 packet_data[64 - 1 * sizeof (u32)];
1226 }
1227 ip4_forward_next_trace_t;
1228
1229 u8 *
1230 format_ip4_forward_next_trace (u8 * s, va_list * args)
1231 {
1232   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
1233   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
1234   ip4_forward_next_trace_t *t = va_arg (*args, ip4_forward_next_trace_t *);
1235   uword indent = format_get_indent (s);
1236   s = format (s, "%U%U",
1237               format_white_space, indent,
1238               format_ip4_header, t->packet_data, sizeof (t->packet_data));
1239   return s;
1240 }
1241
1242 static u8 *
1243 format_ip4_lookup_trace (u8 * s, va_list * args)
1244 {
1245   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
1246   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
1247   ip4_forward_next_trace_t *t = va_arg (*args, ip4_forward_next_trace_t *);
1248   uword indent = format_get_indent (s);
1249
1250   s = format (s, "fib %d dpo-idx %d flow hash: 0x%08x",
1251               t->fib_index, t->dpo_index, t->flow_hash);
1252   s = format (s, "\n%U%U",
1253               format_white_space, indent,
1254               format_ip4_header, t->packet_data, sizeof (t->packet_data));
1255   return s;
1256 }
1257
1258 static u8 *
1259 format_ip4_rewrite_trace (u8 * s, va_list * args)
1260 {
1261   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
1262   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
1263   ip4_forward_next_trace_t *t = va_arg (*args, ip4_forward_next_trace_t *);
1264   uword indent = format_get_indent (s);
1265
1266   s = format (s, "tx_sw_if_index %d dpo-idx %d : %U flow hash: 0x%08x",
1267               t->fib_index, t->dpo_index, format_ip_adjacency,
1268               t->dpo_index, FORMAT_IP_ADJACENCY_NONE, t->flow_hash);
1269   s = format (s, "\n%U%U",
1270               format_white_space, indent,
1271               format_ip_adjacency_packet_data,
1272               t->dpo_index, t->packet_data, sizeof (t->packet_data));
1273   return s;
1274 }
1275
1276 /* Common trace function for all ip4-forward next nodes. */
1277 void
1278 ip4_forward_next_trace (vlib_main_t * vm,
1279                         vlib_node_runtime_t * node,
1280                         vlib_frame_t * frame, vlib_rx_or_tx_t which_adj_index)
1281 {
1282   u32 *from, n_left;
1283   ip4_main_t *im = &ip4_main;
1284
1285   n_left = frame->n_vectors;
1286   from = vlib_frame_vector_args (frame);
1287
1288   while (n_left >= 4)
1289     {
1290       u32 bi0, bi1;
1291       vlib_buffer_t *b0, *b1;
1292       ip4_forward_next_trace_t *t0, *t1;
1293
1294       /* Prefetch next iteration. */
1295       vlib_prefetch_buffer_with_index (vm, from[2], LOAD);
1296       vlib_prefetch_buffer_with_index (vm, from[3], LOAD);
1297
1298       bi0 = from[0];
1299       bi1 = from[1];
1300
1301       b0 = vlib_get_buffer (vm, bi0);
1302       b1 = vlib_get_buffer (vm, bi1);
1303
1304       if (b0->flags & VLIB_BUFFER_IS_TRACED)
1305         {
1306           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
1307           t0->dpo_index = vnet_buffer (b0)->ip.adj_index[which_adj_index];
1308           t0->flow_hash = vnet_buffer (b0)->ip.flow_hash;
1309           t0->fib_index =
1310             (vnet_buffer (b0)->sw_if_index[VLIB_TX] !=
1311              (u32) ~ 0) ? vnet_buffer (b0)->sw_if_index[VLIB_TX] :
1312             vec_elt (im->fib_index_by_sw_if_index,
1313                      vnet_buffer (b0)->sw_if_index[VLIB_RX]);
1314
1315           clib_memcpy (t0->packet_data,
1316                        vlib_buffer_get_current (b0),
1317                        sizeof (t0->packet_data));
1318         }
1319       if (b1->flags & VLIB_BUFFER_IS_TRACED)
1320         {
1321           t1 = vlib_add_trace (vm, node, b1, sizeof (t1[0]));
1322           t1->dpo_index = vnet_buffer (b1)->ip.adj_index[which_adj_index];
1323           t1->flow_hash = vnet_buffer (b1)->ip.flow_hash;
1324           t1->fib_index =
1325             (vnet_buffer (b1)->sw_if_index[VLIB_TX] !=
1326              (u32) ~ 0) ? vnet_buffer (b1)->sw_if_index[VLIB_TX] :
1327             vec_elt (im->fib_index_by_sw_if_index,
1328                      vnet_buffer (b1)->sw_if_index[VLIB_RX]);
1329           clib_memcpy (t1->packet_data, vlib_buffer_get_current (b1),
1330                        sizeof (t1->packet_data));
1331         }
1332       from += 2;
1333       n_left -= 2;
1334     }
1335
1336   while (n_left >= 1)
1337     {
1338       u32 bi0;
1339       vlib_buffer_t *b0;
1340       ip4_forward_next_trace_t *t0;
1341
1342       bi0 = from[0];
1343
1344       b0 = vlib_get_buffer (vm, bi0);
1345
1346       if (b0->flags & VLIB_BUFFER_IS_TRACED)
1347         {
1348           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
1349           t0->dpo_index = vnet_buffer (b0)->ip.adj_index[which_adj_index];
1350           t0->flow_hash = vnet_buffer (b0)->ip.flow_hash;
1351           t0->fib_index =
1352             (vnet_buffer (b0)->sw_if_index[VLIB_TX] !=
1353              (u32) ~ 0) ? vnet_buffer (b0)->sw_if_index[VLIB_TX] :
1354             vec_elt (im->fib_index_by_sw_if_index,
1355                      vnet_buffer (b0)->sw_if_index[VLIB_RX]);
1356           clib_memcpy (t0->packet_data, vlib_buffer_get_current (b0),
1357                        sizeof (t0->packet_data));
1358         }
1359       from += 1;
1360       n_left -= 1;
1361     }
1362 }
1363
1364 static uword
1365 ip4_drop_or_punt (vlib_main_t * vm,
1366                   vlib_node_runtime_t * node,
1367                   vlib_frame_t * frame, ip4_error_t error_code)
1368 {
1369   u32 *buffers = vlib_frame_vector_args (frame);
1370   uword n_packets = frame->n_vectors;
1371
1372   vlib_error_drop_buffers (vm, node, buffers,
1373                            /* stride */ 1,
1374                            n_packets,
1375                            /* next */ 0,
1376                            ip4_input_node.index, error_code);
1377
1378   if (node->flags & VLIB_NODE_FLAG_TRACE)
1379     ip4_forward_next_trace (vm, node, frame, VLIB_TX);
1380
1381   return n_packets;
1382 }
1383
1384 static uword
1385 ip4_drop (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame)
1386 {
1387   return ip4_drop_or_punt (vm, node, frame, IP4_ERROR_ADJACENCY_DROP);
1388 }
1389
1390 static uword
1391 ip4_punt (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame)
1392 {
1393   return ip4_drop_or_punt (vm, node, frame, IP4_ERROR_ADJACENCY_PUNT);
1394 }
1395
1396 /* *INDENT-OFF* */
1397 VLIB_REGISTER_NODE (ip4_drop_node, static) =
1398 {
1399   .function = ip4_drop,
1400   .name = "ip4-drop",
1401   .vector_size = sizeof (u32),
1402   .format_trace = format_ip4_forward_next_trace,
1403   .n_next_nodes = 1,
1404   .next_nodes = {
1405     [0] = "error-drop",
1406   },
1407 };
1408
1409 VLIB_NODE_FUNCTION_MULTIARCH (ip4_drop_node, ip4_drop);
1410
1411 VLIB_REGISTER_NODE (ip4_punt_node, static) =
1412 {
1413   .function = ip4_punt,
1414   .name = "ip4-punt",
1415   .vector_size = sizeof (u32),
1416   .format_trace = format_ip4_forward_next_trace,
1417   .n_next_nodes = 1,
1418   .next_nodes = {
1419     [0] = "error-punt",
1420   },
1421 };
1422
1423 VLIB_NODE_FUNCTION_MULTIARCH (ip4_punt_node, ip4_punt);
1424 /* *INDENT-ON */
1425
1426 /* Compute TCP/UDP/ICMP4 checksum in software. */
1427 u16
1428 ip4_tcp_udp_compute_checksum (vlib_main_t * vm, vlib_buffer_t * p0,
1429                               ip4_header_t * ip0)
1430 {
1431   ip_csum_t sum0;
1432   u32 ip_header_length, payload_length_host_byte_order;
1433   u32 n_this_buffer, n_bytes_left;
1434   u16 sum16;
1435   void *data_this_buffer;
1436
1437   /* Initialize checksum with ip header. */
1438   ip_header_length = ip4_header_bytes (ip0);
1439   payload_length_host_byte_order =
1440     clib_net_to_host_u16 (ip0->length) - ip_header_length;
1441   sum0 =
1442     clib_host_to_net_u32 (payload_length_host_byte_order +
1443                           (ip0->protocol << 16));
1444
1445   if (BITS (uword) == 32)
1446     {
1447       sum0 =
1448         ip_csum_with_carry (sum0,
1449                             clib_mem_unaligned (&ip0->src_address, u32));
1450       sum0 =
1451         ip_csum_with_carry (sum0,
1452                             clib_mem_unaligned (&ip0->dst_address, u32));
1453     }
1454   else
1455     sum0 =
1456       ip_csum_with_carry (sum0, clib_mem_unaligned (&ip0->src_address, u64));
1457
1458   n_bytes_left = n_this_buffer = payload_length_host_byte_order;
1459   data_this_buffer = (void *) ip0 + ip_header_length;
1460   if (n_this_buffer + ip_header_length > p0->current_length)
1461     n_this_buffer =
1462       p0->current_length >
1463       ip_header_length ? p0->current_length - ip_header_length : 0;
1464   while (1)
1465     {
1466       sum0 = ip_incremental_checksum (sum0, data_this_buffer, n_this_buffer);
1467       n_bytes_left -= n_this_buffer;
1468       if (n_bytes_left == 0)
1469         break;
1470
1471       ASSERT (p0->flags & VLIB_BUFFER_NEXT_PRESENT);
1472       p0 = vlib_get_buffer (vm, p0->next_buffer);
1473       data_this_buffer = vlib_buffer_get_current (p0);
1474       n_this_buffer = p0->current_length;
1475     }
1476
1477   sum16 = ~ip_csum_fold (sum0);
1478
1479   return sum16;
1480 }
1481
1482 u32
1483 ip4_tcp_udp_validate_checksum (vlib_main_t * vm, vlib_buffer_t * p0)
1484 {
1485   ip4_header_t *ip0 = vlib_buffer_get_current (p0);
1486   udp_header_t *udp0;
1487   u16 sum16;
1488
1489   ASSERT (ip0->protocol == IP_PROTOCOL_TCP
1490           || ip0->protocol == IP_PROTOCOL_UDP);
1491
1492   udp0 = (void *) (ip0 + 1);
1493   if (ip0->protocol == IP_PROTOCOL_UDP && udp0->checksum == 0)
1494     {
1495       p0->flags |= (IP_BUFFER_L4_CHECKSUM_COMPUTED
1496                     | IP_BUFFER_L4_CHECKSUM_CORRECT);
1497       return p0->flags;
1498     }
1499
1500   sum16 = ip4_tcp_udp_compute_checksum (vm, p0, ip0);
1501
1502   p0->flags |= (IP_BUFFER_L4_CHECKSUM_COMPUTED
1503                 | ((sum16 == 0) << LOG2_IP_BUFFER_L4_CHECKSUM_CORRECT));
1504
1505   return p0->flags;
1506 }
1507
1508 /* *INDENT-OFF* */
1509 VNET_FEATURE_ARC_INIT (ip4_local) =
1510 {
1511   .arc_name  = "ip4-local",
1512   .start_nodes = VNET_FEATURES ("ip4-local"),
1513 };
1514 /* *INDENT-ON* */
1515
1516 static inline uword
1517 ip4_local_inline (vlib_main_t * vm,
1518                   vlib_node_runtime_t * node,
1519                   vlib_frame_t * frame, int head_of_feature_arc)
1520 {
1521   ip4_main_t *im = &ip4_main;
1522   ip_lookup_main_t *lm = &im->lookup_main;
1523   ip_local_next_t next_index;
1524   u32 *from, *to_next, n_left_from, n_left_to_next;
1525   vlib_node_runtime_t *error_node =
1526     vlib_node_get_runtime (vm, ip4_input_node.index);
1527   u8 arc_index = vnet_feat_arc_ip4_local.feature_arc_index;
1528
1529   from = vlib_frame_vector_args (frame);
1530   n_left_from = frame->n_vectors;
1531   next_index = node->cached_next_index;
1532
1533   if (node->flags & VLIB_NODE_FLAG_TRACE)
1534     ip4_forward_next_trace (vm, node, frame, VLIB_TX);
1535
1536   while (n_left_from > 0)
1537     {
1538       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
1539
1540       while (n_left_from >= 4 && n_left_to_next >= 2)
1541         {
1542           vlib_buffer_t *p0, *p1;
1543           ip4_header_t *ip0, *ip1;
1544           udp_header_t *udp0, *udp1;
1545           ip4_fib_mtrie_t *mtrie0, *mtrie1;
1546           ip4_fib_mtrie_leaf_t leaf0, leaf1;
1547           const dpo_id_t *dpo0, *dpo1;
1548           const load_balance_t *lb0, *lb1;
1549           u32 pi0, ip_len0, udp_len0, flags0, next0, fib_index0, lbi0;
1550           u32 pi1, ip_len1, udp_len1, flags1, next1, fib_index1, lbi1;
1551           i32 len_diff0, len_diff1;
1552           u8 error0, is_udp0, is_tcp_udp0, good_tcp_udp0, proto0;
1553           u8 error1, is_udp1, is_tcp_udp1, good_tcp_udp1, proto1;
1554           u32 sw_if_index0, sw_if_index1;
1555
1556           pi0 = to_next[0] = from[0];
1557           pi1 = to_next[1] = from[1];
1558           from += 2;
1559           n_left_from -= 2;
1560           to_next += 2;
1561           n_left_to_next -= 2;
1562
1563           next0 = next1 = IP_LOCAL_NEXT_DROP;
1564
1565           p0 = vlib_get_buffer (vm, pi0);
1566           p1 = vlib_get_buffer (vm, pi1);
1567
1568           ip0 = vlib_buffer_get_current (p0);
1569           ip1 = vlib_buffer_get_current (p1);
1570
1571           vnet_buffer (p0)->ip.start_of_ip_header = p0->current_data;
1572           vnet_buffer (p1)->ip.start_of_ip_header = p1->current_data;
1573
1574           sw_if_index0 = vnet_buffer (p0)->sw_if_index[VLIB_RX];
1575           sw_if_index1 = vnet_buffer (p1)->sw_if_index[VLIB_RX];
1576
1577           fib_index0 = vec_elt (im->fib_index_by_sw_if_index, sw_if_index0);
1578           fib_index1 = vec_elt (im->fib_index_by_sw_if_index, sw_if_index1);
1579
1580           fib_index0 = vec_elt (im->fib_index_by_sw_if_index, sw_if_index0);
1581           fib_index0 =
1582             (vnet_buffer (p0)->sw_if_index[VLIB_TX] ==
1583              (u32) ~ 0) ? fib_index0 : vnet_buffer (p0)->sw_if_index[VLIB_TX];
1584
1585           fib_index1 = vec_elt (im->fib_index_by_sw_if_index, sw_if_index1);
1586           fib_index1 =
1587             (vnet_buffer (p1)->sw_if_index[VLIB_TX] ==
1588              (u32) ~ 0) ? fib_index1 : vnet_buffer (p1)->sw_if_index[VLIB_TX];
1589
1590           mtrie0 = &ip4_fib_get (fib_index0)->mtrie;
1591           mtrie1 = &ip4_fib_get (fib_index1)->mtrie;
1592
1593           leaf0 = ip4_fib_mtrie_lookup_step_one (mtrie0, &ip0->src_address);
1594           leaf1 = ip4_fib_mtrie_lookup_step_one (mtrie1, &ip1->src_address);
1595
1596           /* Treat IP frag packets as "experimental" protocol for now
1597              until support of IP frag reassembly is implemented */
1598           proto0 = ip4_is_fragment (ip0) ? 0xfe : ip0->protocol;
1599           proto1 = ip4_is_fragment (ip1) ? 0xfe : ip1->protocol;
1600
1601           if (head_of_feature_arc == 0)
1602             {
1603               error0 = error1 = IP4_ERROR_UNKNOWN_PROTOCOL;
1604               goto skip_checks;
1605             }
1606
1607           is_udp0 = proto0 == IP_PROTOCOL_UDP;
1608           is_udp1 = proto1 == IP_PROTOCOL_UDP;
1609           is_tcp_udp0 = is_udp0 || proto0 == IP_PROTOCOL_TCP;
1610           is_tcp_udp1 = is_udp1 || proto1 == IP_PROTOCOL_TCP;
1611
1612           flags0 = p0->flags;
1613           flags1 = p1->flags;
1614
1615           good_tcp_udp0 = (flags0 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0;
1616           good_tcp_udp1 = (flags1 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0;
1617
1618           udp0 = ip4_next_header (ip0);
1619           udp1 = ip4_next_header (ip1);
1620
1621           /* Don't verify UDP checksum for packets with explicit zero checksum. */
1622           good_tcp_udp0 |= is_udp0 && udp0->checksum == 0;
1623           good_tcp_udp1 |= is_udp1 && udp1->checksum == 0;
1624
1625           /* Verify UDP length. */
1626           ip_len0 = clib_net_to_host_u16 (ip0->length);
1627           ip_len1 = clib_net_to_host_u16 (ip1->length);
1628           udp_len0 = clib_net_to_host_u16 (udp0->length);
1629           udp_len1 = clib_net_to_host_u16 (udp1->length);
1630
1631           len_diff0 = ip_len0 - udp_len0;
1632           len_diff1 = ip_len1 - udp_len1;
1633
1634           len_diff0 = is_udp0 ? len_diff0 : 0;
1635           len_diff1 = is_udp1 ? len_diff1 : 0;
1636
1637           if (PREDICT_FALSE (!(is_tcp_udp0 & is_tcp_udp1
1638                                & good_tcp_udp0 & good_tcp_udp1)))
1639             {
1640               if (is_tcp_udp0)
1641                 {
1642                   if (is_tcp_udp0
1643                       && !(flags0 & IP_BUFFER_L4_CHECKSUM_COMPUTED))
1644                     flags0 = ip4_tcp_udp_validate_checksum (vm, p0);
1645                   good_tcp_udp0 =
1646                     (flags0 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0;
1647                   good_tcp_udp0 |= is_udp0 && udp0->checksum == 0;
1648                 }
1649               if (is_tcp_udp1)
1650                 {
1651                   if (is_tcp_udp1
1652                       && !(flags1 & IP_BUFFER_L4_CHECKSUM_COMPUTED))
1653                     flags1 = ip4_tcp_udp_validate_checksum (vm, p1);
1654                   good_tcp_udp1 =
1655                     (flags1 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0;
1656                   good_tcp_udp1 |= is_udp1 && udp1->checksum == 0;
1657                 }
1658             }
1659
1660           good_tcp_udp0 &= len_diff0 >= 0;
1661           good_tcp_udp1 &= len_diff1 >= 0;
1662
1663           leaf0 =
1664             ip4_fib_mtrie_lookup_step (mtrie0, leaf0, &ip0->src_address, 2);
1665           leaf1 =
1666             ip4_fib_mtrie_lookup_step (mtrie1, leaf1, &ip1->src_address, 2);
1667
1668           error0 = error1 = IP4_ERROR_UNKNOWN_PROTOCOL;
1669
1670           error0 = len_diff0 < 0 ? IP4_ERROR_UDP_LENGTH : error0;
1671           error1 = len_diff1 < 0 ? IP4_ERROR_UDP_LENGTH : error1;
1672
1673           ASSERT (IP4_ERROR_TCP_CHECKSUM + 1 == IP4_ERROR_UDP_CHECKSUM);
1674           error0 = (is_tcp_udp0 && !good_tcp_udp0
1675                     ? IP4_ERROR_TCP_CHECKSUM + is_udp0 : error0);
1676           error1 = (is_tcp_udp1 && !good_tcp_udp1
1677                     ? IP4_ERROR_TCP_CHECKSUM + is_udp1 : error1);
1678
1679           leaf0 =
1680             ip4_fib_mtrie_lookup_step (mtrie0, leaf0, &ip0->src_address, 3);
1681           leaf1 =
1682             ip4_fib_mtrie_lookup_step (mtrie1, leaf1, &ip1->src_address, 3);
1683
1684           vnet_buffer (p0)->ip.adj_index[VLIB_RX] = lbi0 =
1685             ip4_fib_mtrie_leaf_get_adj_index (leaf0);
1686           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = lbi0;
1687
1688           vnet_buffer (p1)->ip.adj_index[VLIB_RX] = lbi1 =
1689             ip4_fib_mtrie_leaf_get_adj_index (leaf1);
1690           vnet_buffer (p1)->ip.adj_index[VLIB_TX] = lbi1;
1691
1692           lb0 = load_balance_get (lbi0);
1693           lb1 = load_balance_get (lbi1);
1694           dpo0 = load_balance_get_bucket_i (lb0, 0);
1695           dpo1 = load_balance_get_bucket_i (lb1, 0);
1696
1697           /*
1698            * Must have a route to source otherwise we drop the packet.
1699            * ip4 broadcasts are accepted, e.g. to make dhcp client work
1700            *
1701            * The checks are:
1702            *  - the source is a recieve => it's from us => bogus, do this
1703            *    first since it sets a different error code.
1704            *  - uRPF check for any route to source - accept if passes.
1705            *  - allow packets destined to the broadcast address from unknown sources
1706            */
1707           error0 = ((error0 == IP4_ERROR_UNKNOWN_PROTOCOL &&
1708                      dpo0->dpoi_type == DPO_RECEIVE) ?
1709                     IP4_ERROR_SPOOFED_LOCAL_PACKETS : error0);
1710           error0 = ((error0 == IP4_ERROR_UNKNOWN_PROTOCOL &&
1711                      !fib_urpf_check_size (lb0->lb_urpf) &&
1712                      ip0->dst_address.as_u32 != 0xFFFFFFFF)
1713                     ? IP4_ERROR_SRC_LOOKUP_MISS : error0);
1714           error1 = ((error1 == IP4_ERROR_UNKNOWN_PROTOCOL &&
1715                      dpo1->dpoi_type == DPO_RECEIVE) ?
1716                     IP4_ERROR_SPOOFED_LOCAL_PACKETS : error1);
1717           error1 = ((error1 == IP4_ERROR_UNKNOWN_PROTOCOL &&
1718                      !fib_urpf_check_size (lb1->lb_urpf) &&
1719                      ip1->dst_address.as_u32 != 0xFFFFFFFF)
1720                     ? IP4_ERROR_SRC_LOOKUP_MISS : error1);
1721
1722         skip_checks:
1723
1724           next0 = lm->local_next_by_ip_protocol[proto0];
1725           next1 = lm->local_next_by_ip_protocol[proto1];
1726
1727           next0 =
1728             error0 != IP4_ERROR_UNKNOWN_PROTOCOL ? IP_LOCAL_NEXT_DROP : next0;
1729           next1 =
1730             error1 != IP4_ERROR_UNKNOWN_PROTOCOL ? IP_LOCAL_NEXT_DROP : next1;
1731
1732           p0->error = error0 ? error_node->errors[error0] : 0;
1733           p1->error = error1 ? error_node->errors[error1] : 0;
1734
1735           if (head_of_feature_arc)
1736             {
1737               if (PREDICT_TRUE (error0 == (u8) IP4_ERROR_UNKNOWN_PROTOCOL))
1738                 vnet_feature_arc_start (arc_index, sw_if_index0, &next0, p0);
1739               if (PREDICT_TRUE (error1 == (u8) IP4_ERROR_UNKNOWN_PROTOCOL))
1740                 vnet_feature_arc_start (arc_index, sw_if_index1, &next1, p1);
1741             }
1742
1743           vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next,
1744                                            n_left_to_next, pi0, pi1,
1745                                            next0, next1);
1746         }
1747
1748       while (n_left_from > 0 && n_left_to_next > 0)
1749         {
1750           vlib_buffer_t *p0;
1751           ip4_header_t *ip0;
1752           udp_header_t *udp0;
1753           ip4_fib_mtrie_t *mtrie0;
1754           ip4_fib_mtrie_leaf_t leaf0;
1755           u32 pi0, next0, ip_len0, udp_len0, flags0, fib_index0, lbi0;
1756           i32 len_diff0;
1757           u8 error0, is_udp0, is_tcp_udp0, good_tcp_udp0, proto0;
1758           load_balance_t *lb0;
1759           const dpo_id_t *dpo0;
1760           u32 sw_if_index0;
1761
1762           pi0 = to_next[0] = from[0];
1763           from += 1;
1764           n_left_from -= 1;
1765           to_next += 1;
1766           n_left_to_next -= 1;
1767
1768           next0 = IP_LOCAL_NEXT_DROP;
1769
1770           p0 = vlib_get_buffer (vm, pi0);
1771
1772           ip0 = vlib_buffer_get_current (p0);
1773
1774           vnet_buffer (p0)->ip.start_of_ip_header = p0->current_data;
1775
1776           sw_if_index0 = vnet_buffer (p0)->sw_if_index[VLIB_RX];
1777
1778           fib_index0 = vec_elt (im->fib_index_by_sw_if_index, sw_if_index0);
1779
1780           fib_index0 =
1781             (vnet_buffer (p0)->sw_if_index[VLIB_TX] ==
1782              (u32) ~ 0) ? fib_index0 : vnet_buffer (p0)->sw_if_index[VLIB_TX];
1783
1784           mtrie0 = &ip4_fib_get (fib_index0)->mtrie;
1785
1786           leaf0 = ip4_fib_mtrie_lookup_step_one (mtrie0, &ip0->src_address);
1787
1788           /* Treat IP frag packets as "experimental" protocol for now
1789              until support of IP frag reassembly is implemented */
1790           proto0 = ip4_is_fragment (ip0) ? 0xfe : ip0->protocol;
1791
1792           if (head_of_feature_arc == 0)
1793             {
1794               error0 = IP4_ERROR_UNKNOWN_PROTOCOL;
1795               goto skip_check;
1796             }
1797
1798           is_udp0 = proto0 == IP_PROTOCOL_UDP;
1799           is_tcp_udp0 = is_udp0 || proto0 == IP_PROTOCOL_TCP;
1800
1801           flags0 = p0->flags;
1802
1803           good_tcp_udp0 = (flags0 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0;
1804
1805           udp0 = ip4_next_header (ip0);
1806
1807           /* Don't verify UDP checksum for packets with explicit zero checksum. */
1808           good_tcp_udp0 |= is_udp0 && udp0->checksum == 0;
1809
1810           /* Verify UDP length. */
1811           ip_len0 = clib_net_to_host_u16 (ip0->length);
1812           udp_len0 = clib_net_to_host_u16 (udp0->length);
1813
1814           len_diff0 = ip_len0 - udp_len0;
1815
1816           len_diff0 = is_udp0 ? len_diff0 : 0;
1817
1818           if (PREDICT_FALSE (!(is_tcp_udp0 & good_tcp_udp0)))
1819             {
1820               if (is_tcp_udp0)
1821                 {
1822                   if (is_tcp_udp0
1823                       && !(flags0 & IP_BUFFER_L4_CHECKSUM_COMPUTED))
1824                     flags0 = ip4_tcp_udp_validate_checksum (vm, p0);
1825                   good_tcp_udp0 =
1826                     (flags0 & IP_BUFFER_L4_CHECKSUM_CORRECT) != 0;
1827                   good_tcp_udp0 |= is_udp0 && udp0->checksum == 0;
1828                 }
1829             }
1830
1831           good_tcp_udp0 &= len_diff0 >= 0;
1832
1833           leaf0 =
1834             ip4_fib_mtrie_lookup_step (mtrie0, leaf0, &ip0->src_address, 2);
1835
1836           error0 = IP4_ERROR_UNKNOWN_PROTOCOL;
1837
1838           error0 = len_diff0 < 0 ? IP4_ERROR_UDP_LENGTH : error0;
1839
1840           ASSERT (IP4_ERROR_TCP_CHECKSUM + 1 == IP4_ERROR_UDP_CHECKSUM);
1841           error0 = (is_tcp_udp0 && !good_tcp_udp0
1842                     ? IP4_ERROR_TCP_CHECKSUM + is_udp0 : error0);
1843
1844           leaf0 =
1845             ip4_fib_mtrie_lookup_step (mtrie0, leaf0, &ip0->src_address, 3);
1846
1847           lbi0 = ip4_fib_mtrie_leaf_get_adj_index (leaf0);
1848           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = lbi0;
1849
1850           lb0 = load_balance_get (lbi0);
1851           dpo0 = load_balance_get_bucket_i (lb0, 0);
1852
1853           vnet_buffer (p0)->ip.adj_index[VLIB_TX] =
1854             vnet_buffer (p0)->ip.adj_index[VLIB_RX] = lbi0;
1855
1856           error0 = ((error0 == IP4_ERROR_UNKNOWN_PROTOCOL &&
1857                      dpo0->dpoi_type == DPO_RECEIVE) ?
1858                     IP4_ERROR_SPOOFED_LOCAL_PACKETS : error0);
1859           error0 = ((error0 == IP4_ERROR_UNKNOWN_PROTOCOL &&
1860                      !fib_urpf_check_size (lb0->lb_urpf) &&
1861                      ip0->dst_address.as_u32 != 0xFFFFFFFF)
1862                     ? IP4_ERROR_SRC_LOOKUP_MISS : error0);
1863
1864         skip_check:
1865
1866           next0 = lm->local_next_by_ip_protocol[proto0];
1867
1868           next0 =
1869             error0 != IP4_ERROR_UNKNOWN_PROTOCOL ? IP_LOCAL_NEXT_DROP : next0;
1870
1871           p0->error = error0 ? error_node->errors[error0] : 0;
1872
1873           if (head_of_feature_arc)
1874             {
1875               if (PREDICT_TRUE (error0 == (u8) IP4_ERROR_UNKNOWN_PROTOCOL))
1876                 vnet_feature_arc_start (arc_index, sw_if_index0, &next0, p0);
1877             }
1878
1879           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
1880                                            n_left_to_next, pi0, next0);
1881
1882         }
1883
1884       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
1885     }
1886
1887   return frame->n_vectors;
1888 }
1889
1890 static uword
1891 ip4_local (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame)
1892 {
1893   return ip4_local_inline (vm, node, frame, 1 /* head of feature arc */ );
1894 }
1895
1896 /* *INDENT-OFF* */
1897 VLIB_REGISTER_NODE (ip4_local_node) =
1898 {
1899   .function = ip4_local,
1900   .name = "ip4-local",
1901   .vector_size = sizeof (u32),
1902   .format_trace = format_ip4_forward_next_trace,
1903   .n_next_nodes = IP_LOCAL_N_NEXT,
1904   .next_nodes =
1905   {
1906     [IP_LOCAL_NEXT_DROP] = "error-drop",
1907     [IP_LOCAL_NEXT_PUNT] = "error-punt",
1908     [IP_LOCAL_NEXT_UDP_LOOKUP] = "ip4-udp-lookup",
1909     [IP_LOCAL_NEXT_ICMP] = "ip4-icmp-input",},
1910 };
1911 /* *INDENT-ON* */
1912
1913 VLIB_NODE_FUNCTION_MULTIARCH (ip4_local_node, ip4_local);
1914
1915 static uword
1916 ip4_local_end_of_arc (vlib_main_t * vm,
1917                       vlib_node_runtime_t * node, vlib_frame_t * frame)
1918 {
1919   return ip4_local_inline (vm, node, frame, 0 /* head of feature arc */ );
1920 }
1921
1922 /* *INDENT-OFF* */
1923 VLIB_REGISTER_NODE (ip4_local_end_of_arc_node,static) = {
1924   .function = ip4_local_end_of_arc,
1925   .name = "ip4-local-end-of-arc",
1926   .vector_size = sizeof (u32),
1927
1928   .format_trace = format_ip4_forward_next_trace,
1929   .sibling_of = "ip4-local",
1930 };
1931
1932 VLIB_NODE_FUNCTION_MULTIARCH (ip4_local_end_of_arc_node, ip4_local_end_of_arc)
1933
1934 VNET_FEATURE_INIT (ip4_local_end_of_arc, static) = {
1935   .arc_name = "ip4-local",
1936   .node_name = "ip4-local-end-of-arc",
1937   .runs_before = 0, /* not before any other features */
1938 };
1939 /* *INDENT-ON* */
1940
1941 void
1942 ip4_register_protocol (u32 protocol, u32 node_index)
1943 {
1944   vlib_main_t *vm = vlib_get_main ();
1945   ip4_main_t *im = &ip4_main;
1946   ip_lookup_main_t *lm = &im->lookup_main;
1947
1948   ASSERT (protocol < ARRAY_LEN (lm->local_next_by_ip_protocol));
1949   lm->local_next_by_ip_protocol[protocol] =
1950     vlib_node_add_next (vm, ip4_local_node.index, node_index);
1951 }
1952
1953 static clib_error_t *
1954 show_ip_local_command_fn (vlib_main_t * vm,
1955                           unformat_input_t * input, vlib_cli_command_t * cmd)
1956 {
1957   ip4_main_t *im = &ip4_main;
1958   ip_lookup_main_t *lm = &im->lookup_main;
1959   int i;
1960
1961   vlib_cli_output (vm, "Protocols handled by ip4_local");
1962   for (i = 0; i < ARRAY_LEN (lm->local_next_by_ip_protocol); i++)
1963     {
1964       if (lm->local_next_by_ip_protocol[i] != IP_LOCAL_NEXT_PUNT)
1965         vlib_cli_output (vm, "%d", i);
1966     }
1967   return 0;
1968 }
1969
1970
1971
1972 /*?
1973  * Display the set of protocols handled by the local IPv4 stack.
1974  *
1975  * @cliexpar
1976  * Example of how to display local protocol table:
1977  * @cliexstart{show ip local}
1978  * Protocols handled by ip4_local
1979  * 1
1980  * 17
1981  * 47
1982  * @cliexend
1983 ?*/
1984 /* *INDENT-OFF* */
1985 VLIB_CLI_COMMAND (show_ip_local, static) =
1986 {
1987   .path = "show ip local",
1988   .function = show_ip_local_command_fn,
1989   .short_help = "show ip local",
1990 };
1991 /* *INDENT-ON* */
1992
1993 always_inline uword
1994 ip4_arp_inline (vlib_main_t * vm,
1995                 vlib_node_runtime_t * node,
1996                 vlib_frame_t * frame, int is_glean)
1997 {
1998   vnet_main_t *vnm = vnet_get_main ();
1999   ip4_main_t *im = &ip4_main;
2000   ip_lookup_main_t *lm = &im->lookup_main;
2001   u32 *from, *to_next_drop;
2002   uword n_left_from, n_left_to_next_drop, next_index;
2003   static f64 time_last_seed_change = -1e100;
2004   static u32 hash_seeds[3];
2005   static uword hash_bitmap[256 / BITS (uword)];
2006   f64 time_now;
2007
2008   if (node->flags & VLIB_NODE_FLAG_TRACE)
2009     ip4_forward_next_trace (vm, node, frame, VLIB_TX);
2010
2011   time_now = vlib_time_now (vm);
2012   if (time_now - time_last_seed_change > 1e-3)
2013     {
2014       uword i;
2015       u32 *r = clib_random_buffer_get_data (&vm->random_buffer,
2016                                             sizeof (hash_seeds));
2017       for (i = 0; i < ARRAY_LEN (hash_seeds); i++)
2018         hash_seeds[i] = r[i];
2019
2020       /* Mark all hash keys as been no-seen before. */
2021       for (i = 0; i < ARRAY_LEN (hash_bitmap); i++)
2022         hash_bitmap[i] = 0;
2023
2024       time_last_seed_change = time_now;
2025     }
2026
2027   from = vlib_frame_vector_args (frame);
2028   n_left_from = frame->n_vectors;
2029   next_index = node->cached_next_index;
2030   if (next_index == IP4_ARP_NEXT_DROP)
2031     next_index = IP4_ARP_N_NEXT;        /* point to first interface */
2032
2033   while (n_left_from > 0)
2034     {
2035       vlib_get_next_frame (vm, node, IP4_ARP_NEXT_DROP,
2036                            to_next_drop, n_left_to_next_drop);
2037
2038       while (n_left_from > 0 && n_left_to_next_drop > 0)
2039         {
2040           u32 pi0, adj_index0, a0, b0, c0, m0, sw_if_index0, drop0;
2041           ip_adjacency_t *adj0;
2042           vlib_buffer_t *p0;
2043           ip4_header_t *ip0;
2044           uword bm0;
2045
2046           pi0 = from[0];
2047
2048           p0 = vlib_get_buffer (vm, pi0);
2049
2050           adj_index0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
2051           adj0 = adj_get (adj_index0);
2052           ip0 = vlib_buffer_get_current (p0);
2053
2054           a0 = hash_seeds[0];
2055           b0 = hash_seeds[1];
2056           c0 = hash_seeds[2];
2057
2058           sw_if_index0 = adj0->rewrite_header.sw_if_index;
2059           vnet_buffer (p0)->sw_if_index[VLIB_TX] = sw_if_index0;
2060
2061           if (is_glean)
2062             {
2063               /*
2064                * this is the Glean case, so we are ARPing for the
2065                * packet's destination
2066                */
2067               a0 ^= ip0->dst_address.data_u32;
2068             }
2069           else
2070             {
2071               a0 ^= adj0->sub_type.nbr.next_hop.ip4.data_u32;
2072             }
2073           b0 ^= sw_if_index0;
2074
2075           hash_v3_finalize32 (a0, b0, c0);
2076
2077           c0 &= BITS (hash_bitmap) - 1;
2078           c0 = c0 / BITS (uword);
2079           m0 = (uword) 1 << (c0 % BITS (uword));
2080
2081           bm0 = hash_bitmap[c0];
2082           drop0 = (bm0 & m0) != 0;
2083
2084           /* Mark it as seen. */
2085           hash_bitmap[c0] = bm0 | m0;
2086
2087           from += 1;
2088           n_left_from -= 1;
2089           to_next_drop[0] = pi0;
2090           to_next_drop += 1;
2091           n_left_to_next_drop -= 1;
2092
2093           p0->error =
2094             node->errors[drop0 ? IP4_ARP_ERROR_DROP :
2095                          IP4_ARP_ERROR_REQUEST_SENT];
2096
2097           /*
2098            * the adj has been updated to a rewrite but the node the DPO that got
2099            * us here hasn't - yet. no big deal. we'll drop while we wait.
2100            */
2101           if (IP_LOOKUP_NEXT_REWRITE == adj0->lookup_next_index)
2102             continue;
2103
2104           if (drop0)
2105             continue;
2106
2107           /*
2108            * Can happen if the control-plane is programming tables
2109            * with traffic flowing; at least that's today's lame excuse.
2110            */
2111           if ((is_glean && adj0->lookup_next_index != IP_LOOKUP_NEXT_GLEAN)
2112               || (!is_glean && adj0->lookup_next_index != IP_LOOKUP_NEXT_ARP))
2113             {
2114               p0->error = node->errors[IP4_ARP_ERROR_NON_ARP_ADJ];
2115             }
2116           else
2117             /* Send ARP request. */
2118             {
2119               u32 bi0 = 0;
2120               vlib_buffer_t *b0;
2121               ethernet_arp_header_t *h0;
2122               vnet_hw_interface_t *hw_if0;
2123
2124               h0 =
2125                 vlib_packet_template_get_packet (vm,
2126                                                  &im->ip4_arp_request_packet_template,
2127                                                  &bi0);
2128
2129               /* Add rewrite/encap string for ARP packet. */
2130               vnet_rewrite_one_header (adj0[0], h0,
2131                                        sizeof (ethernet_header_t));
2132
2133               hw_if0 = vnet_get_sup_hw_interface (vnm, sw_if_index0);
2134
2135               /* Src ethernet address in ARP header. */
2136               clib_memcpy (h0->ip4_over_ethernet[0].ethernet,
2137                            hw_if0->hw_address,
2138                            sizeof (h0->ip4_over_ethernet[0].ethernet));
2139
2140               if (is_glean)
2141                 {
2142                   /* The interface's source address is stashed in the Glean Adj */
2143                   h0->ip4_over_ethernet[0].ip4 =
2144                     adj0->sub_type.glean.receive_addr.ip4;
2145
2146                   /* Copy in destination address we are requesting. This is the
2147                    * glean case, so it's the packet's destination.*/
2148                   h0->ip4_over_ethernet[1].ip4.data_u32 =
2149                     ip0->dst_address.data_u32;
2150                 }
2151               else
2152                 {
2153                   /* Src IP address in ARP header. */
2154                   if (ip4_src_address_for_packet (lm, sw_if_index0,
2155                                                   &h0->
2156                                                   ip4_over_ethernet[0].ip4))
2157                     {
2158                       /* No source address available */
2159                       p0->error =
2160                         node->errors[IP4_ARP_ERROR_NO_SOURCE_ADDRESS];
2161                       vlib_buffer_free (vm, &bi0, 1);
2162                       continue;
2163                     }
2164
2165                   /* Copy in destination address we are requesting from the
2166                      incomplete adj */
2167                   h0->ip4_over_ethernet[1].ip4.data_u32 =
2168                     adj0->sub_type.nbr.next_hop.ip4.as_u32;
2169                 }
2170
2171               vlib_buffer_copy_trace_flag (vm, p0, bi0);
2172               b0 = vlib_get_buffer (vm, bi0);
2173               vnet_buffer (b0)->sw_if_index[VLIB_TX] = sw_if_index0;
2174
2175               vlib_buffer_advance (b0, -adj0->rewrite_header.data_bytes);
2176
2177               vlib_set_next_frame_buffer (vm, node,
2178                                           adj0->rewrite_header.next_index,
2179                                           bi0);
2180             }
2181         }
2182
2183       vlib_put_next_frame (vm, node, IP4_ARP_NEXT_DROP, n_left_to_next_drop);
2184     }
2185
2186   return frame->n_vectors;
2187 }
2188
2189 static uword
2190 ip4_arp (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame)
2191 {
2192   return (ip4_arp_inline (vm, node, frame, 0));
2193 }
2194
2195 static uword
2196 ip4_glean (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame)
2197 {
2198   return (ip4_arp_inline (vm, node, frame, 1));
2199 }
2200
2201 static char *ip4_arp_error_strings[] = {
2202   [IP4_ARP_ERROR_DROP] = "address overflow drops",
2203   [IP4_ARP_ERROR_REQUEST_SENT] = "ARP requests sent",
2204   [IP4_ARP_ERROR_NON_ARP_ADJ] = "ARPs to non-ARP adjacencies",
2205   [IP4_ARP_ERROR_REPLICATE_DROP] = "ARP replication completed",
2206   [IP4_ARP_ERROR_REPLICATE_FAIL] = "ARP replication failed",
2207   [IP4_ARP_ERROR_NO_SOURCE_ADDRESS] = "no source address for ARP request",
2208 };
2209
2210 VLIB_REGISTER_NODE (ip4_arp_node) =
2211 {
2212   .function = ip4_arp,.name = "ip4-arp",.vector_size =
2213     sizeof (u32),.format_trace = format_ip4_forward_next_trace,.n_errors =
2214     ARRAY_LEN (ip4_arp_error_strings),.error_strings =
2215     ip4_arp_error_strings,.n_next_nodes = IP4_ARP_N_NEXT,.next_nodes =
2216   {
2217   [IP4_ARP_NEXT_DROP] = "error-drop",}
2218 ,};
2219
2220 VLIB_REGISTER_NODE (ip4_glean_node) =
2221 {
2222   .function = ip4_glean,.name = "ip4-glean",.vector_size =
2223     sizeof (u32),.format_trace = format_ip4_forward_next_trace,.n_errors =
2224     ARRAY_LEN (ip4_arp_error_strings),.error_strings =
2225     ip4_arp_error_strings,.n_next_nodes = IP4_ARP_N_NEXT,.next_nodes =
2226   {
2227   [IP4_ARP_NEXT_DROP] = "error-drop",}
2228 ,};
2229
2230 #define foreach_notrace_ip4_arp_error           \
2231 _(DROP)                                         \
2232 _(REQUEST_SENT)                                 \
2233 _(REPLICATE_DROP)                               \
2234 _(REPLICATE_FAIL)
2235
2236 clib_error_t *
2237 arp_notrace_init (vlib_main_t * vm)
2238 {
2239   vlib_node_runtime_t *rt = vlib_node_get_runtime (vm, ip4_arp_node.index);
2240
2241   /* don't trace ARP request packets */
2242 #define _(a)                                    \
2243     vnet_pcap_drop_trace_filter_add_del         \
2244         (rt->errors[IP4_ARP_ERROR_##a],         \
2245          1 /* is_add */);
2246   foreach_notrace_ip4_arp_error;
2247 #undef _
2248   return 0;
2249 }
2250
2251 VLIB_INIT_FUNCTION (arp_notrace_init);
2252
2253
2254 /* Send an ARP request to see if given destination is reachable on given interface. */
2255 clib_error_t *
2256 ip4_probe_neighbor (vlib_main_t * vm, ip4_address_t * dst, u32 sw_if_index)
2257 {
2258   vnet_main_t *vnm = vnet_get_main ();
2259   ip4_main_t *im = &ip4_main;
2260   ethernet_arp_header_t *h;
2261   ip4_address_t *src;
2262   ip_interface_address_t *ia;
2263   ip_adjacency_t *adj;
2264   vnet_hw_interface_t *hi;
2265   vnet_sw_interface_t *si;
2266   vlib_buffer_t *b;
2267   adj_index_t ai;
2268   u32 bi = 0;
2269
2270   si = vnet_get_sw_interface (vnm, sw_if_index);
2271
2272   if (!(si->flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP))
2273     {
2274       return clib_error_return (0, "%U: interface %U down",
2275                                 format_ip4_address, dst,
2276                                 format_vnet_sw_if_index_name, vnm,
2277                                 sw_if_index);
2278     }
2279
2280   src =
2281     ip4_interface_address_matching_destination (im, dst, sw_if_index, &ia);
2282   if (!src)
2283     {
2284       vnm->api_errno = VNET_API_ERROR_NO_MATCHING_INTERFACE;
2285       return clib_error_return
2286         (0,
2287          "no matching interface address for destination %U (interface %U)",
2288          format_ip4_address, dst, format_vnet_sw_if_index_name, vnm,
2289          sw_if_index);
2290     }
2291
2292   ip46_address_t nh = {
2293     .ip4 = *dst,
2294   };
2295
2296   ai = adj_nbr_add_or_lock (FIB_PROTOCOL_IP4,
2297                             VNET_LINK_IP4, &nh, sw_if_index);
2298   adj = adj_get (ai);
2299
2300   h = vlib_packet_template_get_packet (vm,
2301                                        &im->ip4_arp_request_packet_template,
2302                                        &bi);
2303
2304   hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
2305
2306   clib_memcpy (h->ip4_over_ethernet[0].ethernet, hi->hw_address,
2307                sizeof (h->ip4_over_ethernet[0].ethernet));
2308
2309   h->ip4_over_ethernet[0].ip4 = src[0];
2310   h->ip4_over_ethernet[1].ip4 = dst[0];
2311
2312   b = vlib_get_buffer (vm, bi);
2313   vnet_buffer (b)->sw_if_index[VLIB_RX] =
2314     vnet_buffer (b)->sw_if_index[VLIB_TX] = sw_if_index;
2315
2316   /* Add encapsulation string for software interface (e.g. ethernet header). */
2317   vnet_rewrite_one_header (adj[0], h, sizeof (ethernet_header_t));
2318   vlib_buffer_advance (b, -adj->rewrite_header.data_bytes);
2319
2320   {
2321     vlib_frame_t *f = vlib_get_frame_to_node (vm, hi->output_node_index);
2322     u32 *to_next = vlib_frame_vector_args (f);
2323     to_next[0] = bi;
2324     f->n_vectors = 1;
2325     vlib_put_frame_to_node (vm, hi->output_node_index, f);
2326   }
2327
2328   adj_unlock (ai);
2329   return /* no error */ 0;
2330 }
2331
2332 typedef enum
2333 {
2334   IP4_REWRITE_NEXT_DROP,
2335   IP4_REWRITE_NEXT_ICMP_ERROR,
2336 } ip4_rewrite_next_t;
2337
2338 always_inline uword
2339 ip4_rewrite_inline (vlib_main_t * vm,
2340                     vlib_node_runtime_t * node,
2341                     vlib_frame_t * frame,
2342                     int do_counters, int is_midchain, int is_mcast)
2343 {
2344   ip_lookup_main_t *lm = &ip4_main.lookup_main;
2345   u32 *from = vlib_frame_vector_args (frame);
2346   u32 n_left_from, n_left_to_next, *to_next, next_index;
2347   vlib_node_runtime_t *error_node =
2348     vlib_node_get_runtime (vm, ip4_input_node.index);
2349
2350   n_left_from = frame->n_vectors;
2351   next_index = node->cached_next_index;
2352   u32 thread_index = vlib_get_thread_index ();
2353
2354   while (n_left_from > 0)
2355     {
2356       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
2357
2358       while (n_left_from >= 4 && n_left_to_next >= 2)
2359         {
2360           ip_adjacency_t *adj0, *adj1;
2361           vlib_buffer_t *p0, *p1;
2362           ip4_header_t *ip0, *ip1;
2363           u32 pi0, rw_len0, next0, error0, checksum0, adj_index0;
2364           u32 pi1, rw_len1, next1, error1, checksum1, adj_index1;
2365           u32 tx_sw_if_index0, tx_sw_if_index1;
2366
2367           /* Prefetch next iteration. */
2368           {
2369             vlib_buffer_t *p2, *p3;
2370
2371             p2 = vlib_get_buffer (vm, from[2]);
2372             p3 = vlib_get_buffer (vm, from[3]);
2373
2374             vlib_prefetch_buffer_header (p2, STORE);
2375             vlib_prefetch_buffer_header (p3, STORE);
2376
2377             CLIB_PREFETCH (p2->data, sizeof (ip0[0]), STORE);
2378             CLIB_PREFETCH (p3->data, sizeof (ip0[0]), STORE);
2379           }
2380
2381           pi0 = to_next[0] = from[0];
2382           pi1 = to_next[1] = from[1];
2383
2384           from += 2;
2385           n_left_from -= 2;
2386           to_next += 2;
2387           n_left_to_next -= 2;
2388
2389           p0 = vlib_get_buffer (vm, pi0);
2390           p1 = vlib_get_buffer (vm, pi1);
2391
2392           adj_index0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
2393           adj_index1 = vnet_buffer (p1)->ip.adj_index[VLIB_TX];
2394
2395           /*
2396            * pre-fetch the per-adjacency counters
2397            */
2398           if (do_counters)
2399             {
2400               vlib_prefetch_combined_counter (&adjacency_counters,
2401                                               thread_index, adj_index0);
2402               vlib_prefetch_combined_counter (&adjacency_counters,
2403                                               thread_index, adj_index1);
2404             }
2405
2406           ip0 = vlib_buffer_get_current (p0);
2407           ip1 = vlib_buffer_get_current (p1);
2408
2409           error0 = error1 = IP4_ERROR_NONE;
2410           next0 = next1 = IP4_REWRITE_NEXT_DROP;
2411
2412           /* Decrement TTL & update checksum.
2413              Works either endian, so no need for byte swap. */
2414           if (PREDICT_TRUE (!(p0->flags & VNET_BUFFER_LOCALLY_ORIGINATED)))
2415             {
2416               i32 ttl0 = ip0->ttl;
2417
2418               /* Input node should have reject packets with ttl 0. */
2419               ASSERT (ip0->ttl > 0);
2420
2421               checksum0 = ip0->checksum + clib_host_to_net_u16 (0x0100);
2422               checksum0 += checksum0 >= 0xffff;
2423
2424               ip0->checksum = checksum0;
2425               ttl0 -= 1;
2426               ip0->ttl = ttl0;
2427
2428               /*
2429                * If the ttl drops below 1 when forwarding, generate
2430                * an ICMP response.
2431                */
2432               if (PREDICT_FALSE (ttl0 <= 0))
2433                 {
2434                   error0 = IP4_ERROR_TIME_EXPIRED;
2435                   vnet_buffer (p0)->sw_if_index[VLIB_TX] = (u32) ~ 0;
2436                   icmp4_error_set_vnet_buffer (p0, ICMP4_time_exceeded,
2437                                                ICMP4_time_exceeded_ttl_exceeded_in_transit,
2438                                                0);
2439                   next0 = IP4_REWRITE_NEXT_ICMP_ERROR;
2440                 }
2441
2442               /* Verify checksum. */
2443               ASSERT (ip0->checksum == ip4_header_checksum (ip0));
2444             }
2445           else
2446             {
2447               p0->flags &= ~VNET_BUFFER_LOCALLY_ORIGINATED;
2448             }
2449           if (PREDICT_TRUE (!(p1->flags & VNET_BUFFER_LOCALLY_ORIGINATED)))
2450             {
2451               i32 ttl1 = ip1->ttl;
2452
2453               /* Input node should have reject packets with ttl 0. */
2454               ASSERT (ip1->ttl > 0);
2455
2456               checksum1 = ip1->checksum + clib_host_to_net_u16 (0x0100);
2457               checksum1 += checksum1 >= 0xffff;
2458
2459               ip1->checksum = checksum1;
2460               ttl1 -= 1;
2461               ip1->ttl = ttl1;
2462
2463               /*
2464                * If the ttl drops below 1 when forwarding, generate
2465                * an ICMP response.
2466                */
2467               if (PREDICT_FALSE (ttl1 <= 0))
2468                 {
2469                   error1 = IP4_ERROR_TIME_EXPIRED;
2470                   vnet_buffer (p1)->sw_if_index[VLIB_TX] = (u32) ~ 0;
2471                   icmp4_error_set_vnet_buffer (p1, ICMP4_time_exceeded,
2472                                                ICMP4_time_exceeded_ttl_exceeded_in_transit,
2473                                                0);
2474                   next1 = IP4_REWRITE_NEXT_ICMP_ERROR;
2475                 }
2476
2477               /* Verify checksum. */
2478               ASSERT (ip1->checksum == ip4_header_checksum (ip1));
2479             }
2480           else
2481             {
2482               p1->flags &= ~VNET_BUFFER_LOCALLY_ORIGINATED;
2483             }
2484
2485           /* Rewrite packet header and updates lengths. */
2486           adj0 = adj_get (adj_index0);
2487           adj1 = adj_get (adj_index1);
2488
2489           /* Worth pipelining. No guarantee that adj0,1 are hot... */
2490           rw_len0 = adj0[0].rewrite_header.data_bytes;
2491           rw_len1 = adj1[0].rewrite_header.data_bytes;
2492           vnet_buffer (p0)->ip.save_rewrite_length = rw_len0;
2493           vnet_buffer (p1)->ip.save_rewrite_length = rw_len1;
2494
2495           /* Check MTU of outgoing interface. */
2496           error0 =
2497             (vlib_buffer_length_in_chain (vm, p0) >
2498              adj0[0].
2499              rewrite_header.max_l3_packet_bytes ? IP4_ERROR_MTU_EXCEEDED :
2500              error0);
2501           error1 =
2502             (vlib_buffer_length_in_chain (vm, p1) >
2503              adj1[0].
2504              rewrite_header.max_l3_packet_bytes ? IP4_ERROR_MTU_EXCEEDED :
2505              error1);
2506
2507           /* Don't adjust the buffer for ttl issue; icmp-error node wants
2508            * to see the IP headerr */
2509           if (PREDICT_TRUE (error0 == IP4_ERROR_NONE))
2510             {
2511               next0 = adj0[0].rewrite_header.next_index;
2512               p0->current_data -= rw_len0;
2513               p0->current_length += rw_len0;
2514               tx_sw_if_index0 = adj0[0].rewrite_header.sw_if_index;
2515               vnet_buffer (p0)->sw_if_index[VLIB_TX] = tx_sw_if_index0;
2516
2517               if (PREDICT_FALSE
2518                   (adj0[0].rewrite_header.flags & VNET_REWRITE_HAS_FEATURES))
2519                 vnet_feature_arc_start (lm->output_feature_arc_index,
2520                                         tx_sw_if_index0, &next0, p0);
2521             }
2522           if (PREDICT_TRUE (error1 == IP4_ERROR_NONE))
2523             {
2524               next1 = adj1[0].rewrite_header.next_index;
2525               p1->current_data -= rw_len1;
2526               p1->current_length += rw_len1;
2527
2528               tx_sw_if_index1 = adj1[0].rewrite_header.sw_if_index;
2529               vnet_buffer (p1)->sw_if_index[VLIB_TX] = tx_sw_if_index1;
2530
2531               if (PREDICT_FALSE
2532                   (adj1[0].rewrite_header.flags & VNET_REWRITE_HAS_FEATURES))
2533                 vnet_feature_arc_start (lm->output_feature_arc_index,
2534                                         tx_sw_if_index1, &next1, p1);
2535             }
2536
2537           /* Guess we are only writing on simple Ethernet header. */
2538           vnet_rewrite_two_headers (adj0[0], adj1[0],
2539                                     ip0, ip1, sizeof (ethernet_header_t));
2540
2541           /*
2542            * Bump the per-adjacency counters
2543            */
2544           if (do_counters)
2545             {
2546               vlib_increment_combined_counter
2547                 (&adjacency_counters,
2548                  thread_index,
2549                  adj_index0, 1,
2550                  vlib_buffer_length_in_chain (vm, p0) + rw_len0);
2551
2552               vlib_increment_combined_counter
2553                 (&adjacency_counters,
2554                  thread_index,
2555                  adj_index1, 1,
2556                  vlib_buffer_length_in_chain (vm, p1) + rw_len1);
2557             }
2558
2559           if (is_midchain)
2560             {
2561               adj0->sub_type.midchain.fixup_func (vm, adj0, p0);
2562               adj1->sub_type.midchain.fixup_func (vm, adj1, p1);
2563             }
2564           if (is_mcast)
2565             {
2566               /*
2567                * copy bytes from the IP address into the MAC rewrite
2568                */
2569               vnet_fixup_one_header (adj0[0], &ip0->dst_address, ip0);
2570               vnet_fixup_one_header (adj1[0], &ip1->dst_address, ip1);
2571             }
2572
2573           vlib_validate_buffer_enqueue_x2 (vm, node, next_index,
2574                                            to_next, n_left_to_next,
2575                                            pi0, pi1, next0, next1);
2576         }
2577
2578       while (n_left_from > 0 && n_left_to_next > 0)
2579         {
2580           ip_adjacency_t *adj0;
2581           vlib_buffer_t *p0;
2582           ip4_header_t *ip0;
2583           u32 pi0, rw_len0, adj_index0, next0, error0, checksum0;
2584           u32 tx_sw_if_index0;
2585
2586           pi0 = to_next[0] = from[0];
2587
2588           p0 = vlib_get_buffer (vm, pi0);
2589
2590           adj_index0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
2591
2592           adj0 = adj_get (adj_index0);
2593
2594           ip0 = vlib_buffer_get_current (p0);
2595
2596           error0 = IP4_ERROR_NONE;
2597           next0 = IP4_REWRITE_NEXT_DROP;        /* drop on error */
2598
2599           /* Decrement TTL & update checksum. */
2600           if (PREDICT_TRUE (!(p0->flags & VNET_BUFFER_LOCALLY_ORIGINATED)))
2601             {
2602               i32 ttl0 = ip0->ttl;
2603
2604               checksum0 = ip0->checksum + clib_host_to_net_u16 (0x0100);
2605
2606               checksum0 += checksum0 >= 0xffff;
2607
2608               ip0->checksum = checksum0;
2609
2610               ASSERT (ip0->ttl > 0);
2611
2612               ttl0 -= 1;
2613
2614               ip0->ttl = ttl0;
2615
2616               ASSERT (ip0->checksum == ip4_header_checksum (ip0));
2617
2618               if (PREDICT_FALSE (ttl0 <= 0))
2619                 {
2620                   /*
2621                    * If the ttl drops below 1 when forwarding, generate
2622                    * an ICMP response.
2623                    */
2624                   error0 = IP4_ERROR_TIME_EXPIRED;
2625                   next0 = IP4_REWRITE_NEXT_ICMP_ERROR;
2626                   vnet_buffer (p0)->sw_if_index[VLIB_TX] = (u32) ~ 0;
2627                   icmp4_error_set_vnet_buffer (p0, ICMP4_time_exceeded,
2628                                                ICMP4_time_exceeded_ttl_exceeded_in_transit,
2629                                                0);
2630                 }
2631             }
2632           else
2633             {
2634               p0->flags &= ~VNET_BUFFER_LOCALLY_ORIGINATED;
2635             }
2636
2637           if (do_counters)
2638             vlib_prefetch_combined_counter (&adjacency_counters,
2639                                             thread_index, adj_index0);
2640
2641           /* Guess we are only writing on simple Ethernet header. */
2642           vnet_rewrite_one_header (adj0[0], ip0, sizeof (ethernet_header_t));
2643           if (is_mcast)
2644             {
2645               /*
2646                * copy bytes from the IP address into the MAC rewrite
2647                */
2648               vnet_fixup_one_header (adj0[0], &ip0->dst_address, ip0);
2649             }
2650
2651           /* Update packet buffer attributes/set output interface. */
2652           rw_len0 = adj0[0].rewrite_header.data_bytes;
2653           vnet_buffer (p0)->ip.save_rewrite_length = rw_len0;
2654
2655           if (do_counters)
2656             vlib_increment_combined_counter
2657               (&adjacency_counters,
2658                thread_index, adj_index0, 1,
2659                vlib_buffer_length_in_chain (vm, p0) + rw_len0);
2660
2661           /* Check MTU of outgoing interface. */
2662           error0 = (vlib_buffer_length_in_chain (vm, p0)
2663                     > adj0[0].rewrite_header.max_l3_packet_bytes
2664                     ? IP4_ERROR_MTU_EXCEEDED : error0);
2665
2666           p0->error = error_node->errors[error0];
2667
2668           /* Don't adjust the buffer for ttl issue; icmp-error node wants
2669            * to see the IP headerr */
2670           if (PREDICT_TRUE (error0 == IP4_ERROR_NONE))
2671             {
2672               p0->current_data -= rw_len0;
2673               p0->current_length += rw_len0;
2674               tx_sw_if_index0 = adj0[0].rewrite_header.sw_if_index;
2675
2676               vnet_buffer (p0)->sw_if_index[VLIB_TX] = tx_sw_if_index0;
2677               next0 = adj0[0].rewrite_header.next_index;
2678
2679               if (is_midchain)
2680                 {
2681                   adj0->sub_type.midchain.fixup_func (vm, adj0, p0);
2682                 }
2683
2684               if (PREDICT_FALSE
2685                   (adj0[0].rewrite_header.flags & VNET_REWRITE_HAS_FEATURES))
2686                 vnet_feature_arc_start (lm->output_feature_arc_index,
2687                                         tx_sw_if_index0, &next0, p0);
2688
2689             }
2690
2691           from += 1;
2692           n_left_from -= 1;
2693           to_next += 1;
2694           n_left_to_next -= 1;
2695
2696           vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
2697                                            to_next, n_left_to_next,
2698                                            pi0, next0);
2699         }
2700
2701       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
2702     }
2703
2704   /* Need to do trace after rewrites to pick up new packet data. */
2705   if (node->flags & VLIB_NODE_FLAG_TRACE)
2706     ip4_forward_next_trace (vm, node, frame, VLIB_TX);
2707
2708   return frame->n_vectors;
2709 }
2710
2711
2712 /** @brief IPv4 rewrite node.
2713     @node ip4-rewrite
2714
2715     This is the IPv4 transit-rewrite node: decrement TTL, fix the ipv4
2716     header checksum, fetch the ip adjacency, check the outbound mtu,
2717     apply the adjacency rewrite, and send pkts to the adjacency
2718     rewrite header's rewrite_next_index.
2719
2720     @param vm vlib_main_t corresponding to the current thread
2721     @param node vlib_node_runtime_t
2722     @param frame vlib_frame_t whose contents should be dispatched
2723
2724     @par Graph mechanics: buffer metadata, next index usage
2725
2726     @em Uses:
2727     - <code>vnet_buffer(b)->ip.adj_index[VLIB_TX]</code>
2728         - the rewrite adjacency index
2729     - <code>adj->lookup_next_index</code>
2730         - Must be IP_LOOKUP_NEXT_REWRITE or IP_LOOKUP_NEXT_ARP, otherwise
2731           the packet will be dropped.
2732     - <code>adj->rewrite_header</code>
2733         - Rewrite string length, rewrite string, next_index
2734
2735     @em Sets:
2736     - <code>b->current_data, b->current_length</code>
2737         - Updated net of applying the rewrite string
2738
2739     <em>Next Indices:</em>
2740     - <code> adj->rewrite_header.next_index </code>
2741       or @c error-drop
2742 */
2743 static uword
2744 ip4_rewrite (vlib_main_t * vm,
2745              vlib_node_runtime_t * node, vlib_frame_t * frame)
2746 {
2747   if (adj_are_counters_enabled ())
2748     return ip4_rewrite_inline (vm, node, frame, 1, 0, 0);
2749   else
2750     return ip4_rewrite_inline (vm, node, frame, 0, 0, 0);
2751 }
2752
2753 static uword
2754 ip4_midchain (vlib_main_t * vm,
2755               vlib_node_runtime_t * node, vlib_frame_t * frame)
2756 {
2757   if (adj_are_counters_enabled ())
2758     return ip4_rewrite_inline (vm, node, frame, 1, 1, 0);
2759   else
2760     return ip4_rewrite_inline (vm, node, frame, 0, 1, 0);
2761 }
2762
2763 static uword
2764 ip4_rewrite_mcast (vlib_main_t * vm,
2765                    vlib_node_runtime_t * node, vlib_frame_t * frame)
2766 {
2767   if (adj_are_counters_enabled ())
2768     return ip4_rewrite_inline (vm, node, frame, 1, 0, 1);
2769   else
2770     return ip4_rewrite_inline (vm, node, frame, 0, 0, 1);
2771 }
2772
2773 static uword
2774 ip4_mcast_midchain (vlib_main_t * vm,
2775                     vlib_node_runtime_t * node, vlib_frame_t * frame)
2776 {
2777   if (adj_are_counters_enabled ())
2778     return ip4_rewrite_inline (vm, node, frame, 1, 1, 1);
2779   else
2780     return ip4_rewrite_inline (vm, node, frame, 0, 1, 1);
2781 }
2782
2783 /* *INDENT-OFF* */
2784 VLIB_REGISTER_NODE (ip4_rewrite_node) = {
2785   .function = ip4_rewrite,
2786   .name = "ip4-rewrite",
2787   .vector_size = sizeof (u32),
2788
2789   .format_trace = format_ip4_rewrite_trace,
2790
2791   .n_next_nodes = 2,
2792   .next_nodes = {
2793     [IP4_REWRITE_NEXT_DROP] = "error-drop",
2794     [IP4_REWRITE_NEXT_ICMP_ERROR] = "ip4-icmp-error",
2795   },
2796 };
2797 VLIB_NODE_FUNCTION_MULTIARCH (ip4_rewrite_node, ip4_rewrite)
2798
2799 VLIB_REGISTER_NODE (ip4_rewrite_mcast_node) = {
2800   .function = ip4_rewrite_mcast,
2801   .name = "ip4-rewrite-mcast",
2802   .vector_size = sizeof (u32),
2803
2804   .format_trace = format_ip4_rewrite_trace,
2805   .sibling_of = "ip4-rewrite",
2806 };
2807 VLIB_NODE_FUNCTION_MULTIARCH (ip4_rewrite_mcast_node, ip4_rewrite_mcast)
2808
2809 VLIB_REGISTER_NODE (ip4_mcast_midchain_node, static) = {
2810   .function = ip4_mcast_midchain,
2811   .name = "ip4-mcast-midchain",
2812   .vector_size = sizeof (u32),
2813
2814   .format_trace = format_ip4_rewrite_trace,
2815   .sibling_of = "ip4-rewrite",
2816 };
2817 VLIB_NODE_FUNCTION_MULTIARCH (ip4_mcast_midchain_node, ip4_mcast_midchain)
2818
2819 VLIB_REGISTER_NODE (ip4_midchain_node) = {
2820   .function = ip4_midchain,
2821   .name = "ip4-midchain",
2822   .vector_size = sizeof (u32),
2823   .format_trace = format_ip4_forward_next_trace,
2824   .sibling_of =  "ip4-rewrite",
2825 };
2826 VLIB_NODE_FUNCTION_MULTIARCH (ip4_midchain_node, ip4_midchain);
2827 /* *INDENT-ON */
2828
2829 static clib_error_t *
2830 add_del_interface_table (vlib_main_t * vm,
2831                          unformat_input_t * input, vlib_cli_command_t * cmd)
2832 {
2833   vnet_main_t *vnm = vnet_get_main ();
2834   ip_interface_address_t *ia;
2835   clib_error_t *error = 0;
2836   u32 sw_if_index, table_id;
2837
2838   sw_if_index = ~0;
2839
2840   if (!unformat_user (input, unformat_vnet_sw_interface, vnm, &sw_if_index))
2841     {
2842       error = clib_error_return (0, "unknown interface `%U'",
2843                                  format_unformat_error, input);
2844       goto done;
2845     }
2846
2847   if (unformat (input, "%d", &table_id))
2848     ;
2849   else
2850     {
2851       error = clib_error_return (0, "expected table id `%U'",
2852                                  format_unformat_error, input);
2853       goto done;
2854     }
2855
2856   /*
2857    * If the interface already has in IP address, then a change int
2858    * VRF is not allowed. The IP address applied must first be removed.
2859    * We do not do that automatically here, since VPP has no knowledge
2860    * of whether thoses subnets are valid in the destination VRF.
2861    */
2862   /* *INDENT-OFF* */
2863   foreach_ip_interface_address (&ip4_main.lookup_main,
2864                                 ia, sw_if_index,
2865                                 1 /* honor unnumbered */,
2866   ({
2867       ip4_address_t * a;
2868
2869       a = ip_interface_address_get_address (&ip4_main.lookup_main, ia);
2870       error = clib_error_return (0, "interface %U has address %U",
2871                                  format_vnet_sw_if_index_name, vnm,
2872                                  sw_if_index,
2873                                  format_ip4_address, a);
2874       goto done;
2875    }));
2876    /* *INDENT-ON* */
2877
2878 {
2879   ip4_main_t *im = &ip4_main;
2880   u32 fib_index;
2881
2882   fib_index = fib_table_find_or_create_and_lock (FIB_PROTOCOL_IP4, table_id);
2883
2884   vec_validate (im->fib_index_by_sw_if_index, sw_if_index);
2885   im->fib_index_by_sw_if_index[sw_if_index] = fib_index;
2886
2887   fib_index = mfib_table_find_or_create_and_lock (FIB_PROTOCOL_IP4, table_id);
2888   vec_validate (im->mfib_index_by_sw_if_index, sw_if_index);
2889   im->mfib_index_by_sw_if_index[sw_if_index] = fib_index;
2890 }
2891
2892 done:
2893 return error;
2894 }
2895
2896 /*?
2897  * Place the indicated interface into the supplied IPv4 FIB table (also known
2898  * as a VRF). If the FIB table does not exist, this command creates it. To
2899  * display the current IPv4 FIB table, use the command '<em>show ip fib</em>'.
2900  * FIB table will only be displayed if a route has been added to the table, or
2901  * an IP Address is assigned to an interface in the table (which adds a route
2902  * automatically).
2903  *
2904  * @note IP addresses added after setting the interface IP table are added to
2905  * the indicated FIB table. If an IP address is added prior to changing the
2906  * table then this is an error. The control plane must remove these addresses
2907  * first and then change the table. VPP will not automatically move the
2908  * addresses from the old to the new table as it does not know the validity
2909  * of such a change.
2910  *
2911  * @cliexpar
2912  * Example of how to add an interface to an IPv4 FIB table (where 2 is the table-id):
2913  * @cliexcmd{set interface ip table GigabitEthernet2/0/0 2}
2914  ?*/
2915 /* *INDENT-OFF* */
2916 VLIB_CLI_COMMAND (set_interface_ip_table_command, static) =
2917 {
2918   .path = "set interface ip table",
2919   .function = add_del_interface_table,
2920   .short_help = "set interface ip table <interface> <table-id>",
2921 };
2922 /* *INDENT-ON* */
2923
2924 int
2925 ip4_lookup_validate (ip4_address_t * a, u32 fib_index0)
2926 {
2927   ip4_fib_mtrie_t *mtrie0;
2928   ip4_fib_mtrie_leaf_t leaf0;
2929   u32 lbi0;
2930
2931   mtrie0 = &ip4_fib_get (fib_index0)->mtrie;
2932
2933   leaf0 = ip4_fib_mtrie_lookup_step_one (mtrie0, a);
2934   leaf0 = ip4_fib_mtrie_lookup_step (mtrie0, leaf0, a, 2);
2935   leaf0 = ip4_fib_mtrie_lookup_step (mtrie0, leaf0, a, 3);
2936
2937   lbi0 = ip4_fib_mtrie_leaf_get_adj_index (leaf0);
2938
2939   return lbi0 == ip4_fib_table_lookup_lb (ip4_fib_get (fib_index0), a);
2940 }
2941
2942 static clib_error_t *
2943 test_lookup_command_fn (vlib_main_t * vm,
2944                         unformat_input_t * input, vlib_cli_command_t * cmd)
2945 {
2946   ip4_fib_t *fib;
2947   u32 table_id = 0;
2948   f64 count = 1;
2949   u32 n;
2950   int i;
2951   ip4_address_t ip4_base_address;
2952   u64 errors = 0;
2953
2954   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
2955     {
2956       if (unformat (input, "table %d", &table_id))
2957         {
2958           /* Make sure the entry exists. */
2959           fib = ip4_fib_get (table_id);
2960           if ((fib) && (fib->index != table_id))
2961             return clib_error_return (0, "<fib-index> %d does not exist",
2962                                       table_id);
2963         }
2964       else if (unformat (input, "count %f", &count))
2965         ;
2966
2967       else if (unformat (input, "%U",
2968                          unformat_ip4_address, &ip4_base_address))
2969         ;
2970       else
2971         return clib_error_return (0, "unknown input `%U'",
2972                                   format_unformat_error, input);
2973     }
2974
2975   n = count;
2976
2977   for (i = 0; i < n; i++)
2978     {
2979       if (!ip4_lookup_validate (&ip4_base_address, table_id))
2980         errors++;
2981
2982       ip4_base_address.as_u32 =
2983         clib_host_to_net_u32 (1 +
2984                               clib_net_to_host_u32 (ip4_base_address.as_u32));
2985     }
2986
2987   if (errors)
2988     vlib_cli_output (vm, "%llu errors out of %d lookups\n", errors, n);
2989   else
2990     vlib_cli_output (vm, "No errors in %d lookups\n", n);
2991
2992   return 0;
2993 }
2994
2995 /*?
2996  * Perform a lookup of an IPv4 Address (or range of addresses) in the
2997  * given FIB table to determine if there is a conflict with the
2998  * adjacency table. The fib-id can be determined by using the
2999  * '<em>show ip fib</em>' command. If fib-id is not entered, default value
3000  * of 0 is used.
3001  *
3002  * @todo This command uses fib-id, other commands use table-id (not
3003  * just a name, they are different indexes). Would like to change this
3004  * to table-id for consistency.
3005  *
3006  * @cliexpar
3007  * Example of how to run the test lookup command:
3008  * @cliexstart{test lookup 172.16.1.1 table 1 count 2}
3009  * No errors in 2 lookups
3010  * @cliexend
3011 ?*/
3012 /* *INDENT-OFF* */
3013 VLIB_CLI_COMMAND (lookup_test_command, static) =
3014 {
3015   .path = "test lookup",
3016   .short_help = "test lookup <ipv4-addr> [table <fib-id>] [count <nn>]",
3017   .function = test_lookup_command_fn,
3018 };
3019 /* *INDENT-ON* */
3020
3021 int
3022 vnet_set_ip4_flow_hash (u32 table_id, u32 flow_hash_config)
3023 {
3024   u32 fib_index;
3025
3026   fib_index = fib_table_find (FIB_PROTOCOL_IP4, table_id);
3027
3028   if (~0 == fib_index)
3029     return VNET_API_ERROR_NO_SUCH_FIB;
3030
3031   fib_table_set_flow_hash_config (fib_index, FIB_PROTOCOL_IP4,
3032                                   flow_hash_config);
3033
3034   return 0;
3035 }
3036
3037 static clib_error_t *
3038 set_ip_flow_hash_command_fn (vlib_main_t * vm,
3039                              unformat_input_t * input,
3040                              vlib_cli_command_t * cmd)
3041 {
3042   int matched = 0;
3043   u32 table_id = 0;
3044   u32 flow_hash_config = 0;
3045   int rv;
3046
3047   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
3048     {
3049       if (unformat (input, "table %d", &table_id))
3050         matched = 1;
3051 #define _(a,v) \
3052     else if (unformat (input, #a)) { flow_hash_config |= v; matched=1;}
3053       foreach_flow_hash_bit
3054 #undef _
3055         else
3056         break;
3057     }
3058
3059   if (matched == 0)
3060     return clib_error_return (0, "unknown input `%U'",
3061                               format_unformat_error, input);
3062
3063   rv = vnet_set_ip4_flow_hash (table_id, flow_hash_config);
3064   switch (rv)
3065     {
3066     case 0:
3067       break;
3068
3069     case VNET_API_ERROR_NO_SUCH_FIB:
3070       return clib_error_return (0, "no such FIB table %d", table_id);
3071
3072     default:
3073       clib_warning ("BUG: illegal flow hash config 0x%x", flow_hash_config);
3074       break;
3075     }
3076
3077   return 0;
3078 }
3079
3080 /*?
3081  * Configure the set of IPv4 fields used by the flow hash.
3082  *
3083  * @cliexpar
3084  * Example of how to set the flow hash on a given table:
3085  * @cliexcmd{set ip flow-hash table 7 dst sport dport proto}
3086  * Example of display the configured flow hash:
3087  * @cliexstart{show ip fib}
3088  * ipv4-VRF:0, fib_index 0, flow hash: src dst sport dport proto
3089  * 0.0.0.0/0
3090  *   unicast-ip4-chain
3091  *   [@0]: dpo-load-balance: [index:0 buckets:1 uRPF:0 to:[0:0]]
3092  *     [0] [@0]: dpo-drop ip6
3093  * 0.0.0.0/32
3094  *   unicast-ip4-chain
3095  *   [@0]: dpo-load-balance: [index:1 buckets:1 uRPF:1 to:[0:0]]
3096  *     [0] [@0]: dpo-drop ip6
3097  * 224.0.0.0/8
3098  *   unicast-ip4-chain
3099  *   [@0]: dpo-load-balance: [index:3 buckets:1 uRPF:3 to:[0:0]]
3100  *     [0] [@0]: dpo-drop ip6
3101  * 6.0.1.2/32
3102  *   unicast-ip4-chain
3103  *   [@0]: dpo-load-balance: [index:30 buckets:1 uRPF:29 to:[0:0]]
3104  *     [0] [@3]: arp-ipv4: via 6.0.0.1 af_packet0
3105  * 7.0.0.1/32
3106  *   unicast-ip4-chain
3107  *   [@0]: dpo-load-balance: [index:31 buckets:4 uRPF:30 to:[0:0]]
3108  *     [0] [@3]: arp-ipv4: via 6.0.0.2 af_packet0
3109  *     [1] [@3]: arp-ipv4: via 6.0.0.2 af_packet0
3110  *     [2] [@3]: arp-ipv4: via 6.0.0.2 af_packet0
3111  *     [3] [@3]: arp-ipv4: via 6.0.0.1 af_packet0
3112  * 240.0.0.0/8
3113  *   unicast-ip4-chain
3114  *   [@0]: dpo-load-balance: [index:2 buckets:1 uRPF:2 to:[0:0]]
3115  *     [0] [@0]: dpo-drop ip6
3116  * 255.255.255.255/32
3117  *   unicast-ip4-chain
3118  *   [@0]: dpo-load-balance: [index:4 buckets:1 uRPF:4 to:[0:0]]
3119  *     [0] [@0]: dpo-drop ip6
3120  * ipv4-VRF:7, fib_index 1, flow hash: dst sport dport proto
3121  * 0.0.0.0/0
3122  *   unicast-ip4-chain
3123  *   [@0]: dpo-load-balance: [index:12 buckets:1 uRPF:11 to:[0:0]]
3124  *     [0] [@0]: dpo-drop ip6
3125  * 0.0.0.0/32
3126  *   unicast-ip4-chain
3127  *   [@0]: dpo-load-balance: [index:13 buckets:1 uRPF:12 to:[0:0]]
3128  *     [0] [@0]: dpo-drop ip6
3129  * 172.16.1.0/24
3130  *   unicast-ip4-chain
3131  *   [@0]: dpo-load-balance: [index:17 buckets:1 uRPF:16 to:[0:0]]
3132  *     [0] [@4]: ipv4-glean: af_packet0
3133  * 172.16.1.1/32
3134  *   unicast-ip4-chain
3135  *   [@0]: dpo-load-balance: [index:18 buckets:1 uRPF:17 to:[1:84]]
3136  *     [0] [@2]: dpo-receive: 172.16.1.1 on af_packet0
3137  * 172.16.1.2/32
3138  *   unicast-ip4-chain
3139  *   [@0]: dpo-load-balance: [index:21 buckets:1 uRPF:20 to:[0:0]]
3140  *     [0] [@5]: ipv4 via 172.16.1.2 af_packet0: IP4: 02:fe:9e:70:7a:2b -> 26:a5:f6:9c:3a:36
3141  * 172.16.2.0/24
3142  *   unicast-ip4-chain
3143  *   [@0]: dpo-load-balance: [index:19 buckets:1 uRPF:18 to:[0:0]]
3144  *     [0] [@4]: ipv4-glean: af_packet1
3145  * 172.16.2.1/32
3146  *   unicast-ip4-chain
3147  *   [@0]: dpo-load-balance: [index:20 buckets:1 uRPF:19 to:[0:0]]
3148  *     [0] [@2]: dpo-receive: 172.16.2.1 on af_packet1
3149  * 224.0.0.0/8
3150  *   unicast-ip4-chain
3151  *   [@0]: dpo-load-balance: [index:15 buckets:1 uRPF:14 to:[0:0]]
3152  *     [0] [@0]: dpo-drop ip6
3153  * 240.0.0.0/8
3154  *   unicast-ip4-chain
3155  *   [@0]: dpo-load-balance: [index:14 buckets:1 uRPF:13 to:[0:0]]
3156  *     [0] [@0]: dpo-drop ip6
3157  * 255.255.255.255/32
3158  *   unicast-ip4-chain
3159  *   [@0]: dpo-load-balance: [index:16 buckets:1 uRPF:15 to:[0:0]]
3160  *     [0] [@0]: dpo-drop ip6
3161  * @cliexend
3162 ?*/
3163 /* *INDENT-OFF* */
3164 VLIB_CLI_COMMAND (set_ip_flow_hash_command, static) =
3165 {
3166   .path = "set ip flow-hash",
3167   .short_help =
3168   "set ip flow-hash table <table-id> [src] [dst] [sport] [dport] [proto] [reverse]",
3169   .function = set_ip_flow_hash_command_fn,
3170 };
3171 /* *INDENT-ON* */
3172
3173 int
3174 vnet_set_ip4_classify_intfc (vlib_main_t * vm, u32 sw_if_index,
3175                              u32 table_index)
3176 {
3177   vnet_main_t *vnm = vnet_get_main ();
3178   vnet_interface_main_t *im = &vnm->interface_main;
3179   ip4_main_t *ipm = &ip4_main;
3180   ip_lookup_main_t *lm = &ipm->lookup_main;
3181   vnet_classify_main_t *cm = &vnet_classify_main;
3182   ip4_address_t *if_addr;
3183
3184   if (pool_is_free_index (im->sw_interfaces, sw_if_index))
3185     return VNET_API_ERROR_NO_MATCHING_INTERFACE;
3186
3187   if (table_index != ~0 && pool_is_free_index (cm->tables, table_index))
3188     return VNET_API_ERROR_NO_SUCH_ENTRY;
3189
3190   vec_validate (lm->classify_table_index_by_sw_if_index, sw_if_index);
3191   lm->classify_table_index_by_sw_if_index[sw_if_index] = table_index;
3192
3193   if_addr = ip4_interface_first_address (ipm, sw_if_index, NULL);
3194
3195   if (NULL != if_addr)
3196     {
3197       fib_prefix_t pfx = {
3198         .fp_len = 32,
3199         .fp_proto = FIB_PROTOCOL_IP4,
3200         .fp_addr.ip4 = *if_addr,
3201       };
3202       u32 fib_index;
3203
3204       fib_index = fib_table_get_index_for_sw_if_index (FIB_PROTOCOL_IP4,
3205                                                        sw_if_index);
3206
3207
3208       if (table_index != (u32) ~ 0)
3209         {
3210           dpo_id_t dpo = DPO_INVALID;
3211
3212           dpo_set (&dpo,
3213                    DPO_CLASSIFY,
3214                    DPO_PROTO_IP4,
3215                    classify_dpo_create (DPO_PROTO_IP4, table_index));
3216
3217           fib_table_entry_special_dpo_add (fib_index,
3218                                            &pfx,
3219                                            FIB_SOURCE_CLASSIFY,
3220                                            FIB_ENTRY_FLAG_NONE, &dpo);
3221           dpo_reset (&dpo);
3222         }
3223       else
3224         {
3225           fib_table_entry_special_remove (fib_index,
3226                                           &pfx, FIB_SOURCE_CLASSIFY);
3227         }
3228     }
3229
3230   return 0;
3231 }
3232
3233 static clib_error_t *
3234 set_ip_classify_command_fn (vlib_main_t * vm,
3235                             unformat_input_t * input,
3236                             vlib_cli_command_t * cmd)
3237 {
3238   u32 table_index = ~0;
3239   int table_index_set = 0;
3240   u32 sw_if_index = ~0;
3241   int rv;
3242
3243   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
3244     {
3245       if (unformat (input, "table-index %d", &table_index))
3246         table_index_set = 1;
3247       else if (unformat (input, "intfc %U", unformat_vnet_sw_interface,
3248                          vnet_get_main (), &sw_if_index))
3249         ;
3250       else
3251         break;
3252     }
3253
3254   if (table_index_set == 0)
3255     return clib_error_return (0, "classify table-index must be specified");
3256
3257   if (sw_if_index == ~0)
3258     return clib_error_return (0, "interface / subif must be specified");
3259
3260   rv = vnet_set_ip4_classify_intfc (vm, sw_if_index, table_index);
3261
3262   switch (rv)
3263     {
3264     case 0:
3265       break;
3266
3267     case VNET_API_ERROR_NO_MATCHING_INTERFACE:
3268       return clib_error_return (0, "No such interface");
3269
3270     case VNET_API_ERROR_NO_SUCH_ENTRY:
3271       return clib_error_return (0, "No such classifier table");
3272     }
3273   return 0;
3274 }
3275
3276 /*?
3277  * Assign a classification table to an interface. The classification
3278  * table is created using the '<em>classify table</em>' and '<em>classify session</em>'
3279  * commands. Once the table is create, use this command to filter packets
3280  * on an interface.
3281  *
3282  * @cliexpar
3283  * Example of how to assign a classification table to an interface:
3284  * @cliexcmd{set ip classify intfc GigabitEthernet2/0/0 table-index 1}
3285 ?*/
3286 /* *INDENT-OFF* */
3287 VLIB_CLI_COMMAND (set_ip_classify_command, static) =
3288 {
3289     .path = "set ip classify",
3290     .short_help =
3291     "set ip classify intfc <interface> table-index <classify-idx>",
3292     .function = set_ip_classify_command_fn,
3293 };
3294 /* *INDENT-ON* */
3295
3296 /*
3297  * fd.io coding-style-patch-verification: ON
3298  *
3299  * Local Variables:
3300  * eval: (c-set-style "gnu")
3301  * End:
3302  */