src/vnet/ip/ip6_forward.c

   1 /*
   2  * Copyright (c) 2016 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/ip6_forward.c: IP v6 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/ip/ip6_neighbor.h>
  43 #include <vnet/ethernet/ethernet.h>     /* for ethernet_header_t */
  44 #include <vnet/srp/srp.h>       /* for srp_hw_interface_class */
  45 #include <vppinfra/cache.h>
  46 #include <vnet/fib/fib_urpf_list.h>     /* for FIB uRPF check */
  47 #include <vnet/fib/ip6_fib.h>
  48 #include <vnet/mfib/ip6_mfib.h>
  49 #include <vnet/dpo/load_balance_map.h>
  50 #include <vnet/dpo/classify_dpo.h>
  51
  52 #include <vppinfra/bihash_template.c>
  53
  54 /* Flag used by IOAM code. Classifier sets it pop-hop-by-hop checks it */
  55 #define OI_DECAP   0x80000000
  56
  57 /**
  58  * @file
  59  * @brief IPv6 Forwarding.
  60  *
  61  * This file contains the source code for IPv6 forwarding.
  62  */
  63
  64 void
  65 ip6_forward_next_trace (vlib_main_t * vm,
  66                         vlib_node_runtime_t * node,
  67                         vlib_frame_t * frame,
  68                         vlib_rx_or_tx_t which_adj_index);
  69
  70 always_inline uword
  71 ip6_lookup_inline (vlib_main_t * vm,
  72                    vlib_node_runtime_t * node, vlib_frame_t * frame)
  73 {
  74   ip6_main_t *im = &ip6_main;
  75   vlib_combined_counter_main_t *cm = &load_balance_main.lbm_to_counters;
  76   u32 n_left_from, n_left_to_next, *from, *to_next;
  77   ip_lookup_next_t next;
  78   u32 thread_index = vlib_get_thread_index ();
  79
  80   from = vlib_frame_vector_args (frame);
  81   n_left_from = frame->n_vectors;
  82   next = node->cached_next_index;
  83
  84   while (n_left_from > 0)
  85     {
  86       vlib_get_next_frame (vm, node, next, to_next, n_left_to_next);
  87
  88       while (n_left_from >= 4 && n_left_to_next >= 2)
  89         {
  90           vlib_buffer_t *p0, *p1;
  91           u32 pi0, pi1, lbi0, lbi1, wrong_next;
  92           ip_lookup_next_t next0, next1;
  93           ip6_header_t *ip0, *ip1;
  94           ip6_address_t *dst_addr0, *dst_addr1;
  95           u32 fib_index0, fib_index1;
  96           u32 flow_hash_config0, flow_hash_config1;
  97           const dpo_id_t *dpo0, *dpo1;
  98           const load_balance_t *lb0, *lb1;
  99
 100           /* Prefetch next iteration. */
 101           {
 102             vlib_buffer_t *p2, *p3;
 103
 104             p2 = vlib_get_buffer (vm, from[2]);
 105             p3 = vlib_get_buffer (vm, from[3]);
 106
 107             vlib_prefetch_buffer_header (p2, LOAD);
 108             vlib_prefetch_buffer_header (p3, LOAD);
 109             CLIB_PREFETCH (p2->data, sizeof (ip0[0]), LOAD);
 110             CLIB_PREFETCH (p3->data, sizeof (ip0[0]), LOAD);
 111           }
 112
 113           pi0 = to_next[0] = from[0];
 114           pi1 = to_next[1] = from[1];
 115
 116           p0 = vlib_get_buffer (vm, pi0);
 117           p1 = vlib_get_buffer (vm, pi1);
 118
 119           ip0 = vlib_buffer_get_current (p0);
 120           ip1 = vlib_buffer_get_current (p1);
 121
 122           dst_addr0 = &ip0->dst_address;
 123           dst_addr1 = &ip1->dst_address;
 124
 125           fib_index0 =
 126             vec_elt (im->fib_index_by_sw_if_index,
 127                      vnet_buffer (p0)->sw_if_index[VLIB_RX]);
 128           fib_index1 =
 129             vec_elt (im->fib_index_by_sw_if_index,
 130                      vnet_buffer (p1)->sw_if_index[VLIB_RX]);
 131
 132           fib_index0 = (vnet_buffer (p0)->sw_if_index[VLIB_TX] == (u32) ~ 0) ?
 133             fib_index0 : vnet_buffer (p0)->sw_if_index[VLIB_TX];
 134           fib_index1 = (vnet_buffer (p1)->sw_if_index[VLIB_TX] == (u32) ~ 0) ?
 135             fib_index1 : vnet_buffer (p1)->sw_if_index[VLIB_TX];
 136
 137           lbi0 = ip6_fib_table_fwding_lookup (im, fib_index0, dst_addr0);
 138           lbi1 = ip6_fib_table_fwding_lookup (im, fib_index1, dst_addr1);
 139
 140           lb0 = load_balance_get (lbi0);
 141           lb1 = load_balance_get (lbi1);
 142           ASSERT (lb0->lb_n_buckets > 0);
 143           ASSERT (lb1->lb_n_buckets > 0);
 144           ASSERT (is_pow2 (lb0->lb_n_buckets));
 145           ASSERT (is_pow2 (lb1->lb_n_buckets));
 146
 147           vnet_buffer (p0)->ip.flow_hash = vnet_buffer (p1)->ip.flow_hash = 0;
 148
 149           if (PREDICT_FALSE (lb0->lb_n_buckets > 1))
 150             {
 151               flow_hash_config0 = lb0->lb_hash_config;
 152               vnet_buffer (p0)->ip.flow_hash =
 153                 ip6_compute_flow_hash (ip0, flow_hash_config0);
 154               dpo0 =
 155                 load_balance_get_fwd_bucket (lb0,
 156                                              (vnet_buffer (p0)->ip.flow_hash &
 157                                               (lb0->lb_n_buckets_minus_1)));
 158             }
 159           else
 160             {
 161               dpo0 = load_balance_get_bucket_i (lb0, 0);
 162             }
 163           if (PREDICT_FALSE (lb1->lb_n_buckets > 1))
 164             {
 165               flow_hash_config1 = lb1->lb_hash_config;
 166               vnet_buffer (p1)->ip.flow_hash =
 167                 ip6_compute_flow_hash (ip1, flow_hash_config1);
 168               dpo1 =
 169                 load_balance_get_fwd_bucket (lb1,
 170                                              (vnet_buffer (p1)->ip.flow_hash &
 171                                               (lb1->lb_n_buckets_minus_1)));
 172             }
 173           else
 174             {
 175               dpo1 = load_balance_get_bucket_i (lb1, 0);
 176             }
 177           next0 = dpo0->dpoi_next_node;
 178           next1 = dpo1->dpoi_next_node;
 179
 180           /* Only process the HBH Option Header if explicitly configured to do so */
 181           if (PREDICT_FALSE
 182               (ip0->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS))
 183             {
 184               next0 = (dpo_is_adj (dpo0) && im->hbh_enabled) ?
 185                 (ip_lookup_next_t) IP6_LOOKUP_NEXT_HOP_BY_HOP : next0;
 186             }
 187           if (PREDICT_FALSE
 188               (ip1->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS))
 189             {
 190               next1 = (dpo_is_adj (dpo1) && im->hbh_enabled) ?
 191                 (ip_lookup_next_t) IP6_LOOKUP_NEXT_HOP_BY_HOP : next1;
 192             }
 193           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = dpo0->dpoi_index;
 194           vnet_buffer (p1)->ip.adj_index[VLIB_TX] = dpo1->dpoi_index;
 195
 196           vlib_increment_combined_counter
 197             (cm, thread_index, lbi0, 1, vlib_buffer_length_in_chain (vm, p0));
 198           vlib_increment_combined_counter
 199             (cm, thread_index, lbi1, 1, vlib_buffer_length_in_chain (vm, p1));
 200
 201           from += 2;
 202           to_next += 2;
 203           n_left_to_next -= 2;
 204           n_left_from -= 2;
 205
 206           wrong_next = (next0 != next) + 2 * (next1 != next);
 207           if (PREDICT_FALSE (wrong_next != 0))
 208             {
 209               switch (wrong_next)
 210                 {
 211                 case 1:
 212                   /* A B A */
 213                   to_next[-2] = pi1;
 214                   to_next -= 1;
 215                   n_left_to_next += 1;
 216                   vlib_set_next_frame_buffer (vm, node, next0, pi0);
 217                   break;
 218
 219                 case 2:
 220                   /* A A B */
 221                   to_next -= 1;
 222                   n_left_to_next += 1;
 223                   vlib_set_next_frame_buffer (vm, node, next1, pi1);
 224                   break;
 225
 226                 case 3:
 227                   /* A B C */
 228                   to_next -= 2;
 229                   n_left_to_next += 2;
 230                   vlib_set_next_frame_buffer (vm, node, next0, pi0);
 231                   vlib_set_next_frame_buffer (vm, node, next1, pi1);
 232                   if (next0 == next1)
 233                     {
 234                       /* A B B */
 235                       vlib_put_next_frame (vm, node, next, n_left_to_next);
 236                       next = next1;
 237                       vlib_get_next_frame (vm, node, next, to_next,
 238                                            n_left_to_next);
 239                     }
 240                 }
 241             }
 242         }
 243
 244       while (n_left_from > 0 && n_left_to_next > 0)
 245         {
 246           vlib_buffer_t *p0;
 247           ip6_header_t *ip0;
 248           u32 pi0, lbi0;
 249           ip_lookup_next_t next0;
 250           load_balance_t *lb0;
 251           ip6_address_t *dst_addr0;
 252           u32 fib_index0, flow_hash_config0;
 253           const dpo_id_t *dpo0;
 254
 255           pi0 = from[0];
 256           to_next[0] = pi0;
 257
 258           p0 = vlib_get_buffer (vm, pi0);
 259
 260           ip0 = vlib_buffer_get_current (p0);
 261
 262           dst_addr0 = &ip0->dst_address;
 263
 264           fib_index0 =
 265             vec_elt (im->fib_index_by_sw_if_index,
 266                      vnet_buffer (p0)->sw_if_index[VLIB_RX]);
 267           fib_index0 =
 268             (vnet_buffer (p0)->sw_if_index[VLIB_TX] ==
 269              (u32) ~ 0) ? fib_index0 : vnet_buffer (p0)->sw_if_index[VLIB_TX];
 270
 271           lbi0 = ip6_fib_table_fwding_lookup (im, fib_index0, dst_addr0);
 272
 273           lb0 = load_balance_get (lbi0);
 274           flow_hash_config0 = lb0->lb_hash_config;
 275
 276           vnet_buffer (p0)->ip.flow_hash = 0;
 277           ASSERT (lb0->lb_n_buckets > 0);
 278           ASSERT (is_pow2 (lb0->lb_n_buckets));
 279
 280           if (PREDICT_FALSE (lb0->lb_n_buckets > 1))
 281             {
 282               flow_hash_config0 = lb0->lb_hash_config;
 283               vnet_buffer (p0)->ip.flow_hash =
 284                 ip6_compute_flow_hash (ip0, flow_hash_config0);
 285               dpo0 =
 286                 load_balance_get_fwd_bucket (lb0,
 287                                              (vnet_buffer (p0)->ip.flow_hash &
 288                                               (lb0->lb_n_buckets_minus_1)));
 289             }
 290           else
 291             {
 292               dpo0 = load_balance_get_bucket_i (lb0, 0);
 293             }
 294
 295           dpo0 = load_balance_get_bucket_i (lb0,
 296                                             (vnet_buffer (p0)->ip.flow_hash &
 297                                              lb0->lb_n_buckets_minus_1));
 298           next0 = dpo0->dpoi_next_node;
 299
 300           /* Only process the HBH Option Header if explicitly configured to do so */
 301           if (PREDICT_FALSE
 302               (ip0->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS))
 303             {
 304               next0 = (dpo_is_adj (dpo0) && im->hbh_enabled) ?
 305                 (ip_lookup_next_t) IP6_LOOKUP_NEXT_HOP_BY_HOP : next0;
 306             }
 307           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = dpo0->dpoi_index;
 308
 309           vlib_increment_combined_counter
 310             (cm, thread_index, lbi0, 1, vlib_buffer_length_in_chain (vm, p0));
 311
 312           from += 1;
 313           to_next += 1;
 314           n_left_to_next -= 1;
 315           n_left_from -= 1;
 316
 317           if (PREDICT_FALSE (next0 != next))
 318             {
 319               n_left_to_next += 1;
 320               vlib_put_next_frame (vm, node, next, n_left_to_next);
 321               next = next0;
 322               vlib_get_next_frame (vm, node, next, to_next, n_left_to_next);
 323               to_next[0] = pi0;
 324               to_next += 1;
 325               n_left_to_next -= 1;
 326             }
 327         }
 328
 329       vlib_put_next_frame (vm, node, next, n_left_to_next);
 330     }
 331
 332   if (node->flags & VLIB_NODE_FLAG_TRACE)
 333     ip6_forward_next_trace (vm, node, frame, VLIB_TX);
 334
 335   return frame->n_vectors;
 336 }
 337
 338 static void
 339 ip6_add_interface_routes (vnet_main_t * vnm, u32 sw_if_index,
 340                           ip6_main_t * im, u32 fib_index,
 341                           ip_interface_address_t * a)
 342 {
 343   ip_lookup_main_t *lm = &im->lookup_main;
 344   ip6_address_t *address = ip_interface_address_get_address (lm, a);
 345   fib_prefix_t pfx = {
 346     .fp_len = a->address_length,
 347     .fp_proto = FIB_PROTOCOL_IP6,
 348     .fp_addr.ip6 = *address,
 349   };
 350
 351   if (a->address_length < 128)
 352     {
 353       fib_table_entry_update_one_path (fib_index,
 354                                        &pfx,
 355                                        FIB_SOURCE_INTERFACE,
 356                                        (FIB_ENTRY_FLAG_CONNECTED |
 357                                         FIB_ENTRY_FLAG_ATTACHED),
 358                                        DPO_PROTO_IP6,
 359                                        /* No next-hop address */
 360                                        NULL, sw_if_index,
 361                                        /* invalid FIB index */
 362                                        ~0, 1,
 363                                        /* no label stack */
 364                                        NULL, FIB_ROUTE_PATH_FLAG_NONE);
 365     }
 366
 367   pfx.fp_len = 128;
 368   if (sw_if_index < vec_len (lm->classify_table_index_by_sw_if_index))
 369     {
 370       u32 classify_table_index =
 371         lm->classify_table_index_by_sw_if_index[sw_if_index];
 372       if (classify_table_index != (u32) ~ 0)
 373         {
 374           dpo_id_t dpo = DPO_INVALID;
 375
 376           dpo_set (&dpo,
 377                    DPO_CLASSIFY,
 378                    DPO_PROTO_IP6,
 379                    classify_dpo_create (DPO_PROTO_IP6, classify_table_index));
 380
 381           fib_table_entry_special_dpo_add (fib_index,
 382                                            &pfx,
 383                                            FIB_SOURCE_CLASSIFY,
 384                                            FIB_ENTRY_FLAG_NONE, &dpo);
 385           dpo_reset (&dpo);
 386         }
 387     }
 388
 389   fib_table_entry_update_one_path (fib_index, &pfx,
 390                                    FIB_SOURCE_INTERFACE,
 391                                    (FIB_ENTRY_FLAG_CONNECTED |
 392                                     FIB_ENTRY_FLAG_LOCAL),
 393                                    DPO_PROTO_IP6,
 394                                    &pfx.fp_addr,
 395                                    sw_if_index, ~0,
 396                                    1, NULL, FIB_ROUTE_PATH_FLAG_NONE);
 397 }
 398
 399 static void
 400 ip6_del_interface_routes (ip6_main_t * im,
 401                           u32 fib_index,
 402                           ip6_address_t * address, u32 address_length)
 403 {
 404   fib_prefix_t pfx = {
 405     .fp_len = address_length,
 406     .fp_proto = FIB_PROTOCOL_IP6,
 407     .fp_addr.ip6 = *address,
 408   };
 409
 410   if (pfx.fp_len < 128)
 411     {
 412       fib_table_entry_delete (fib_index, &pfx, FIB_SOURCE_INTERFACE);
 413
 414     }
 415
 416   pfx.fp_len = 128;
 417   fib_table_entry_delete (fib_index, &pfx, FIB_SOURCE_INTERFACE);
 418 }
 419
 420 void
 421 ip6_sw_interface_enable_disable (u32 sw_if_index, u32 is_enable)
 422 {
 423   ip6_main_t *im = &ip6_main;
 424
 425   vec_validate_init_empty (im->ip_enabled_by_sw_if_index, sw_if_index, 0);
 426
 427   /*
 428    * enable/disable only on the 1<->0 transition
 429    */
 430   if (is_enable)
 431     {
 432       if (1 != ++im->ip_enabled_by_sw_if_index[sw_if_index])
 433         return;
 434     }
 435   else
 436     {
 437       /* The ref count is 0 when an address is removed from an interface that has
 438        * no address - this is not a ciritical error */
 439       if (0 == im->ip_enabled_by_sw_if_index[sw_if_index] ||
 440           0 != --im->ip_enabled_by_sw_if_index[sw_if_index])
 441         return;
 442     }
 443
 444   vnet_feature_enable_disable ("ip6-unicast", "ip6-drop", sw_if_index,
 445                                !is_enable, 0, 0);
 446
 447   vnet_feature_enable_disable ("ip6-multicast", "ip6-drop", sw_if_index,
 448                                !is_enable, 0, 0);
 449 }
 450
 451 /* get first interface address */
 452 ip6_address_t *
 453 ip6_interface_first_address (ip6_main_t * im, u32 sw_if_index)
 454 {
 455   ip_lookup_main_t *lm = &im->lookup_main;
 456   ip_interface_address_t *ia = 0;
 457   ip6_address_t *result = 0;
 458
 459   /* *INDENT-OFF* */
 460   foreach_ip_interface_address (lm, ia, sw_if_index,
 461                                 1 /* honor unnumbered */,
 462   ({
 463     ip6_address_t * a = ip_interface_address_get_address (lm, ia);
 464     result = a;
 465     break;
 466   }));
 467   /* *INDENT-ON* */
 468   return result;
 469 }
 470
 471 clib_error_t *
 472 ip6_add_del_interface_address (vlib_main_t * vm,
 473                                u32 sw_if_index,
 474                                ip6_address_t * address,
 475                                u32 address_length, u32 is_del)
 476 {
 477   vnet_main_t *vnm = vnet_get_main ();
 478   ip6_main_t *im = &ip6_main;
 479   ip_lookup_main_t *lm = &im->lookup_main;
 480   clib_error_t *error;
 481   u32 if_address_index;
 482   ip6_address_fib_t ip6_af, *addr_fib = 0;
 483
 484   /* local0 interface doesn't support IP addressing */
 485   if (sw_if_index == 0)
 486     {
 487       return
 488         clib_error_create ("local0 interface doesn't support IP addressing");
 489     }
 490
 491   vec_validate (im->fib_index_by_sw_if_index, sw_if_index);
 492   vec_validate (im->mfib_index_by_sw_if_index, sw_if_index);
 493
 494   ip6_addr_fib_init (&ip6_af, address,
 495                      vec_elt (im->fib_index_by_sw_if_index, sw_if_index));
 496   vec_add1 (addr_fib, ip6_af);
 497
 498   {
 499     uword elts_before = pool_elts (lm->if_address_pool);
 500
 501     error = ip_interface_address_add_del
 502       (lm, sw_if_index, addr_fib, address_length, is_del, &if_address_index);
 503     if (error)
 504       goto done;
 505
 506     /* Pool did not grow: add duplicate address. */
 507     if (elts_before == pool_elts (lm->if_address_pool))
 508       goto done;
 509   }
 510
 511   ip6_sw_interface_enable_disable (sw_if_index, !is_del);
 512
 513   if (is_del)
 514     ip6_del_interface_routes (im, ip6_af.fib_index, address, address_length);
 515   else
 516     ip6_add_interface_routes (vnm, sw_if_index,
 517                               im, ip6_af.fib_index,
 518                               pool_elt_at_index (lm->if_address_pool,
 519                                                  if_address_index));
 520
 521   {
 522     ip6_add_del_interface_address_callback_t *cb;
 523     vec_foreach (cb, im->add_del_interface_address_callbacks)
 524       cb->function (im, cb->function_opaque, sw_if_index,
 525                     address, address_length, if_address_index, is_del);
 526   }
 527
 528 done:
 529   vec_free (addr_fib);
 530   return error;
 531 }
 532
 533 clib_error_t *
 534 ip6_sw_interface_admin_up_down (vnet_main_t * vnm, u32 sw_if_index, u32 flags)
 535 {
 536   ip6_main_t *im = &ip6_main;
 537   ip_interface_address_t *ia;
 538   ip6_address_t *a;
 539   u32 is_admin_up, fib_index;
 540
 541   /* Fill in lookup tables with default table (0). */
 542   vec_validate (im->fib_index_by_sw_if_index, sw_if_index);
 543
 544   vec_validate_init_empty (im->
 545                            lookup_main.if_address_pool_index_by_sw_if_index,
 546                            sw_if_index, ~0);
 547
 548   is_admin_up = (flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) != 0;
 549
 550   fib_index = vec_elt (im->fib_index_by_sw_if_index, sw_if_index);
 551
 552   /* *INDENT-OFF* */
 553   foreach_ip_interface_address (&im->lookup_main, ia, sw_if_index,
 554                                 0 /* honor unnumbered */,
 555   ({
 556     a = ip_interface_address_get_address (&im->lookup_main, ia);
 557     if (is_admin_up)
 558       ip6_add_interface_routes (vnm, sw_if_index,
 559                                 im, fib_index,
 560                                 ia);
 561     else
 562       ip6_del_interface_routes (im, fib_index,
 563                                 a, ia->address_length);
 564   }));
 565   /* *INDENT-ON* */
 566
 567   return 0;
 568 }
 569
 570 VNET_SW_INTERFACE_ADMIN_UP_DOWN_FUNCTION (ip6_sw_interface_admin_up_down);
 571
 572 /* Built-in ip6 unicast rx feature path definition */
 573 /* *INDENT-OFF* */
 574 VNET_FEATURE_ARC_INIT (ip6_unicast, static) =
 575 {
 576   .arc_name  = "ip6-unicast",
 577   .start_nodes = VNET_FEATURES ("ip6-input"),
 578   .arc_index_ptr = &ip6_main.lookup_main.ucast_feature_arc_index,
 579 };
 580
 581 VNET_FEATURE_INIT (ip6_flow_classify, static) =
 582 {
 583   .arc_name = "ip6-unicast",
 584   .node_name = "ip6-flow-classify",
 585   .runs_before = VNET_FEATURES ("ip6-inacl"),
 586 };
 587
 588 VNET_FEATURE_INIT (ip6_inacl, static) =
 589 {
 590   .arc_name = "ip6-unicast",
 591   .node_name = "ip6-inacl",
 592   .runs_before = VNET_FEATURES ("ip6-policer-classify"),
 593 };
 594
 595 VNET_FEATURE_INIT (ip6_policer_classify, static) =
 596 {
 597   .arc_name = "ip6-unicast",
 598   .node_name = "ip6-policer-classify",
 599   .runs_before = VNET_FEATURES ("ipsec-input-ip6"),
 600 };
 601
 602 VNET_FEATURE_INIT (ip6_ipsec, static) =
 603 {
 604   .arc_name = "ip6-unicast",
 605   .node_name = "ipsec-input-ip6",
 606   .runs_before = VNET_FEATURES ("l2tp-decap"),
 607 };
 608
 609 VNET_FEATURE_INIT (ip6_l2tp, static) =
 610 {
 611   .arc_name = "ip6-unicast",
 612   .node_name = "l2tp-decap",
 613   .runs_before = VNET_FEATURES ("vpath-input-ip6"),
 614 };
 615
 616 VNET_FEATURE_INIT (ip6_vpath, static) =
 617 {
 618   .arc_name = "ip6-unicast",
 619   .node_name = "vpath-input-ip6",
 620   .runs_before = VNET_FEATURES ("ip6-vxlan-bypass"),
 621 };
 622
 623 VNET_FEATURE_INIT (ip6_vxlan_bypass, static) =
 624 {
 625   .arc_name = "ip6-unicast",
 626   .node_name = "ip6-vxlan-bypass",
 627   .runs_before = VNET_FEATURES ("ip6-lookup"),
 628 };
 629
 630 VNET_FEATURE_INIT (ip6_drop, static) =
 631 {
 632   .arc_name = "ip6-unicast",
 633   .node_name = "ip6-drop",
 634   .runs_before = VNET_FEATURES ("ip6-lookup"),
 635 };
 636
 637 VNET_FEATURE_INIT (ip6_lookup, static) =
 638 {
 639   .arc_name = "ip6-unicast",
 640   .node_name = "ip6-lookup",
 641   .runs_before = 0,  /*last feature*/
 642 };
 643
 644 /* Built-in ip6 multicast rx feature path definition (none now) */
 645 VNET_FEATURE_ARC_INIT (ip6_multicast, static) =
 646 {
 647   .arc_name  = "ip6-multicast",
 648   .start_nodes = VNET_FEATURES ("ip6-input"),
 649   .arc_index_ptr = &ip6_main.lookup_main.mcast_feature_arc_index,
 650 };
 651
 652 VNET_FEATURE_INIT (ip6_vpath_mc, static) = {
 653   .arc_name = "ip6-multicast",
 654   .node_name = "vpath-input-ip6",
 655   .runs_before = VNET_FEATURES ("ip6-mfib-forward-lookup"),
 656 };
 657
 658 VNET_FEATURE_INIT (ip6_drop_mc, static) = {
 659   .arc_name = "ip6-multicast",
 660   .node_name = "ip6-drop",
 661   .runs_before = VNET_FEATURES ("ip6-mfib-forward-lookup"),
 662 };
 663
 664 VNET_FEATURE_INIT (ip6_mc_lookup, static) = {
 665   .arc_name = "ip6-multicast",
 666   .node_name = "ip6-mfib-forward-lookup",
 667   .runs_before = 0, /* last feature */
 668 };
 669
 670 /* Built-in ip4 tx feature path definition */
 671 VNET_FEATURE_ARC_INIT (ip6_output, static) =
 672 {
 673   .arc_name  = "ip6-output",
 674   .start_nodes = VNET_FEATURES ("ip6-rewrite", "ip6-midchain"),
 675   .arc_index_ptr = &ip6_main.lookup_main.output_feature_arc_index,
 676 };
 677
 678 VNET_FEATURE_INIT (ip6_ipsec_output, static) = {
 679   .arc_name = "ip6-output",
 680   .node_name = "ipsec-output-ip6",
 681   .runs_before = VNET_FEATURES ("interface-output"),
 682 };
 683
 684 VNET_FEATURE_INIT (ip6_interface_output, static) = {
 685   .arc_name = "ip6-output",
 686   .node_name = "interface-output",
 687   .runs_before = 0, /* not before any other features */
 688 };
 689 /* *INDENT-ON* */
 690
 691 clib_error_t *
 692 ip6_sw_interface_add_del (vnet_main_t * vnm, u32 sw_if_index, u32 is_add)
 693 {
 694   ip6_main_t *im = &ip6_main;
 695
 696   vec_validate (im->fib_index_by_sw_if_index, sw_if_index);
 697   vec_validate (im->mfib_index_by_sw_if_index, sw_if_index);
 698
 699   if (!is_add)
 700     {
 701       /* Ensure that IPv6 is disabled */
 702       ip6_main_t *im6 = &ip6_main;
 703       ip_lookup_main_t *lm6 = &im6->lookup_main;
 704       ip_interface_address_t *ia = 0;
 705       ip6_address_t *address;
 706       vlib_main_t *vm = vlib_get_main ();
 707
 708       ip6_neighbor_sw_interface_add_del (vnm, sw_if_index, 0 /* is_add */ );
 709       /* *INDENT-OFF* */
 710       foreach_ip_interface_address (lm6, ia, sw_if_index, 1 /* honor unnumbered */,
 711       ({
 712         address = ip_interface_address_get_address (lm6, ia);
 713         ip6_add_del_interface_address(vm, sw_if_index, address, ia->address_length, 1);
 714       }));
 715       /* *INDENT-ON* */
 716       ip6_mfib_interface_enable_disable (sw_if_index, 0);
 717     }
 718
 719   vnet_feature_enable_disable ("ip6-unicast", "ip6-drop", sw_if_index,
 720                                is_add, 0, 0);
 721
 722   vnet_feature_enable_disable ("ip6-multicast", "ip6-drop", sw_if_index,
 723                                is_add, 0, 0);
 724
 725   return /* no error */ 0;
 726 }
 727
 728 VNET_SW_INTERFACE_ADD_DEL_FUNCTION (ip6_sw_interface_add_del);
 729
 730 static uword
 731 ip6_lookup (vlib_main_t * vm,
 732             vlib_node_runtime_t * node, vlib_frame_t * frame)
 733 {
 734   return ip6_lookup_inline (vm, node, frame);
 735 }
 736
 737 static u8 *format_ip6_lookup_trace (u8 * s, va_list * args);
 738
 739 /* *INDENT-OFF* */
 740 VLIB_REGISTER_NODE (ip6_lookup_node) =
 741 {
 742   .function = ip6_lookup,
 743   .name = "ip6-lookup",
 744   .vector_size = sizeof (u32),
 745   .format_trace = format_ip6_lookup_trace,
 746   .n_next_nodes = IP6_LOOKUP_N_NEXT,
 747   .next_nodes = IP6_LOOKUP_NEXT_NODES,
 748 };
 749 /* *INDENT-ON* */
 750
 751 VLIB_NODE_FUNCTION_MULTIARCH (ip6_lookup_node, ip6_lookup);
 752
 753 always_inline uword
 754 ip6_load_balance (vlib_main_t * vm,
 755                   vlib_node_runtime_t * node, vlib_frame_t * frame)
 756 {
 757   vlib_combined_counter_main_t *cm = &load_balance_main.lbm_via_counters;
 758   u32 n_left_from, n_left_to_next, *from, *to_next;
 759   ip_lookup_next_t next;
 760   u32 thread_index = vlib_get_thread_index ();
 761   ip6_main_t *im = &ip6_main;
 762
 763   from = vlib_frame_vector_args (frame);
 764   n_left_from = frame->n_vectors;
 765   next = node->cached_next_index;
 766
 767   if (node->flags & VLIB_NODE_FLAG_TRACE)
 768     ip6_forward_next_trace (vm, node, frame, VLIB_TX);
 769
 770   while (n_left_from > 0)
 771     {
 772       vlib_get_next_frame (vm, node, next, to_next, n_left_to_next);
 773
 774
 775       while (n_left_from >= 4 && n_left_to_next >= 2)
 776         {
 777           ip_lookup_next_t next0, next1;
 778           const load_balance_t *lb0, *lb1;
 779           vlib_buffer_t *p0, *p1;
 780           u32 pi0, lbi0, hc0, pi1, lbi1, hc1;
 781           const ip6_header_t *ip0, *ip1;
 782           const dpo_id_t *dpo0, *dpo1;
 783
 784           /* Prefetch next iteration. */
 785           {
 786             vlib_buffer_t *p2, *p3;
 787
 788             p2 = vlib_get_buffer (vm, from[2]);
 789             p3 = vlib_get_buffer (vm, from[3]);
 790
 791             vlib_prefetch_buffer_header (p2, STORE);
 792             vlib_prefetch_buffer_header (p3, STORE);
 793
 794             CLIB_PREFETCH (p2->data, sizeof (ip0[0]), STORE);
 795             CLIB_PREFETCH (p3->data, sizeof (ip0[0]), STORE);
 796           }
 797
 798           pi0 = to_next[0] = from[0];
 799           pi1 = to_next[1] = from[1];
 800
 801           from += 2;
 802           n_left_from -= 2;
 803           to_next += 2;
 804           n_left_to_next -= 2;
 805
 806           p0 = vlib_get_buffer (vm, pi0);
 807           p1 = vlib_get_buffer (vm, pi1);
 808
 809           ip0 = vlib_buffer_get_current (p0);
 810           ip1 = vlib_buffer_get_current (p1);
 811           lbi0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
 812           lbi1 = vnet_buffer (p1)->ip.adj_index[VLIB_TX];
 813
 814           lb0 = load_balance_get (lbi0);
 815           lb1 = load_balance_get (lbi1);
 816
 817           /*
 818            * this node is for via FIBs we can re-use the hash value from the
 819            * to node if present.
 820            * We don't want to use the same hash value at each level in the recursion
 821            * graph as that would lead to polarisation
 822            */
 823           hc0 = hc1 = 0;
 824
 825           if (PREDICT_FALSE (lb0->lb_n_buckets > 1))
 826             {
 827               if (PREDICT_TRUE (vnet_buffer (p0)->ip.flow_hash))
 828                 {
 829                   hc0 = vnet_buffer (p0)->ip.flow_hash =
 830                     vnet_buffer (p0)->ip.flow_hash >> 1;
 831                 }
 832               else
 833                 {
 834                   hc0 = vnet_buffer (p0)->ip.flow_hash =
 835                     ip6_compute_flow_hash (ip0, lb0->lb_hash_config);
 836                 }
 837               dpo0 =
 838                 load_balance_get_fwd_bucket (lb0,
 839                                              (hc0 &
 840                                               lb0->lb_n_buckets_minus_1));
 841             }
 842           else
 843             {
 844               dpo0 = load_balance_get_bucket_i (lb0, 0);
 845             }
 846           if (PREDICT_FALSE (lb1->lb_n_buckets > 1))
 847             {
 848               if (PREDICT_TRUE (vnet_buffer (p1)->ip.flow_hash))
 849                 {
 850                   hc1 = vnet_buffer (p1)->ip.flow_hash =
 851                     vnet_buffer (p1)->ip.flow_hash >> 1;
 852                 }
 853               else
 854                 {
 855                   hc1 = vnet_buffer (p1)->ip.flow_hash =
 856                     ip6_compute_flow_hash (ip1, lb1->lb_hash_config);
 857                 }
 858               dpo1 =
 859                 load_balance_get_fwd_bucket (lb1,
 860                                              (hc1 &
 861                                               lb1->lb_n_buckets_minus_1));
 862             }
 863           else
 864             {
 865               dpo1 = load_balance_get_bucket_i (lb1, 0);
 866             }
 867
 868           next0 = dpo0->dpoi_next_node;
 869           next1 = dpo1->dpoi_next_node;
 870
 871           /* Only process the HBH Option Header if explicitly configured to do so */
 872           if (PREDICT_FALSE
 873               (ip0->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS))
 874             {
 875               next0 = (dpo_is_adj (dpo0) && im->hbh_enabled) ?
 876                 (ip_lookup_next_t) IP6_LOOKUP_NEXT_HOP_BY_HOP : next0;
 877             }
 878           /* Only process the HBH Option Header if explicitly configured to do so */
 879           if (PREDICT_FALSE
 880               (ip1->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS))
 881             {
 882               next1 = (dpo_is_adj (dpo1) && im->hbh_enabled) ?
 883                 (ip_lookup_next_t) IP6_LOOKUP_NEXT_HOP_BY_HOP : next1;
 884             }
 885
 886           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = dpo0->dpoi_index;
 887           vnet_buffer (p1)->ip.adj_index[VLIB_TX] = dpo1->dpoi_index;
 888
 889           vlib_increment_combined_counter
 890             (cm, thread_index, lbi0, 1, vlib_buffer_length_in_chain (vm, p0));
 891           vlib_increment_combined_counter
 892             (cm, thread_index, lbi1, 1, vlib_buffer_length_in_chain (vm, p1));
 893
 894           vlib_validate_buffer_enqueue_x2 (vm, node, next,
 895                                            to_next, n_left_to_next,
 896                                            pi0, pi1, next0, next1);
 897         }
 898
 899       while (n_left_from > 0 && n_left_to_next > 0)
 900         {
 901           ip_lookup_next_t next0;
 902           const load_balance_t *lb0;
 903           vlib_buffer_t *p0;
 904           u32 pi0, lbi0, hc0;
 905           const ip6_header_t *ip0;
 906           const dpo_id_t *dpo0;
 907
 908           pi0 = from[0];
 909           to_next[0] = pi0;
 910           from += 1;
 911           to_next += 1;
 912           n_left_to_next -= 1;
 913           n_left_from -= 1;
 914
 915           p0 = vlib_get_buffer (vm, pi0);
 916
 917           ip0 = vlib_buffer_get_current (p0);
 918           lbi0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
 919
 920           lb0 = load_balance_get (lbi0);
 921
 922           hc0 = 0;
 923           if (PREDICT_FALSE (lb0->lb_n_buckets > 1))
 924             {
 925               if (PREDICT_TRUE (vnet_buffer (p0)->ip.flow_hash))
 926                 {
 927                   hc0 = vnet_buffer (p0)->ip.flow_hash =
 928                     vnet_buffer (p0)->ip.flow_hash >> 1;
 929                 }
 930               else
 931                 {
 932                   hc0 = vnet_buffer (p0)->ip.flow_hash =
 933                     ip6_compute_flow_hash (ip0, lb0->lb_hash_config);
 934                 }
 935               dpo0 =
 936                 load_balance_get_fwd_bucket (lb0,
 937                                              (hc0 &
 938                                               lb0->lb_n_buckets_minus_1));
 939             }
 940           else
 941             {
 942               dpo0 = load_balance_get_bucket_i (lb0, 0);
 943             }
 944
 945           next0 = dpo0->dpoi_next_node;
 946           vnet_buffer (p0)->ip.adj_index[VLIB_TX] = dpo0->dpoi_index;
 947
 948           /* Only process the HBH Option Header if explicitly configured to do so */
 949           if (PREDICT_FALSE
 950               (ip0->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS))
 951             {
 952               next0 = (dpo_is_adj (dpo0) && im->hbh_enabled) ?
 953                 (ip_lookup_next_t) IP6_LOOKUP_NEXT_HOP_BY_HOP : next0;
 954             }
 955
 956           vlib_increment_combined_counter
 957             (cm, thread_index, lbi0, 1, vlib_buffer_length_in_chain (vm, p0));
 958
 959           vlib_validate_buffer_enqueue_x1 (vm, node, next,
 960                                            to_next, n_left_to_next,
 961                                            pi0, next0);
 962         }
 963
 964       vlib_put_next_frame (vm, node, next, n_left_to_next);
 965     }
 966
 967   return frame->n_vectors;
 968 }
 969
 970 /* *INDENT-OFF* */
 971 VLIB_REGISTER_NODE (ip6_load_balance_node) =
 972 {
 973   .function = ip6_load_balance,
 974   .name = "ip6-load-balance",
 975   .vector_size = sizeof (u32),
 976   .sibling_of = "ip6-lookup",
 977   .format_trace = format_ip6_lookup_trace,
 978 };
 979 /* *INDENT-ON* */
 980
 981 VLIB_NODE_FUNCTION_MULTIARCH (ip6_load_balance_node, ip6_load_balance);
 982
 983 typedef struct
 984 {
 985   /* Adjacency taken. */
 986   u32 adj_index;
 987   u32 flow_hash;
 988   u32 fib_index;
 989
 990   /* Packet data, possibly *after* rewrite. */
 991   u8 packet_data[128 - 1 * sizeof (u32)];
 992 }
 993 ip6_forward_next_trace_t;
 994
 995 u8 *
 996 format_ip6_forward_next_trace (u8 * s, va_list * args)
 997 {
 998   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
 999   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
1000   ip6_forward_next_trace_t *t = va_arg (*args, ip6_forward_next_trace_t *);
1001   uword indent = format_get_indent (s);
1002
1003   s = format (s, "%U%U",
1004               format_white_space, indent,
1005               format_ip6_header, t->packet_data, sizeof (t->packet_data));
1006   return s;
1007 }
1008
1009 static u8 *
1010 format_ip6_lookup_trace (u8 * s, va_list * args)
1011 {
1012   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
1013   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
1014   ip6_forward_next_trace_t *t = va_arg (*args, ip6_forward_next_trace_t *);
1015   uword indent = format_get_indent (s);
1016
1017   s = format (s, "fib %d dpo-idx %d flow hash: 0x%08x",
1018               t->fib_index, t->adj_index, t->flow_hash);
1019   s = format (s, "\n%U%U",
1020               format_white_space, indent,
1021               format_ip6_header, t->packet_data, sizeof (t->packet_data));
1022   return s;
1023 }
1024
1025
1026 static u8 *
1027 format_ip6_rewrite_trace (u8 * s, va_list * args)
1028 {
1029   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
1030   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
1031   ip6_forward_next_trace_t *t = va_arg (*args, ip6_forward_next_trace_t *);
1032   uword indent = format_get_indent (s);
1033
1034   s = format (s, "tx_sw_if_index %d adj-idx %d : %U flow hash: 0x%08x",
1035               t->fib_index, t->adj_index, format_ip_adjacency,
1036               t->adj_index, FORMAT_IP_ADJACENCY_NONE, t->flow_hash);
1037   s = format (s, "\n%U%U",
1038               format_white_space, indent,
1039               format_ip_adjacency_packet_data,
1040               t->adj_index, t->packet_data, sizeof (t->packet_data));
1041   return s;
1042 }
1043
1044 /* Common trace function for all ip6-forward next nodes. */
1045 void
1046 ip6_forward_next_trace (vlib_main_t * vm,
1047                         vlib_node_runtime_t * node,
1048                         vlib_frame_t * frame, vlib_rx_or_tx_t which_adj_index)
1049 {
1050   u32 *from, n_left;
1051   ip6_main_t *im = &ip6_main;
1052
1053   n_left = frame->n_vectors;
1054   from = vlib_frame_vector_args (frame);
1055
1056   while (n_left >= 4)
1057     {
1058       u32 bi0, bi1;
1059       vlib_buffer_t *b0, *b1;
1060       ip6_forward_next_trace_t *t0, *t1;
1061
1062       /* Prefetch next iteration. */
1063       vlib_prefetch_buffer_with_index (vm, from[2], LOAD);
1064       vlib_prefetch_buffer_with_index (vm, from[3], LOAD);
1065
1066       bi0 = from[0];
1067       bi1 = from[1];
1068
1069       b0 = vlib_get_buffer (vm, bi0);
1070       b1 = vlib_get_buffer (vm, bi1);
1071
1072       if (b0->flags & VLIB_BUFFER_IS_TRACED)
1073         {
1074           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
1075           t0->adj_index = vnet_buffer (b0)->ip.adj_index[which_adj_index];
1076           t0->flow_hash = vnet_buffer (b0)->ip.flow_hash;
1077           t0->fib_index =
1078             (vnet_buffer (b0)->sw_if_index[VLIB_TX] !=
1079              (u32) ~ 0) ? vnet_buffer (b0)->sw_if_index[VLIB_TX] :
1080             vec_elt (im->fib_index_by_sw_if_index,
1081                      vnet_buffer (b0)->sw_if_index[VLIB_RX]);
1082
1083           clib_memcpy (t0->packet_data,
1084                        vlib_buffer_get_current (b0),
1085                        sizeof (t0->packet_data));
1086         }
1087       if (b1->flags & VLIB_BUFFER_IS_TRACED)
1088         {
1089           t1 = vlib_add_trace (vm, node, b1, sizeof (t1[0]));
1090           t1->adj_index = vnet_buffer (b1)->ip.adj_index[which_adj_index];
1091           t1->flow_hash = vnet_buffer (b1)->ip.flow_hash;
1092           t1->fib_index =
1093             (vnet_buffer (b1)->sw_if_index[VLIB_TX] !=
1094              (u32) ~ 0) ? vnet_buffer (b1)->sw_if_index[VLIB_TX] :
1095             vec_elt (im->fib_index_by_sw_if_index,
1096                      vnet_buffer (b1)->sw_if_index[VLIB_RX]);
1097
1098           clib_memcpy (t1->packet_data,
1099                        vlib_buffer_get_current (b1),
1100                        sizeof (t1->packet_data));
1101         }
1102       from += 2;
1103       n_left -= 2;
1104     }
1105
1106   while (n_left >= 1)
1107     {
1108       u32 bi0;
1109       vlib_buffer_t *b0;
1110       ip6_forward_next_trace_t *t0;
1111
1112       bi0 = from[0];
1113
1114       b0 = vlib_get_buffer (vm, bi0);
1115
1116       if (b0->flags & VLIB_BUFFER_IS_TRACED)
1117         {
1118           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
1119           t0->adj_index = vnet_buffer (b0)->ip.adj_index[which_adj_index];
1120           t0->flow_hash = vnet_buffer (b0)->ip.flow_hash;
1121           t0->fib_index =
1122             (vnet_buffer (b0)->sw_if_index[VLIB_TX] !=
1123              (u32) ~ 0) ? vnet_buffer (b0)->sw_if_index[VLIB_TX] :
1124             vec_elt (im->fib_index_by_sw_if_index,
1125                      vnet_buffer (b0)->sw_if_index[VLIB_RX]);
1126
1127           clib_memcpy (t0->packet_data,
1128                        vlib_buffer_get_current (b0),
1129                        sizeof (t0->packet_data));
1130         }
1131       from += 1;
1132       n_left -= 1;
1133     }
1134 }
1135
1136 static uword
1137 ip6_drop_or_punt (vlib_main_t * vm,
1138                   vlib_node_runtime_t * node,
1139                   vlib_frame_t * frame, ip6_error_t error_code)
1140 {
1141   u32 *buffers = vlib_frame_vector_args (frame);
1142   uword n_packets = frame->n_vectors;
1143
1144   vlib_error_drop_buffers (vm, node, buffers,
1145                            /* stride */ 1,
1146                            n_packets,
1147                            /* next */ 0,
1148                            ip6_input_node.index, error_code);
1149
1150   if (node->flags & VLIB_NODE_FLAG_TRACE)
1151     ip6_forward_next_trace (vm, node, frame, VLIB_TX);
1152
1153   return n_packets;
1154 }
1155
1156 static uword
1157 ip6_drop (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame)
1158 {
1159   return ip6_drop_or_punt (vm, node, frame, IP6_ERROR_ADJACENCY_DROP);
1160 }
1161
1162 static uword
1163 ip6_punt (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame)
1164 {
1165   return ip6_drop_or_punt (vm, node, frame, IP6_ERROR_ADJACENCY_PUNT);
1166 }
1167
1168 /* *INDENT-OFF* */
1169 VLIB_REGISTER_NODE (ip6_drop_node, static) =
1170 {
1171   .function = ip6_drop,
1172   .name = "ip6-drop",
1173   .vector_size = sizeof (u32),
1174   .format_trace = format_ip6_forward_next_trace,
1175   .n_next_nodes = 1,
1176   .next_nodes =
1177   {
1178     [0] = "error-drop",},
1179 };
1180 /* *INDENT-ON* */
1181
1182 VLIB_NODE_FUNCTION_MULTIARCH (ip6_drop_node, ip6_drop);
1183
1184 /* *INDENT-OFF* */
1185 VLIB_REGISTER_NODE (ip6_punt_node, static) =
1186 {
1187   .function = ip6_punt,
1188   .name = "ip6-punt",
1189   .vector_size = sizeof (u32),
1190   .format_trace = format_ip6_forward_next_trace,
1191   .n_next_nodes = 1,
1192   .next_nodes =
1193   {
1194     [0] = "error-punt",},
1195 };
1196 /* *INDENT-ON* */
1197
1198 VLIB_NODE_FUNCTION_MULTIARCH (ip6_punt_node, ip6_punt);
1199
1200 /* Compute TCP/UDP/ICMP6 checksum in software. */
1201 u16
1202 ip6_tcp_udp_icmp_compute_checksum (vlib_main_t * vm, vlib_buffer_t * p0,
1203                                    ip6_header_t * ip0, int *bogus_lengthp)
1204 {
1205   ip_csum_t sum0;
1206   u16 sum16, payload_length_host_byte_order;
1207   u32 i, n_this_buffer, n_bytes_left;
1208   u32 headers_size = sizeof (ip0[0]);
1209   void *data_this_buffer;
1210
1211   ASSERT (bogus_lengthp);
1212   *bogus_lengthp = 0;
1213
1214   /* Initialize checksum with ip header. */
1215   sum0 = ip0->payload_length + clib_host_to_net_u16 (ip0->protocol);
1216   payload_length_host_byte_order = clib_net_to_host_u16 (ip0->payload_length);
1217   data_this_buffer = (void *) (ip0 + 1);
1218
1219   for (i = 0; i < ARRAY_LEN (ip0->src_address.as_uword); i++)
1220     {
1221       sum0 = ip_csum_with_carry (sum0,
1222                                  clib_mem_unaligned (&ip0->
1223                                                      src_address.as_uword[i],
1224                                                      uword));
1225       sum0 =
1226         ip_csum_with_carry (sum0,
1227                             clib_mem_unaligned (&ip0->dst_address.as_uword[i],
1228                                                 uword));
1229     }
1230
1231   /* some icmp packets may come with a "router alert" hop-by-hop extension header (e.g., mldv2 packets)
1232    * or UDP-Ping packets */
1233   if (PREDICT_FALSE (ip0->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS))
1234     {
1235       u32 skip_bytes;
1236       ip6_hop_by_hop_ext_t *ext_hdr =
1237         (ip6_hop_by_hop_ext_t *) data_this_buffer;
1238
1239       /* validate really icmp6 next */
1240       ASSERT ((ext_hdr->next_hdr == IP_PROTOCOL_ICMP6)
1241               || (ext_hdr->next_hdr == IP_PROTOCOL_UDP));
1242
1243       skip_bytes = 8 * (1 + ext_hdr->n_data_u64s);
1244       data_this_buffer = (void *) ((u8 *) data_this_buffer + skip_bytes);
1245
1246       payload_length_host_byte_order -= skip_bytes;
1247       headers_size += skip_bytes;
1248     }
1249
1250   n_bytes_left = n_this_buffer = payload_length_host_byte_order;
1251   if (p0 && n_this_buffer + headers_size > p0->current_length)
1252     n_this_buffer =
1253       p0->current_length >
1254       headers_size ? p0->current_length - headers_size : 0;
1255   while (1)
1256     {
1257       sum0 = ip_incremental_checksum (sum0, data_this_buffer, n_this_buffer);
1258       n_bytes_left -= n_this_buffer;
1259       if (n_bytes_left == 0)
1260         break;
1261
1262       if (!(p0->flags & VLIB_BUFFER_NEXT_PRESENT))
1263         {
1264           *bogus_lengthp = 1;
1265           return 0xfefe;
1266         }
1267       p0 = vlib_get_buffer (vm, p0->next_buffer);
1268       data_this_buffer = vlib_buffer_get_current (p0);
1269       n_this_buffer = p0->current_length;
1270     }
1271
1272   sum16 = ~ip_csum_fold (sum0);
1273
1274   return sum16;
1275 }
1276
1277 u32
1278 ip6_tcp_udp_icmp_validate_checksum (vlib_main_t * vm, vlib_buffer_t * p0)
1279 {
1280   ip6_header_t *ip0 = vlib_buffer_get_current (p0);
1281   udp_header_t *udp0;
1282   u16 sum16;
1283   int bogus_length;
1284
1285   /* some icmp packets may come with a "router alert" hop-by-hop extension header (e.g., mldv2 packets) */
1286   ASSERT (ip0->protocol == IP_PROTOCOL_TCP
1287           || ip0->protocol == IP_PROTOCOL_ICMP6
1288           || ip0->protocol == IP_PROTOCOL_UDP
1289           || ip0->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS);
1290
1291   udp0 = (void *) (ip0 + 1);
1292   if (ip0->protocol == IP_PROTOCOL_UDP && udp0->checksum == 0)
1293     {
1294       p0->flags |= (VNET_BUFFER_F_L4_CHECKSUM_COMPUTED
1295                     | VNET_BUFFER_F_L4_CHECKSUM_CORRECT);
1296       return p0->flags;
1297     }
1298
1299   sum16 = ip6_tcp_udp_icmp_compute_checksum (vm, p0, ip0, &bogus_length);
1300
1301   p0->flags |= (VNET_BUFFER_F_L4_CHECKSUM_COMPUTED
1302                 | ((sum16 == 0) << VNET_BUFFER_F_LOG2_L4_CHECKSUM_CORRECT));
1303
1304   return p0->flags;
1305 }
1306
1307 /**
1308  * @brief returns number of links on which src is reachable.
1309  */
1310 always_inline int
1311 ip6_urpf_loose_check (ip6_main_t * im, vlib_buffer_t * b, ip6_header_t * i)
1312 {
1313   const load_balance_t *lb0;
1314   index_t lbi;
1315
1316   lbi = ip6_fib_table_fwding_lookup_with_if_index (im,
1317                                                    vnet_buffer
1318                                                    (b)->sw_if_index[VLIB_RX],
1319                                                    &i->src_address);
1320
1321   lb0 = load_balance_get (lbi);
1322
1323   return (fib_urpf_check_size (lb0->lb_urpf));
1324 }
1325
1326 always_inline u8
1327 ip6_next_proto_is_tcp_udp (vlib_buffer_t * p0, ip6_header_t * ip0,
1328                            u32 * udp_offset0)
1329 {
1330   u32 proto0;
1331   proto0 = ip6_locate_header (p0, ip0, IP_PROTOCOL_UDP, udp_offset0);
1332   if (proto0 != IP_PROTOCOL_UDP)
1333     {
1334       proto0 = ip6_locate_header (p0, ip0, IP_PROTOCOL_TCP, udp_offset0);
1335       proto0 = (proto0 == IP_PROTOCOL_TCP) ? proto0 : 0;
1336     }
1337   return proto0;
1338 }
1339
1340 /* *INDENT-OFF* */
1341 VNET_FEATURE_ARC_INIT (ip6_local) =
1342 {
1343   .arc_name  = "ip6-local",
1344   .start_nodes = VNET_FEATURES ("ip6-local"),
1345 };
1346 /* *INDENT-ON* */
1347
1348 static uword
1349 ip6_local_inline (vlib_main_t * vm, vlib_node_runtime_t * node,
1350                   vlib_frame_t * frame, int head_of_feature_arc)
1351 {
1352   ip6_main_t *im = &ip6_main;
1353   ip_lookup_main_t *lm = &im->lookup_main;
1354   ip_local_next_t next_index;
1355   u32 *from, *to_next, n_left_from, n_left_to_next;
1356   vlib_node_runtime_t *error_node =
1357     vlib_node_get_runtime (vm, ip6_input_node.index);
1358   u8 arc_index = vnet_feat_arc_ip6_local.feature_arc_index;
1359
1360   from = vlib_frame_vector_args (frame);
1361   n_left_from = frame->n_vectors;
1362   next_index = node->cached_next_index;
1363
1364   if (node->flags & VLIB_NODE_FLAG_TRACE)
1365     ip6_forward_next_trace (vm, node, frame, VLIB_TX);
1366
1367   while (n_left_from > 0)
1368     {
1369       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
1370
1371       while (n_left_from >= 4 && n_left_to_next >= 2)
1372         {
1373           vlib_buffer_t *p0, *p1;
1374           ip6_header_t *ip0, *ip1;
1375           udp_header_t *udp0, *udp1;
1376           u32 pi0, ip_len0, udp_len0, flags0, next0;
1377           u32 pi1, ip_len1, udp_len1, flags1, next1;
1378           i32 len_diff0, len_diff1;
1379           u8 error0, type0, good_l4_csum0, is_tcp_udp0;
1380           u8 error1, type1, good_l4_csum1, is_tcp_udp1;
1381           u32 udp_offset0, udp_offset1;
1382
1383           pi0 = to_next[0] = from[0];
1384           pi1 = to_next[1] = from[1];
1385           from += 2;
1386           n_left_from -= 2;
1387           to_next += 2;
1388           n_left_to_next -= 2;
1389
1390           error0 = error1 = IP6_ERROR_UNKNOWN_PROTOCOL;
1391
1392           p0 = vlib_get_buffer (vm, pi0);
1393           p1 = vlib_get_buffer (vm, pi1);
1394
1395           ip0 = vlib_buffer_get_current (p0);
1396           ip1 = vlib_buffer_get_current (p1);
1397
1398           if (head_of_feature_arc == 0)
1399             goto skip_checks;
1400
1401           vnet_buffer (p0)->l3_hdr_offset = p0->current_data;
1402           vnet_buffer (p1)->l3_hdr_offset = p1->current_data;
1403
1404           type0 = lm->builtin_protocol_by_ip_protocol[ip0->protocol];
1405           type1 = lm->builtin_protocol_by_ip_protocol[ip1->protocol];
1406
1407           flags0 = p0->flags;
1408           flags1 = p1->flags;
1409
1410           is_tcp_udp0 = ip6_next_proto_is_tcp_udp (p0, ip0, &udp_offset0);
1411           is_tcp_udp1 = ip6_next_proto_is_tcp_udp (p1, ip1, &udp_offset1);
1412
1413           good_l4_csum0 = (flags0 & VNET_BUFFER_F_L4_CHECKSUM_CORRECT) != 0;
1414           good_l4_csum1 = (flags1 & VNET_BUFFER_F_L4_CHECKSUM_CORRECT) != 0;
1415           len_diff0 = 0;
1416           len_diff1 = 0;
1417
1418           if (PREDICT_TRUE (is_tcp_udp0))
1419             {
1420               udp0 = (udp_header_t *) ((u8 *) ip0 + udp_offset0);
1421               /* Don't verify UDP checksum for packets with explicit zero checksum. */
1422               good_l4_csum0 |= type0 == IP_BUILTIN_PROTOCOL_UDP
1423                 && udp0->checksum == 0;
1424               /* Verify UDP length. */
1425               if (is_tcp_udp0 == IP_PROTOCOL_UDP)
1426                 {
1427                   ip_len0 = clib_net_to_host_u16 (ip0->payload_length);
1428                   udp_len0 = clib_net_to_host_u16 (udp0->length);
1429                   len_diff0 = ip_len0 - udp_len0;
1430                 }
1431             }
1432           if (PREDICT_TRUE (is_tcp_udp1))
1433             {
1434               udp1 = (udp_header_t *) ((u8 *) ip1 + udp_offset1);
1435               /* Don't verify UDP checksum for packets with explicit zero checksum. */
1436               good_l4_csum1 |= type1 == IP_BUILTIN_PROTOCOL_UDP
1437                 && udp1->checksum == 0;
1438               /* Verify UDP length. */
1439               if (is_tcp_udp1 == IP_PROTOCOL_UDP)
1440                 {
1441                   ip_len1 = clib_net_to_host_u16 (ip1->payload_length);
1442                   udp_len1 = clib_net_to_host_u16 (udp1->length);
1443                   len_diff1 = ip_len1 - udp_len1;
1444                 }
1445             }
1446
1447           good_l4_csum0 |= type0 == IP_BUILTIN_PROTOCOL_UNKNOWN;
1448           good_l4_csum1 |= type1 == IP_BUILTIN_PROTOCOL_UNKNOWN;
1449
1450           len_diff0 = type0 == IP_BUILTIN_PROTOCOL_UDP ? len_diff0 : 0;
1451           len_diff1 = type1 == IP_BUILTIN_PROTOCOL_UDP ? len_diff1 : 0;
1452
1453           if (PREDICT_FALSE (type0 != IP_BUILTIN_PROTOCOL_UNKNOWN
1454                              && !good_l4_csum0
1455                              && !(flags0 &
1456                                   VNET_BUFFER_F_L4_CHECKSUM_COMPUTED)))
1457             {
1458               flags0 = ip6_tcp_udp_icmp_validate_checksum (vm, p0);
1459               good_l4_csum0 =
1460                 (flags0 & VNET_BUFFER_F_L4_CHECKSUM_CORRECT) != 0;
1461             }
1462           if (PREDICT_FALSE (type1 != IP_BUILTIN_PROTOCOL_UNKNOWN
1463                              && !good_l4_csum1
1464                              && !(flags1 &
1465                                   VNET_BUFFER_F_L4_CHECKSUM_COMPUTED)))
1466             {
1467               flags1 = ip6_tcp_udp_icmp_validate_checksum (vm, p1);
1468               good_l4_csum1 =
1469                 (flags1 & VNET_BUFFER_F_L4_CHECKSUM_CORRECT) != 0;
1470             }
1471
1472           error0 = error1 = IP6_ERROR_UNKNOWN_PROTOCOL;
1473           error0 = len_diff0 < 0 ? IP6_ERROR_UDP_LENGTH : error0;
1474           error1 = len_diff1 < 0 ? IP6_ERROR_UDP_LENGTH : error1;
1475
1476           ASSERT (IP6_ERROR_UDP_CHECKSUM + IP_BUILTIN_PROTOCOL_UDP ==
1477                   IP6_ERROR_UDP_CHECKSUM);
1478           ASSERT (IP6_ERROR_UDP_CHECKSUM + IP_BUILTIN_PROTOCOL_ICMP ==
1479                   IP6_ERROR_ICMP_CHECKSUM);
1480           error0 = (!good_l4_csum0 ? IP6_ERROR_UDP_CHECKSUM + type0 : error0);
1481           error1 = (!good_l4_csum1 ? IP6_ERROR_UDP_CHECKSUM + type1 : error1);
1482
1483           /* Drop packets from unroutable hosts. */
1484           /* If this is a neighbor solicitation (ICMP), skip source RPF check */
1485           if (error0 == IP6_ERROR_UNKNOWN_PROTOCOL &&
1486               type0 != IP_BUILTIN_PROTOCOL_ICMP &&
1487               !ip6_address_is_link_local_unicast (&ip0->src_address))
1488             {
1489               error0 = (!ip6_urpf_loose_check (im, p0, ip0)
1490                         ? IP6_ERROR_SRC_LOOKUP_MISS : error0);
1491             }
1492           if (error1 == IP6_ERROR_UNKNOWN_PROTOCOL &&
1493               type1 != IP_BUILTIN_PROTOCOL_ICMP &&
1494               !ip6_address_is_link_local_unicast (&ip1->src_address))
1495             {
1496               error1 = (!ip6_urpf_loose_check (im, p1, ip1)
1497                         ? IP6_ERROR_SRC_LOOKUP_MISS : error1);
1498             }
1499
1500         skip_checks:
1501
1502           next0 = lm->local_next_by_ip_protocol[ip0->protocol];
1503           next1 = lm->local_next_by_ip_protocol[ip1->protocol];
1504
1505           next0 =
1506             error0 != IP6_ERROR_UNKNOWN_PROTOCOL ? IP_LOCAL_NEXT_DROP : next0;
1507           next1 =
1508             error1 != IP6_ERROR_UNKNOWN_PROTOCOL ? IP_LOCAL_NEXT_DROP : next1;
1509
1510           p0->error = error_node->errors[error0];
1511           p1->error = error_node->errors[error1];
1512
1513           if (head_of_feature_arc)
1514             {
1515               if (PREDICT_TRUE (error0 == (u8) IP6_ERROR_UNKNOWN_PROTOCOL))
1516                 vnet_feature_arc_start (arc_index,
1517                                         vnet_buffer (p0)->sw_if_index
1518                                         [VLIB_RX], &next0, p0);
1519               if (PREDICT_TRUE (error1 == (u8) IP6_ERROR_UNKNOWN_PROTOCOL))
1520                 vnet_feature_arc_start (arc_index,
1521                                         vnet_buffer (p1)->sw_if_index
1522                                         [VLIB_RX], &next1, p1);
1523             }
1524
1525           vlib_validate_buffer_enqueue_x2 (vm, node, next_index,
1526                                            to_next, n_left_to_next,
1527                                            pi0, pi1, next0, next1);
1528         }
1529
1530       while (n_left_from > 0 && n_left_to_next > 0)
1531         {
1532           vlib_buffer_t *p0;
1533           ip6_header_t *ip0;
1534           udp_header_t *udp0;
1535           u32 pi0, ip_len0, udp_len0, flags0, next0;
1536           i32 len_diff0;
1537           u8 error0, type0, good_l4_csum0;
1538           u32 udp_offset0;
1539           u8 is_tcp_udp0;
1540
1541           pi0 = to_next[0] = from[0];
1542           from += 1;
1543           n_left_from -= 1;
1544           to_next += 1;
1545           n_left_to_next -= 1;
1546
1547           error0 = IP6_ERROR_UNKNOWN_PROTOCOL;
1548
1549           p0 = vlib_get_buffer (vm, pi0);
1550           ip0 = vlib_buffer_get_current (p0);
1551
1552           if (head_of_feature_arc == 0)
1553             goto skip_check;
1554
1555           vnet_buffer (p0)->l3_hdr_offset = p0->current_data;
1556
1557           type0 = lm->builtin_protocol_by_ip_protocol[ip0->protocol];
1558           flags0 = p0->flags;
1559           is_tcp_udp0 = ip6_next_proto_is_tcp_udp (p0, ip0, &udp_offset0);
1560           good_l4_csum0 = (flags0 & VNET_BUFFER_F_L4_CHECKSUM_CORRECT) != 0;
1561
1562           len_diff0 = 0;
1563           if (PREDICT_TRUE (is_tcp_udp0))
1564             {
1565               udp0 = (udp_header_t *) ((u8 *) ip0 + udp_offset0);
1566               /* Don't verify UDP checksum for packets with explicit zero
1567                * checksum. */
1568               good_l4_csum0 |= type0 == IP_BUILTIN_PROTOCOL_UDP
1569                 && udp0->checksum == 0;
1570               /* Verify UDP length. */
1571               if (is_tcp_udp0 == IP_PROTOCOL_UDP)
1572                 {
1573                   ip_len0 = clib_net_to_host_u16 (ip0->payload_length);
1574                   udp_len0 = clib_net_to_host_u16 (udp0->length);
1575                   len_diff0 = ip_len0 - udp_len0;
1576                 }
1577             }
1578
1579           good_l4_csum0 |= type0 == IP_BUILTIN_PROTOCOL_UNKNOWN;
1580           len_diff0 = type0 == IP_BUILTIN_PROTOCOL_UDP ? len_diff0 : 0;
1581
1582           if (PREDICT_FALSE (type0 != IP_BUILTIN_PROTOCOL_UNKNOWN
1583                              && !good_l4_csum0
1584                              && !(flags0 &
1585                                   VNET_BUFFER_F_L4_CHECKSUM_COMPUTED)))
1586             {
1587               flags0 = ip6_tcp_udp_icmp_validate_checksum (vm, p0);
1588               good_l4_csum0 =
1589                 (flags0 & VNET_BUFFER_F_L4_CHECKSUM_CORRECT) != 0;
1590             }
1591
1592           error0 = IP6_ERROR_UNKNOWN_PROTOCOL;
1593           error0 = len_diff0 < 0 ? IP6_ERROR_UDP_LENGTH : error0;
1594
1595           ASSERT (IP6_ERROR_UDP_CHECKSUM + IP_BUILTIN_PROTOCOL_UDP ==
1596                   IP6_ERROR_UDP_CHECKSUM);
1597           ASSERT (IP6_ERROR_UDP_CHECKSUM + IP_BUILTIN_PROTOCOL_ICMP ==
1598                   IP6_ERROR_ICMP_CHECKSUM);
1599           error0 = (!good_l4_csum0 ? IP6_ERROR_UDP_CHECKSUM + type0 : error0);
1600
1601           /* If this is a neighbor solicitation (ICMP), skip src RPF check */
1602           if (error0 == IP6_ERROR_UNKNOWN_PROTOCOL &&
1603               type0 != IP_BUILTIN_PROTOCOL_ICMP &&
1604               !ip6_address_is_link_local_unicast (&ip0->src_address))
1605             {
1606               error0 = (!ip6_urpf_loose_check (im, p0, ip0)
1607                         ? IP6_ERROR_SRC_LOOKUP_MISS : error0);
1608             }
1609
1610         skip_check:
1611
1612           next0 = lm->local_next_by_ip_protocol[ip0->protocol];
1613           next0 =
1614             error0 != IP6_ERROR_UNKNOWN_PROTOCOL ? IP_LOCAL_NEXT_DROP : next0;
1615           p0->error = error_node->errors[error0];
1616
1617           if (head_of_feature_arc)
1618             {
1619               if (PREDICT_TRUE (error0 == (u8) IP6_ERROR_UNKNOWN_PROTOCOL))
1620                 vnet_feature_arc_start (arc_index,
1621                                         vnet_buffer (p0)->sw_if_index
1622                                         [VLIB_RX], &next0, p0);
1623             }
1624
1625           vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
1626                                            to_next, n_left_to_next,
1627                                            pi0, next0);
1628         }
1629
1630       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
1631     }
1632
1633   return frame->n_vectors;
1634 }
1635
1636 static uword
1637 ip6_local (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame)
1638 {
1639   return ip6_local_inline (vm, node, frame, 1 /* head of feature arc */ );
1640 }
1641
1642 /* *INDENT-OFF* */
1643 VLIB_REGISTER_NODE (ip6_local_node, static) =
1644 {
1645   .function = ip6_local,
1646   .name = "ip6-local",
1647   .vector_size = sizeof (u32),
1648   .format_trace = format_ip6_forward_next_trace,
1649   .n_next_nodes = IP_LOCAL_N_NEXT,
1650   .next_nodes =
1651   {
1652     [IP_LOCAL_NEXT_DROP] = "error-drop",
1653     [IP_LOCAL_NEXT_PUNT] = "error-punt",
1654     [IP_LOCAL_NEXT_UDP_LOOKUP] = "ip6-udp-lookup",
1655     [IP_LOCAL_NEXT_ICMP] = "ip6-icmp-input",
1656   },
1657 };
1658 /* *INDENT-ON* */
1659
1660 VLIB_NODE_FUNCTION_MULTIARCH (ip6_local_node, ip6_local);
1661
1662
1663 static uword
1664 ip6_local_end_of_arc (vlib_main_t * vm,
1665                       vlib_node_runtime_t * node, vlib_frame_t * frame)
1666 {
1667   return ip6_local_inline (vm, node, frame, 0 /* head of feature arc */ );
1668 }
1669
1670 /* *INDENT-OFF* */
1671 VLIB_REGISTER_NODE (ip6_local_end_of_arc_node,static) = {
1672   .function = ip6_local_end_of_arc,
1673   .name = "ip6-local-end-of-arc",
1674   .vector_size = sizeof (u32),
1675
1676   .format_trace = format_ip6_forward_next_trace,
1677   .sibling_of = "ip6-local",
1678 };
1679
1680 VLIB_NODE_FUNCTION_MULTIARCH (ip6_local_end_of_arc_node, ip6_local_end_of_arc)
1681
1682 VNET_FEATURE_INIT (ip6_local_end_of_arc, static) = {
1683   .arc_name = "ip6-local",
1684   .node_name = "ip6-local-end-of-arc",
1685   .runs_before = 0, /* not before any other features */
1686 };
1687 /* *INDENT-ON* */
1688
1689 void
1690 ip6_register_protocol (u32 protocol, u32 node_index)
1691 {
1692   vlib_main_t *vm = vlib_get_main ();
1693   ip6_main_t *im = &ip6_main;
1694   ip_lookup_main_t *lm = &im->lookup_main;
1695
1696   ASSERT (protocol < ARRAY_LEN (lm->local_next_by_ip_protocol));
1697   lm->local_next_by_ip_protocol[protocol] =
1698     vlib_node_add_next (vm, ip6_local_node.index, node_index);
1699 }
1700
1701 typedef enum
1702 {
1703   IP6_DISCOVER_NEIGHBOR_NEXT_DROP,
1704   IP6_DISCOVER_NEIGHBOR_NEXT_REPLY_TX,
1705   IP6_DISCOVER_NEIGHBOR_N_NEXT,
1706 } ip6_discover_neighbor_next_t;
1707
1708 typedef enum
1709 {
1710   IP6_DISCOVER_NEIGHBOR_ERROR_DROP,
1711   IP6_DISCOVER_NEIGHBOR_ERROR_REQUEST_SENT,
1712   IP6_DISCOVER_NEIGHBOR_ERROR_NO_SOURCE_ADDRESS,
1713 } ip6_discover_neighbor_error_t;
1714
1715 static uword
1716 ip6_discover_neighbor_inline (vlib_main_t * vm,
1717                               vlib_node_runtime_t * node,
1718                               vlib_frame_t * frame, int is_glean)
1719 {
1720   vnet_main_t *vnm = vnet_get_main ();
1721   ip6_main_t *im = &ip6_main;
1722   ip_lookup_main_t *lm = &im->lookup_main;
1723   u32 *from, *to_next_drop;
1724   uword n_left_from, n_left_to_next_drop;
1725   static f64 time_last_seed_change = -1e100;
1726   static u32 hash_seeds[3];
1727   static uword hash_bitmap[256 / BITS (uword)];
1728   f64 time_now;
1729   int bogus_length;
1730
1731   if (node->flags & VLIB_NODE_FLAG_TRACE)
1732     ip6_forward_next_trace (vm, node, frame, VLIB_TX);
1733
1734   time_now = vlib_time_now (vm);
1735   if (time_now - time_last_seed_change > 1e-3)
1736     {
1737       uword i;
1738       u32 *r = clib_random_buffer_get_data (&vm->random_buffer,
1739                                             sizeof (hash_seeds));
1740       for (i = 0; i < ARRAY_LEN (hash_seeds); i++)
1741         hash_seeds[i] = r[i];
1742
1743       /* Mark all hash keys as been not-seen before. */
1744       for (i = 0; i < ARRAY_LEN (hash_bitmap); i++)
1745         hash_bitmap[i] = 0;
1746
1747       time_last_seed_change = time_now;
1748     }
1749
1750   from = vlib_frame_vector_args (frame);
1751   n_left_from = frame->n_vectors;
1752
1753   while (n_left_from > 0)
1754     {
1755       vlib_get_next_frame (vm, node, IP6_DISCOVER_NEIGHBOR_NEXT_DROP,
1756                            to_next_drop, n_left_to_next_drop);
1757
1758       while (n_left_from > 0 && n_left_to_next_drop > 0)
1759         {
1760           vlib_buffer_t *p0;
1761           ip6_header_t *ip0;
1762           u32 pi0, adj_index0, a0, b0, c0, m0, sw_if_index0, drop0;
1763           uword bm0;
1764           ip_adjacency_t *adj0;
1765           vnet_hw_interface_t *hw_if0;
1766           u32 next0;
1767
1768           pi0 = from[0];
1769
1770           p0 = vlib_get_buffer (vm, pi0);
1771
1772           adj_index0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
1773
1774           ip0 = vlib_buffer_get_current (p0);
1775
1776           adj0 = adj_get (adj_index0);
1777
1778           if (!is_glean)
1779             {
1780               ip0->dst_address.as_u64[0] =
1781                 adj0->sub_type.nbr.next_hop.ip6.as_u64[0];
1782               ip0->dst_address.as_u64[1] =
1783                 adj0->sub_type.nbr.next_hop.ip6.as_u64[1];
1784             }
1785
1786           a0 = hash_seeds[0];
1787           b0 = hash_seeds[1];
1788           c0 = hash_seeds[2];
1789
1790           sw_if_index0 = adj0->rewrite_header.sw_if_index;
1791           vnet_buffer (p0)->sw_if_index[VLIB_TX] = sw_if_index0;
1792
1793           a0 ^= sw_if_index0;
1794           b0 ^= ip0->dst_address.as_u32[0];
1795           c0 ^= ip0->dst_address.as_u32[1];
1796
1797           hash_v3_mix32 (a0, b0, c0);
1798
1799           b0 ^= ip0->dst_address.as_u32[2];
1800           c0 ^= ip0->dst_address.as_u32[3];
1801
1802           hash_v3_finalize32 (a0, b0, c0);
1803
1804           c0 &= BITS (hash_bitmap) - 1;
1805           c0 = c0 / BITS (uword);
1806           m0 = (uword) 1 << (c0 % BITS (uword));
1807
1808           bm0 = hash_bitmap[c0];
1809           drop0 = (bm0 & m0) != 0;
1810
1811           /* Mark it as seen. */
1812           hash_bitmap[c0] = bm0 | m0;
1813
1814           from += 1;
1815           n_left_from -= 1;
1816           to_next_drop[0] = pi0;
1817           to_next_drop += 1;
1818           n_left_to_next_drop -= 1;
1819
1820           hw_if0 = vnet_get_sup_hw_interface (vnm, sw_if_index0);
1821
1822           /* If the interface is link-down, drop the pkt */
1823           if (!(hw_if0->flags & VNET_HW_INTERFACE_FLAG_LINK_UP))
1824             drop0 = 1;
1825
1826           p0->error =
1827             node->errors[drop0 ? IP6_DISCOVER_NEIGHBOR_ERROR_DROP
1828                          : IP6_DISCOVER_NEIGHBOR_ERROR_REQUEST_SENT];
1829           if (drop0)
1830             continue;
1831
1832           /*
1833            * the adj has been updated to a rewrite but the node the DPO that got
1834            * us here hasn't - yet. no big deal. we'll drop while we wait.
1835            */
1836           if (IP_LOOKUP_NEXT_REWRITE == adj0->lookup_next_index)
1837             continue;
1838
1839           {
1840             u32 bi0 = 0;
1841             icmp6_neighbor_solicitation_header_t *h0;
1842             vlib_buffer_t *b0;
1843
1844             h0 = vlib_packet_template_get_packet
1845               (vm, &im->discover_neighbor_packet_template, &bi0);
1846
1847             /*
1848              * Build ethernet header.
1849              * Choose source address based on destination lookup
1850              * adjacency.
1851              */
1852             if (ip6_src_address_for_packet (lm,
1853                                             sw_if_index0,
1854                                             &h0->ip.src_address))
1855               {
1856                 /* There is no address on the interface */
1857                 p0->error =
1858                   node->errors[IP6_DISCOVER_NEIGHBOR_ERROR_NO_SOURCE_ADDRESS];
1859                 vlib_buffer_free (vm, &bi0, 1);
1860                 continue;
1861               }
1862
1863             /*
1864              * Destination address is a solicited node multicast address.
1865              * We need to fill in
1866              * the low 24 bits with low 24 bits of target's address.
1867              */
1868             h0->ip.dst_address.as_u8[13] = ip0->dst_address.as_u8[13];
1869             h0->ip.dst_address.as_u8[14] = ip0->dst_address.as_u8[14];
1870             h0->ip.dst_address.as_u8[15] = ip0->dst_address.as_u8[15];
1871
1872             h0->neighbor.target_address = ip0->dst_address;
1873
1874             clib_memcpy (h0->link_layer_option.ethernet_address,
1875                          hw_if0->hw_address, vec_len (hw_if0->hw_address));
1876
1877             /* $$$$ appears we need this; why is the checksum non-zero? */
1878             h0->neighbor.icmp.checksum = 0;
1879             h0->neighbor.icmp.checksum =
1880               ip6_tcp_udp_icmp_compute_checksum (vm, 0, &h0->ip,
1881                                                  &bogus_length);
1882
1883             ASSERT (bogus_length == 0);
1884
1885             vlib_buffer_copy_trace_flag (vm, p0, bi0);
1886             b0 = vlib_get_buffer (vm, bi0);
1887             vnet_buffer (b0)->sw_if_index[VLIB_TX]
1888               = vnet_buffer (p0)->sw_if_index[VLIB_TX];
1889
1890             /* Add rewrite/encap string. */
1891             vnet_rewrite_one_header (adj0[0], h0, sizeof (ethernet_header_t));
1892             vlib_buffer_advance (b0, -adj0->rewrite_header.data_bytes);
1893
1894             next0 = IP6_DISCOVER_NEIGHBOR_NEXT_REPLY_TX;
1895
1896             vlib_set_next_frame_buffer (vm, node, next0, bi0);
1897           }
1898         }
1899
1900       vlib_put_next_frame (vm, node, IP6_DISCOVER_NEIGHBOR_NEXT_DROP,
1901                            n_left_to_next_drop);
1902     }
1903
1904   return frame->n_vectors;
1905 }
1906
1907 static uword
1908 ip6_discover_neighbor (vlib_main_t * vm,
1909                        vlib_node_runtime_t * node, vlib_frame_t * frame)
1910 {
1911   return (ip6_discover_neighbor_inline (vm, node, frame, 0));
1912 }
1913
1914 static uword
1915 ip6_glean (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame)
1916 {
1917   return (ip6_discover_neighbor_inline (vm, node, frame, 1));
1918 }
1919
1920 static char *ip6_discover_neighbor_error_strings[] = {
1921   [IP6_DISCOVER_NEIGHBOR_ERROR_DROP] = "address overflow drops",
1922   [IP6_DISCOVER_NEIGHBOR_ERROR_REQUEST_SENT] = "neighbor solicitations sent",
1923   [IP6_DISCOVER_NEIGHBOR_ERROR_NO_SOURCE_ADDRESS]
1924     = "no source address for ND solicitation",
1925 };
1926
1927 /* *INDENT-OFF* */
1928 VLIB_REGISTER_NODE (ip6_discover_neighbor_node) =
1929 {
1930   .function = ip6_discover_neighbor,
1931   .name = "ip6-discover-neighbor",
1932   .vector_size = sizeof (u32),
1933   .format_trace = format_ip6_forward_next_trace,
1934   .n_errors = ARRAY_LEN (ip6_discover_neighbor_error_strings),
1935   .error_strings = ip6_discover_neighbor_error_strings,
1936   .n_next_nodes = IP6_DISCOVER_NEIGHBOR_N_NEXT,
1937   .next_nodes =
1938   {
1939     [IP6_DISCOVER_NEIGHBOR_NEXT_DROP] = "error-drop",
1940     [IP6_DISCOVER_NEIGHBOR_NEXT_REPLY_TX] = "interface-output",
1941   },
1942 };
1943 /* *INDENT-ON* */
1944
1945 /* *INDENT-OFF* */
1946 VLIB_REGISTER_NODE (ip6_glean_node) =
1947 {
1948   .function = ip6_glean,
1949   .name = "ip6-glean",
1950   .vector_size = sizeof (u32),
1951   .format_trace = format_ip6_forward_next_trace,
1952   .n_errors = ARRAY_LEN (ip6_discover_neighbor_error_strings),
1953   .error_strings = ip6_discover_neighbor_error_strings,
1954   .n_next_nodes = IP6_DISCOVER_NEIGHBOR_N_NEXT,
1955   .next_nodes =
1956   {
1957     [IP6_DISCOVER_NEIGHBOR_NEXT_DROP] = "error-drop",
1958     [IP6_DISCOVER_NEIGHBOR_NEXT_REPLY_TX] = "interface-output",
1959   },
1960 };
1961 /* *INDENT-ON* */
1962
1963 clib_error_t *
1964 ip6_probe_neighbor (vlib_main_t * vm, ip6_address_t * dst, u32 sw_if_index)
1965 {
1966   vnet_main_t *vnm = vnet_get_main ();
1967   ip6_main_t *im = &ip6_main;
1968   icmp6_neighbor_solicitation_header_t *h;
1969   ip6_address_t *src;
1970   ip_interface_address_t *ia;
1971   ip_adjacency_t *adj;
1972   vnet_hw_interface_t *hi;
1973   vnet_sw_interface_t *si;
1974   vlib_buffer_t *b;
1975   adj_index_t ai;
1976   u32 bi = 0;
1977   int bogus_length;
1978
1979   si = vnet_get_sw_interface (vnm, sw_if_index);
1980
1981   if (!(si->flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP))
1982     {
1983       return clib_error_return (0, "%U: interface %U down",
1984                                 format_ip6_address, dst,
1985                                 format_vnet_sw_if_index_name, vnm,
1986                                 sw_if_index);
1987     }
1988
1989   src =
1990     ip6_interface_address_matching_destination (im, dst, sw_if_index, &ia);
1991   if (!src)
1992     {
1993       vnm->api_errno = VNET_API_ERROR_NO_MATCHING_INTERFACE;
1994       return clib_error_return
1995         (0, "no matching interface address for destination %U (interface %U)",
1996          format_ip6_address, dst,
1997          format_vnet_sw_if_index_name, vnm, sw_if_index);
1998     }
1999
2000   h =
2001     vlib_packet_template_get_packet (vm,
2002                                      &im->discover_neighbor_packet_template,
2003                                      &bi);
2004
2005   hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
2006
2007   /* Destination address is a solicited node multicast address.  We need to fill in
2008      the low 24 bits with low 24 bits of target's address. */
2009   h->ip.dst_address.as_u8[13] = dst->as_u8[13];
2010   h->ip.dst_address.as_u8[14] = dst->as_u8[14];
2011   h->ip.dst_address.as_u8[15] = dst->as_u8[15];
2012
2013   h->ip.src_address = src[0];
2014   h->neighbor.target_address = dst[0];
2015
2016   if (PREDICT_FALSE (!hi->hw_address))
2017     {
2018       return clib_error_return (0, "%U: interface %U do not support ip probe",
2019                                 format_ip6_address, dst,
2020                                 format_vnet_sw_if_index_name, vnm,
2021                                 sw_if_index);
2022     }
2023
2024   clib_memcpy (h->link_layer_option.ethernet_address, hi->hw_address,
2025                vec_len (hi->hw_address));
2026
2027   h->neighbor.icmp.checksum =
2028     ip6_tcp_udp_icmp_compute_checksum (vm, 0, &h->ip, &bogus_length);
2029   ASSERT (bogus_length == 0);
2030
2031   b = vlib_get_buffer (vm, bi);
2032   vnet_buffer (b)->sw_if_index[VLIB_RX] =
2033     vnet_buffer (b)->sw_if_index[VLIB_TX] = sw_if_index;
2034
2035   /* Add encapsulation string for software interface (e.g. ethernet header). */
2036   ip46_address_t nh = {
2037     .ip6 = *dst,
2038   };
2039
2040   ai = adj_nbr_add_or_lock (FIB_PROTOCOL_IP6,
2041                             VNET_LINK_IP6, &nh, sw_if_index);
2042   adj = adj_get (ai);
2043
2044   vnet_rewrite_one_header (adj[0], h, sizeof (ethernet_header_t));
2045   vlib_buffer_advance (b, -adj->rewrite_header.data_bytes);
2046
2047   {
2048     vlib_frame_t *f = vlib_get_frame_to_node (vm, hi->output_node_index);
2049     u32 *to_next = vlib_frame_vector_args (f);
2050     to_next[0] = bi;
2051     f->n_vectors = 1;
2052     vlib_put_frame_to_node (vm, hi->output_node_index, f);
2053   }
2054
2055   adj_unlock (ai);
2056   return /* no error */ 0;
2057 }
2058
2059 typedef enum
2060 {
2061   IP6_REWRITE_NEXT_DROP,
2062   IP6_REWRITE_NEXT_ICMP_ERROR,
2063 } ip6_rewrite_next_t;
2064
2065 always_inline uword
2066 ip6_rewrite_inline (vlib_main_t * vm,
2067                     vlib_node_runtime_t * node,
2068                     vlib_frame_t * frame,
2069                     int do_counters, int is_midchain, int is_mcast)
2070 {
2071   ip_lookup_main_t *lm = &ip6_main.lookup_main;
2072   u32 *from = vlib_frame_vector_args (frame);
2073   u32 n_left_from, n_left_to_next, *to_next, next_index;
2074   vlib_node_runtime_t *error_node =
2075     vlib_node_get_runtime (vm, ip6_input_node.index);
2076
2077   n_left_from = frame->n_vectors;
2078   next_index = node->cached_next_index;
2079   u32 thread_index = vlib_get_thread_index ();
2080
2081   while (n_left_from > 0)
2082     {
2083       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
2084
2085       while (n_left_from >= 4 && n_left_to_next >= 2)
2086         {
2087           ip_adjacency_t *adj0, *adj1;
2088           vlib_buffer_t *p0, *p1;
2089           ip6_header_t *ip0, *ip1;
2090           u32 pi0, rw_len0, next0, error0, adj_index0;
2091           u32 pi1, rw_len1, next1, error1, adj_index1;
2092           u32 tx_sw_if_index0, tx_sw_if_index1;
2093
2094           /* Prefetch next iteration. */
2095           {
2096             vlib_buffer_t *p2, *p3;
2097
2098             p2 = vlib_get_buffer (vm, from[2]);
2099             p3 = vlib_get_buffer (vm, from[3]);
2100
2101             vlib_prefetch_buffer_header (p2, LOAD);
2102             vlib_prefetch_buffer_header (p3, LOAD);
2103
2104             CLIB_PREFETCH (p2->pre_data, 32, STORE);
2105             CLIB_PREFETCH (p3->pre_data, 32, STORE);
2106
2107             CLIB_PREFETCH (p2->data, sizeof (ip0[0]), STORE);
2108             CLIB_PREFETCH (p3->data, sizeof (ip0[0]), STORE);
2109           }
2110
2111           pi0 = to_next[0] = from[0];
2112           pi1 = to_next[1] = from[1];
2113
2114           from += 2;
2115           n_left_from -= 2;
2116           to_next += 2;
2117           n_left_to_next -= 2;
2118
2119           p0 = vlib_get_buffer (vm, pi0);
2120           p1 = vlib_get_buffer (vm, pi1);
2121
2122           adj_index0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
2123           adj_index1 = vnet_buffer (p1)->ip.adj_index[VLIB_TX];
2124
2125           ip0 = vlib_buffer_get_current (p0);
2126           ip1 = vlib_buffer_get_current (p1);
2127
2128           error0 = error1 = IP6_ERROR_NONE;
2129           next0 = next1 = IP6_REWRITE_NEXT_DROP;
2130
2131           if (PREDICT_TRUE (!(p0->flags & VNET_BUFFER_F_LOCALLY_ORIGINATED)))
2132             {
2133               i32 hop_limit0 = ip0->hop_limit;
2134
2135               /* Input node should have reject packets with hop limit 0. */
2136               ASSERT (ip0->hop_limit > 0);
2137
2138               hop_limit0 -= 1;
2139
2140               ip0->hop_limit = hop_limit0;
2141
2142               /*
2143                * If the hop count drops below 1 when forwarding, generate
2144                * an ICMP response.
2145                */
2146               if (PREDICT_FALSE (hop_limit0 <= 0))
2147                 {
2148                   error0 = IP6_ERROR_TIME_EXPIRED;
2149                   next0 = IP6_REWRITE_NEXT_ICMP_ERROR;
2150                   vnet_buffer (p0)->sw_if_index[VLIB_TX] = (u32) ~ 0;
2151                   icmp6_error_set_vnet_buffer (p0, ICMP6_time_exceeded,
2152                                                ICMP6_time_exceeded_ttl_exceeded_in_transit,
2153                                                0);
2154                 }
2155             }
2156           else
2157             {
2158               p0->flags &= ~VNET_BUFFER_F_LOCALLY_ORIGINATED;
2159             }
2160           if (PREDICT_TRUE (!(p1->flags & VNET_BUFFER_F_LOCALLY_ORIGINATED)))
2161             {
2162               i32 hop_limit1 = ip1->hop_limit;
2163
2164               /* Input node should have reject packets with hop limit 0. */
2165               ASSERT (ip1->hop_limit > 0);
2166
2167               hop_limit1 -= 1;
2168
2169               ip1->hop_limit = hop_limit1;
2170
2171               /*
2172                * If the hop count drops below 1 when forwarding, generate
2173                * an ICMP response.
2174                */
2175               if (PREDICT_FALSE (hop_limit1 <= 0))
2176                 {
2177                   error1 = IP6_ERROR_TIME_EXPIRED;
2178                   next1 = IP6_REWRITE_NEXT_ICMP_ERROR;
2179                   vnet_buffer (p1)->sw_if_index[VLIB_TX] = (u32) ~ 0;
2180                   icmp6_error_set_vnet_buffer (p1, ICMP6_time_exceeded,
2181                                                ICMP6_time_exceeded_ttl_exceeded_in_transit,
2182                                                0);
2183                 }
2184             }
2185           else
2186             {
2187               p1->flags &= ~VNET_BUFFER_F_LOCALLY_ORIGINATED;
2188             }
2189           adj0 = adj_get (adj_index0);
2190           adj1 = adj_get (adj_index1);
2191
2192           rw_len0 = adj0[0].rewrite_header.data_bytes;
2193           rw_len1 = adj1[0].rewrite_header.data_bytes;
2194           vnet_buffer (p0)->ip.save_rewrite_length = rw_len0;
2195           vnet_buffer (p1)->ip.save_rewrite_length = rw_len1;
2196
2197           if (do_counters)
2198             {
2199               vlib_increment_combined_counter
2200                 (&adjacency_counters,
2201                  thread_index, adj_index0, 1,
2202                  vlib_buffer_length_in_chain (vm, p0) + rw_len0);
2203               vlib_increment_combined_counter
2204                 (&adjacency_counters,
2205                  thread_index, adj_index1, 1,
2206                  vlib_buffer_length_in_chain (vm, p1) + rw_len1);
2207             }
2208
2209           /* Check MTU of outgoing interface. */
2210           error0 =
2211             (vlib_buffer_length_in_chain (vm, p0) >
2212              adj0[0].
2213              rewrite_header.max_l3_packet_bytes ? IP6_ERROR_MTU_EXCEEDED :
2214              error0);
2215           error1 =
2216             (vlib_buffer_length_in_chain (vm, p1) >
2217              adj1[0].
2218              rewrite_header.max_l3_packet_bytes ? IP6_ERROR_MTU_EXCEEDED :
2219              error1);
2220
2221           /* Don't adjust the buffer for hop count issue; icmp-error node
2222            * wants to see the IP headerr */
2223           if (PREDICT_TRUE (error0 == IP6_ERROR_NONE))
2224             {
2225               p0->current_data -= rw_len0;
2226               p0->current_length += rw_len0;
2227
2228               tx_sw_if_index0 = adj0[0].rewrite_header.sw_if_index;
2229               vnet_buffer (p0)->sw_if_index[VLIB_TX] = tx_sw_if_index0;
2230               next0 = adj0[0].rewrite_header.next_index;
2231
2232               if (PREDICT_FALSE
2233                   (adj0[0].rewrite_header.flags & VNET_REWRITE_HAS_FEATURES))
2234                 vnet_feature_arc_start (lm->output_feature_arc_index,
2235                                         tx_sw_if_index0, &next0, p0);
2236             }
2237           if (PREDICT_TRUE (error1 == IP6_ERROR_NONE))
2238             {
2239               p1->current_data -= rw_len1;
2240               p1->current_length += rw_len1;
2241
2242               tx_sw_if_index1 = adj1[0].rewrite_header.sw_if_index;
2243               vnet_buffer (p1)->sw_if_index[VLIB_TX] = tx_sw_if_index1;
2244               next1 = adj1[0].rewrite_header.next_index;
2245
2246               if (PREDICT_FALSE
2247                   (adj1[0].rewrite_header.flags & VNET_REWRITE_HAS_FEATURES))
2248                 vnet_feature_arc_start (lm->output_feature_arc_index,
2249                                         tx_sw_if_index1, &next1, p1);
2250             }
2251
2252           /* Guess we are only writing on simple Ethernet header. */
2253           vnet_rewrite_two_headers (adj0[0], adj1[0],
2254                                     ip0, ip1, sizeof (ethernet_header_t));
2255
2256           if (is_midchain)
2257             {
2258               adj0->sub_type.midchain.fixup_func (vm, adj0, p0);
2259               adj1->sub_type.midchain.fixup_func (vm, adj1, p1);
2260             }
2261           if (is_mcast)
2262             {
2263               /*
2264                * copy bytes from the IP address into the MAC rewrite
2265                */
2266               vnet_fixup_one_header (adj0[0], &ip0->dst_address, ip0);
2267               vnet_fixup_one_header (adj1[0], &ip1->dst_address, ip1);
2268             }
2269
2270           vlib_validate_buffer_enqueue_x2 (vm, node, next_index,
2271                                            to_next, n_left_to_next,
2272                                            pi0, pi1, next0, next1);
2273         }
2274
2275       while (n_left_from > 0 && n_left_to_next > 0)
2276         {
2277           ip_adjacency_t *adj0;
2278           vlib_buffer_t *p0;
2279           ip6_header_t *ip0;
2280           u32 pi0, rw_len0;
2281           u32 adj_index0, next0, error0;
2282           u32 tx_sw_if_index0;
2283
2284           pi0 = to_next[0] = from[0];
2285
2286           p0 = vlib_get_buffer (vm, pi0);
2287
2288           adj_index0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
2289
2290           adj0 = adj_get (adj_index0);
2291
2292           ip0 = vlib_buffer_get_current (p0);
2293
2294           error0 = IP6_ERROR_NONE;
2295           next0 = IP6_REWRITE_NEXT_DROP;
2296
2297           /* Check hop limit */
2298           if (PREDICT_TRUE (!(p0->flags & VNET_BUFFER_F_LOCALLY_ORIGINATED)))
2299             {
2300               i32 hop_limit0 = ip0->hop_limit;
2301
2302               ASSERT (ip0->hop_limit > 0);
2303
2304               hop_limit0 -= 1;
2305
2306               ip0->hop_limit = hop_limit0;
2307
2308               if (PREDICT_FALSE (hop_limit0 <= 0))
2309                 {
2310                   /*
2311                    * If the hop count drops below 1 when forwarding, generate
2312                    * an ICMP response.
2313                    */
2314                   error0 = IP6_ERROR_TIME_EXPIRED;
2315                   next0 = IP6_REWRITE_NEXT_ICMP_ERROR;
2316                   vnet_buffer (p0)->sw_if_index[VLIB_TX] = (u32) ~ 0;
2317                   icmp6_error_set_vnet_buffer (p0, ICMP6_time_exceeded,
2318                                                ICMP6_time_exceeded_ttl_exceeded_in_transit,
2319                                                0);
2320                 }
2321             }
2322           else
2323             {
2324               p0->flags &= ~VNET_BUFFER_F_LOCALLY_ORIGINATED;
2325             }
2326
2327           /* Guess we are only writing on simple Ethernet header. */
2328           vnet_rewrite_one_header (adj0[0], ip0, sizeof (ethernet_header_t));
2329
2330           /* Update packet buffer attributes/set output interface. */
2331           rw_len0 = adj0[0].rewrite_header.data_bytes;
2332           vnet_buffer (p0)->ip.save_rewrite_length = rw_len0;
2333
2334           if (do_counters)
2335             {
2336               vlib_increment_combined_counter
2337                 (&adjacency_counters,
2338                  thread_index, adj_index0, 1,
2339                  vlib_buffer_length_in_chain (vm, p0) + rw_len0);
2340             }
2341
2342           /* Check MTU of outgoing interface. */
2343           error0 =
2344             (vlib_buffer_length_in_chain (vm, p0) >
2345              adj0[0].
2346              rewrite_header.max_l3_packet_bytes ? IP6_ERROR_MTU_EXCEEDED :
2347              error0);
2348
2349           /* Don't adjust the buffer for hop count issue; icmp-error node
2350            * wants to see the IP headerr */
2351           if (PREDICT_TRUE (error0 == IP6_ERROR_NONE))
2352             {
2353               p0->current_data -= rw_len0;
2354               p0->current_length += rw_len0;
2355
2356               tx_sw_if_index0 = adj0[0].rewrite_header.sw_if_index;
2357
2358               vnet_buffer (p0)->sw_if_index[VLIB_TX] = tx_sw_if_index0;
2359               next0 = adj0[0].rewrite_header.next_index;
2360
2361               if (PREDICT_FALSE
2362                   (adj0[0].rewrite_header.flags & VNET_REWRITE_HAS_FEATURES))
2363                 vnet_feature_arc_start (lm->output_feature_arc_index,
2364                                         tx_sw_if_index0, &next0, p0);
2365             }
2366
2367           if (is_midchain)
2368             {
2369               adj0->sub_type.midchain.fixup_func (vm, adj0, p0);
2370             }
2371           if (is_mcast)
2372             {
2373               vnet_fixup_one_header (adj0[0], &ip0->dst_address, ip0);
2374             }
2375
2376           p0->error = error_node->errors[error0];
2377
2378           from += 1;
2379           n_left_from -= 1;
2380           to_next += 1;
2381           n_left_to_next -= 1;
2382
2383           vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
2384                                            to_next, n_left_to_next,
2385                                            pi0, next0);
2386         }
2387
2388       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
2389     }
2390
2391   /* Need to do trace after rewrites to pick up new packet data. */
2392   if (node->flags & VLIB_NODE_FLAG_TRACE)
2393     ip6_forward_next_trace (vm, node, frame, VLIB_TX);
2394
2395   return frame->n_vectors;
2396 }
2397
2398 static uword
2399 ip6_rewrite (vlib_main_t * vm,
2400              vlib_node_runtime_t * node, vlib_frame_t * frame)
2401 {
2402   if (adj_are_counters_enabled ())
2403     return ip6_rewrite_inline (vm, node, frame, 1, 0, 0);
2404   else
2405     return ip6_rewrite_inline (vm, node, frame, 0, 0, 0);
2406 }
2407
2408 static uword
2409 ip6_rewrite_mcast (vlib_main_t * vm,
2410                    vlib_node_runtime_t * node, vlib_frame_t * frame)
2411 {
2412   if (adj_are_counters_enabled ())
2413     return ip6_rewrite_inline (vm, node, frame, 1, 0, 1);
2414   else
2415     return ip6_rewrite_inline (vm, node, frame, 0, 0, 1);
2416 }
2417
2418 static uword
2419 ip6_midchain (vlib_main_t * vm,
2420               vlib_node_runtime_t * node, vlib_frame_t * frame)
2421 {
2422   if (adj_are_counters_enabled ())
2423     return ip6_rewrite_inline (vm, node, frame, 1, 1, 0);
2424   else
2425     return ip6_rewrite_inline (vm, node, frame, 0, 1, 0);
2426 }
2427
2428 static uword
2429 ip6_mcast_midchain (vlib_main_t * vm,
2430                     vlib_node_runtime_t * node, vlib_frame_t * frame)
2431 {
2432   if (adj_are_counters_enabled ())
2433     return ip6_rewrite_inline (vm, node, frame, 1, 1, 1);
2434   else
2435     return ip6_rewrite_inline (vm, node, frame, 0, 1, 1);
2436 }
2437
2438 /* *INDENT-OFF* */
2439 VLIB_REGISTER_NODE (ip6_midchain_node) =
2440 {
2441   .function = ip6_midchain,
2442   .name = "ip6-midchain",
2443   .vector_size = sizeof (u32),
2444   .format_trace = format_ip6_forward_next_trace,
2445   .sibling_of = "ip6-rewrite",
2446   };
2447 /* *INDENT-ON* */
2448
2449 VLIB_NODE_FUNCTION_MULTIARCH (ip6_midchain_node, ip6_midchain);
2450
2451 /* *INDENT-OFF* */
2452 VLIB_REGISTER_NODE (ip6_rewrite_node) =
2453 {
2454   .function = ip6_rewrite,
2455   .name = "ip6-rewrite",
2456   .vector_size = sizeof (u32),
2457   .format_trace = format_ip6_rewrite_trace,
2458   .n_next_nodes = 2,
2459   .next_nodes =
2460   {
2461     [IP6_REWRITE_NEXT_DROP] = "error-drop",
2462     [IP6_REWRITE_NEXT_ICMP_ERROR] = "ip6-icmp-error",
2463   },
2464 };
2465 /* *INDENT-ON* */
2466
2467 VLIB_NODE_FUNCTION_MULTIARCH (ip6_rewrite_node, ip6_rewrite);
2468
2469 /* *INDENT-OFF* */
2470 VLIB_REGISTER_NODE (ip6_rewrite_mcast_node) =
2471 {
2472   .function = ip6_rewrite_mcast,
2473   .name = "ip6-rewrite-mcast",
2474   .vector_size = sizeof (u32),
2475   .format_trace = format_ip6_rewrite_trace,
2476   .sibling_of = "ip6-rewrite",
2477 };
2478 /* *INDENT-ON* */
2479
2480 VLIB_NODE_FUNCTION_MULTIARCH (ip6_rewrite_mcast_node, ip6_rewrite_mcast);
2481
2482 /* *INDENT-OFF* */
2483 VLIB_REGISTER_NODE (ip6_mcast_midchain_node, static) =
2484 {
2485   .function = ip6_mcast_midchain,
2486   .name = "ip6-mcast-midchain",
2487   .vector_size = sizeof (u32),
2488   .format_trace = format_ip6_rewrite_trace,
2489   .sibling_of = "ip6-rewrite",
2490 };
2491 /* *INDENT-ON* */
2492
2493 VLIB_NODE_FUNCTION_MULTIARCH (ip6_mcast_midchain_node, ip6_mcast_midchain);
2494
2495 /*
2496  * Hop-by-Hop handling
2497  */
2498 ip6_hop_by_hop_main_t ip6_hop_by_hop_main;
2499
2500 #define foreach_ip6_hop_by_hop_error \
2501 _(PROCESSED, "pkts with ip6 hop-by-hop options") \
2502 _(FORMAT, "incorrectly formatted hop-by-hop options") \
2503 _(UNKNOWN_OPTION, "unknown ip6 hop-by-hop options")
2504
2505 /* *INDENT-OFF* */
2506 typedef enum
2507 {
2508 #define _(sym,str) IP6_HOP_BY_HOP_ERROR_##sym,
2509   foreach_ip6_hop_by_hop_error
2510 #undef _
2511   IP6_HOP_BY_HOP_N_ERROR,
2512 } ip6_hop_by_hop_error_t;
2513 /* *INDENT-ON* */
2514
2515 /*
2516  * Primary h-b-h handler trace support
2517  * We work pretty hard on the problem for obvious reasons
2518  */
2519 typedef struct
2520 {
2521   u32 next_index;
2522   u32 trace_len;
2523   u8 option_data[256];
2524 } ip6_hop_by_hop_trace_t;
2525
2526 vlib_node_registration_t ip6_hop_by_hop_node;
2527
2528 static char *ip6_hop_by_hop_error_strings[] = {
2529 #define _(sym,string) string,
2530   foreach_ip6_hop_by_hop_error
2531 #undef _
2532 };
2533
2534 u8 *
2535 format_ip6_hop_by_hop_ext_hdr (u8 * s, va_list * args)
2536 {
2537   ip6_hop_by_hop_header_t *hbh0 = va_arg (*args, ip6_hop_by_hop_header_t *);
2538   int total_len = va_arg (*args, int);
2539   ip6_hop_by_hop_option_t *opt0, *limit0;
2540   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2541   u8 type0;
2542
2543   s = format (s, "IP6_HOP_BY_HOP: next protocol %d len %d total %d",
2544               hbh0->protocol, (hbh0->length + 1) << 3, total_len);
2545
2546   opt0 = (ip6_hop_by_hop_option_t *) (hbh0 + 1);
2547   limit0 = (ip6_hop_by_hop_option_t *) ((u8 *) hbh0 + total_len);
2548
2549   while (opt0 < limit0)
2550     {
2551       type0 = opt0->type;
2552       switch (type0)
2553         {
2554         case 0:         /* Pad, just stop */
2555           opt0 = (ip6_hop_by_hop_option_t *) ((u8 *) opt0 + 1);
2556           break;
2557
2558         default:
2559           if (hm->trace[type0])
2560             {
2561               s = (*hm->trace[type0]) (s, opt0);
2562             }
2563           else
2564             {
2565               s =
2566                 format (s, "\n    unrecognized option %d length %d", type0,
2567                         opt0->length);
2568             }
2569           opt0 =
2570             (ip6_hop_by_hop_option_t *) (((u8 *) opt0) + opt0->length +
2571                                          sizeof (ip6_hop_by_hop_option_t));
2572           break;
2573         }
2574     }
2575   return s;
2576 }
2577
2578 static u8 *
2579 format_ip6_hop_by_hop_trace (u8 * s, va_list * args)
2580 {
2581   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
2582   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
2583   ip6_hop_by_hop_trace_t *t = va_arg (*args, ip6_hop_by_hop_trace_t *);
2584   ip6_hop_by_hop_header_t *hbh0;
2585   ip6_hop_by_hop_option_t *opt0, *limit0;
2586   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2587
2588   u8 type0;
2589
2590   hbh0 = (ip6_hop_by_hop_header_t *) t->option_data;
2591
2592   s = format (s, "IP6_HOP_BY_HOP: next index %d len %d traced %d",
2593               t->next_index, (hbh0->length + 1) << 3, t->trace_len);
2594
2595   opt0 = (ip6_hop_by_hop_option_t *) (hbh0 + 1);
2596   limit0 = (ip6_hop_by_hop_option_t *) ((u8 *) hbh0) + t->trace_len;
2597
2598   while (opt0 < limit0)
2599     {
2600       type0 = opt0->type;
2601       switch (type0)
2602         {
2603         case 0:         /* Pad, just stop */
2604           opt0 = (ip6_hop_by_hop_option_t *) ((u8 *) opt0) + 1;
2605           break;
2606
2607         default:
2608           if (hm->trace[type0])
2609             {
2610               s = (*hm->trace[type0]) (s, opt0);
2611             }
2612           else
2613             {
2614               s =
2615                 format (s, "\n    unrecognized option %d length %d", type0,
2616                         opt0->length);
2617             }
2618           opt0 =
2619             (ip6_hop_by_hop_option_t *) (((u8 *) opt0) + opt0->length +
2620                                          sizeof (ip6_hop_by_hop_option_t));
2621           break;
2622         }
2623     }
2624   return s;
2625 }
2626
2627 always_inline u8
2628 ip6_scan_hbh_options (vlib_buffer_t * b0,
2629                       ip6_header_t * ip0,
2630                       ip6_hop_by_hop_header_t * hbh0,
2631                       ip6_hop_by_hop_option_t * opt0,
2632                       ip6_hop_by_hop_option_t * limit0, u32 * next0)
2633 {
2634   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2635   u8 type0;
2636   u8 error0 = 0;
2637
2638   while (opt0 < limit0)
2639     {
2640       type0 = opt0->type;
2641       switch (type0)
2642         {
2643         case 0:         /* Pad1 */
2644           opt0 = (ip6_hop_by_hop_option_t *) ((u8 *) opt0) + 1;
2645           continue;
2646         case 1:         /* PadN */
2647           break;
2648         default:
2649           if (hm->options[type0])
2650             {
2651               if ((*hm->options[type0]) (b0, ip0, opt0) < 0)
2652                 {
2653                   error0 = IP6_HOP_BY_HOP_ERROR_FORMAT;
2654                   return (error0);
2655                 }
2656             }
2657           else
2658             {
2659               /* Unrecognized mandatory option, check the two high order bits */
2660               switch (opt0->type & HBH_OPTION_TYPE_HIGH_ORDER_BITS)
2661                 {
2662                 case HBH_OPTION_TYPE_SKIP_UNKNOWN:
2663                   break;
2664                 case HBH_OPTION_TYPE_DISCARD_UNKNOWN:
2665                   error0 = IP6_HOP_BY_HOP_ERROR_UNKNOWN_OPTION;
2666                   *next0 = IP_LOOKUP_NEXT_DROP;
2667                   break;
2668                 case HBH_OPTION_TYPE_DISCARD_UNKNOWN_ICMP:
2669                   error0 = IP6_HOP_BY_HOP_ERROR_UNKNOWN_OPTION;
2670                   *next0 = IP_LOOKUP_NEXT_ICMP_ERROR;
2671                   icmp6_error_set_vnet_buffer (b0, ICMP6_parameter_problem,
2672                                                ICMP6_parameter_problem_unrecognized_option,
2673                                                (u8 *) opt0 - (u8 *) ip0);
2674                   break;
2675                 case HBH_OPTION_TYPE_DISCARD_UNKNOWN_ICMP_NOT_MCAST:
2676                   error0 = IP6_HOP_BY_HOP_ERROR_UNKNOWN_OPTION;
2677                   if (!ip6_address_is_multicast (&ip0->dst_address))
2678                     {
2679                       *next0 = IP_LOOKUP_NEXT_ICMP_ERROR;
2680                       icmp6_error_set_vnet_buffer (b0,
2681                                                    ICMP6_parameter_problem,
2682                                                    ICMP6_parameter_problem_unrecognized_option,
2683                                                    (u8 *) opt0 - (u8 *) ip0);
2684                     }
2685                   else
2686                     {
2687                       *next0 = IP_LOOKUP_NEXT_DROP;
2688                     }
2689                   break;
2690                 }
2691               return (error0);
2692             }
2693         }
2694       opt0 =
2695         (ip6_hop_by_hop_option_t *) (((u8 *) opt0) + opt0->length +
2696                                      sizeof (ip6_hop_by_hop_option_t));
2697     }
2698   return (error0);
2699 }
2700
2701 /*
2702  * Process the Hop-by-Hop Options header
2703  */
2704 static uword
2705 ip6_hop_by_hop (vlib_main_t * vm,
2706                 vlib_node_runtime_t * node, vlib_frame_t * frame)
2707 {
2708   vlib_node_runtime_t *error_node =
2709     vlib_node_get_runtime (vm, ip6_hop_by_hop_node.index);
2710   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2711   u32 n_left_from, *from, *to_next;
2712   ip_lookup_next_t next_index;
2713
2714   from = vlib_frame_vector_args (frame);
2715   n_left_from = frame->n_vectors;
2716   next_index = node->cached_next_index;
2717
2718   while (n_left_from > 0)
2719     {
2720       u32 n_left_to_next;
2721
2722       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
2723
2724       while (n_left_from >= 4 && n_left_to_next >= 2)
2725         {
2726           u32 bi0, bi1;
2727           vlib_buffer_t *b0, *b1;
2728           u32 next0, next1;
2729           ip6_header_t *ip0, *ip1;
2730           ip6_hop_by_hop_header_t *hbh0, *hbh1;
2731           ip6_hop_by_hop_option_t *opt0, *limit0, *opt1, *limit1;
2732           u8 error0 = 0, error1 = 0;
2733
2734           /* Prefetch next iteration. */
2735           {
2736             vlib_buffer_t *p2, *p3;
2737
2738             p2 = vlib_get_buffer (vm, from[2]);
2739             p3 = vlib_get_buffer (vm, from[3]);
2740
2741             vlib_prefetch_buffer_header (p2, LOAD);
2742             vlib_prefetch_buffer_header (p3, LOAD);
2743
2744             CLIB_PREFETCH (p2->data, 2 * CLIB_CACHE_LINE_BYTES, LOAD);
2745             CLIB_PREFETCH (p3->data, 2 * CLIB_CACHE_LINE_BYTES, LOAD);
2746           }
2747
2748           /* Speculatively enqueue b0, b1 to the current next frame */
2749           to_next[0] = bi0 = from[0];
2750           to_next[1] = bi1 = from[1];
2751           from += 2;
2752           to_next += 2;
2753           n_left_from -= 2;
2754           n_left_to_next -= 2;
2755
2756           b0 = vlib_get_buffer (vm, bi0);
2757           b1 = vlib_get_buffer (vm, bi1);
2758
2759           /* Default use the next_index from the adjacency. A HBH option rarely redirects to a different node */
2760           u32 adj_index0 = vnet_buffer (b0)->ip.adj_index[VLIB_TX];
2761           ip_adjacency_t *adj0 = adj_get (adj_index0);
2762           u32 adj_index1 = vnet_buffer (b1)->ip.adj_index[VLIB_TX];
2763           ip_adjacency_t *adj1 = adj_get (adj_index1);
2764
2765           /* Default use the next_index from the adjacency. A HBH option rarely redirects to a different node */
2766           next0 = adj0->lookup_next_index;
2767           next1 = adj1->lookup_next_index;
2768
2769           ip0 = vlib_buffer_get_current (b0);
2770           ip1 = vlib_buffer_get_current (b1);
2771           hbh0 = (ip6_hop_by_hop_header_t *) (ip0 + 1);
2772           hbh1 = (ip6_hop_by_hop_header_t *) (ip1 + 1);
2773           opt0 = (ip6_hop_by_hop_option_t *) (hbh0 + 1);
2774           opt1 = (ip6_hop_by_hop_option_t *) (hbh1 + 1);
2775           limit0 =
2776             (ip6_hop_by_hop_option_t *) ((u8 *) hbh0 +
2777                                          ((hbh0->length + 1) << 3));
2778           limit1 =
2779             (ip6_hop_by_hop_option_t *) ((u8 *) hbh1 +
2780                                          ((hbh1->length + 1) << 3));
2781
2782           /*
2783            * Basic validity checks
2784            */
2785           if ((hbh0->length + 1) << 3 >
2786               clib_net_to_host_u16 (ip0->payload_length))
2787             {
2788               error0 = IP6_HOP_BY_HOP_ERROR_FORMAT;
2789               next0 = IP_LOOKUP_NEXT_DROP;
2790               goto outdual;
2791             }
2792           /* Scan the set of h-b-h options, process ones that we understand */
2793           error0 = ip6_scan_hbh_options (b0, ip0, hbh0, opt0, limit0, &next0);
2794
2795           if ((hbh1->length + 1) << 3 >
2796               clib_net_to_host_u16 (ip1->payload_length))
2797             {
2798               error1 = IP6_HOP_BY_HOP_ERROR_FORMAT;
2799               next1 = IP_LOOKUP_NEXT_DROP;
2800               goto outdual;
2801             }
2802           /* Scan the set of h-b-h options, process ones that we understand */
2803           error1 = ip6_scan_hbh_options (b1, ip1, hbh1, opt1, limit1, &next1);
2804
2805         outdual:
2806           /* Has the classifier flagged this buffer for special treatment? */
2807           if (PREDICT_FALSE
2808               ((error0 == 0)
2809                && (vnet_buffer (b0)->l2_classify.opaque_index & OI_DECAP)))
2810             next0 = hm->next_override;
2811
2812           /* Has the classifier flagged this buffer for special treatment? */
2813           if (PREDICT_FALSE
2814               ((error1 == 0)
2815                && (vnet_buffer (b1)->l2_classify.opaque_index & OI_DECAP)))
2816             next1 = hm->next_override;
2817
2818           if (PREDICT_FALSE ((node->flags & VLIB_NODE_FLAG_TRACE)))
2819             {
2820               if (b0->flags & VLIB_BUFFER_IS_TRACED)
2821                 {
2822                   ip6_hop_by_hop_trace_t *t =
2823                     vlib_add_trace (vm, node, b0, sizeof (*t));
2824                   u32 trace_len = (hbh0->length + 1) << 3;
2825                   t->next_index = next0;
2826                   /* Capture the h-b-h option verbatim */
2827                   trace_len =
2828                     trace_len <
2829                     ARRAY_LEN (t->option_data) ? trace_len :
2830                     ARRAY_LEN (t->option_data);
2831                   t->trace_len = trace_len;
2832                   clib_memcpy (t->option_data, hbh0, trace_len);
2833                 }
2834               if (b1->flags & VLIB_BUFFER_IS_TRACED)
2835                 {
2836                   ip6_hop_by_hop_trace_t *t =
2837                     vlib_add_trace (vm, node, b1, sizeof (*t));
2838                   u32 trace_len = (hbh1->length + 1) << 3;
2839                   t->next_index = next1;
2840                   /* Capture the h-b-h option verbatim */
2841                   trace_len =
2842                     trace_len <
2843                     ARRAY_LEN (t->option_data) ? trace_len :
2844                     ARRAY_LEN (t->option_data);
2845                   t->trace_len = trace_len;
2846                   clib_memcpy (t->option_data, hbh1, trace_len);
2847                 }
2848
2849             }
2850
2851           b0->error = error_node->errors[error0];
2852           b1->error = error_node->errors[error1];
2853
2854           /* verify speculative enqueue, maybe switch current next frame */
2855           vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next,
2856                                            n_left_to_next, bi0, bi1, next0,
2857                                            next1);
2858         }
2859
2860       while (n_left_from > 0 && n_left_to_next > 0)
2861         {
2862           u32 bi0;
2863           vlib_buffer_t *b0;
2864           u32 next0;
2865           ip6_header_t *ip0;
2866           ip6_hop_by_hop_header_t *hbh0;
2867           ip6_hop_by_hop_option_t *opt0, *limit0;
2868           u8 error0 = 0;
2869
2870           /* Speculatively enqueue b0 to the current next frame */
2871           bi0 = from[0];
2872           to_next[0] = bi0;
2873           from += 1;
2874           to_next += 1;
2875           n_left_from -= 1;
2876           n_left_to_next -= 1;
2877
2878           b0 = vlib_get_buffer (vm, bi0);
2879           /*
2880            * Default use the next_index from the adjacency.
2881            * A HBH option rarely redirects to a different node
2882            */
2883           u32 adj_index0 = vnet_buffer (b0)->ip.adj_index[VLIB_TX];
2884           ip_adjacency_t *adj0 = adj_get (adj_index0);
2885           next0 = adj0->lookup_next_index;
2886
2887           ip0 = vlib_buffer_get_current (b0);
2888           hbh0 = (ip6_hop_by_hop_header_t *) (ip0 + 1);
2889           opt0 = (ip6_hop_by_hop_option_t *) (hbh0 + 1);
2890           limit0 =
2891             (ip6_hop_by_hop_option_t *) ((u8 *) hbh0 +
2892                                          ((hbh0->length + 1) << 3));
2893
2894           /*
2895            * Basic validity checks
2896            */
2897           if ((hbh0->length + 1) << 3 >
2898               clib_net_to_host_u16 (ip0->payload_length))
2899             {
2900               error0 = IP6_HOP_BY_HOP_ERROR_FORMAT;
2901               next0 = IP_LOOKUP_NEXT_DROP;
2902               goto out0;
2903             }
2904
2905           /* Scan the set of h-b-h options, process ones that we understand */
2906           error0 = ip6_scan_hbh_options (b0, ip0, hbh0, opt0, limit0, &next0);
2907
2908         out0:
2909           /* Has the classifier flagged this buffer for special treatment? */
2910           if (PREDICT_FALSE
2911               ((error0 == 0)
2912                && (vnet_buffer (b0)->l2_classify.opaque_index & OI_DECAP)))
2913             next0 = hm->next_override;
2914
2915           if (PREDICT_FALSE (b0->flags & VLIB_BUFFER_IS_TRACED))
2916             {
2917               ip6_hop_by_hop_trace_t *t =
2918                 vlib_add_trace (vm, node, b0, sizeof (*t));
2919               u32 trace_len = (hbh0->length + 1) << 3;
2920               t->next_index = next0;
2921               /* Capture the h-b-h option verbatim */
2922               trace_len =
2923                 trace_len <
2924                 ARRAY_LEN (t->option_data) ? trace_len :
2925                 ARRAY_LEN (t->option_data);
2926               t->trace_len = trace_len;
2927               clib_memcpy (t->option_data, hbh0, trace_len);
2928             }
2929
2930           b0->error = error_node->errors[error0];
2931
2932           /* verify speculative enqueue, maybe switch current next frame */
2933           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
2934                                            n_left_to_next, bi0, next0);
2935         }
2936       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
2937     }
2938   return frame->n_vectors;
2939 }
2940
2941 /* *INDENT-OFF* */
2942 VLIB_REGISTER_NODE (ip6_hop_by_hop_node) =
2943 {
2944   .function = ip6_hop_by_hop,
2945   .name = "ip6-hop-by-hop",
2946   .sibling_of = "ip6-lookup",
2947   .vector_size = sizeof (u32),
2948   .format_trace = format_ip6_hop_by_hop_trace,
2949   .type = VLIB_NODE_TYPE_INTERNAL,
2950   .n_errors = ARRAY_LEN (ip6_hop_by_hop_error_strings),
2951   .error_strings = ip6_hop_by_hop_error_strings,
2952   .n_next_nodes = 0,
2953 };
2954 /* *INDENT-ON* */
2955
2956 VLIB_NODE_FUNCTION_MULTIARCH (ip6_hop_by_hop_node, ip6_hop_by_hop);
2957
2958 static clib_error_t *
2959 ip6_hop_by_hop_init (vlib_main_t * vm)
2960 {
2961   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2962   memset (hm->options, 0, sizeof (hm->options));
2963   memset (hm->trace, 0, sizeof (hm->trace));
2964   hm->next_override = IP6_LOOKUP_NEXT_POP_HOP_BY_HOP;
2965   return (0);
2966 }
2967
2968 VLIB_INIT_FUNCTION (ip6_hop_by_hop_init);
2969
2970 void
2971 ip6_hbh_set_next_override (uword next)
2972 {
2973   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2974
2975   hm->next_override = next;
2976 }
2977
2978 int
2979 ip6_hbh_register_option (u8 option,
2980                          int options (vlib_buffer_t * b, ip6_header_t * ip,
2981                                       ip6_hop_by_hop_option_t * opt),
2982                          u8 * trace (u8 * s, ip6_hop_by_hop_option_t * opt))
2983 {
2984   ip6_main_t *im = &ip6_main;
2985   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2986
2987   ASSERT (option < ARRAY_LEN (hm->options));
2988
2989   /* Already registered */
2990   if (hm->options[option])
2991     return (-1);
2992
2993   hm->options[option] = options;
2994   hm->trace[option] = trace;
2995
2996   /* Set global variable */
2997   im->hbh_enabled = 1;
2998
2999   return (0);
3000 }
3001
3002 int
3003 ip6_hbh_unregister_option (u8 option)
3004 {
3005   ip6_main_t *im = &ip6_main;
3006   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
3007
3008   ASSERT (option < ARRAY_LEN (hm->options));
3009
3010   /* Not registered */
3011   if (!hm->options[option])
3012     return (-1);
3013
3014   hm->options[option] = NULL;
3015   hm->trace[option] = NULL;
3016
3017   /* Disable global knob if this was the last option configured */
3018   int i;
3019   bool found = false;
3020   for (i = 0; i < 256; i++)
3021     {
3022       if (hm->options[option])
3023         {
3024           found = true;
3025           break;
3026         }
3027     }
3028   if (!found)
3029     im->hbh_enabled = 0;
3030
3031   return (0);
3032 }
3033
3034 /* Global IP6 main. */
3035 ip6_main_t ip6_main;
3036
3037 static clib_error_t *
3038 ip6_lookup_init (vlib_main_t * vm)
3039 {
3040   ip6_main_t *im = &ip6_main;
3041   clib_error_t *error;
3042   uword i;
3043
3044   if ((error = vlib_call_init_function (vm, vnet_feature_init)))
3045     return error;
3046
3047   for (i = 0; i < ARRAY_LEN (im->fib_masks); i++)
3048     {
3049       u32 j, i0, i1;
3050
3051       i0 = i / 32;
3052       i1 = i % 32;
3053
3054       for (j = 0; j < i0; j++)
3055         im->fib_masks[i].as_u32[j] = ~0;
3056
3057       if (i1)
3058         im->fib_masks[i].as_u32[i0] =
3059           clib_host_to_net_u32 (pow2_mask (i1) << (32 - i1));
3060     }
3061
3062   ip_lookup_init (&im->lookup_main, /* is_ip6 */ 1);
3063
3064   if (im->lookup_table_nbuckets == 0)
3065     im->lookup_table_nbuckets = IP6_FIB_DEFAULT_HASH_NUM_BUCKETS;
3066
3067   im->lookup_table_nbuckets = 1 << max_log2 (im->lookup_table_nbuckets);
3068
3069   if (im->lookup_table_size == 0)
3070     im->lookup_table_size = IP6_FIB_DEFAULT_HASH_MEMORY_SIZE;
3071
3072   BV (clib_bihash_init) (&(im->ip6_table[IP6_FIB_TABLE_FWDING].ip6_hash),
3073                          "ip6 FIB fwding table",
3074                          im->lookup_table_nbuckets, im->lookup_table_size);
3075   BV (clib_bihash_init) (&im->ip6_table[IP6_FIB_TABLE_NON_FWDING].ip6_hash,
3076                          "ip6 FIB non-fwding table",
3077                          im->lookup_table_nbuckets, im->lookup_table_size);
3078
3079   /* Create FIB with index 0 and table id of 0. */
3080   fib_table_find_or_create_and_lock (FIB_PROTOCOL_IP6, 0,
3081                                      FIB_SOURCE_DEFAULT_ROUTE);
3082   mfib_table_find_or_create_and_lock (FIB_PROTOCOL_IP6, 0,
3083                                       MFIB_SOURCE_DEFAULT_ROUTE);
3084
3085   {
3086     pg_node_t *pn;
3087     pn = pg_get_node (ip6_lookup_node.index);
3088     pn->unformat_edit = unformat_pg_ip6_header;
3089   }
3090
3091   /* Unless explicitly configured, don't process HBH options */
3092   im->hbh_enabled = 0;
3093
3094   {
3095     icmp6_neighbor_solicitation_header_t p;
3096
3097     memset (&p, 0, sizeof (p));
3098
3099     p.ip.ip_version_traffic_class_and_flow_label =
3100       clib_host_to_net_u32 (0x6 << 28);
3101     p.ip.payload_length =
3102       clib_host_to_net_u16 (sizeof (p) -
3103                             STRUCT_OFFSET_OF
3104                             (icmp6_neighbor_solicitation_header_t, neighbor));
3105     p.ip.protocol = IP_PROTOCOL_ICMP6;
3106     p.ip.hop_limit = 255;
3107     ip6_set_solicited_node_multicast_address (&p.ip.dst_address, 0);
3108
3109     p.neighbor.icmp.type = ICMP6_neighbor_solicitation;
3110
3111     p.link_layer_option.header.type =
3112       ICMP6_NEIGHBOR_DISCOVERY_OPTION_source_link_layer_address;
3113     p.link_layer_option.header.n_data_u64s =
3114       sizeof (p.link_layer_option) / sizeof (u64);
3115
3116     vlib_packet_template_init (vm,
3117                                &im->discover_neighbor_packet_template,
3118                                &p, sizeof (p),
3119                                /* alloc chunk size */ 8,
3120                                "ip6 neighbor discovery");
3121   }
3122
3123   return error;
3124 }
3125
3126 VLIB_INIT_FUNCTION (ip6_lookup_init);
3127
3128 void
3129 ip6_link_local_address_from_ethernet_mac_address (ip6_address_t * ip,
3130                                                   u8 * mac)
3131 {
3132   ip->as_u64[0] = clib_host_to_net_u64 (0xFE80000000000000ULL);
3133   /* Invert the "u" bit */
3134   ip->as_u8[8] = mac[0] ^ (1 << 1);
3135   ip->as_u8[9] = mac[1];
3136   ip->as_u8[10] = mac[2];
3137   ip->as_u8[11] = 0xFF;
3138   ip->as_u8[12] = 0xFE;
3139   ip->as_u8[13] = mac[3];
3140   ip->as_u8[14] = mac[4];
3141   ip->as_u8[15] = mac[5];
3142 }
3143
3144 void
3145 ip6_ethernet_mac_address_from_link_local_address (u8 * mac,
3146                                                   ip6_address_t * ip)
3147 {
3148   /* Invert the previously inverted "u" bit */
3149   mac[0] = ip->as_u8[8] ^ (1 << 1);
3150   mac[1] = ip->as_u8[9];
3151   mac[2] = ip->as_u8[10];
3152   mac[3] = ip->as_u8[13];
3153   mac[4] = ip->as_u8[14];
3154   mac[5] = ip->as_u8[15];
3155 }
3156
3157 static clib_error_t *
3158 test_ip6_link_command_fn (vlib_main_t * vm,
3159                           unformat_input_t * input, vlib_cli_command_t * cmd)
3160 {
3161   u8 mac[6];
3162   ip6_address_t _a, *a = &_a;
3163
3164   if (unformat (input, "%U", unformat_ethernet_address, mac))
3165     {
3166       ip6_link_local_address_from_ethernet_mac_address (a, mac);
3167       vlib_cli_output (vm, "Link local address: %U", format_ip6_address, a);
3168       ip6_ethernet_mac_address_from_link_local_address (mac, a);
3169       vlib_cli_output (vm, "Original MAC address: %U",
3170                        format_ethernet_address, mac);
3171     }
3172
3173   return 0;
3174 }
3175
3176 /*?
3177  * This command converts the given MAC Address into an IPv6 link-local
3178  * address.
3179  *
3180  * @cliexpar
3181  * Example of how to create an IPv6 link-local address:
3182  * @cliexstart{test ip6 link 16:d9:e0:91:79:86}
3183  * Link local address: fe80::14d9:e0ff:fe91:7986
3184  * Original MAC address: 16:d9:e0:91:79:86
3185  * @cliexend
3186 ?*/
3187 /* *INDENT-OFF* */
3188 VLIB_CLI_COMMAND (test_link_command, static) =
3189 {
3190   .path = "test ip6 link",
3191   .function = test_ip6_link_command_fn,
3192   .short_help = "test ip6 link <mac-address>",
3193 };
3194 /* *INDENT-ON* */
3195
3196 int
3197 vnet_set_ip6_flow_hash (u32 table_id, u32 flow_hash_config)
3198 {
3199   u32 fib_index;
3200
3201   fib_index = fib_table_find (FIB_PROTOCOL_IP6, table_id);
3202
3203   if (~0 == fib_index)
3204     return VNET_API_ERROR_NO_SUCH_FIB;
3205
3206   fib_table_set_flow_hash_config (fib_index, FIB_PROTOCOL_IP6,
3207                                   flow_hash_config);
3208
3209   return 0;
3210 }
3211
3212 static clib_error_t *
3213 set_ip6_flow_hash_command_fn (vlib_main_t * vm,
3214                               unformat_input_t * input,
3215                               vlib_cli_command_t * cmd)
3216 {
3217   int matched = 0;
3218   u32 table_id = 0;
3219   u32 flow_hash_config = 0;
3220   int rv;
3221
3222   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
3223     {
3224       if (unformat (input, "table %d", &table_id))
3225         matched = 1;
3226 #define _(a,v) \
3227     else if (unformat (input, #a)) { flow_hash_config |= v; matched=1;}
3228       foreach_flow_hash_bit
3229 #undef _
3230         else
3231         break;
3232     }
3233
3234   if (matched == 0)
3235     return clib_error_return (0, "unknown input `%U'",
3236                               format_unformat_error, input);
3237
3238   rv = vnet_set_ip6_flow_hash (table_id, flow_hash_config);
3239   switch (rv)
3240     {
3241     case 0:
3242       break;
3243
3244     case -1:
3245       return clib_error_return (0, "no such FIB table %d", table_id);
3246
3247     default:
3248       clib_warning ("BUG: illegal flow hash config 0x%x", flow_hash_config);
3249       break;
3250     }
3251
3252   return 0;
3253 }
3254
3255 /*?
3256  * Configure the set of IPv6 fields used by the flow hash.
3257  *
3258  * @cliexpar
3259  * @parblock
3260  * Example of how to set the flow hash on a given table:
3261  * @cliexcmd{set ip6 flow-hash table 8 dst sport dport proto}
3262  *
3263  * Example of display the configured flow hash:
3264  * @cliexstart{show ip6 fib}
3265  * ipv6-VRF:0, fib_index 0, flow hash: src dst sport dport proto
3266  * @::/0
3267  *   unicast-ip6-chain
3268  *   [@0]: dpo-load-balance: [index:5 buckets:1 uRPF:5 to:[0:0]]
3269  *     [0] [@0]: dpo-drop ip6
3270  * fe80::/10
3271  *   unicast-ip6-chain
3272  *   [@0]: dpo-load-balance: [index:10 buckets:1 uRPF:10 to:[0:0]]
3273  *     [0] [@2]: dpo-receive
3274  * ff02::1/128
3275  *   unicast-ip6-chain
3276  *   [@0]: dpo-load-balance: [index:8 buckets:1 uRPF:8 to:[0:0]]
3277  *     [0] [@2]: dpo-receive
3278  * ff02::2/128
3279  *   unicast-ip6-chain
3280  *   [@0]: dpo-load-balance: [index:7 buckets:1 uRPF:7 to:[0:0]]
3281  *     [0] [@2]: dpo-receive
3282  * ff02::16/128
3283  *   unicast-ip6-chain
3284  *   [@0]: dpo-load-balance: [index:9 buckets:1 uRPF:9 to:[0:0]]
3285  *     [0] [@2]: dpo-receive
3286  * ff02::1:ff00:0/104
3287  *   unicast-ip6-chain
3288  *   [@0]: dpo-load-balance: [index:6 buckets:1 uRPF:6 to:[0:0]]
3289  *     [0] [@2]: dpo-receive
3290  * ipv6-VRF:8, fib_index 1, flow hash: dst sport dport proto
3291  * @::/0
3292  *   unicast-ip6-chain
3293  *   [@0]: dpo-load-balance: [index:21 buckets:1 uRPF:20 to:[0:0]]
3294  *     [0] [@0]: dpo-drop ip6
3295  * @::a:1:1:0:4/126
3296  *   unicast-ip6-chain
3297  *   [@0]: dpo-load-balance: [index:27 buckets:1 uRPF:26 to:[0:0]]
3298  *     [0] [@4]: ipv6-glean: af_packet0
3299  * @::a:1:1:0:7/128
3300  *   unicast-ip6-chain
3301  *   [@0]: dpo-load-balance: [index:28 buckets:1 uRPF:27 to:[0:0]]
3302  *     [0] [@2]: dpo-receive: @::a:1:1:0:7 on af_packet0
3303  * fe80::/10
3304  *   unicast-ip6-chain
3305  *   [@0]: dpo-load-balance: [index:26 buckets:1 uRPF:25 to:[0:0]]
3306  *     [0] [@2]: dpo-receive
3307  * fe80::fe:3eff:fe3e:9222/128
3308  *   unicast-ip6-chain
3309  *   [@0]: dpo-load-balance: [index:29 buckets:1 uRPF:28 to:[0:0]]
3310  *     [0] [@2]: dpo-receive: fe80::fe:3eff:fe3e:9222 on af_packet0
3311  * ff02::1/128
3312  *   unicast-ip6-chain
3313  *   [@0]: dpo-load-balance: [index:24 buckets:1 uRPF:23 to:[0:0]]
3314  *     [0] [@2]: dpo-receive
3315  * ff02::2/128
3316  *   unicast-ip6-chain
3317  *   [@0]: dpo-load-balance: [index:23 buckets:1 uRPF:22 to:[0:0]]
3318  *     [0] [@2]: dpo-receive
3319  * ff02::16/128
3320  *   unicast-ip6-chain
3321  *   [@0]: dpo-load-balance: [index:25 buckets:1 uRPF:24 to:[0:0]]
3322  *     [0] [@2]: dpo-receive
3323  * ff02::1:ff00:0/104
3324  *   unicast-ip6-chain
3325  *   [@0]: dpo-load-balance: [index:22 buckets:1 uRPF:21 to:[0:0]]
3326  *     [0] [@2]: dpo-receive
3327  * @cliexend
3328  * @endparblock
3329 ?*/
3330 /* *INDENT-OFF* */
3331 VLIB_CLI_COMMAND (set_ip6_flow_hash_command, static) =
3332 {
3333   .path = "set ip6 flow-hash",
3334   .short_help =
3335   "set ip6 flow-hash table <table-id> [src] [dst] [sport] [dport] [proto] [reverse]",
3336   .function = set_ip6_flow_hash_command_fn,
3337 };
3338 /* *INDENT-ON* */
3339
3340 static clib_error_t *
3341 show_ip6_local_command_fn (vlib_main_t * vm,
3342                            unformat_input_t * input, vlib_cli_command_t * cmd)
3343 {
3344   ip6_main_t *im = &ip6_main;
3345   ip_lookup_main_t *lm = &im->lookup_main;
3346   int i;
3347
3348   vlib_cli_output (vm, "Protocols handled by ip6_local");
3349   for (i = 0; i < ARRAY_LEN (lm->local_next_by_ip_protocol); i++)
3350     {
3351       if (lm->local_next_by_ip_protocol[i] != IP_LOCAL_NEXT_PUNT)
3352         {
3353
3354           u32 node_index = vlib_get_node (vm,
3355                                           ip6_local_node.index)->
3356             next_nodes[lm->local_next_by_ip_protocol[i]];
3357           vlib_cli_output (vm, "%d: %U", i, format_vlib_node_name, vm,
3358                            node_index);
3359         }
3360     }
3361   return 0;
3362 }
3363
3364
3365
3366 /*?
3367  * Display the set of protocols handled by the local IPv6 stack.
3368  *
3369  * @cliexpar
3370  * Example of how to display local protocol table:
3371  * @cliexstart{show ip6 local}
3372  * Protocols handled by ip6_local
3373  * 17
3374  * 43
3375  * 58
3376  * 115
3377  * @cliexend
3378 ?*/
3379 /* *INDENT-OFF* */
3380 VLIB_CLI_COMMAND (show_ip6_local, static) =
3381 {
3382   .path = "show ip6 local",
3383   .function = show_ip6_local_command_fn,
3384   .short_help = "show ip6 local",
3385 };
3386 /* *INDENT-ON* */
3387
3388 int
3389 vnet_set_ip6_classify_intfc (vlib_main_t * vm, u32 sw_if_index,
3390                              u32 table_index)
3391 {
3392   vnet_main_t *vnm = vnet_get_main ();
3393   vnet_interface_main_t *im = &vnm->interface_main;
3394   ip6_main_t *ipm = &ip6_main;
3395   ip_lookup_main_t *lm = &ipm->lookup_main;
3396   vnet_classify_main_t *cm = &vnet_classify_main;
3397   ip6_address_t *if_addr;
3398
3399   if (pool_is_free_index (im->sw_interfaces, sw_if_index))
3400     return VNET_API_ERROR_NO_MATCHING_INTERFACE;
3401
3402   if (table_index != ~0 && pool_is_free_index (cm->tables, table_index))
3403     return VNET_API_ERROR_NO_SUCH_ENTRY;
3404
3405   vec_validate (lm->classify_table_index_by_sw_if_index, sw_if_index);
3406   lm->classify_table_index_by_sw_if_index[sw_if_index] = table_index;
3407
3408   if_addr = ip6_interface_first_address (ipm, sw_if_index);
3409
3410   if (NULL != if_addr)
3411     {
3412       fib_prefix_t pfx = {
3413         .fp_len = 128,
3414         .fp_proto = FIB_PROTOCOL_IP6,
3415         .fp_addr.ip6 = *if_addr,
3416       };
3417       u32 fib_index;
3418
3419       fib_index = fib_table_get_index_for_sw_if_index (FIB_PROTOCOL_IP4,
3420                                                        sw_if_index);
3421
3422
3423       if (table_index != (u32) ~ 0)
3424         {
3425           dpo_id_t dpo = DPO_INVALID;
3426
3427           dpo_set (&dpo,
3428                    DPO_CLASSIFY,
3429                    DPO_PROTO_IP6,
3430                    classify_dpo_create (DPO_PROTO_IP6, table_index));
3431
3432           fib_table_entry_special_dpo_add (fib_index,
3433                                            &pfx,
3434                                            FIB_SOURCE_CLASSIFY,
3435                                            FIB_ENTRY_FLAG_NONE, &dpo);
3436           dpo_reset (&dpo);
3437         }
3438       else
3439         {
3440           fib_table_entry_special_remove (fib_index,
3441                                           &pfx, FIB_SOURCE_CLASSIFY);
3442         }
3443     }
3444
3445   return 0;
3446 }
3447
3448 static clib_error_t *
3449 set_ip6_classify_command_fn (vlib_main_t * vm,
3450                              unformat_input_t * input,
3451                              vlib_cli_command_t * cmd)
3452 {
3453   u32 table_index = ~0;
3454   int table_index_set = 0;
3455   u32 sw_if_index = ~0;
3456   int rv;
3457
3458   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
3459     {
3460       if (unformat (input, "table-index %d", &table_index))
3461         table_index_set = 1;
3462       else if (unformat (input, "intfc %U", unformat_vnet_sw_interface,
3463                          vnet_get_main (), &sw_if_index))
3464         ;
3465       else
3466         break;
3467     }
3468
3469   if (table_index_set == 0)
3470     return clib_error_return (0, "classify table-index must be specified");
3471
3472   if (sw_if_index == ~0)
3473     return clib_error_return (0, "interface / subif must be specified");
3474
3475   rv = vnet_set_ip6_classify_intfc (vm, sw_if_index, table_index);
3476
3477   switch (rv)
3478     {
3479     case 0:
3480       break;
3481
3482     case VNET_API_ERROR_NO_MATCHING_INTERFACE:
3483       return clib_error_return (0, "No such interface");
3484
3485     case VNET_API_ERROR_NO_SUCH_ENTRY:
3486       return clib_error_return (0, "No such classifier table");
3487     }
3488   return 0;
3489 }
3490
3491 /*?
3492  * Assign a classification table to an interface. The classification
3493  * table is created using the '<em>classify table</em>' and '<em>classify session</em>'
3494  * commands. Once the table is create, use this command to filter packets
3495  * on an interface.
3496  *
3497  * @cliexpar
3498  * Example of how to assign a classification table to an interface:
3499  * @cliexcmd{set ip6 classify intfc GigabitEthernet2/0/0 table-index 1}
3500 ?*/
3501 /* *INDENT-OFF* */
3502 VLIB_CLI_COMMAND (set_ip6_classify_command, static) =
3503 {
3504   .path = "set ip6 classify",
3505   .short_help =
3506   "set ip6 classify intfc <interface> table-index <classify-idx>",
3507   .function = set_ip6_classify_command_fn,
3508 };
3509 /* *INDENT-ON* */
3510
3511 static clib_error_t *
3512 ip6_config (vlib_main_t * vm, unformat_input_t * input)
3513 {
3514   ip6_main_t *im = &ip6_main;
3515   uword heapsize = 0;
3516   u32 tmp;
3517   u32 nbuckets = 0;
3518
3519   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
3520     {
3521       if (unformat (input, "hash-buckets %d", &tmp))
3522         nbuckets = tmp;
3523       else if (unformat (input, "heap-size %dm", &tmp))
3524         heapsize = ((u64) tmp) << 20;
3525       else if (unformat (input, "heap-size %dM", &tmp))
3526         heapsize = ((u64) tmp) << 20;
3527       else if (unformat (input, "heap-size %dg", &tmp))
3528         heapsize = ((u64) tmp) << 30;
3529       else if (unformat (input, "heap-size %dG", &tmp))
3530         heapsize = ((u64) tmp) << 30;
3531       else
3532         return clib_error_return (0, "unknown input '%U'",
3533                                   format_unformat_error, input);
3534     }
3535
3536   im->lookup_table_nbuckets = nbuckets;
3537   im->lookup_table_size = heapsize;
3538
3539   return 0;
3540 }
3541
3542 VLIB_EARLY_CONFIG_FUNCTION (ip6_config, "ip6");
3543
3544 /*
3545  * fd.io coding-style-patch-verification: ON
3546  *
3547  * Local Variables:
3548  * eval: (c-set-style "gnu")
3549  * End:
3550  */