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_w_cfg_index
1897                   (lm->output_feature_arc_index, tx_sw_if_index0, &next0, p0,
1898                    adj0->ia_cfg_index);
1899             }
1900           else
1901             {
1902               p0->error = error_node->errors[error0];
1903             }
1904           if (PREDICT_TRUE (error1 == IP6_ERROR_NONE))
1905             {
1906               p1->current_data -= rw_len1;
1907               p1->current_length += rw_len1;
1908
1909               tx_sw_if_index1 = adj1[0].rewrite_header.sw_if_index;
1910               vnet_buffer (p1)->sw_if_index[VLIB_TX] = tx_sw_if_index1;
1911               next1 = adj1[0].rewrite_header.next_index;
1912
1913               if (PREDICT_FALSE
1914                   (adj1[0].rewrite_header.flags & VNET_REWRITE_HAS_FEATURES))
1915                 vnet_feature_arc_start_w_cfg_index
1916                   (lm->output_feature_arc_index, tx_sw_if_index1, &next1, p1,
1917                    adj1->ia_cfg_index);
1918             }
1919           else
1920             {
1921               p1->error = error_node->errors[error1];
1922             }
1923
1924           if (is_midchain)
1925             {
1926               /* before we paint on the next header, update the L4
1927                * checksums if required, since there's no offload on a tunnel */
1928               vnet_calc_checksums_inline (vm, p0, 0 /* is_ip4 */ ,
1929                                           1 /* is_ip6 */ ,
1930                                           0 /* with gso */ );
1931               vnet_calc_checksums_inline (vm, p1, 0 /* is_ip4 */ ,
1932                                           1 /* is_ip6 */ ,
1933                                           0 /* with gso */ );
1934
1935               /* Guess we are only writing on ipv6 header. */
1936               vnet_rewrite_two_headers (adj0[0], adj1[0],
1937                                         ip0, ip1, sizeof (ip6_header_t));
1938             }
1939           else
1940             /* Guess we are only writing on simple Ethernet header. */
1941             vnet_rewrite_two_headers (adj0[0], adj1[0],
1942                                       ip0, ip1, sizeof (ethernet_header_t));
1943
1944           if (is_midchain)
1945             {
1946               if (adj0->sub_type.midchain.fixup_func)
1947                 adj0->sub_type.midchain.fixup_func
1948                   (vm, adj0, p0, adj0->sub_type.midchain.fixup_data);
1949               if (adj1->sub_type.midchain.fixup_func)
1950                 adj1->sub_type.midchain.fixup_func
1951                   (vm, adj1, p1, adj1->sub_type.midchain.fixup_data);
1952             }
1953           if (is_mcast)
1954             {
1955               /*
1956                * copy bytes from the IP address into the MAC rewrite
1957                */
1958               vnet_ip_mcast_fixup_header (IP6_MCAST_ADDR_MASK,
1959                                           adj0->
1960                                           rewrite_header.dst_mcast_offset,
1961                                           &ip0->dst_address.as_u32[3],
1962                                           (u8 *) ip0);
1963               vnet_ip_mcast_fixup_header (IP6_MCAST_ADDR_MASK,
1964                                           adj1->
1965                                           rewrite_header.dst_mcast_offset,
1966                                           &ip1->dst_address.as_u32[3],
1967                                           (u8 *) ip1);
1968             }
1969
1970           vlib_validate_buffer_enqueue_x2 (vm, node, next_index,
1971                                            to_next, n_left_to_next,
1972                                            pi0, pi1, next0, next1);
1973         }
1974
1975       while (n_left_from > 0 && n_left_to_next > 0)
1976         {
1977           ip_adjacency_t *adj0;
1978           vlib_buffer_t *p0;
1979           ip6_header_t *ip0;
1980           u32 pi0, rw_len0;
1981           u32 adj_index0, next0, error0;
1982           u32 tx_sw_if_index0;
1983           bool is_locally_originated0;
1984
1985           pi0 = to_next[0] = from[0];
1986
1987           p0 = vlib_get_buffer (vm, pi0);
1988
1989           adj_index0 = vnet_buffer (p0)->ip.adj_index[VLIB_TX];
1990
1991           adj0 = adj_get (adj_index0);
1992
1993           ip0 = vlib_buffer_get_current (p0);
1994
1995           error0 = IP6_ERROR_NONE;
1996           next0 = IP6_REWRITE_NEXT_DROP;
1997
1998           /* Check hop limit */
1999           is_locally_originated0 =
2000             p0->flags & VNET_BUFFER_F_LOCALLY_ORIGINATED;
2001           if (PREDICT_TRUE (!is_locally_originated0))
2002             {
2003               i32 hop_limit0 = ip0->hop_limit;
2004
2005               ASSERT (ip0->hop_limit > 0);
2006
2007               hop_limit0 -= 1;
2008
2009               ip0->hop_limit = hop_limit0;
2010
2011               if (PREDICT_FALSE (hop_limit0 <= 0))
2012                 {
2013                   /*
2014                    * If the hop count drops below 1 when forwarding, generate
2015                    * an ICMP response.
2016                    */
2017                   error0 = IP6_ERROR_TIME_EXPIRED;
2018                   next0 = IP6_REWRITE_NEXT_ICMP_ERROR;
2019                   vnet_buffer (p0)->sw_if_index[VLIB_TX] = (u32) ~ 0;
2020                   icmp6_error_set_vnet_buffer (p0, ICMP6_time_exceeded,
2021                                                ICMP6_time_exceeded_ttl_exceeded_in_transit,
2022                                                0);
2023                 }
2024             }
2025
2026           if (is_midchain)
2027             {
2028               vnet_calc_checksums_inline (vm, p0, 0 /* is_ip4 */ ,
2029                                           1 /* is_ip6 */ ,
2030                                           0 /* with gso */ );
2031
2032               /* Guess we are only writing on ip6 header. */
2033               vnet_rewrite_one_header (adj0[0], ip0, sizeof (ip6_header_t));
2034             }
2035           else
2036             /* Guess we are only writing on simple Ethernet header. */
2037             vnet_rewrite_one_header (adj0[0], ip0,
2038                                      sizeof (ethernet_header_t));
2039
2040           /* Update packet buffer attributes/set output interface. */
2041           rw_len0 = adj0[0].rewrite_header.data_bytes;
2042           vnet_buffer (p0)->ip.save_rewrite_length = rw_len0;
2043
2044           if (do_counters)
2045             {
2046               vlib_increment_combined_counter
2047                 (&adjacency_counters,
2048                  thread_index, adj_index0, 1,
2049                  vlib_buffer_length_in_chain (vm, p0) + rw_len0);
2050             }
2051
2052           /* Check MTU of outgoing interface. */
2053           u16 ip0_len =
2054             clib_net_to_host_u16 (ip0->payload_length) +
2055             sizeof (ip6_header_t);
2056           if (p0->flags & VNET_BUFFER_F_GSO)
2057             ip0_len = gso_mtu_sz (p0);
2058
2059           ip6_mtu_check (p0, ip0_len,
2060                          adj0[0].rewrite_header.max_l3_packet_bytes,
2061                          is_locally_originated0, &next0, is_midchain,
2062                          &error0);
2063
2064           /* Don't adjust the buffer for hop count issue; icmp-error node
2065            * wants to see the IP header */
2066           if (PREDICT_TRUE (error0 == IP6_ERROR_NONE))
2067             {
2068               p0->current_data -= rw_len0;
2069               p0->current_length += rw_len0;
2070
2071               tx_sw_if_index0 = adj0[0].rewrite_header.sw_if_index;
2072
2073               vnet_buffer (p0)->sw_if_index[VLIB_TX] = tx_sw_if_index0;
2074               next0 = adj0[0].rewrite_header.next_index;
2075
2076               if (PREDICT_FALSE
2077                   (adj0[0].rewrite_header.flags & VNET_REWRITE_HAS_FEATURES))
2078                 vnet_feature_arc_start_w_cfg_index
2079                   (lm->output_feature_arc_index, tx_sw_if_index0, &next0, p0,
2080                    adj0->ia_cfg_index);
2081             }
2082           else
2083             {
2084               p0->error = error_node->errors[error0];
2085             }
2086
2087           if (is_midchain)
2088             {
2089               if (adj0->sub_type.midchain.fixup_func)
2090                 adj0->sub_type.midchain.fixup_func
2091                   (vm, adj0, p0, adj0->sub_type.midchain.fixup_data);
2092             }
2093           if (is_mcast)
2094             {
2095               vnet_ip_mcast_fixup_header (IP6_MCAST_ADDR_MASK,
2096                                           adj0->
2097                                           rewrite_header.dst_mcast_offset,
2098                                           &ip0->dst_address.as_u32[3],
2099                                           (u8 *) ip0);
2100             }
2101
2102           from += 1;
2103           n_left_from -= 1;
2104           to_next += 1;
2105           n_left_to_next -= 1;
2106
2107           vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
2108                                            to_next, n_left_to_next,
2109                                            pi0, next0);
2110         }
2111
2112       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
2113     }
2114
2115   /* Need to do trace after rewrites to pick up new packet data. */
2116   if (node->flags & VLIB_NODE_FLAG_TRACE)
2117     ip6_forward_next_trace (vm, node, frame, VLIB_TX);
2118
2119   return frame->n_vectors;
2120 }
2121
2122 always_inline uword
2123 ip6_rewrite_inline (vlib_main_t * vm,
2124                     vlib_node_runtime_t * node,
2125                     vlib_frame_t * frame,
2126                     int do_counters, int is_midchain, int is_mcast)
2127 {
2128   return ip6_rewrite_inline_with_gso (vm, node, frame, do_counters,
2129                                       is_midchain, is_mcast);
2130 }
2131
2132 VLIB_NODE_FN (ip6_rewrite_node) (vlib_main_t * vm,
2133                                  vlib_node_runtime_t * node,
2134                                  vlib_frame_t * frame)
2135 {
2136   if (adj_are_counters_enabled ())
2137     return ip6_rewrite_inline (vm, node, frame, 1, 0, 0);
2138   else
2139     return ip6_rewrite_inline (vm, node, frame, 0, 0, 0);
2140 }
2141
2142 VLIB_NODE_FN (ip6_rewrite_bcast_node) (vlib_main_t * vm,
2143                                        vlib_node_runtime_t * node,
2144                                        vlib_frame_t * frame)
2145 {
2146   if (adj_are_counters_enabled ())
2147     return ip6_rewrite_inline (vm, node, frame, 1, 0, 0);
2148   else
2149     return ip6_rewrite_inline (vm, node, frame, 0, 0, 0);
2150 }
2151
2152 VLIB_NODE_FN (ip6_rewrite_mcast_node) (vlib_main_t * vm,
2153                                        vlib_node_runtime_t * node,
2154                                        vlib_frame_t * frame)
2155 {
2156   if (adj_are_counters_enabled ())
2157     return ip6_rewrite_inline (vm, node, frame, 1, 0, 1);
2158   else
2159     return ip6_rewrite_inline (vm, node, frame, 0, 0, 1);
2160 }
2161
2162 VLIB_NODE_FN (ip6_midchain_node) (vlib_main_t * vm,
2163                                   vlib_node_runtime_t * node,
2164                                   vlib_frame_t * frame)
2165 {
2166   if (adj_are_counters_enabled ())
2167     return ip6_rewrite_inline (vm, node, frame, 1, 1, 0);
2168   else
2169     return ip6_rewrite_inline (vm, node, frame, 0, 1, 0);
2170 }
2171
2172 VLIB_NODE_FN (ip6_mcast_midchain_node) (vlib_main_t * vm,
2173                                         vlib_node_runtime_t * node,
2174                                         vlib_frame_t * frame)
2175 {
2176   if (adj_are_counters_enabled ())
2177     return ip6_rewrite_inline (vm, node, frame, 1, 1, 1);
2178   else
2179     return ip6_rewrite_inline (vm, node, frame, 0, 1, 1);
2180 }
2181
2182 /* *INDENT-OFF* */
2183 VLIB_REGISTER_NODE (ip6_midchain_node) =
2184 {
2185   .name = "ip6-midchain",
2186   .vector_size = sizeof (u32),
2187   .format_trace = format_ip6_forward_next_trace,
2188   .sibling_of = "ip6-rewrite",
2189   };
2190
2191 VLIB_REGISTER_NODE (ip6_rewrite_node) =
2192 {
2193   .name = "ip6-rewrite",
2194   .vector_size = sizeof (u32),
2195   .format_trace = format_ip6_rewrite_trace,
2196   .n_next_nodes = IP6_REWRITE_N_NEXT,
2197   .next_nodes =
2198   {
2199     [IP6_REWRITE_NEXT_DROP] = "ip6-drop",
2200     [IP6_REWRITE_NEXT_ICMP_ERROR] = "ip6-icmp-error",
2201     [IP6_REWRITE_NEXT_FRAGMENT] = "ip6-frag",
2202   },
2203 };
2204
2205 VLIB_REGISTER_NODE (ip6_rewrite_bcast_node) = {
2206   .name = "ip6-rewrite-bcast",
2207   .vector_size = sizeof (u32),
2208
2209   .format_trace = format_ip6_rewrite_trace,
2210   .sibling_of = "ip6-rewrite",
2211 };
2212
2213 VLIB_REGISTER_NODE (ip6_rewrite_mcast_node) =
2214 {
2215   .name = "ip6-rewrite-mcast",
2216   .vector_size = sizeof (u32),
2217   .format_trace = format_ip6_rewrite_trace,
2218   .sibling_of = "ip6-rewrite",
2219 };
2220
2221
2222 VLIB_REGISTER_NODE (ip6_mcast_midchain_node) =
2223 {
2224   .name = "ip6-mcast-midchain",
2225   .vector_size = sizeof (u32),
2226   .format_trace = format_ip6_rewrite_trace,
2227   .sibling_of = "ip6-rewrite",
2228 };
2229
2230 /* *INDENT-ON* */
2231
2232 /*
2233  * Hop-by-Hop handling
2234  */
2235 #ifndef CLIB_MARCH_VARIANT
2236 ip6_hop_by_hop_main_t ip6_hop_by_hop_main;
2237 #endif /* CLIB_MARCH_VARIANT */
2238
2239 #define foreach_ip6_hop_by_hop_error \
2240 _(PROCESSED, "pkts with ip6 hop-by-hop options") \
2241 _(FORMAT, "incorrectly formatted hop-by-hop options") \
2242 _(UNKNOWN_OPTION, "unknown ip6 hop-by-hop options")
2243
2244 /* *INDENT-OFF* */
2245 typedef enum
2246 {
2247 #define _(sym,str) IP6_HOP_BY_HOP_ERROR_##sym,
2248   foreach_ip6_hop_by_hop_error
2249 #undef _
2250   IP6_HOP_BY_HOP_N_ERROR,
2251 } ip6_hop_by_hop_error_t;
2252 /* *INDENT-ON* */
2253
2254 /*
2255  * Primary h-b-h handler trace support
2256  * We work pretty hard on the problem for obvious reasons
2257  */
2258 typedef struct
2259 {
2260   u32 next_index;
2261   u32 trace_len;
2262   u8 option_data[256];
2263 } ip6_hop_by_hop_trace_t;
2264
2265 extern vlib_node_registration_t ip6_hop_by_hop_node;
2266
2267 static char *ip6_hop_by_hop_error_strings[] = {
2268 #define _(sym,string) string,
2269   foreach_ip6_hop_by_hop_error
2270 #undef _
2271 };
2272
2273 #ifndef CLIB_MARCH_VARIANT
2274 u8 *
2275 format_ip6_hop_by_hop_ext_hdr (u8 * s, va_list * args)
2276 {
2277   ip6_hop_by_hop_header_t *hbh0 = va_arg (*args, ip6_hop_by_hop_header_t *);
2278   int total_len = va_arg (*args, int);
2279   ip6_hop_by_hop_option_t *opt0, *limit0;
2280   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2281   u8 type0;
2282
2283   s = format (s, "IP6_HOP_BY_HOP: next protocol %d len %d total %d",
2284               hbh0->protocol, (hbh0->length + 1) << 3, total_len);
2285
2286   opt0 = (ip6_hop_by_hop_option_t *) (hbh0 + 1);
2287   limit0 = (ip6_hop_by_hop_option_t *) ((u8 *) hbh0 + total_len);
2288
2289   while (opt0 < limit0)
2290     {
2291       type0 = opt0->type;
2292       switch (type0)
2293         {
2294         case 0:         /* Pad, just stop */
2295           opt0 = (ip6_hop_by_hop_option_t *) ((u8 *) opt0 + 1);
2296           break;
2297
2298         default:
2299           if (hm->trace[type0])
2300             {
2301               s = (*hm->trace[type0]) (s, opt0);
2302             }
2303           else
2304             {
2305               s =
2306                 format (s, "\n    unrecognized option %d length %d", type0,
2307                         opt0->length);
2308             }
2309           opt0 =
2310             (ip6_hop_by_hop_option_t *) (((u8 *) opt0) + opt0->length +
2311                                          sizeof (ip6_hop_by_hop_option_t));
2312           break;
2313         }
2314     }
2315   return s;
2316 }
2317 #endif
2318
2319 static u8 *
2320 format_ip6_hop_by_hop_trace (u8 * s, va_list * args)
2321 {
2322   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
2323   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
2324   ip6_hop_by_hop_trace_t *t = va_arg (*args, ip6_hop_by_hop_trace_t *);
2325   ip6_hop_by_hop_header_t *hbh0;
2326   ip6_hop_by_hop_option_t *opt0, *limit0;
2327   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2328
2329   u8 type0;
2330
2331   hbh0 = (ip6_hop_by_hop_header_t *) t->option_data;
2332
2333   s = format (s, "IP6_HOP_BY_HOP: next index %d len %d traced %d",
2334               t->next_index, (hbh0->length + 1) << 3, t->trace_len);
2335
2336   opt0 = (ip6_hop_by_hop_option_t *) (hbh0 + 1);
2337   limit0 = (ip6_hop_by_hop_option_t *) ((u8 *) hbh0) + t->trace_len;
2338
2339   while (opt0 < limit0)
2340     {
2341       type0 = opt0->type;
2342       switch (type0)
2343         {
2344         case 0:         /* Pad, just stop */
2345           opt0 = (ip6_hop_by_hop_option_t *) ((u8 *) opt0) + 1;
2346           break;
2347
2348         default:
2349           if (hm->trace[type0])
2350             {
2351               s = (*hm->trace[type0]) (s, opt0);
2352             }
2353           else
2354             {
2355               s =
2356                 format (s, "\n    unrecognized option %d length %d", type0,
2357                         opt0->length);
2358             }
2359           opt0 =
2360             (ip6_hop_by_hop_option_t *) (((u8 *) opt0) + opt0->length +
2361                                          sizeof (ip6_hop_by_hop_option_t));
2362           break;
2363         }
2364     }
2365   return s;
2366 }
2367
2368 always_inline u8
2369 ip6_scan_hbh_options (vlib_buffer_t * b0,
2370                       ip6_header_t * ip0,
2371                       ip6_hop_by_hop_header_t * hbh0,
2372                       ip6_hop_by_hop_option_t * opt0,
2373                       ip6_hop_by_hop_option_t * limit0, u32 * next0)
2374 {
2375   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2376   u8 type0;
2377   u8 error0 = 0;
2378
2379   while (opt0 < limit0)
2380     {
2381       type0 = opt0->type;
2382       switch (type0)
2383         {
2384         case 0:         /* Pad1 */
2385           opt0 = (ip6_hop_by_hop_option_t *) ((u8 *) opt0) + 1;
2386           continue;
2387         case 1:         /* PadN */
2388           break;
2389         default:
2390           if (hm->options[type0])
2391             {
2392               if ((*hm->options[type0]) (b0, ip0, opt0) < 0)
2393                 {
2394                   error0 = IP6_HOP_BY_HOP_ERROR_FORMAT;
2395                   return (error0);
2396                 }
2397             }
2398           else
2399             {
2400               /* Unrecognized mandatory option, check the two high order bits */
2401               switch (opt0->type & HBH_OPTION_TYPE_HIGH_ORDER_BITS)
2402                 {
2403                 case HBH_OPTION_TYPE_SKIP_UNKNOWN:
2404                   break;
2405                 case HBH_OPTION_TYPE_DISCARD_UNKNOWN:
2406                   error0 = IP6_HOP_BY_HOP_ERROR_UNKNOWN_OPTION;
2407                   *next0 = IP_LOOKUP_NEXT_DROP;
2408                   break;
2409                 case HBH_OPTION_TYPE_DISCARD_UNKNOWN_ICMP:
2410                   error0 = IP6_HOP_BY_HOP_ERROR_UNKNOWN_OPTION;
2411                   *next0 = IP_LOOKUP_NEXT_ICMP_ERROR;
2412                   icmp6_error_set_vnet_buffer (b0, ICMP6_parameter_problem,
2413                                                ICMP6_parameter_problem_unrecognized_option,
2414                                                (u8 *) opt0 - (u8 *) ip0);
2415                   break;
2416                 case HBH_OPTION_TYPE_DISCARD_UNKNOWN_ICMP_NOT_MCAST:
2417                   error0 = IP6_HOP_BY_HOP_ERROR_UNKNOWN_OPTION;
2418                   if (!ip6_address_is_multicast (&ip0->dst_address))
2419                     {
2420                       *next0 = IP_LOOKUP_NEXT_ICMP_ERROR;
2421                       icmp6_error_set_vnet_buffer (b0,
2422                                                    ICMP6_parameter_problem,
2423                                                    ICMP6_parameter_problem_unrecognized_option,
2424                                                    (u8 *) opt0 - (u8 *) ip0);
2425                     }
2426                   else
2427                     {
2428                       *next0 = IP_LOOKUP_NEXT_DROP;
2429                     }
2430                   break;
2431                 }
2432               return (error0);
2433             }
2434         }
2435       opt0 =
2436         (ip6_hop_by_hop_option_t *) (((u8 *) opt0) + opt0->length +
2437                                      sizeof (ip6_hop_by_hop_option_t));
2438     }
2439   return (error0);
2440 }
2441
2442 /*
2443  * Process the Hop-by-Hop Options header
2444  */
2445 VLIB_NODE_FN (ip6_hop_by_hop_node) (vlib_main_t * vm,
2446                                     vlib_node_runtime_t * node,
2447                                     vlib_frame_t * frame)
2448 {
2449   vlib_node_runtime_t *error_node =
2450     vlib_node_get_runtime (vm, ip6_hop_by_hop_node.index);
2451   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2452   u32 n_left_from, *from, *to_next;
2453   ip_lookup_next_t next_index;
2454
2455   from = vlib_frame_vector_args (frame);
2456   n_left_from = frame->n_vectors;
2457   next_index = node->cached_next_index;
2458
2459   while (n_left_from > 0)
2460     {
2461       u32 n_left_to_next;
2462
2463       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
2464
2465       while (n_left_from >= 4 && n_left_to_next >= 2)
2466         {
2467           u32 bi0, bi1;
2468           vlib_buffer_t *b0, *b1;
2469           u32 next0, next1;
2470           ip6_header_t *ip0, *ip1;
2471           ip6_hop_by_hop_header_t *hbh0, *hbh1;
2472           ip6_hop_by_hop_option_t *opt0, *limit0, *opt1, *limit1;
2473           u8 error0 = 0, error1 = 0;
2474
2475           /* Prefetch next iteration. */
2476           {
2477             vlib_buffer_t *p2, *p3;
2478
2479             p2 = vlib_get_buffer (vm, from[2]);
2480             p3 = vlib_get_buffer (vm, from[3]);
2481
2482             vlib_prefetch_buffer_header (p2, LOAD);
2483             vlib_prefetch_buffer_header (p3, LOAD);
2484
2485             CLIB_PREFETCH (p2->data, 2 * CLIB_CACHE_LINE_BYTES, LOAD);
2486             CLIB_PREFETCH (p3->data, 2 * CLIB_CACHE_LINE_BYTES, LOAD);
2487           }
2488
2489           /* Speculatively enqueue b0, b1 to the current next frame */
2490           to_next[0] = bi0 = from[0];
2491           to_next[1] = bi1 = from[1];
2492           from += 2;
2493           to_next += 2;
2494           n_left_from -= 2;
2495           n_left_to_next -= 2;
2496
2497           b0 = vlib_get_buffer (vm, bi0);
2498           b1 = vlib_get_buffer (vm, bi1);
2499
2500           /* Default use the next_index from the adjacency. A HBH option rarely redirects to a different node */
2501           u32 adj_index0 = vnet_buffer (b0)->ip.adj_index[VLIB_TX];
2502           ip_adjacency_t *adj0 = adj_get (adj_index0);
2503           u32 adj_index1 = vnet_buffer (b1)->ip.adj_index[VLIB_TX];
2504           ip_adjacency_t *adj1 = adj_get (adj_index1);
2505
2506           /* Default use the next_index from the adjacency. A HBH option rarely redirects to a different node */
2507           next0 = adj0->lookup_next_index;
2508           next1 = adj1->lookup_next_index;
2509
2510           ip0 = vlib_buffer_get_current (b0);
2511           ip1 = vlib_buffer_get_current (b1);
2512           hbh0 = (ip6_hop_by_hop_header_t *) (ip0 + 1);
2513           hbh1 = (ip6_hop_by_hop_header_t *) (ip1 + 1);
2514           opt0 = (ip6_hop_by_hop_option_t *) (hbh0 + 1);
2515           opt1 = (ip6_hop_by_hop_option_t *) (hbh1 + 1);
2516           limit0 =
2517             (ip6_hop_by_hop_option_t *) ((u8 *) hbh0 +
2518                                          ((hbh0->length + 1) << 3));
2519           limit1 =
2520             (ip6_hop_by_hop_option_t *) ((u8 *) hbh1 +
2521                                          ((hbh1->length + 1) << 3));
2522
2523           /*
2524            * Basic validity checks
2525            */
2526           if ((hbh0->length + 1) << 3 >
2527               clib_net_to_host_u16 (ip0->payload_length))
2528             {
2529               error0 = IP6_HOP_BY_HOP_ERROR_FORMAT;
2530               next0 = IP_LOOKUP_NEXT_DROP;
2531               goto outdual;
2532             }
2533           /* Scan the set of h-b-h options, process ones that we understand */
2534           error0 = ip6_scan_hbh_options (b0, ip0, hbh0, opt0, limit0, &next0);
2535
2536           if ((hbh1->length + 1) << 3 >
2537               clib_net_to_host_u16 (ip1->payload_length))
2538             {
2539               error1 = IP6_HOP_BY_HOP_ERROR_FORMAT;
2540               next1 = IP_LOOKUP_NEXT_DROP;
2541               goto outdual;
2542             }
2543           /* Scan the set of h-b-h options, process ones that we understand */
2544           error1 = ip6_scan_hbh_options (b1, ip1, hbh1, opt1, limit1, &next1);
2545
2546         outdual:
2547           /* Has the classifier flagged this buffer for special treatment? */
2548           if (PREDICT_FALSE
2549               ((error0 == 0)
2550                && (vnet_buffer (b0)->l2_classify.opaque_index & OI_DECAP)))
2551             next0 = hm->next_override;
2552
2553           /* Has the classifier flagged this buffer for special treatment? */
2554           if (PREDICT_FALSE
2555               ((error1 == 0)
2556                && (vnet_buffer (b1)->l2_classify.opaque_index & OI_DECAP)))
2557             next1 = hm->next_override;
2558
2559           if (PREDICT_FALSE ((node->flags & VLIB_NODE_FLAG_TRACE)))
2560             {
2561               if (b0->flags & VLIB_BUFFER_IS_TRACED)
2562                 {
2563                   ip6_hop_by_hop_trace_t *t =
2564                     vlib_add_trace (vm, node, b0, sizeof (*t));
2565                   u32 trace_len = (hbh0->length + 1) << 3;
2566                   t->next_index = next0;
2567                   /* Capture the h-b-h option verbatim */
2568                   trace_len =
2569                     trace_len <
2570                     ARRAY_LEN (t->option_data) ? trace_len :
2571                     ARRAY_LEN (t->option_data);
2572                   t->trace_len = trace_len;
2573                   clib_memcpy_fast (t->option_data, hbh0, trace_len);
2574                 }
2575               if (b1->flags & VLIB_BUFFER_IS_TRACED)
2576                 {
2577                   ip6_hop_by_hop_trace_t *t =
2578                     vlib_add_trace (vm, node, b1, sizeof (*t));
2579                   u32 trace_len = (hbh1->length + 1) << 3;
2580                   t->next_index = next1;
2581                   /* Capture the h-b-h option verbatim */
2582                   trace_len =
2583                     trace_len <
2584                     ARRAY_LEN (t->option_data) ? trace_len :
2585                     ARRAY_LEN (t->option_data);
2586                   t->trace_len = trace_len;
2587                   clib_memcpy_fast (t->option_data, hbh1, trace_len);
2588                 }
2589
2590             }
2591
2592           b0->error = error_node->errors[error0];
2593           b1->error = error_node->errors[error1];
2594
2595           /* verify speculative enqueue, maybe switch current next frame */
2596           vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next,
2597                                            n_left_to_next, bi0, bi1, next0,
2598                                            next1);
2599         }
2600
2601       while (n_left_from > 0 && n_left_to_next > 0)
2602         {
2603           u32 bi0;
2604           vlib_buffer_t *b0;
2605           u32 next0;
2606           ip6_header_t *ip0;
2607           ip6_hop_by_hop_header_t *hbh0;
2608           ip6_hop_by_hop_option_t *opt0, *limit0;
2609           u8 error0 = 0;
2610
2611           /* Speculatively enqueue b0 to the current next frame */
2612           bi0 = from[0];
2613           to_next[0] = bi0;
2614           from += 1;
2615           to_next += 1;
2616           n_left_from -= 1;
2617           n_left_to_next -= 1;
2618
2619           b0 = vlib_get_buffer (vm, bi0);
2620           /*
2621            * Default use the next_index from the adjacency.
2622            * A HBH option rarely redirects to a different node
2623            */
2624           u32 adj_index0 = vnet_buffer (b0)->ip.adj_index[VLIB_TX];
2625           ip_adjacency_t *adj0 = adj_get (adj_index0);
2626           next0 = adj0->lookup_next_index;
2627
2628           ip0 = vlib_buffer_get_current (b0);
2629           hbh0 = (ip6_hop_by_hop_header_t *) (ip0 + 1);
2630           opt0 = (ip6_hop_by_hop_option_t *) (hbh0 + 1);
2631           limit0 =
2632             (ip6_hop_by_hop_option_t *) ((u8 *) hbh0 +
2633                                          ((hbh0->length + 1) << 3));
2634
2635           /*
2636            * Basic validity checks
2637            */
2638           if ((hbh0->length + 1) << 3 >
2639               clib_net_to_host_u16 (ip0->payload_length))
2640             {
2641               error0 = IP6_HOP_BY_HOP_ERROR_FORMAT;
2642               next0 = IP_LOOKUP_NEXT_DROP;
2643               goto out0;
2644             }
2645
2646           /* Scan the set of h-b-h options, process ones that we understand */
2647           error0 = ip6_scan_hbh_options (b0, ip0, hbh0, opt0, limit0, &next0);
2648
2649         out0:
2650           /* Has the classifier flagged this buffer for special treatment? */
2651           if (PREDICT_FALSE
2652               ((error0 == 0)
2653                && (vnet_buffer (b0)->l2_classify.opaque_index & OI_DECAP)))
2654             next0 = hm->next_override;
2655
2656           if (PREDICT_FALSE (b0->flags & VLIB_BUFFER_IS_TRACED))
2657             {
2658               ip6_hop_by_hop_trace_t *t =
2659                 vlib_add_trace (vm, node, b0, sizeof (*t));
2660               u32 trace_len = (hbh0->length + 1) << 3;
2661               t->next_index = next0;
2662               /* Capture the h-b-h option verbatim */
2663               trace_len =
2664                 trace_len <
2665                 ARRAY_LEN (t->option_data) ? trace_len :
2666                 ARRAY_LEN (t->option_data);
2667               t->trace_len = trace_len;
2668               clib_memcpy_fast (t->option_data, hbh0, trace_len);
2669             }
2670
2671           b0->error = error_node->errors[error0];
2672
2673           /* verify speculative enqueue, maybe switch current next frame */
2674           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
2675                                            n_left_to_next, bi0, next0);
2676         }
2677       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
2678     }
2679   return frame->n_vectors;
2680 }
2681
2682 /* *INDENT-OFF* */
2683 VLIB_REGISTER_NODE (ip6_hop_by_hop_node) =
2684 {
2685   .name = "ip6-hop-by-hop",
2686   .sibling_of = "ip6-lookup",
2687   .vector_size = sizeof (u32),
2688   .format_trace = format_ip6_hop_by_hop_trace,
2689   .type = VLIB_NODE_TYPE_INTERNAL,
2690   .n_errors = ARRAY_LEN (ip6_hop_by_hop_error_strings),
2691   .error_strings = ip6_hop_by_hop_error_strings,
2692   .n_next_nodes = 0,
2693 };
2694 /* *INDENT-ON* */
2695
2696 static clib_error_t *
2697 ip6_hop_by_hop_init (vlib_main_t * vm)
2698 {
2699   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2700   clib_memset (hm->options, 0, sizeof (hm->options));
2701   clib_memset (hm->trace, 0, sizeof (hm->trace));
2702   hm->next_override = IP6_LOOKUP_NEXT_POP_HOP_BY_HOP;
2703   return (0);
2704 }
2705
2706 VLIB_INIT_FUNCTION (ip6_hop_by_hop_init);
2707
2708 #ifndef CLIB_MARCH_VARIANT
2709 void
2710 ip6_hbh_set_next_override (uword next)
2711 {
2712   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2713
2714   hm->next_override = next;
2715 }
2716
2717 int
2718 ip6_hbh_register_option (u8 option,
2719                          int options (vlib_buffer_t * b, ip6_header_t * ip,
2720                                       ip6_hop_by_hop_option_t * opt),
2721                          u8 * trace (u8 * s, ip6_hop_by_hop_option_t * opt))
2722 {
2723   ip6_main_t *im = &ip6_main;
2724   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2725
2726   ASSERT ((u32) option < ARRAY_LEN (hm->options));
2727
2728   /* Already registered */
2729   if (hm->options[option])
2730     return (-1);
2731
2732   hm->options[option] = options;
2733   hm->trace[option] = trace;
2734
2735   /* Set global variable */
2736   im->hbh_enabled = 1;
2737
2738   return (0);
2739 }
2740
2741 int
2742 ip6_hbh_unregister_option (u8 option)
2743 {
2744   ip6_main_t *im = &ip6_main;
2745   ip6_hop_by_hop_main_t *hm = &ip6_hop_by_hop_main;
2746
2747   ASSERT ((u32) option < ARRAY_LEN (hm->options));
2748
2749   /* Not registered */
2750   if (!hm->options[option])
2751     return (-1);
2752
2753   hm->options[option] = NULL;
2754   hm->trace[option] = NULL;
2755
2756   /* Disable global knob if this was the last option configured */
2757   int i;
2758   bool found = false;
2759   for (i = 0; i < 256; i++)
2760     {
2761       if (hm->options[option])
2762         {
2763           found = true;
2764           break;
2765         }
2766     }
2767   if (!found)
2768     im->hbh_enabled = 0;
2769
2770   return (0);
2771 }
2772
2773 /* Global IP6 main. */
2774 ip6_main_t ip6_main;
2775 #endif
2776
2777 static clib_error_t *
2778 ip6_lookup_init (vlib_main_t * vm)
2779 {
2780   ip6_main_t *im = &ip6_main;
2781   clib_error_t *error;
2782   uword i;
2783
2784   if ((error = vlib_call_init_function (vm, vnet_feature_init)))
2785     return error;
2786
2787   for (i = 0; i < ARRAY_LEN (im->fib_masks); i++)
2788     {
2789       u32 j, i0, i1;
2790
2791       i0 = i / 32;
2792       i1 = i % 32;
2793
2794       for (j = 0; j < i0; j++)
2795         im->fib_masks[i].as_u32[j] = ~0;
2796
2797       if (i1)
2798         im->fib_masks[i].as_u32[i0] =
2799           clib_host_to_net_u32 (pow2_mask (i1) << (32 - i1));
2800     }
2801
2802   ip_lookup_init (&im->lookup_main, /* is_ip6 */ 1);
2803
2804   if (im->lookup_table_nbuckets == 0)
2805     im->lookup_table_nbuckets = IP6_FIB_DEFAULT_HASH_NUM_BUCKETS;
2806
2807   im->lookup_table_nbuckets = 1 << max_log2 (im->lookup_table_nbuckets);
2808
2809   if (im->lookup_table_size == 0)
2810     im->lookup_table_size = IP6_FIB_DEFAULT_HASH_MEMORY_SIZE;
2811
2812   clib_bihash_init_24_8 (&(im->ip6_table[IP6_FIB_TABLE_FWDING].ip6_hash),
2813                          "ip6 FIB fwding table",
2814                          im->lookup_table_nbuckets, im->lookup_table_size);
2815   clib_bihash_init_24_8 (&im->ip6_table[IP6_FIB_TABLE_NON_FWDING].ip6_hash,
2816                          "ip6 FIB non-fwding table",
2817                          im->lookup_table_nbuckets, im->lookup_table_size);
2818   clib_bihash_init_40_8 (&im->ip6_mtable.ip6_mhash,
2819                          "ip6 mFIB table",
2820                          im->lookup_table_nbuckets, im->lookup_table_size);
2821
2822   /* Create FIB with index 0 and table id of 0. */
2823   fib_table_find_or_create_and_lock (FIB_PROTOCOL_IP6, 0,
2824                                      FIB_SOURCE_DEFAULT_ROUTE);
2825   mfib_table_find_or_create_and_lock (FIB_PROTOCOL_IP6, 0,
2826                                       MFIB_SOURCE_DEFAULT_ROUTE);
2827
2828   {
2829     pg_node_t *pn;
2830     pn = pg_get_node (ip6_lookup_node.index);
2831     pn->unformat_edit = unformat_pg_ip6_header;
2832   }
2833
2834   /* Unless explicitly configured, don't process HBH options */
2835   im->hbh_enabled = 0;
2836
2837   return error;
2838 }
2839
2840 VLIB_INIT_FUNCTION (ip6_lookup_init);
2841
2842 #ifndef CLIB_MARCH_VARIANT
2843 int
2844 vnet_set_ip6_flow_hash (u32 table_id, u32 flow_hash_config)
2845 {
2846   u32 fib_index;
2847
2848   fib_index = fib_table_find (FIB_PROTOCOL_IP6, table_id);
2849
2850   if (~0 == fib_index)
2851     return VNET_API_ERROR_NO_SUCH_FIB;
2852
2853   fib_table_set_flow_hash_config (fib_index, FIB_PROTOCOL_IP6,
2854                                   flow_hash_config);
2855
2856   return 0;
2857 }
2858 #endif
2859
2860 static clib_error_t *
2861 set_ip6_flow_hash_command_fn (vlib_main_t * vm,
2862                               unformat_input_t * input,
2863                               vlib_cli_command_t * cmd)
2864 {
2865   int matched = 0;
2866   u32 table_id = 0;
2867   u32 flow_hash_config = 0;
2868   int rv;
2869
2870   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
2871     {
2872       if (unformat (input, "table %d", &table_id))
2873         matched = 1;
2874 #define _(a,v) \
2875     else if (unformat (input, #a)) { flow_hash_config |= v; matched=1;}
2876       foreach_flow_hash_bit
2877 #undef _
2878         else
2879         break;
2880     }
2881
2882   if (matched == 0)
2883     return clib_error_return (0, "unknown input `%U'",
2884                               format_unformat_error, input);
2885
2886   rv = vnet_set_ip6_flow_hash (table_id, flow_hash_config);
2887   switch (rv)
2888     {
2889     case 0:
2890       break;
2891
2892     case -1:
2893       return clib_error_return (0, "no such FIB table %d", table_id);
2894
2895     default:
2896       clib_warning ("BUG: illegal flow hash config 0x%x", flow_hash_config);
2897       break;
2898     }
2899
2900   return 0;
2901 }
2902
2903 /*?
2904  * Configure the set of IPv6 fields used by the flow hash.
2905  *
2906  * @cliexpar
2907  * @parblock
2908  * Example of how to set the flow hash on a given table:
2909  * @cliexcmd{set ip6 flow-hash table 8 dst sport dport proto}
2910  *
2911  * Example of display the configured flow hash:
2912  * @cliexstart{show ip6 fib}
2913  * ipv6-VRF:0, fib_index 0, flow hash: src dst sport dport proto
2914  * @::/0
2915  *   unicast-ip6-chain
2916  *   [@0]: dpo-load-balance: [index:5 buckets:1 uRPF:5 to:[0:0]]
2917  *     [0] [@0]: dpo-drop ip6
2918  * fe80::/10
2919  *   unicast-ip6-chain
2920  *   [@0]: dpo-load-balance: [index:10 buckets:1 uRPF:10 to:[0:0]]
2921  *     [0] [@2]: dpo-receive
2922  * ff02::1/128
2923  *   unicast-ip6-chain
2924  *   [@0]: dpo-load-balance: [index:8 buckets:1 uRPF:8 to:[0:0]]
2925  *     [0] [@2]: dpo-receive
2926  * ff02::2/128
2927  *   unicast-ip6-chain
2928  *   [@0]: dpo-load-balance: [index:7 buckets:1 uRPF:7 to:[0:0]]
2929  *     [0] [@2]: dpo-receive
2930  * ff02::16/128
2931  *   unicast-ip6-chain
2932  *   [@0]: dpo-load-balance: [index:9 buckets:1 uRPF:9 to:[0:0]]
2933  *     [0] [@2]: dpo-receive
2934  * ff02::1:ff00:0/104
2935  *   unicast-ip6-chain
2936  *   [@0]: dpo-load-balance: [index:6 buckets:1 uRPF:6 to:[0:0]]
2937  *     [0] [@2]: dpo-receive
2938  * ipv6-VRF:8, fib_index 1, flow hash: dst sport dport proto
2939  * @::/0
2940  *   unicast-ip6-chain
2941  *   [@0]: dpo-load-balance: [index:21 buckets:1 uRPF:20 to:[0:0]]
2942  *     [0] [@0]: dpo-drop ip6
2943  * @::a:1:1:0:4/126
2944  *   unicast-ip6-chain
2945  *   [@0]: dpo-load-balance: [index:27 buckets:1 uRPF:26 to:[0:0]]
2946  *     [0] [@4]: ipv6-glean: af_packet0
2947  * @::a:1:1:0:7/128
2948  *   unicast-ip6-chain
2949  *   [@0]: dpo-load-balance: [index:28 buckets:1 uRPF:27 to:[0:0]]
2950  *     [0] [@2]: dpo-receive: @::a:1:1:0:7 on af_packet0
2951  * fe80::/10
2952  *   unicast-ip6-chain
2953  *   [@0]: dpo-load-balance: [index:26 buckets:1 uRPF:25 to:[0:0]]
2954  *     [0] [@2]: dpo-receive
2955  * fe80::fe:3eff:fe3e:9222/128
2956  *   unicast-ip6-chain
2957  *   [@0]: dpo-load-balance: [index:29 buckets:1 uRPF:28 to:[0:0]]
2958  *     [0] [@2]: dpo-receive: fe80::fe:3eff:fe3e:9222 on af_packet0
2959  * ff02::1/128
2960  *   unicast-ip6-chain
2961  *   [@0]: dpo-load-balance: [index:24 buckets:1 uRPF:23 to:[0:0]]
2962  *     [0] [@2]: dpo-receive
2963  * ff02::2/128
2964  *   unicast-ip6-chain
2965  *   [@0]: dpo-load-balance: [index:23 buckets:1 uRPF:22 to:[0:0]]
2966  *     [0] [@2]: dpo-receive
2967  * ff02::16/128
2968  *   unicast-ip6-chain
2969  *   [@0]: dpo-load-balance: [index:25 buckets:1 uRPF:24 to:[0:0]]
2970  *     [0] [@2]: dpo-receive
2971  * ff02::1:ff00:0/104
2972  *   unicast-ip6-chain
2973  *   [@0]: dpo-load-balance: [index:22 buckets:1 uRPF:21 to:[0:0]]
2974  *     [0] [@2]: dpo-receive
2975  * @cliexend
2976  * @endparblock
2977 ?*/
2978 /* *INDENT-OFF* */
2979 VLIB_CLI_COMMAND (set_ip6_flow_hash_command, static) =
2980 {
2981   .path = "set ip6 flow-hash",
2982   .short_help =
2983   "set ip6 flow-hash table <table-id> [src] [dst] [sport] [dport] [proto] [reverse]",
2984   .function = set_ip6_flow_hash_command_fn,
2985 };
2986 /* *INDENT-ON* */
2987
2988 static clib_error_t *
2989 show_ip6_local_command_fn (vlib_main_t * vm,
2990                            unformat_input_t * input, vlib_cli_command_t * cmd)
2991 {
2992   ip6_main_t *im = &ip6_main;
2993   ip_lookup_main_t *lm = &im->lookup_main;
2994   int i;
2995
2996   vlib_cli_output (vm, "Protocols handled by ip6_local");
2997   for (i = 0; i < ARRAY_LEN (lm->local_next_by_ip_protocol); i++)
2998     {
2999       if (lm->local_next_by_ip_protocol[i] != IP_LOCAL_NEXT_PUNT)
3000         {
3001
3002           u32 node_index = vlib_get_node (vm,
3003                                           ip6_local_node.index)->
3004             next_nodes[lm->local_next_by_ip_protocol[i]];
3005           vlib_cli_output (vm, "%d: %U", i, format_vlib_node_name, vm,
3006                            node_index);
3007         }
3008     }
3009   return 0;
3010 }
3011
3012
3013
3014 /*?
3015  * Display the set of protocols handled by the local IPv6 stack.
3016  *
3017  * @cliexpar
3018  * Example of how to display local protocol table:
3019  * @cliexstart{show ip6 local}
3020  * Protocols handled by ip6_local
3021  * 17
3022  * 43
3023  * 58
3024  * 115
3025  * @cliexend
3026 ?*/
3027 /* *INDENT-OFF* */
3028 VLIB_CLI_COMMAND (show_ip6_local, static) =
3029 {
3030   .path = "show ip6 local",
3031   .function = show_ip6_local_command_fn,
3032   .short_help = "show ip6 local",
3033 };
3034 /* *INDENT-ON* */
3035
3036 #ifndef CLIB_MARCH_VARIANT
3037 int
3038 vnet_set_ip6_classify_intfc (vlib_main_t * vm, u32 sw_if_index,
3039                              u32 table_index)
3040 {
3041   vnet_main_t *vnm = vnet_get_main ();
3042   vnet_interface_main_t *im = &vnm->interface_main;
3043   ip6_main_t *ipm = &ip6_main;
3044   ip_lookup_main_t *lm = &ipm->lookup_main;
3045   vnet_classify_main_t *cm = &vnet_classify_main;
3046   ip6_address_t *if_addr;
3047
3048   if (pool_is_free_index (im->sw_interfaces, sw_if_index))
3049     return VNET_API_ERROR_NO_MATCHING_INTERFACE;
3050
3051   if (table_index != ~0 && pool_is_free_index (cm->tables, table_index))
3052     return VNET_API_ERROR_NO_SUCH_ENTRY;
3053
3054   vec_validate (lm->classify_table_index_by_sw_if_index, sw_if_index);
3055   lm->classify_table_index_by_sw_if_index[sw_if_index] = table_index;
3056
3057   if_addr = ip6_interface_first_address (ipm, sw_if_index);
3058
3059   if (NULL != if_addr)
3060     {
3061       fib_prefix_t pfx = {
3062         .fp_len = 128,
3063         .fp_proto = FIB_PROTOCOL_IP6,
3064         .fp_addr.ip6 = *if_addr,
3065       };
3066       u32 fib_index;
3067
3068       fib_index = fib_table_get_index_for_sw_if_index (FIB_PROTOCOL_IP4,
3069                                                        sw_if_index);
3070
3071
3072       if (table_index != (u32) ~ 0)
3073         {
3074           dpo_id_t dpo = DPO_INVALID;
3075
3076           dpo_set (&dpo,
3077                    DPO_CLASSIFY,
3078                    DPO_PROTO_IP6,
3079                    classify_dpo_create (DPO_PROTO_IP6, table_index));
3080
3081           fib_table_entry_special_dpo_add (fib_index,
3082                                            &pfx,
3083                                            FIB_SOURCE_CLASSIFY,
3084                                            FIB_ENTRY_FLAG_NONE, &dpo);
3085           dpo_reset (&dpo);
3086         }
3087       else
3088         {
3089           fib_table_entry_special_remove (fib_index,
3090                                           &pfx, FIB_SOURCE_CLASSIFY);
3091         }
3092     }
3093
3094   return 0;
3095 }
3096 #endif
3097
3098 static clib_error_t *
3099 set_ip6_classify_command_fn (vlib_main_t * vm,
3100                              unformat_input_t * input,
3101                              vlib_cli_command_t * cmd)
3102 {
3103   u32 table_index = ~0;
3104   int table_index_set = 0;
3105   u32 sw_if_index = ~0;
3106   int rv;
3107
3108   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
3109     {
3110       if (unformat (input, "table-index %d", &table_index))
3111         table_index_set = 1;
3112       else if (unformat (input, "intfc %U", unformat_vnet_sw_interface,
3113                          vnet_get_main (), &sw_if_index))
3114         ;
3115       else
3116         break;
3117     }
3118
3119   if (table_index_set == 0)
3120     return clib_error_return (0, "classify table-index must be specified");
3121
3122   if (sw_if_index == ~0)
3123     return clib_error_return (0, "interface / subif must be specified");
3124
3125   rv = vnet_set_ip6_classify_intfc (vm, sw_if_index, table_index);
3126
3127   switch (rv)
3128     {
3129     case 0:
3130       break;
3131
3132     case VNET_API_ERROR_NO_MATCHING_INTERFACE:
3133       return clib_error_return (0, "No such interface");
3134
3135     case VNET_API_ERROR_NO_SUCH_ENTRY:
3136       return clib_error_return (0, "No such classifier table");
3137     }
3138   return 0;
3139 }
3140
3141 /*?
3142  * Assign a classification table to an interface. The classification
3143  * table is created using the '<em>classify table</em>' and '<em>classify session</em>'
3144  * commands. Once the table is create, use this command to filter packets
3145  * on an interface.
3146  *
3147  * @cliexpar
3148  * Example of how to assign a classification table to an interface:
3149  * @cliexcmd{set ip6 classify intfc GigabitEthernet2/0/0 table-index 1}
3150 ?*/
3151 /* *INDENT-OFF* */
3152 VLIB_CLI_COMMAND (set_ip6_classify_command, static) =
3153 {
3154   .path = "set ip6 classify",
3155   .short_help =
3156   "set ip6 classify intfc <interface> table-index <classify-idx>",
3157   .function = set_ip6_classify_command_fn,
3158 };
3159 /* *INDENT-ON* */
3160
3161 static clib_error_t *
3162 ip6_config (vlib_main_t * vm, unformat_input_t * input)
3163 {
3164   ip6_main_t *im = &ip6_main;
3165   uword heapsize = 0;
3166   u32 tmp;
3167   u32 nbuckets = 0;
3168
3169   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
3170     {
3171       if (unformat (input, "hash-buckets %d", &tmp))
3172         nbuckets = tmp;
3173       else if (unformat (input, "heap-size %U",
3174                          unformat_memory_size, &heapsize))
3175         ;
3176       else
3177         return clib_error_return (0, "unknown input '%U'",
3178                                   format_unformat_error, input);
3179     }
3180
3181   im->lookup_table_nbuckets = nbuckets;
3182   im->lookup_table_size = heapsize;
3183
3184   return 0;
3185 }
3186
3187 VLIB_EARLY_CONFIG_FUNCTION (ip6_config, "ip6");
3188
3189 /*
3190  * fd.io coding-style-patch-verification: ON
3191  *
3192  * Local Variables:
3193  * eval: (c-set-style "gnu")
3194  * End:
3195  */