src/plugins/linux-cp/lcp_router.c

   1 /*
   2  * Copyright (c) 2019 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 <sys/socket.h>
  17 #include <linux/if.h>
  18
  19 //#include <vlib/vlib.h>
  20 #include <vlib/unix/plugin.h>
  21 #include <linux-cp/lcp_nl.h>
  22 #include <linux-cp/lcp_interface.h>
  23
  24 #include <netlink/msg.h>
  25 #include <netlink/netlink.h>
  26 #include <netlink/socket.h>
  27 #include <netlink/route/link.h>
  28 #include <netlink/route/route.h>
  29 #include <netlink/route/neighbour.h>
  30 #include <netlink/route/addr.h>
  31 #include <netlink/route/link/vlan.h>
  32
  33 #include <vnet/fib/fib_table.h>
  34 #include <vnet/mfib/mfib_table.h>
  35 #include <vnet/ip/ip6_ll_table.h>
  36 #include <vnet/ip-neighbor/ip_neighbor.h>
  37 #include <vnet/ip/ip6_link.h>
  38
  39 typedef struct lcp_router_table_t_
  40 {
  41   uint32_t nlt_id;
  42   fib_protocol_t nlt_proto;
  43   u32 nlt_fib_index;
  44   u32 nlt_mfib_index;
  45   u32 nlt_refs;
  46 } lcp_router_table_t;
  47
  48 static uword *lcp_router_table_db[FIB_PROTOCOL_MAX];
  49 static lcp_router_table_t *lcp_router_table_pool;
  50 static vlib_log_class_t lcp_router_logger;
  51
  52 const static fib_prefix_t pfx_all1s = {
  53   .fp_addr = {
  54     .ip4 = {
  55       .as_u32 = 0xffffffff,
  56     }
  57   },
  58   .fp_proto = FIB_PROTOCOL_IP4,
  59   .fp_len = 32,
  60 };
  61
  62 static fib_source_t lcp_rt_fib_src;
  63 static fib_source_t lcp_rt_fib_src_dynamic;
  64
  65 #define LCP_ROUTER_DBG(...) vlib_log_debug (lcp_router_logger, __VA_ARGS__);
  66
  67 #define LCP_ROUTER_INFO(...) vlib_log_notice (lcp_router_logger, __VA_ARGS__);
  68
  69 #define LCP_ROUTER_ERROR(...) vlib_log_err (lcp_router_logger, __VA_ARGS__);
  70
  71 static const mfib_prefix_t ip4_specials[] = {
  72   /* ALL prefixes are in network order */
  73   {
  74    /* (*,224.0.0.0)/24 - all local subnet */
  75    .fp_grp_addr = {
  76                    .ip4.data_u32 = 0x000000e0,
  77                    },
  78    .fp_len = 24,
  79    .fp_proto = FIB_PROTOCOL_IP4,
  80    },
  81 };
  82
  83 static const mfib_prefix_t ip6_specials[] = {
  84   /* ALL prefixes are in network order */
  85   {
  86    /* (*,ff00::)/8 - all local subnet */
  87    .fp_grp_addr = {
  88                    .ip6.as_u64[0] = 0x00000000000000ff,
  89                    },
  90    .fp_len = 8,
  91    .fp_proto = FIB_PROTOCOL_IP6,
  92    },
  93 };
  94
  95 /* VIF to PHY DB of managed interfaces */
  96 static uword *lcp_routing_itf_db;
  97
  98 static u32
  99 lcp_router_intf_h2p (u32 host)
 100 {
 101   lcp_itf_pair_t *lip;
 102   index_t lipi;
 103   uword *p;
 104
 105   /*
 106    * first check the linux side created interface (i.e. vlans, tunnels etc)
 107    */
 108   p = hash_get (lcp_routing_itf_db, host);
 109
 110   if (p)
 111     return p[0];
 112
 113   /*
 114    * then check the paired phys
 115    */
 116   lipi = lcp_itf_pair_find_by_vif (host);
 117
 118   if (INDEX_INVALID == lipi)
 119     return (~0);
 120
 121   lip = lcp_itf_pair_get (lipi);
 122
 123   return lip->lip_phy_sw_if_index;
 124 }
 125
 126 /*
 127  * Check timestamps on netlink message and interface pair to decide whether
 128  * the message should be applied. See the declaration of nl_msg_info_t for
 129  * an explanation on why this is necessary.
 130  * If timestamps are good (message ts is newer than intf pair ts), return 0.
 131  * Else, return -1.
 132  */
 133 static int
 134 lcp_router_lip_ts_check (nl_msg_info_t *msg_info, lcp_itf_pair_t *lip)
 135 {
 136   if (!msg_info)
 137     return 0;
 138
 139   if (msg_info->ts > lip->lip_create_ts)
 140     return 0;
 141
 142   LCP_ROUTER_INFO ("Early message received for %U",
 143                    format_vnet_sw_if_index_name, vnet_get_main (),
 144                    lip->lip_phy_sw_if_index);
 145   return -1;
 146 }
 147
 148 static void
 149 lcp_router_link_del (struct rtnl_link *rl, void *ctx)
 150 {
 151   index_t lipi;
 152
 153   if (!lcp_auto_subint ())
 154     return;
 155
 156   lipi = lcp_itf_pair_find_by_vif (rtnl_link_get_ifindex (rl));
 157
 158   if (INDEX_INVALID != lipi)
 159     {
 160       lcp_itf_pair_t *lip;
 161
 162       lip = lcp_itf_pair_get (lipi);
 163
 164       if (lcp_router_lip_ts_check ((nl_msg_info_t *) ctx, lip))
 165         return;
 166
 167       LCP_ROUTER_INFO ("delete link: %s - %U", rtnl_link_get_type (rl),
 168                        format_vnet_sw_if_index_name, vnet_get_main (),
 169                        lip->lip_phy_sw_if_index);
 170       lcp_itf_pair_delete (lip->lip_phy_sw_if_index);
 171
 172       if (rtnl_link_is_vlan (rl))
 173         {
 174           LCP_ROUTER_INFO ("delete vlan: %s -> %U", rtnl_link_get_name (rl),
 175                            format_vnet_sw_if_index_name, vnet_get_main (),
 176                            lip->lip_phy_sw_if_index);
 177           vnet_delete_sub_interface (lip->lip_phy_sw_if_index);
 178           vnet_delete_sub_interface (lip->lip_host_sw_if_index);
 179         }
 180     }
 181   else
 182     LCP_ROUTER_INFO ("ignore link del: %s - %s", rtnl_link_get_type (rl),
 183                      rtnl_link_get_name (rl));
 184 }
 185
 186 static void
 187 lcp_router_ip4_mroutes_add_del (u32 sw_if_index, u8 is_add)
 188 {
 189   const fib_route_path_t path = {
 190     .frp_proto = DPO_PROTO_IP4,
 191     .frp_addr = zero_addr,
 192     .frp_sw_if_index = sw_if_index,
 193     .frp_fib_index = ~0,
 194     .frp_weight = 1,
 195     .frp_mitf_flags = MFIB_ITF_FLAG_ACCEPT,
 196   };
 197   u32 mfib_index;
 198   int ii;
 199
 200   mfib_index =
 201     mfib_table_get_index_for_sw_if_index (FIB_PROTOCOL_IP4, sw_if_index);
 202
 203   for (ii = 0; ii < ARRAY_LEN (ip4_specials); ii++)
 204     {
 205       if (is_add)
 206         {
 207           mfib_table_entry_path_update (mfib_index, &ip4_specials[ii],
 208                                         MFIB_SOURCE_PLUGIN_LOW,
 209                                         MFIB_ENTRY_FLAG_NONE, &path);
 210         }
 211       else
 212         {
 213           mfib_table_entry_path_remove (mfib_index, &ip4_specials[ii],
 214                                         MFIB_SOURCE_PLUGIN_LOW, &path);
 215         }
 216     }
 217 }
 218
 219 static void
 220 lcp_router_ip6_mroutes_add_del (u32 sw_if_index, u8 is_add)
 221 {
 222   const fib_route_path_t path = {
 223     .frp_proto = DPO_PROTO_IP6,
 224     .frp_addr = zero_addr,
 225     .frp_sw_if_index = sw_if_index,
 226     .frp_fib_index = ~0,
 227     .frp_weight = 1,
 228     .frp_mitf_flags = MFIB_ITF_FLAG_ACCEPT,
 229   };
 230   u32 mfib_index;
 231   int ii;
 232
 233   mfib_index =
 234     mfib_table_get_index_for_sw_if_index (FIB_PROTOCOL_IP6, sw_if_index);
 235
 236   for (ii = 0; ii < ARRAY_LEN (ip6_specials); ii++)
 237     {
 238       if (is_add)
 239         {
 240           mfib_table_entry_path_update (mfib_index, &ip6_specials[ii],
 241                                         MFIB_SOURCE_PLUGIN_LOW,
 242                                         MFIB_ENTRY_FLAG_NONE, &path);
 243         }
 244       else
 245         {
 246           mfib_table_entry_path_remove (mfib_index, &ip6_specials[ii],
 247                                         MFIB_SOURCE_PLUGIN_LOW, &path);
 248         }
 249     }
 250 }
 251
 252 static void
 253 lcp_router_link_mtu (struct rtnl_link *rl, u32 sw_if_index)
 254 {
 255   vnet_main_t *vnm = vnet_get_main ();
 256   u32 mtu;
 257   vnet_sw_interface_t *sw;
 258   vnet_hw_interface_t *hw;
 259
 260   mtu = rtnl_link_get_mtu (rl);
 261   if (!mtu)
 262     return;
 263
 264   sw = vnet_get_sw_interface (vnm, sw_if_index);
 265   hw = vnet_get_sup_hw_interface (vnm, sw_if_index);
 266
 267   /* If HW interface, try to change hw link */
 268   if ((sw->sw_if_index == sw->sup_sw_if_index) &&
 269       (hw->hw_class_index == ethernet_hw_interface_class.index))
 270     vnet_hw_interface_set_mtu (vnm, hw->hw_if_index, mtu);
 271   else
 272     vnet_sw_interface_set_mtu (vnm, sw->sw_if_index, mtu);
 273 }
 274
 275 static void
 276 lcp_router_link_addr (struct rtnl_link *rl, lcp_itf_pair_t *lip)
 277 {
 278   vnet_main_t *vnm = vnet_get_main ();
 279   struct nl_addr *mac_addr;
 280   vnet_sw_interface_t *sw;
 281   vnet_hw_interface_t *hw;
 282   void *mac_addr_bytes;
 283
 284   mac_addr = rtnl_link_get_addr (rl);
 285   if (!mac_addr || (nl_addr_get_family (mac_addr) != AF_LLC))
 286     return;
 287
 288   sw = vnet_get_sw_interface (vnm, lip->lip_phy_sw_if_index);
 289
 290   /* can only change address on hw interface */
 291   if (sw->sw_if_index != sw->sup_sw_if_index)
 292     return;
 293
 294   hw = vnet_get_sup_hw_interface (vnm, lip->lip_phy_sw_if_index);
 295   if (!vec_len (hw->hw_address))
 296     return;
 297
 298   mac_addr_bytes = nl_addr_get_binary_addr (mac_addr);
 299   if (clib_memcmp (mac_addr_bytes, hw->hw_address, nl_addr_get_len (mac_addr)))
 300     vnet_hw_interface_change_mac_address (vnm, hw->hw_if_index,
 301                                           mac_addr_bytes);
 302
 303   /* mcast adjacencies need to be updated */
 304   vnet_update_adjacency_for_sw_interface (vnm, lip->lip_phy_sw_if_index,
 305                                           lip->lip_phy_adjs.adj_index[AF_IP4]);
 306   vnet_update_adjacency_for_sw_interface (vnm, lip->lip_phy_sw_if_index,
 307                                           lip->lip_phy_adjs.adj_index[AF_IP6]);
 308 }
 309
 310 static void lcp_router_table_flush (lcp_router_table_t *nlt,
 311                                     u32 *sw_if_index_to_bool,
 312                                     fib_source_t source);
 313
 314 static void
 315 lcp_router_link_add (struct rtnl_link *rl, void *ctx)
 316 {
 317   index_t lipi;
 318   int up;
 319   vnet_main_t *vnm = vnet_get_main ();
 320
 321   lipi = lcp_itf_pair_find_by_vif (rtnl_link_get_ifindex (rl));
 322   up = IFF_UP & rtnl_link_get_flags (rl);
 323
 324   if (INDEX_INVALID != lipi)
 325     {
 326       lcp_itf_pair_t *lip;
 327       u32 sw_if_flags;
 328       u32 sw_if_up;
 329
 330       lip = lcp_itf_pair_get (lipi);
 331       if (!vnet_get_sw_interface (vnm, lip->lip_phy_sw_if_index))
 332         return;
 333
 334       if (lcp_router_lip_ts_check ((nl_msg_info_t *) ctx, lip))
 335         return;
 336
 337       sw_if_flags =
 338         vnet_sw_interface_get_flags (vnm, lip->lip_phy_sw_if_index);
 339       sw_if_up = (sw_if_flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP);
 340
 341       if (!sw_if_up && up)
 342         {
 343           vnet_sw_interface_admin_up (vnet_get_main (),
 344                                       lip->lip_phy_sw_if_index);
 345         }
 346       else if (sw_if_up && !up)
 347         {
 348           vnet_sw_interface_admin_down (vnet_get_main (),
 349                                         lip->lip_phy_sw_if_index);
 350
 351           /* When an interface is brought down administratively, the kernel
 352            * removes routes which resolve through that interface. For IPv4
 353            * routes, the kernel will not send any explicit RTM_DELROUTE
 354            * messages about removing them. In order to synchronize with the
 355            * kernel, affected IPv4 routes need to be manually removed from the
 356            * FIB. The behavior is different for IPv6 routes. Explicit
 357            * RTM_DELROUTE messages are sent about IPv6 routes being removed.
 358            */
 359           u32 fib_index;
 360           lcp_router_table_t *nlt;
 361
 362           fib_index = fib_table_get_index_for_sw_if_index (
 363             FIB_PROTOCOL_IP4, lip->lip_phy_sw_if_index);
 364
 365           pool_foreach (nlt, lcp_router_table_pool)
 366             {
 367               if (fib_index == nlt->nlt_fib_index &&
 368                   FIB_PROTOCOL_IP4 == nlt->nlt_proto)
 369                 {
 370                   u32 *sw_if_index_to_bool = NULL;
 371
 372                   vec_validate_init_empty (sw_if_index_to_bool,
 373                                            lip->lip_phy_sw_if_index, false);
 374                   sw_if_index_to_bool[lip->lip_phy_sw_if_index] = true;
 375
 376                   lcp_router_table_flush (nlt, sw_if_index_to_bool,
 377                                           lcp_rt_fib_src);
 378                   lcp_router_table_flush (nlt, sw_if_index_to_bool,
 379                                           lcp_rt_fib_src_dynamic);
 380
 381                   vec_free (sw_if_index_to_bool);
 382                   break;
 383                 }
 384             }
 385         }
 386
 387       LCP_ROUTER_DBG ("link: %s (%d) -> %U/%U %s", rtnl_link_get_name (rl),
 388                       rtnl_link_get_ifindex (rl), format_vnet_sw_if_index_name,
 389                       vnm, lip->lip_phy_sw_if_index,
 390                       format_vnet_sw_if_index_name, vnm,
 391                       lip->lip_host_sw_if_index, (up ? "up" : "down"));
 392
 393       lcp_router_link_mtu (rl, lip->lip_phy_sw_if_index);
 394       lcp_router_link_addr (rl, lip);
 395     }
 396   else if (lcp_auto_subint () && rtnl_link_is_vlan (rl))
 397     {
 398       /* Find the pair based on the parent VIF */
 399       lipi = lcp_itf_pair_find_by_vif (rtnl_link_get_link (rl));
 400
 401       if (INDEX_INVALID != lipi)
 402         {
 403           u32 sub_phy_sw_if_index, sub_host_sw_if_index;
 404           const lcp_itf_pair_t *lip;
 405           int vlan;
 406           u8 *ns = 0; /* FIXME */
 407
 408           lip = lcp_itf_pair_get (lipi);
 409
 410           vlan = rtnl_link_vlan_get_id (rl);
 411
 412           /* create the vlan interface on the parent phy */
 413           if (vnet_create_sub_interface (lip->lip_phy_sw_if_index, vlan, 18, 0,
 414                                          vlan, &sub_phy_sw_if_index))
 415             {
 416               LCP_ROUTER_INFO ("failed create phy vlan: %s on %U",
 417                                rtnl_link_get_name (rl),
 418                                format_vnet_sw_if_index_name, vnet_get_main (),
 419                                lip->lip_phy_sw_if_index);
 420               return;
 421             }
 422           /* create the vlan interface on the parent host */
 423           if (vnet_create_sub_interface (lip->lip_host_sw_if_index, vlan, 18,
 424                                          0, vlan, &sub_host_sw_if_index))
 425             {
 426               LCP_ROUTER_INFO ("failed create vlan: %s on %U",
 427                                rtnl_link_get_name (rl),
 428                                format_vnet_sw_if_index_name, vnet_get_main (),
 429                                lip->lip_host_sw_if_index);
 430               return;
 431             }
 432
 433           char *if_name;
 434           u8 *if_namev = 0;
 435
 436           LCP_ROUTER_INFO (
 437             "create vlan: %s -> (%U, %U) : (%U, %U)", rtnl_link_get_name (rl),
 438             format_vnet_sw_if_index_name, vnet_get_main (),
 439             lip->lip_phy_sw_if_index, format_vnet_sw_if_index_name,
 440             vnet_get_main (), sub_phy_sw_if_index,
 441             format_vnet_sw_if_index_name, vnet_get_main (),
 442             lip->lip_host_sw_if_index, format_vnet_sw_if_index_name,
 443             vnet_get_main (), sub_host_sw_if_index);
 444
 445           if ((if_name = rtnl_link_get_name (rl)) != NULL)
 446             vec_validate_init_c_string (if_namev, if_name,
 447                                         strnlen (if_name, IFNAMSIZ));
 448           lcp_itf_pair_add (sub_host_sw_if_index, sub_phy_sw_if_index,
 449                             if_namev, rtnl_link_get_ifindex (rl),
 450                             lip->lip_host_type, ns);
 451           if (up)
 452             vnet_sw_interface_admin_up (vnet_get_main (), sub_phy_sw_if_index);
 453           vnet_sw_interface_admin_up (vnet_get_main (), sub_host_sw_if_index);
 454
 455           vec_free (if_namev);
 456         }
 457       else
 458         {
 459           LCP_ROUTER_INFO ("ignore parent-link add: %s - %s",
 460                            rtnl_link_get_type (rl), rtnl_link_get_name (rl));
 461         }
 462     }
 463   else
 464     LCP_ROUTER_INFO ("ignore link add: %s - %s", rtnl_link_get_type (rl),
 465                      rtnl_link_get_name (rl));
 466 }
 467
 468 static void
 469 lcp_router_link_sync_begin (void)
 470 {
 471   LCP_ROUTER_INFO ("Begin synchronization of interface configurations");
 472 }
 473
 474 static void
 475 lcp_router_link_sync_end (void)
 476 {
 477   LCP_ROUTER_INFO ("End synchronization of interface configurations");
 478 }
 479
 480 static clib_error_t *
 481 lcp_router_link_up_down (vnet_main_t *vnm, u32 hw_if_index, u32 flags)
 482 {
 483   vnet_hw_interface_t *hi;
 484   index_t lipi;
 485
 486   hi = vnet_get_hw_interface_or_null (vnm, hw_if_index);
 487   if (!hi)
 488     return 0;
 489
 490   lipi = lcp_itf_pair_find_by_phy (hi->sw_if_index);
 491   if (lipi == INDEX_INVALID)
 492     return 0;
 493
 494   /* When the link goes down on an interface, the kernel processes routes which
 495    * resolve through that interface depending on how they were created:
 496    *   - Legacy Route API: the kernel retains the routes and marks them as
 497    *     "linkdown";
 498    *   - Nexthop API: the kernel removes the next-hop objects and the routes
 499    *     which reference them.
 500    *
 501    * For IPv4 routes created with Nexthop API, the kernel will not send any
 502    * explicit RTM_DELROUTE messages about removing them. In order to
 503    * synchronize with the kernel, affected routes need to be manually removed
 504    * from the FIB.
 505    *
 506    * The behavior is different for IPv6 routes created with Nexthop API. The
 507    * kernel will send explicit RTM_DELROUTE messages about IPv6 routes being
 508    * removed.
 509    */
 510   if (!(flags & VNET_HW_INTERFACE_FLAG_LINK_UP) &&
 511       (lcp_get_del_static_on_link_down () ||
 512        lcp_get_del_dynamic_on_link_down ()))
 513     {
 514       u32 fib_index;
 515       u32 **fib_index_to_sw_if_index_to_bool = NULL;
 516       u32 id, sw_if_index;
 517       lcp_router_table_t *nlt;
 518
 519       fib_index = fib_table_get_index_for_sw_if_index (FIB_PROTOCOL_IP4,
 520                                                        hi->sw_if_index);
 521
 522       vec_validate_init_empty (fib_index_to_sw_if_index_to_bool, fib_index,
 523                                NULL);
 524       vec_validate_init_empty (fib_index_to_sw_if_index_to_bool[fib_index],
 525                                hi->sw_if_index, false);
 526       fib_index_to_sw_if_index_to_bool[fib_index][hi->sw_if_index] = true;
 527
 528       /* clang-format off */
 529       hash_foreach (id, sw_if_index, hi->sub_interface_sw_if_index_by_id,
 530       ({
 531         fib_index = fib_table_get_index_for_sw_if_index (FIB_PROTOCOL_IP4,
 532                                                          sw_if_index);
 533         vec_validate_init_empty (fib_index_to_sw_if_index_to_bool, fib_index,
 534                                  NULL);
 535         vec_validate_init_empty (fib_index_to_sw_if_index_to_bool[fib_index],
 536                                  sw_if_index, false);
 537         fib_index_to_sw_if_index_to_bool[fib_index][sw_if_index] = true;
 538       }));
 539       /* clang-format on */
 540
 541       vec_foreach_index (fib_index, fib_index_to_sw_if_index_to_bool)
 542         {
 543           u32 *sw_if_index_to_bool;
 544
 545           sw_if_index_to_bool = fib_index_to_sw_if_index_to_bool[fib_index];
 546           if (NULL == sw_if_index_to_bool)
 547             continue;
 548
 549           pool_foreach (nlt, lcp_router_table_pool)
 550             {
 551               if (fib_index == nlt->nlt_fib_index &&
 552                   FIB_PROTOCOL_IP4 == nlt->nlt_proto)
 553                 {
 554                   if (lcp_get_del_static_on_link_down ())
 555                     lcp_router_table_flush (nlt, sw_if_index_to_bool,
 556                                             lcp_rt_fib_src);
 557                   if (lcp_get_del_dynamic_on_link_down ())
 558                     lcp_router_table_flush (nlt, sw_if_index_to_bool,
 559                                             lcp_rt_fib_src_dynamic);
 560                   break;
 561                 }
 562             }
 563
 564           vec_free (sw_if_index_to_bool);
 565         }
 566
 567       vec_free (fib_index_to_sw_if_index_to_bool);
 568     }
 569
 570   return 0;
 571 }
 572
 573 VNET_HW_INTERFACE_LINK_UP_DOWN_FUNCTION (lcp_router_link_up_down);
 574
 575 static fib_protocol_t
 576 lcp_router_proto_k2f (uint32_t k)
 577 {
 578   if (AF_INET6 == k)
 579     return (FIB_PROTOCOL_IP6);
 580   return (FIB_PROTOCOL_IP4);
 581 }
 582
 583 static void
 584 lcp_router_mk_addr (const struct nl_addr *rna, ip_address_t *ia)
 585 {
 586   fib_protocol_t fproto;
 587
 588   ip_address_reset (ia);
 589   fproto = lcp_router_proto_k2f (nl_addr_get_family (rna));
 590
 591   ip_address_set (ia, nl_addr_get_binary_addr (rna),
 592                   FIB_PROTOCOL_IP4 == fproto ? AF_IP4 : AF_IP6);
 593 }
 594
 595 static fib_protocol_t
 596 lcp_router_mk_addr46 (const struct nl_addr *rna, ip46_address_t *ia)
 597 {
 598   fib_protocol_t fproto;
 599
 600   fproto = lcp_router_proto_k2f (nl_addr_get_family (rna));
 601   ip46_address_reset (ia);
 602   if (FIB_PROTOCOL_IP4 == fproto)
 603     memcpy (&ia->ip4, nl_addr_get_binary_addr (rna), nl_addr_get_len (rna));
 604   else
 605     memcpy (&ia->ip6, nl_addr_get_binary_addr (rna), nl_addr_get_len (rna));
 606
 607   return (fproto);
 608 }
 609
 610 static void
 611 lcp_router_link_addr_add_del (struct rtnl_addr *rla, int is_del)
 612 {
 613   u32 sw_if_index;
 614
 615   sw_if_index = lcp_router_intf_h2p (rtnl_addr_get_ifindex (rla));
 616
 617   if (~0 != sw_if_index)
 618     {
 619       ip_address_t nh;
 620
 621       lcp_router_mk_addr (rtnl_addr_get_local (rla), &nh);
 622
 623       if (AF_IP4 == ip_addr_version (&nh))
 624         {
 625           ip4_add_del_interface_address (
 626             vlib_get_main (), sw_if_index, &ip_addr_v4 (&nh),
 627             rtnl_addr_get_prefixlen (rla), is_del);
 628           lcp_router_ip4_mroutes_add_del (sw_if_index, !is_del);
 629         }
 630       else if (AF_IP6 == ip_addr_version (&nh))
 631         {
 632           if (ip6_address_is_link_local_unicast (&ip_addr_v6 (&nh)))
 633             if (is_del)
 634               ip6_link_disable (sw_if_index);
 635             else
 636               {
 637                 ip6_link_enable (sw_if_index, NULL);
 638                 ip6_link_set_local_address (sw_if_index, &ip_addr_v6 (&nh));
 639               }
 640           else
 641             ip6_add_del_interface_address (
 642               vlib_get_main (), sw_if_index, &ip_addr_v6 (&nh),
 643               rtnl_addr_get_prefixlen (rla), is_del);
 644           lcp_router_ip6_mroutes_add_del (sw_if_index, !is_del);
 645         }
 646
 647       LCP_ROUTER_DBG ("link-addr: %U %U/%d", format_vnet_sw_if_index_name,
 648                       vnet_get_main (), sw_if_index, format_ip_address, &nh,
 649                       rtnl_addr_get_prefixlen (rla));
 650     }
 651 }
 652
 653 static void
 654 lcp_router_link_addr_del (struct rtnl_addr *la)
 655 {
 656   lcp_router_link_addr_add_del (la, 1);
 657 }
 658
 659 static void
 660 lcp_router_link_addr_add (struct rtnl_addr *la)
 661 {
 662   lcp_router_link_addr_add_del (la, 0);
 663 }
 664
 665 static void
 666 lcp_router_link_addr_sync_begin (void)
 667 {
 668   ip_interface_address_mark ();
 669
 670   LCP_ROUTER_INFO ("Begin synchronization of interface addresses");
 671 }
 672
 673 static void
 674 lcp_router_link_addr_sync_end (void)
 675 {
 676   ip_interface_address_sweep ();
 677
 678   LCP_ROUTER_INFO ("End synchronization of interface addresses");
 679 }
 680
 681 static void
 682 lcp_router_mk_mac_addr (const struct nl_addr *rna, mac_address_t *mac)
 683 {
 684   mac_address_from_bytes (mac, nl_addr_get_binary_addr (rna));
 685 }
 686
 687 static void
 688 lcp_router_neigh_del (struct rtnl_neigh *rn)
 689 {
 690   u32 sw_if_index;
 691
 692   sw_if_index = lcp_router_intf_h2p (rtnl_neigh_get_ifindex (rn));
 693
 694   if (~0 != sw_if_index)
 695     {
 696       ip_address_t nh;
 697       int rv;
 698
 699       lcp_router_mk_addr (rtnl_neigh_get_dst (rn), &nh);
 700
 701       if (ip46_address_is_multicast (&ip_addr_46 (&nh)))
 702         {
 703           LCP_ROUTER_DBG ("ignore neighbor del: %U %U", format_ip_address, &nh,
 704                           format_vnet_sw_if_index_name, vnet_get_main (),
 705                           sw_if_index);
 706           return;
 707         }
 708
 709       rv = ip_neighbor_del (&nh, sw_if_index);
 710
 711       if (rv)
 712         {
 713           LCP_ROUTER_ERROR (
 714             "Failed to delete neighbor: %U %U", format_ip_address, &nh,
 715             format_vnet_sw_if_index_name, vnet_get_main (), sw_if_index);
 716         }
 717       else
 718         {
 719           LCP_ROUTER_DBG ("neighbor del: %U %U", format_ip_address, &nh,
 720                           format_vnet_sw_if_index_name, vnet_get_main (),
 721                           sw_if_index);
 722         }
 723     }
 724   else
 725     LCP_ROUTER_INFO ("ignore neighbour del on: %d",
 726                      rtnl_neigh_get_ifindex (rn));
 727 }
 728
 729 #ifndef NUD_VALID
 730 #define NUD_VALID                                                             \
 731   (NUD_PERMANENT | NUD_NOARP | NUD_REACHABLE | NUD_PROBE | NUD_STALE |        \
 732    NUD_DELAY)
 733 #endif
 734
 735 static void
 736 lcp_router_neigh_add (struct rtnl_neigh *rn)
 737 {
 738   u32 sw_if_index;
 739
 740   sw_if_index = lcp_router_intf_h2p (rtnl_neigh_get_ifindex (rn));
 741
 742   if (~0 != sw_if_index)
 743     {
 744       struct nl_addr *ll;
 745       ip_address_t nh;
 746       int state;
 747
 748       lcp_router_mk_addr (rtnl_neigh_get_dst (rn), &nh);
 749
 750       if (ip46_address_is_multicast (&ip_addr_46 (&nh)))
 751         {
 752           LCP_ROUTER_DBG ("ignore neighbor add: %U %U", format_ip_address, &nh,
 753                           format_vnet_sw_if_index_name, vnet_get_main (),
 754                           sw_if_index);
 755           return;
 756         }
 757
 758       ll = rtnl_neigh_get_lladdr (rn);
 759       state = rtnl_neigh_get_state (rn);
 760
 761       if (ll && (state & NUD_VALID))
 762         {
 763           mac_address_t mac;
 764           ip_neighbor_flags_t flags;
 765           int rv;
 766
 767           lcp_router_mk_mac_addr (ll, &mac);
 768
 769           if (state & (NUD_NOARP | NUD_PERMANENT))
 770             flags = IP_NEIGHBOR_FLAG_STATIC;
 771           else
 772             flags = IP_NEIGHBOR_FLAG_DYNAMIC;
 773
 774           rv = ip_neighbor_add (&nh, &mac, sw_if_index, flags, NULL);
 775
 776           if (rv)
 777             {
 778               LCP_ROUTER_ERROR (
 779                 "Failed to create neighbor: %U %U", format_ip_address, &nh,
 780                 format_vnet_sw_if_index_name, vnet_get_main (), sw_if_index);
 781             }
 782           else
 783             {
 784               LCP_ROUTER_DBG ("neighbor add: %U %U", format_ip_address, &nh,
 785                               format_vnet_sw_if_index_name, vnet_get_main (),
 786                               sw_if_index);
 787             }
 788         }
 789       else
 790         /* It's a delete */
 791         lcp_router_neigh_del (rn);
 792     }
 793   else
 794     LCP_ROUTER_INFO ("ignore neighbour add on: %d",
 795                      rtnl_neigh_get_ifindex (rn));
 796 }
 797
 798 static void
 799 lcp_router_neigh_sync_begin (void)
 800 {
 801   ip_neighbor_mark (AF_IP4);
 802   ip_neighbor_mark (AF_IP6);
 803
 804   LCP_ROUTER_INFO ("Begin synchronization of neighbors");
 805 }
 806
 807 static void
 808 lcp_router_neigh_sync_end (void)
 809 {
 810   ip_neighbor_sweep (AF_IP4);
 811   ip_neighbor_sweep (AF_IP6);
 812
 813   LCP_ROUTER_INFO ("End synchronization of neighbors");
 814 }
 815
 816 static lcp_router_table_t *
 817 lcp_router_table_find (uint32_t id, fib_protocol_t fproto)
 818 {
 819   uword *p;
 820
 821   p = hash_get (lcp_router_table_db[fproto], id);
 822
 823   if (p)
 824     return pool_elt_at_index (lcp_router_table_pool, p[0]);
 825
 826   return (NULL);
 827 }
 828
 829 static uint32_t
 830 lcp_router_table_k2f (uint32_t k)
 831 {
 832   // the kernel's table ID 255 is the default table
 833   if (k == 255 || k == 254)
 834     return 0;
 835   return k;
 836 }
 837
 838 static lcp_router_table_t *
 839 lcp_router_table_add_or_lock (uint32_t id, fib_protocol_t fproto)
 840 {
 841   lcp_router_table_t *nlt;
 842
 843   id = lcp_router_table_k2f (id);
 844   nlt = lcp_router_table_find (id, fproto);
 845
 846   if (NULL == nlt)
 847     {
 848       pool_get_zero (lcp_router_table_pool, nlt);
 849
 850       nlt->nlt_id = id;
 851       nlt->nlt_proto = fproto;
 852
 853       nlt->nlt_fib_index = fib_table_find_or_create_and_lock (
 854         nlt->nlt_proto, nlt->nlt_id, lcp_rt_fib_src);
 855       nlt->nlt_mfib_index = mfib_table_find_or_create_and_lock (
 856         nlt->nlt_proto, nlt->nlt_id, MFIB_SOURCE_PLUGIN_LOW);
 857
 858       hash_set (lcp_router_table_db[fproto], nlt->nlt_id,
 859                 nlt - lcp_router_table_pool);
 860
 861       if (FIB_PROTOCOL_IP4 == fproto)
 862         {
 863           /* Set the all 1s address in this table to punt */
 864           fib_table_entry_special_add (nlt->nlt_fib_index, &pfx_all1s,
 865                                        lcp_rt_fib_src, FIB_ENTRY_FLAG_LOCAL);
 866
 867           const fib_route_path_t path = {
 868             .frp_proto = DPO_PROTO_IP4,
 869             .frp_addr = zero_addr,
 870             .frp_sw_if_index = ~0,
 871             .frp_fib_index = ~0,
 872             .frp_weight = 1,
 873             .frp_mitf_flags = MFIB_ITF_FLAG_FORWARD,
 874             .frp_flags = FIB_ROUTE_PATH_LOCAL,
 875           };
 876           int ii;
 877
 878           for (ii = 0; ii < ARRAY_LEN (ip4_specials); ii++)
 879             {
 880               mfib_table_entry_path_update (
 881                 nlt->nlt_mfib_index, &ip4_specials[ii], MFIB_SOURCE_PLUGIN_LOW,
 882                 MFIB_ENTRY_FLAG_NONE, &path);
 883             }
 884         }
 885       else if (FIB_PROTOCOL_IP6 == fproto)
 886         {
 887           const fib_route_path_t path = {
 888             .frp_proto = DPO_PROTO_IP6,
 889             .frp_addr = zero_addr,
 890             .frp_sw_if_index = ~0,
 891             .frp_fib_index = ~0,
 892             .frp_weight = 1,
 893             .frp_mitf_flags = MFIB_ITF_FLAG_FORWARD,
 894             .frp_flags = FIB_ROUTE_PATH_LOCAL,
 895           };
 896           int ii;
 897
 898           for (ii = 0; ii < ARRAY_LEN (ip6_specials); ii++)
 899             {
 900               mfib_table_entry_path_update (
 901                 nlt->nlt_mfib_index, &ip6_specials[ii], MFIB_SOURCE_PLUGIN_LOW,
 902                 MFIB_ENTRY_FLAG_NONE, &path);
 903             }
 904         }
 905     }
 906
 907   nlt->nlt_refs++;
 908
 909   return (nlt);
 910 }
 911
 912 static void
 913 lcp_router_table_unlock (lcp_router_table_t *nlt)
 914 {
 915   nlt->nlt_refs--;
 916
 917   if (0 == nlt->nlt_refs)
 918     {
 919       if (FIB_PROTOCOL_IP4 == nlt->nlt_proto)
 920         {
 921           /* Set the all 1s address in this table to punt */
 922           fib_table_entry_special_remove (nlt->nlt_fib_index, &pfx_all1s,
 923                                           lcp_rt_fib_src);
 924         }
 925
 926       fib_table_unlock (nlt->nlt_fib_index, nlt->nlt_proto, lcp_rt_fib_src);
 927
 928       hash_unset (lcp_router_table_db[nlt->nlt_proto], nlt->nlt_id);
 929       pool_put (lcp_router_table_pool, nlt);
 930     }
 931 }
 932
 933 static void
 934 lcp_router_route_mk_prefix (struct rtnl_route *r, fib_prefix_t *p)
 935 {
 936   const struct nl_addr *addr = rtnl_route_get_dst (r);
 937
 938   p->fp_len = nl_addr_get_prefixlen (addr);
 939   p->fp_proto = lcp_router_mk_addr46 (addr, &p->fp_addr);
 940 }
 941
 942 static void
 943 lcp_router_route_mk_mprefix (struct rtnl_route *r, mfib_prefix_t *p)
 944 {
 945   const struct nl_addr *addr;
 946
 947   addr = rtnl_route_get_dst (r);
 948
 949   p->fp_len = nl_addr_get_prefixlen (addr);
 950   p->fp_proto = lcp_router_mk_addr46 (addr, &p->fp_grp_addr);
 951
 952   addr = rtnl_route_get_src (r);
 953   if (addr)
 954     p->fp_proto = lcp_router_mk_addr46 (addr, &p->fp_src_addr);
 955 }
 956
 957 typedef struct lcp_router_route_path_parse_t_
 958 {
 959   fib_route_path_t *paths;
 960   fib_protocol_t route_proto;
 961   bool is_mcast;
 962   fib_route_path_flags_t type_flags;
 963   u8 preference;
 964 } lcp_router_route_path_parse_t;
 965
 966 static void
 967 lcp_router_route_path_parse (struct rtnl_nexthop *rnh, void *arg)
 968 {
 969   lcp_router_route_path_parse_t *ctx = arg;
 970   fib_route_path_t *path;
 971   u32 sw_if_index;
 972
 973   sw_if_index = lcp_router_intf_h2p (rtnl_route_nh_get_ifindex (rnh));
 974
 975   if (~0 != sw_if_index)
 976     {
 977       fib_protocol_t fproto;
 978       struct nl_addr *addr;
 979
 980       vec_add2 (ctx->paths, path, 1);
 981
 982       path->frp_flags = FIB_ROUTE_PATH_FLAG_NONE | ctx->type_flags;
 983       path->frp_sw_if_index = sw_if_index;
 984       path->frp_weight = rtnl_route_nh_get_weight (rnh);
 985       path->frp_preference = ctx->preference;
 986
 987       addr = rtnl_route_nh_get_gateway (rnh);
 988
 989       if (addr)
 990         fproto = lcp_router_mk_addr46 (rtnl_route_nh_get_gateway (rnh),
 991                                        &path->frp_addr);
 992       else
 993         fproto = ctx->route_proto;
 994
 995       path->frp_proto = fib_proto_to_dpo (fproto);
 996
 997       if (ctx->is_mcast)
 998         path->frp_mitf_flags = MFIB_ITF_FLAG_FORWARD;
 999
1000       LCP_ROUTER_DBG (" path:[%U]", format_fib_route_path, path);
1001     }
1002 }
1003
1004 /*
1005  * blackhole, unreachable, prohibit will not have a next hop in an
1006  * RTM_NEWROUTE. Add a path for them.
1007  */
1008 static void
1009 lcp_router_route_path_add_special (struct rtnl_route *rr,
1010                                    lcp_router_route_path_parse_t *ctx)
1011 {
1012   fib_route_path_t *path;
1013
1014   if (rtnl_route_get_type (rr) < RTN_BLACKHOLE)
1015     return;
1016
1017   /* if it already has a path, it does not need us to add one */
1018   if (vec_len (ctx->paths) > 0)
1019     return;
1020
1021   vec_add2 (ctx->paths, path, 1);
1022
1023   path->frp_flags = FIB_ROUTE_PATH_FLAG_NONE | ctx->type_flags;
1024   path->frp_sw_if_index = ~0;
1025   path->frp_proto = fib_proto_to_dpo (ctx->route_proto);
1026   path->frp_preference = ctx->preference;
1027
1028   LCP_ROUTER_DBG (" path:[%U]", format_fib_route_path, path);
1029 }
1030
1031 /*
1032  * Map of supported route types. Some types are omitted:
1033  * RTN_LOCAL - interface address addition creates these automatically
1034  * RTN_BROADCAST - same as RTN_LOCAL
1035  * RTN_UNSPEC, RTN_ANYCAST, RTN_THROW, RTN_NAT, RTN_XRESOLVE -
1036  *   There's not a VPP equivalent for these currently.
1037  */
1038 static const u8 lcp_router_route_type_valid[__RTN_MAX] = {
1039   [RTN_UNICAST] = 1,     [RTN_MULTICAST] = 1, [RTN_BLACKHOLE] = 1,
1040   [RTN_UNREACHABLE] = 1, [RTN_PROHIBIT] = 1,
1041 };
1042
1043 /* Map of fib entry flags by route type */
1044 static const fib_entry_flag_t lcp_router_route_type_feflags[__RTN_MAX] = {
1045   [RTN_LOCAL] = FIB_ENTRY_FLAG_LOCAL | FIB_ENTRY_FLAG_CONNECTED,
1046   [RTN_BROADCAST] = FIB_ENTRY_FLAG_DROP | FIB_ENTRY_FLAG_LOOSE_URPF_EXEMPT,
1047   [RTN_BLACKHOLE] = FIB_ENTRY_FLAG_DROP,
1048 };
1049
1050 /* Map of fib route path flags by route type */
1051 static const fib_route_path_flags_t
1052   lcp_router_route_type_frpflags[__RTN_MAX] = {
1053     [RTN_UNREACHABLE] = FIB_ROUTE_PATH_ICMP_UNREACH,
1054     [RTN_PROHIBIT] = FIB_ROUTE_PATH_ICMP_PROHIBIT,
1055     [RTN_BLACKHOLE] = FIB_ROUTE_PATH_DROP,
1056   };
1057
1058 static inline fib_source_t
1059 lcp_router_proto_fib_source (u8 rt_proto)
1060 {
1061   return (rt_proto <= RTPROT_STATIC) ? lcp_rt_fib_src : lcp_rt_fib_src_dynamic;
1062 }
1063
1064 static fib_entry_flag_t
1065 lcp_router_route_mk_entry_flags (uint8_t rtype, int table_id, uint8_t rproto)
1066 {
1067   fib_entry_flag_t fef = FIB_ENTRY_FLAG_NONE;
1068
1069   fef |= lcp_router_route_type_feflags[rtype];
1070   if ((rproto == RTPROT_KERNEL) || PREDICT_FALSE (255 == table_id))
1071     /* kernel proto is interface prefixes, 255 is linux's 'local' table */
1072     fef |= FIB_ENTRY_FLAG_ATTACHED | FIB_ENTRY_FLAG_CONNECTED;
1073
1074   return (fef);
1075 }
1076
1077 static void
1078 lcp_router_route_del (struct rtnl_route *rr)
1079 {
1080   fib_entry_flag_t entry_flags;
1081   uint32_t table_id;
1082   fib_prefix_t pfx;
1083   lcp_router_table_t *nlt;
1084   uint8_t rtype, rproto;
1085
1086   rtype = rtnl_route_get_type (rr);
1087   table_id = rtnl_route_get_table (rr);
1088   rproto = rtnl_route_get_protocol (rr);
1089
1090   /* skip unsupported route types and local table */
1091   if (!lcp_router_route_type_valid[rtype] || (table_id == 255))
1092     return;
1093
1094   lcp_router_route_mk_prefix (rr, &pfx);
1095   entry_flags = lcp_router_route_mk_entry_flags (rtype, table_id, rproto);
1096   nlt = lcp_router_table_find (lcp_router_table_k2f (table_id), pfx.fp_proto);
1097
1098   LCP_ROUTER_DBG ("route del: %d:%U %U", rtnl_route_get_table (rr),
1099                   format_fib_prefix, &pfx, format_fib_entry_flags,
1100                   entry_flags);
1101
1102   if (NULL == nlt)
1103     return;
1104
1105   lcp_router_route_path_parse_t np = {
1106     .route_proto = pfx.fp_proto,
1107     .type_flags = lcp_router_route_type_frpflags[rtype],
1108   };
1109
1110   rtnl_route_foreach_nexthop (rr, lcp_router_route_path_parse, &np);
1111   lcp_router_route_path_add_special (rr, &np);
1112
1113   if (0 != vec_len (np.paths))
1114     {
1115       fib_source_t fib_src;
1116
1117       fib_src = lcp_router_proto_fib_source (rproto);
1118
1119       if (pfx.fp_proto == FIB_PROTOCOL_IP6)
1120         fib_table_entry_delete (nlt->nlt_fib_index, &pfx, fib_src);
1121       else
1122         fib_table_entry_path_remove2 (nlt->nlt_fib_index, &pfx, fib_src,
1123                                       np.paths);
1124     }
1125
1126   vec_free (np.paths);
1127
1128   lcp_router_table_unlock (nlt);
1129 }
1130
1131 static void
1132 lcp_router_route_add (struct rtnl_route *rr)
1133 {
1134   fib_entry_flag_t entry_flags;
1135   uint32_t table_id;
1136   fib_prefix_t pfx;
1137   lcp_router_table_t *nlt;
1138   uint8_t rtype, rproto;
1139
1140   rtype = rtnl_route_get_type (rr);
1141   table_id = rtnl_route_get_table (rr);
1142   rproto = rtnl_route_get_protocol (rr);
1143
1144   /* skip unsupported route types and local table */
1145   if (!lcp_router_route_type_valid[rtype] || (table_id == 255))
1146     return;
1147
1148   lcp_router_route_mk_prefix (rr, &pfx);
1149   entry_flags = lcp_router_route_mk_entry_flags (rtype, table_id, rproto);
1150
1151   nlt = lcp_router_table_add_or_lock (table_id, pfx.fp_proto);
1152   /* Skip any kernel routes and IPv6 LL or multicast routes */
1153   if (rproto == RTPROT_KERNEL ||
1154       (FIB_PROTOCOL_IP6 == pfx.fp_proto &&
1155        (ip6_address_is_multicast (&pfx.fp_addr.ip6) ||
1156         ip6_address_is_link_local_unicast (&pfx.fp_addr.ip6))))
1157     {
1158       LCP_ROUTER_DBG ("route skip: %d:%U %U", rtnl_route_get_table (rr),
1159                       format_fib_prefix, &pfx, format_fib_entry_flags,
1160                       entry_flags);
1161     }
1162   else
1163     {
1164       LCP_ROUTER_DBG ("route add: %d:%U %U", rtnl_route_get_table (rr),
1165                       format_fib_prefix, &pfx, format_fib_entry_flags,
1166                       entry_flags);
1167
1168       lcp_router_route_path_parse_t np = {
1169         .route_proto = pfx.fp_proto,
1170         .is_mcast = (rtype == RTN_MULTICAST),
1171         .type_flags = lcp_router_route_type_frpflags[rtype],
1172         .preference = (u8) rtnl_route_get_priority (rr),
1173       };
1174
1175       rtnl_route_foreach_nexthop (rr, lcp_router_route_path_parse, &np);
1176       lcp_router_route_path_add_special (rr, &np);
1177
1178       if (0 != vec_len (np.paths))
1179         {
1180           if (rtype == RTN_MULTICAST)
1181             {
1182               /* it's not clear to me how linux expresses the RPF paramters
1183                * so we'll allow from all interfaces and hope for the best */
1184               mfib_prefix_t mpfx = {};
1185
1186               lcp_router_route_mk_mprefix (rr, &mpfx);
1187
1188               mfib_table_entry_update (
1189                 nlt->nlt_mfib_index, &mpfx, MFIB_SOURCE_PLUGIN_LOW,
1190                 MFIB_RPF_ID_NONE, MFIB_ENTRY_FLAG_ACCEPT_ALL_ITF);
1191
1192               mfib_table_entry_paths_update (nlt->nlt_mfib_index, &mpfx,
1193                                              MFIB_SOURCE_PLUGIN_LOW,
1194                                              MFIB_ENTRY_FLAG_NONE, np.paths);
1195             }
1196           else
1197             {
1198               fib_source_t fib_src;
1199
1200               fib_src = lcp_router_proto_fib_source (rproto);
1201
1202               if (pfx.fp_proto == FIB_PROTOCOL_IP6)
1203                 fib_table_entry_path_add2 (nlt->nlt_fib_index, &pfx, fib_src,
1204                                            entry_flags, np.paths);
1205               else
1206                 fib_table_entry_update (nlt->nlt_fib_index, &pfx, fib_src,
1207                                         entry_flags, np.paths);
1208             }
1209         }
1210       else
1211         LCP_ROUTER_DBG ("no paths for route add: %d:%U %U",
1212                         rtnl_route_get_table (rr), format_fib_prefix, &pfx,
1213                         format_fib_entry_flags, entry_flags);
1214       vec_free (np.paths);
1215     }
1216 }
1217
1218 static void
1219 lcp_router_route_sync_begin (void)
1220 {
1221   lcp_router_table_t *nlt;
1222
1223   pool_foreach (nlt, lcp_router_table_pool)
1224     {
1225       fib_table_mark (nlt->nlt_fib_index, nlt->nlt_proto, lcp_rt_fib_src);
1226       fib_table_mark (nlt->nlt_fib_index, nlt->nlt_proto,
1227                       lcp_rt_fib_src_dynamic);
1228
1229       LCP_ROUTER_INFO ("Begin synchronization of %U routes in table %u",
1230                        format_fib_protocol, nlt->nlt_proto,
1231                        nlt->nlt_fib_index);
1232     }
1233 }
1234
1235 static void
1236 lcp_router_route_sync_end (void)
1237 {
1238   lcp_router_table_t *nlt;
1239
1240   pool_foreach (nlt, lcp_router_table_pool)
1241     {
1242       fib_table_sweep (nlt->nlt_fib_index, nlt->nlt_proto, lcp_rt_fib_src);
1243       fib_table_sweep (nlt->nlt_fib_index, nlt->nlt_proto,
1244                        lcp_rt_fib_src_dynamic);
1245
1246       LCP_ROUTER_INFO ("End synchronization of %U routes in table %u",
1247                        format_fib_protocol, nlt->nlt_proto,
1248                        nlt->nlt_fib_index);
1249     }
1250 }
1251
1252 typedef struct lcp_router_table_flush_ctx_t_
1253 {
1254   fib_node_index_t *lrtf_entries;
1255   u32 *lrtf_sw_if_index_to_bool;
1256   fib_source_t lrtf_source;
1257 } lcp_router_table_flush_ctx_t;
1258
1259 static fib_table_walk_rc_t
1260 lcp_router_table_flush_cb (fib_node_index_t fib_entry_index, void *arg)
1261 {
1262   lcp_router_table_flush_ctx_t *ctx = arg;
1263   u32 sw_if_index;
1264
1265   sw_if_index = fib_entry_get_resolving_interface_for_source (
1266     fib_entry_index, ctx->lrtf_source);
1267
1268   if (sw_if_index < vec_len (ctx->lrtf_sw_if_index_to_bool) &&
1269       ctx->lrtf_sw_if_index_to_bool[sw_if_index])
1270     {
1271       vec_add1 (ctx->lrtf_entries, fib_entry_index);
1272     }
1273   return (FIB_TABLE_WALK_CONTINUE);
1274 }
1275
1276 static void
1277 lcp_router_table_flush (lcp_router_table_t *nlt, u32 *sw_if_index_to_bool,
1278                         fib_source_t source)
1279 {
1280   fib_node_index_t *fib_entry_index;
1281   lcp_router_table_flush_ctx_t ctx = {
1282     .lrtf_entries = NULL,
1283     .lrtf_sw_if_index_to_bool = sw_if_index_to_bool,
1284     .lrtf_source = source,
1285   };
1286
1287   LCP_ROUTER_DBG (
1288     "Flush table: proto %U, fib-index %u, max sw_if_index %u, source %U",
1289     format_fib_protocol, nlt->nlt_proto, nlt->nlt_fib_index,
1290     vec_len (sw_if_index_to_bool) - 1, format_fib_source, source);
1291
1292   fib_table_walk (nlt->nlt_fib_index, nlt->nlt_proto,
1293                   lcp_router_table_flush_cb, &ctx);
1294
1295   LCP_ROUTER_DBG ("Flush table: entries number to delete %u",
1296                   vec_len (ctx.lrtf_entries));
1297
1298   vec_foreach (fib_entry_index, ctx.lrtf_entries)
1299     {
1300       fib_table_entry_delete_index (*fib_entry_index, source);
1301       lcp_router_table_unlock (nlt);
1302     }
1303
1304   vec_free (ctx.lrtf_entries);
1305 }
1306
1307 const nl_vft_t lcp_router_vft = {
1308   .nvl_rt_link_add = { .is_mp_safe = 0, .cb = lcp_router_link_add },
1309   .nvl_rt_link_del = { .is_mp_safe = 0, .cb = lcp_router_link_del },
1310   .nvl_rt_link_sync_begin = { .is_mp_safe = 0,
1311                               .cb = lcp_router_link_sync_begin },
1312   .nvl_rt_link_sync_end = { .is_mp_safe = 0, .cb = lcp_router_link_sync_end },
1313   .nvl_rt_addr_add = { .is_mp_safe = 0, .cb = lcp_router_link_addr_add },
1314   .nvl_rt_addr_del = { .is_mp_safe = 0, .cb = lcp_router_link_addr_del },
1315   .nvl_rt_addr_sync_begin = { .is_mp_safe = 0,
1316                               .cb = lcp_router_link_addr_sync_begin },
1317   .nvl_rt_addr_sync_end = { .is_mp_safe = 0,
1318                             .cb = lcp_router_link_addr_sync_end },
1319   .nvl_rt_neigh_add = { .is_mp_safe = 0, .cb = lcp_router_neigh_add },
1320   .nvl_rt_neigh_del = { .is_mp_safe = 0, .cb = lcp_router_neigh_del },
1321   .nvl_rt_neigh_sync_begin = { .is_mp_safe = 0,
1322                                .cb = lcp_router_neigh_sync_begin },
1323   .nvl_rt_neigh_sync_end = { .is_mp_safe = 0,
1324                              .cb = lcp_router_neigh_sync_end },
1325   .nvl_rt_route_add = { .is_mp_safe = 1, .cb = lcp_router_route_add },
1326   .nvl_rt_route_del = { .is_mp_safe = 1, .cb = lcp_router_route_del },
1327   .nvl_rt_route_sync_begin = { .is_mp_safe = 0,
1328                                .cb = lcp_router_route_sync_begin },
1329   .nvl_rt_route_sync_end = { .is_mp_safe = 0,
1330                              .cb = lcp_router_route_sync_end },
1331 };
1332
1333 static clib_error_t *
1334 lcp_router_init (vlib_main_t *vm)
1335 {
1336   lcp_router_logger = vlib_log_register_class ("linux-cp", "router");
1337
1338   nl_register_vft (&lcp_router_vft);
1339
1340   /*
1341    * allocate 2 route sources. The low priority source will be for
1342    * dynamic routes. If a dynamic route daemon (FRR) tries to remove its
1343    * route, it will use the low priority source to ensure it will not
1344    * remove static routes which were added with the higher priority source.
1345    */
1346   lcp_rt_fib_src =
1347     fib_source_allocate ("lcp-rt", FIB_SOURCE_PRIORITY_HI, FIB_SOURCE_BH_API);
1348
1349   lcp_rt_fib_src_dynamic = fib_source_allocate (
1350     "lcp-rt-dynamic", FIB_SOURCE_PRIORITY_HI + 1, FIB_SOURCE_BH_API);
1351
1352   return (NULL);
1353 }
1354
1355 VLIB_INIT_FUNCTION (lcp_router_init) = {
1356   .runs_before = VLIB_INITS ("lcp_nl_init"),
1357 };
1358
1359 /*
1360  * fd.io coding-style-patch-verification: ON
1361  *
1362  * Local Variables:
1363  * eval: (c-set-style "gnu")
1364  * End:
1365  */