src/vnet/ip/ip6_forward.c

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