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