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