src/vnet/bfd/bfd_udp.c

   1 #include <vppinfra/types.h>
   2 #include <vlibmemory/api.h>
   3 #include <vlib/vlib.h>
   4 #include <vlib/buffer.h>
   5 #include <vnet/ip/format.h>
   6 #include <vnet/ethernet/packet.h>
   7 #include <vnet/ip/udp_packet.h>
   8 #include <vnet/ip/lookup.h>
   9 #include <vnet/ip/icmp46_packet.h>
  10 #include <vnet/ip/ip4.h>
  11 #include <vnet/ip/ip6.h>
  12 #include <vnet/ip/udp.h>
  13 #include <vnet/ip/ip6_packet.h>
  14 #include <vnet/adj/adj.h>
  15 #include <vnet/adj/adj_nbr.h>
  16 #include <vnet/bfd/bfd_debug.h>
  17 #include <vnet/bfd/bfd_udp.h>
  18 #include <vnet/bfd/bfd_main.h>
  19 #include <vnet/bfd/bfd_api.h>
  20
  21 typedef struct
  22 {
  23   bfd_main_t *bfd_main;
  24   /* hashmap - bfd session index by bfd key - used for CLI/API lookup, where
  25    * discriminator is unknown */
  26   mhash_t bfd_session_idx_by_bfd_key;
  27 } bfd_udp_main_t;
  28
  29 static vlib_node_registration_t bfd_udp4_input_node;
  30 static vlib_node_registration_t bfd_udp6_input_node;
  31
  32 bfd_udp_main_t bfd_udp_main;
  33
  34 void bfd_udp_transport_to_buffer (vlib_main_t *vm, vlib_buffer_t *b,
  35                                   bfd_udp_session_t *bus)
  36 {
  37   udp_header_t *udp;
  38   u16 udp_length, ip_length;
  39   bfd_udp_key_t *key = &bus->key;
  40
  41   b->flags |= VNET_BUFFER_LOCALLY_ORIGINATED;
  42   if (ip46_address_is_ip4 (&key->local_addr))
  43     {
  44       ip4_header_t *ip4;
  45       const size_t data_size = sizeof (*ip4) + sizeof (*udp);
  46       vlib_buffer_advance (b, -data_size);
  47       ip4 = vlib_buffer_get_current (b);
  48       udp = (udp_header_t *)(ip4 + 1);
  49       memset (ip4, 0, data_size);
  50       ip4->ip_version_and_header_length = 0x45;
  51       ip4->ttl = 255;
  52       ip4->protocol = IP_PROTOCOL_UDP;
  53       ip4->src_address.as_u32 = key->local_addr.ip4.as_u32;
  54       ip4->dst_address.as_u32 = key->peer_addr.ip4.as_u32;
  55
  56       udp->src_port = clib_host_to_net_u16 (50000); /* FIXME */
  57       udp->dst_port = clib_host_to_net_u16 (UDP_DST_PORT_bfd4);
  58
  59       /* fix ip length, checksum and udp length */
  60       ip_length = vlib_buffer_length_in_chain (vm, b);
  61
  62       ip4->length = clib_host_to_net_u16 (ip_length);
  63       ip4->checksum = ip4_header_checksum (ip4);
  64
  65       udp_length = ip_length - (sizeof (*ip4));
  66       udp->length = clib_host_to_net_u16 (udp_length);
  67     }
  68   else
  69     {
  70       BFD_ERR ("not implemented");
  71       abort ();
  72     }
  73 }
  74
  75 void bfd_add_udp_transport (vlib_main_t *vm, vlib_buffer_t *b,
  76                             bfd_udp_session_t *bus)
  77 {
  78   vnet_buffer (b)->ip.adj_index[VLIB_RX] = bus->adj_index;
  79   vnet_buffer (b)->ip.adj_index[VLIB_TX] = bus->adj_index;
  80   bfd_udp_transport_to_buffer (vm, b, bus);
  81 }
  82
  83 static bfd_session_t *bfd_lookup_session (bfd_udp_main_t *bum,
  84                                           const bfd_udp_key_t *key)
  85 {
  86   uword *p = mhash_get (&bum->bfd_session_idx_by_bfd_key, key);
  87   if (p)
  88     {
  89       return bfd_find_session_by_idx (bum->bfd_main, *p);
  90     }
  91   return 0;
  92 }
  93
  94 static vnet_api_error_t
  95 bfd_udp_add_session_internal (bfd_udp_main_t *bum, u32 sw_if_index,
  96                               u32 desired_min_tx_us, u32 required_min_rx_us,
  97                               u8 detect_mult, const ip46_address_t *local_addr,
  98                               const ip46_address_t *peer_addr)
  99 {
 100   vnet_sw_interface_t *sw_if =
 101       vnet_get_sw_interface (vnet_get_main (), sw_if_index);
 102   /* get a pool entry and if we end up not needing it, give it back */
 103   bfd_transport_t t = BFD_TRANSPORT_UDP4;
 104   if (!ip46_address_is_ip4 (local_addr))
 105     {
 106       t = BFD_TRANSPORT_UDP6;
 107     }
 108   bfd_session_t *bs = bfd_get_session (bum->bfd_main, t);
 109   bfd_udp_session_t *bus = &bs->udp;
 110   memset (bus, 0, sizeof (*bus));
 111   bfd_udp_key_t *key = &bus->key;
 112   key->sw_if_index = sw_if->sw_if_index;
 113   key->local_addr.as_u64[0] = local_addr->as_u64[0];
 114   key->local_addr.as_u64[1] = local_addr->as_u64[1];
 115   key->peer_addr.as_u64[0] = peer_addr->as_u64[0];
 116   key->peer_addr.as_u64[1] = peer_addr->as_u64[1];
 117   const bfd_session_t *tmp = bfd_lookup_session (bum, key);
 118   if (tmp)
 119     {
 120       BFD_ERR ("duplicate bfd-udp session, existing bs_idx=%d", tmp->bs_idx);
 121       bfd_put_session (bum->bfd_main, bs);
 122       return VNET_API_ERROR_BFD_EEXIST;
 123     }
 124   key->sw_if_index = sw_if->sw_if_index;
 125   mhash_set (&bum->bfd_session_idx_by_bfd_key, key, bs->bs_idx, NULL);
 126   BFD_DBG ("session created, bs_idx=%u, sw_if_index=%d, local=%U, peer=%U",
 127            bs->bs_idx, key->sw_if_index, format_ip46_address, &key->local_addr,
 128            IP46_TYPE_ANY, format_ip46_address, &key->peer_addr, IP46_TYPE_ANY);
 129   if (BFD_TRANSPORT_UDP4 == t)
 130     {
 131       bus->adj_index = adj_nbr_add_or_lock (FIB_PROTOCOL_IP4, VNET_LINK_IP4,
 132                                             &key->peer_addr, key->sw_if_index);
 133       BFD_DBG ("adj_nbr_add_or_lock(FIB_PROTOCOL_IP4, VNET_LINK_IP4, %U, %d) "
 134                "returns %d",
 135                format_ip46_address, &key->peer_addr, IP46_TYPE_ANY,
 136                key->sw_if_index, bus->adj_index);
 137     }
 138   else
 139     {
 140       bus->adj_index = adj_nbr_add_or_lock (FIB_PROTOCOL_IP6, VNET_LINK_IP6,
 141                                             &key->peer_addr, key->sw_if_index);
 142       BFD_DBG ("adj_nbr_add_or_lock(FIB_PROTOCOL_IP6, VNET_LINK_IP6, %U, %d) "
 143                "returns %d",
 144                format_ip46_address, &key->peer_addr, IP46_TYPE_ANY,
 145                key->sw_if_index, bus->adj_index);
 146     }
 147   bs->config_desired_min_tx_us = desired_min_tx_us;
 148   bs->required_min_rx_us = required_min_rx_us;
 149   bs->local_detect_mult = detect_mult;
 150   bfd_session_start (bum->bfd_main, bs);
 151   return 0;
 152 }
 153
 154 static vnet_api_error_t
 155 bfd_udp_validate_api_input (u32 sw_if_index, const ip46_address_t *local_addr,
 156                             const ip46_address_t *peer_addr)
 157 {
 158   vnet_sw_interface_t *sw_if =
 159       vnet_get_sw_interface (vnet_get_main (), sw_if_index);
 160   u8 local_ip_valid = 0;
 161   ip_interface_address_t *ia = NULL;
 162   if (!sw_if)
 163     {
 164       BFD_ERR ("got NULL sw_if");
 165       return VNET_API_ERROR_INVALID_SW_IF_INDEX;
 166     }
 167   if (ip46_address_is_ip4 (local_addr))
 168     {
 169       if (!ip46_address_is_ip4 (peer_addr))
 170         {
 171           BFD_ERR ("IP family mismatch");
 172           return VNET_API_ERROR_INVALID_ARGUMENT;
 173         }
 174       ip4_main_t *im = &ip4_main;
 175
 176       /* *INDENT-OFF* */
 177       foreach_ip_interface_address (
 178           &im->lookup_main, ia, sw_if_index, 0 /* honor unnumbered */, ({
 179             ip4_address_t *x =
 180                 ip_interface_address_get_address (&im->lookup_main, ia);
 181             if (x->as_u32 == local_addr->ip4.as_u32)
 182               {
 183                 /* valid address for this interface */
 184                 local_ip_valid = 1;
 185                 break;
 186               }
 187           }));
 188       /* *INDENT-ON* */
 189     }
 190   else
 191     {
 192       if (ip46_address_is_ip4 (peer_addr))
 193         {
 194           BFD_ERR ("IP family mismatch");
 195           return VNET_API_ERROR_INVALID_ARGUMENT;
 196         }
 197       ip6_main_t *im = &ip6_main;
 198       /* *INDENT-OFF* */
 199       foreach_ip_interface_address (
 200           &im->lookup_main, ia, sw_if_index, 0 /* honor unnumbered */, ({
 201             ip6_address_t *x =
 202                 ip_interface_address_get_address (&im->lookup_main, ia);
 203             if (local_addr->ip6.as_u64[0] == x->as_u64[0] &&
 204                 local_addr->ip6.as_u64[1] == x->as_u64[1])
 205               {
 206                 /* valid address for this interface */
 207                 local_ip_valid = 1;
 208                 break;
 209               }
 210           }));
 211       /* *INDENT-ON* */
 212     }
 213
 214   if (!local_ip_valid)
 215     {
 216       BFD_ERR ("address not found on interface");
 217       return VNET_API_ERROR_ADDRESS_NOT_FOUND_FOR_INTERFACE;
 218     }
 219
 220   return 0;
 221 }
 222
 223 vnet_api_error_t bfd_udp_add_session (u32 sw_if_index, u32 desired_min_tx_us,
 224                                       u32 required_min_rx_us, u8 detect_mult,
 225                                       const ip46_address_t *local_addr,
 226                                       const ip46_address_t *peer_addr)
 227 {
 228   vnet_api_error_t rv =
 229       bfd_udp_validate_api_input (sw_if_index, local_addr, peer_addr);
 230   if (rv)
 231     {
 232       return rv;
 233     }
 234   if (detect_mult < 1)
 235     {
 236       BFD_ERR ("detect_mult < 1");
 237       return VNET_API_ERROR_INVALID_ARGUMENT;
 238     }
 239   if (desired_min_tx_us < 1)
 240     {
 241       BFD_ERR ("desired_min_tx_us < 1");
 242       return VNET_API_ERROR_INVALID_ARGUMENT;
 243     }
 244   return bfd_udp_add_session_internal (&bfd_udp_main, sw_if_index,
 245                                        desired_min_tx_us, required_min_rx_us,
 246                                        detect_mult, local_addr, peer_addr);
 247 }
 248
 249 vnet_api_error_t bfd_udp_del_session (u32 sw_if_index,
 250                                       const ip46_address_t *local_addr,
 251                                       const ip46_address_t *peer_addr)
 252 {
 253   vnet_api_error_t rv =
 254       bfd_udp_validate_api_input (sw_if_index, local_addr, peer_addr);
 255   if (rv)
 256     {
 257       return rv;
 258     }
 259   bfd_udp_main_t *bum = &bfd_udp_main;
 260   vnet_sw_interface_t *sw_if =
 261       vnet_get_sw_interface (vnet_get_main (), sw_if_index);
 262   bfd_udp_key_t key;
 263   memset (&key, 0, sizeof (key));
 264   key.sw_if_index = sw_if->sw_if_index;
 265   key.local_addr.as_u64[0] = local_addr->as_u64[0];
 266   key.local_addr.as_u64[1] = local_addr->as_u64[1];
 267   key.peer_addr.as_u64[0] = peer_addr->as_u64[0];
 268   key.peer_addr.as_u64[1] = peer_addr->as_u64[1];
 269   bfd_session_t *tmp = bfd_lookup_session (bum, &key);
 270   if (tmp)
 271     {
 272       BFD_DBG ("free bfd-udp session, bs_idx=%d", tmp->bs_idx);
 273       mhash_unset (&bum->bfd_session_idx_by_bfd_key, &key, NULL);
 274       adj_unlock (tmp->udp.adj_index);
 275       bfd_put_session (bum->bfd_main, tmp);
 276     }
 277   else
 278     {
 279       BFD_ERR ("no such session");
 280       return VNET_API_ERROR_BFD_NOENT;
 281     }
 282   return 0;
 283 }
 284
 285 typedef enum {
 286   BFD_UDP_INPUT_NEXT_NORMAL,
 287   BFD_UDP_INPUT_NEXT_REPLY,
 288   BFD_UDP_INPUT_N_NEXT,
 289 } bfd_udp_input_next_t;
 290
 291 /* Packet counters */
 292 #define foreach_bfd_udp_error(F)           \
 293   F (NONE, "good bfd packets (processed)") \
 294   F (BAD, "invalid bfd packets")           \
 295   F (DISABLED, "bfd packets received on disabled interfaces")
 296
 297 #define F(sym, string) static char BFD_UDP_ERR_##sym##_STR[] = string;
 298 foreach_bfd_udp_error (F);
 299 #undef F
 300
 301 static char *bfd_udp_error_strings[] = {
 302 #define F(sym, string) BFD_UDP_ERR_##sym##_STR,
 303   foreach_bfd_udp_error (F)
 304 #undef F
 305 };
 306
 307 typedef enum {
 308 #define F(sym, str) BFD_UDP_ERROR_##sym,
 309   foreach_bfd_udp_error (F)
 310 #undef F
 311       BFD_UDP_N_ERROR,
 312 } bfd_udp_error_t;
 313
 314 static void bfd_udp4_find_headers (vlib_buffer_t *b, const ip4_header_t **ip4,
 315                                    const udp_header_t **udp)
 316 {
 317   /* sanity check first */
 318   const i32 start = vnet_buffer (b)->ip.start_of_ip_header;
 319   if (start < 0 && start < sizeof (b->pre_data))
 320     {
 321       BFD_ERR ("Start of ip header is before pre_data, ignoring");
 322       *ip4 = NULL;
 323       *udp = NULL;
 324       return;
 325     }
 326   *ip4 = (ip4_header_t *)(b->data + start);
 327   if ((u8 *)*ip4 > (u8 *)vlib_buffer_get_current (b))
 328     {
 329       BFD_ERR ("Start of ip header is beyond current data, ignoring");
 330       *ip4 = NULL;
 331       *udp = NULL;
 332       return;
 333     }
 334   *udp = (udp_header_t *)((*ip4) + 1);
 335 }
 336
 337 static bfd_udp_error_t bfd_udp4_verify_transport (const ip4_header_t *ip4,
 338                                                   const udp_header_t *udp,
 339                                                   const bfd_session_t *bs)
 340 {
 341   const bfd_udp_session_t *bus = &bs->udp;
 342   const bfd_udp_key_t *key = &bus->key;
 343   if (ip4->src_address.as_u32 != key->peer_addr.ip4.as_u32)
 344     {
 345       BFD_ERR ("IP src addr mismatch, got %U, expected %U", format_ip4_address,
 346                ip4->src_address.as_u32, format_ip4_address,
 347                key->peer_addr.ip4.as_u32);
 348       return BFD_UDP_ERROR_BAD;
 349     }
 350   if (ip4->dst_address.as_u32 != key->local_addr.ip4.as_u32)
 351     {
 352       BFD_ERR ("IP dst addr mismatch, got %U, expected %U", format_ip4_address,
 353                ip4->dst_address.as_u32, format_ip4_address,
 354                key->local_addr.ip4.as_u32);
 355       return BFD_UDP_ERROR_BAD;
 356     }
 357   const u8 expected_ttl = 255;
 358   if (ip4->ttl != expected_ttl)
 359     {
 360       BFD_ERR ("IP unexpected TTL value %d, expected %d", ip4->ttl,
 361                expected_ttl);
 362       return BFD_UDP_ERROR_BAD;
 363     }
 364   if (clib_net_to_host_u16 (udp->src_port) < 49152 ||
 365       clib_net_to_host_u16 (udp->src_port) > 65535)
 366     {
 367       BFD_ERR ("Invalid UDP src port %d, out of range <49152,65535>",
 368                udp->src_port);
 369     }
 370   return BFD_UDP_ERROR_NONE;
 371 }
 372
 373 typedef struct
 374 {
 375   u32 bs_idx;
 376   bfd_pkt_t pkt;
 377 } bfd_rpc_update_t;
 378
 379 static void bfd_rpc_update_session_cb (const bfd_rpc_update_t *a)
 380 {
 381   bfd_consume_pkt (bfd_udp_main.bfd_main, &a->pkt, a->bs_idx);
 382 }
 383
 384 static void bfd_rpc_update_session (u32 bs_idx, const bfd_pkt_t *pkt)
 385 {
 386   /* packet length was already verified to be correct by the caller */
 387   const u32 data_size = sizeof (bfd_rpc_update_t) -
 388                         STRUCT_SIZE_OF (bfd_rpc_update_t, pkt) +
 389                         pkt->head.length;
 390   u8 data[data_size];
 391   bfd_rpc_update_t *update = (bfd_rpc_update_t *)data;
 392   update->bs_idx = bs_idx;
 393   clib_memcpy (&update->pkt, pkt, pkt->head.length);
 394   vl_api_rpc_call_main_thread (bfd_rpc_update_session_cb, data, data_size);
 395 }
 396
 397 static bfd_udp_error_t bfd_udp4_scan (vlib_main_t *vm, vlib_node_runtime_t *rt,
 398                                       vlib_buffer_t *b, bfd_session_t **bs_out)
 399 {
 400   const bfd_pkt_t *pkt = vlib_buffer_get_current (b);
 401   if (sizeof (*pkt) > b->current_length)
 402     {
 403       BFD_ERR (
 404           "Payload size %d too small to hold bfd packet of minimum size %d",
 405           b->current_length, sizeof (*pkt));
 406       return BFD_UDP_ERROR_BAD;
 407     }
 408   const ip4_header_t *ip4;
 409   const udp_header_t *udp;
 410   bfd_udp4_find_headers (b, &ip4, &udp);
 411   if (!ip4 || !udp)
 412     {
 413       BFD_ERR ("Couldn't find ip4 or udp header");
 414       return BFD_UDP_ERROR_BAD;
 415     }
 416   if (!bfd_verify_pkt_common (pkt))
 417     {
 418       return BFD_UDP_ERROR_BAD;
 419     }
 420   bfd_session_t *bs = NULL;
 421   if (pkt->your_disc)
 422     {
 423       BFD_DBG ("Looking up BFD session using discriminator %u",
 424                pkt->your_disc);
 425       bs = bfd_find_session_by_disc (bfd_udp_main.bfd_main, pkt->your_disc);
 426     }
 427   else
 428     {
 429       bfd_udp_key_t key;
 430       memset (&key, 0, sizeof (key));
 431       key.sw_if_index = vnet_buffer (b)->sw_if_index[VLIB_RX];
 432       key.local_addr.ip4.as_u32 = ip4->dst_address.as_u32;
 433       key.peer_addr.ip4.as_u32 = ip4->src_address.as_u32;
 434       BFD_DBG ("Looking up BFD session using key (sw_if_index=%u, local=%U, "
 435                "peer=%U)",
 436                key.sw_if_index, format_ip4_address, key.local_addr.ip4.as_u8,
 437                format_ip4_address, key.peer_addr.ip4.as_u8);
 438       bs = bfd_lookup_session (&bfd_udp_main, &key);
 439     }
 440   if (!bs)
 441     {
 442       BFD_ERR ("BFD session lookup failed - no session matches BFD pkt");
 443       return BFD_UDP_ERROR_BAD;
 444     }
 445   BFD_DBG ("BFD session found, bs_idx=%u", bs->bs_idx);
 446   if (!bfd_verify_pkt_session (pkt, b->current_length, bs))
 447     {
 448       return BFD_UDP_ERROR_BAD;
 449     }
 450   bfd_udp_error_t err;
 451   if (BFD_UDP_ERROR_NONE != (err = bfd_udp4_verify_transport (ip4, udp, bs)))
 452     {
 453       return err;
 454     }
 455   bfd_rpc_update_session (bs->bs_idx, pkt);
 456   *bs_out = bs;
 457   return BFD_UDP_ERROR_NONE;
 458 }
 459
 460 static bfd_udp_error_t bfd_udp6_scan (vlib_main_t *vm, vlib_buffer_t *b)
 461 {
 462   /* TODO */
 463   return BFD_UDP_ERROR_BAD;
 464 }
 465
 466 /*
 467  * Process a frame of bfd packets
 468  * Expect 1 packet / frame
 469  */
 470 static uword bfd_udp_input (vlib_main_t *vm, vlib_node_runtime_t *rt,
 471                             vlib_frame_t *f, int is_ipv6)
 472 {
 473   u32 n_left_from, *from;
 474   bfd_input_trace_t *t0;
 475
 476   from = vlib_frame_vector_args (f); /* array of buffer indices */
 477   n_left_from = f->n_vectors;        /* number of buffer indices */
 478
 479   while (n_left_from > 0)
 480     {
 481       u32 bi0;
 482       vlib_buffer_t *b0;
 483       u32 next0, error0;
 484
 485       bi0 = from[0];
 486       b0 = vlib_get_buffer (vm, bi0);
 487
 488       bfd_session_t *bs = NULL;
 489
 490       /* If this pkt is traced, snapshot the data */
 491       if (b0->flags & VLIB_BUFFER_IS_TRACED)
 492         {
 493           int len;
 494           t0 = vlib_add_trace (vm, rt, b0, sizeof (*t0));
 495           len = (b0->current_length < sizeof (t0->data)) ? b0->current_length
 496                                                          : sizeof (t0->data);
 497           t0->len = len;
 498           clib_memcpy (t0->data, vlib_buffer_get_current (b0), len);
 499         }
 500
 501       /* scan this bfd pkt. error0 is the counter index to bmp */
 502       if (is_ipv6)
 503         {
 504           error0 = bfd_udp6_scan (vm, b0);
 505         }
 506       else
 507         {
 508           error0 = bfd_udp4_scan (vm, rt, b0, &bs);
 509         }
 510       b0->error = rt->errors[error0];
 511
 512       next0 = BFD_UDP_INPUT_NEXT_NORMAL;
 513       if (BFD_UDP_ERROR_NONE == error0)
 514         {
 515           /* if everything went fine, check for poll bit, if present, re-use
 516              the buffer and based on (now updated) session parameters, send the
 517              final packet back */
 518           const bfd_pkt_t *pkt = vlib_buffer_get_current (b0);
 519           if (bfd_pkt_get_poll (pkt))
 520             {
 521               bfd_send_final (vm, b0, bs);
 522               if (is_ipv6)
 523                 {
 524                   vlib_node_increment_counter (vm, bfd_udp6_input_node.index,
 525                                                b0->error, 1);
 526                 }
 527               else
 528                 {
 529                   vlib_node_increment_counter (vm, bfd_udp4_input_node.index,
 530                                                b0->error, 1);
 531                 }
 532               next0 = BFD_UDP_INPUT_NEXT_REPLY;
 533             }
 534         }
 535       vlib_set_next_frame_buffer (vm, rt, next0, bi0);
 536
 537       from += 1;
 538       n_left_from -= 1;
 539     }
 540
 541   return f->n_vectors;
 542 }
 543
 544 static uword bfd_udp4_input (vlib_main_t *vm, vlib_node_runtime_t *rt,
 545                              vlib_frame_t *f)
 546 {
 547   return bfd_udp_input (vm, rt, f, 0);
 548 }
 549
 550 /*
 551  * bfd input graph node declaration
 552  */
 553 /* *INDENT-OFF* */
 554 VLIB_REGISTER_NODE (bfd_udp4_input_node, static) = {
 555   .function = bfd_udp4_input,
 556   .name = "bfd-udp4-input",
 557   .vector_size = sizeof (u32),
 558   .type = VLIB_NODE_TYPE_INTERNAL,
 559
 560   .n_errors = BFD_UDP_N_ERROR,
 561   .error_strings = bfd_udp_error_strings,
 562
 563   .format_trace = bfd_input_format_trace,
 564
 565   .n_next_nodes = BFD_UDP_INPUT_N_NEXT,
 566   .next_nodes =
 567       {
 568               [BFD_UDP_INPUT_NEXT_NORMAL] = "error-drop",
 569               [BFD_UDP_INPUT_NEXT_REPLY] = "ip4-lookup",
 570       },
 571 };
 572 /* *INDENT-ON* */
 573
 574 static uword bfd_udp6_input (vlib_main_t *vm, vlib_node_runtime_t *rt,
 575                              vlib_frame_t *f)
 576 {
 577   return bfd_udp_input (vm, rt, f, 1);
 578 }
 579
 580 /* *INDENT-OFF* */
 581 VLIB_REGISTER_NODE (bfd_udp6_input_node, static) = {
 582   .function = bfd_udp6_input,
 583   .name = "bfd-udp6-input",
 584   .vector_size = sizeof (u32),
 585   .type = VLIB_NODE_TYPE_INTERNAL,
 586
 587   .n_errors = BFD_UDP_N_ERROR,
 588   .error_strings = bfd_udp_error_strings,
 589
 590   .format_trace = bfd_input_format_trace,
 591
 592   .n_next_nodes = BFD_UDP_INPUT_N_NEXT,
 593   .next_nodes =
 594       {
 595               [BFD_UDP_INPUT_NEXT_NORMAL] = "error-drop",
 596               [BFD_UDP_INPUT_NEXT_REPLY] = "ip6-lookup",
 597       },
 598 };
 599 /* *INDENT-ON* */
 600
 601 static clib_error_t *bfd_sw_interface_up_down (vnet_main_t *vnm,
 602                                                u32 sw_if_index, u32 flags)
 603 {
 604   // vnet_hw_interface_t *hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
 605   if (!(flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP))
 606     {
 607       /* TODO */
 608     }
 609   return 0;
 610 }
 611
 612 VNET_SW_INTERFACE_ADMIN_UP_DOWN_FUNCTION (bfd_sw_interface_up_down);
 613
 614 static clib_error_t *bfd_hw_interface_up_down (vnet_main_t *vnm,
 615                                                u32 hw_if_index, u32 flags)
 616 {
 617   if (flags & VNET_HW_INTERFACE_FLAG_LINK_UP)
 618     {
 619       /* TODO */
 620     }
 621   return 0;
 622 }
 623
 624 VNET_HW_INTERFACE_LINK_UP_DOWN_FUNCTION (bfd_hw_interface_up_down);
 625
 626 /*
 627  * setup function
 628  */
 629 static clib_error_t *bfd_udp_init (vlib_main_t *vm)
 630 {
 631   mhash_init (&bfd_udp_main.bfd_session_idx_by_bfd_key, sizeof (uword),
 632               sizeof (bfd_udp_key_t));
 633   bfd_udp_main.bfd_main = &bfd_main;
 634   udp_register_dst_port (vm, UDP_DST_PORT_bfd4, bfd_udp4_input_node.index, 1);
 635   udp_register_dst_port (vm, UDP_DST_PORT_bfd6, bfd_udp6_input_node.index, 0);
 636   return 0;
 637 }
 638
 639 VLIB_INIT_FUNCTION (bfd_udp_init);