src/vnet/lisp-gpe/lisp_gpe_fwd_entry.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 #include <vnet/lisp-gpe/lisp_gpe_fwd_entry.h>
  17 #include <vnet/lisp-gpe/lisp_gpe_adjacency.h>
  18 #include <vnet/lisp-gpe/lisp_gpe_tenant.h>
  19 #include <vnet/lisp-cp/lisp_cp_dpo.h>
  20 #include <vnet/fib/fib_table.h>
  21 #include <vnet/fib/fib_entry.h>
  22 #include <vnet/fib/fib_path_list.h>
  23 #include <vnet/fib/ip6_fib.h>
  24 #include <vnet/fib/ip4_fib.h>
  25 #include <vnet/dpo/drop_dpo.h>
  26 #include <vnet/dpo/lookup_dpo.h>
  27 #include <vnet/dpo/load_balance.h>
  28 #include <vnet/adj/adj_midchain.h>
  29
  30 /**
  31  * @brief Add route to IP4 or IP6 Destination FIB.
  32  *
  33  * Add a route to the destination FIB that results in the lookup
  34  * in the SRC FIB. The SRC FIB is created is it does not yet exist.
  35  *
  36  * @param[in]   dst_table_id    Destination FIB Table-ID
  37  * @param[in]   dst_prefix      Destination IP prefix.
  38  *
  39  * @return  src_fib_index   The index/ID of the SRC FIB created.
  40  */
  41 static u32
  42 ip_dst_fib_add_route (u32 dst_fib_index, const ip_prefix_t * dst_prefix)
  43 {
  44   fib_node_index_t src_fib_index;
  45   fib_prefix_t dst_fib_prefix;
  46   fib_node_index_t dst_fei;
  47
  48   ASSERT (NULL != dst_prefix);
  49
  50   ip_prefix_to_fib_prefix (dst_prefix, &dst_fib_prefix);
  51
  52   /*
  53    * lookup the destination prefix in the VRF table and retrieve the
  54    * LISP associated data
  55    */
  56   dst_fei = fib_table_lookup_exact_match (dst_fib_index, &dst_fib_prefix);
  57
  58   /*
  59    * If the FIB entry is not present, or not LISP sourced, add it
  60    */
  61   if (dst_fei == FIB_NODE_INDEX_INVALID ||
  62       NULL == fib_entry_get_source_data (dst_fei, FIB_SOURCE_LISP))
  63     {
  64       dpo_id_t src_lkup_dpo = DPO_INVALID;
  65
  66       /* create a new src FIB.  */
  67       src_fib_index =
  68         fib_table_create_and_lock (dst_fib_prefix.fp_proto,
  69                                    "LISP-src for [%d,%U]",
  70                                    dst_fib_index,
  71                                    format_fib_prefix, &dst_fib_prefix);
  72       /*
  73        * add src fib default route
  74        */
  75       fib_prefix_t prefix = {
  76         .fp_proto = dst_fib_prefix.fp_proto,
  77       };
  78       fib_table_entry_special_dpo_add (src_fib_index, &prefix,
  79                                        FIB_SOURCE_LISP,
  80                                        FIB_ENTRY_FLAG_EXCLUSIVE,
  81                                        lisp_cp_dpo_get (fib_proto_to_dpo
  82                                                         (dst_fib_prefix.fp_proto)));
  83       /*
  84        * create a data-path object to perform the source address lookup
  85        * in the SRC FIB
  86        */
  87       lookup_dpo_add_or_lock_w_fib_index (src_fib_index,
  88                                           (ip_prefix_version (dst_prefix) ==
  89                                            IP6 ? DPO_PROTO_IP6 :
  90                                            DPO_PROTO_IP4),
  91                                           LOOKUP_UNICAST,
  92                                           LOOKUP_INPUT_SRC_ADDR,
  93                                           LOOKUP_TABLE_FROM_CONFIG,
  94                                           &src_lkup_dpo);
  95
  96       /*
  97        * add the entry to the destination FIB that uses the lookup DPO
  98        */
  99       dst_fei = fib_table_entry_special_dpo_add (dst_fib_index,
 100                                                  &dst_fib_prefix,
 101                                                  FIB_SOURCE_LISP,
 102                                                  FIB_ENTRY_FLAG_EXCLUSIVE,
 103                                                  &src_lkup_dpo);
 104
 105       /*
 106        * the DPO is locked by the FIB entry, and we have no further
 107        * need for it.
 108        */
 109       dpo_unlock (&src_lkup_dpo);
 110
 111       /*
 112        * save the SRC FIB index on the entry so we can retrieve it for
 113        * subsequent routes.
 114        */
 115       fib_entry_set_source_data (dst_fei, FIB_SOURCE_LISP, &src_fib_index);
 116     }
 117   else
 118     {
 119       /*
 120        * destination FIB entry already present
 121        */
 122       src_fib_index = *(u32 *) fib_entry_get_source_data (dst_fei,
 123                                                           FIB_SOURCE_LISP);
 124     }
 125
 126   return (src_fib_index);
 127 }
 128
 129 /**
 130  * @brief Del route to IP4 or IP6 SD FIB.
 131  *
 132  * Remove routes from both destination and source FIBs.
 133  *
 134  * @param[in]   src_fib_index   The index/ID of the SRC FIB
 135  * @param[in]   src_prefix      Source IP prefix.
 136  * @param[in]   dst_fib_index   The index/ID of the DST FIB
 137  * @param[in]   dst_prefix      Destination IP prefix.
 138  */
 139 static void
 140 ip_src_dst_fib_del_route (u32 src_fib_index,
 141                           const ip_prefix_t * src_prefix,
 142                           u32 dst_fib_index, const ip_prefix_t * dst_prefix)
 143 {
 144   fib_prefix_t dst_fib_prefix, src_fib_prefix;
 145   u8 have_default = 0;
 146   u32 n_entries;
 147
 148   ASSERT (NULL != dst_prefix);
 149   ASSERT (NULL != src_prefix);
 150
 151   ip_prefix_to_fib_prefix (dst_prefix, &dst_fib_prefix);
 152   ip_prefix_to_fib_prefix (src_prefix, &src_fib_prefix);
 153
 154   fib_table_entry_delete (src_fib_index, &src_fib_prefix, FIB_SOURCE_LISP);
 155
 156   /* check if only default left or empty */
 157   fib_prefix_t default_pref = {
 158     .fp_proto = dst_fib_prefix.fp_proto
 159   };
 160
 161   if (fib_table_lookup_exact_match (src_fib_index,
 162                                     &default_pref) != FIB_NODE_INDEX_INVALID)
 163     have_default = 1;
 164
 165   n_entries = fib_table_get_num_entries (src_fib_index,
 166                                          src_fib_prefix.fp_proto,
 167                                          FIB_SOURCE_LISP);
 168   if (n_entries == 0 || (have_default && n_entries == 1))
 169     {
 170       /*
 171        * remove src FIB default route
 172        */
 173       if (have_default)
 174         fib_table_entry_special_remove (src_fib_index, &default_pref,
 175                                         FIB_SOURCE_LISP);
 176
 177       /*
 178        * there's nothing left now, unlock the source FIB and the
 179        * destination route
 180        */
 181       fib_table_entry_special_remove (dst_fib_index,
 182                                       &dst_fib_prefix, FIB_SOURCE_LISP);
 183       fib_table_unlock (src_fib_index, src_fib_prefix.fp_proto);
 184     }
 185 }
 186
 187 /**
 188  * @brief Add route to IP4 or IP6 SRC FIB.
 189  *
 190  * Adds a route to in the LISP SRC FIB with the result of the route
 191  * being the DPO passed.
 192  *
 193  * @param[in]   src_fib_index   The index/ID of the SRC FIB
 194  * @param[in]   src_prefix      Source IP prefix.
 195  * @param[in]   src_dpo         The DPO the route will link to.
 196  */
 197 static void
 198 ip_src_fib_add_route_w_dpo (u32 src_fib_index,
 199                             const ip_prefix_t * src_prefix,
 200                             const dpo_id_t * src_dpo)
 201 {
 202   fib_prefix_t src_fib_prefix;
 203
 204   ip_prefix_to_fib_prefix (src_prefix, &src_fib_prefix);
 205
 206   /*
 207    * add the entry into the source fib.
 208    */
 209   fib_node_index_t src_fei;
 210
 211   src_fei = fib_table_lookup_exact_match (src_fib_index, &src_fib_prefix);
 212
 213   if (FIB_NODE_INDEX_INVALID == src_fei ||
 214       !fib_entry_is_sourced (src_fei, FIB_SOURCE_LISP))
 215     {
 216       fib_table_entry_special_dpo_add (src_fib_index,
 217                                        &src_fib_prefix,
 218                                        FIB_SOURCE_LISP,
 219                                        FIB_ENTRY_FLAG_EXCLUSIVE, src_dpo);
 220     }
 221 }
 222
 223 static fib_route_path_t *
 224 lisp_gpe_mk_fib_paths (const lisp_fwd_path_t * paths)
 225 {
 226   const lisp_gpe_adjacency_t *ladj;
 227   fib_route_path_t *rpaths = NULL;
 228   u8 best_priority;
 229   u32 ii;
 230
 231   vec_validate (rpaths, vec_len (paths) - 1);
 232
 233   best_priority = paths[0].priority;
 234
 235   vec_foreach_index (ii, paths)
 236   {
 237     if (paths[0].priority != best_priority)
 238       break;
 239
 240     ladj = lisp_gpe_adjacency_get (paths[ii].lisp_adj);
 241
 242     ip_address_to_46 (&ladj->remote_rloc,
 243                       &rpaths[ii].frp_addr, &rpaths[ii].frp_proto);
 244
 245     rpaths[ii].frp_sw_if_index = ladj->sw_if_index;
 246     rpaths[ii].frp_weight = (paths[ii].weight ? paths[ii].weight : 1);
 247   }
 248
 249   ASSERT (0 != vec_len (rpaths));
 250
 251   return (rpaths);
 252 }
 253
 254 /**
 255  * @brief Add route to IP4 or IP6 SRC FIB.
 256  *
 257  * Adds a route to in the LISP SRC FIB for the tunnel.
 258  *
 259  * @param[in]   src_fib_index   The index/ID of the SRC FIB
 260  * @param[in]   src_prefix      Source IP prefix.
 261  * @param[in]   paths           The paths from which to construct the
 262  *                              load balance
 263  */
 264 static void
 265 ip_src_fib_add_route (u32 src_fib_index,
 266                       const ip_prefix_t * src_prefix,
 267                       const lisp_fwd_path_t * paths)
 268 {
 269   fib_prefix_t src_fib_prefix;
 270   fib_route_path_t *rpaths;
 271
 272   ip_prefix_to_fib_prefix (src_prefix, &src_fib_prefix);
 273
 274   rpaths = lisp_gpe_mk_fib_paths (paths);
 275
 276   fib_table_entry_update (src_fib_index,
 277                           &src_fib_prefix,
 278                           FIB_SOURCE_LISP, FIB_ENTRY_FLAG_NONE, rpaths);
 279   vec_free (rpaths);
 280 }
 281
 282
 283 static void
 284 create_fib_entries (lisp_gpe_fwd_entry_t * lfe)
 285 {
 286   dpo_proto_t dproto;
 287   ip_prefix_t ippref;
 288   dproto = (ip_prefix_version (&lfe->key->rmt.ippref) == IP4 ?
 289             DPO_PROTO_IP4 : DPO_PROTO_IP6);
 290
 291   if (lfe->is_src_dst)
 292     {
 293       lfe->src_fib_index = ip_dst_fib_add_route (lfe->eid_fib_index,
 294                                                  &lfe->key->rmt.ippref);
 295       memcpy (&ippref, &lfe->key->lcl.ippref, sizeof (ippref));
 296     }
 297   else
 298     {
 299       lfe->src_fib_index = lfe->eid_fib_index;
 300       memcpy (&ippref, &lfe->key->rmt.ippref, sizeof (ippref));
 301     }
 302
 303   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE == lfe->type)
 304     {
 305       dpo_id_t dpo = DPO_INVALID;
 306
 307       switch (lfe->action)
 308         {
 309         case LISP_NO_ACTION:
 310           /* TODO update timers? */
 311         case LISP_FORWARD_NATIVE:
 312           /* TODO check if route/next-hop for eid exists in fib and add
 313            * more specific for the eid with the next-hop found */
 314         case LISP_SEND_MAP_REQUEST:
 315           /* insert tunnel that always sends map-request */
 316           dpo_copy (&dpo, lisp_cp_dpo_get (dproto));
 317           break;
 318         case LISP_DROP:
 319           /* for drop fwd entries, just add route, no need to add encap tunnel */
 320           dpo_copy (&dpo, drop_dpo_get (dproto));
 321           break;
 322         }
 323       ip_src_fib_add_route_w_dpo (lfe->src_fib_index, &ippref, &dpo);
 324       dpo_reset (&dpo);
 325     }
 326   else
 327     {
 328       ip_src_fib_add_route (lfe->src_fib_index, &ippref, lfe->paths);
 329     }
 330 }
 331
 332 static void
 333 delete_fib_entries (lisp_gpe_fwd_entry_t * lfe)
 334 {
 335   fib_prefix_t dst_fib_prefix;
 336
 337   if (lfe->is_src_dst)
 338     ip_src_dst_fib_del_route (lfe->src_fib_index,
 339                               &lfe->key->lcl.ippref,
 340                               lfe->eid_fib_index, &lfe->key->rmt.ippref);
 341   else
 342     {
 343       ip_prefix_to_fib_prefix (&lfe->key->rmt.ippref, &dst_fib_prefix);
 344       fib_table_entry_delete (lfe->src_fib_index, &dst_fib_prefix,
 345                               FIB_SOURCE_LISP);
 346     }
 347 }
 348
 349 static lisp_gpe_fwd_entry_t *
 350 find_fwd_entry (lisp_gpe_main_t * lgm,
 351                 vnet_lisp_gpe_add_del_fwd_entry_args_t * a,
 352                 lisp_gpe_fwd_entry_key_t * key)
 353 {
 354   uword *p;
 355
 356   memset (key, 0, sizeof (*key));
 357
 358   if (GID_ADDR_IP_PREFIX == gid_address_type (&a->rmt_eid))
 359     {
 360       /*
 361        * the ip version of the source is not set to ip6 when the
 362        * source is all zeros. force it.
 363        */
 364       ip_prefix_version (&gid_address_ippref (&a->lcl_eid)) =
 365         ip_prefix_version (&gid_address_ippref (&a->rmt_eid));
 366     }
 367
 368   gid_to_dp_address (&a->rmt_eid, &key->rmt);
 369   gid_to_dp_address (&a->lcl_eid, &key->lcl);
 370   key->vni = a->vni;
 371
 372   p = hash_get_mem (lgm->lisp_gpe_fwd_entries, key);
 373
 374   if (NULL != p)
 375     {
 376       return (pool_elt_at_index (lgm->lisp_fwd_entry_pool, p[0]));
 377     }
 378   return (NULL);
 379 }
 380
 381 static int
 382 lisp_gpe_fwd_entry_path_sort (void *a1, void *a2)
 383 {
 384   lisp_fwd_path_t *p1 = a1, *p2 = a2;
 385
 386   return (p1->priority - p2->priority);
 387 }
 388
 389 static void
 390 lisp_gpe_fwd_entry_mk_paths (lisp_gpe_fwd_entry_t * lfe,
 391                              vnet_lisp_gpe_add_del_fwd_entry_args_t * a)
 392 {
 393   lisp_fwd_path_t *path;
 394   u32 index;
 395
 396   vec_validate (lfe->paths, vec_len (a->locator_pairs) - 1);
 397
 398   vec_foreach_index (index, a->locator_pairs)
 399   {
 400     path = &lfe->paths[index];
 401
 402     path->priority = a->locator_pairs[index].priority;
 403     path->weight = a->locator_pairs[index].weight;
 404
 405     path->lisp_adj =
 406       lisp_gpe_adjacency_find_or_create_and_lock (&a->locator_pairs
 407                                                   [index],
 408                                                   a->dp_table, lfe->key->vni);
 409   }
 410   vec_sort_with_function (lfe->paths, lisp_gpe_fwd_entry_path_sort);
 411 }
 412
 413 void
 414 vnet_lisp_gpe_add_fwd_counters (vnet_lisp_gpe_add_del_fwd_entry_args_t * a,
 415                                 u32 fwd_entry_index)
 416 {
 417   const lisp_gpe_adjacency_t *ladj;
 418   lisp_fwd_path_t *path;
 419   lisp_gpe_main_t *lgm = vnet_lisp_gpe_get_main ();
 420   u8 *dummy_elt;
 421   lisp_gpe_fwd_entry_t *lfe;
 422   lisp_gpe_fwd_entry_key_t fe_key;
 423   lisp_stats_key_t key;
 424
 425   lfe = find_fwd_entry (lgm, a, &fe_key);
 426
 427   if (LISP_GPE_FWD_ENTRY_TYPE_NORMAL != lfe->type)
 428     return;
 429
 430   memset (&key, 0, sizeof (key));
 431   key.fwd_entry_index = fwd_entry_index;
 432
 433   vec_foreach (path, lfe->paths)
 434   {
 435     ladj = lisp_gpe_adjacency_get (path->lisp_adj);
 436     key.tunnel_index = ladj->tunnel_index;
 437     lisp_stats_key_t *key_copy = clib_mem_alloc (sizeof (*key_copy));
 438     memcpy (key_copy, &key, sizeof (*key_copy));
 439     pool_get (lgm->dummy_stats_pool, dummy_elt);
 440     hash_set_mem (lgm->lisp_stats_index_by_key, key_copy,
 441                   dummy_elt - lgm->dummy_stats_pool);
 442
 443     vlib_validate_combined_counter (&lgm->counters,
 444                                     dummy_elt - lgm->dummy_stats_pool);
 445     vlib_zero_combined_counter (&lgm->counters,
 446                                 dummy_elt - lgm->dummy_stats_pool);
 447   }
 448 }
 449
 450 /**
 451  * @brief Add/Delete LISP IP forwarding entry.
 452  *
 453  * creation of forwarding entries for IP LISP overlay:
 454  *
 455  * @param[in]   lgm     Reference to @ref lisp_gpe_main_t.
 456  * @param[in]   a       Parameters for building the forwarding entry.
 457  *
 458  * @return 0 on success.
 459  */
 460 static int
 461 add_ip_fwd_entry (lisp_gpe_main_t * lgm,
 462                   vnet_lisp_gpe_add_del_fwd_entry_args_t * a)
 463 {
 464   lisp_gpe_fwd_entry_key_t key;
 465   lisp_gpe_fwd_entry_t *lfe;
 466   fib_protocol_t fproto;
 467
 468   lfe = find_fwd_entry (lgm, a, &key);
 469
 470   if (NULL != lfe)
 471     /* don't support updates */
 472     return VNET_API_ERROR_INVALID_VALUE;
 473
 474   pool_get (lgm->lisp_fwd_entry_pool, lfe);
 475   memset (lfe, 0, sizeof (*lfe));
 476   lfe->key = clib_mem_alloc (sizeof (key));
 477   memcpy (lfe->key, &key, sizeof (key));
 478
 479   hash_set_mem (lgm->lisp_gpe_fwd_entries, lfe->key,
 480                 lfe - lgm->lisp_fwd_entry_pool);
 481
 482   fproto = (IP4 == ip_prefix_version (&fid_addr_ippref (&lfe->key->rmt)) ?
 483             FIB_PROTOCOL_IP4 : FIB_PROTOCOL_IP6);
 484
 485   lfe->type = (a->is_negative ?
 486                LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE :
 487                LISP_GPE_FWD_ENTRY_TYPE_NORMAL);
 488   lfe->tenant = lisp_gpe_tenant_find_or_create (lfe->key->vni);
 489   lfe->eid_table_id = a->table_id;
 490   lfe->eid_fib_index = fib_table_find_or_create_and_lock (fproto,
 491                                                           lfe->eid_table_id);
 492   lfe->is_src_dst = a->is_src_dst;
 493
 494   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE != lfe->type)
 495     {
 496       lisp_gpe_fwd_entry_mk_paths (lfe, a);
 497     }
 498   else
 499     {
 500       lfe->action = a->action;
 501     }
 502
 503   create_fib_entries (lfe);
 504   return (0);
 505 }
 506
 507 static void
 508 del_ip_fwd_entry_i (lisp_gpe_main_t * lgm, lisp_gpe_fwd_entry_t * lfe)
 509 {
 510   lisp_fwd_path_t *path;
 511   fib_protocol_t fproto;
 512
 513   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE != lfe->type)
 514     {
 515       vec_foreach (path, lfe->paths)
 516       {
 517         lisp_gpe_adjacency_unlock (path->lisp_adj);
 518       }
 519     }
 520
 521   delete_fib_entries (lfe);
 522
 523   fproto = (IP4 == ip_prefix_version (&fid_addr_ippref (&lfe->key->rmt)) ?
 524             FIB_PROTOCOL_IP4 : FIB_PROTOCOL_IP6);
 525   fib_table_unlock (lfe->eid_fib_index, fproto);
 526
 527   hash_unset_mem (lgm->lisp_gpe_fwd_entries, lfe->key);
 528   clib_mem_free (lfe->key);
 529   pool_put (lgm->lisp_fwd_entry_pool, lfe);
 530 }
 531
 532 /**
 533  * @brief Add/Delete LISP IP forwarding entry.
 534  *
 535  * removal of forwarding entries for IP LISP overlay:
 536  *
 537  * @param[in]   lgm     Reference to @ref lisp_gpe_main_t.
 538  * @param[in]   a       Parameters for building the forwarding entry.
 539  *
 540  * @return 0 on success.
 541  */
 542 static int
 543 del_ip_fwd_entry (lisp_gpe_main_t * lgm,
 544                   vnet_lisp_gpe_add_del_fwd_entry_args_t * a)
 545 {
 546   lisp_gpe_fwd_entry_key_t key;
 547   lisp_gpe_fwd_entry_t *lfe;
 548
 549   lfe = find_fwd_entry (lgm, a, &key);
 550
 551   if (NULL == lfe)
 552     /* no such entry */
 553     return VNET_API_ERROR_INVALID_VALUE;
 554
 555   del_ip_fwd_entry_i (lgm, lfe);
 556
 557   return (0);
 558 }
 559
 560 static void
 561 make_mac_fib_key (BVT (clib_bihash_kv) * kv, u16 bd_index, u8 src_mac[6],
 562                   u8 dst_mac[6])
 563 {
 564   kv->key[0] = (((u64) bd_index) << 48) | mac_to_u64 (dst_mac);
 565   kv->key[1] = mac_to_u64 (src_mac);
 566   kv->key[2] = 0;
 567 }
 568
 569 /**
 570  * @brief Lookup L2 SD FIB entry
 571  *
 572  * Does a vni + dest + source lookup in the L2 LISP FIB. If the lookup fails
 573  * it tries a second time with source set to 0 (i.e., a simple dest lookup).
 574  *
 575  * @param[in]   lgm             Reference to @ref lisp_gpe_main_t.
 576  * @param[in]   bd_index        Bridge domain index.
 577  * @param[in]   src_mac         Source mac address.
 578  * @param[in]   dst_mac         Destination mac address.
 579  *
 580  * @return index of mapping matching the lookup key.
 581  */
 582 index_t
 583 lisp_l2_fib_lookup (lisp_gpe_main_t * lgm, u16 bd_index, u8 src_mac[6],
 584                     u8 dst_mac[6])
 585 {
 586   int rv;
 587   BVT (clib_bihash_kv) kv, value;
 588
 589   make_mac_fib_key (&kv, bd_index, src_mac, dst_mac);
 590   rv = BV (clib_bihash_search_inline_2) (&lgm->l2_fib, &kv, &value);
 591
 592   /* no match, try with src 0, catch all for dst */
 593   if (rv != 0)
 594     {
 595       kv.key[1] = 0;
 596       rv = BV (clib_bihash_search_inline_2) (&lgm->l2_fib, &kv, &value);
 597       if (rv == 0)
 598         return value.value;
 599     }
 600   else
 601     return value.value;
 602
 603   return lisp_gpe_main.l2_lb_cp_lkup.dpoi_index;
 604 }
 605
 606 /**
 607  * @brief Add/del L2 SD FIB entry
 608  *
 609  * Inserts value in L2 FIB keyed by vni + dest + source. If entry is
 610  * overwritten the associated value is returned.
 611  *
 612  * @param[in]   lgm             Reference to @ref lisp_gpe_main_t.
 613  * @param[in]   bd_index        Bridge domain index.
 614  * @param[in]   src_mac         Source mac address.
 615  * @param[in]   dst_mac         Destination mac address.
 616  * @param[in]   val             Value to add.
 617  * @param[in]   is_add          Add/del flag.
 618  *
 619  * @return ~0 or value of overwritten entry.
 620  */
 621 static u32
 622 lisp_l2_fib_add_del_entry (u16 bd_index, u8 src_mac[6],
 623                            u8 dst_mac[6], const dpo_id_t * dpo, u8 is_add)
 624 {
 625   lisp_gpe_main_t *lgm = &lisp_gpe_main;
 626   BVT (clib_bihash_kv) kv, value;
 627   u32 old_val = ~0;
 628
 629   make_mac_fib_key (&kv, bd_index, src_mac, dst_mac);
 630
 631   if (BV (clib_bihash_search) (&lgm->l2_fib, &kv, &value) == 0)
 632     old_val = value.value;
 633
 634   if (!is_add)
 635     BV (clib_bihash_add_del) (&lgm->l2_fib, &kv, 0 /* is_add */ );
 636   else
 637     {
 638       kv.value = dpo->dpoi_index;
 639       BV (clib_bihash_add_del) (&lgm->l2_fib, &kv, 1 /* is_add */ );
 640     }
 641   return old_val;
 642 }
 643
 644 #define L2_FIB_DEFAULT_HASH_NUM_BUCKETS (64 * 1024)
 645 #define L2_FIB_DEFAULT_HASH_MEMORY_SIZE (32<<20)
 646
 647 static void
 648 l2_fib_init (lisp_gpe_main_t * lgm)
 649 {
 650   index_t lbi;
 651
 652   BV (clib_bihash_init) (&lgm->l2_fib, "l2 fib",
 653                          1 << max_log2 (L2_FIB_DEFAULT_HASH_NUM_BUCKETS),
 654                          L2_FIB_DEFAULT_HASH_MEMORY_SIZE);
 655
 656   /*
 657    * the result from a 'miss' in a L2 Table
 658    */
 659   lbi = load_balance_create (1, DPO_PROTO_ETHERNET, 0);
 660   load_balance_set_bucket (lbi, 0, lisp_cp_dpo_get (DPO_PROTO_ETHERNET));
 661
 662   dpo_set (&lgm->l2_lb_cp_lkup, DPO_LOAD_BALANCE, DPO_PROTO_ETHERNET, lbi);
 663 }
 664
 665 static void
 666 del_l2_fwd_entry_i (lisp_gpe_main_t * lgm, lisp_gpe_fwd_entry_t * lfe)
 667 {
 668   lisp_fwd_path_t *path;
 669
 670   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE != lfe->type)
 671     {
 672       vec_foreach (path, lfe->paths)
 673       {
 674         lisp_gpe_adjacency_unlock (path->lisp_adj);
 675       }
 676       fib_path_list_child_remove (lfe->l2.path_list_index,
 677                                   lfe->l2.child_index);
 678     }
 679
 680   lisp_l2_fib_add_del_entry (lfe->l2.eid_bd_index,
 681                              fid_addr_mac (&lfe->key->lcl),
 682                              fid_addr_mac (&lfe->key->rmt), NULL, 0);
 683
 684   hash_unset_mem (lgm->lisp_gpe_fwd_entries, lfe->key);
 685   clib_mem_free (lfe->key);
 686   pool_put (lgm->lisp_fwd_entry_pool, lfe);
 687 }
 688
 689 /**
 690  * @brief Delete LISP L2 forwarding entry.
 691  *
 692  * Coordinates the removal of forwarding entries for L2 LISP overlay:
 693  *
 694  * @param[in]   lgm     Reference to @ref lisp_gpe_main_t.
 695  * @param[in]   a       Parameters for building the forwarding entry.
 696  *
 697  * @return 0 on success.
 698  */
 699 static int
 700 del_l2_fwd_entry (lisp_gpe_main_t * lgm,
 701                   vnet_lisp_gpe_add_del_fwd_entry_args_t * a)
 702 {
 703   lisp_gpe_fwd_entry_key_t key;
 704   lisp_gpe_fwd_entry_t *lfe;
 705
 706   lfe = find_fwd_entry (lgm, a, &key);
 707
 708   if (NULL == lfe)
 709     return VNET_API_ERROR_INVALID_VALUE;
 710
 711   del_l2_fwd_entry_i (lgm, lfe);
 712
 713   return (0);
 714 }
 715
 716 /**
 717  * @brief Construct and insert the forwarding information used by an L2 entry
 718  */
 719 static void
 720 lisp_gpe_l2_update_fwding (lisp_gpe_fwd_entry_t * lfe)
 721 {
 722   lisp_gpe_main_t *lgm = &lisp_gpe_main;
 723   dpo_id_t dpo = DPO_INVALID;
 724
 725   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE != lfe->type)
 726     {
 727       fib_path_list_contribute_forwarding (lfe->l2.path_list_index,
 728                                            FIB_FORW_CHAIN_TYPE_ETHERNET,
 729                                            &lfe->l2.dpo);
 730       dpo_copy (&dpo, &lfe->l2.dpo);
 731     }
 732   else
 733     {
 734       switch (lfe->action)
 735         {
 736         case SEND_MAP_REQUEST:
 737           dpo_copy (&dpo, &lgm->l2_lb_cp_lkup);
 738           break;
 739         case NO_ACTION:
 740         case FORWARD_NATIVE:
 741         case DROP:
 742           dpo_copy (&dpo, drop_dpo_get (DPO_PROTO_ETHERNET));
 743         }
 744     }
 745
 746   /* add entry to l2 lisp fib */
 747   lisp_l2_fib_add_del_entry (lfe->l2.eid_bd_index,
 748                              fid_addr_mac (&lfe->key->lcl),
 749                              fid_addr_mac (&lfe->key->rmt), &dpo, 1);
 750
 751   dpo_reset (&dpo);
 752 }
 753
 754 /**
 755  * @brief Add LISP L2 forwarding entry.
 756  *
 757  * Coordinates the creation of forwarding entries for L2 LISP overlay:
 758  * creates lisp-gpe tunnel and injects new entry in Source/Dest L2 FIB.
 759  *
 760  * @param[in]   lgm     Reference to @ref lisp_gpe_main_t.
 761  * @param[in]   a       Parameters for building the forwarding entry.
 762  *
 763  * @return 0 on success.
 764  */
 765 static int
 766 add_l2_fwd_entry (lisp_gpe_main_t * lgm,
 767                   vnet_lisp_gpe_add_del_fwd_entry_args_t * a)
 768 {
 769   lisp_gpe_fwd_entry_key_t key;
 770   bd_main_t *bdm = &bd_main;
 771   lisp_gpe_fwd_entry_t *lfe;
 772   uword *bd_indexp;
 773
 774   bd_indexp = hash_get (bdm->bd_index_by_bd_id, a->bd_id);
 775   if (!bd_indexp)
 776     {
 777       clib_warning ("bridge domain %d doesn't exist", a->bd_id);
 778       return -1;
 779     }
 780
 781   lfe = find_fwd_entry (lgm, a, &key);
 782
 783   if (NULL != lfe)
 784     /* don't support updates */
 785     return VNET_API_ERROR_INVALID_VALUE;
 786
 787   pool_get (lgm->lisp_fwd_entry_pool, lfe);
 788   memset (lfe, 0, sizeof (*lfe));
 789   lfe->key = clib_mem_alloc (sizeof (key));
 790   memcpy (lfe->key, &key, sizeof (key));
 791
 792   hash_set_mem (lgm->lisp_gpe_fwd_entries, lfe->key,
 793                 lfe - lgm->lisp_fwd_entry_pool);
 794
 795   lfe->type = (a->is_negative ?
 796                LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE :
 797                LISP_GPE_FWD_ENTRY_TYPE_NORMAL);
 798   lfe->l2.eid_bd_id = a->bd_id;
 799   lfe->l2.eid_bd_index = bd_indexp[0];
 800   lfe->tenant = lisp_gpe_tenant_find_or_create (lfe->key->vni);
 801
 802   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE != lfe->type)
 803     {
 804       fib_route_path_t *rpaths;
 805
 806       /*
 807        * Make the sorted array of LISP paths with their resp. adjacency
 808        */
 809       lisp_gpe_fwd_entry_mk_paths (lfe, a);
 810
 811       /*
 812        * From the LISP paths, construct a FIB path list that will
 813        * contribute a load-balance.
 814        */
 815       rpaths = lisp_gpe_mk_fib_paths (lfe->paths);
 816
 817       lfe->l2.path_list_index =
 818         fib_path_list_create (FIB_PATH_LIST_FLAG_NONE, rpaths);
 819
 820       /*
 821        * become a child of the path-list so we receive updates when
 822        * its forwarding state changes. this includes an implicit lock.
 823        */
 824       lfe->l2.child_index =
 825         fib_path_list_child_add (lfe->l2.path_list_index,
 826                                  FIB_NODE_TYPE_LISP_GPE_FWD_ENTRY,
 827                                  lfe - lgm->lisp_fwd_entry_pool);
 828     }
 829   else
 830     {
 831       lfe->action = a->action;
 832     }
 833
 834   lisp_gpe_l2_update_fwding (lfe);
 835
 836   return 0;
 837 }
 838
 839 /**
 840  * @brief Lookup NSH SD FIB entry
 841  *
 842  * Does an SPI+SI lookup in the NSH LISP FIB.
 843  *
 844  * @param[in]   lgm             Reference to @ref lisp_gpe_main_t.
 845  * @param[in]   spi_si          SPI + SI.
 846  *
 847  * @return next node index.
 848  */
 849 const dpo_id_t *
 850 lisp_nsh_fib_lookup (lisp_gpe_main_t * lgm, u32 spi_si_net_order)
 851 {
 852   int rv;
 853   BVT (clib_bihash_kv) kv, value;
 854
 855   memset (&kv, 0, sizeof (kv));
 856   kv.key[0] = spi_si_net_order;
 857   rv = BV (clib_bihash_search_inline_2) (&lgm->nsh_fib, &kv, &value);
 858
 859   if (rv != 0)
 860     {
 861       return lgm->nsh_cp_lkup;
 862     }
 863   else
 864     {
 865       lisp_gpe_fwd_entry_t *lfe;
 866       lfe = pool_elt_at_index (lgm->lisp_fwd_entry_pool, value.value);
 867       return &lfe->nsh.choice;
 868     }
 869 }
 870
 871 /**
 872  * @brief Add/del NSH FIB entry
 873  *
 874  * Inserts value in NSH FIB keyed by SPI+SI. If entry is
 875  * overwritten the associated value is returned.
 876  *
 877  * @param[in]   lgm             Reference to @ref lisp_gpe_main_t.
 878  * @param[in]   spi_si          SPI + SI.
 879  * @param[in]   dpo             Load balanced mapped to SPI + SI
 880  *
 881  * @return ~0 or value of overwritten entry.
 882  */
 883 static u32
 884 lisp_nsh_fib_add_del_entry (u32 spi_si_host_order, u32 lfei, u8 is_add)
 885 {
 886   lisp_gpe_main_t *lgm = &lisp_gpe_main;
 887   BVT (clib_bihash_kv) kv, value;
 888   u32 old_val = ~0;
 889
 890   memset (&kv, 0, sizeof (kv));
 891   kv.key[0] = clib_host_to_net_u32 (spi_si_host_order);
 892   kv.value = 0ULL;
 893
 894   if (BV (clib_bihash_search) (&lgm->nsh_fib, &kv, &value) == 0)
 895     old_val = value.value;
 896
 897   if (!is_add)
 898     BV (clib_bihash_add_del) (&lgm->nsh_fib, &kv, 0 /* is_add */ );
 899   else
 900     {
 901       kv.value = lfei;
 902       BV (clib_bihash_add_del) (&lgm->nsh_fib, &kv, 1 /* is_add */ );
 903     }
 904   return old_val;
 905 }
 906
 907 #define NSH_FIB_DEFAULT_HASH_NUM_BUCKETS (64 * 1024)
 908 #define NSH_FIB_DEFAULT_HASH_MEMORY_SIZE (32<<20)
 909
 910 static void
 911 nsh_fib_init (lisp_gpe_main_t * lgm)
 912 {
 913   BV (clib_bihash_init) (&lgm->nsh_fib, "nsh fib",
 914                          1 << max_log2 (NSH_FIB_DEFAULT_HASH_NUM_BUCKETS),
 915                          NSH_FIB_DEFAULT_HASH_MEMORY_SIZE);
 916
 917   /*
 918    * the result from a 'miss' in a NSH Table
 919    */
 920   lgm->nsh_cp_lkup = lisp_cp_dpo_get (DPO_PROTO_NSH);
 921 }
 922
 923 static void
 924 del_nsh_fwd_entry_i (lisp_gpe_main_t * lgm, lisp_gpe_fwd_entry_t * lfe)
 925 {
 926   lisp_fwd_path_t *path;
 927
 928   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE != lfe->type)
 929     {
 930       vec_foreach (path, lfe->paths)
 931       {
 932         lisp_gpe_adjacency_unlock (path->lisp_adj);
 933       }
 934       fib_path_list_child_remove (lfe->nsh.path_list_index,
 935                                   lfe->nsh.child_index);
 936       dpo_reset (&lfe->nsh.choice);
 937     }
 938
 939   lisp_nsh_fib_add_del_entry (fid_addr_nsh (&lfe->key->rmt), (u32) ~ 0, 0);
 940
 941   hash_unset_mem (lgm->lisp_gpe_fwd_entries, lfe->key);
 942   clib_mem_free (lfe->key);
 943   pool_put (lgm->lisp_fwd_entry_pool, lfe);
 944 }
 945
 946 /**
 947  * @brief Delete LISP NSH forwarding entry.
 948  *
 949  * Coordinates the removal of forwarding entries for NSH LISP overlay:
 950  *
 951  * @param[in]   lgm     Reference to @ref lisp_gpe_main_t.
 952  * @param[in]   a       Parameters for building the forwarding entry.
 953  *
 954  * @return 0 on success.
 955  */
 956 static int
 957 del_nsh_fwd_entry (lisp_gpe_main_t * lgm,
 958                    vnet_lisp_gpe_add_del_fwd_entry_args_t * a)
 959 {
 960   lisp_gpe_fwd_entry_key_t key;
 961   lisp_gpe_fwd_entry_t *lfe;
 962
 963   lfe = find_fwd_entry (lgm, a, &key);
 964
 965   if (NULL == lfe)
 966     return VNET_API_ERROR_INVALID_VALUE;
 967
 968   del_nsh_fwd_entry_i (lgm, lfe);
 969
 970   return (0);
 971 }
 972
 973 /**
 974  * @brief Construct and insert the forwarding information used by an NSH entry
 975  */
 976 static void
 977 lisp_gpe_nsh_update_fwding (lisp_gpe_fwd_entry_t * lfe)
 978 {
 979   lisp_gpe_main_t *lgm = vnet_lisp_gpe_get_main ();
 980   dpo_id_t dpo = DPO_INVALID;
 981   vnet_hw_interface_t *hi;
 982   uword *hip;
 983
 984   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE != lfe->type)
 985     {
 986       fib_path_list_contribute_forwarding (lfe->nsh.path_list_index,
 987                                            FIB_FORW_CHAIN_TYPE_NSH,
 988                                            &lfe->nsh.dpo);
 989
 990       /*
 991        * LISP encap is always the same for this SPI+SI so we do that hash now
 992        * and stack on the choice.
 993        */
 994       if (DPO_LOAD_BALANCE == lfe->nsh.dpo.dpoi_type)
 995         {
 996           const dpo_id_t *tmp;
 997           const load_balance_t *lb;
 998           int hash;
 999
1000           lb = load_balance_get (lfe->nsh.dpo.dpoi_index);
1001           hash = fid_addr_nsh (&lfe->key->rmt) % lb->lb_n_buckets;
1002           tmp =
1003             load_balance_get_bucket_i (lb, hash & lb->lb_n_buckets_minus_1);
1004
1005           dpo_copy (&dpo, tmp);
1006         }
1007     }
1008   else
1009     {
1010       switch (lfe->action)
1011         {
1012         case SEND_MAP_REQUEST:
1013           dpo_copy (&dpo, lgm->nsh_cp_lkup);
1014           break;
1015         case NO_ACTION:
1016         case FORWARD_NATIVE:
1017         case DROP:
1018           dpo_copy (&dpo, drop_dpo_get (DPO_PROTO_NSH));
1019         }
1020     }
1021
1022   /* We have only one nsh-lisp interface (no NSH virtualization) */
1023   hip = hash_get (lgm->nsh_ifaces.hw_if_index_by_dp_table, 0);
1024   if (hip)
1025     {
1026       hi = vnet_get_hw_interface (lgm->vnet_main, hip[0]);
1027       dpo_stack_from_node (hi->tx_node_index, &lfe->nsh.choice, &dpo);
1028     }
1029   /* add entry to nsh lisp fib */
1030   lisp_nsh_fib_add_del_entry (fid_addr_nsh (&lfe->key->rmt),
1031                               lfe - lgm->lisp_fwd_entry_pool, 1);
1032   dpo_reset (&dpo);
1033
1034 }
1035
1036 /**
1037  * @brief Add LISP NSH forwarding entry.
1038  *
1039  * Coordinates the creation of forwarding entries for L2 LISP overlay:
1040  * creates lisp-gpe tunnel and injects new entry in Source/Dest L2 FIB.
1041  *
1042  * @param[in]   lgm     Reference to @ref lisp_gpe_main_t.
1043  * @param[in]   a       Parameters for building the forwarding entry.
1044  *
1045  * @return 0 on success.
1046  */
1047 static int
1048 add_nsh_fwd_entry (lisp_gpe_main_t * lgm,
1049                    vnet_lisp_gpe_add_del_fwd_entry_args_t * a)
1050 {
1051   lisp_gpe_fwd_entry_key_t key;
1052   lisp_gpe_fwd_entry_t *lfe;
1053
1054   lfe = find_fwd_entry (lgm, a, &key);
1055
1056   if (NULL != lfe)
1057     /* don't support updates */
1058     return VNET_API_ERROR_INVALID_VALUE;
1059
1060   pool_get (lgm->lisp_fwd_entry_pool, lfe);
1061   memset (lfe, 0, sizeof (*lfe));
1062   lfe->key = clib_mem_alloc (sizeof (key));
1063   memcpy (lfe->key, &key, sizeof (key));
1064
1065   hash_set_mem (lgm->lisp_gpe_fwd_entries, lfe->key,
1066                 lfe - lgm->lisp_fwd_entry_pool);
1067
1068   lfe->type = (a->is_negative ?
1069                LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE :
1070                LISP_GPE_FWD_ENTRY_TYPE_NORMAL);
1071   lfe->tenant = 0;
1072
1073   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE != lfe->type)
1074     {
1075       fib_route_path_t *rpaths;
1076
1077       /*
1078        * Make the sorted array of LISP paths with their resp. adjacency
1079        */
1080       lisp_gpe_fwd_entry_mk_paths (lfe, a);
1081
1082       /*
1083        * From the LISP paths, construct a FIB path list that will
1084        * contribute a load-balance.
1085        */
1086       rpaths = lisp_gpe_mk_fib_paths (lfe->paths);
1087
1088       lfe->nsh.path_list_index =
1089         fib_path_list_create (FIB_PATH_LIST_FLAG_NONE, rpaths);
1090
1091       /*
1092        * become a child of the path-list so we receive updates when
1093        * its forwarding state changes. this includes an implicit lock.
1094        */
1095       lfe->nsh.child_index =
1096         fib_path_list_child_add (lfe->nsh.path_list_index,
1097                                  FIB_NODE_TYPE_LISP_GPE_FWD_ENTRY,
1098                                  lfe - lgm->lisp_fwd_entry_pool);
1099     }
1100   else
1101     {
1102       lfe->action = a->action;
1103     }
1104
1105   lisp_gpe_nsh_update_fwding (lfe);
1106
1107   return 0;
1108 }
1109
1110 /**
1111  * @brief conver from the embedded fib_node_t struct to the LSIP entry
1112  */
1113 static lisp_gpe_fwd_entry_t *
1114 lisp_gpe_fwd_entry_from_fib_node (fib_node_t * node)
1115 {
1116   return ((lisp_gpe_fwd_entry_t *) (((char *) node) -
1117                                     STRUCT_OFFSET_OF (lisp_gpe_fwd_entry_t,
1118                                                       node)));
1119 }
1120
1121 /**
1122  * @brief Function invoked during a backwalk of the FIB graph
1123  */
1124 static fib_node_back_walk_rc_t
1125 lisp_gpe_fib_node_back_walk (fib_node_t * node,
1126                              fib_node_back_walk_ctx_t * ctx)
1127 {
1128   lisp_gpe_fwd_entry_t *lfe = lisp_gpe_fwd_entry_from_fib_node (node);
1129
1130   if (fid_addr_type (&lfe->key->rmt) == FID_ADDR_MAC)
1131     lisp_gpe_l2_update_fwding (lfe);
1132   else if (fid_addr_type (&lfe->key->rmt) == FID_ADDR_NSH)
1133     lisp_gpe_nsh_update_fwding (lfe);
1134
1135   return (FIB_NODE_BACK_WALK_CONTINUE);
1136 }
1137
1138 /**
1139  * @brief Get a fib_node_t struct from the index of a LISP fwd entry
1140  */
1141 static fib_node_t *
1142 lisp_gpe_fwd_entry_get_fib_node (fib_node_index_t index)
1143 {
1144   lisp_gpe_main_t *lgm = &lisp_gpe_main;
1145   lisp_gpe_fwd_entry_t *lfe;
1146
1147   lfe = pool_elt_at_index (lgm->lisp_fwd_entry_pool, index);
1148
1149   return (&(lfe->node));
1150 }
1151
1152 /**
1153  * @brief An indication from the graph that the last lock has gone
1154  */
1155 static void
1156 lisp_gpe_fwd_entry_fib_node_last_lock_gone (fib_node_t * node)
1157 {
1158   /* We don't manage the locks of the LISP objects via the graph, since
1159    * this object has no children. so this is a no-op. */
1160 }
1161
1162 /**
1163  * @brief Virtual function table to register with FIB for the LISP type
1164  */
1165 const static fib_node_vft_t lisp_fwd_vft = {
1166   .fnv_get = lisp_gpe_fwd_entry_get_fib_node,
1167   .fnv_last_lock = lisp_gpe_fwd_entry_fib_node_last_lock_gone,
1168   .fnv_back_walk = lisp_gpe_fib_node_back_walk,
1169 };
1170
1171 /**
1172  * @brief Forwarding entry create/remove dispatcher.
1173  *
1174  * Calls l2 or l3 forwarding entry add/del function based on input data.
1175  *
1176  * @param[in]   a       Forwarding entry parameters.
1177  * @param[out]  hw_if_indexp    NOT USED
1178  *
1179  * @return 0 on success.
1180  */
1181 int
1182 vnet_lisp_gpe_add_del_fwd_entry (vnet_lisp_gpe_add_del_fwd_entry_args_t * a,
1183                                  u32 * hw_if_indexp)
1184 {
1185   lisp_gpe_main_t *lgm = &lisp_gpe_main;
1186   u8 type;
1187
1188   if (vnet_lisp_gpe_enable_disable_status () == 0)
1189     {
1190       clib_warning ("LISP is disabled!");
1191       return VNET_API_ERROR_LISP_DISABLED;
1192     }
1193
1194   type = gid_address_type (&a->rmt_eid);
1195   switch (type)
1196     {
1197     case GID_ADDR_IP_PREFIX:
1198       if (a->is_add)
1199         return add_ip_fwd_entry (lgm, a);
1200       else
1201         return del_ip_fwd_entry (lgm, a);
1202       break;
1203     case GID_ADDR_MAC:
1204       if (a->is_add)
1205         return add_l2_fwd_entry (lgm, a);
1206       else
1207         return del_l2_fwd_entry (lgm, a);
1208     case GID_ADDR_NSH:
1209       if (a->is_add)
1210         return add_nsh_fwd_entry (lgm, a);
1211       else
1212         return del_nsh_fwd_entry (lgm, a);
1213     default:
1214       clib_warning ("Forwarding entries for type %d not supported!", type);
1215       return -1;
1216     }
1217 }
1218
1219 int
1220 vnet_lisp_flush_stats (void)
1221 {
1222   lisp_gpe_main_t *lgm = vnet_lisp_gpe_get_main ();
1223   vlib_combined_counter_main_t *cm = &lgm->counters;
1224   u32 i;
1225
1226   for (i = 0; i < vlib_combined_counter_n_counters (cm); i++)
1227     vlib_zero_combined_counter (cm, i);
1228
1229   return 0;
1230 }
1231
1232 static void
1233 lisp_del_adj_stats (lisp_gpe_main_t * lgm, u32 fwd_entry_index, u32 ti)
1234 {
1235   hash_pair_t *hp;
1236   lisp_stats_key_t key;
1237   void *key_copy;
1238   uword *p;
1239   u8 *s;
1240
1241   memset (&key, 0, sizeof (key));
1242   key.fwd_entry_index = fwd_entry_index;
1243   key.tunnel_index = ti;
1244
1245   p = hash_get_mem (lgm->lisp_stats_index_by_key, &key);
1246   if (p)
1247     {
1248       s = pool_elt_at_index (lgm->dummy_stats_pool, p[0]);
1249       hp = hash_get_pair (lgm->lisp_stats_index_by_key, &key);
1250       key_copy = (void *) (hp->key);
1251       hash_unset_mem (lgm->lisp_stats_index_by_key, &key);
1252       clib_mem_free (key_copy);
1253       pool_put (lgm->dummy_stats_pool, s);
1254     }
1255 }
1256
1257 void
1258 vnet_lisp_gpe_del_fwd_counters (vnet_lisp_gpe_add_del_fwd_entry_args_t * a,
1259                                 u32 fwd_entry_index)
1260 {
1261   lisp_gpe_main_t *lgm = &lisp_gpe_main;
1262   lisp_gpe_fwd_entry_key_t fe_key;
1263   lisp_gpe_fwd_entry_t *lfe;
1264   lisp_fwd_path_t *path;
1265   const lisp_gpe_adjacency_t *ladj;
1266
1267   lfe = find_fwd_entry (lgm, a, &fe_key);
1268   if (!lfe)
1269     return;
1270
1271   if (LISP_GPE_FWD_ENTRY_TYPE_NORMAL != lfe->type)
1272     return;
1273
1274   vec_foreach (path, lfe->paths)
1275   {
1276     ladj = lisp_gpe_adjacency_get (path->lisp_adj);
1277     lisp_del_adj_stats (lgm, fwd_entry_index, ladj->tunnel_index);
1278   }
1279 }
1280
1281 /**
1282  * @brief Flush all the forwrding entries
1283  */
1284 void
1285 vnet_lisp_gpe_fwd_entry_flush (void)
1286 {
1287   lisp_gpe_main_t *lgm = &lisp_gpe_main;
1288   lisp_gpe_fwd_entry_t *lfe;
1289
1290   /* *INDENT-OFF* */
1291   pool_foreach (lfe, lgm->lisp_fwd_entry_pool,
1292   ({
1293     switch (fid_addr_type(&lfe->key->rmt))
1294       {
1295       case FID_ADDR_MAC:
1296         del_l2_fwd_entry_i (lgm, lfe);
1297         break;
1298       case FID_ADDR_IP_PREF:
1299         del_ip_fwd_entry_i (lgm, lfe);
1300         break;
1301       case FID_ADDR_NSH:
1302         del_nsh_fwd_entry_i (lgm, lfe);
1303         break;
1304       }
1305   }));
1306   /* *INDENT-ON* */
1307 }
1308
1309 static u8 *
1310 format_lisp_fwd_path (u8 * s, va_list ap)
1311 {
1312   lisp_fwd_path_t *lfp = va_arg (ap, lisp_fwd_path_t *);
1313
1314   s = format (s, "weight:%d ", lfp->weight);
1315   s = format (s, "adj:[%U]\n",
1316               format_lisp_gpe_adjacency,
1317               lisp_gpe_adjacency_get (lfp->lisp_adj),
1318               LISP_GPE_ADJ_FORMAT_FLAG_NONE);
1319
1320   return (s);
1321 }
1322
1323 typedef enum lisp_gpe_fwd_entry_format_flag_t_
1324 {
1325   LISP_GPE_FWD_ENTRY_FORMAT_NONE = (0 << 0),
1326   LISP_GPE_FWD_ENTRY_FORMAT_DETAIL = (1 << 1),
1327 } lisp_gpe_fwd_entry_format_flag_t;
1328
1329
1330 static u8 *
1331 format_lisp_gpe_fwd_entry (u8 * s, va_list ap)
1332 {
1333   lisp_gpe_main_t *lgm = &lisp_gpe_main;
1334   lisp_gpe_fwd_entry_t *lfe = va_arg (ap, lisp_gpe_fwd_entry_t *);
1335   lisp_gpe_fwd_entry_format_flag_t flags =
1336     va_arg (ap, lisp_gpe_fwd_entry_format_flag_t);
1337
1338   s = format (s, "VNI:%d VRF:%d EID: %U -> %U  [index:%d]",
1339               lfe->key->vni, lfe->eid_table_id,
1340               format_fid_address, &lfe->key->lcl,
1341               format_fid_address, &lfe->key->rmt,
1342               lfe - lgm->lisp_fwd_entry_pool);
1343
1344   if (LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE == lfe->type)
1345     {
1346       s = format (s, "\n Negative - action:%U",
1347                   format_negative_mapping_action, lfe->action);
1348     }
1349   else
1350     {
1351       lisp_fwd_path_t *path;
1352
1353       s = format (s, "\n via:");
1354       vec_foreach (path, lfe->paths)
1355       {
1356         s = format (s, "\n  %U", format_lisp_fwd_path, path);
1357       }
1358     }
1359
1360   if (flags & LISP_GPE_FWD_ENTRY_FORMAT_DETAIL)
1361     {
1362       switch (fid_addr_type (&lfe->key->rmt))
1363         {
1364         case FID_ADDR_MAC:
1365           s = format (s, " fib-path-list:%d\n", lfe->l2.path_list_index);
1366           s = format (s, " dpo:%U\n", format_dpo_id, &lfe->l2.dpo, 0);
1367           break;
1368         case FID_ADDR_NSH:
1369           s = format (s, " fib-path-list:%d\n", lfe->nsh.path_list_index);
1370           s = format (s, " dpo:%U\n", format_dpo_id, &lfe->nsh.dpo, 0);
1371           break;
1372         case FID_ADDR_IP_PREF:
1373           break;
1374         }
1375     }
1376
1377   return (s);
1378 }
1379
1380 static clib_error_t *
1381 lisp_gpe_fwd_entry_show (vlib_main_t * vm,
1382                          unformat_input_t * input, vlib_cli_command_t * cmd)
1383 {
1384   lisp_gpe_main_t *lgm = &lisp_gpe_main;
1385   lisp_gpe_fwd_entry_t *lfe;
1386   index_t index;
1387   u32 vni = ~0;
1388
1389   if (unformat (input, "vni %d", &vni))
1390     ;
1391   else if (unformat (input, "%d", &index))
1392     {
1393       if (!pool_is_free_index (lgm->lisp_fwd_entry_pool, index))
1394         {
1395           lfe = pool_elt_at_index (lgm->lisp_fwd_entry_pool, index);
1396
1397           vlib_cli_output (vm, "[%d@] %U",
1398                            index,
1399                            format_lisp_gpe_fwd_entry, lfe,
1400                            LISP_GPE_FWD_ENTRY_FORMAT_DETAIL);
1401         }
1402       else
1403         {
1404           vlib_cli_output (vm, "entry %d invalid", index);
1405         }
1406
1407       return (NULL);
1408     }
1409
1410   /* *INDENT-OFF* */
1411   pool_foreach (lfe, lgm->lisp_fwd_entry_pool,
1412   ({
1413     if ((vni == ~0) ||
1414         (lfe->key->vni == vni))
1415       vlib_cli_output (vm, "%U", format_lisp_gpe_fwd_entry, lfe,
1416                        LISP_GPE_FWD_ENTRY_FORMAT_NONE);
1417   }));
1418   /* *INDENT-ON* */
1419
1420   return (NULL);
1421 }
1422
1423 /* *INDENT-OFF* */
1424 VLIB_CLI_COMMAND (lisp_gpe_fwd_entry_show_command, static) = {
1425   .path = "show gpe entry",
1426   .short_help = "show gpe entry vni <vni> vrf <vrf> [leid <leid>] reid <reid>",
1427   .function = lisp_gpe_fwd_entry_show,
1428 };
1429 /* *INDENT-ON* */
1430
1431 clib_error_t *
1432 lisp_gpe_fwd_entry_init (vlib_main_t * vm)
1433 {
1434   lisp_gpe_main_t *lgm = &lisp_gpe_main;
1435   clib_error_t *error = NULL;
1436
1437   if ((error = vlib_call_init_function (vm, lisp_cp_dpo_module_init)))
1438     return (error);
1439
1440   l2_fib_init (lgm);
1441   nsh_fib_init (lgm);
1442
1443   fib_node_register_type (FIB_NODE_TYPE_LISP_GPE_FWD_ENTRY, &lisp_fwd_vft);
1444
1445   return (error);
1446 }
1447
1448 u32 *
1449 vnet_lisp_gpe_get_fwd_entry_vnis (void)
1450 {
1451   lisp_gpe_main_t *lgm = vnet_lisp_gpe_get_main ();
1452   lisp_gpe_fwd_entry_t *lfe;
1453   u32 *vnis = 0;
1454
1455   /* *INDENT-OFF* */
1456   pool_foreach (lfe, lgm->lisp_fwd_entry_pool,
1457   ({
1458     hash_set (vnis, lfe->key->vni, 0);
1459   }));
1460   /* *INDENT-ON* */
1461
1462   return vnis;
1463 }
1464
1465 lisp_api_gpe_fwd_entry_t *
1466 vnet_lisp_gpe_fwd_entries_get_by_vni (u32 vni)
1467 {
1468   lisp_gpe_main_t *lgm = &lisp_gpe_main;
1469   lisp_gpe_fwd_entry_t *lfe;
1470   lisp_api_gpe_fwd_entry_t *entries = 0, e;
1471
1472   /* *INDENT-OFF* */
1473   pool_foreach (lfe, lgm->lisp_fwd_entry_pool,
1474   ({
1475     if (lfe->key->vni == vni)
1476       {
1477         memset (&e, 0, sizeof (e));
1478         e.dp_table = lfe->eid_table_id;
1479         e.vni = lfe->key->vni;
1480         if (lfe->type == LISP_GPE_FWD_ENTRY_TYPE_NEGATIVE)
1481           e.action = lfe->action;
1482         e.fwd_entry_index = lfe - lgm->lisp_fwd_entry_pool;
1483         memcpy (&e.reid, &lfe->key->rmt, sizeof (e.reid));
1484         memcpy (&e.leid, &lfe->key->lcl, sizeof (e.leid));
1485         vec_add1 (entries, e);
1486       }
1487   }));
1488   /* *INDENT-ON* */
1489
1490   return entries;
1491 }
1492
1493 VLIB_INIT_FUNCTION (lisp_gpe_fwd_entry_init);
1494
1495 /*
1496  * fd.io coding-style-patch-verification: ON
1497  *
1498  * Local Variables:
1499  * eval: (c-set-style "gnu")
1500  * End:
1501  */