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