src/vnet/l2tp/l2tp.c

   1 /*
   2  * l2tp.c : L2TPv3 tunnel support
   3  *
   4  * Copyright (c) 2013 Cisco and/or its affiliates.
   5  * Licensed under the Apache License, Version 2.0 (the "License");
   6  * you may not use this file except in compliance with the License.
   7  * You may obtain a copy of the License at:
   8  *
   9  *     http://www.apache.org/licenses/LICENSE-2.0
  10  *
  11  * Unless required by applicable law or agreed to in writing, software
  12  * distributed under the License is distributed on an "AS IS" BASIS,
  13  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  14  * See the License for the specific language governing permissions and
  15  * limitations under the License.
  16  */
  17
  18 #include <vppinfra/error.h>
  19 #include <vppinfra/hash.h>
  20 #include <vnet/vnet.h>
  21 #include <vnet/ip/ip.h>
  22 #include <vnet/l2/l2_input.h>
  23 #include <vnet/ethernet/ethernet.h>
  24 #include <vnet/l2tp/l2tp.h>
  25
  26 l2t_main_t l2t_main;
  27
  28 /* packet trace format function */
  29 u8 *
  30 format_l2t_trace (u8 * s, va_list * args)
  31 {
  32   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
  33   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
  34   l2t_trace_t *t = va_arg (*args, l2t_trace_t *);
  35
  36   if (t->is_user_to_network)
  37     s = format (s, "L2T: %U (client) -> %U (our) session %d",
  38                 format_ip6_address, &t->client_address,
  39                 format_ip6_address, &t->our_address, t->session_index);
  40   else
  41     s = format (s, "L2T: %U (our) -> %U (client) session %d)",
  42                 format_ip6_address, &t->our_address,
  43                 format_ip6_address, &t->client_address, t->session_index);
  44   return s;
  45 }
  46
  47 u8 *
  48 format_l2t_session (u8 * s, va_list * args)
  49 {
  50   l2t_session_t *session = va_arg (*args, l2t_session_t *);
  51   l2t_main_t *lm = &l2t_main;
  52   u32 counter_index;
  53   vlib_counter_t v;
  54
  55   s = format (s, "[%d] %U (our) %U (client) %U (sw_if_index %d)\n",
  56               session - lm->sessions,
  57               format_ip6_address, &session->our_address,
  58               format_ip6_address, &session->client_address,
  59               format_vnet_sw_interface_name, lm->vnet_main,
  60               vnet_get_sw_interface (lm->vnet_main, session->sw_if_index),
  61               session->sw_if_index);
  62
  63   s = format (s, "   local cookies %016llx %016llx remote cookie %016llx\n",
  64               clib_net_to_host_u64 (session->local_cookie[0]),
  65               clib_net_to_host_u64 (session->local_cookie[1]),
  66               clib_net_to_host_u64 (session->remote_cookie));
  67
  68   s = format (s, "   local session-id %d remote session-id %d\n",
  69               clib_net_to_host_u32 (session->local_session_id),
  70               clib_net_to_host_u32 (session->remote_session_id));
  71
  72   s = format (s, "   l2 specific sublayer %s\n",
  73               session->l2_sublayer_present ? "preset" : "absent");
  74
  75   counter_index =
  76     session_index_to_counter_index (session - lm->sessions,
  77                                     SESSION_COUNTER_USER_TO_NETWORK);
  78
  79   vlib_get_combined_counter (&lm->counter_main, counter_index, &v);
  80   if (v.packets != 0)
  81     s = format (s, "   user-to-net: %llu pkts %llu bytes\n",
  82                 v.packets, v.bytes);
  83
  84   vlib_get_combined_counter (&lm->counter_main, counter_index + 1, &v);
  85
  86   if (v.packets != 0)
  87     s = format (s, "   net-to-user: %llu pkts %llu bytes\n",
  88                 v.packets, v.bytes);
  89   return s;
  90 }
  91
  92 static clib_error_t *
  93 show_l2tp_command_fn (vlib_main_t * vm,
  94                       unformat_input_t * input, vlib_cli_command_t * cmd)
  95 {
  96   l2t_session_t *session;
  97   l2t_main_t *lm = &l2t_main;
  98   char *keystr = 0;
  99   int verbose = 0;
 100
 101   if (unformat (input, "verbose") || unformat (input, "v"))
 102     verbose = 1;
 103
 104   if (pool_elts (lm->sessions) == 0)
 105     vlib_cli_output (vm, "No l2tp sessions...");
 106   else
 107     vlib_cli_output (vm, "%u l2tp sessions...", pool_elts (lm->sessions));
 108
 109   if (verbose)
 110     {
 111       switch (lm->lookup_type)
 112         {
 113         case L2T_LOOKUP_SRC_ADDRESS:
 114           keystr = "src address";
 115           break;
 116
 117         case L2T_LOOKUP_DST_ADDRESS:
 118           keystr = "dst address";
 119           break;
 120
 121         case L2T_LOOKUP_SESSION_ID:
 122           keystr = "session id";
 123           break;
 124
 125         default:
 126           keystr = "BOGUS!";
 127           break;
 128         }
 129
 130       vlib_cli_output (vm, "L2tp session lookup on %s", keystr);
 131
 132       /* *INDENT-OFF* */
 133       pool_foreach (session, lm->sessions,
 134       ({
 135         vlib_cli_output (vm, "%U", format_l2t_session, session);
 136       }));
 137       /* *INDENT-ON* */
 138     }
 139
 140   return 0;
 141 }
 142
 143 /* *INDENT-OFF* */
 144 VLIB_CLI_COMMAND (show_session_detail_command, static) = {
 145   .path = "show l2tpv3",
 146   .short_help = "show l2tpv3 [verbose]",
 147   .function = show_l2tp_command_fn,
 148 };
 149 /* *INDENT-ON* */
 150
 151 static clib_error_t *
 152 test_counters_command_fn (vlib_main_t * vm,
 153                           unformat_input_t * input, vlib_cli_command_t * cmd)
 154 {
 155   l2t_session_t *session;
 156   l2t_main_t *lm = &l2t_main;
 157   u32 session_index;
 158   u32 counter_index;
 159   u32 nincr = 0;
 160   u32 thread_index = vm->thread_index;
 161
 162   /* *INDENT-OFF* */
 163   pool_foreach (session, lm->sessions,
 164   ({
 165     session_index = session - lm->sessions;
 166     counter_index =
 167       session_index_to_counter_index (session_index,
 168                                       SESSION_COUNTER_USER_TO_NETWORK);
 169     vlib_increment_combined_counter (&lm->counter_main,
 170                                      thread_index,
 171                                      counter_index,
 172                                      1/*pkt*/, 1111 /*bytes*/);
 173     vlib_increment_combined_counter (&lm->counter_main,
 174                                      thread_index,
 175                                      counter_index+1,
 176                                      1/*pkt*/, 2222 /*bytes*/);
 177     nincr++;
 178
 179   }));
 180   /* *INDENT-ON* */
 181   vlib_cli_output (vm, "Incremented %d active counters\n", nincr);
 182
 183   return 0;
 184 }
 185
 186 /* *INDENT-OFF* */
 187 VLIB_CLI_COMMAND (test_counters_command, static) = {
 188     .path = "test counters",
 189     .short_help = "increment all active counters",
 190     .function = test_counters_command_fn,
 191 };
 192 /* *INDENT-ON* */
 193
 194 static clib_error_t *
 195 clear_counters_command_fn (vlib_main_t * vm,
 196                            unformat_input_t * input, vlib_cli_command_t * cmd)
 197 {
 198   l2t_session_t *session;
 199   l2t_main_t *lm = &l2t_main;
 200   u32 session_index;
 201   u32 counter_index;
 202   u32 nincr = 0;
 203
 204   /* *INDENT-OFF* */
 205   pool_foreach (session, lm->sessions,
 206   ({
 207     session_index = session - lm->sessions;
 208     counter_index =
 209       session_index_to_counter_index (session_index,
 210                                       SESSION_COUNTER_USER_TO_NETWORK);
 211     vlib_zero_combined_counter (&lm->counter_main, counter_index);
 212     vlib_zero_combined_counter (&lm->counter_main, counter_index+1);
 213     nincr++;
 214   }));
 215   /* *INDENT-ON* */
 216   vlib_cli_output (vm, "Cleared %d active counters\n", nincr);
 217
 218   return 0;
 219 }
 220
 221 /* *INDENT-OFF* */
 222 VLIB_CLI_COMMAND (clear_counters_command, static) = {
 223   .path = "clear counters",
 224   .short_help = "clear all active counters",
 225   .function = clear_counters_command_fn,
 226 };
 227 /* *INDENT-ON* */
 228
 229 static u8 *
 230 format_l2tpv3_name (u8 * s, va_list * args)
 231 {
 232   l2t_main_t *lm = &l2t_main;
 233   u32 i = va_arg (*args, u32);
 234   u32 show_dev_instance = ~0;
 235
 236   if (i < vec_len (lm->dev_inst_by_real))
 237     show_dev_instance = lm->dev_inst_by_real[i];
 238
 239   if (show_dev_instance != ~0)
 240     i = show_dev_instance;
 241
 242   return format (s, "l2tpv3_tunnel%d", i);
 243 }
 244
 245 static int
 246 l2tpv3_name_renumber (vnet_hw_interface_t * hi, u32 new_dev_instance)
 247 {
 248   l2t_main_t *lm = &l2t_main;
 249
 250   vec_validate_init_empty (lm->dev_inst_by_real, hi->dev_instance, ~0);
 251
 252   lm->dev_inst_by_real[hi->dev_instance] = new_dev_instance;
 253
 254   return 0;
 255 }
 256
 257 /* *INDENT-OFF* */
 258 VNET_DEVICE_CLASS (l2tpv3_device_class,static) = {
 259   .name = "L2TPv3",
 260   .format_device_name = format_l2tpv3_name,
 261   .name_renumber = l2tpv3_name_renumber,
 262 };
 263 /* *INDENT-ON* */
 264
 265 static u8 *
 266 format_l2tp_header_with_length (u8 * s, va_list * args)
 267 {
 268   u32 dev_instance = va_arg (*args, u32);
 269   s = format (s, "unimplemented dev %u", dev_instance);
 270   return s;
 271 }
 272
 273 /* *INDENT-OFF* */
 274 VNET_HW_INTERFACE_CLASS (l2tpv3_hw_class) = {
 275   .name = "L2TPV3",
 276   .format_header = format_l2tp_header_with_length,
 277   .build_rewrite = default_build_rewrite,
 278   .flags = VNET_HW_INTERFACE_CLASS_FLAG_P2P,
 279 };
 280 /* *INDENT-ON* */
 281
 282 int
 283 create_l2tpv3_ipv6_tunnel (l2t_main_t * lm,
 284                            ip6_address_t * client_address,
 285                            ip6_address_t * our_address,
 286                            u32 local_session_id,
 287                            u32 remote_session_id,
 288                            u64 local_cookie,
 289                            u64 remote_cookie,
 290                            int l2_sublayer_present,
 291                            u32 encap_fib_index, u32 * sw_if_index)
 292 {
 293   l2t_session_t *s = 0;
 294   vnet_main_t *vnm = lm->vnet_main;
 295   vnet_hw_interface_t *hi;
 296   uword *p = (uword *) ~ 0;
 297   u32 hw_if_index;
 298   l2tpv3_header_t l2tp_hdr;
 299   ip6_address_t *dst_address_copy, *src_address_copy;
 300   u32 counter_index;
 301
 302   remote_session_id = clib_host_to_net_u32 (remote_session_id);
 303   local_session_id = clib_host_to_net_u32 (local_session_id);
 304
 305   switch (lm->lookup_type)
 306     {
 307     case L2T_LOOKUP_SRC_ADDRESS:
 308       p = hash_get_mem (lm->session_by_src_address, client_address);
 309       break;
 310
 311     case L2T_LOOKUP_DST_ADDRESS:
 312       p = hash_get_mem (lm->session_by_dst_address, our_address);
 313       break;
 314
 315     case L2T_LOOKUP_SESSION_ID:
 316       p = hash_get (lm->session_by_session_id, local_session_id);
 317       break;
 318
 319     default:
 320       ASSERT (0);
 321     }
 322
 323   /* adding a session: session must not already exist */
 324   if (p)
 325     return VNET_API_ERROR_INVALID_VALUE;
 326
 327   pool_get (lm->sessions, s);
 328   clib_memset (s, 0, sizeof (*s));
 329   clib_memcpy (&s->our_address, our_address, sizeof (s->our_address));
 330   clib_memcpy (&s->client_address, client_address,
 331                sizeof (s->client_address));
 332   s->local_cookie[0] = clib_host_to_net_u64 (local_cookie);
 333   s->remote_cookie = clib_host_to_net_u64 (remote_cookie);
 334   s->local_session_id = local_session_id;
 335   s->remote_session_id = remote_session_id;
 336   s->l2_sublayer_present = l2_sublayer_present;
 337   /* precompute l2tp header size */
 338   s->l2tp_hdr_size = l2_sublayer_present ?
 339     sizeof (l2tpv3_header_t) :
 340     sizeof (l2tpv3_header_t) - sizeof (l2tp_hdr.l2_specific_sublayer);
 341   s->admin_up = 0;
 342   s->encap_fib_index = encap_fib_index;
 343
 344   /* Setup hash table entries */
 345   switch (lm->lookup_type)
 346     {
 347     case L2T_LOOKUP_SRC_ADDRESS:
 348       src_address_copy = clib_mem_alloc (sizeof (*src_address_copy));
 349       clib_memcpy (src_address_copy, client_address,
 350                    sizeof (*src_address_copy));
 351       hash_set_mem (lm->session_by_src_address, src_address_copy,
 352                     s - lm->sessions);
 353       break;
 354     case L2T_LOOKUP_DST_ADDRESS:
 355       dst_address_copy = clib_mem_alloc (sizeof (*dst_address_copy));
 356       clib_memcpy (dst_address_copy, our_address, sizeof (*dst_address_copy));
 357       hash_set_mem (lm->session_by_dst_address, dst_address_copy,
 358                     s - lm->sessions);
 359       break;
 360     case L2T_LOOKUP_SESSION_ID:
 361       hash_set (lm->session_by_session_id, local_session_id,
 362                 s - lm->sessions);
 363       break;
 364
 365     default:
 366       ASSERT (0);
 367     }
 368
 369   /* validate counters */
 370   counter_index =
 371     session_index_to_counter_index (s - lm->sessions,
 372                                     SESSION_COUNTER_USER_TO_NETWORK);
 373   vlib_validate_combined_counter (&lm->counter_main, counter_index);
 374   vlib_validate_combined_counter (&lm->counter_main, counter_index + 1);
 375
 376   if (vec_len (lm->free_l2tpv3_tunnel_hw_if_indices) > 0)
 377     {
 378       hw_if_index = lm->free_l2tpv3_tunnel_hw_if_indices
 379         [vec_len (lm->free_l2tpv3_tunnel_hw_if_indices) - 1];
 380       _vec_len (lm->free_l2tpv3_tunnel_hw_if_indices) -= 1;
 381
 382       hi = vnet_get_hw_interface (vnm, hw_if_index);
 383       hi->dev_instance = s - lm->sessions;
 384       hi->hw_instance = hi->dev_instance;
 385     }
 386   else
 387     {
 388       hw_if_index = vnet_register_interface
 389         (vnm, l2tpv3_device_class.index, s - lm->sessions,
 390          l2tpv3_hw_class.index, s - lm->sessions);
 391       hi = vnet_get_hw_interface (vnm, hw_if_index);
 392       hi->output_node_index = l2t_encap_node.index;
 393       /* $$$$ initialize custom dispositions, if needed */
 394     }
 395
 396   s->hw_if_index = hw_if_index;
 397   s->sw_if_index = hi->sw_if_index;
 398
 399   if (sw_if_index)
 400     *sw_if_index = hi->sw_if_index;
 401
 402   return 0;
 403 }
 404
 405 static clib_error_t *
 406 create_l2tpv3_tunnel_command_fn (vlib_main_t * vm,
 407                                  unformat_input_t * input,
 408                                  vlib_cli_command_t * cmd)
 409 {
 410   ip6_address_t client_address, our_address;
 411   unformat_input_t _line_input, *line_input = &_line_input;
 412   l2t_main_t *lm = &l2t_main;
 413   u64 local_cookie = (u64) ~ 0, remote_cookie = (u64) ~ 0;
 414   u32 local_session_id = 1, remote_session_id = 1;
 415   int our_address_set = 0, client_address_set = 0;
 416   int l2_sublayer_present = 0;
 417   int rv;
 418   u32 sw_if_index;
 419   u32 encap_fib_id = ~0;
 420   u32 encap_fib_index = ~0;
 421   clib_error_t *error = NULL;
 422
 423   /* Get a line of input. */
 424   if (!unformat_user (input, unformat_line_input, line_input))
 425     return 0;
 426
 427   while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT)
 428     {
 429       if (unformat (line_input, "client %U",
 430                     unformat_ip6_address, &client_address))
 431         client_address_set = 1;
 432       else if (unformat (line_input, "our %U",
 433                          unformat_ip6_address, &our_address))
 434         our_address_set = 1;
 435       else if (unformat (line_input, "local-cookie %llx", &local_cookie))
 436         ;
 437       else if (unformat (line_input, "remote-cookie %llx", &remote_cookie))
 438         ;
 439       else if (unformat (line_input, "local-session-id %d",
 440                          &local_session_id))
 441         ;
 442       else if (unformat (line_input, "remote-session-id %d",
 443                          &remote_session_id))
 444         ;
 445       else if (unformat (line_input, "fib-id %d", &encap_fib_id))
 446         ;
 447       else if (unformat (line_input, "l2-sublayer-present"))
 448         l2_sublayer_present = 1;
 449       else
 450         {
 451           error = clib_error_return (0, "parse error: '%U'",
 452                                      format_unformat_error, line_input);
 453           goto done;
 454         }
 455     }
 456
 457   if (encap_fib_id != ~0)
 458     {
 459       uword *p;
 460       ip6_main_t *im = &ip6_main;
 461       if (!(p = hash_get (im->fib_index_by_table_id, encap_fib_id)))
 462         {
 463           error = clib_error_return (0, "No fib with id %d", encap_fib_id);
 464           goto done;
 465         }
 466       encap_fib_index = p[0];
 467     }
 468   else
 469     {
 470       encap_fib_index = ~0;
 471     }
 472
 473   if (our_address_set == 0)
 474     {
 475       error = clib_error_return (0, "our address not specified");
 476       goto done;
 477     }
 478   if (client_address_set == 0)
 479     {
 480       error = clib_error_return (0, "client address not specified");
 481       goto done;
 482     }
 483
 484   rv = create_l2tpv3_ipv6_tunnel (lm, &client_address, &our_address,
 485                                   local_session_id, remote_session_id,
 486                                   local_cookie, remote_cookie,
 487                                   l2_sublayer_present,
 488                                   encap_fib_index, &sw_if_index);
 489   switch (rv)
 490     {
 491     case 0:
 492       vlib_cli_output (vm, "%U\n", format_vnet_sw_if_index_name,
 493                        vnet_get_main (), sw_if_index);
 494       break;
 495     case VNET_API_ERROR_INVALID_VALUE:
 496       error = clib_error_return (0, "session already exists...");
 497       goto done;
 498
 499     case VNET_API_ERROR_NO_SUCH_ENTRY:
 500       error = clib_error_return (0, "session does not exist...");
 501       goto done;
 502
 503     default:
 504       error = clib_error_return (0, "l2tp_session_add_del returned %d", rv);
 505       goto done;
 506     }
 507
 508 done:
 509   unformat_free (line_input);
 510
 511   return error;
 512 }
 513
 514 /* *INDENT-OFF* */
 515 VLIB_CLI_COMMAND (create_l2tpv3_tunnel_command, static) =
 516 {
 517   .path = "create l2tpv3 tunnel",
 518   .short_help =
 519   "create l2tpv3 tunnel client <ip6> our <ip6> local-cookie <hex> remote-cookie <hex> local-session <dec> remote-session <dec>",
 520   .function = create_l2tpv3_tunnel_command_fn,
 521 };
 522 /* *INDENT-ON* */
 523
 524 int
 525 l2tpv3_set_tunnel_cookies (l2t_main_t * lm,
 526                            u32 sw_if_index,
 527                            u64 new_local_cookie, u64 new_remote_cookie)
 528 {
 529   l2t_session_t *s;
 530   vnet_hw_interface_t *hi;
 531   vnet_main_t *vnm = vnet_get_main ();
 532   hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
 533
 534   if (pool_is_free_index (lm->sessions, hi->dev_instance))
 535     return VNET_API_ERROR_INVALID_VALUE;
 536
 537   s = pool_elt_at_index (lm->sessions, hi->dev_instance);
 538
 539   s->local_cookie[1] = s->local_cookie[0];
 540   s->local_cookie[0] = clib_host_to_net_u64 (new_local_cookie);
 541   s->remote_cookie = clib_host_to_net_u64 (new_remote_cookie);
 542
 543   return 0;
 544 }
 545
 546
 547 static clib_error_t *
 548 set_l2tp_tunnel_cookie_command_fn (vlib_main_t * vm,
 549                                    unformat_input_t * input,
 550                                    vlib_cli_command_t * cmd)
 551 {
 552   l2t_main_t *lm = &l2t_main;
 553   vnet_main_t *vnm = vnet_get_main ();
 554   u32 sw_if_index = ~0;
 555   u64 local_cookie = (u64) ~ 0, remote_cookie = (u64) ~ 0;
 556
 557   int rv;
 558
 559   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
 560     {
 561       if (unformat (input, "%U", unformat_vnet_sw_interface, vnm,
 562                     &sw_if_index))
 563         ;
 564       else if (unformat (input, "local %llx", &local_cookie))
 565         ;
 566       else if (unformat (input, "remote %llx", &remote_cookie))
 567         ;
 568       else
 569         break;
 570     }
 571   if (sw_if_index == ~0)
 572     return clib_error_return (0, "unknown interface");
 573   if (local_cookie == ~0)
 574     return clib_error_return (0, "local cookie required");
 575   if (remote_cookie == ~0)
 576     return clib_error_return (0, "remote cookie required");
 577
 578   rv = l2tpv3_set_tunnel_cookies (lm, sw_if_index,
 579                                   local_cookie, remote_cookie);
 580
 581   switch (rv)
 582     {
 583     case 0:
 584       break;
 585
 586     case VNET_API_ERROR_INVALID_SW_IF_INDEX:
 587       return clib_error_return (0, "invalid interface");
 588
 589     default:
 590       return clib_error_return (0, "l2tp_session_set_cookies returned %d",
 591                                 rv);
 592     }
 593
 594   return 0;
 595 }
 596
 597 /* *INDENT-OFF* */
 598 VLIB_CLI_COMMAND (set_l2tp_tunnel_cookie_command, static) =
 599 {
 600   .path = "set l2tpv3 tunnel cookie",
 601   .short_help =
 602   "set l2tpv3 tunnel cookie <intfc> local <hex> remote <hex>",
 603   .function = set_l2tp_tunnel_cookie_command_fn,
 604 };
 605 /* *INDENT-ON* */
 606
 607 int
 608 l2tpv3_interface_enable_disable (vnet_main_t * vnm,
 609                                  u32 sw_if_index, int enable_disable)
 610 {
 611
 612   if (pool_is_free_index (vnm->interface_main.sw_interfaces, sw_if_index))
 613     return VNET_API_ERROR_INVALID_SW_IF_INDEX;
 614
 615   vnet_feature_enable_disable ("ip6-unicast", "l2tp-decap", sw_if_index,
 616                                enable_disable, 0, 0);
 617   return 0;
 618 }
 619
 620 /* Enable/disable L2TPv3 intercept on IP6 forwarding path */
 621 static clib_error_t *
 622 set_ip6_l2tpv3 (vlib_main_t * vm,
 623                 unformat_input_t * input, vlib_cli_command_t * cmd)
 624 {
 625   u32 sw_if_index = ~0;
 626   int is_add = 1;
 627   int rv;
 628   vnet_main_t *vnm = vnet_get_main ();
 629
 630   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
 631     {
 632       if (unformat (input, "%U", unformat_vnet_sw_interface, vnm,
 633                     &sw_if_index))
 634         ;
 635       else if (unformat (input, "del"))
 636         is_add = 0;
 637       else
 638         break;
 639     }
 640
 641   if (sw_if_index == ~0)
 642     return clib_error_return (0, "interface required");
 643
 644   rv = l2tpv3_interface_enable_disable (vnm, sw_if_index, is_add);
 645
 646   switch (rv)
 647     {
 648     case 0:
 649       break;
 650
 651     case VNET_API_ERROR_INVALID_SW_IF_INDEX:
 652       return clib_error_return (0, "invalid interface");
 653
 654     default:
 655       return clib_error_return (0,
 656                                 "l2tp_interface_enable_disable returned %d",
 657                                 rv);
 658     }
 659   return 0;
 660 }
 661
 662 /* *INDENT-OFF* */
 663 VLIB_CLI_COMMAND (set_interface_ip6_l2tpv3, static) =
 664 {
 665   .path = "set interface ip6 l2tpv3",
 666   .function = set_ip6_l2tpv3,
 667   .short_help = "set interface ip6 l2tpv3 <intfc> [del]",
 668 };
 669 /* *INDENT-ON* */
 670
 671 static clib_error_t *
 672 l2tp_config (vlib_main_t * vm, unformat_input_t * input)
 673 {
 674   l2t_main_t *lm = &l2t_main;
 675
 676   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
 677     {
 678       if (unformat (input, "lookup-v6-src"))
 679         lm->lookup_type = L2T_LOOKUP_SRC_ADDRESS;
 680       else if (unformat (input, "lookup-v6-dst"))
 681         lm->lookup_type = L2T_LOOKUP_DST_ADDRESS;
 682       else if (unformat (input, "lookup-session-id"))
 683         lm->lookup_type = L2T_LOOKUP_SESSION_ID;
 684       else
 685         return clib_error_return (0, "unknown input `%U'",
 686                                   format_unformat_error, input);
 687     }
 688   return 0;
 689 }
 690
 691 VLIB_CONFIG_FUNCTION (l2tp_config, "l2tp");
 692
 693
 694 clib_error_t *
 695 l2tp_sw_interface_up_down (vnet_main_t * vnm, u32 sw_if_index, u32 flags)
 696 {
 697   l2t_main_t *lm = &l2t_main;
 698   vnet_hw_interface_t *hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
 699   if (hi->hw_class_index != l2tpv3_hw_class.index)
 700     return 0;
 701
 702   u32 session_index = hi->dev_instance;
 703   l2t_session_t *s = pool_elt_at_index (lm->sessions, session_index);
 704   s->admin_up = ! !(flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP);
 705   return 0;
 706 }
 707
 708 VNET_SW_INTERFACE_ADMIN_UP_DOWN_FUNCTION (l2tp_sw_interface_up_down);
 709
 710 clib_error_t *
 711 l2tp_init (vlib_main_t * vm)
 712 {
 713   l2t_main_t *lm = &l2t_main;
 714   ip_main_t *im = &ip_main;
 715   ip_protocol_info_t *pi;
 716
 717   lm->vnet_main = vnet_get_main ();
 718   lm->vlib_main = vm;
 719   lm->lookup_type = L2T_LOOKUP_DST_ADDRESS;
 720
 721   lm->session_by_src_address = hash_create_mem
 722     (0, sizeof (ip6_address_t) /* key bytes */ ,
 723      sizeof (u32) /* value bytes */ );
 724   lm->session_by_dst_address = hash_create_mem
 725     (0, sizeof (ip6_address_t) /* key bytes */ ,
 726      sizeof (u32) /* value bytes */ );
 727   lm->session_by_session_id = hash_create (0, sizeof (uword));
 728
 729   pi = ip_get_protocol_info (im, IP_PROTOCOL_L2TP);
 730   pi->unformat_pg_edit = unformat_pg_l2tp_header;
 731
 732   /* insure these nodes are included in build */
 733   l2tp_encap_init (vm);
 734   l2tp_decap_init ();
 735
 736   return 0;
 737 }
 738
 739 VLIB_INIT_FUNCTION (l2tp_init);
 740
 741 clib_error_t *
 742 l2tp_worker_init (vlib_main_t * vm)
 743 {
 744   l2tp_encap_init (vm);
 745
 746   return 0;
 747 }
 748
 749 VLIB_WORKER_INIT_FUNCTION (l2tp_worker_init);
 750
 751 /*
 752  * fd.io coding-style-patch-verification: ON
 753  *
 754  * Local Variables:
 755  * eval: (c-set-style "gnu")
 756  * End:
 757  */