src/vnet/ipsec/ipsec_tun.c

   1 /*
   2  * ipsec_tun.h : IPSEC tunnel protection
   3  *
   4  * Copyright (c) 2015 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 <vnet/ipsec/ipsec_tun.h>
  19 #include <vnet/ipsec/ipsec_itf.h>
  20 #include <vnet/ipsec/esp.h>
  21 #include <vnet/udp/udp.h>
  22 #include <vnet/adj/adj_delegate.h>
  23 #include <vnet/adj/adj_midchain.h>
  24 #include <vnet/teib/teib.h>
  25
  26 /**
  27  * The logger
  28  */
  29 vlib_log_class_t ipsec_tun_protect_logger;
  30
  31 /**
  32  * Pool of tunnel protection objects
  33  */
  34 ipsec_tun_protect_t *ipsec_tun_protect_pool;
  35
  36 /**
  37  * Adj delegate registered type
  38  */
  39 static adj_delegate_type_t ipsec_tun_adj_delegate_type;
  40
  41 /**
  42  * Adj index to TX SA mapping
  43  */
  44 index_t *ipsec_tun_protect_sa_by_adj_index;
  45
  46 const ip_address_t IP_ADDR_ALL_0 = IP_ADDRESS_V4_ALL_0S;
  47
  48 /**
  49  * The DB of all added per-nh tunnel protectiond
  50  */
  51 typedef struct ipsec_tun_protect_itf_db_t_
  52 {
  53   /** A hash table key'd on IP (4 or 6) address */
  54   uword *id_hash;
  55   /** If the interface is P2P then there is only one protect
  56    * object associated with the auto-adj for each NH proto */
  57   index_t id_itp;
  58 } ipsec_tun_protect_itf_db_t;
  59
  60 typedef struct ipsec_tun_protect_db_t_
  61 {
  62   /** Per-interface vector */
  63   ipsec_tun_protect_itf_db_t *id_itf;
  64 } ipsec_tun_protect_db_t;
  65
  66 static ipsec_tun_protect_db_t itp_db;
  67
  68 const static ipsec_tun_protect_itf_db_t IPSEC_TUN_PROTECT_DEFAULT_DB_ENTRY = {
  69   .id_itp = INDEX_INVALID,
  70 };
  71
  72 #define ITP_DBG(_itp, _fmt, _args...)                   \
  73 {                                                       \
  74   vlib_log_debug(ipsec_tun_protect_logger,              \
  75                  "[%U]: " _fmt,                         \
  76                  format_ipsec_tun_protect,              \
  77                  _itp, ##_args);                        \
  78 }
  79
  80 #define ITP_DBG2(_fmt, _args...)                        \
  81 {                                                       \
  82   vlib_log_debug(ipsec_tun_protect_logger,              \
  83                  _fmt, ##_args);                        \
  84 }
  85
  86 static u32 ipsec_tun_node_regs[N_AF];
  87
  88 void
  89 ipsec_tun_register_nodes (ip_address_family_t af)
  90 {
  91   if (0 == ipsec_tun_node_regs[af]++)
  92     {
  93       if (AF_IP4 == af)
  94         {
  95           ipsec_register_udp_port (UDP_DST_PORT_ipsec);
  96           ip4_register_protocol (IP_PROTOCOL_IPSEC_ESP,
  97                                  ipsec4_tun_input_node.index);
  98         }
  99       else
 100         ip6_register_protocol (IP_PROTOCOL_IPSEC_ESP,
 101                                ipsec6_tun_input_node.index);
 102     }
 103 }
 104
 105 void
 106 ipsec_tun_unregister_nodes (ip_address_family_t af)
 107 {
 108   ASSERT (0 != ipsec_tun_node_regs[af]);
 109   if (0 == --ipsec_tun_node_regs[af])
 110     {
 111       if (AF_IP4 == af)
 112         {
 113           ipsec_unregister_udp_port (UDP_DST_PORT_ipsec);
 114           ip4_unregister_protocol (IP_PROTOCOL_IPSEC_ESP);
 115         }
 116       else
 117         ip6_unregister_protocol (IP_PROTOCOL_IPSEC_ESP);
 118     }
 119 }
 120
 121 static inline const ipsec_tun_protect_t *
 122 ipsec_tun_protect_from_const_base (const adj_delegate_t * ad)
 123 {
 124   if (ad == NULL)
 125     return (NULL);
 126   return (pool_elt_at_index (ipsec_tun_protect_pool, ad->ad_index));
 127 }
 128
 129 static u32
 130 ipsec_tun_protect_get_adj_next (vnet_link_t linkt,
 131                                 const ipsec_tun_protect_t * itp)
 132 {
 133   ipsec_main_t *im;
 134   ipsec_sa_t *sa;
 135   bool is_ip4;
 136   u32 next;
 137
 138
 139   if (itp->itp_flags & IPSEC_PROTECT_ITF)
 140     is_ip4 = linkt == VNET_LINK_IP4;
 141   else
 142     is_ip4 = ip46_address_is_ip4 (&itp->itp_tun.src);
 143
 144   sa = ipsec_sa_get (itp->itp_out_sa);
 145   im = &ipsec_main;
 146
 147   if (sa->crypto_alg == IPSEC_CRYPTO_ALG_NONE &&
 148       sa->integ_alg == IPSEC_INTEG_ALG_NONE)
 149     next = (is_ip4 ?
 150             im->esp4_no_crypto_tun_node_index :
 151             im->esp6_no_crypto_tun_node_index);
 152   else if (itp->itp_flags & IPSEC_PROTECT_L2)
 153     next = (is_ip4 ?
 154             im->esp4_encrypt_l2_tun_node_index :
 155             im->esp6_encrypt_l2_tun_node_index);
 156   else
 157     next = (is_ip4 ?
 158             im->esp4_encrypt_tun_node_index :
 159             im->esp6_encrypt_tun_node_index);
 160
 161   return (next);
 162 }
 163
 164 static void
 165 ipsec_tun_protect_add_adj (adj_index_t ai, const ipsec_tun_protect_t * itp)
 166 {
 167   vec_validate_init_empty (ipsec_tun_protect_sa_by_adj_index, ai,
 168                            INDEX_INVALID);
 169
 170   if (NULL == itp)
 171     {
 172       ipsec_tun_protect_sa_by_adj_index[ai] = INDEX_INVALID;
 173       adj_nbr_midchain_reset_next_node (ai);
 174     }
 175   else
 176     {
 177       ipsec_tun_protect_sa_by_adj_index[ai] = itp->itp_out_sa;
 178       adj_nbr_midchain_update_next_node
 179         (ai, ipsec_tun_protect_get_adj_next (adj_get_link_type (ai), itp));
 180     }
 181 }
 182
 183 static index_t
 184 ipsec_tun_protect_find (u32 sw_if_index, const ip_address_t * nh)
 185 {
 186   ipsec_tun_protect_itf_db_t *idi;
 187   uword *p;
 188
 189   if (vec_len (itp_db.id_itf) <= sw_if_index)
 190     return INDEX_INVALID;
 191
 192   if (vnet_sw_interface_is_p2p (vnet_get_main (), sw_if_index))
 193     return (itp_db.id_itf[sw_if_index].id_itp);
 194
 195   idi = &itp_db.id_itf[sw_if_index];
 196   p = hash_get_mem (idi->id_hash, nh);
 197
 198   if (NULL == p)
 199     {
 200       return INDEX_INVALID;
 201     }
 202   return (p[0]);
 203 }
 204
 205 static void
 206 ipsec_tun_protect_rx_db_add (ipsec_main_t * im,
 207                              const ipsec_tun_protect_t * itp)
 208 {
 209   const ipsec_sa_t *sa;
 210   u32 sai;
 211
 212   if (ip46_address_is_zero (&itp->itp_crypto.dst))
 213     return;
 214
 215   /* *INDENT-OFF* */
 216   FOR_EACH_IPSEC_PROTECT_INPUT_SAI(itp, sai,
 217   ({
 218       sa = ipsec_sa_get (sai);
 219
 220       ipsec_tun_lkup_result_t res = {
 221         .tun_index = itp - ipsec_tun_protect_pool,
 222         .sa_index = sai,
 223       };
 224
 225       /*
 226        * The key is formed from the tunnel's destination
 227        * as the packet lookup is done from the packet's source
 228        */
 229       if (ip46_address_is_ip4 (&itp->itp_crypto.dst))
 230         {
 231           ipsec4_tunnel_key_t key = {
 232             .remote_ip = itp->itp_crypto.dst.ip4,
 233             .spi = clib_host_to_net_u32 (sa->spi),
 234           };
 235           hash_set (im->tun4_protect_by_key, key.as_u64, res.as_u64);
 236           ipsec_tun_register_nodes(AF_IP4);
 237         }
 238       else
 239         {
 240           ipsec6_tunnel_key_t key = {
 241             .remote_ip = itp->itp_crypto.dst.ip6,
 242             .spi = clib_host_to_net_u32 (sa->spi),
 243           };
 244           hash_set_mem_alloc (&im->tun6_protect_by_key, &key, res.as_u64);
 245           ipsec_tun_register_nodes(AF_IP6);
 246         }
 247   }))
 248   /* *INDENT-ON* */
 249 }
 250
 251 static adj_walk_rc_t
 252 ipsec_tun_protect_adj_add (adj_index_t ai, void *arg)
 253 {
 254   ipsec_tun_protect_t *itp = arg;
 255   adj_delegate_add (adj_get (ai), ipsec_tun_adj_delegate_type,
 256                     itp - ipsec_tun_protect_pool);
 257   ipsec_tun_protect_add_adj (ai, itp);
 258
 259   if (itp->itp_flags & IPSEC_PROTECT_ITF)
 260     ipsec_itf_adj_stack (ai, itp->itp_out_sa);
 261
 262   return (ADJ_WALK_RC_CONTINUE);
 263 }
 264
 265 static void
 266 ipsec_tun_protect_tx_db_add (ipsec_tun_protect_t * itp)
 267 {
 268   /*
 269    * add the delegate to the adj
 270    */
 271   ipsec_tun_protect_itf_db_t *idi;
 272   fib_protocol_t nh_proto;
 273   ip46_address_t nh;
 274
 275   vec_validate_init_empty (itp_db.id_itf,
 276                            itp->itp_sw_if_index,
 277                            IPSEC_TUN_PROTECT_DEFAULT_DB_ENTRY);
 278
 279   idi = &itp_db.id_itf[itp->itp_sw_if_index];
 280
 281   if (vnet_sw_interface_is_p2p (vnet_get_main (), itp->itp_sw_if_index))
 282     {
 283       if (INDEX_INVALID == idi->id_itp)
 284         {
 285           // ipsec_tun_protect_feature_set (itp, 1);
 286         }
 287       idi->id_itp = itp - ipsec_tun_protect_pool;
 288
 289       FOR_EACH_FIB_IP_PROTOCOL (nh_proto)
 290         adj_nbr_walk (itp->itp_sw_if_index,
 291                       nh_proto, ipsec_tun_protect_adj_add, itp);
 292     }
 293   else
 294     {
 295       if (NULL == idi->id_hash)
 296         {
 297           idi->id_hash =
 298             hash_create_mem (0, sizeof (ip_address_t), sizeof (uword));
 299           /*
 300            * enable the encrypt feature for egress if this is the first addition
 301            * on this interface
 302            */
 303           // ipsec_tun_protect_feature_set (itp, 1);
 304         }
 305
 306       hash_set_mem (idi->id_hash, itp->itp_key, itp - ipsec_tun_protect_pool);
 307
 308       /*
 309        * walk all the adjs with the same nh on this interface
 310        * to associate them with this protection
 311        */
 312       nh_proto = ip_address_to_46 (itp->itp_key, &nh);
 313
 314       adj_nbr_walk_nh (itp->itp_sw_if_index,
 315                        nh_proto, &nh, ipsec_tun_protect_adj_add, itp);
 316
 317       ipsec_tun_register_nodes (FIB_PROTOCOL_IP6 == nh_proto ?
 318                                 AF_IP6 : AF_IP4);
 319     }
 320 }
 321
 322 static void
 323 ipsec_tun_protect_rx_db_remove (ipsec_main_t * im,
 324                                 const ipsec_tun_protect_t * itp)
 325 {
 326   const ipsec_sa_t *sa;
 327
 328   /* *INDENT-OFF* */
 329   FOR_EACH_IPSEC_PROTECT_INPUT_SA(itp, sa,
 330   ({
 331     if (ip46_address_is_ip4 (&itp->itp_crypto.dst))
 332       {
 333         ipsec4_tunnel_key_t key = {
 334           .remote_ip = itp->itp_crypto.dst.ip4,
 335           .spi = clib_host_to_net_u32 (sa->spi),
 336         };
 337         if (hash_get(im->tun4_protect_by_key, key.as_u64))
 338           {
 339             hash_unset (im->tun4_protect_by_key, key.as_u64);
 340             ipsec_tun_unregister_nodes(AF_IP4);
 341           }
 342       }
 343     else
 344       {
 345         ipsec6_tunnel_key_t key = {
 346           .remote_ip = itp->itp_crypto.dst.ip6,
 347           .spi = clib_host_to_net_u32 (sa->spi),
 348         };
 349         if (hash_get_mem(im->tun6_protect_by_key, &key))
 350           {
 351             hash_unset_mem_free (&im->tun6_protect_by_key, &key);
 352             ipsec_tun_unregister_nodes(AF_IP6);
 353           }
 354       }
 355   }));
 356   /* *INDENT-ON* */
 357 }
 358
 359 static adj_walk_rc_t
 360 ipsec_tun_protect_adj_remove (adj_index_t ai, void *arg)
 361 {
 362   ipsec_tun_protect_t *itp = arg;
 363
 364   adj_delegate_remove (ai, ipsec_tun_adj_delegate_type);
 365   ipsec_tun_protect_add_adj (ai, NULL);
 366
 367   if (itp->itp_flags & IPSEC_PROTECT_ITF)
 368     ipsec_itf_adj_unstack (ai);
 369
 370   return (ADJ_WALK_RC_CONTINUE);
 371 }
 372
 373 static void
 374 ipsec_tun_protect_tx_db_remove (ipsec_tun_protect_t * itp)
 375 {
 376   ipsec_tun_protect_itf_db_t *idi;
 377   fib_protocol_t nh_proto;
 378   ip46_address_t nh;
 379
 380   nh_proto = ip_address_to_46 (itp->itp_key, &nh);
 381   idi = &itp_db.id_itf[itp->itp_sw_if_index];
 382
 383   if (vnet_sw_interface_is_p2p (vnet_get_main (), itp->itp_sw_if_index))
 384     {
 385       // ipsec_tun_protect_feature_set (itp, 0);
 386       idi->id_itp = INDEX_INVALID;
 387
 388       FOR_EACH_FIB_IP_PROTOCOL (nh_proto)
 389         adj_nbr_walk (itp->itp_sw_if_index,
 390                       nh_proto, ipsec_tun_protect_adj_remove, itp);
 391     }
 392   else
 393     {
 394       adj_nbr_walk_nh (itp->itp_sw_if_index,
 395                        nh_proto, &nh, ipsec_tun_protect_adj_remove, itp);
 396
 397       hash_unset_mem (idi->id_hash, itp->itp_key);
 398
 399       if (0 == hash_elts (idi->id_hash))
 400         {
 401           // ipsec_tun_protect_feature_set (itp, 0);
 402           hash_free (idi->id_hash);
 403           idi->id_hash = NULL;
 404         }
 405       ipsec_tun_unregister_nodes (FIB_PROTOCOL_IP6 == nh_proto ?
 406                                   AF_IP6 : AF_IP4);
 407     }
 408 }
 409
 410 static void
 411 ipsec_tun_protect_set_crypto_addr (ipsec_tun_protect_t * itp)
 412 {
 413   ipsec_sa_t *sa;
 414
 415   /* *INDENT-OFF* */
 416   FOR_EACH_IPSEC_PROTECT_INPUT_SA(itp, sa,
 417   ({
 418     if (ipsec_sa_is_set_IS_TUNNEL (sa))
 419       {
 420         itp->itp_crypto.src = sa->tunnel_dst_addr;
 421         itp->itp_crypto.dst = sa->tunnel_src_addr;
 422         if (!(itp->itp_flags & IPSEC_PROTECT_ITF))
 423           {
 424             ipsec_sa_set_IS_PROTECT (sa);
 425             itp->itp_flags |= IPSEC_PROTECT_ENCAPED;
 426           }
 427       }
 428     else
 429       {
 430         itp->itp_crypto.src = itp->itp_tun.src;
 431         itp->itp_crypto.dst = itp->itp_tun.dst;
 432         itp->itp_flags &= ~IPSEC_PROTECT_ENCAPED;
 433       }
 434   }));
 435   /* *INDENT-ON* */
 436 }
 437
 438 static void
 439 ipsec_tun_protect_config (ipsec_main_t * im,
 440                           ipsec_tun_protect_t * itp, u32 sa_out, u32 * sas_in)
 441 {
 442   index_t sai;
 443   u32 ii;
 444
 445   itp->itp_n_sa_in = vec_len (sas_in);
 446   for (ii = 0; ii < itp->itp_n_sa_in; ii++)
 447     itp->itp_in_sas[ii] = sas_in[ii];
 448   itp->itp_out_sa = sa_out;
 449
 450   ipsec_sa_lock (itp->itp_out_sa);
 451
 452   /* *INDENT-OFF* */
 453   FOR_EACH_IPSEC_PROTECT_INPUT_SAI(itp, sai,
 454   ({
 455     ipsec_sa_lock(sai);
 456   }));
 457   ipsec_tun_protect_set_crypto_addr(itp);
 458   /* *INDENT-ON* */
 459
 460   /*
 461    * add to the DB against each SA
 462    */
 463   ipsec_tun_protect_rx_db_add (im, itp);
 464   ipsec_tun_protect_tx_db_add (itp);
 465
 466   ITP_DBG (itp, "configured");
 467 }
 468
 469 static void
 470 ipsec_tun_protect_unconfig (ipsec_main_t * im, ipsec_tun_protect_t * itp)
 471 {
 472   ipsec_sa_t *sa;
 473   index_t sai;
 474
 475   /* *INDENT-OFF* */
 476   FOR_EACH_IPSEC_PROTECT_INPUT_SA(itp, sa,
 477   ({
 478     ipsec_sa_unset_IS_PROTECT (sa);
 479   }));
 480
 481   ipsec_tun_protect_rx_db_remove (im, itp);
 482   ipsec_tun_protect_tx_db_remove (itp);
 483
 484   ipsec_sa_unlock(itp->itp_out_sa);
 485
 486   FOR_EACH_IPSEC_PROTECT_INPUT_SAI(itp, sai,
 487   ({
 488     ipsec_sa_unlock(sai);
 489   }));
 490   /* *INDENT-ON* */
 491   ITP_DBG (itp, "unconfigured");
 492 }
 493
 494 int
 495 ipsec_tun_protect_update_one (u32 sw_if_index,
 496                               const ip_address_t * nh, u32 sa_out, u32 sa_in)
 497 {
 498   u32 *sas_in = NULL;
 499   int rv;
 500
 501   vec_add1 (sas_in, sa_in);
 502   rv = ipsec_tun_protect_update (sw_if_index, nh, sa_out, sas_in);
 503
 504   return (rv);
 505 }
 506
 507 int
 508 ipsec_tun_protect_update_out (u32 sw_if_index,
 509                               const ip_address_t * nh, u32 sa_out)
 510 {
 511   u32 itpi, *sas_in, sai, *saip;
 512   ipsec_tun_protect_t *itp;
 513   ipsec_main_t *im;
 514   int rv;
 515
 516   sas_in = NULL;
 517   rv = 0;
 518   im = &ipsec_main;
 519
 520   itpi = ipsec_tun_protect_find (sw_if_index, nh);
 521
 522   if (INDEX_INVALID == itpi)
 523     {
 524       return (VNET_API_ERROR_INVALID_INTERFACE);
 525     }
 526
 527   itp = pool_elt_at_index (ipsec_tun_protect_pool, itpi);
 528
 529   /* *INDENT-OFF* */
 530   FOR_EACH_IPSEC_PROTECT_INPUT_SAI (itp, sai,
 531   ({
 532     ipsec_sa_lock (sai);
 533     vec_add1 (sas_in, sai);
 534   }));
 535   /* *INDENT-ON* */
 536
 537   sa_out = ipsec_sa_find_and_lock (sa_out);
 538
 539   if (~0 == sa_out)
 540     {
 541       rv = VNET_API_ERROR_INVALID_VALUE;
 542       goto out;
 543     }
 544
 545   ipsec_tun_protect_unconfig (im, itp);
 546   ipsec_tun_protect_config (im, itp, sa_out, sas_in);
 547
 548   ipsec_sa_unlock (sa_out);
 549   vec_foreach (saip, sas_in) ipsec_sa_unlock (*saip);
 550
 551 out:
 552   vec_free (sas_in);
 553   return (rv);
 554 }
 555
 556 int
 557 ipsec_tun_protect_update_in (u32 sw_if_index,
 558                              const ip_address_t * nh, u32 sa_in)
 559 {
 560   u32 itpi, *sas_in, sa_out;
 561   ipsec_tun_protect_t *itp;
 562   ipsec_main_t *im;
 563   int rv;
 564
 565   sas_in = NULL;
 566   rv = 0;
 567   im = &ipsec_main;
 568   itpi = ipsec_tun_protect_find (sw_if_index, nh);
 569
 570   if (INDEX_INVALID == itpi)
 571     {
 572       return (VNET_API_ERROR_INVALID_INTERFACE);
 573     }
 574
 575   sa_in = ipsec_sa_find_and_lock (sa_in);
 576
 577   if (~0 == sa_in)
 578     {
 579       rv = VNET_API_ERROR_INVALID_VALUE;
 580       goto out;
 581     }
 582   vec_add1 (sas_in, sa_in);
 583
 584   itp = pool_elt_at_index (ipsec_tun_protect_pool, itpi);
 585   sa_out = itp->itp_out_sa;
 586
 587   ipsec_sa_lock (sa_out);
 588
 589   ipsec_tun_protect_unconfig (im, itp);
 590   ipsec_tun_protect_config (im, itp, sa_out, sas_in);
 591
 592   ipsec_sa_unlock (sa_out);
 593   ipsec_sa_unlock (sa_in);
 594 out:
 595   vec_free (sas_in);
 596   return (rv);
 597 }
 598
 599 static void
 600 ipsec_tun_protect_update_from_teib (ipsec_tun_protect_t * itp,
 601                                     const teib_entry_t * ne)
 602 {
 603   if (NULL != ne)
 604     {
 605       const fib_prefix_t *pfx;
 606
 607       pfx = teib_entry_get_nh (ne);
 608
 609       ip46_address_copy (&itp->itp_tun.dst, &pfx->fp_addr);
 610     }
 611   else
 612     ip46_address_reset (&itp->itp_tun.dst);
 613 }
 614
 615 int
 616 ipsec_tun_protect_update (u32 sw_if_index,
 617                           const ip_address_t * nh, u32 sa_out, u32 * sas_in)
 618 {
 619   ipsec_tun_protect_t *itp;
 620   u32 itpi, ii, *saip;
 621   ipsec_main_t *im;
 622   int rv;
 623
 624   ITP_DBG2 ("update: %U/%U",
 625             format_vnet_sw_if_index_name, vnet_get_main (), sw_if_index,
 626             format_ip_address, nh);
 627
 628   if (vec_len (sas_in) > ITP_MAX_N_SA_IN)
 629     {
 630       rv = VNET_API_ERROR_LIMIT_EXCEEDED;
 631       goto out;
 632     }
 633
 634   rv = 0;
 635   im = &ipsec_main;
 636   if (NULL == nh)
 637     nh = &IP_ADDR_ALL_0;
 638   itpi = ipsec_tun_protect_find (sw_if_index, nh);
 639
 640   vec_foreach_index (ii, sas_in)
 641   {
 642     sas_in[ii] = ipsec_sa_find_and_lock (sas_in[ii]);
 643     if (~0 == sas_in[ii])
 644       {
 645         rv = VNET_API_ERROR_INVALID_VALUE;
 646         goto out;
 647       }
 648   }
 649
 650   sa_out = ipsec_sa_find_and_lock (sa_out);
 651
 652   if (~0 == sa_out)
 653     {
 654       rv = VNET_API_ERROR_INVALID_VALUE;
 655       goto out;
 656     }
 657
 658   if (INDEX_INVALID == itpi)
 659     {
 660       vnet_device_class_t *dev_class;
 661       vnet_hw_interface_t *hi;
 662       vnet_main_t *vnm;
 663       u8 is_l2;
 664
 665       vnm = vnet_get_main ();
 666       hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
 667       dev_class = vnet_get_device_class (vnm, hi->dev_class_index);
 668
 669       if (NULL == dev_class->ip_tun_desc)
 670         {
 671           rv = VNET_API_ERROR_INVALID_SW_IF_INDEX;
 672           goto out;
 673         }
 674
 675       pool_get_zero (ipsec_tun_protect_pool, itp);
 676
 677       itp->itp_sw_if_index = sw_if_index;
 678       itp->itp_ai = ADJ_INDEX_INVALID;
 679
 680       itp->itp_n_sa_in = vec_len (sas_in);
 681       for (ii = 0; ii < itp->itp_n_sa_in; ii++)
 682         itp->itp_in_sas[ii] = sas_in[ii];
 683       itp->itp_out_sa = sa_out;
 684
 685       itp->itp_key = clib_mem_alloc (sizeof (*itp->itp_key));
 686       ip_address_copy (itp->itp_key, nh);
 687
 688       rv = dev_class->ip_tun_desc (sw_if_index,
 689                                    &itp->itp_tun.src,
 690                                    &itp->itp_tun.dst, &is_l2);
 691
 692       if (rv)
 693         goto out;
 694
 695       if (ip46_address_is_zero (&itp->itp_tun.src))
 696         {
 697           /* must be one of thos pesky ipsec interfaces that has no encap.
 698            * the encap then MUST comefrom the tunnel mode SA.
 699            */
 700           ipsec_sa_t *sa;
 701
 702           sa = ipsec_sa_get (itp->itp_out_sa);
 703
 704           if (!ipsec_sa_is_set_IS_TUNNEL (sa))
 705             {
 706               rv = VNET_API_ERROR_INVALID_DST_ADDRESS;
 707               goto out;
 708             }
 709
 710           itp->itp_flags |= IPSEC_PROTECT_ITF;
 711         }
 712       else if (ip46_address_is_zero (&itp->itp_tun.dst))
 713         {
 714           /* tunnel has no destination address, presumably because it's p2mp
 715              in which case we use the nh that this is protection for */
 716           ip46_address_t peer;
 717
 718           ip_address_to_46 (nh, &peer);
 719
 720           ipsec_tun_protect_update_from_teib
 721             (itp, teib_entry_find (sw_if_index, &peer));
 722         }
 723
 724       if (is_l2)
 725         itp->itp_flags |= IPSEC_PROTECT_L2;
 726
 727       /*
 728        * add to the tunnel DB for ingress
 729        *  - if the SA is in trasnport mode, then the packates will arrive
 730        *    with the IP src,dst of the protected tunnel, in which case we can
 731        *    simply strip the IP header and hand the payload to the protocol
 732        *    appropriate input handler
 733        *  - if the SA is in tunnel mode then there are two IP headers present
 734        *    one for the crytpo tunnel endpoints (described in the SA) and one
 735        *    for the tunnel endpoints. The outer IP headers in the srriving
 736        *    packets will have the crypto endpoints. So the DB needs to contain
 737        *    the crpto endpoint. Once the crypto header is stripped, revealing,
 738        *    the tunnel-IP we have 2 choices:
 739        *     1) do a tunnel lookup based on the revealed header
 740        *     2) skip the tunnel lookup and assume that the packet matches the
 741        *        one that is protected here.
 742        *    If we did 1) then we would allow our peer to use the SA for tunnel
 743        *    X to inject traffic onto tunnel Y, this is not good. If we do 2)
 744        *    then we don't verify that the peer is indeed using SA for tunnel
 745        *    X and addressing tunnel X. So we take a compromise, once the SA
 746        *    matches to tunnel X we veriy that the inner IP matches the value
 747        *    of the tunnel we are protecting, else it's dropped.
 748        */
 749       ipsec_tun_protect_config (im, itp, sa_out, sas_in);
 750     }
 751   else
 752     {
 753       /* updating SAs only */
 754       itp = pool_elt_at_index (ipsec_tun_protect_pool, itpi);
 755
 756       ipsec_tun_protect_unconfig (im, itp);
 757       ipsec_tun_protect_config (im, itp, sa_out, sas_in);
 758     }
 759
 760   ipsec_sa_unlock (sa_out);
 761   vec_foreach (saip, sas_in) ipsec_sa_unlock (*saip);
 762   vec_free (sas_in);
 763
 764 out:
 765   return (rv);
 766 }
 767
 768 int
 769 ipsec_tun_protect_del (u32 sw_if_index, const ip_address_t * nh)
 770 {
 771   ipsec_tun_protect_t *itp;
 772   ipsec_main_t *im;
 773   index_t itpi;
 774
 775   ITP_DBG2 ("delete: %U/%U",
 776             format_vnet_sw_if_index_name, vnet_get_main (), sw_if_index,
 777             format_ip_address, nh);
 778
 779   im = &ipsec_main;
 780   if (NULL == nh)
 781     nh = &IP_ADDR_ALL_0;
 782
 783   itpi = ipsec_tun_protect_find (sw_if_index, nh);
 784
 785   if (INDEX_INVALID == itpi)
 786     return (VNET_API_ERROR_NO_SUCH_ENTRY);
 787
 788   itp = ipsec_tun_protect_get (itpi);
 789   ipsec_tun_protect_unconfig (im, itp);
 790
 791   if (ADJ_INDEX_INVALID != itp->itp_ai)
 792     adj_unlock (itp->itp_ai);
 793
 794   clib_mem_free (itp->itp_key);
 795   pool_put (ipsec_tun_protect_pool, itp);
 796
 797   return (0);
 798 }
 799
 800 void
 801 ipsec_tun_protect_walk (ipsec_tun_protect_walk_cb_t fn, void *ctx)
 802 {
 803   index_t itpi;
 804
 805   /* *INDENT-OFF* */
 806   pool_foreach_index(itpi, ipsec_tun_protect_pool,
 807   ({
 808     fn (itpi, ctx);
 809   }));
 810   /* *INDENT-ON* */
 811 }
 812
 813 void
 814 ipsec_tun_protect_walk_itf (u32 sw_if_index,
 815                             ipsec_tun_protect_walk_cb_t fn, void *ctx)
 816 {
 817   ipsec_tun_protect_itf_db_t *idi;
 818   ip_address_t *key;
 819   index_t itpi;
 820
 821   if (vec_len (itp_db.id_itf) <= sw_if_index)
 822     return;
 823
 824   idi = &itp_db.id_itf[sw_if_index];
 825
 826   /* *INDENT-OFF* */
 827   hash_foreach(key, itpi, idi->id_hash,
 828   ({
 829     fn (itpi, ctx);
 830   }));
 831   /* *INDENT-ON* */
 832   if (INDEX_INVALID != idi->id_itp)
 833     fn (idi->id_itp, ctx);
 834 }
 835
 836 static void
 837 ipsec_tun_protect_adj_delegate_adj_deleted (adj_delegate_t * ad)
 838 {
 839   /* remove our delegate */
 840   ipsec_tun_protect_add_adj (ad->ad_adj_index, NULL);
 841   adj_delegate_remove (ad->ad_adj_index, ipsec_tun_adj_delegate_type);
 842 }
 843
 844 static void
 845 ipsec_tun_protect_adj_delegate_adj_modified (adj_delegate_t * ad)
 846 {
 847   ipsec_tun_protect_add_adj (ad->ad_adj_index,
 848                              ipsec_tun_protect_get (ad->ad_index));
 849 }
 850
 851 static void
 852 ipsec_tun_protect_adj_delegate_adj_created (adj_index_t ai)
 853 {
 854   /* add our delegate if there is protection for this neighbour */
 855   ip_address_t ip = IP_ADDRESS_V4_ALL_0S;
 856   ip_adjacency_t *adj;
 857   index_t itpi;
 858
 859   if (!adj_is_midchain (ai))
 860     return;
 861
 862   adj = adj_get (ai);
 863
 864   ip_address_from_46 (&adj->sub_type.midchain.next_hop,
 865                       adj->ia_nh_proto, &ip);
 866
 867   itpi = ipsec_tun_protect_find (adj->rewrite_header.sw_if_index, &ip);
 868
 869   if (INDEX_INVALID != itpi)
 870     ipsec_tun_protect_adj_add (ai, ipsec_tun_protect_get (itpi));
 871 }
 872
 873 static u8 *
 874 ipsec_tun_protect_adj_delegate_format (const adj_delegate_t * aed, u8 * s)
 875 {
 876   const ipsec_tun_protect_t *itp;
 877
 878   itp = ipsec_tun_protect_from_const_base (aed);
 879   s = format (s, "ipsec-tun-protect:\n%U", format_ipsec_tun_protect, itp);
 880
 881   return (s);
 882 }
 883
 884 static void
 885 ipsec_tun_teib_entry_added (const teib_entry_t * ne)
 886 {
 887   const ip46_address_t *peer46;
 888   ipsec_tun_protect_t *itp;
 889   ip_address_t peer;
 890   index_t itpi;
 891
 892   peer46 = teib_entry_get_peer (ne);
 893   ip_address_from_46 (peer46,
 894                       (ip46_address_is_ip4 (peer46) ?
 895                        FIB_PROTOCOL_IP4 : FIB_PROTOCOL_IP6), &peer);
 896
 897   itpi = ipsec_tun_protect_find (teib_entry_get_sw_if_index (ne), &peer);
 898
 899   if (INDEX_INVALID == itpi)
 900     return;
 901
 902   itp = ipsec_tun_protect_get (itpi);
 903   ipsec_tun_protect_rx_db_remove (&ipsec_main, itp);
 904   ipsec_tun_protect_update_from_teib (itp, ne);
 905   ipsec_tun_protect_set_crypto_addr (itp);
 906   ipsec_tun_protect_rx_db_add (&ipsec_main, itp);
 907
 908   ITP_DBG (itp, "teib-added");
 909 }
 910
 911 static void
 912 ipsec_tun_teib_entry_deleted (const teib_entry_t * ne)
 913 {
 914   const ip46_address_t *peer46;
 915   ipsec_tun_protect_t *itp;
 916   ip_address_t peer;
 917   index_t itpi;
 918
 919   peer46 = teib_entry_get_peer (ne);
 920   ip_address_from_46 (peer46,
 921                       (ip46_address_is_ip4 (peer46) ?
 922                        FIB_PROTOCOL_IP4 : FIB_PROTOCOL_IP6), &peer);
 923
 924   itpi = ipsec_tun_protect_find (teib_entry_get_sw_if_index (ne), &peer);
 925
 926   if (INDEX_INVALID == itpi)
 927     return;
 928
 929   itp = ipsec_tun_protect_get (itpi);
 930   ipsec_tun_protect_rx_db_remove (&ipsec_main, itp);
 931   ipsec_tun_protect_update_from_teib (itp, NULL);
 932   ipsec_tun_protect_set_crypto_addr (itp);
 933
 934   ITP_DBG (itp, "teib-removed");
 935 }
 936
 937 /**
 938  * VFT registered with the adjacency delegate
 939  */
 940 const static adj_delegate_vft_t ipsec_tun_adj_delegate_vft = {
 941   .adv_adj_deleted = ipsec_tun_protect_adj_delegate_adj_deleted,
 942   .adv_adj_created = ipsec_tun_protect_adj_delegate_adj_created,
 943   .adv_adj_modified = ipsec_tun_protect_adj_delegate_adj_modified,
 944   .adv_format = ipsec_tun_protect_adj_delegate_format,
 945 };
 946
 947 const static teib_vft_t ipsec_tun_teib_vft = {
 948   .nv_added = ipsec_tun_teib_entry_added,
 949   .nv_deleted = ipsec_tun_teib_entry_deleted,
 950 };
 951
 952
 953 clib_error_t *
 954 ipsec_tunnel_protect_init (vlib_main_t * vm)
 955 {
 956   ipsec_main_t *im;
 957
 958   im = &ipsec_main;
 959   im->tun6_protect_by_key = hash_create_mem (0,
 960                                              sizeof (ipsec6_tunnel_key_t),
 961                                              sizeof (u64));
 962   im->tun4_protect_by_key = hash_create (0, sizeof (u64));
 963
 964   /* set up feature nodes to drop outbound packets with no crypto alg set */
 965   im->esp4_no_crypto_tun_node_index =
 966     vlib_get_node_by_name (vm, (u8 *) "esp4-no-crypto")->index;
 967   im->esp6_no_crypto_tun_node_index =
 968     vlib_get_node_by_name (vm, (u8 *) "esp6-no-crypto")->index;
 969   im->esp6_encrypt_l2_tun_node_index =
 970     vlib_get_node_by_name (vm, (u8 *) "esp6-encrypt-tun")->index;
 971   im->esp4_encrypt_l2_tun_node_index =
 972     vlib_get_node_by_name (vm, (u8 *) "esp4-encrypt-tun")->index;
 973
 974   ipsec_tun_adj_delegate_type =
 975     adj_delegate_register_new_type (&ipsec_tun_adj_delegate_vft);
 976
 977   ipsec_tun_protect_logger = vlib_log_register_class ("ipsec", "tun");
 978
 979   teib_register (&ipsec_tun_teib_vft);
 980
 981   return 0;
 982 }
 983
 984 VLIB_INIT_FUNCTION (ipsec_tunnel_protect_init);
 985
 986
 987 /*
 988  * fd.io coding-style-patch-verification: ON
 989  *
 990  * Local Variables:
 991  * eval: (c-set-style "gnu")
 992  * End:
 993  */