1 /* $FreeBSD$ */ 2 /* $KAME: key.c,v 1.191 2001/06/27 10:46:49 sakane Exp $ */ 3 4 /*- 5 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. Neither the name of the project nor the names of its contributors 17 * may be used to endorse or promote products derived from this software 18 * without specific prior written permission. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30 * SUCH DAMAGE. 31 */ 32 33 /* 34 * This code is referd to RFC 2367 35 */ 36 37 #include "opt_inet.h" 38 #include "opt_inet6.h" 39 #include "opt_ipsec.h" 40 41 #include <sys/types.h> 42 #include <sys/param.h> 43 #include <sys/systm.h> 44 #include <sys/kernel.h> 45 #include <sys/lock.h> 46 #include <sys/mutex.h> 47 #include <sys/mbuf.h> 48 #include <sys/domain.h> 49 #include <sys/protosw.h> 50 #include <sys/malloc.h> 51 #include <sys/rmlock.h> 52 #include <sys/socket.h> 53 #include <sys/socketvar.h> 54 #include <sys/sysctl.h> 55 #include <sys/errno.h> 56 #include <sys/proc.h> 57 #include <sys/queue.h> 58 #include <sys/refcount.h> 59 #include <sys/syslog.h> 60 61 #include <net/if.h> 62 #include <net/if_var.h> 63 #include <net/vnet.h> 64 #include <net/raw_cb.h> 65 66 #include <netinet/in.h> 67 #include <netinet/in_systm.h> 68 #include <netinet/ip.h> 69 #include <netinet/in_var.h> 70 71 #ifdef INET6 72 #include <netinet/ip6.h> 73 #include <netinet6/in6_var.h> 74 #include <netinet6/ip6_var.h> 75 #endif /* INET6 */ 76 77 #if defined(INET) || defined(INET6) 78 #include <netinet/in_pcb.h> 79 #endif 80 #ifdef INET6 81 #include <netinet6/in6_pcb.h> 82 #endif /* INET6 */ 83 84 #include <net/pfkeyv2.h> 85 #include <netipsec/keydb.h> 86 #include <netipsec/key.h> 87 #include <netipsec/keysock.h> 88 #include <netipsec/key_debug.h> 89 90 #include <netipsec/ipsec.h> 91 #ifdef INET6 92 #include <netipsec/ipsec6.h> 93 #endif 94 95 #include <netipsec/xform.h> 96 97 #include <machine/stdarg.h> 98 99 /* randomness */ 100 #include <sys/random.h> 101 102 #define FULLMASK 0xff 103 #define _BITS(bytes) ((bytes) << 3) 104 105 /* 106 * Note on SA reference counting: 107 * - SAs that are not in DEAD state will have (total external reference + 1) 108 * following value in reference count field. they cannot be freed and are 109 * referenced from SA header. 110 * - SAs that are in DEAD state will have (total external reference) 111 * in reference count field. they are ready to be freed. reference from 112 * SA header will be removed in key_delsav(), when the reference count 113 * field hits 0 (= no external reference other than from SA header. 114 */ 115 116 VNET_DEFINE(u_int32_t, key_debug_level) = 0; 117 static VNET_DEFINE(u_int, key_spi_trycnt) = 1000; 118 static VNET_DEFINE(u_int32_t, key_spi_minval) = 0x100; 119 static VNET_DEFINE(u_int32_t, key_spi_maxval) = 0x0fffffff; /* XXX */ 120 static VNET_DEFINE(u_int32_t, policy_id) = 0; 121 /*interval to initialize randseed,1(m)*/ 122 static VNET_DEFINE(u_int, key_int_random) = 60; 123 /* interval to expire acquiring, 30(s)*/ 124 static VNET_DEFINE(u_int, key_larval_lifetime) = 30; 125 /* counter for blocking SADB_ACQUIRE.*/ 126 static VNET_DEFINE(int, key_blockacq_count) = 10; 127 /* lifetime for blocking SADB_ACQUIRE.*/ 128 static VNET_DEFINE(int, key_blockacq_lifetime) = 20; 129 /* preferred old sa rather than new sa.*/ 130 static VNET_DEFINE(int, key_preferred_oldsa) = 1; 131 #define V_key_spi_trycnt VNET(key_spi_trycnt) 132 #define V_key_spi_minval VNET(key_spi_minval) 133 #define V_key_spi_maxval VNET(key_spi_maxval) 134 #define V_policy_id VNET(policy_id) 135 #define V_key_int_random VNET(key_int_random) 136 #define V_key_larval_lifetime VNET(key_larval_lifetime) 137 #define V_key_blockacq_count VNET(key_blockacq_count) 138 #define V_key_blockacq_lifetime VNET(key_blockacq_lifetime) 139 #define V_key_preferred_oldsa VNET(key_preferred_oldsa) 140 141 static VNET_DEFINE(u_int32_t, acq_seq) = 0; 142 #define V_acq_seq VNET(acq_seq) 143 144 /* SPD */ 145 static VNET_DEFINE(TAILQ_HEAD(_sptree, secpolicy), sptree[IPSEC_DIR_MAX]); 146 static struct rmlock sptree_lock; 147 #define V_sptree VNET(sptree) 148 #define SPTREE_LOCK_INIT() rm_init(&sptree_lock, "sptree") 149 #define SPTREE_LOCK_DESTROY() rm_destroy(&sptree_lock) 150 #define SPTREE_RLOCK_TRACKER struct rm_priotracker sptree_tracker 151 #define SPTREE_RLOCK() rm_rlock(&sptree_lock, &sptree_tracker) 152 #define SPTREE_RUNLOCK() rm_runlock(&sptree_lock, &sptree_tracker) 153 #define SPTREE_RLOCK_ASSERT() rm_assert(&sptree_lock, RA_RLOCKED) 154 #define SPTREE_WLOCK() rm_wlock(&sptree_lock) 155 #define SPTREE_WUNLOCK() rm_wunlock(&sptree_lock) 156 #define SPTREE_WLOCK_ASSERT() rm_assert(&sptree_lock, RA_WLOCKED) 157 #define SPTREE_UNLOCK_ASSERT() rm_assert(&sptree_lock, RA_UNLOCKED) 158 159 static VNET_DEFINE(LIST_HEAD(_sahtree, secashead), sahtree); /* SAD */ 160 #define V_sahtree VNET(sahtree) 161 static struct mtx sahtree_lock; 162 #define SAHTREE_LOCK_INIT() \ 163 mtx_init(&sahtree_lock, "sahtree", \ 164 "fast ipsec security association database", MTX_DEF) 165 #define SAHTREE_LOCK_DESTROY() mtx_destroy(&sahtree_lock) 166 #define SAHTREE_LOCK() mtx_lock(&sahtree_lock) 167 #define SAHTREE_UNLOCK() mtx_unlock(&sahtree_lock) 168 #define SAHTREE_LOCK_ASSERT() mtx_assert(&sahtree_lock, MA_OWNED) 169 170 /* registed list */ 171 static VNET_DEFINE(LIST_HEAD(_regtree, secreg), regtree[SADB_SATYPE_MAX + 1]); 172 #define V_regtree VNET(regtree) 173 static struct mtx regtree_lock; 174 #define REGTREE_LOCK_INIT() \ 175 mtx_init(®tree_lock, "regtree", "fast ipsec regtree", MTX_DEF) 176 #define REGTREE_LOCK_DESTROY() mtx_destroy(®tree_lock) 177 #define REGTREE_LOCK() mtx_lock(®tree_lock) 178 #define REGTREE_UNLOCK() mtx_unlock(®tree_lock) 179 #define REGTREE_LOCK_ASSERT() mtx_assert(®tree_lock, MA_OWNED) 180 181 static VNET_DEFINE(LIST_HEAD(_acqtree, secacq), acqtree); /* acquiring list */ 182 #define V_acqtree VNET(acqtree) 183 static struct mtx acq_lock; 184 #define ACQ_LOCK_INIT() \ 185 mtx_init(&acq_lock, "acqtree", "fast ipsec acquire list", MTX_DEF) 186 #define ACQ_LOCK_DESTROY() mtx_destroy(&acq_lock) 187 #define ACQ_LOCK() mtx_lock(&acq_lock) 188 #define ACQ_UNLOCK() mtx_unlock(&acq_lock) 189 #define ACQ_LOCK_ASSERT() mtx_assert(&acq_lock, MA_OWNED) 190 191 /* SP acquiring list */ 192 static VNET_DEFINE(LIST_HEAD(_spacqtree, secspacq), spacqtree); 193 #define V_spacqtree VNET(spacqtree) 194 static struct mtx spacq_lock; 195 #define SPACQ_LOCK_INIT() \ 196 mtx_init(&spacq_lock, "spacqtree", \ 197 "fast ipsec security policy acquire list", MTX_DEF) 198 #define SPACQ_LOCK_DESTROY() mtx_destroy(&spacq_lock) 199 #define SPACQ_LOCK() mtx_lock(&spacq_lock) 200 #define SPACQ_UNLOCK() mtx_unlock(&spacq_lock) 201 #define SPACQ_LOCK_ASSERT() mtx_assert(&spacq_lock, MA_OWNED) 202 203 /* search order for SAs */ 204 static const u_int saorder_state_valid_prefer_old[] = { 205 SADB_SASTATE_DYING, SADB_SASTATE_MATURE, 206 }; 207 static const u_int saorder_state_valid_prefer_new[] = { 208 SADB_SASTATE_MATURE, SADB_SASTATE_DYING, 209 }; 210 static const u_int saorder_state_alive[] = { 211 /* except DEAD */ 212 SADB_SASTATE_MATURE, SADB_SASTATE_DYING, SADB_SASTATE_LARVAL 213 }; 214 static const u_int saorder_state_any[] = { 215 SADB_SASTATE_MATURE, SADB_SASTATE_DYING, 216 SADB_SASTATE_LARVAL, SADB_SASTATE_DEAD 217 }; 218 219 static const int minsize[] = { 220 sizeof(struct sadb_msg), /* SADB_EXT_RESERVED */ 221 sizeof(struct sadb_sa), /* SADB_EXT_SA */ 222 sizeof(struct sadb_lifetime), /* SADB_EXT_LIFETIME_CURRENT */ 223 sizeof(struct sadb_lifetime), /* SADB_EXT_LIFETIME_HARD */ 224 sizeof(struct sadb_lifetime), /* SADB_EXT_LIFETIME_SOFT */ 225 sizeof(struct sadb_address), /* SADB_EXT_ADDRESS_SRC */ 226 sizeof(struct sadb_address), /* SADB_EXT_ADDRESS_DST */ 227 sizeof(struct sadb_address), /* SADB_EXT_ADDRESS_PROXY */ 228 sizeof(struct sadb_key), /* SADB_EXT_KEY_AUTH */ 229 sizeof(struct sadb_key), /* SADB_EXT_KEY_ENCRYPT */ 230 sizeof(struct sadb_ident), /* SADB_EXT_IDENTITY_SRC */ 231 sizeof(struct sadb_ident), /* SADB_EXT_IDENTITY_DST */ 232 sizeof(struct sadb_sens), /* SADB_EXT_SENSITIVITY */ 233 sizeof(struct sadb_prop), /* SADB_EXT_PROPOSAL */ 234 sizeof(struct sadb_supported), /* SADB_EXT_SUPPORTED_AUTH */ 235 sizeof(struct sadb_supported), /* SADB_EXT_SUPPORTED_ENCRYPT */ 236 sizeof(struct sadb_spirange), /* SADB_EXT_SPIRANGE */ 237 0, /* SADB_X_EXT_KMPRIVATE */ 238 sizeof(struct sadb_x_policy), /* SADB_X_EXT_POLICY */ 239 sizeof(struct sadb_x_sa2), /* SADB_X_SA2 */ 240 sizeof(struct sadb_x_nat_t_type),/* SADB_X_EXT_NAT_T_TYPE */ 241 sizeof(struct sadb_x_nat_t_port),/* SADB_X_EXT_NAT_T_SPORT */ 242 sizeof(struct sadb_x_nat_t_port),/* SADB_X_EXT_NAT_T_DPORT */ 243 sizeof(struct sadb_address), /* SADB_X_EXT_NAT_T_OAI */ 244 sizeof(struct sadb_address), /* SADB_X_EXT_NAT_T_OAR */ 245 sizeof(struct sadb_x_nat_t_frag),/* SADB_X_EXT_NAT_T_FRAG */ 246 }; 247 static const int maxsize[] = { 248 sizeof(struct sadb_msg), /* SADB_EXT_RESERVED */ 249 sizeof(struct sadb_sa), /* SADB_EXT_SA */ 250 sizeof(struct sadb_lifetime), /* SADB_EXT_LIFETIME_CURRENT */ 251 sizeof(struct sadb_lifetime), /* SADB_EXT_LIFETIME_HARD */ 252 sizeof(struct sadb_lifetime), /* SADB_EXT_LIFETIME_SOFT */ 253 0, /* SADB_EXT_ADDRESS_SRC */ 254 0, /* SADB_EXT_ADDRESS_DST */ 255 0, /* SADB_EXT_ADDRESS_PROXY */ 256 0, /* SADB_EXT_KEY_AUTH */ 257 0, /* SADB_EXT_KEY_ENCRYPT */ 258 0, /* SADB_EXT_IDENTITY_SRC */ 259 0, /* SADB_EXT_IDENTITY_DST */ 260 0, /* SADB_EXT_SENSITIVITY */ 261 0, /* SADB_EXT_PROPOSAL */ 262 0, /* SADB_EXT_SUPPORTED_AUTH */ 263 0, /* SADB_EXT_SUPPORTED_ENCRYPT */ 264 sizeof(struct sadb_spirange), /* SADB_EXT_SPIRANGE */ 265 0, /* SADB_X_EXT_KMPRIVATE */ 266 0, /* SADB_X_EXT_POLICY */ 267 sizeof(struct sadb_x_sa2), /* SADB_X_SA2 */ 268 sizeof(struct sadb_x_nat_t_type),/* SADB_X_EXT_NAT_T_TYPE */ 269 sizeof(struct sadb_x_nat_t_port),/* SADB_X_EXT_NAT_T_SPORT */ 270 sizeof(struct sadb_x_nat_t_port),/* SADB_X_EXT_NAT_T_DPORT */ 271 0, /* SADB_X_EXT_NAT_T_OAI */ 272 0, /* SADB_X_EXT_NAT_T_OAR */ 273 sizeof(struct sadb_x_nat_t_frag),/* SADB_X_EXT_NAT_T_FRAG */ 274 }; 275 276 static VNET_DEFINE(int, ipsec_esp_keymin) = 256; 277 static VNET_DEFINE(int, ipsec_esp_auth) = 0; 278 static VNET_DEFINE(int, ipsec_ah_keymin) = 128; 279 280 #define V_ipsec_esp_keymin VNET(ipsec_esp_keymin) 281 #define V_ipsec_esp_auth VNET(ipsec_esp_auth) 282 #define V_ipsec_ah_keymin VNET(ipsec_ah_keymin) 283 284 #ifdef SYSCTL_DECL 285 SYSCTL_DECL(_net_key); 286 #endif 287 288 SYSCTL_INT(_net_key, KEYCTL_DEBUG_LEVEL, debug, 289 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(key_debug_level), 0, ""); 290 291 /* max count of trial for the decision of spi value */ 292 SYSCTL_INT(_net_key, KEYCTL_SPI_TRY, spi_trycnt, 293 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(key_spi_trycnt), 0, ""); 294 295 /* minimum spi value to allocate automatically. */ 296 SYSCTL_INT(_net_key, KEYCTL_SPI_MIN_VALUE, spi_minval, 297 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(key_spi_minval), 0, ""); 298 299 /* maximun spi value to allocate automatically. */ 300 SYSCTL_INT(_net_key, KEYCTL_SPI_MAX_VALUE, spi_maxval, 301 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(key_spi_maxval), 0, ""); 302 303 /* interval to initialize randseed */ 304 SYSCTL_INT(_net_key, KEYCTL_RANDOM_INT, int_random, 305 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(key_int_random), 0, ""); 306 307 /* lifetime for larval SA */ 308 SYSCTL_INT(_net_key, KEYCTL_LARVAL_LIFETIME, larval_lifetime, 309 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(key_larval_lifetime), 0, ""); 310 311 /* counter for blocking to send SADB_ACQUIRE to IKEd */ 312 SYSCTL_INT(_net_key, KEYCTL_BLOCKACQ_COUNT, blockacq_count, 313 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(key_blockacq_count), 0, ""); 314 315 /* lifetime for blocking to send SADB_ACQUIRE to IKEd */ 316 SYSCTL_INT(_net_key, KEYCTL_BLOCKACQ_LIFETIME, blockacq_lifetime, 317 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(key_blockacq_lifetime), 0, ""); 318 319 /* ESP auth */ 320 SYSCTL_INT(_net_key, KEYCTL_ESP_AUTH, esp_auth, 321 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(ipsec_esp_auth), 0, ""); 322 323 /* minimum ESP key length */ 324 SYSCTL_INT(_net_key, KEYCTL_ESP_KEYMIN, esp_keymin, 325 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(ipsec_esp_keymin), 0, ""); 326 327 /* minimum AH key length */ 328 SYSCTL_INT(_net_key, KEYCTL_AH_KEYMIN, ah_keymin, 329 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(ipsec_ah_keymin), 0, ""); 330 331 /* perfered old SA rather than new SA */ 332 SYSCTL_INT(_net_key, KEYCTL_PREFERED_OLDSA, preferred_oldsa, 333 CTLFLAG_VNET | CTLFLAG_RW, &VNET_NAME(key_preferred_oldsa), 0, ""); 334 335 #define __LIST_CHAINED(elm) \ 336 (!((elm)->chain.le_next == NULL && (elm)->chain.le_prev == NULL)) 337 #define LIST_INSERT_TAIL(head, elm, type, field) \ 338 do {\ 339 struct type *curelm = LIST_FIRST(head); \ 340 if (curelm == NULL) {\ 341 LIST_INSERT_HEAD(head, elm, field); \ 342 } else { \ 343 while (LIST_NEXT(curelm, field)) \ 344 curelm = LIST_NEXT(curelm, field);\ 345 LIST_INSERT_AFTER(curelm, elm, field);\ 346 }\ 347 } while (0) 348 349 #define KEY_CHKSASTATE(head, sav, name) \ 350 do { \ 351 if ((head) != (sav)) { \ 352 ipseclog((LOG_DEBUG, "%s: state mismatched (TREE=%d SA=%d)\n", \ 353 (name), (head), (sav))); \ 354 continue; \ 355 } \ 356 } while (0) 357 358 #define KEY_CHKSPDIR(head, sp, name) \ 359 do { \ 360 if ((head) != (sp)) { \ 361 ipseclog((LOG_DEBUG, "%s: direction mismatched (TREE=%d SP=%d), " \ 362 "anyway continue.\n", \ 363 (name), (head), (sp))); \ 364 } \ 365 } while (0) 366 367 MALLOC_DEFINE(M_IPSEC_SA, "secasvar", "ipsec security association"); 368 MALLOC_DEFINE(M_IPSEC_SAH, "sahead", "ipsec sa head"); 369 MALLOC_DEFINE(M_IPSEC_SP, "ipsecpolicy", "ipsec security policy"); 370 MALLOC_DEFINE(M_IPSEC_SR, "ipsecrequest", "ipsec security request"); 371 MALLOC_DEFINE(M_IPSEC_MISC, "ipsec-misc", "ipsec miscellaneous"); 372 MALLOC_DEFINE(M_IPSEC_SAQ, "ipsec-saq", "ipsec sa acquire"); 373 MALLOC_DEFINE(M_IPSEC_SAR, "ipsec-reg", "ipsec sa acquire"); 374 375 /* 376 * set parameters into secpolicyindex buffer. 377 * Must allocate secpolicyindex buffer passed to this function. 378 */ 379 #define KEY_SETSECSPIDX(_dir, s, d, ps, pd, ulp, idx) \ 380 do { \ 381 bzero((idx), sizeof(struct secpolicyindex)); \ 382 (idx)->dir = (_dir); \ 383 (idx)->prefs = (ps); \ 384 (idx)->prefd = (pd); \ 385 (idx)->ul_proto = (ulp); \ 386 bcopy((s), &(idx)->src, ((const struct sockaddr *)(s))->sa_len); \ 387 bcopy((d), &(idx)->dst, ((const struct sockaddr *)(d))->sa_len); \ 388 } while (0) 389 390 /* 391 * set parameters into secasindex buffer. 392 * Must allocate secasindex buffer before calling this function. 393 */ 394 #define KEY_SETSECASIDX(p, m, r, s, d, idx) \ 395 do { \ 396 bzero((idx), sizeof(struct secasindex)); \ 397 (idx)->proto = (p); \ 398 (idx)->mode = (m); \ 399 (idx)->reqid = (r); \ 400 bcopy((s), &(idx)->src, ((const struct sockaddr *)(s))->sa_len); \ 401 bcopy((d), &(idx)->dst, ((const struct sockaddr *)(d))->sa_len); \ 402 } while (0) 403 404 /* key statistics */ 405 struct _keystat { 406 u_long getspi_count; /* the avarage of count to try to get new SPI */ 407 } keystat; 408 409 struct sadb_msghdr { 410 struct sadb_msg *msg; 411 struct sadb_ext *ext[SADB_EXT_MAX + 1]; 412 int extoff[SADB_EXT_MAX + 1]; 413 int extlen[SADB_EXT_MAX + 1]; 414 }; 415 416 #ifndef IPSEC_DEBUG2 417 static struct callout key_timer; 418 #endif 419 420 static struct secasvar *key_allocsa_policy(const struct secasindex *); 421 static void key_freesp_so(struct secpolicy **); 422 static struct secasvar *key_do_allocsa_policy(struct secashead *, u_int); 423 static void key_unlink(struct secpolicy *); 424 static struct secpolicy *key_getsp(struct secpolicyindex *); 425 static struct secpolicy *key_getspbyid(u_int32_t); 426 static u_int32_t key_newreqid(void); 427 static struct mbuf *key_gather_mbuf(struct mbuf *, 428 const struct sadb_msghdr *, int, int, ...); 429 static int key_spdadd(struct socket *, struct mbuf *, 430 const struct sadb_msghdr *); 431 static u_int32_t key_getnewspid(void); 432 static int key_spddelete(struct socket *, struct mbuf *, 433 const struct sadb_msghdr *); 434 static int key_spddelete2(struct socket *, struct mbuf *, 435 const struct sadb_msghdr *); 436 static int key_spdget(struct socket *, struct mbuf *, 437 const struct sadb_msghdr *); 438 static int key_spdflush(struct socket *, struct mbuf *, 439 const struct sadb_msghdr *); 440 static int key_spddump(struct socket *, struct mbuf *, 441 const struct sadb_msghdr *); 442 static struct mbuf *key_setdumpsp(struct secpolicy *, 443 u_int8_t, u_int32_t, u_int32_t); 444 static u_int key_getspreqmsglen(struct secpolicy *); 445 static int key_spdexpire(struct secpolicy *); 446 static struct secashead *key_newsah(struct secasindex *); 447 static void key_delsah(struct secashead *); 448 static struct secasvar *key_newsav(struct mbuf *, 449 const struct sadb_msghdr *, struct secashead *, int *, 450 const char*, int); 451 #define KEY_NEWSAV(m, sadb, sah, e) \ 452 key_newsav(m, sadb, sah, e, __FILE__, __LINE__) 453 static void key_delsav(struct secasvar *); 454 static struct secashead *key_getsah(struct secasindex *); 455 static struct secasvar *key_checkspidup(struct secasindex *, u_int32_t); 456 static struct secasvar *key_getsavbyspi(struct secashead *, u_int32_t); 457 static int key_setsaval(struct secasvar *, struct mbuf *, 458 const struct sadb_msghdr *); 459 static int key_mature(struct secasvar *); 460 static struct mbuf *key_setdumpsa(struct secasvar *, u_int8_t, 461 u_int8_t, u_int32_t, u_int32_t); 462 static struct mbuf *key_setsadbmsg(u_int8_t, u_int16_t, u_int8_t, 463 u_int32_t, pid_t, u_int16_t); 464 static struct mbuf *key_setsadbsa(struct secasvar *); 465 static struct mbuf *key_setsadbaddr(u_int16_t, 466 const struct sockaddr *, u_int8_t, u_int16_t); 467 #ifdef IPSEC_NAT_T 468 static struct mbuf *key_setsadbxport(u_int16_t, u_int16_t); 469 static struct mbuf *key_setsadbxtype(u_int16_t); 470 #endif 471 static void key_porttosaddr(struct sockaddr *, u_int16_t); 472 #define KEY_PORTTOSADDR(saddr, port) \ 473 key_porttosaddr((struct sockaddr *)(saddr), (port)) 474 static struct mbuf *key_setsadbxsa2(u_int8_t, u_int32_t, u_int32_t); 475 static struct mbuf *key_setsadbxpolicy(u_int16_t, u_int8_t, 476 u_int32_t, u_int32_t); 477 static struct seckey *key_dup_keymsg(const struct sadb_key *, u_int, 478 struct malloc_type *); 479 static struct seclifetime *key_dup_lifemsg(const struct sadb_lifetime *src, 480 struct malloc_type *type); 481 #ifdef INET6 482 static int key_ismyaddr6(struct sockaddr_in6 *); 483 #endif 484 485 /* flags for key_cmpsaidx() */ 486 #define CMP_HEAD 1 /* protocol, addresses. */ 487 #define CMP_MODE_REQID 2 /* additionally HEAD, reqid, mode. */ 488 #define CMP_REQID 3 /* additionally HEAD, reaid. */ 489 #define CMP_EXACTLY 4 /* all elements. */ 490 static int key_cmpsaidx(const struct secasindex *, 491 const struct secasindex *, int); 492 static int key_cmpspidx_exactly(struct secpolicyindex *, 493 struct secpolicyindex *); 494 static int key_cmpspidx_withmask(struct secpolicyindex *, 495 struct secpolicyindex *); 496 static int key_sockaddrcmp(const struct sockaddr *, 497 const struct sockaddr *, int); 498 static int key_bbcmp(const void *, const void *, u_int); 499 static u_int16_t key_satype2proto(u_int8_t); 500 static u_int8_t key_proto2satype(u_int16_t); 501 502 static int key_getspi(struct socket *, struct mbuf *, 503 const struct sadb_msghdr *); 504 static u_int32_t key_do_getnewspi(struct sadb_spirange *, 505 struct secasindex *); 506 static int key_update(struct socket *, struct mbuf *, 507 const struct sadb_msghdr *); 508 #ifdef IPSEC_DOSEQCHECK 509 static struct secasvar *key_getsavbyseq(struct secashead *, u_int32_t); 510 #endif 511 static int key_add(struct socket *, struct mbuf *, 512 const struct sadb_msghdr *); 513 static int key_setident(struct secashead *, struct mbuf *, 514 const struct sadb_msghdr *); 515 static struct mbuf *key_getmsgbuf_x1(struct mbuf *, 516 const struct sadb_msghdr *); 517 static int key_delete(struct socket *, struct mbuf *, 518 const struct sadb_msghdr *); 519 static int key_delete_all(struct socket *, struct mbuf *, 520 const struct sadb_msghdr *, u_int16_t); 521 static int key_get(struct socket *, struct mbuf *, 522 const struct sadb_msghdr *); 523 524 static void key_getcomb_setlifetime(struct sadb_comb *); 525 static struct mbuf *key_getcomb_esp(void); 526 static struct mbuf *key_getcomb_ah(void); 527 static struct mbuf *key_getcomb_ipcomp(void); 528 static struct mbuf *key_getprop(const struct secasindex *); 529 530 static int key_acquire(const struct secasindex *, struct secpolicy *); 531 static struct secacq *key_newacq(const struct secasindex *); 532 static struct secacq *key_getacq(const struct secasindex *); 533 static struct secacq *key_getacqbyseq(u_int32_t); 534 static struct secspacq *key_newspacq(struct secpolicyindex *); 535 static struct secspacq *key_getspacq(struct secpolicyindex *); 536 static int key_acquire2(struct socket *, struct mbuf *, 537 const struct sadb_msghdr *); 538 static int key_register(struct socket *, struct mbuf *, 539 const struct sadb_msghdr *); 540 static int key_expire(struct secasvar *, int); 541 static int key_flush(struct socket *, struct mbuf *, 542 const struct sadb_msghdr *); 543 static int key_dump(struct socket *, struct mbuf *, 544 const struct sadb_msghdr *); 545 static int key_promisc(struct socket *, struct mbuf *, 546 const struct sadb_msghdr *); 547 static int key_senderror(struct socket *, struct mbuf *, int); 548 static int key_validate_ext(const struct sadb_ext *, int); 549 static int key_align(struct mbuf *, struct sadb_msghdr *); 550 static struct mbuf *key_setlifetime(struct seclifetime *src, 551 u_int16_t exttype); 552 static struct mbuf *key_setkey(struct seckey *src, u_int16_t exttype); 553 554 #if 0 555 static const char *key_getfqdn(void); 556 static const char *key_getuserfqdn(void); 557 #endif 558 static void key_sa_chgstate(struct secasvar *, u_int8_t); 559 560 static __inline void 561 sa_initref(struct secasvar *sav) 562 { 563 564 refcount_init(&sav->refcnt, 1); 565 } 566 static __inline void 567 sa_addref(struct secasvar *sav) 568 { 569 570 refcount_acquire(&sav->refcnt); 571 IPSEC_ASSERT(sav->refcnt != 0, ("SA refcnt overflow")); 572 } 573 static __inline int 574 sa_delref(struct secasvar *sav) 575 { 576 577 IPSEC_ASSERT(sav->refcnt > 0, ("SA refcnt underflow")); 578 return (refcount_release(&sav->refcnt)); 579 } 580 581 #define SP_ADDREF(p) refcount_acquire(&(p)->refcnt) 582 #define SP_DELREF(p) refcount_release(&(p)->refcnt) 583 584 /* 585 * Update the refcnt while holding the SPTREE lock. 586 */ 587 void 588 key_addref(struct secpolicy *sp) 589 { 590 591 SP_ADDREF(sp); 592 } 593 594 /* 595 * Return 0 when there are known to be no SP's for the specified 596 * direction. Otherwise return 1. This is used by IPsec code 597 * to optimize performance. 598 */ 599 int 600 key_havesp(u_int dir) 601 { 602 603 return (dir == IPSEC_DIR_INBOUND || dir == IPSEC_DIR_OUTBOUND ? 604 TAILQ_FIRST(&V_sptree[dir]) != NULL : 1); 605 } 606 607 /* %%% IPsec policy management */ 608 /* 609 * allocating a SP for OUTBOUND or INBOUND packet. 610 * Must call key_freesp() later. 611 * OUT: NULL: not found 612 * others: found and return the pointer. 613 */ 614 struct secpolicy * 615 key_allocsp(struct secpolicyindex *spidx, u_int dir, const char* where, 616 int tag) 617 { 618 SPTREE_RLOCK_TRACKER; 619 struct secpolicy *sp; 620 621 IPSEC_ASSERT(spidx != NULL, ("null spidx")); 622 IPSEC_ASSERT(dir == IPSEC_DIR_INBOUND || dir == IPSEC_DIR_OUTBOUND, 623 ("invalid direction %u", dir)); 624 625 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 626 printf("DP %s from %s:%u\n", __func__, where, tag)); 627 628 /* get a SP entry */ 629 KEYDEBUG(KEYDEBUG_IPSEC_DATA, 630 printf("*** objects\n"); 631 kdebug_secpolicyindex(spidx)); 632 633 SPTREE_RLOCK(); 634 TAILQ_FOREACH(sp, &V_sptree[dir], chain) { 635 KEYDEBUG(KEYDEBUG_IPSEC_DATA, 636 printf("*** in SPD\n"); 637 kdebug_secpolicyindex(&sp->spidx)); 638 if (key_cmpspidx_withmask(&sp->spidx, spidx)) 639 goto found; 640 } 641 sp = NULL; 642 found: 643 if (sp) { 644 /* sanity check */ 645 KEY_CHKSPDIR(sp->spidx.dir, dir, __func__); 646 647 /* found a SPD entry */ 648 sp->lastused = time_second; 649 SP_ADDREF(sp); 650 } 651 SPTREE_RUNLOCK(); 652 653 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 654 printf("DP %s return SP:%p (ID=%u) refcnt %u\n", __func__, 655 sp, sp ? sp->id : 0, sp ? sp->refcnt : 0)); 656 return sp; 657 } 658 659 /* 660 * allocating a SP for OUTBOUND or INBOUND packet. 661 * Must call key_freesp() later. 662 * OUT: NULL: not found 663 * others: found and return the pointer. 664 */ 665 struct secpolicy * 666 key_allocsp2(u_int32_t spi, union sockaddr_union *dst, u_int8_t proto, 667 u_int dir, const char* where, int tag) 668 { 669 SPTREE_RLOCK_TRACKER; 670 struct secpolicy *sp; 671 672 IPSEC_ASSERT(dst != NULL, ("null dst")); 673 IPSEC_ASSERT(dir == IPSEC_DIR_INBOUND || dir == IPSEC_DIR_OUTBOUND, 674 ("invalid direction %u", dir)); 675 676 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 677 printf("DP %s from %s:%u\n", __func__, where, tag)); 678 679 /* get a SP entry */ 680 KEYDEBUG(KEYDEBUG_IPSEC_DATA, 681 printf("*** objects\n"); 682 printf("spi %u proto %u dir %u\n", spi, proto, dir); 683 kdebug_sockaddr(&dst->sa)); 684 685 SPTREE_RLOCK(); 686 TAILQ_FOREACH(sp, &V_sptree[dir], chain) { 687 KEYDEBUG(KEYDEBUG_IPSEC_DATA, 688 printf("*** in SPD\n"); 689 kdebug_secpolicyindex(&sp->spidx)); 690 /* compare simple values, then dst address */ 691 if (sp->spidx.ul_proto != proto) 692 continue; 693 /* NB: spi's must exist and match */ 694 if (!sp->req || !sp->req->sav || sp->req->sav->spi != spi) 695 continue; 696 if (key_sockaddrcmp(&sp->spidx.dst.sa, &dst->sa, 1) == 0) 697 goto found; 698 } 699 sp = NULL; 700 found: 701 if (sp) { 702 /* sanity check */ 703 KEY_CHKSPDIR(sp->spidx.dir, dir, __func__); 704 705 /* found a SPD entry */ 706 sp->lastused = time_second; 707 SP_ADDREF(sp); 708 } 709 SPTREE_RUNLOCK(); 710 711 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 712 printf("DP %s return SP:%p (ID=%u) refcnt %u\n", __func__, 713 sp, sp ? sp->id : 0, sp ? sp->refcnt : 0)); 714 return sp; 715 } 716 717 #if 0 718 /* 719 * return a policy that matches this particular inbound packet. 720 * XXX slow 721 */ 722 struct secpolicy * 723 key_gettunnel(const struct sockaddr *osrc, 724 const struct sockaddr *odst, 725 const struct sockaddr *isrc, 726 const struct sockaddr *idst, 727 const char* where, int tag) 728 { 729 struct secpolicy *sp; 730 const int dir = IPSEC_DIR_INBOUND; 731 struct ipsecrequest *r1, *r2, *p; 732 struct secpolicyindex spidx; 733 734 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 735 printf("DP %s from %s:%u\n", __func__, where, tag)); 736 737 if (isrc->sa_family != idst->sa_family) { 738 ipseclog((LOG_ERR, "%s: protocol family mismatched %d != %d\n.", 739 __func__, isrc->sa_family, idst->sa_family)); 740 sp = NULL; 741 goto done; 742 } 743 744 SPTREE_LOCK(); 745 LIST_FOREACH(sp, &V_sptree[dir], chain) { 746 if (sp->state == IPSEC_SPSTATE_DEAD) 747 continue; 748 749 r1 = r2 = NULL; 750 for (p = sp->req; p; p = p->next) { 751 if (p->saidx.mode != IPSEC_MODE_TUNNEL) 752 continue; 753 754 r1 = r2; 755 r2 = p; 756 757 if (!r1) { 758 /* here we look at address matches only */ 759 spidx = sp->spidx; 760 if (isrc->sa_len > sizeof(spidx.src) || 761 idst->sa_len > sizeof(spidx.dst)) 762 continue; 763 bcopy(isrc, &spidx.src, isrc->sa_len); 764 bcopy(idst, &spidx.dst, idst->sa_len); 765 if (!key_cmpspidx_withmask(&sp->spidx, &spidx)) 766 continue; 767 } else { 768 if (key_sockaddrcmp(&r1->saidx.src.sa, isrc, 0) || 769 key_sockaddrcmp(&r1->saidx.dst.sa, idst, 0)) 770 continue; 771 } 772 773 if (key_sockaddrcmp(&r2->saidx.src.sa, osrc, 0) || 774 key_sockaddrcmp(&r2->saidx.dst.sa, odst, 0)) 775 continue; 776 777 goto found; 778 } 779 } 780 sp = NULL; 781 found: 782 if (sp) { 783 sp->lastused = time_second; 784 SP_ADDREF(sp); 785 } 786 SPTREE_UNLOCK(); 787 done: 788 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 789 printf("DP %s return SP:%p (ID=%u) refcnt %u\n", __func__, 790 sp, sp ? sp->id : 0, sp ? sp->refcnt : 0)); 791 return sp; 792 } 793 #endif 794 795 /* 796 * allocating an SA entry for an *OUTBOUND* packet. 797 * checking each request entries in SP, and acquire an SA if need. 798 * OUT: 0: there are valid requests. 799 * ENOENT: policy may be valid, but SA with REQUIRE is on acquiring. 800 */ 801 int 802 key_checkrequest(struct ipsecrequest *isr, const struct secasindex *saidx) 803 { 804 u_int level; 805 int error; 806 struct secasvar *sav; 807 808 IPSEC_ASSERT(isr != NULL, ("null isr")); 809 IPSEC_ASSERT(saidx != NULL, ("null saidx")); 810 IPSEC_ASSERT(saidx->mode == IPSEC_MODE_TRANSPORT || 811 saidx->mode == IPSEC_MODE_TUNNEL, 812 ("unexpected policy %u", saidx->mode)); 813 814 /* 815 * XXX guard against protocol callbacks from the crypto 816 * thread as they reference ipsecrequest.sav which we 817 * temporarily null out below. Need to rethink how we 818 * handle bundled SA's in the callback thread. 819 */ 820 IPSECREQUEST_LOCK_ASSERT(isr); 821 822 /* get current level */ 823 level = ipsec_get_reqlevel(isr); 824 825 /* 826 * We check new SA in the IPsec request because a different 827 * SA may be involved each time this request is checked, either 828 * because new SAs are being configured, or this request is 829 * associated with an unconnected datagram socket, or this request 830 * is associated with a system default policy. 831 * 832 * key_allocsa_policy should allocate the oldest SA available. 833 * See key_do_allocsa_policy(), and draft-jenkins-ipsec-rekeying-03.txt. 834 */ 835 sav = key_allocsa_policy(saidx); 836 if (sav != isr->sav) { 837 /* SA need to be updated. */ 838 if (!IPSECREQUEST_UPGRADE(isr)) { 839 /* Kick everyone off. */ 840 IPSECREQUEST_UNLOCK(isr); 841 IPSECREQUEST_WLOCK(isr); 842 } 843 if (isr->sav != NULL) 844 KEY_FREESAV(&isr->sav); 845 isr->sav = sav; 846 IPSECREQUEST_DOWNGRADE(isr); 847 } else if (sav != NULL) 848 KEY_FREESAV(&sav); 849 850 /* When there is SA. */ 851 if (isr->sav != NULL) { 852 if (isr->sav->state != SADB_SASTATE_MATURE && 853 isr->sav->state != SADB_SASTATE_DYING) 854 return EINVAL; 855 return 0; 856 } 857 858 /* there is no SA */ 859 error = key_acquire(saidx, isr->sp); 860 if (error != 0) { 861 /* XXX What should I do ? */ 862 ipseclog((LOG_DEBUG, "%s: error %d returned from key_acquire\n", 863 __func__, error)); 864 return error; 865 } 866 867 if (level != IPSEC_LEVEL_REQUIRE) { 868 /* XXX sigh, the interface to this routine is botched */ 869 IPSEC_ASSERT(isr->sav == NULL, ("unexpected SA")); 870 return 0; 871 } else { 872 return ENOENT; 873 } 874 } 875 876 /* 877 * allocating a SA for policy entry from SAD. 878 * NOTE: searching SAD of aliving state. 879 * OUT: NULL: not found. 880 * others: found and return the pointer. 881 */ 882 static struct secasvar * 883 key_allocsa_policy(const struct secasindex *saidx) 884 { 885 #define N(a) _ARRAYLEN(a) 886 struct secashead *sah; 887 struct secasvar *sav; 888 u_int stateidx, arraysize; 889 const u_int *state_valid; 890 891 state_valid = NULL; /* silence gcc */ 892 arraysize = 0; /* silence gcc */ 893 894 SAHTREE_LOCK(); 895 LIST_FOREACH(sah, &V_sahtree, chain) { 896 if (sah->state == SADB_SASTATE_DEAD) 897 continue; 898 if (key_cmpsaidx(&sah->saidx, saidx, CMP_MODE_REQID)) { 899 if (V_key_preferred_oldsa) { 900 state_valid = saorder_state_valid_prefer_old; 901 arraysize = N(saorder_state_valid_prefer_old); 902 } else { 903 state_valid = saorder_state_valid_prefer_new; 904 arraysize = N(saorder_state_valid_prefer_new); 905 } 906 break; 907 } 908 } 909 SAHTREE_UNLOCK(); 910 if (sah == NULL) 911 return NULL; 912 913 /* search valid state */ 914 for (stateidx = 0; stateidx < arraysize; stateidx++) { 915 sav = key_do_allocsa_policy(sah, state_valid[stateidx]); 916 if (sav != NULL) 917 return sav; 918 } 919 920 return NULL; 921 #undef N 922 } 923 924 /* 925 * searching SAD with direction, protocol, mode and state. 926 * called by key_allocsa_policy(). 927 * OUT: 928 * NULL : not found 929 * others : found, pointer to a SA. 930 */ 931 static struct secasvar * 932 key_do_allocsa_policy(struct secashead *sah, u_int state) 933 { 934 struct secasvar *sav, *nextsav, *candidate, *d; 935 936 /* initilize */ 937 candidate = NULL; 938 939 SAHTREE_LOCK(); 940 for (sav = LIST_FIRST(&sah->savtree[state]); 941 sav != NULL; 942 sav = nextsav) { 943 944 nextsav = LIST_NEXT(sav, chain); 945 946 /* sanity check */ 947 KEY_CHKSASTATE(sav->state, state, __func__); 948 949 /* initialize */ 950 if (candidate == NULL) { 951 candidate = sav; 952 continue; 953 } 954 955 /* Which SA is the better ? */ 956 957 IPSEC_ASSERT(candidate->lft_c != NULL, 958 ("null candidate lifetime")); 959 IPSEC_ASSERT(sav->lft_c != NULL, ("null sav lifetime")); 960 961 /* What the best method is to compare ? */ 962 if (V_key_preferred_oldsa) { 963 if (candidate->lft_c->addtime > 964 sav->lft_c->addtime) { 965 candidate = sav; 966 } 967 continue; 968 /*NOTREACHED*/ 969 } 970 971 /* preferred new sa rather than old sa */ 972 if (candidate->lft_c->addtime < 973 sav->lft_c->addtime) { 974 d = candidate; 975 candidate = sav; 976 } else 977 d = sav; 978 979 /* 980 * prepared to delete the SA when there is more 981 * suitable candidate and the lifetime of the SA is not 982 * permanent. 983 */ 984 if (d->lft_h->addtime != 0) { 985 struct mbuf *m, *result; 986 u_int8_t satype; 987 988 key_sa_chgstate(d, SADB_SASTATE_DEAD); 989 990 IPSEC_ASSERT(d->refcnt > 0, ("bogus ref count")); 991 992 satype = key_proto2satype(d->sah->saidx.proto); 993 if (satype == 0) 994 goto msgfail; 995 996 m = key_setsadbmsg(SADB_DELETE, 0, 997 satype, 0, 0, d->refcnt - 1); 998 if (!m) 999 goto msgfail; 1000 result = m; 1001 1002 /* set sadb_address for saidx's. */ 1003 m = key_setsadbaddr(SADB_EXT_ADDRESS_SRC, 1004 &d->sah->saidx.src.sa, 1005 d->sah->saidx.src.sa.sa_len << 3, 1006 IPSEC_ULPROTO_ANY); 1007 if (!m) 1008 goto msgfail; 1009 m_cat(result, m); 1010 1011 /* set sadb_address for saidx's. */ 1012 m = key_setsadbaddr(SADB_EXT_ADDRESS_DST, 1013 &d->sah->saidx.dst.sa, 1014 d->sah->saidx.dst.sa.sa_len << 3, 1015 IPSEC_ULPROTO_ANY); 1016 if (!m) 1017 goto msgfail; 1018 m_cat(result, m); 1019 1020 /* create SA extension */ 1021 m = key_setsadbsa(d); 1022 if (!m) 1023 goto msgfail; 1024 m_cat(result, m); 1025 1026 if (result->m_len < sizeof(struct sadb_msg)) { 1027 result = m_pullup(result, 1028 sizeof(struct sadb_msg)); 1029 if (result == NULL) 1030 goto msgfail; 1031 } 1032 1033 result->m_pkthdr.len = 0; 1034 for (m = result; m; m = m->m_next) 1035 result->m_pkthdr.len += m->m_len; 1036 mtod(result, struct sadb_msg *)->sadb_msg_len = 1037 PFKEY_UNIT64(result->m_pkthdr.len); 1038 1039 if (key_sendup_mbuf(NULL, result, 1040 KEY_SENDUP_REGISTERED)) 1041 goto msgfail; 1042 msgfail: 1043 KEY_FREESAV(&d); 1044 } 1045 } 1046 if (candidate) { 1047 sa_addref(candidate); 1048 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 1049 printf("DP %s cause refcnt++:%d SA:%p\n", 1050 __func__, candidate->refcnt, candidate)); 1051 } 1052 SAHTREE_UNLOCK(); 1053 1054 return candidate; 1055 } 1056 1057 /* 1058 * allocating a usable SA entry for a *INBOUND* packet. 1059 * Must call key_freesav() later. 1060 * OUT: positive: pointer to a usable sav (i.e. MATURE or DYING state). 1061 * NULL: not found, or error occured. 1062 * 1063 * In the comparison, no source address is used--for RFC2401 conformance. 1064 * To quote, from section 4.1: 1065 * A security association is uniquely identified by a triple consisting 1066 * of a Security Parameter Index (SPI), an IP Destination Address, and a 1067 * security protocol (AH or ESP) identifier. 1068 * Note that, however, we do need to keep source address in IPsec SA. 1069 * IKE specification and PF_KEY specification do assume that we 1070 * keep source address in IPsec SA. We see a tricky situation here. 1071 */ 1072 struct secasvar * 1073 key_allocsa(union sockaddr_union *dst, u_int proto, u_int32_t spi, 1074 const char* where, int tag) 1075 { 1076 struct secashead *sah; 1077 struct secasvar *sav; 1078 u_int stateidx, arraysize, state; 1079 const u_int *saorder_state_valid; 1080 #ifdef IPSEC_NAT_T 1081 int natt_chkport; 1082 #endif 1083 1084 IPSEC_ASSERT(dst != NULL, ("null dst address")); 1085 1086 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 1087 printf("DP %s from %s:%u\n", __func__, where, tag)); 1088 1089 #ifdef IPSEC_NAT_T 1090 natt_chkport = (dst->sa.sa_family == AF_INET && 1091 dst->sa.sa_len == sizeof(struct sockaddr_in) && 1092 dst->sin.sin_port != 0); 1093 #endif 1094 1095 /* 1096 * searching SAD. 1097 * XXX: to be checked internal IP header somewhere. Also when 1098 * IPsec tunnel packet is received. But ESP tunnel mode is 1099 * encrypted so we can't check internal IP header. 1100 */ 1101 SAHTREE_LOCK(); 1102 if (V_key_preferred_oldsa) { 1103 saorder_state_valid = saorder_state_valid_prefer_old; 1104 arraysize = _ARRAYLEN(saorder_state_valid_prefer_old); 1105 } else { 1106 saorder_state_valid = saorder_state_valid_prefer_new; 1107 arraysize = _ARRAYLEN(saorder_state_valid_prefer_new); 1108 } 1109 LIST_FOREACH(sah, &V_sahtree, chain) { 1110 int checkport; 1111 1112 /* search valid state */ 1113 for (stateidx = 0; stateidx < arraysize; stateidx++) { 1114 state = saorder_state_valid[stateidx]; 1115 LIST_FOREACH(sav, &sah->savtree[state], chain) { 1116 /* sanity check */ 1117 KEY_CHKSASTATE(sav->state, state, __func__); 1118 /* do not return entries w/ unusable state */ 1119 if (sav->state != SADB_SASTATE_MATURE && 1120 sav->state != SADB_SASTATE_DYING) 1121 continue; 1122 if (proto != sav->sah->saidx.proto) 1123 continue; 1124 if (spi != sav->spi) 1125 continue; 1126 checkport = 0; 1127 #ifdef IPSEC_NAT_T 1128 /* 1129 * Really only check ports when this is a NAT-T 1130 * SA. Otherwise other lookups providing ports 1131 * might suffer. 1132 */ 1133 if (sav->natt_type && natt_chkport) 1134 checkport = 1; 1135 #endif 1136 #if 0 /* don't check src */ 1137 /* check src address */ 1138 if (key_sockaddrcmp(&src->sa, 1139 &sav->sah->saidx.src.sa, checkport) != 0) 1140 continue; 1141 #endif 1142 /* check dst address */ 1143 if (key_sockaddrcmp(&dst->sa, 1144 &sav->sah->saidx.dst.sa, checkport) != 0) 1145 continue; 1146 sa_addref(sav); 1147 goto done; 1148 } 1149 } 1150 } 1151 sav = NULL; 1152 done: 1153 SAHTREE_UNLOCK(); 1154 1155 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 1156 printf("DP %s return SA:%p; refcnt %u\n", __func__, 1157 sav, sav ? sav->refcnt : 0)); 1158 return sav; 1159 } 1160 1161 struct secasvar * 1162 key_allocsa_tunnel(union sockaddr_union *src, union sockaddr_union *dst, 1163 u_int proto, const char* where, int tag) 1164 { 1165 struct secashead *sah; 1166 struct secasvar *sav; 1167 u_int stateidx, arraysize, state; 1168 const u_int *saorder_state_valid; 1169 1170 IPSEC_ASSERT(src != NULL, ("null src address")); 1171 IPSEC_ASSERT(dst != NULL, ("null dst address")); 1172 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 1173 printf("DP %s from %s:%u\n", __func__, where, tag)); 1174 1175 SAHTREE_LOCK(); 1176 if (V_key_preferred_oldsa) { 1177 saorder_state_valid = saorder_state_valid_prefer_old; 1178 arraysize = _ARRAYLEN(saorder_state_valid_prefer_old); 1179 } else { 1180 saorder_state_valid = saorder_state_valid_prefer_new; 1181 arraysize = _ARRAYLEN(saorder_state_valid_prefer_new); 1182 } 1183 LIST_FOREACH(sah, &V_sahtree, chain) { 1184 /* search valid state */ 1185 for (stateidx = 0; stateidx < arraysize; stateidx++) { 1186 state = saorder_state_valid[stateidx]; 1187 LIST_FOREACH(sav, &sah->savtree[state], chain) { 1188 /* sanity check */ 1189 KEY_CHKSASTATE(sav->state, state, __func__); 1190 /* do not return entries w/ unusable state */ 1191 if (sav->state != SADB_SASTATE_MATURE && 1192 sav->state != SADB_SASTATE_DYING) 1193 continue; 1194 if (IPSEC_MODE_TUNNEL != sav->sah->saidx.mode) 1195 continue; 1196 if (proto != sav->sah->saidx.proto) 1197 continue; 1198 /* check src address */ 1199 if (key_sockaddrcmp(&src->sa, 1200 &sav->sah->saidx.src.sa, 0) != 0) 1201 continue; 1202 /* check dst address */ 1203 if (key_sockaddrcmp(&dst->sa, 1204 &sav->sah->saidx.dst.sa, 0) != 0) 1205 continue; 1206 sa_addref(sav); 1207 goto done; 1208 } 1209 } 1210 } 1211 sav = NULL; 1212 done: 1213 SAHTREE_UNLOCK(); 1214 1215 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 1216 printf("DP %s return SA:%p; refcnt %u\n", __func__, 1217 sav, sav ? sav->refcnt : 0)); 1218 return (sav); 1219 } 1220 1221 /* 1222 * Must be called after calling key_allocsp(). 1223 * For both the packet without socket and key_freeso(). 1224 */ 1225 void 1226 _key_freesp(struct secpolicy **spp, const char* where, int tag) 1227 { 1228 struct ipsecrequest *isr, *nextisr; 1229 struct secpolicy *sp = *spp; 1230 1231 IPSEC_ASSERT(sp != NULL, ("null sp")); 1232 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 1233 printf("DP %s SP:%p (ID=%u) from %s:%u; refcnt now %u\n", 1234 __func__, sp, sp->id, where, tag, sp->refcnt)); 1235 1236 if (SP_DELREF(sp) == 0) 1237 return; 1238 *spp = NULL; 1239 for (isr = sp->req; isr != NULL; isr = nextisr) { 1240 if (isr->sav != NULL) { 1241 KEY_FREESAV(&isr->sav); 1242 isr->sav = NULL; 1243 } 1244 nextisr = isr->next; 1245 ipsec_delisr(isr); 1246 } 1247 free(sp, M_IPSEC_SP); 1248 } 1249 1250 static void 1251 key_unlink(struct secpolicy *sp) 1252 { 1253 1254 IPSEC_ASSERT(sp != NULL, ("null sp")); 1255 IPSEC_ASSERT(sp->spidx.dir == IPSEC_DIR_INBOUND || 1256 sp->spidx.dir == IPSEC_DIR_OUTBOUND, 1257 ("invalid direction %u", sp->spidx.dir)); 1258 SPTREE_UNLOCK_ASSERT(); 1259 1260 SPTREE_WLOCK(); 1261 if (sp->state == IPSEC_SPSTATE_DEAD) { 1262 SPTREE_WUNLOCK(); 1263 return; 1264 } 1265 sp->state = IPSEC_SPSTATE_DEAD; 1266 TAILQ_REMOVE(&V_sptree[sp->spidx.dir], sp, chain); 1267 SPTREE_WUNLOCK(); 1268 KEY_FREESP(&sp); 1269 } 1270 1271 /* 1272 * insert a secpolicy into the SP database. Lower priorities first 1273 */ 1274 static void 1275 key_insertsp(struct secpolicy *newsp) 1276 { 1277 struct secpolicy *sp; 1278 1279 SPTREE_WLOCK(); 1280 TAILQ_FOREACH(sp, &V_sptree[newsp->spidx.dir], chain) { 1281 if (newsp->priority < sp->priority) { 1282 TAILQ_INSERT_BEFORE(sp, newsp, chain); 1283 goto done; 1284 } 1285 } 1286 1287 TAILQ_INSERT_TAIL(&V_sptree[newsp->spidx.dir], newsp, chain); 1288 1289 done: 1290 newsp->state = IPSEC_SPSTATE_ALIVE; 1291 SPTREE_WUNLOCK(); 1292 } 1293 1294 /* 1295 * Must be called after calling key_allocsp(). 1296 * For the packet with socket. 1297 */ 1298 void 1299 key_freeso(struct socket *so) 1300 { 1301 IPSEC_ASSERT(so != NULL, ("null so")); 1302 1303 switch (so->so_proto->pr_domain->dom_family) { 1304 #if defined(INET) || defined(INET6) 1305 #ifdef INET 1306 case PF_INET: 1307 #endif 1308 #ifdef INET6 1309 case PF_INET6: 1310 #endif 1311 { 1312 struct inpcb *pcb = sotoinpcb(so); 1313 1314 /* Does it have a PCB ? */ 1315 if (pcb == NULL) 1316 return; 1317 key_freesp_so(&pcb->inp_sp->sp_in); 1318 key_freesp_so(&pcb->inp_sp->sp_out); 1319 } 1320 break; 1321 #endif /* INET || INET6 */ 1322 default: 1323 ipseclog((LOG_DEBUG, "%s: unknown address family=%d.\n", 1324 __func__, so->so_proto->pr_domain->dom_family)); 1325 return; 1326 } 1327 } 1328 1329 static void 1330 key_freesp_so(struct secpolicy **sp) 1331 { 1332 IPSEC_ASSERT(sp != NULL && *sp != NULL, ("null sp")); 1333 1334 if ((*sp)->policy == IPSEC_POLICY_ENTRUST || 1335 (*sp)->policy == IPSEC_POLICY_BYPASS) 1336 return; 1337 1338 IPSEC_ASSERT((*sp)->policy == IPSEC_POLICY_IPSEC, 1339 ("invalid policy %u", (*sp)->policy)); 1340 KEY_FREESP(sp); 1341 } 1342 1343 void 1344 key_addrefsa(struct secasvar *sav, const char* where, int tag) 1345 { 1346 1347 IPSEC_ASSERT(sav != NULL, ("null sav")); 1348 IPSEC_ASSERT(sav->refcnt > 0, ("refcount must exist")); 1349 1350 sa_addref(sav); 1351 } 1352 1353 /* 1354 * Must be called after calling key_allocsa(). 1355 * This function is called by key_freesp() to free some SA allocated 1356 * for a policy. 1357 */ 1358 void 1359 key_freesav(struct secasvar **psav, const char* where, int tag) 1360 { 1361 struct secasvar *sav = *psav; 1362 1363 IPSEC_ASSERT(sav != NULL, ("null sav")); 1364 1365 if (sa_delref(sav)) { 1366 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 1367 printf("DP %s SA:%p (SPI %u) from %s:%u; refcnt now %u\n", 1368 __func__, sav, ntohl(sav->spi), where, tag, sav->refcnt)); 1369 *psav = NULL; 1370 key_delsav(sav); 1371 } else { 1372 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 1373 printf("DP %s SA:%p (SPI %u) from %s:%u; refcnt now %u\n", 1374 __func__, sav, ntohl(sav->spi), where, tag, sav->refcnt)); 1375 } 1376 } 1377 1378 /* %%% SPD management */ 1379 /* 1380 * search SPD 1381 * OUT: NULL : not found 1382 * others : found, pointer to a SP. 1383 */ 1384 static struct secpolicy * 1385 key_getsp(struct secpolicyindex *spidx) 1386 { 1387 SPTREE_RLOCK_TRACKER; 1388 struct secpolicy *sp; 1389 1390 IPSEC_ASSERT(spidx != NULL, ("null spidx")); 1391 1392 SPTREE_RLOCK(); 1393 TAILQ_FOREACH(sp, &V_sptree[spidx->dir], chain) { 1394 if (key_cmpspidx_exactly(spidx, &sp->spidx)) { 1395 SP_ADDREF(sp); 1396 break; 1397 } 1398 } 1399 SPTREE_RUNLOCK(); 1400 1401 return sp; 1402 } 1403 1404 /* 1405 * get SP by index. 1406 * OUT: NULL : not found 1407 * others : found, pointer to a SP. 1408 */ 1409 static struct secpolicy * 1410 key_getspbyid(u_int32_t id) 1411 { 1412 SPTREE_RLOCK_TRACKER; 1413 struct secpolicy *sp; 1414 1415 SPTREE_RLOCK(); 1416 TAILQ_FOREACH(sp, &V_sptree[IPSEC_DIR_INBOUND], chain) { 1417 if (sp->id == id) { 1418 SP_ADDREF(sp); 1419 goto done; 1420 } 1421 } 1422 1423 TAILQ_FOREACH(sp, &V_sptree[IPSEC_DIR_OUTBOUND], chain) { 1424 if (sp->id == id) { 1425 SP_ADDREF(sp); 1426 goto done; 1427 } 1428 } 1429 done: 1430 SPTREE_RUNLOCK(); 1431 1432 return sp; 1433 } 1434 1435 struct secpolicy * 1436 key_newsp(const char* where, int tag) 1437 { 1438 struct secpolicy *newsp = NULL; 1439 1440 newsp = (struct secpolicy *) 1441 malloc(sizeof(struct secpolicy), M_IPSEC_SP, M_NOWAIT|M_ZERO); 1442 if (newsp) 1443 refcount_init(&newsp->refcnt, 1); 1444 1445 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 1446 printf("DP %s from %s:%u return SP:%p\n", __func__, 1447 where, tag, newsp)); 1448 return newsp; 1449 } 1450 1451 /* 1452 * create secpolicy structure from sadb_x_policy structure. 1453 * NOTE: `state', `secpolicyindex' in secpolicy structure are not set, 1454 * so must be set properly later. 1455 */ 1456 struct secpolicy * 1457 key_msg2sp(struct sadb_x_policy *xpl0, size_t len, int *error) 1458 { 1459 struct secpolicy *newsp; 1460 1461 IPSEC_ASSERT(xpl0 != NULL, ("null xpl0")); 1462 IPSEC_ASSERT(len >= sizeof(*xpl0), ("policy too short: %zu", len)); 1463 1464 if (len != PFKEY_EXTLEN(xpl0)) { 1465 ipseclog((LOG_DEBUG, "%s: Invalid msg length.\n", __func__)); 1466 *error = EINVAL; 1467 return NULL; 1468 } 1469 1470 if ((newsp = KEY_NEWSP()) == NULL) { 1471 *error = ENOBUFS; 1472 return NULL; 1473 } 1474 1475 newsp->spidx.dir = xpl0->sadb_x_policy_dir; 1476 newsp->policy = xpl0->sadb_x_policy_type; 1477 newsp->priority = xpl0->sadb_x_policy_priority; 1478 1479 /* check policy */ 1480 switch (xpl0->sadb_x_policy_type) { 1481 case IPSEC_POLICY_DISCARD: 1482 case IPSEC_POLICY_NONE: 1483 case IPSEC_POLICY_ENTRUST: 1484 case IPSEC_POLICY_BYPASS: 1485 newsp->req = NULL; 1486 break; 1487 1488 case IPSEC_POLICY_IPSEC: 1489 { 1490 int tlen; 1491 struct sadb_x_ipsecrequest *xisr; 1492 struct ipsecrequest **p_isr = &newsp->req; 1493 1494 /* validity check */ 1495 if (PFKEY_EXTLEN(xpl0) < sizeof(*xpl0)) { 1496 ipseclog((LOG_DEBUG, "%s: Invalid msg length.\n", 1497 __func__)); 1498 KEY_FREESP(&newsp); 1499 *error = EINVAL; 1500 return NULL; 1501 } 1502 1503 tlen = PFKEY_EXTLEN(xpl0) - sizeof(*xpl0); 1504 xisr = (struct sadb_x_ipsecrequest *)(xpl0 + 1); 1505 1506 while (tlen > 0) { 1507 /* length check */ 1508 if (xisr->sadb_x_ipsecrequest_len < sizeof(*xisr)) { 1509 ipseclog((LOG_DEBUG, "%s: invalid ipsecrequest " 1510 "length.\n", __func__)); 1511 KEY_FREESP(&newsp); 1512 *error = EINVAL; 1513 return NULL; 1514 } 1515 1516 /* allocate request buffer */ 1517 /* NB: data structure is zero'd */ 1518 *p_isr = ipsec_newisr(); 1519 if ((*p_isr) == NULL) { 1520 ipseclog((LOG_DEBUG, 1521 "%s: No more memory.\n", __func__)); 1522 KEY_FREESP(&newsp); 1523 *error = ENOBUFS; 1524 return NULL; 1525 } 1526 1527 /* set values */ 1528 switch (xisr->sadb_x_ipsecrequest_proto) { 1529 case IPPROTO_ESP: 1530 case IPPROTO_AH: 1531 case IPPROTO_IPCOMP: 1532 break; 1533 default: 1534 ipseclog((LOG_DEBUG, 1535 "%s: invalid proto type=%u\n", __func__, 1536 xisr->sadb_x_ipsecrequest_proto)); 1537 KEY_FREESP(&newsp); 1538 *error = EPROTONOSUPPORT; 1539 return NULL; 1540 } 1541 (*p_isr)->saidx.proto = xisr->sadb_x_ipsecrequest_proto; 1542 1543 switch (xisr->sadb_x_ipsecrequest_mode) { 1544 case IPSEC_MODE_TRANSPORT: 1545 case IPSEC_MODE_TUNNEL: 1546 break; 1547 case IPSEC_MODE_ANY: 1548 default: 1549 ipseclog((LOG_DEBUG, 1550 "%s: invalid mode=%u\n", __func__, 1551 xisr->sadb_x_ipsecrequest_mode)); 1552 KEY_FREESP(&newsp); 1553 *error = EINVAL; 1554 return NULL; 1555 } 1556 (*p_isr)->saidx.mode = xisr->sadb_x_ipsecrequest_mode; 1557 1558 switch (xisr->sadb_x_ipsecrequest_level) { 1559 case IPSEC_LEVEL_DEFAULT: 1560 case IPSEC_LEVEL_USE: 1561 case IPSEC_LEVEL_REQUIRE: 1562 break; 1563 case IPSEC_LEVEL_UNIQUE: 1564 /* validity check */ 1565 /* 1566 * If range violation of reqid, kernel will 1567 * update it, don't refuse it. 1568 */ 1569 if (xisr->sadb_x_ipsecrequest_reqid 1570 > IPSEC_MANUAL_REQID_MAX) { 1571 ipseclog((LOG_DEBUG, 1572 "%s: reqid=%d range " 1573 "violation, updated by kernel.\n", 1574 __func__, 1575 xisr->sadb_x_ipsecrequest_reqid)); 1576 xisr->sadb_x_ipsecrequest_reqid = 0; 1577 } 1578 1579 /* allocate new reqid id if reqid is zero. */ 1580 if (xisr->sadb_x_ipsecrequest_reqid == 0) { 1581 u_int32_t reqid; 1582 if ((reqid = key_newreqid()) == 0) { 1583 KEY_FREESP(&newsp); 1584 *error = ENOBUFS; 1585 return NULL; 1586 } 1587 (*p_isr)->saidx.reqid = reqid; 1588 xisr->sadb_x_ipsecrequest_reqid = reqid; 1589 } else { 1590 /* set it for manual keying. */ 1591 (*p_isr)->saidx.reqid = 1592 xisr->sadb_x_ipsecrequest_reqid; 1593 } 1594 break; 1595 1596 default: 1597 ipseclog((LOG_DEBUG, "%s: invalid level=%u\n", 1598 __func__, 1599 xisr->sadb_x_ipsecrequest_level)); 1600 KEY_FREESP(&newsp); 1601 *error = EINVAL; 1602 return NULL; 1603 } 1604 (*p_isr)->level = xisr->sadb_x_ipsecrequest_level; 1605 1606 /* set IP addresses if there */ 1607 if (xisr->sadb_x_ipsecrequest_len > sizeof(*xisr)) { 1608 struct sockaddr *paddr; 1609 1610 paddr = (struct sockaddr *)(xisr + 1); 1611 1612 /* validity check */ 1613 if (paddr->sa_len 1614 > sizeof((*p_isr)->saidx.src)) { 1615 ipseclog((LOG_DEBUG, "%s: invalid " 1616 "request address length.\n", 1617 __func__)); 1618 KEY_FREESP(&newsp); 1619 *error = EINVAL; 1620 return NULL; 1621 } 1622 bcopy(paddr, &(*p_isr)->saidx.src, 1623 paddr->sa_len); 1624 1625 paddr = (struct sockaddr *)((caddr_t)paddr 1626 + paddr->sa_len); 1627 1628 /* validity check */ 1629 if (paddr->sa_len 1630 > sizeof((*p_isr)->saidx.dst)) { 1631 ipseclog((LOG_DEBUG, "%s: invalid " 1632 "request address length.\n", 1633 __func__)); 1634 KEY_FREESP(&newsp); 1635 *error = EINVAL; 1636 return NULL; 1637 } 1638 bcopy(paddr, &(*p_isr)->saidx.dst, 1639 paddr->sa_len); 1640 } 1641 1642 (*p_isr)->sp = newsp; 1643 1644 /* initialization for the next. */ 1645 p_isr = &(*p_isr)->next; 1646 tlen -= xisr->sadb_x_ipsecrequest_len; 1647 1648 /* validity check */ 1649 if (tlen < 0) { 1650 ipseclog((LOG_DEBUG, "%s: becoming tlen < 0.\n", 1651 __func__)); 1652 KEY_FREESP(&newsp); 1653 *error = EINVAL; 1654 return NULL; 1655 } 1656 1657 xisr = (struct sadb_x_ipsecrequest *)((caddr_t)xisr 1658 + xisr->sadb_x_ipsecrequest_len); 1659 } 1660 } 1661 break; 1662 default: 1663 ipseclog((LOG_DEBUG, "%s: invalid policy type.\n", __func__)); 1664 KEY_FREESP(&newsp); 1665 *error = EINVAL; 1666 return NULL; 1667 } 1668 1669 *error = 0; 1670 return newsp; 1671 } 1672 1673 static u_int32_t 1674 key_newreqid() 1675 { 1676 static u_int32_t auto_reqid = IPSEC_MANUAL_REQID_MAX + 1; 1677 1678 auto_reqid = (auto_reqid == ~0 1679 ? IPSEC_MANUAL_REQID_MAX + 1 : auto_reqid + 1); 1680 1681 /* XXX should be unique check */ 1682 1683 return auto_reqid; 1684 } 1685 1686 /* 1687 * copy secpolicy struct to sadb_x_policy structure indicated. 1688 */ 1689 struct mbuf * 1690 key_sp2msg(struct secpolicy *sp) 1691 { 1692 struct sadb_x_policy *xpl; 1693 int tlen; 1694 caddr_t p; 1695 struct mbuf *m; 1696 1697 IPSEC_ASSERT(sp != NULL, ("null policy")); 1698 1699 tlen = key_getspreqmsglen(sp); 1700 1701 m = m_get2(tlen, M_NOWAIT, MT_DATA, 0); 1702 if (m == NULL) 1703 return (NULL); 1704 m_align(m, tlen); 1705 m->m_len = tlen; 1706 xpl = mtod(m, struct sadb_x_policy *); 1707 bzero(xpl, tlen); 1708 1709 xpl->sadb_x_policy_len = PFKEY_UNIT64(tlen); 1710 xpl->sadb_x_policy_exttype = SADB_X_EXT_POLICY; 1711 xpl->sadb_x_policy_type = sp->policy; 1712 xpl->sadb_x_policy_dir = sp->spidx.dir; 1713 xpl->sadb_x_policy_id = sp->id; 1714 xpl->sadb_x_policy_priority = sp->priority; 1715 p = (caddr_t)xpl + sizeof(*xpl); 1716 1717 /* if is the policy for ipsec ? */ 1718 if (sp->policy == IPSEC_POLICY_IPSEC) { 1719 struct sadb_x_ipsecrequest *xisr; 1720 struct ipsecrequest *isr; 1721 1722 for (isr = sp->req; isr != NULL; isr = isr->next) { 1723 1724 xisr = (struct sadb_x_ipsecrequest *)p; 1725 1726 xisr->sadb_x_ipsecrequest_proto = isr->saidx.proto; 1727 xisr->sadb_x_ipsecrequest_mode = isr->saidx.mode; 1728 xisr->sadb_x_ipsecrequest_level = isr->level; 1729 xisr->sadb_x_ipsecrequest_reqid = isr->saidx.reqid; 1730 1731 p += sizeof(*xisr); 1732 bcopy(&isr->saidx.src, p, isr->saidx.src.sa.sa_len); 1733 p += isr->saidx.src.sa.sa_len; 1734 bcopy(&isr->saidx.dst, p, isr->saidx.dst.sa.sa_len); 1735 p += isr->saidx.src.sa.sa_len; 1736 1737 xisr->sadb_x_ipsecrequest_len = 1738 PFKEY_ALIGN8(sizeof(*xisr) 1739 + isr->saidx.src.sa.sa_len 1740 + isr->saidx.dst.sa.sa_len); 1741 } 1742 } 1743 1744 return m; 1745 } 1746 1747 /* m will not be freed nor modified */ 1748 static struct mbuf * 1749 key_gather_mbuf(struct mbuf *m, const struct sadb_msghdr *mhp, 1750 int ndeep, int nitem, ...) 1751 { 1752 va_list ap; 1753 int idx; 1754 int i; 1755 struct mbuf *result = NULL, *n; 1756 int len; 1757 1758 IPSEC_ASSERT(m != NULL, ("null mbuf")); 1759 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 1760 1761 va_start(ap, nitem); 1762 for (i = 0; i < nitem; i++) { 1763 idx = va_arg(ap, int); 1764 if (idx < 0 || idx > SADB_EXT_MAX) 1765 goto fail; 1766 /* don't attempt to pull empty extension */ 1767 if (idx == SADB_EXT_RESERVED && mhp->msg == NULL) 1768 continue; 1769 if (idx != SADB_EXT_RESERVED && 1770 (mhp->ext[idx] == NULL || mhp->extlen[idx] == 0)) 1771 continue; 1772 1773 if (idx == SADB_EXT_RESERVED) { 1774 len = PFKEY_ALIGN8(sizeof(struct sadb_msg)); 1775 1776 IPSEC_ASSERT(len <= MHLEN, ("header too big %u", len)); 1777 1778 MGETHDR(n, M_NOWAIT, MT_DATA); 1779 if (!n) 1780 goto fail; 1781 n->m_len = len; 1782 n->m_next = NULL; 1783 m_copydata(m, 0, sizeof(struct sadb_msg), 1784 mtod(n, caddr_t)); 1785 } else if (i < ndeep) { 1786 len = mhp->extlen[idx]; 1787 n = m_get2(len, M_NOWAIT, MT_DATA, 0); 1788 if (n == NULL) 1789 goto fail; 1790 m_align(n, len); 1791 n->m_len = len; 1792 m_copydata(m, mhp->extoff[idx], mhp->extlen[idx], 1793 mtod(n, caddr_t)); 1794 } else { 1795 n = m_copym(m, mhp->extoff[idx], mhp->extlen[idx], 1796 M_NOWAIT); 1797 } 1798 if (n == NULL) 1799 goto fail; 1800 1801 if (result) 1802 m_cat(result, n); 1803 else 1804 result = n; 1805 } 1806 va_end(ap); 1807 1808 if ((result->m_flags & M_PKTHDR) != 0) { 1809 result->m_pkthdr.len = 0; 1810 for (n = result; n; n = n->m_next) 1811 result->m_pkthdr.len += n->m_len; 1812 } 1813 1814 return result; 1815 1816 fail: 1817 m_freem(result); 1818 va_end(ap); 1819 return NULL; 1820 } 1821 1822 /* 1823 * SADB_X_SPDADD, SADB_X_SPDSETIDX or SADB_X_SPDUPDATE processing 1824 * add an entry to SP database, when received 1825 * <base, address(SD), (lifetime(H),) policy> 1826 * from the user(?). 1827 * Adding to SP database, 1828 * and send 1829 * <base, address(SD), (lifetime(H),) policy> 1830 * to the socket which was send. 1831 * 1832 * SPDADD set a unique policy entry. 1833 * SPDSETIDX like SPDADD without a part of policy requests. 1834 * SPDUPDATE replace a unique policy entry. 1835 * 1836 * m will always be freed. 1837 */ 1838 static int 1839 key_spdadd(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 1840 { 1841 struct sadb_address *src0, *dst0; 1842 struct sadb_x_policy *xpl0, *xpl; 1843 struct sadb_lifetime *lft = NULL; 1844 struct secpolicyindex spidx; 1845 struct secpolicy *newsp; 1846 int error; 1847 1848 IPSEC_ASSERT(so != NULL, ("null socket")); 1849 IPSEC_ASSERT(m != NULL, ("null mbuf")); 1850 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 1851 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 1852 1853 if (mhp->ext[SADB_EXT_ADDRESS_SRC] == NULL || 1854 mhp->ext[SADB_EXT_ADDRESS_DST] == NULL || 1855 mhp->ext[SADB_X_EXT_POLICY] == NULL) { 1856 ipseclog((LOG_DEBUG, "key_spdadd: invalid message is passed.\n")); 1857 return key_senderror(so, m, EINVAL); 1858 } 1859 if (mhp->extlen[SADB_EXT_ADDRESS_SRC] < sizeof(struct sadb_address) || 1860 mhp->extlen[SADB_EXT_ADDRESS_DST] < sizeof(struct sadb_address) || 1861 mhp->extlen[SADB_X_EXT_POLICY] < sizeof(struct sadb_x_policy)) { 1862 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 1863 __func__)); 1864 return key_senderror(so, m, EINVAL); 1865 } 1866 if (mhp->ext[SADB_EXT_LIFETIME_HARD] != NULL) { 1867 if (mhp->extlen[SADB_EXT_LIFETIME_HARD] 1868 < sizeof(struct sadb_lifetime)) { 1869 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 1870 __func__)); 1871 return key_senderror(so, m, EINVAL); 1872 } 1873 lft = (struct sadb_lifetime *)mhp->ext[SADB_EXT_LIFETIME_HARD]; 1874 } 1875 1876 src0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_SRC]; 1877 dst0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_DST]; 1878 xpl0 = (struct sadb_x_policy *)mhp->ext[SADB_X_EXT_POLICY]; 1879 1880 /* 1881 * Note: do not parse SADB_X_EXT_NAT_T_* here: 1882 * we are processing traffic endpoints. 1883 */ 1884 1885 /* make secindex */ 1886 /* XXX boundary check against sa_len */ 1887 KEY_SETSECSPIDX(xpl0->sadb_x_policy_dir, 1888 src0 + 1, 1889 dst0 + 1, 1890 src0->sadb_address_prefixlen, 1891 dst0->sadb_address_prefixlen, 1892 src0->sadb_address_proto, 1893 &spidx); 1894 1895 /* checking the direciton. */ 1896 switch (xpl0->sadb_x_policy_dir) { 1897 case IPSEC_DIR_INBOUND: 1898 case IPSEC_DIR_OUTBOUND: 1899 break; 1900 default: 1901 ipseclog((LOG_DEBUG, "%s: Invalid SP direction.\n", __func__)); 1902 mhp->msg->sadb_msg_errno = EINVAL; 1903 return 0; 1904 } 1905 1906 /* check policy */ 1907 /* key_spdadd() accepts DISCARD, NONE and IPSEC. */ 1908 if (xpl0->sadb_x_policy_type == IPSEC_POLICY_ENTRUST 1909 || xpl0->sadb_x_policy_type == IPSEC_POLICY_BYPASS) { 1910 ipseclog((LOG_DEBUG, "%s: Invalid policy type.\n", __func__)); 1911 return key_senderror(so, m, EINVAL); 1912 } 1913 1914 /* policy requests are mandatory when action is ipsec. */ 1915 if (mhp->msg->sadb_msg_type != SADB_X_SPDSETIDX 1916 && xpl0->sadb_x_policy_type == IPSEC_POLICY_IPSEC 1917 && mhp->extlen[SADB_X_EXT_POLICY] <= sizeof(*xpl0)) { 1918 ipseclog((LOG_DEBUG, "%s: some policy requests part required\n", 1919 __func__)); 1920 return key_senderror(so, m, EINVAL); 1921 } 1922 1923 /* 1924 * checking there is SP already or not. 1925 * SPDUPDATE doesn't depend on whether there is a SP or not. 1926 * If the type is either SPDADD or SPDSETIDX AND a SP is found, 1927 * then error. 1928 */ 1929 newsp = key_getsp(&spidx); 1930 if (mhp->msg->sadb_msg_type == SADB_X_SPDUPDATE) { 1931 if (newsp) { 1932 key_unlink(newsp); 1933 KEY_FREESP(&newsp); 1934 } 1935 } else { 1936 if (newsp != NULL) { 1937 KEY_FREESP(&newsp); 1938 ipseclog((LOG_DEBUG, "%s: a SP entry exists already.\n", 1939 __func__)); 1940 return key_senderror(so, m, EEXIST); 1941 } 1942 } 1943 1944 /* XXX: there is race between key_getsp and key_msg2sp. */ 1945 1946 /* allocation new SP entry */ 1947 if ((newsp = key_msg2sp(xpl0, PFKEY_EXTLEN(xpl0), &error)) == NULL) { 1948 return key_senderror(so, m, error); 1949 } 1950 1951 if ((newsp->id = key_getnewspid()) == 0) { 1952 KEY_FREESP(&newsp); 1953 return key_senderror(so, m, ENOBUFS); 1954 } 1955 1956 /* XXX boundary check against sa_len */ 1957 KEY_SETSECSPIDX(xpl0->sadb_x_policy_dir, 1958 src0 + 1, 1959 dst0 + 1, 1960 src0->sadb_address_prefixlen, 1961 dst0->sadb_address_prefixlen, 1962 src0->sadb_address_proto, 1963 &newsp->spidx); 1964 1965 /* sanity check on addr pair */ 1966 if (((struct sockaddr *)(src0 + 1))->sa_family != 1967 ((struct sockaddr *)(dst0+ 1))->sa_family) { 1968 KEY_FREESP(&newsp); 1969 return key_senderror(so, m, EINVAL); 1970 } 1971 if (((struct sockaddr *)(src0 + 1))->sa_len != 1972 ((struct sockaddr *)(dst0+ 1))->sa_len) { 1973 KEY_FREESP(&newsp); 1974 return key_senderror(so, m, EINVAL); 1975 } 1976 #if 1 1977 if (newsp->req && newsp->req->saidx.src.sa.sa_family && 1978 newsp->req->saidx.dst.sa.sa_family) { 1979 if (newsp->req->saidx.src.sa.sa_family != 1980 newsp->req->saidx.dst.sa.sa_family) { 1981 KEY_FREESP(&newsp); 1982 return key_senderror(so, m, EINVAL); 1983 } 1984 } 1985 #endif 1986 1987 newsp->created = time_second; 1988 newsp->lastused = newsp->created; 1989 newsp->lifetime = lft ? lft->sadb_lifetime_addtime : 0; 1990 newsp->validtime = lft ? lft->sadb_lifetime_usetime : 0; 1991 1992 key_insertsp(newsp); 1993 1994 /* delete the entry in spacqtree */ 1995 if (mhp->msg->sadb_msg_type == SADB_X_SPDUPDATE) { 1996 struct secspacq *spacq = key_getspacq(&spidx); 1997 if (spacq != NULL) { 1998 /* reset counter in order to deletion by timehandler. */ 1999 spacq->created = time_second; 2000 spacq->count = 0; 2001 SPACQ_UNLOCK(); 2002 } 2003 } 2004 2005 { 2006 struct mbuf *n, *mpolicy; 2007 struct sadb_msg *newmsg; 2008 int off; 2009 2010 /* 2011 * Note: do not send SADB_X_EXT_NAT_T_* here: 2012 * we are sending traffic endpoints. 2013 */ 2014 2015 /* create new sadb_msg to reply. */ 2016 if (lft) { 2017 n = key_gather_mbuf(m, mhp, 2, 5, SADB_EXT_RESERVED, 2018 SADB_X_EXT_POLICY, SADB_EXT_LIFETIME_HARD, 2019 SADB_EXT_ADDRESS_SRC, SADB_EXT_ADDRESS_DST); 2020 } else { 2021 n = key_gather_mbuf(m, mhp, 2, 4, SADB_EXT_RESERVED, 2022 SADB_X_EXT_POLICY, 2023 SADB_EXT_ADDRESS_SRC, SADB_EXT_ADDRESS_DST); 2024 } 2025 if (!n) 2026 return key_senderror(so, m, ENOBUFS); 2027 2028 if (n->m_len < sizeof(*newmsg)) { 2029 n = m_pullup(n, sizeof(*newmsg)); 2030 if (!n) 2031 return key_senderror(so, m, ENOBUFS); 2032 } 2033 newmsg = mtod(n, struct sadb_msg *); 2034 newmsg->sadb_msg_errno = 0; 2035 newmsg->sadb_msg_len = PFKEY_UNIT64(n->m_pkthdr.len); 2036 2037 off = 0; 2038 mpolicy = m_pulldown(n, PFKEY_ALIGN8(sizeof(struct sadb_msg)), 2039 sizeof(*xpl), &off); 2040 if (mpolicy == NULL) { 2041 /* n is already freed */ 2042 return key_senderror(so, m, ENOBUFS); 2043 } 2044 xpl = (struct sadb_x_policy *)(mtod(mpolicy, caddr_t) + off); 2045 if (xpl->sadb_x_policy_exttype != SADB_X_EXT_POLICY) { 2046 m_freem(n); 2047 return key_senderror(so, m, EINVAL); 2048 } 2049 xpl->sadb_x_policy_id = newsp->id; 2050 2051 m_freem(m); 2052 return key_sendup_mbuf(so, n, KEY_SENDUP_ALL); 2053 } 2054 } 2055 2056 /* 2057 * get new policy id. 2058 * OUT: 2059 * 0: failure. 2060 * others: success. 2061 */ 2062 static u_int32_t 2063 key_getnewspid() 2064 { 2065 u_int32_t newid = 0; 2066 int count = V_key_spi_trycnt; /* XXX */ 2067 struct secpolicy *sp; 2068 2069 /* when requesting to allocate spi ranged */ 2070 while (count--) { 2071 newid = (V_policy_id = (V_policy_id == ~0 ? 1 : V_policy_id + 1)); 2072 2073 if ((sp = key_getspbyid(newid)) == NULL) 2074 break; 2075 2076 KEY_FREESP(&sp); 2077 } 2078 2079 if (count == 0 || newid == 0) { 2080 ipseclog((LOG_DEBUG, "%s: to allocate policy id is failed.\n", 2081 __func__)); 2082 return 0; 2083 } 2084 2085 return newid; 2086 } 2087 2088 /* 2089 * SADB_SPDDELETE processing 2090 * receive 2091 * <base, address(SD), policy(*)> 2092 * from the user(?), and set SADB_SASTATE_DEAD, 2093 * and send, 2094 * <base, address(SD), policy(*)> 2095 * to the ikmpd. 2096 * policy(*) including direction of policy. 2097 * 2098 * m will always be freed. 2099 */ 2100 static int 2101 key_spddelete(struct socket *so, struct mbuf *m, 2102 const struct sadb_msghdr *mhp) 2103 { 2104 struct sadb_address *src0, *dst0; 2105 struct sadb_x_policy *xpl0; 2106 struct secpolicyindex spidx; 2107 struct secpolicy *sp; 2108 2109 IPSEC_ASSERT(so != NULL, ("null so")); 2110 IPSEC_ASSERT(m != NULL, ("null mbuf")); 2111 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 2112 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 2113 2114 if (mhp->ext[SADB_EXT_ADDRESS_SRC] == NULL || 2115 mhp->ext[SADB_EXT_ADDRESS_DST] == NULL || 2116 mhp->ext[SADB_X_EXT_POLICY] == NULL) { 2117 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 2118 __func__)); 2119 return key_senderror(so, m, EINVAL); 2120 } 2121 if (mhp->extlen[SADB_EXT_ADDRESS_SRC] < sizeof(struct sadb_address) || 2122 mhp->extlen[SADB_EXT_ADDRESS_DST] < sizeof(struct sadb_address) || 2123 mhp->extlen[SADB_X_EXT_POLICY] < sizeof(struct sadb_x_policy)) { 2124 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 2125 __func__)); 2126 return key_senderror(so, m, EINVAL); 2127 } 2128 2129 src0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_SRC]; 2130 dst0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_DST]; 2131 xpl0 = (struct sadb_x_policy *)mhp->ext[SADB_X_EXT_POLICY]; 2132 2133 /* 2134 * Note: do not parse SADB_X_EXT_NAT_T_* here: 2135 * we are processing traffic endpoints. 2136 */ 2137 2138 /* make secindex */ 2139 /* XXX boundary check against sa_len */ 2140 KEY_SETSECSPIDX(xpl0->sadb_x_policy_dir, 2141 src0 + 1, 2142 dst0 + 1, 2143 src0->sadb_address_prefixlen, 2144 dst0->sadb_address_prefixlen, 2145 src0->sadb_address_proto, 2146 &spidx); 2147 2148 /* checking the direciton. */ 2149 switch (xpl0->sadb_x_policy_dir) { 2150 case IPSEC_DIR_INBOUND: 2151 case IPSEC_DIR_OUTBOUND: 2152 break; 2153 default: 2154 ipseclog((LOG_DEBUG, "%s: Invalid SP direction.\n", __func__)); 2155 return key_senderror(so, m, EINVAL); 2156 } 2157 2158 /* Is there SP in SPD ? */ 2159 if ((sp = key_getsp(&spidx)) == NULL) { 2160 ipseclog((LOG_DEBUG, "%s: no SP found.\n", __func__)); 2161 return key_senderror(so, m, EINVAL); 2162 } 2163 2164 /* save policy id to buffer to be returned. */ 2165 xpl0->sadb_x_policy_id = sp->id; 2166 2167 key_unlink(sp); 2168 KEY_FREESP(&sp); 2169 2170 { 2171 struct mbuf *n; 2172 struct sadb_msg *newmsg; 2173 2174 /* 2175 * Note: do not send SADB_X_EXT_NAT_T_* here: 2176 * we are sending traffic endpoints. 2177 */ 2178 2179 /* create new sadb_msg to reply. */ 2180 n = key_gather_mbuf(m, mhp, 1, 4, SADB_EXT_RESERVED, 2181 SADB_X_EXT_POLICY, SADB_EXT_ADDRESS_SRC, SADB_EXT_ADDRESS_DST); 2182 if (!n) 2183 return key_senderror(so, m, ENOBUFS); 2184 2185 newmsg = mtod(n, struct sadb_msg *); 2186 newmsg->sadb_msg_errno = 0; 2187 newmsg->sadb_msg_len = PFKEY_UNIT64(n->m_pkthdr.len); 2188 2189 m_freem(m); 2190 return key_sendup_mbuf(so, n, KEY_SENDUP_ALL); 2191 } 2192 } 2193 2194 /* 2195 * SADB_SPDDELETE2 processing 2196 * receive 2197 * <base, policy(*)> 2198 * from the user(?), and set SADB_SASTATE_DEAD, 2199 * and send, 2200 * <base, policy(*)> 2201 * to the ikmpd. 2202 * policy(*) including direction of policy. 2203 * 2204 * m will always be freed. 2205 */ 2206 static int 2207 key_spddelete2(struct socket *so, struct mbuf *m, 2208 const struct sadb_msghdr *mhp) 2209 { 2210 u_int32_t id; 2211 struct secpolicy *sp; 2212 2213 IPSEC_ASSERT(so != NULL, ("null socket")); 2214 IPSEC_ASSERT(m != NULL, ("null mbuf")); 2215 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 2216 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 2217 2218 if (mhp->ext[SADB_X_EXT_POLICY] == NULL || 2219 mhp->extlen[SADB_X_EXT_POLICY] < sizeof(struct sadb_x_policy)) { 2220 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", __func__)); 2221 return key_senderror(so, m, EINVAL); 2222 } 2223 2224 id = ((struct sadb_x_policy *)mhp->ext[SADB_X_EXT_POLICY])->sadb_x_policy_id; 2225 2226 /* Is there SP in SPD ? */ 2227 if ((sp = key_getspbyid(id)) == NULL) { 2228 ipseclog((LOG_DEBUG, "%s: no SP found id:%u.\n", __func__, id)); 2229 return key_senderror(so, m, EINVAL); 2230 } 2231 2232 key_unlink(sp); 2233 KEY_FREESP(&sp); 2234 2235 { 2236 struct mbuf *n, *nn; 2237 struct sadb_msg *newmsg; 2238 int off, len; 2239 2240 /* create new sadb_msg to reply. */ 2241 len = PFKEY_ALIGN8(sizeof(struct sadb_msg)); 2242 2243 MGETHDR(n, M_NOWAIT, MT_DATA); 2244 if (n && len > MHLEN) { 2245 if (!(MCLGET(n, M_NOWAIT))) { 2246 m_freem(n); 2247 n = NULL; 2248 } 2249 } 2250 if (!n) 2251 return key_senderror(so, m, ENOBUFS); 2252 2253 n->m_len = len; 2254 n->m_next = NULL; 2255 off = 0; 2256 2257 m_copydata(m, 0, sizeof(struct sadb_msg), mtod(n, caddr_t) + off); 2258 off += PFKEY_ALIGN8(sizeof(struct sadb_msg)); 2259 2260 IPSEC_ASSERT(off == len, ("length inconsistency (off %u len %u)", 2261 off, len)); 2262 2263 n->m_next = m_copym(m, mhp->extoff[SADB_X_EXT_POLICY], 2264 mhp->extlen[SADB_X_EXT_POLICY], M_NOWAIT); 2265 if (!n->m_next) { 2266 m_freem(n); 2267 return key_senderror(so, m, ENOBUFS); 2268 } 2269 2270 n->m_pkthdr.len = 0; 2271 for (nn = n; nn; nn = nn->m_next) 2272 n->m_pkthdr.len += nn->m_len; 2273 2274 newmsg = mtod(n, struct sadb_msg *); 2275 newmsg->sadb_msg_errno = 0; 2276 newmsg->sadb_msg_len = PFKEY_UNIT64(n->m_pkthdr.len); 2277 2278 m_freem(m); 2279 return key_sendup_mbuf(so, n, KEY_SENDUP_ALL); 2280 } 2281 } 2282 2283 /* 2284 * SADB_X_SPDGET processing 2285 * receive 2286 * <base, policy(*)> 2287 * from the user(?), 2288 * and send, 2289 * <base, address(SD), policy> 2290 * to the ikmpd. 2291 * policy(*) including direction of policy. 2292 * 2293 * m will always be freed. 2294 */ 2295 static int 2296 key_spdget(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 2297 { 2298 u_int32_t id; 2299 struct secpolicy *sp; 2300 struct mbuf *n; 2301 2302 IPSEC_ASSERT(so != NULL, ("null socket")); 2303 IPSEC_ASSERT(m != NULL, ("null mbuf")); 2304 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 2305 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 2306 2307 if (mhp->ext[SADB_X_EXT_POLICY] == NULL || 2308 mhp->extlen[SADB_X_EXT_POLICY] < sizeof(struct sadb_x_policy)) { 2309 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 2310 __func__)); 2311 return key_senderror(so, m, EINVAL); 2312 } 2313 2314 id = ((struct sadb_x_policy *)mhp->ext[SADB_X_EXT_POLICY])->sadb_x_policy_id; 2315 2316 /* Is there SP in SPD ? */ 2317 if ((sp = key_getspbyid(id)) == NULL) { 2318 ipseclog((LOG_DEBUG, "%s: no SP found id:%u.\n", __func__, id)); 2319 return key_senderror(so, m, ENOENT); 2320 } 2321 2322 n = key_setdumpsp(sp, SADB_X_SPDGET, mhp->msg->sadb_msg_seq, 2323 mhp->msg->sadb_msg_pid); 2324 KEY_FREESP(&sp); 2325 if (n != NULL) { 2326 m_freem(m); 2327 return key_sendup_mbuf(so, n, KEY_SENDUP_ONE); 2328 } else 2329 return key_senderror(so, m, ENOBUFS); 2330 } 2331 2332 /* 2333 * SADB_X_SPDACQUIRE processing. 2334 * Acquire policy and SA(s) for a *OUTBOUND* packet. 2335 * send 2336 * <base, policy(*)> 2337 * to KMD, and expect to receive 2338 * <base> with SADB_X_SPDACQUIRE if error occured, 2339 * or 2340 * <base, policy> 2341 * with SADB_X_SPDUPDATE from KMD by PF_KEY. 2342 * policy(*) is without policy requests. 2343 * 2344 * 0 : succeed 2345 * others: error number 2346 */ 2347 int 2348 key_spdacquire(struct secpolicy *sp) 2349 { 2350 struct mbuf *result = NULL, *m; 2351 struct secspacq *newspacq; 2352 2353 IPSEC_ASSERT(sp != NULL, ("null secpolicy")); 2354 IPSEC_ASSERT(sp->req == NULL, ("policy exists")); 2355 IPSEC_ASSERT(sp->policy == IPSEC_POLICY_IPSEC, 2356 ("policy not IPSEC %u", sp->policy)); 2357 2358 /* Get an entry to check whether sent message or not. */ 2359 newspacq = key_getspacq(&sp->spidx); 2360 if (newspacq != NULL) { 2361 if (V_key_blockacq_count < newspacq->count) { 2362 /* reset counter and do send message. */ 2363 newspacq->count = 0; 2364 } else { 2365 /* increment counter and do nothing. */ 2366 newspacq->count++; 2367 SPACQ_UNLOCK(); 2368 return (0); 2369 } 2370 SPACQ_UNLOCK(); 2371 } else { 2372 /* make new entry for blocking to send SADB_ACQUIRE. */ 2373 newspacq = key_newspacq(&sp->spidx); 2374 if (newspacq == NULL) 2375 return ENOBUFS; 2376 } 2377 2378 /* create new sadb_msg to reply. */ 2379 m = key_setsadbmsg(SADB_X_SPDACQUIRE, 0, 0, 0, 0, 0); 2380 if (!m) 2381 return ENOBUFS; 2382 2383 result = m; 2384 2385 result->m_pkthdr.len = 0; 2386 for (m = result; m; m = m->m_next) 2387 result->m_pkthdr.len += m->m_len; 2388 2389 mtod(result, struct sadb_msg *)->sadb_msg_len = 2390 PFKEY_UNIT64(result->m_pkthdr.len); 2391 2392 return key_sendup_mbuf(NULL, m, KEY_SENDUP_REGISTERED); 2393 } 2394 2395 /* 2396 * SADB_SPDFLUSH processing 2397 * receive 2398 * <base> 2399 * from the user, and free all entries in secpctree. 2400 * and send, 2401 * <base> 2402 * to the user. 2403 * NOTE: what to do is only marking SADB_SASTATE_DEAD. 2404 * 2405 * m will always be freed. 2406 */ 2407 static int 2408 key_spdflush(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 2409 { 2410 TAILQ_HEAD(, secpolicy) drainq; 2411 struct sadb_msg *newmsg; 2412 struct secpolicy *sp, *nextsp; 2413 u_int dir; 2414 2415 IPSEC_ASSERT(so != NULL, ("null socket")); 2416 IPSEC_ASSERT(m != NULL, ("null mbuf")); 2417 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 2418 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 2419 2420 if (m->m_len != PFKEY_ALIGN8(sizeof(struct sadb_msg))) 2421 return key_senderror(so, m, EINVAL); 2422 2423 TAILQ_INIT(&drainq); 2424 SPTREE_WLOCK(); 2425 for (dir = 0; dir < IPSEC_DIR_MAX; dir++) { 2426 TAILQ_CONCAT(&drainq, &V_sptree[dir], chain); 2427 } 2428 /* 2429 * We need to set state to DEAD for each policy to be sure, 2430 * that another thread won't try to unlink it. 2431 */ 2432 TAILQ_FOREACH(sp, &drainq, chain) 2433 sp->state = IPSEC_SPSTATE_DEAD; 2434 SPTREE_WUNLOCK(); 2435 sp = TAILQ_FIRST(&drainq); 2436 while (sp != NULL) { 2437 nextsp = TAILQ_NEXT(sp, chain); 2438 KEY_FREESP(&sp); 2439 sp = nextsp; 2440 } 2441 2442 if (sizeof(struct sadb_msg) > m->m_len + M_TRAILINGSPACE(m)) { 2443 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 2444 return key_senderror(so, m, ENOBUFS); 2445 } 2446 2447 if (m->m_next) 2448 m_freem(m->m_next); 2449 m->m_next = NULL; 2450 m->m_pkthdr.len = m->m_len = PFKEY_ALIGN8(sizeof(struct sadb_msg)); 2451 newmsg = mtod(m, struct sadb_msg *); 2452 newmsg->sadb_msg_errno = 0; 2453 newmsg->sadb_msg_len = PFKEY_UNIT64(m->m_pkthdr.len); 2454 2455 return key_sendup_mbuf(so, m, KEY_SENDUP_ALL); 2456 } 2457 2458 /* 2459 * SADB_SPDDUMP processing 2460 * receive 2461 * <base> 2462 * from the user, and dump all SP leaves 2463 * and send, 2464 * <base> ..... 2465 * to the ikmpd. 2466 * 2467 * m will always be freed. 2468 */ 2469 static int 2470 key_spddump(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 2471 { 2472 SPTREE_RLOCK_TRACKER; 2473 struct secpolicy *sp; 2474 int cnt; 2475 u_int dir; 2476 struct mbuf *n; 2477 2478 IPSEC_ASSERT(so != NULL, ("null socket")); 2479 IPSEC_ASSERT(m != NULL, ("null mbuf")); 2480 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 2481 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 2482 2483 /* search SPD entry and get buffer size. */ 2484 cnt = 0; 2485 SPTREE_RLOCK(); 2486 for (dir = 0; dir < IPSEC_DIR_MAX; dir++) { 2487 TAILQ_FOREACH(sp, &V_sptree[dir], chain) { 2488 cnt++; 2489 } 2490 } 2491 2492 if (cnt == 0) { 2493 SPTREE_RUNLOCK(); 2494 return key_senderror(so, m, ENOENT); 2495 } 2496 2497 for (dir = 0; dir < IPSEC_DIR_MAX; dir++) { 2498 TAILQ_FOREACH(sp, &V_sptree[dir], chain) { 2499 --cnt; 2500 n = key_setdumpsp(sp, SADB_X_SPDDUMP, cnt, 2501 mhp->msg->sadb_msg_pid); 2502 2503 if (n) 2504 key_sendup_mbuf(so, n, KEY_SENDUP_ONE); 2505 } 2506 } 2507 2508 SPTREE_RUNLOCK(); 2509 m_freem(m); 2510 return 0; 2511 } 2512 2513 static struct mbuf * 2514 key_setdumpsp(struct secpolicy *sp, u_int8_t type, u_int32_t seq, 2515 u_int32_t pid) 2516 { 2517 struct mbuf *result = NULL, *m; 2518 struct seclifetime lt; 2519 2520 m = key_setsadbmsg(type, 0, SADB_SATYPE_UNSPEC, seq, pid, sp->refcnt); 2521 if (!m) 2522 goto fail; 2523 result = m; 2524 2525 /* 2526 * Note: do not send SADB_X_EXT_NAT_T_* here: 2527 * we are sending traffic endpoints. 2528 */ 2529 m = key_setsadbaddr(SADB_EXT_ADDRESS_SRC, 2530 &sp->spidx.src.sa, sp->spidx.prefs, 2531 sp->spidx.ul_proto); 2532 if (!m) 2533 goto fail; 2534 m_cat(result, m); 2535 2536 m = key_setsadbaddr(SADB_EXT_ADDRESS_DST, 2537 &sp->spidx.dst.sa, sp->spidx.prefd, 2538 sp->spidx.ul_proto); 2539 if (!m) 2540 goto fail; 2541 m_cat(result, m); 2542 2543 m = key_sp2msg(sp); 2544 if (!m) 2545 goto fail; 2546 m_cat(result, m); 2547 2548 if(sp->lifetime){ 2549 lt.addtime=sp->created; 2550 lt.usetime= sp->lastused; 2551 m = key_setlifetime(<, SADB_EXT_LIFETIME_CURRENT); 2552 if (!m) 2553 goto fail; 2554 m_cat(result, m); 2555 2556 lt.addtime=sp->lifetime; 2557 lt.usetime= sp->validtime; 2558 m = key_setlifetime(<, SADB_EXT_LIFETIME_HARD); 2559 if (!m) 2560 goto fail; 2561 m_cat(result, m); 2562 } 2563 2564 if ((result->m_flags & M_PKTHDR) == 0) 2565 goto fail; 2566 2567 if (result->m_len < sizeof(struct sadb_msg)) { 2568 result = m_pullup(result, sizeof(struct sadb_msg)); 2569 if (result == NULL) 2570 goto fail; 2571 } 2572 2573 result->m_pkthdr.len = 0; 2574 for (m = result; m; m = m->m_next) 2575 result->m_pkthdr.len += m->m_len; 2576 2577 mtod(result, struct sadb_msg *)->sadb_msg_len = 2578 PFKEY_UNIT64(result->m_pkthdr.len); 2579 2580 return result; 2581 2582 fail: 2583 m_freem(result); 2584 return NULL; 2585 } 2586 2587 /* 2588 * get PFKEY message length for security policy and request. 2589 */ 2590 static u_int 2591 key_getspreqmsglen(struct secpolicy *sp) 2592 { 2593 u_int tlen; 2594 2595 tlen = sizeof(struct sadb_x_policy); 2596 2597 /* if is the policy for ipsec ? */ 2598 if (sp->policy != IPSEC_POLICY_IPSEC) 2599 return tlen; 2600 2601 /* get length of ipsec requests */ 2602 { 2603 struct ipsecrequest *isr; 2604 int len; 2605 2606 for (isr = sp->req; isr != NULL; isr = isr->next) { 2607 len = sizeof(struct sadb_x_ipsecrequest) 2608 + isr->saidx.src.sa.sa_len 2609 + isr->saidx.dst.sa.sa_len; 2610 2611 tlen += PFKEY_ALIGN8(len); 2612 } 2613 } 2614 2615 return tlen; 2616 } 2617 2618 /* 2619 * SADB_SPDEXPIRE processing 2620 * send 2621 * <base, address(SD), lifetime(CH), policy> 2622 * to KMD by PF_KEY. 2623 * 2624 * OUT: 0 : succeed 2625 * others : error number 2626 */ 2627 static int 2628 key_spdexpire(struct secpolicy *sp) 2629 { 2630 struct mbuf *result = NULL, *m; 2631 int len; 2632 int error = -1; 2633 struct sadb_lifetime *lt; 2634 2635 /* XXX: Why do we lock ? */ 2636 2637 IPSEC_ASSERT(sp != NULL, ("null secpolicy")); 2638 2639 /* set msg header */ 2640 m = key_setsadbmsg(SADB_X_SPDEXPIRE, 0, 0, 0, 0, 0); 2641 if (!m) { 2642 error = ENOBUFS; 2643 goto fail; 2644 } 2645 result = m; 2646 2647 /* create lifetime extension (current and hard) */ 2648 len = PFKEY_ALIGN8(sizeof(*lt)) * 2; 2649 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 2650 if (m == NULL) { 2651 error = ENOBUFS; 2652 goto fail; 2653 } 2654 m_align(m, len); 2655 m->m_len = len; 2656 bzero(mtod(m, caddr_t), len); 2657 lt = mtod(m, struct sadb_lifetime *); 2658 lt->sadb_lifetime_len = PFKEY_UNIT64(sizeof(struct sadb_lifetime)); 2659 lt->sadb_lifetime_exttype = SADB_EXT_LIFETIME_CURRENT; 2660 lt->sadb_lifetime_allocations = 0; 2661 lt->sadb_lifetime_bytes = 0; 2662 lt->sadb_lifetime_addtime = sp->created; 2663 lt->sadb_lifetime_usetime = sp->lastused; 2664 lt = (struct sadb_lifetime *)(mtod(m, caddr_t) + len / 2); 2665 lt->sadb_lifetime_len = PFKEY_UNIT64(sizeof(struct sadb_lifetime)); 2666 lt->sadb_lifetime_exttype = SADB_EXT_LIFETIME_HARD; 2667 lt->sadb_lifetime_allocations = 0; 2668 lt->sadb_lifetime_bytes = 0; 2669 lt->sadb_lifetime_addtime = sp->lifetime; 2670 lt->sadb_lifetime_usetime = sp->validtime; 2671 m_cat(result, m); 2672 2673 /* 2674 * Note: do not send SADB_X_EXT_NAT_T_* here: 2675 * we are sending traffic endpoints. 2676 */ 2677 2678 /* set sadb_address for source */ 2679 m = key_setsadbaddr(SADB_EXT_ADDRESS_SRC, 2680 &sp->spidx.src.sa, 2681 sp->spidx.prefs, sp->spidx.ul_proto); 2682 if (!m) { 2683 error = ENOBUFS; 2684 goto fail; 2685 } 2686 m_cat(result, m); 2687 2688 /* set sadb_address for destination */ 2689 m = key_setsadbaddr(SADB_EXT_ADDRESS_DST, 2690 &sp->spidx.dst.sa, 2691 sp->spidx.prefd, sp->spidx.ul_proto); 2692 if (!m) { 2693 error = ENOBUFS; 2694 goto fail; 2695 } 2696 m_cat(result, m); 2697 2698 /* set secpolicy */ 2699 m = key_sp2msg(sp); 2700 if (!m) { 2701 error = ENOBUFS; 2702 goto fail; 2703 } 2704 m_cat(result, m); 2705 2706 if ((result->m_flags & M_PKTHDR) == 0) { 2707 error = EINVAL; 2708 goto fail; 2709 } 2710 2711 if (result->m_len < sizeof(struct sadb_msg)) { 2712 result = m_pullup(result, sizeof(struct sadb_msg)); 2713 if (result == NULL) { 2714 error = ENOBUFS; 2715 goto fail; 2716 } 2717 } 2718 2719 result->m_pkthdr.len = 0; 2720 for (m = result; m; m = m->m_next) 2721 result->m_pkthdr.len += m->m_len; 2722 2723 mtod(result, struct sadb_msg *)->sadb_msg_len = 2724 PFKEY_UNIT64(result->m_pkthdr.len); 2725 2726 return key_sendup_mbuf(NULL, result, KEY_SENDUP_REGISTERED); 2727 2728 fail: 2729 if (result) 2730 m_freem(result); 2731 return error; 2732 } 2733 2734 /* %%% SAD management */ 2735 /* 2736 * allocating a memory for new SA head, and copy from the values of mhp. 2737 * OUT: NULL : failure due to the lack of memory. 2738 * others : pointer to new SA head. 2739 */ 2740 static struct secashead * 2741 key_newsah(struct secasindex *saidx) 2742 { 2743 struct secashead *newsah; 2744 2745 IPSEC_ASSERT(saidx != NULL, ("null saidx")); 2746 2747 newsah = malloc(sizeof(struct secashead), M_IPSEC_SAH, M_NOWAIT|M_ZERO); 2748 if (newsah != NULL) { 2749 int i; 2750 for (i = 0; i < sizeof(newsah->savtree)/sizeof(newsah->savtree[0]); i++) 2751 LIST_INIT(&newsah->savtree[i]); 2752 newsah->saidx = *saidx; 2753 2754 /* add to saidxtree */ 2755 newsah->state = SADB_SASTATE_MATURE; 2756 2757 SAHTREE_LOCK(); 2758 LIST_INSERT_HEAD(&V_sahtree, newsah, chain); 2759 SAHTREE_UNLOCK(); 2760 } 2761 return(newsah); 2762 } 2763 2764 /* 2765 * delete SA index and all SA registerd. 2766 */ 2767 static void 2768 key_delsah(struct secashead *sah) 2769 { 2770 struct secasvar *sav, *nextsav; 2771 u_int stateidx; 2772 int zombie = 0; 2773 2774 IPSEC_ASSERT(sah != NULL, ("NULL sah")); 2775 SAHTREE_LOCK_ASSERT(); 2776 2777 /* searching all SA registerd in the secindex. */ 2778 for (stateidx = 0; 2779 stateidx < _ARRAYLEN(saorder_state_any); 2780 stateidx++) { 2781 u_int state = saorder_state_any[stateidx]; 2782 LIST_FOREACH_SAFE(sav, &sah->savtree[state], chain, nextsav) { 2783 if (sav->refcnt == 0) { 2784 /* sanity check */ 2785 KEY_CHKSASTATE(state, sav->state, __func__); 2786 /* 2787 * do NOT call KEY_FREESAV here: 2788 * it will only delete the sav if refcnt == 1, 2789 * where we already know that refcnt == 0 2790 */ 2791 key_delsav(sav); 2792 } else { 2793 /* give up to delete this sa */ 2794 zombie++; 2795 } 2796 } 2797 } 2798 if (!zombie) { /* delete only if there are savs */ 2799 /* remove from tree of SA index */ 2800 if (__LIST_CHAINED(sah)) 2801 LIST_REMOVE(sah, chain); 2802 free(sah, M_IPSEC_SAH); 2803 } 2804 } 2805 2806 /* 2807 * allocating a new SA with LARVAL state. key_add() and key_getspi() call, 2808 * and copy the values of mhp into new buffer. 2809 * When SAD message type is GETSPI: 2810 * to set sequence number from acq_seq++, 2811 * to set zero to SPI. 2812 * not to call key_setsava(). 2813 * OUT: NULL : fail 2814 * others : pointer to new secasvar. 2815 * 2816 * does not modify mbuf. does not free mbuf on error. 2817 */ 2818 static struct secasvar * 2819 key_newsav(struct mbuf *m, const struct sadb_msghdr *mhp, 2820 struct secashead *sah, int *errp, const char *where, int tag) 2821 { 2822 struct secasvar *newsav; 2823 const struct sadb_sa *xsa; 2824 2825 IPSEC_ASSERT(m != NULL, ("null mbuf")); 2826 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 2827 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 2828 IPSEC_ASSERT(sah != NULL, ("null secashead")); 2829 2830 newsav = malloc(sizeof(struct secasvar), M_IPSEC_SA, M_NOWAIT|M_ZERO); 2831 if (newsav == NULL) { 2832 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 2833 *errp = ENOBUFS; 2834 goto done; 2835 } 2836 2837 switch (mhp->msg->sadb_msg_type) { 2838 case SADB_GETSPI: 2839 newsav->spi = 0; 2840 2841 #ifdef IPSEC_DOSEQCHECK 2842 /* sync sequence number */ 2843 if (mhp->msg->sadb_msg_seq == 0) 2844 newsav->seq = 2845 (V_acq_seq = (V_acq_seq == ~0 ? 1 : ++V_acq_seq)); 2846 else 2847 #endif 2848 newsav->seq = mhp->msg->sadb_msg_seq; 2849 break; 2850 2851 case SADB_ADD: 2852 /* sanity check */ 2853 if (mhp->ext[SADB_EXT_SA] == NULL) { 2854 free(newsav, M_IPSEC_SA); 2855 newsav = NULL; 2856 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 2857 __func__)); 2858 *errp = EINVAL; 2859 goto done; 2860 } 2861 xsa = (const struct sadb_sa *)mhp->ext[SADB_EXT_SA]; 2862 newsav->spi = xsa->sadb_sa_spi; 2863 newsav->seq = mhp->msg->sadb_msg_seq; 2864 break; 2865 default: 2866 free(newsav, M_IPSEC_SA); 2867 newsav = NULL; 2868 *errp = EINVAL; 2869 goto done; 2870 } 2871 2872 2873 /* copy sav values */ 2874 if (mhp->msg->sadb_msg_type != SADB_GETSPI) { 2875 *errp = key_setsaval(newsav, m, mhp); 2876 if (*errp) { 2877 free(newsav, M_IPSEC_SA); 2878 newsav = NULL; 2879 goto done; 2880 } 2881 } 2882 2883 SECASVAR_LOCK_INIT(newsav); 2884 2885 /* reset created */ 2886 newsav->created = time_second; 2887 newsav->pid = mhp->msg->sadb_msg_pid; 2888 2889 /* add to satree */ 2890 newsav->sah = sah; 2891 sa_initref(newsav); 2892 newsav->state = SADB_SASTATE_LARVAL; 2893 2894 SAHTREE_LOCK(); 2895 LIST_INSERT_TAIL(&sah->savtree[SADB_SASTATE_LARVAL], newsav, 2896 secasvar, chain); 2897 SAHTREE_UNLOCK(); 2898 done: 2899 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 2900 printf("DP %s from %s:%u return SP:%p\n", __func__, 2901 where, tag, newsav)); 2902 2903 return newsav; 2904 } 2905 2906 /* 2907 * free() SA variable entry. 2908 */ 2909 static void 2910 key_cleansav(struct secasvar *sav) 2911 { 2912 /* 2913 * Cleanup xform state. Note that zeroize'ing causes the 2914 * keys to be cleared; otherwise we must do it ourself. 2915 */ 2916 if (sav->tdb_xform != NULL) { 2917 sav->tdb_xform->xf_zeroize(sav); 2918 sav->tdb_xform = NULL; 2919 } else { 2920 if (sav->key_auth != NULL) 2921 bzero(sav->key_auth->key_data, _KEYLEN(sav->key_auth)); 2922 if (sav->key_enc != NULL) 2923 bzero(sav->key_enc->key_data, _KEYLEN(sav->key_enc)); 2924 } 2925 if (sav->key_auth != NULL) { 2926 if (sav->key_auth->key_data != NULL) 2927 free(sav->key_auth->key_data, M_IPSEC_MISC); 2928 free(sav->key_auth, M_IPSEC_MISC); 2929 sav->key_auth = NULL; 2930 } 2931 if (sav->key_enc != NULL) { 2932 if (sav->key_enc->key_data != NULL) 2933 free(sav->key_enc->key_data, M_IPSEC_MISC); 2934 free(sav->key_enc, M_IPSEC_MISC); 2935 sav->key_enc = NULL; 2936 } 2937 if (sav->sched) { 2938 bzero(sav->sched, sav->schedlen); 2939 free(sav->sched, M_IPSEC_MISC); 2940 sav->sched = NULL; 2941 } 2942 if (sav->replay != NULL) { 2943 free(sav->replay, M_IPSEC_MISC); 2944 sav->replay = NULL; 2945 } 2946 if (sav->lft_c != NULL) { 2947 free(sav->lft_c, M_IPSEC_MISC); 2948 sav->lft_c = NULL; 2949 } 2950 if (sav->lft_h != NULL) { 2951 free(sav->lft_h, M_IPSEC_MISC); 2952 sav->lft_h = NULL; 2953 } 2954 if (sav->lft_s != NULL) { 2955 free(sav->lft_s, M_IPSEC_MISC); 2956 sav->lft_s = NULL; 2957 } 2958 } 2959 2960 /* 2961 * free() SA variable entry. 2962 */ 2963 static void 2964 key_delsav(struct secasvar *sav) 2965 { 2966 IPSEC_ASSERT(sav != NULL, ("null sav")); 2967 IPSEC_ASSERT(sav->refcnt == 0, ("reference count %u > 0", sav->refcnt)); 2968 2969 /* remove from SA header */ 2970 if (__LIST_CHAINED(sav)) 2971 LIST_REMOVE(sav, chain); 2972 key_cleansav(sav); 2973 SECASVAR_LOCK_DESTROY(sav); 2974 free(sav, M_IPSEC_SA); 2975 } 2976 2977 /* 2978 * search SAD. 2979 * OUT: 2980 * NULL : not found 2981 * others : found, pointer to a SA. 2982 */ 2983 static struct secashead * 2984 key_getsah(struct secasindex *saidx) 2985 { 2986 struct secashead *sah; 2987 2988 SAHTREE_LOCK(); 2989 LIST_FOREACH(sah, &V_sahtree, chain) { 2990 if (sah->state == SADB_SASTATE_DEAD) 2991 continue; 2992 if (key_cmpsaidx(&sah->saidx, saidx, CMP_REQID)) 2993 break; 2994 } 2995 SAHTREE_UNLOCK(); 2996 2997 return sah; 2998 } 2999 3000 /* 3001 * check not to be duplicated SPI. 3002 * NOTE: this function is too slow due to searching all SAD. 3003 * OUT: 3004 * NULL : not found 3005 * others : found, pointer to a SA. 3006 */ 3007 static struct secasvar * 3008 key_checkspidup(struct secasindex *saidx, u_int32_t spi) 3009 { 3010 struct secashead *sah; 3011 struct secasvar *sav; 3012 3013 /* check address family */ 3014 if (saidx->src.sa.sa_family != saidx->dst.sa.sa_family) { 3015 ipseclog((LOG_DEBUG, "%s: address family mismatched.\n", 3016 __func__)); 3017 return NULL; 3018 } 3019 3020 sav = NULL; 3021 /* check all SAD */ 3022 SAHTREE_LOCK(); 3023 LIST_FOREACH(sah, &V_sahtree, chain) { 3024 if (!key_ismyaddr((struct sockaddr *)&sah->saidx.dst)) 3025 continue; 3026 sav = key_getsavbyspi(sah, spi); 3027 if (sav != NULL) 3028 break; 3029 } 3030 SAHTREE_UNLOCK(); 3031 3032 return sav; 3033 } 3034 3035 /* 3036 * search SAD litmited alive SA, protocol, SPI. 3037 * OUT: 3038 * NULL : not found 3039 * others : found, pointer to a SA. 3040 */ 3041 static struct secasvar * 3042 key_getsavbyspi(struct secashead *sah, u_int32_t spi) 3043 { 3044 struct secasvar *sav; 3045 u_int stateidx, state; 3046 3047 sav = NULL; 3048 SAHTREE_LOCK_ASSERT(); 3049 /* search all status */ 3050 for (stateidx = 0; 3051 stateidx < _ARRAYLEN(saorder_state_alive); 3052 stateidx++) { 3053 3054 state = saorder_state_alive[stateidx]; 3055 LIST_FOREACH(sav, &sah->savtree[state], chain) { 3056 3057 /* sanity check */ 3058 if (sav->state != state) { 3059 ipseclog((LOG_DEBUG, "%s: " 3060 "invalid sav->state (queue: %d SA: %d)\n", 3061 __func__, state, sav->state)); 3062 continue; 3063 } 3064 3065 if (sav->spi == spi) 3066 return sav; 3067 } 3068 } 3069 3070 return NULL; 3071 } 3072 3073 /* 3074 * copy SA values from PF_KEY message except *SPI, SEQ, PID, STATE and TYPE*. 3075 * You must update these if need. 3076 * OUT: 0: success. 3077 * !0: failure. 3078 * 3079 * does not modify mbuf. does not free mbuf on error. 3080 */ 3081 static int 3082 key_setsaval(struct secasvar *sav, struct mbuf *m, 3083 const struct sadb_msghdr *mhp) 3084 { 3085 int error = 0; 3086 3087 IPSEC_ASSERT(m != NULL, ("null mbuf")); 3088 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 3089 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 3090 3091 /* initialization */ 3092 sav->replay = NULL; 3093 sav->key_auth = NULL; 3094 sav->key_enc = NULL; 3095 sav->sched = NULL; 3096 sav->schedlen = 0; 3097 sav->lft_c = NULL; 3098 sav->lft_h = NULL; 3099 sav->lft_s = NULL; 3100 sav->tdb_xform = NULL; /* transform */ 3101 sav->tdb_encalgxform = NULL; /* encoding algorithm */ 3102 sav->tdb_authalgxform = NULL; /* authentication algorithm */ 3103 sav->tdb_compalgxform = NULL; /* compression algorithm */ 3104 /* Initialize even if NAT-T not compiled in: */ 3105 sav->natt_type = 0; 3106 sav->natt_esp_frag_len = 0; 3107 3108 /* SA */ 3109 if (mhp->ext[SADB_EXT_SA] != NULL) { 3110 const struct sadb_sa *sa0; 3111 3112 sa0 = (const struct sadb_sa *)mhp->ext[SADB_EXT_SA]; 3113 if (mhp->extlen[SADB_EXT_SA] < sizeof(*sa0)) { 3114 error = EINVAL; 3115 goto fail; 3116 } 3117 3118 sav->alg_auth = sa0->sadb_sa_auth; 3119 sav->alg_enc = sa0->sadb_sa_encrypt; 3120 sav->flags = sa0->sadb_sa_flags; 3121 3122 /* replay window */ 3123 if ((sa0->sadb_sa_flags & SADB_X_EXT_OLD) == 0) { 3124 sav->replay = (struct secreplay *) 3125 malloc(sizeof(struct secreplay)+sa0->sadb_sa_replay, M_IPSEC_MISC, M_NOWAIT|M_ZERO); 3126 if (sav->replay == NULL) { 3127 ipseclog((LOG_DEBUG, "%s: No more memory.\n", 3128 __func__)); 3129 error = ENOBUFS; 3130 goto fail; 3131 } 3132 if (sa0->sadb_sa_replay != 0) 3133 sav->replay->bitmap = (caddr_t)(sav->replay+1); 3134 sav->replay->wsize = sa0->sadb_sa_replay; 3135 } 3136 } 3137 3138 /* Authentication keys */ 3139 if (mhp->ext[SADB_EXT_KEY_AUTH] != NULL) { 3140 const struct sadb_key *key0; 3141 int len; 3142 3143 key0 = (const struct sadb_key *)mhp->ext[SADB_EXT_KEY_AUTH]; 3144 len = mhp->extlen[SADB_EXT_KEY_AUTH]; 3145 3146 error = 0; 3147 if (len < sizeof(*key0)) { 3148 error = EINVAL; 3149 goto fail; 3150 } 3151 switch (mhp->msg->sadb_msg_satype) { 3152 case SADB_SATYPE_AH: 3153 case SADB_SATYPE_ESP: 3154 case SADB_X_SATYPE_TCPSIGNATURE: 3155 if (len == PFKEY_ALIGN8(sizeof(struct sadb_key)) && 3156 sav->alg_auth != SADB_X_AALG_NULL) 3157 error = EINVAL; 3158 break; 3159 case SADB_X_SATYPE_IPCOMP: 3160 default: 3161 error = EINVAL; 3162 break; 3163 } 3164 if (error) { 3165 ipseclog((LOG_DEBUG, "%s: invalid key_auth values.\n", 3166 __func__)); 3167 goto fail; 3168 } 3169 3170 sav->key_auth = (struct seckey *)key_dup_keymsg(key0, len, 3171 M_IPSEC_MISC); 3172 if (sav->key_auth == NULL ) { 3173 ipseclog((LOG_DEBUG, "%s: No more memory.\n", 3174 __func__)); 3175 error = ENOBUFS; 3176 goto fail; 3177 } 3178 } 3179 3180 /* Encryption key */ 3181 if (mhp->ext[SADB_EXT_KEY_ENCRYPT] != NULL) { 3182 const struct sadb_key *key0; 3183 int len; 3184 3185 key0 = (const struct sadb_key *)mhp->ext[SADB_EXT_KEY_ENCRYPT]; 3186 len = mhp->extlen[SADB_EXT_KEY_ENCRYPT]; 3187 3188 error = 0; 3189 if (len < sizeof(*key0)) { 3190 error = EINVAL; 3191 goto fail; 3192 } 3193 switch (mhp->msg->sadb_msg_satype) { 3194 case SADB_SATYPE_ESP: 3195 if (len == PFKEY_ALIGN8(sizeof(struct sadb_key)) && 3196 sav->alg_enc != SADB_EALG_NULL) { 3197 error = EINVAL; 3198 break; 3199 } 3200 sav->key_enc = (struct seckey *)key_dup_keymsg(key0, 3201 len, 3202 M_IPSEC_MISC); 3203 if (sav->key_enc == NULL) { 3204 ipseclog((LOG_DEBUG, "%s: No more memory.\n", 3205 __func__)); 3206 error = ENOBUFS; 3207 goto fail; 3208 } 3209 break; 3210 case SADB_X_SATYPE_IPCOMP: 3211 if (len != PFKEY_ALIGN8(sizeof(struct sadb_key))) 3212 error = EINVAL; 3213 sav->key_enc = NULL; /*just in case*/ 3214 break; 3215 case SADB_SATYPE_AH: 3216 case SADB_X_SATYPE_TCPSIGNATURE: 3217 default: 3218 error = EINVAL; 3219 break; 3220 } 3221 if (error) { 3222 ipseclog((LOG_DEBUG, "%s: invalid key_enc value.\n", 3223 __func__)); 3224 goto fail; 3225 } 3226 } 3227 3228 /* set iv */ 3229 sav->ivlen = 0; 3230 3231 switch (mhp->msg->sadb_msg_satype) { 3232 case SADB_SATYPE_AH: 3233 error = xform_init(sav, XF_AH); 3234 break; 3235 case SADB_SATYPE_ESP: 3236 error = xform_init(sav, XF_ESP); 3237 break; 3238 case SADB_X_SATYPE_IPCOMP: 3239 error = xform_init(sav, XF_IPCOMP); 3240 break; 3241 case SADB_X_SATYPE_TCPSIGNATURE: 3242 error = xform_init(sav, XF_TCPSIGNATURE); 3243 break; 3244 } 3245 if (error) { 3246 ipseclog((LOG_DEBUG, "%s: unable to initialize SA type %u.\n", 3247 __func__, mhp->msg->sadb_msg_satype)); 3248 goto fail; 3249 } 3250 3251 /* reset created */ 3252 sav->created = time_second; 3253 3254 /* make lifetime for CURRENT */ 3255 sav->lft_c = malloc(sizeof(struct seclifetime), M_IPSEC_MISC, M_NOWAIT); 3256 if (sav->lft_c == NULL) { 3257 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 3258 error = ENOBUFS; 3259 goto fail; 3260 } 3261 3262 sav->lft_c->allocations = 0; 3263 sav->lft_c->bytes = 0; 3264 sav->lft_c->addtime = time_second; 3265 sav->lft_c->usetime = 0; 3266 3267 /* lifetimes for HARD and SOFT */ 3268 { 3269 const struct sadb_lifetime *lft0; 3270 3271 lft0 = (struct sadb_lifetime *)mhp->ext[SADB_EXT_LIFETIME_HARD]; 3272 if (lft0 != NULL) { 3273 if (mhp->extlen[SADB_EXT_LIFETIME_HARD] < sizeof(*lft0)) { 3274 error = EINVAL; 3275 goto fail; 3276 } 3277 sav->lft_h = key_dup_lifemsg(lft0, M_IPSEC_MISC); 3278 if (sav->lft_h == NULL) { 3279 ipseclog((LOG_DEBUG, "%s: No more memory.\n",__func__)); 3280 error = ENOBUFS; 3281 goto fail; 3282 } 3283 /* to be initialize ? */ 3284 } 3285 3286 lft0 = (struct sadb_lifetime *)mhp->ext[SADB_EXT_LIFETIME_SOFT]; 3287 if (lft0 != NULL) { 3288 if (mhp->extlen[SADB_EXT_LIFETIME_SOFT] < sizeof(*lft0)) { 3289 error = EINVAL; 3290 goto fail; 3291 } 3292 sav->lft_s = key_dup_lifemsg(lft0, M_IPSEC_MISC); 3293 if (sav->lft_s == NULL) { 3294 ipseclog((LOG_DEBUG, "%s: No more memory.\n",__func__)); 3295 error = ENOBUFS; 3296 goto fail; 3297 } 3298 /* to be initialize ? */ 3299 } 3300 } 3301 3302 return 0; 3303 3304 fail: 3305 /* initialization */ 3306 key_cleansav(sav); 3307 3308 return error; 3309 } 3310 3311 /* 3312 * validation with a secasvar entry, and set SADB_SATYPE_MATURE. 3313 * OUT: 0: valid 3314 * other: errno 3315 */ 3316 static int 3317 key_mature(struct secasvar *sav) 3318 { 3319 int error; 3320 3321 /* check SPI value */ 3322 switch (sav->sah->saidx.proto) { 3323 case IPPROTO_ESP: 3324 case IPPROTO_AH: 3325 /* 3326 * RFC 4302, 2.4. Security Parameters Index (SPI), SPI values 3327 * 1-255 reserved by IANA for future use, 3328 * 0 for implementation specific, local use. 3329 */ 3330 if (ntohl(sav->spi) <= 255) { 3331 ipseclog((LOG_DEBUG, "%s: illegal range of SPI %u.\n", 3332 __func__, (u_int32_t)ntohl(sav->spi))); 3333 return EINVAL; 3334 } 3335 break; 3336 } 3337 3338 /* check satype */ 3339 switch (sav->sah->saidx.proto) { 3340 case IPPROTO_ESP: 3341 /* check flags */ 3342 if ((sav->flags & (SADB_X_EXT_OLD|SADB_X_EXT_DERIV)) == 3343 (SADB_X_EXT_OLD|SADB_X_EXT_DERIV)) { 3344 ipseclog((LOG_DEBUG, "%s: invalid flag (derived) " 3345 "given to old-esp.\n", __func__)); 3346 return EINVAL; 3347 } 3348 error = xform_init(sav, XF_ESP); 3349 break; 3350 case IPPROTO_AH: 3351 /* check flags */ 3352 if (sav->flags & SADB_X_EXT_DERIV) { 3353 ipseclog((LOG_DEBUG, "%s: invalid flag (derived) " 3354 "given to AH SA.\n", __func__)); 3355 return EINVAL; 3356 } 3357 if (sav->alg_enc != SADB_EALG_NONE) { 3358 ipseclog((LOG_DEBUG, "%s: protocol and algorithm " 3359 "mismated.\n", __func__)); 3360 return(EINVAL); 3361 } 3362 error = xform_init(sav, XF_AH); 3363 break; 3364 case IPPROTO_IPCOMP: 3365 if (sav->alg_auth != SADB_AALG_NONE) { 3366 ipseclog((LOG_DEBUG, "%s: protocol and algorithm " 3367 "mismated.\n", __func__)); 3368 return(EINVAL); 3369 } 3370 if ((sav->flags & SADB_X_EXT_RAWCPI) == 0 3371 && ntohl(sav->spi) >= 0x10000) { 3372 ipseclog((LOG_DEBUG, "%s: invalid cpi for IPComp.\n", 3373 __func__)); 3374 return(EINVAL); 3375 } 3376 error = xform_init(sav, XF_IPCOMP); 3377 break; 3378 case IPPROTO_TCP: 3379 if (sav->alg_enc != SADB_EALG_NONE) { 3380 ipseclog((LOG_DEBUG, "%s: protocol and algorithm " 3381 "mismated.\n", __func__)); 3382 return(EINVAL); 3383 } 3384 error = xform_init(sav, XF_TCPSIGNATURE); 3385 break; 3386 default: 3387 ipseclog((LOG_DEBUG, "%s: Invalid satype.\n", __func__)); 3388 error = EPROTONOSUPPORT; 3389 break; 3390 } 3391 if (error == 0) { 3392 SAHTREE_LOCK(); 3393 key_sa_chgstate(sav, SADB_SASTATE_MATURE); 3394 SAHTREE_UNLOCK(); 3395 } 3396 return (error); 3397 } 3398 3399 /* 3400 * subroutine for SADB_GET and SADB_DUMP. 3401 */ 3402 static struct mbuf * 3403 key_setdumpsa(struct secasvar *sav, u_int8_t type, u_int8_t satype, 3404 u_int32_t seq, u_int32_t pid) 3405 { 3406 struct mbuf *result = NULL, *tres = NULL, *m; 3407 int i; 3408 int dumporder[] = { 3409 SADB_EXT_SA, SADB_X_EXT_SA2, 3410 SADB_EXT_LIFETIME_HARD, SADB_EXT_LIFETIME_SOFT, 3411 SADB_EXT_LIFETIME_CURRENT, SADB_EXT_ADDRESS_SRC, 3412 SADB_EXT_ADDRESS_DST, SADB_EXT_ADDRESS_PROXY, SADB_EXT_KEY_AUTH, 3413 SADB_EXT_KEY_ENCRYPT, SADB_EXT_IDENTITY_SRC, 3414 SADB_EXT_IDENTITY_DST, SADB_EXT_SENSITIVITY, 3415 #ifdef IPSEC_NAT_T 3416 SADB_X_EXT_NAT_T_TYPE, 3417 SADB_X_EXT_NAT_T_SPORT, SADB_X_EXT_NAT_T_DPORT, 3418 SADB_X_EXT_NAT_T_OAI, SADB_X_EXT_NAT_T_OAR, 3419 SADB_X_EXT_NAT_T_FRAG, 3420 #endif 3421 }; 3422 3423 m = key_setsadbmsg(type, 0, satype, seq, pid, sav->refcnt); 3424 if (m == NULL) 3425 goto fail; 3426 result = m; 3427 3428 for (i = nitems(dumporder) - 1; i >= 0; i--) { 3429 m = NULL; 3430 switch (dumporder[i]) { 3431 case SADB_EXT_SA: 3432 m = key_setsadbsa(sav); 3433 if (!m) 3434 goto fail; 3435 break; 3436 3437 case SADB_X_EXT_SA2: 3438 m = key_setsadbxsa2(sav->sah->saidx.mode, 3439 sav->replay ? sav->replay->count : 0, 3440 sav->sah->saidx.reqid); 3441 if (!m) 3442 goto fail; 3443 break; 3444 3445 case SADB_EXT_ADDRESS_SRC: 3446 m = key_setsadbaddr(SADB_EXT_ADDRESS_SRC, 3447 &sav->sah->saidx.src.sa, 3448 FULLMASK, IPSEC_ULPROTO_ANY); 3449 if (!m) 3450 goto fail; 3451 break; 3452 3453 case SADB_EXT_ADDRESS_DST: 3454 m = key_setsadbaddr(SADB_EXT_ADDRESS_DST, 3455 &sav->sah->saidx.dst.sa, 3456 FULLMASK, IPSEC_ULPROTO_ANY); 3457 if (!m) 3458 goto fail; 3459 break; 3460 3461 case SADB_EXT_KEY_AUTH: 3462 if (!sav->key_auth) 3463 continue; 3464 m = key_setkey(sav->key_auth, SADB_EXT_KEY_AUTH); 3465 if (!m) 3466 goto fail; 3467 break; 3468 3469 case SADB_EXT_KEY_ENCRYPT: 3470 if (!sav->key_enc) 3471 continue; 3472 m = key_setkey(sav->key_enc, SADB_EXT_KEY_ENCRYPT); 3473 if (!m) 3474 goto fail; 3475 break; 3476 3477 case SADB_EXT_LIFETIME_CURRENT: 3478 if (!sav->lft_c) 3479 continue; 3480 m = key_setlifetime(sav->lft_c, 3481 SADB_EXT_LIFETIME_CURRENT); 3482 if (!m) 3483 goto fail; 3484 break; 3485 3486 case SADB_EXT_LIFETIME_HARD: 3487 if (!sav->lft_h) 3488 continue; 3489 m = key_setlifetime(sav->lft_h, 3490 SADB_EXT_LIFETIME_HARD); 3491 if (!m) 3492 goto fail; 3493 break; 3494 3495 case SADB_EXT_LIFETIME_SOFT: 3496 if (!sav->lft_s) 3497 continue; 3498 m = key_setlifetime(sav->lft_s, 3499 SADB_EXT_LIFETIME_SOFT); 3500 3501 if (!m) 3502 goto fail; 3503 break; 3504 3505 #ifdef IPSEC_NAT_T 3506 case SADB_X_EXT_NAT_T_TYPE: 3507 m = key_setsadbxtype(sav->natt_type); 3508 if (!m) 3509 goto fail; 3510 break; 3511 3512 case SADB_X_EXT_NAT_T_DPORT: 3513 m = key_setsadbxport( 3514 KEY_PORTFROMSADDR(&sav->sah->saidx.dst), 3515 SADB_X_EXT_NAT_T_DPORT); 3516 if (!m) 3517 goto fail; 3518 break; 3519 3520 case SADB_X_EXT_NAT_T_SPORT: 3521 m = key_setsadbxport( 3522 KEY_PORTFROMSADDR(&sav->sah->saidx.src), 3523 SADB_X_EXT_NAT_T_SPORT); 3524 if (!m) 3525 goto fail; 3526 break; 3527 3528 case SADB_X_EXT_NAT_T_OAI: 3529 case SADB_X_EXT_NAT_T_OAR: 3530 case SADB_X_EXT_NAT_T_FRAG: 3531 /* We do not (yet) support those. */ 3532 continue; 3533 #endif 3534 3535 case SADB_EXT_ADDRESS_PROXY: 3536 case SADB_EXT_IDENTITY_SRC: 3537 case SADB_EXT_IDENTITY_DST: 3538 /* XXX: should we brought from SPD ? */ 3539 case SADB_EXT_SENSITIVITY: 3540 default: 3541 continue; 3542 } 3543 3544 if (!m) 3545 goto fail; 3546 if (tres) 3547 m_cat(m, tres); 3548 tres = m; 3549 3550 } 3551 3552 m_cat(result, tres); 3553 tres = NULL; 3554 if (result->m_len < sizeof(struct sadb_msg)) { 3555 result = m_pullup(result, sizeof(struct sadb_msg)); 3556 if (result == NULL) 3557 goto fail; 3558 } 3559 3560 result->m_pkthdr.len = 0; 3561 for (m = result; m; m = m->m_next) 3562 result->m_pkthdr.len += m->m_len; 3563 3564 mtod(result, struct sadb_msg *)->sadb_msg_len = 3565 PFKEY_UNIT64(result->m_pkthdr.len); 3566 3567 return result; 3568 3569 fail: 3570 m_freem(result); 3571 m_freem(tres); 3572 return NULL; 3573 } 3574 3575 /* 3576 * set data into sadb_msg. 3577 */ 3578 static struct mbuf * 3579 key_setsadbmsg(u_int8_t type, u_int16_t tlen, u_int8_t satype, u_int32_t seq, 3580 pid_t pid, u_int16_t reserved) 3581 { 3582 struct mbuf *m; 3583 struct sadb_msg *p; 3584 int len; 3585 3586 len = PFKEY_ALIGN8(sizeof(struct sadb_msg)); 3587 if (len > MCLBYTES) 3588 return NULL; 3589 MGETHDR(m, M_NOWAIT, MT_DATA); 3590 if (m && len > MHLEN) { 3591 if (!(MCLGET(m, M_NOWAIT))) { 3592 m_freem(m); 3593 m = NULL; 3594 } 3595 } 3596 if (!m) 3597 return NULL; 3598 m->m_pkthdr.len = m->m_len = len; 3599 m->m_next = NULL; 3600 3601 p = mtod(m, struct sadb_msg *); 3602 3603 bzero(p, len); 3604 p->sadb_msg_version = PF_KEY_V2; 3605 p->sadb_msg_type = type; 3606 p->sadb_msg_errno = 0; 3607 p->sadb_msg_satype = satype; 3608 p->sadb_msg_len = PFKEY_UNIT64(tlen); 3609 p->sadb_msg_reserved = reserved; 3610 p->sadb_msg_seq = seq; 3611 p->sadb_msg_pid = (u_int32_t)pid; 3612 3613 return m; 3614 } 3615 3616 /* 3617 * copy secasvar data into sadb_address. 3618 */ 3619 static struct mbuf * 3620 key_setsadbsa(struct secasvar *sav) 3621 { 3622 struct mbuf *m; 3623 struct sadb_sa *p; 3624 int len; 3625 3626 len = PFKEY_ALIGN8(sizeof(struct sadb_sa)); 3627 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 3628 if (m == NULL) 3629 return (NULL); 3630 m_align(m, len); 3631 m->m_len = len; 3632 p = mtod(m, struct sadb_sa *); 3633 bzero(p, len); 3634 p->sadb_sa_len = PFKEY_UNIT64(len); 3635 p->sadb_sa_exttype = SADB_EXT_SA; 3636 p->sadb_sa_spi = sav->spi; 3637 p->sadb_sa_replay = (sav->replay != NULL ? sav->replay->wsize : 0); 3638 p->sadb_sa_state = sav->state; 3639 p->sadb_sa_auth = sav->alg_auth; 3640 p->sadb_sa_encrypt = sav->alg_enc; 3641 p->sadb_sa_flags = sav->flags; 3642 3643 return m; 3644 } 3645 3646 /* 3647 * set data into sadb_address. 3648 */ 3649 static struct mbuf * 3650 key_setsadbaddr(u_int16_t exttype, const struct sockaddr *saddr, 3651 u_int8_t prefixlen, u_int16_t ul_proto) 3652 { 3653 struct mbuf *m; 3654 struct sadb_address *p; 3655 size_t len; 3656 3657 len = PFKEY_ALIGN8(sizeof(struct sadb_address)) + 3658 PFKEY_ALIGN8(saddr->sa_len); 3659 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 3660 if (m == NULL) 3661 return (NULL); 3662 m_align(m, len); 3663 m->m_len = len; 3664 p = mtod(m, struct sadb_address *); 3665 3666 bzero(p, len); 3667 p->sadb_address_len = PFKEY_UNIT64(len); 3668 p->sadb_address_exttype = exttype; 3669 p->sadb_address_proto = ul_proto; 3670 if (prefixlen == FULLMASK) { 3671 switch (saddr->sa_family) { 3672 case AF_INET: 3673 prefixlen = sizeof(struct in_addr) << 3; 3674 break; 3675 case AF_INET6: 3676 prefixlen = sizeof(struct in6_addr) << 3; 3677 break; 3678 default: 3679 ; /*XXX*/ 3680 } 3681 } 3682 p->sadb_address_prefixlen = prefixlen; 3683 p->sadb_address_reserved = 0; 3684 3685 bcopy(saddr, 3686 mtod(m, caddr_t) + PFKEY_ALIGN8(sizeof(struct sadb_address)), 3687 saddr->sa_len); 3688 3689 return m; 3690 } 3691 3692 /* 3693 * set data into sadb_x_sa2. 3694 */ 3695 static struct mbuf * 3696 key_setsadbxsa2(u_int8_t mode, u_int32_t seq, u_int32_t reqid) 3697 { 3698 struct mbuf *m; 3699 struct sadb_x_sa2 *p; 3700 size_t len; 3701 3702 len = PFKEY_ALIGN8(sizeof(struct sadb_x_sa2)); 3703 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 3704 if (m == NULL) 3705 return (NULL); 3706 m_align(m, len); 3707 m->m_len = len; 3708 p = mtod(m, struct sadb_x_sa2 *); 3709 3710 bzero(p, len); 3711 p->sadb_x_sa2_len = PFKEY_UNIT64(len); 3712 p->sadb_x_sa2_exttype = SADB_X_EXT_SA2; 3713 p->sadb_x_sa2_mode = mode; 3714 p->sadb_x_sa2_reserved1 = 0; 3715 p->sadb_x_sa2_reserved2 = 0; 3716 p->sadb_x_sa2_sequence = seq; 3717 p->sadb_x_sa2_reqid = reqid; 3718 3719 return m; 3720 } 3721 3722 #ifdef IPSEC_NAT_T 3723 /* 3724 * Set a type in sadb_x_nat_t_type. 3725 */ 3726 static struct mbuf * 3727 key_setsadbxtype(u_int16_t type) 3728 { 3729 struct mbuf *m; 3730 size_t len; 3731 struct sadb_x_nat_t_type *p; 3732 3733 len = PFKEY_ALIGN8(sizeof(struct sadb_x_nat_t_type)); 3734 3735 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 3736 if (m == NULL) 3737 return (NULL); 3738 m_align(m, len); 3739 m->m_len = len; 3740 p = mtod(m, struct sadb_x_nat_t_type *); 3741 3742 bzero(p, len); 3743 p->sadb_x_nat_t_type_len = PFKEY_UNIT64(len); 3744 p->sadb_x_nat_t_type_exttype = SADB_X_EXT_NAT_T_TYPE; 3745 p->sadb_x_nat_t_type_type = type; 3746 3747 return (m); 3748 } 3749 /* 3750 * Set a port in sadb_x_nat_t_port. 3751 * In contrast to default RFC 2367 behaviour, port is in network byte order. 3752 */ 3753 static struct mbuf * 3754 key_setsadbxport(u_int16_t port, u_int16_t type) 3755 { 3756 struct mbuf *m; 3757 size_t len; 3758 struct sadb_x_nat_t_port *p; 3759 3760 len = PFKEY_ALIGN8(sizeof(struct sadb_x_nat_t_port)); 3761 3762 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 3763 if (m == NULL) 3764 return (NULL); 3765 m_align(m, len); 3766 m->m_len = len; 3767 p = mtod(m, struct sadb_x_nat_t_port *); 3768 3769 bzero(p, len); 3770 p->sadb_x_nat_t_port_len = PFKEY_UNIT64(len); 3771 p->sadb_x_nat_t_port_exttype = type; 3772 p->sadb_x_nat_t_port_port = port; 3773 3774 return (m); 3775 } 3776 3777 /* 3778 * Get port from sockaddr. Port is in network byte order. 3779 */ 3780 u_int16_t 3781 key_portfromsaddr(struct sockaddr *sa) 3782 { 3783 3784 switch (sa->sa_family) { 3785 #ifdef INET 3786 case AF_INET: 3787 return ((struct sockaddr_in *)sa)->sin_port; 3788 #endif 3789 #ifdef INET6 3790 case AF_INET6: 3791 return ((struct sockaddr_in6 *)sa)->sin6_port; 3792 #endif 3793 } 3794 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 3795 printf("DP %s unexpected address family %d\n", 3796 __func__, sa->sa_family)); 3797 return (0); 3798 } 3799 #endif /* IPSEC_NAT_T */ 3800 3801 /* 3802 * Set port in struct sockaddr. Port is in network byte order. 3803 */ 3804 static void 3805 key_porttosaddr(struct sockaddr *sa, u_int16_t port) 3806 { 3807 3808 switch (sa->sa_family) { 3809 #ifdef INET 3810 case AF_INET: 3811 ((struct sockaddr_in *)sa)->sin_port = port; 3812 break; 3813 #endif 3814 #ifdef INET6 3815 case AF_INET6: 3816 ((struct sockaddr_in6 *)sa)->sin6_port = port; 3817 break; 3818 #endif 3819 default: 3820 ipseclog((LOG_DEBUG, "%s: unexpected address family %d.\n", 3821 __func__, sa->sa_family)); 3822 break; 3823 } 3824 } 3825 3826 /* 3827 * set data into sadb_x_policy 3828 */ 3829 static struct mbuf * 3830 key_setsadbxpolicy(u_int16_t type, u_int8_t dir, u_int32_t id, u_int32_t priority) 3831 { 3832 struct mbuf *m; 3833 struct sadb_x_policy *p; 3834 size_t len; 3835 3836 len = PFKEY_ALIGN8(sizeof(struct sadb_x_policy)); 3837 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 3838 if (m == NULL) 3839 return (NULL); 3840 m_align(m, len); 3841 m->m_len = len; 3842 p = mtod(m, struct sadb_x_policy *); 3843 3844 bzero(p, len); 3845 p->sadb_x_policy_len = PFKEY_UNIT64(len); 3846 p->sadb_x_policy_exttype = SADB_X_EXT_POLICY; 3847 p->sadb_x_policy_type = type; 3848 p->sadb_x_policy_dir = dir; 3849 p->sadb_x_policy_id = id; 3850 p->sadb_x_policy_priority = priority; 3851 3852 return m; 3853 } 3854 3855 /* %%% utilities */ 3856 /* Take a key message (sadb_key) from the socket and turn it into one 3857 * of the kernel's key structures (seckey). 3858 * 3859 * IN: pointer to the src 3860 * OUT: NULL no more memory 3861 */ 3862 struct seckey * 3863 key_dup_keymsg(const struct sadb_key *src, u_int len, 3864 struct malloc_type *type) 3865 { 3866 struct seckey *dst; 3867 dst = (struct seckey *)malloc(sizeof(struct seckey), type, M_NOWAIT); 3868 if (dst != NULL) { 3869 dst->bits = src->sadb_key_bits; 3870 dst->key_data = (char *)malloc(len, type, M_NOWAIT); 3871 if (dst->key_data != NULL) { 3872 bcopy((const char *)src + sizeof(struct sadb_key), 3873 dst->key_data, len); 3874 } else { 3875 ipseclog((LOG_DEBUG, "%s: No more memory.\n", 3876 __func__)); 3877 free(dst, type); 3878 dst = NULL; 3879 } 3880 } else { 3881 ipseclog((LOG_DEBUG, "%s: No more memory.\n", 3882 __func__)); 3883 3884 } 3885 return dst; 3886 } 3887 3888 /* Take a lifetime message (sadb_lifetime) passed in on a socket and 3889 * turn it into one of the kernel's lifetime structures (seclifetime). 3890 * 3891 * IN: pointer to the destination, source and malloc type 3892 * OUT: NULL, no more memory 3893 */ 3894 3895 static struct seclifetime * 3896 key_dup_lifemsg(const struct sadb_lifetime *src, struct malloc_type *type) 3897 { 3898 struct seclifetime *dst = NULL; 3899 3900 dst = (struct seclifetime *)malloc(sizeof(struct seclifetime), 3901 type, M_NOWAIT); 3902 if (dst == NULL) { 3903 /* XXX counter */ 3904 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 3905 } else { 3906 dst->allocations = src->sadb_lifetime_allocations; 3907 dst->bytes = src->sadb_lifetime_bytes; 3908 dst->addtime = src->sadb_lifetime_addtime; 3909 dst->usetime = src->sadb_lifetime_usetime; 3910 } 3911 return dst; 3912 } 3913 3914 /* compare my own address 3915 * OUT: 1: true, i.e. my address. 3916 * 0: false 3917 */ 3918 int 3919 key_ismyaddr(struct sockaddr *sa) 3920 { 3921 3922 IPSEC_ASSERT(sa != NULL, ("null sockaddr")); 3923 switch (sa->sa_family) { 3924 #ifdef INET 3925 case AF_INET: 3926 return (in_localip(satosin(sa)->sin_addr)); 3927 #endif 3928 #ifdef INET6 3929 case AF_INET6: 3930 return key_ismyaddr6((struct sockaddr_in6 *)sa); 3931 #endif 3932 } 3933 3934 return 0; 3935 } 3936 3937 #ifdef INET6 3938 /* 3939 * compare my own address for IPv6. 3940 * 1: ours 3941 * 0: other 3942 */ 3943 static int 3944 key_ismyaddr6(struct sockaddr_in6 *sin6) 3945 { 3946 struct in6_addr in6; 3947 3948 if (!IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr)) 3949 return (in6_localip(&sin6->sin6_addr)); 3950 3951 /* Convert address into kernel-internal form */ 3952 in6 = sin6->sin6_addr; 3953 in6.s6_addr16[1] = htons(sin6->sin6_scope_id & 0xffff); 3954 return (in6_localip(&in6)); 3955 } 3956 #endif /*INET6*/ 3957 3958 /* 3959 * compare two secasindex structure. 3960 * flag can specify to compare 2 saidxes. 3961 * compare two secasindex structure without both mode and reqid. 3962 * don't compare port. 3963 * IN: 3964 * saidx0: source, it can be in SAD. 3965 * saidx1: object. 3966 * OUT: 3967 * 1 : equal 3968 * 0 : not equal 3969 */ 3970 static int 3971 key_cmpsaidx(const struct secasindex *saidx0, const struct secasindex *saidx1, 3972 int flag) 3973 { 3974 int chkport = 0; 3975 3976 /* sanity */ 3977 if (saidx0 == NULL && saidx1 == NULL) 3978 return 1; 3979 3980 if (saidx0 == NULL || saidx1 == NULL) 3981 return 0; 3982 3983 if (saidx0->proto != saidx1->proto) 3984 return 0; 3985 3986 if (flag == CMP_EXACTLY) { 3987 if (saidx0->mode != saidx1->mode) 3988 return 0; 3989 if (saidx0->reqid != saidx1->reqid) 3990 return 0; 3991 if (bcmp(&saidx0->src, &saidx1->src, saidx0->src.sa.sa_len) != 0 || 3992 bcmp(&saidx0->dst, &saidx1->dst, saidx0->dst.sa.sa_len) != 0) 3993 return 0; 3994 } else { 3995 3996 /* CMP_MODE_REQID, CMP_REQID, CMP_HEAD */ 3997 if (flag == CMP_MODE_REQID 3998 ||flag == CMP_REQID) { 3999 /* 4000 * If reqid of SPD is non-zero, unique SA is required. 4001 * The result must be of same reqid in this case. 4002 */ 4003 if (saidx1->reqid != 0 && saidx0->reqid != saidx1->reqid) 4004 return 0; 4005 } 4006 4007 if (flag == CMP_MODE_REQID) { 4008 if (saidx0->mode != IPSEC_MODE_ANY 4009 && saidx0->mode != saidx1->mode) 4010 return 0; 4011 } 4012 4013 #ifdef IPSEC_NAT_T 4014 /* 4015 * If NAT-T is enabled, check ports for tunnel mode. 4016 * Do not check ports if they are set to zero in the SPD. 4017 * Also do not do it for native transport mode, as there 4018 * is no port information available in the SP. 4019 */ 4020 if ((saidx1->mode == IPSEC_MODE_TUNNEL || 4021 (saidx1->mode == IPSEC_MODE_TRANSPORT && 4022 saidx1->proto == IPPROTO_ESP)) && 4023 saidx1->src.sa.sa_family == AF_INET && 4024 saidx1->dst.sa.sa_family == AF_INET && 4025 ((const struct sockaddr_in *)(&saidx1->src))->sin_port && 4026 ((const struct sockaddr_in *)(&saidx1->dst))->sin_port) 4027 chkport = 1; 4028 #endif /* IPSEC_NAT_T */ 4029 4030 if (key_sockaddrcmp(&saidx0->src.sa, &saidx1->src.sa, chkport) != 0) { 4031 return 0; 4032 } 4033 if (key_sockaddrcmp(&saidx0->dst.sa, &saidx1->dst.sa, chkport) != 0) { 4034 return 0; 4035 } 4036 } 4037 4038 return 1; 4039 } 4040 4041 /* 4042 * compare two secindex structure exactly. 4043 * IN: 4044 * spidx0: source, it is often in SPD. 4045 * spidx1: object, it is often from PFKEY message. 4046 * OUT: 4047 * 1 : equal 4048 * 0 : not equal 4049 */ 4050 static int 4051 key_cmpspidx_exactly(struct secpolicyindex *spidx0, 4052 struct secpolicyindex *spidx1) 4053 { 4054 /* sanity */ 4055 if (spidx0 == NULL && spidx1 == NULL) 4056 return 1; 4057 4058 if (spidx0 == NULL || spidx1 == NULL) 4059 return 0; 4060 4061 if (spidx0->prefs != spidx1->prefs 4062 || spidx0->prefd != spidx1->prefd 4063 || spidx0->ul_proto != spidx1->ul_proto) 4064 return 0; 4065 4066 return key_sockaddrcmp(&spidx0->src.sa, &spidx1->src.sa, 1) == 0 && 4067 key_sockaddrcmp(&spidx0->dst.sa, &spidx1->dst.sa, 1) == 0; 4068 } 4069 4070 /* 4071 * compare two secindex structure with mask. 4072 * IN: 4073 * spidx0: source, it is often in SPD. 4074 * spidx1: object, it is often from IP header. 4075 * OUT: 4076 * 1 : equal 4077 * 0 : not equal 4078 */ 4079 static int 4080 key_cmpspidx_withmask(struct secpolicyindex *spidx0, 4081 struct secpolicyindex *spidx1) 4082 { 4083 /* sanity */ 4084 if (spidx0 == NULL && spidx1 == NULL) 4085 return 1; 4086 4087 if (spidx0 == NULL || spidx1 == NULL) 4088 return 0; 4089 4090 if (spidx0->src.sa.sa_family != spidx1->src.sa.sa_family || 4091 spidx0->dst.sa.sa_family != spidx1->dst.sa.sa_family || 4092 spidx0->src.sa.sa_len != spidx1->src.sa.sa_len || 4093 spidx0->dst.sa.sa_len != spidx1->dst.sa.sa_len) 4094 return 0; 4095 4096 /* if spidx.ul_proto == IPSEC_ULPROTO_ANY, ignore. */ 4097 if (spidx0->ul_proto != (u_int16_t)IPSEC_ULPROTO_ANY 4098 && spidx0->ul_proto != spidx1->ul_proto) 4099 return 0; 4100 4101 switch (spidx0->src.sa.sa_family) { 4102 case AF_INET: 4103 if (spidx0->src.sin.sin_port != IPSEC_PORT_ANY 4104 && spidx0->src.sin.sin_port != spidx1->src.sin.sin_port) 4105 return 0; 4106 if (!key_bbcmp(&spidx0->src.sin.sin_addr, 4107 &spidx1->src.sin.sin_addr, spidx0->prefs)) 4108 return 0; 4109 break; 4110 case AF_INET6: 4111 if (spidx0->src.sin6.sin6_port != IPSEC_PORT_ANY 4112 && spidx0->src.sin6.sin6_port != spidx1->src.sin6.sin6_port) 4113 return 0; 4114 /* 4115 * scope_id check. if sin6_scope_id is 0, we regard it 4116 * as a wildcard scope, which matches any scope zone ID. 4117 */ 4118 if (spidx0->src.sin6.sin6_scope_id && 4119 spidx1->src.sin6.sin6_scope_id && 4120 spidx0->src.sin6.sin6_scope_id != spidx1->src.sin6.sin6_scope_id) 4121 return 0; 4122 if (!key_bbcmp(&spidx0->src.sin6.sin6_addr, 4123 &spidx1->src.sin6.sin6_addr, spidx0->prefs)) 4124 return 0; 4125 break; 4126 default: 4127 /* XXX */ 4128 if (bcmp(&spidx0->src, &spidx1->src, spidx0->src.sa.sa_len) != 0) 4129 return 0; 4130 break; 4131 } 4132 4133 switch (spidx0->dst.sa.sa_family) { 4134 case AF_INET: 4135 if (spidx0->dst.sin.sin_port != IPSEC_PORT_ANY 4136 && spidx0->dst.sin.sin_port != spidx1->dst.sin.sin_port) 4137 return 0; 4138 if (!key_bbcmp(&spidx0->dst.sin.sin_addr, 4139 &spidx1->dst.sin.sin_addr, spidx0->prefd)) 4140 return 0; 4141 break; 4142 case AF_INET6: 4143 if (spidx0->dst.sin6.sin6_port != IPSEC_PORT_ANY 4144 && spidx0->dst.sin6.sin6_port != spidx1->dst.sin6.sin6_port) 4145 return 0; 4146 /* 4147 * scope_id check. if sin6_scope_id is 0, we regard it 4148 * as a wildcard scope, which matches any scope zone ID. 4149 */ 4150 if (spidx0->dst.sin6.sin6_scope_id && 4151 spidx1->dst.sin6.sin6_scope_id && 4152 spidx0->dst.sin6.sin6_scope_id != spidx1->dst.sin6.sin6_scope_id) 4153 return 0; 4154 if (!key_bbcmp(&spidx0->dst.sin6.sin6_addr, 4155 &spidx1->dst.sin6.sin6_addr, spidx0->prefd)) 4156 return 0; 4157 break; 4158 default: 4159 /* XXX */ 4160 if (bcmp(&spidx0->dst, &spidx1->dst, spidx0->dst.sa.sa_len) != 0) 4161 return 0; 4162 break; 4163 } 4164 4165 /* XXX Do we check other field ? e.g. flowinfo */ 4166 4167 return 1; 4168 } 4169 4170 /* returns 0 on match */ 4171 static int 4172 key_sockaddrcmp(const struct sockaddr *sa1, const struct sockaddr *sa2, 4173 int port) 4174 { 4175 #ifdef satosin 4176 #undef satosin 4177 #endif 4178 #define satosin(s) ((const struct sockaddr_in *)s) 4179 #ifdef satosin6 4180 #undef satosin6 4181 #endif 4182 #define satosin6(s) ((const struct sockaddr_in6 *)s) 4183 if (sa1->sa_family != sa2->sa_family || sa1->sa_len != sa2->sa_len) 4184 return 1; 4185 4186 switch (sa1->sa_family) { 4187 case AF_INET: 4188 if (sa1->sa_len != sizeof(struct sockaddr_in)) 4189 return 1; 4190 if (satosin(sa1)->sin_addr.s_addr != 4191 satosin(sa2)->sin_addr.s_addr) { 4192 return 1; 4193 } 4194 if (port && satosin(sa1)->sin_port != satosin(sa2)->sin_port) 4195 return 1; 4196 break; 4197 case AF_INET6: 4198 if (sa1->sa_len != sizeof(struct sockaddr_in6)) 4199 return 1; /*EINVAL*/ 4200 if (satosin6(sa1)->sin6_scope_id != 4201 satosin6(sa2)->sin6_scope_id) { 4202 return 1; 4203 } 4204 if (!IN6_ARE_ADDR_EQUAL(&satosin6(sa1)->sin6_addr, 4205 &satosin6(sa2)->sin6_addr)) { 4206 return 1; 4207 } 4208 if (port && 4209 satosin6(sa1)->sin6_port != satosin6(sa2)->sin6_port) { 4210 return 1; 4211 } 4212 break; 4213 default: 4214 if (bcmp(sa1, sa2, sa1->sa_len) != 0) 4215 return 1; 4216 break; 4217 } 4218 4219 return 0; 4220 #undef satosin 4221 #undef satosin6 4222 } 4223 4224 /* 4225 * compare two buffers with mask. 4226 * IN: 4227 * addr1: source 4228 * addr2: object 4229 * bits: Number of bits to compare 4230 * OUT: 4231 * 1 : equal 4232 * 0 : not equal 4233 */ 4234 static int 4235 key_bbcmp(const void *a1, const void *a2, u_int bits) 4236 { 4237 const unsigned char *p1 = a1; 4238 const unsigned char *p2 = a2; 4239 4240 /* XXX: This could be considerably faster if we compare a word 4241 * at a time, but it is complicated on LSB Endian machines */ 4242 4243 /* Handle null pointers */ 4244 if (p1 == NULL || p2 == NULL) 4245 return (p1 == p2); 4246 4247 while (bits >= 8) { 4248 if (*p1++ != *p2++) 4249 return 0; 4250 bits -= 8; 4251 } 4252 4253 if (bits > 0) { 4254 u_int8_t mask = ~((1<<(8-bits))-1); 4255 if ((*p1 & mask) != (*p2 & mask)) 4256 return 0; 4257 } 4258 return 1; /* Match! */ 4259 } 4260 4261 static void 4262 key_flush_spd(time_t now) 4263 { 4264 SPTREE_RLOCK_TRACKER; 4265 struct secpolicy *sp; 4266 u_int dir; 4267 4268 /* SPD */ 4269 for (dir = 0; dir < IPSEC_DIR_MAX; dir++) { 4270 restart: 4271 SPTREE_RLOCK(); 4272 TAILQ_FOREACH(sp, &V_sptree[dir], chain) { 4273 if (sp->lifetime == 0 && sp->validtime == 0) 4274 continue; 4275 if ((sp->lifetime && 4276 now - sp->created > sp->lifetime) || 4277 (sp->validtime && 4278 now - sp->lastused > sp->validtime)) { 4279 SP_ADDREF(sp); 4280 SPTREE_RUNLOCK(); 4281 key_spdexpire(sp); 4282 key_unlink(sp); 4283 KEY_FREESP(&sp); 4284 goto restart; 4285 } 4286 } 4287 SPTREE_RUNLOCK(); 4288 } 4289 } 4290 4291 static void 4292 key_flush_sad(time_t now) 4293 { 4294 struct secashead *sah, *nextsah; 4295 struct secasvar *sav, *nextsav; 4296 4297 /* SAD */ 4298 SAHTREE_LOCK(); 4299 LIST_FOREACH_SAFE(sah, &V_sahtree, chain, nextsah) { 4300 /* if sah has been dead, then delete it and process next sah. */ 4301 if (sah->state == SADB_SASTATE_DEAD) { 4302 key_delsah(sah); 4303 continue; 4304 } 4305 4306 /* if LARVAL entry doesn't become MATURE, delete it. */ 4307 LIST_FOREACH_SAFE(sav, &sah->savtree[SADB_SASTATE_LARVAL], chain, nextsav) { 4308 /* Need to also check refcnt for a larval SA ??? */ 4309 if (now - sav->created > V_key_larval_lifetime) 4310 KEY_FREESAV(&sav); 4311 } 4312 4313 /* 4314 * check MATURE entry to start to send expire message 4315 * whether or not. 4316 */ 4317 LIST_FOREACH_SAFE(sav, &sah->savtree[SADB_SASTATE_MATURE], chain, nextsav) { 4318 /* we don't need to check. */ 4319 if (sav->lft_s == NULL) 4320 continue; 4321 4322 /* sanity check */ 4323 if (sav->lft_c == NULL) { 4324 ipseclog((LOG_DEBUG,"%s: there is no CURRENT " 4325 "time, why?\n", __func__)); 4326 continue; 4327 } 4328 /* 4329 * RFC 2367: 4330 * HARD lifetimes MUST take precedence over SOFT 4331 * lifetimes, meaning if the HARD and SOFT lifetimes 4332 * are the same, the HARD lifetime will appear on the 4333 * EXPIRE message. 4334 */ 4335 /* check HARD lifetime */ 4336 if ((sav->lft_h->addtime != 0 && 4337 now - sav->created > sav->lft_h->addtime) || 4338 (sav->lft_h->bytes != 0 && 4339 sav->lft_h->bytes < sav->lft_c->bytes)) { 4340 key_sa_chgstate(sav, SADB_SASTATE_DEAD); 4341 key_expire(sav, 1); 4342 KEY_FREESAV(&sav); 4343 } 4344 /* check SOFT lifetime */ 4345 else if ((sav->lft_s->addtime != 0 && 4346 now - sav->created > sav->lft_s->addtime) || 4347 (sav->lft_s->bytes != 0 && 4348 sav->lft_s->bytes < sav->lft_c->bytes)) { 4349 key_sa_chgstate(sav, SADB_SASTATE_DYING); 4350 key_expire(sav, 0); 4351 } 4352 } 4353 4354 /* check DYING entry to change status to DEAD. */ 4355 LIST_FOREACH_SAFE(sav, &sah->savtree[SADB_SASTATE_DYING], chain, nextsav) { 4356 /* we don't need to check. */ 4357 if (sav->lft_h == NULL) 4358 continue; 4359 4360 /* sanity check */ 4361 if (sav->lft_c == NULL) { 4362 ipseclog((LOG_DEBUG, "%s: there is no CURRENT " 4363 "time, why?\n", __func__)); 4364 continue; 4365 } 4366 4367 if (sav->lft_h->addtime != 0 && 4368 now - sav->created > sav->lft_h->addtime) { 4369 key_sa_chgstate(sav, SADB_SASTATE_DEAD); 4370 key_expire(sav, 1); 4371 KEY_FREESAV(&sav); 4372 } 4373 #if 0 /* XXX Should we keep to send expire message until HARD lifetime ? */ 4374 else if (sav->lft_s != NULL 4375 && sav->lft_s->addtime != 0 4376 && now - sav->created > sav->lft_s->addtime) { 4377 /* 4378 * XXX: should be checked to be 4379 * installed the valid SA. 4380 */ 4381 4382 /* 4383 * If there is no SA then sending 4384 * expire message. 4385 */ 4386 key_expire(sav, 0); 4387 } 4388 #endif 4389 /* check HARD lifetime by bytes */ 4390 else if (sav->lft_h->bytes != 0 && 4391 sav->lft_h->bytes < sav->lft_c->bytes) { 4392 key_sa_chgstate(sav, SADB_SASTATE_DEAD); 4393 key_expire(sav, 1); 4394 KEY_FREESAV(&sav); 4395 } 4396 } 4397 4398 /* delete entry in DEAD */ 4399 LIST_FOREACH_SAFE(sav, &sah->savtree[SADB_SASTATE_DEAD], chain, nextsav) { 4400 /* sanity check */ 4401 if (sav->state != SADB_SASTATE_DEAD) { 4402 ipseclog((LOG_DEBUG, "%s: invalid sav->state " 4403 "(queue: %d SA: %d): kill it anyway\n", 4404 __func__, 4405 SADB_SASTATE_DEAD, sav->state)); 4406 } 4407 /* 4408 * do not call key_freesav() here. 4409 * sav should already be freed, and sav->refcnt 4410 * shows other references to sav 4411 * (such as from SPD). 4412 */ 4413 } 4414 } 4415 SAHTREE_UNLOCK(); 4416 } 4417 4418 static void 4419 key_flush_acq(time_t now) 4420 { 4421 struct secacq *acq, *nextacq; 4422 4423 /* ACQ tree */ 4424 ACQ_LOCK(); 4425 for (acq = LIST_FIRST(&V_acqtree); acq != NULL; acq = nextacq) { 4426 nextacq = LIST_NEXT(acq, chain); 4427 if (now - acq->created > V_key_blockacq_lifetime 4428 && __LIST_CHAINED(acq)) { 4429 LIST_REMOVE(acq, chain); 4430 free(acq, M_IPSEC_SAQ); 4431 } 4432 } 4433 ACQ_UNLOCK(); 4434 } 4435 4436 static void 4437 key_flush_spacq(time_t now) 4438 { 4439 struct secspacq *acq, *nextacq; 4440 4441 /* SP ACQ tree */ 4442 SPACQ_LOCK(); 4443 for (acq = LIST_FIRST(&V_spacqtree); acq != NULL; acq = nextacq) { 4444 nextacq = LIST_NEXT(acq, chain); 4445 if (now - acq->created > V_key_blockacq_lifetime 4446 && __LIST_CHAINED(acq)) { 4447 LIST_REMOVE(acq, chain); 4448 free(acq, M_IPSEC_SAQ); 4449 } 4450 } 4451 SPACQ_UNLOCK(); 4452 } 4453 4454 /* 4455 * time handler. 4456 * scanning SPD and SAD to check status for each entries, 4457 * and do to remove or to expire. 4458 * XXX: year 2038 problem may remain. 4459 */ 4460 static void 4461 key_timehandler(void *arg) 4462 { 4463 VNET_ITERATOR_DECL(vnet_iter); 4464 time_t now = time_second; 4465 4466 VNET_LIST_RLOCK_NOSLEEP(); 4467 VNET_FOREACH(vnet_iter) { 4468 CURVNET_SET(vnet_iter); 4469 key_flush_spd(now); 4470 key_flush_sad(now); 4471 key_flush_acq(now); 4472 key_flush_spacq(now); 4473 CURVNET_RESTORE(); 4474 } 4475 VNET_LIST_RUNLOCK_NOSLEEP(); 4476 4477 #ifndef IPSEC_DEBUG2 4478 /* do exchange to tick time !! */ 4479 callout_schedule(&key_timer, hz); 4480 #endif /* IPSEC_DEBUG2 */ 4481 } 4482 4483 u_long 4484 key_random() 4485 { 4486 u_long value; 4487 4488 key_randomfill(&value, sizeof(value)); 4489 return value; 4490 } 4491 4492 void 4493 key_randomfill(void *p, size_t l) 4494 { 4495 size_t n; 4496 u_long v; 4497 static int warn = 1; 4498 4499 n = 0; 4500 n = (size_t)read_random(p, (u_int)l); 4501 /* last resort */ 4502 while (n < l) { 4503 v = random(); 4504 bcopy(&v, (u_int8_t *)p + n, 4505 l - n < sizeof(v) ? l - n : sizeof(v)); 4506 n += sizeof(v); 4507 4508 if (warn) { 4509 printf("WARNING: pseudo-random number generator " 4510 "used for IPsec processing\n"); 4511 warn = 0; 4512 } 4513 } 4514 } 4515 4516 /* 4517 * map SADB_SATYPE_* to IPPROTO_*. 4518 * if satype == SADB_SATYPE then satype is mapped to ~0. 4519 * OUT: 4520 * 0: invalid satype. 4521 */ 4522 static u_int16_t 4523 key_satype2proto(u_int8_t satype) 4524 { 4525 switch (satype) { 4526 case SADB_SATYPE_UNSPEC: 4527 return IPSEC_PROTO_ANY; 4528 case SADB_SATYPE_AH: 4529 return IPPROTO_AH; 4530 case SADB_SATYPE_ESP: 4531 return IPPROTO_ESP; 4532 case SADB_X_SATYPE_IPCOMP: 4533 return IPPROTO_IPCOMP; 4534 case SADB_X_SATYPE_TCPSIGNATURE: 4535 return IPPROTO_TCP; 4536 default: 4537 return 0; 4538 } 4539 /* NOTREACHED */ 4540 } 4541 4542 /* 4543 * map IPPROTO_* to SADB_SATYPE_* 4544 * OUT: 4545 * 0: invalid protocol type. 4546 */ 4547 static u_int8_t 4548 key_proto2satype(u_int16_t proto) 4549 { 4550 switch (proto) { 4551 case IPPROTO_AH: 4552 return SADB_SATYPE_AH; 4553 case IPPROTO_ESP: 4554 return SADB_SATYPE_ESP; 4555 case IPPROTO_IPCOMP: 4556 return SADB_X_SATYPE_IPCOMP; 4557 case IPPROTO_TCP: 4558 return SADB_X_SATYPE_TCPSIGNATURE; 4559 default: 4560 return 0; 4561 } 4562 /* NOTREACHED */ 4563 } 4564 4565 /* %%% PF_KEY */ 4566 /* 4567 * SADB_GETSPI processing is to receive 4568 * <base, (SA2), src address, dst address, (SPI range)> 4569 * from the IKMPd, to assign a unique spi value, to hang on the INBOUND 4570 * tree with the status of LARVAL, and send 4571 * <base, SA(*), address(SD)> 4572 * to the IKMPd. 4573 * 4574 * IN: mhp: pointer to the pointer to each header. 4575 * OUT: NULL if fail. 4576 * other if success, return pointer to the message to send. 4577 */ 4578 static int 4579 key_getspi(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 4580 { 4581 struct sadb_address *src0, *dst0; 4582 struct secasindex saidx; 4583 struct secashead *newsah; 4584 struct secasvar *newsav; 4585 u_int8_t proto; 4586 u_int32_t spi; 4587 u_int8_t mode; 4588 u_int32_t reqid; 4589 int error; 4590 4591 IPSEC_ASSERT(so != NULL, ("null socket")); 4592 IPSEC_ASSERT(m != NULL, ("null mbuf")); 4593 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 4594 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 4595 4596 if (mhp->ext[SADB_EXT_ADDRESS_SRC] == NULL || 4597 mhp->ext[SADB_EXT_ADDRESS_DST] == NULL) { 4598 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 4599 __func__)); 4600 return key_senderror(so, m, EINVAL); 4601 } 4602 if (mhp->extlen[SADB_EXT_ADDRESS_SRC] < sizeof(struct sadb_address) || 4603 mhp->extlen[SADB_EXT_ADDRESS_DST] < sizeof(struct sadb_address)) { 4604 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 4605 __func__)); 4606 return key_senderror(so, m, EINVAL); 4607 } 4608 if (mhp->ext[SADB_X_EXT_SA2] != NULL) { 4609 mode = ((struct sadb_x_sa2 *)mhp->ext[SADB_X_EXT_SA2])->sadb_x_sa2_mode; 4610 reqid = ((struct sadb_x_sa2 *)mhp->ext[SADB_X_EXT_SA2])->sadb_x_sa2_reqid; 4611 } else { 4612 mode = IPSEC_MODE_ANY; 4613 reqid = 0; 4614 } 4615 4616 src0 = (struct sadb_address *)(mhp->ext[SADB_EXT_ADDRESS_SRC]); 4617 dst0 = (struct sadb_address *)(mhp->ext[SADB_EXT_ADDRESS_DST]); 4618 4619 /* map satype to proto */ 4620 if ((proto = key_satype2proto(mhp->msg->sadb_msg_satype)) == 0) { 4621 ipseclog((LOG_DEBUG, "%s: invalid satype is passed.\n", 4622 __func__)); 4623 return key_senderror(so, m, EINVAL); 4624 } 4625 4626 /* 4627 * Make sure the port numbers are zero. 4628 * In case of NAT-T we will update them later if needed. 4629 */ 4630 switch (((struct sockaddr *)(src0 + 1))->sa_family) { 4631 case AF_INET: 4632 if (((struct sockaddr *)(src0 + 1))->sa_len != 4633 sizeof(struct sockaddr_in)) 4634 return key_senderror(so, m, EINVAL); 4635 ((struct sockaddr_in *)(src0 + 1))->sin_port = 0; 4636 break; 4637 case AF_INET6: 4638 if (((struct sockaddr *)(src0 + 1))->sa_len != 4639 sizeof(struct sockaddr_in6)) 4640 return key_senderror(so, m, EINVAL); 4641 ((struct sockaddr_in6 *)(src0 + 1))->sin6_port = 0; 4642 break; 4643 default: 4644 ; /*???*/ 4645 } 4646 switch (((struct sockaddr *)(dst0 + 1))->sa_family) { 4647 case AF_INET: 4648 if (((struct sockaddr *)(dst0 + 1))->sa_len != 4649 sizeof(struct sockaddr_in)) 4650 return key_senderror(so, m, EINVAL); 4651 ((struct sockaddr_in *)(dst0 + 1))->sin_port = 0; 4652 break; 4653 case AF_INET6: 4654 if (((struct sockaddr *)(dst0 + 1))->sa_len != 4655 sizeof(struct sockaddr_in6)) 4656 return key_senderror(so, m, EINVAL); 4657 ((struct sockaddr_in6 *)(dst0 + 1))->sin6_port = 0; 4658 break; 4659 default: 4660 ; /*???*/ 4661 } 4662 4663 /* XXX boundary check against sa_len */ 4664 KEY_SETSECASIDX(proto, mode, reqid, src0 + 1, dst0 + 1, &saidx); 4665 4666 #ifdef IPSEC_NAT_T 4667 /* 4668 * Handle NAT-T info if present. 4669 * We made sure the port numbers are zero above, so we do 4670 * not have to worry in case we do not update them. 4671 */ 4672 if (mhp->ext[SADB_X_EXT_NAT_T_OAI] != NULL) 4673 ipseclog((LOG_DEBUG, "%s: NAT-T OAi present\n", __func__)); 4674 if (mhp->ext[SADB_X_EXT_NAT_T_OAR] != NULL) 4675 ipseclog((LOG_DEBUG, "%s: NAT-T OAr present\n", __func__)); 4676 4677 if (mhp->ext[SADB_X_EXT_NAT_T_TYPE] != NULL && 4678 mhp->ext[SADB_X_EXT_NAT_T_SPORT] != NULL && 4679 mhp->ext[SADB_X_EXT_NAT_T_DPORT] != NULL) { 4680 struct sadb_x_nat_t_type *type; 4681 struct sadb_x_nat_t_port *sport, *dport; 4682 4683 if (mhp->extlen[SADB_X_EXT_NAT_T_TYPE] < sizeof(*type) || 4684 mhp->extlen[SADB_X_EXT_NAT_T_SPORT] < sizeof(*sport) || 4685 mhp->extlen[SADB_X_EXT_NAT_T_DPORT] < sizeof(*dport)) { 4686 ipseclog((LOG_DEBUG, "%s: invalid nat-t message " 4687 "passed.\n", __func__)); 4688 return key_senderror(so, m, EINVAL); 4689 } 4690 4691 sport = (struct sadb_x_nat_t_port *) 4692 mhp->ext[SADB_X_EXT_NAT_T_SPORT]; 4693 dport = (struct sadb_x_nat_t_port *) 4694 mhp->ext[SADB_X_EXT_NAT_T_DPORT]; 4695 4696 if (sport) 4697 KEY_PORTTOSADDR(&saidx.src, sport->sadb_x_nat_t_port_port); 4698 if (dport) 4699 KEY_PORTTOSADDR(&saidx.dst, dport->sadb_x_nat_t_port_port); 4700 } 4701 #endif 4702 4703 /* SPI allocation */ 4704 spi = key_do_getnewspi((struct sadb_spirange *)mhp->ext[SADB_EXT_SPIRANGE], 4705 &saidx); 4706 if (spi == 0) 4707 return key_senderror(so, m, EINVAL); 4708 4709 /* get a SA index */ 4710 if ((newsah = key_getsah(&saidx)) == NULL) { 4711 /* create a new SA index */ 4712 if ((newsah = key_newsah(&saidx)) == NULL) { 4713 ipseclog((LOG_DEBUG, "%s: No more memory.\n",__func__)); 4714 return key_senderror(so, m, ENOBUFS); 4715 } 4716 } 4717 4718 /* get a new SA */ 4719 /* XXX rewrite */ 4720 newsav = KEY_NEWSAV(m, mhp, newsah, &error); 4721 if (newsav == NULL) { 4722 /* XXX don't free new SA index allocated in above. */ 4723 return key_senderror(so, m, error); 4724 } 4725 4726 /* set spi */ 4727 newsav->spi = htonl(spi); 4728 4729 /* delete the entry in acqtree */ 4730 if (mhp->msg->sadb_msg_seq != 0) { 4731 struct secacq *acq; 4732 if ((acq = key_getacqbyseq(mhp->msg->sadb_msg_seq)) != NULL) { 4733 /* reset counter in order to deletion by timehandler. */ 4734 acq->created = time_second; 4735 acq->count = 0; 4736 } 4737 } 4738 4739 { 4740 struct mbuf *n, *nn; 4741 struct sadb_sa *m_sa; 4742 struct sadb_msg *newmsg; 4743 int off, len; 4744 4745 /* create new sadb_msg to reply. */ 4746 len = PFKEY_ALIGN8(sizeof(struct sadb_msg)) + 4747 PFKEY_ALIGN8(sizeof(struct sadb_sa)); 4748 4749 MGETHDR(n, M_NOWAIT, MT_DATA); 4750 if (len > MHLEN) { 4751 if (!(MCLGET(n, M_NOWAIT))) { 4752 m_freem(n); 4753 n = NULL; 4754 } 4755 } 4756 if (!n) 4757 return key_senderror(so, m, ENOBUFS); 4758 4759 n->m_len = len; 4760 n->m_next = NULL; 4761 off = 0; 4762 4763 m_copydata(m, 0, sizeof(struct sadb_msg), mtod(n, caddr_t) + off); 4764 off += PFKEY_ALIGN8(sizeof(struct sadb_msg)); 4765 4766 m_sa = (struct sadb_sa *)(mtod(n, caddr_t) + off); 4767 m_sa->sadb_sa_len = PFKEY_UNIT64(sizeof(struct sadb_sa)); 4768 m_sa->sadb_sa_exttype = SADB_EXT_SA; 4769 m_sa->sadb_sa_spi = htonl(spi); 4770 off += PFKEY_ALIGN8(sizeof(struct sadb_sa)); 4771 4772 IPSEC_ASSERT(off == len, 4773 ("length inconsistency (off %u len %u)", off, len)); 4774 4775 n->m_next = key_gather_mbuf(m, mhp, 0, 2, SADB_EXT_ADDRESS_SRC, 4776 SADB_EXT_ADDRESS_DST); 4777 if (!n->m_next) { 4778 m_freem(n); 4779 return key_senderror(so, m, ENOBUFS); 4780 } 4781 4782 if (n->m_len < sizeof(struct sadb_msg)) { 4783 n = m_pullup(n, sizeof(struct sadb_msg)); 4784 if (n == NULL) 4785 return key_sendup_mbuf(so, m, KEY_SENDUP_ONE); 4786 } 4787 4788 n->m_pkthdr.len = 0; 4789 for (nn = n; nn; nn = nn->m_next) 4790 n->m_pkthdr.len += nn->m_len; 4791 4792 newmsg = mtod(n, struct sadb_msg *); 4793 newmsg->sadb_msg_seq = newsav->seq; 4794 newmsg->sadb_msg_errno = 0; 4795 newmsg->sadb_msg_len = PFKEY_UNIT64(n->m_pkthdr.len); 4796 4797 m_freem(m); 4798 return key_sendup_mbuf(so, n, KEY_SENDUP_ONE); 4799 } 4800 } 4801 4802 /* 4803 * allocating new SPI 4804 * called by key_getspi(). 4805 * OUT: 4806 * 0: failure. 4807 * others: success. 4808 */ 4809 static u_int32_t 4810 key_do_getnewspi(struct sadb_spirange *spirange, struct secasindex *saidx) 4811 { 4812 u_int32_t newspi; 4813 u_int32_t min, max; 4814 int count = V_key_spi_trycnt; 4815 4816 /* set spi range to allocate */ 4817 if (spirange != NULL) { 4818 min = spirange->sadb_spirange_min; 4819 max = spirange->sadb_spirange_max; 4820 } else { 4821 min = V_key_spi_minval; 4822 max = V_key_spi_maxval; 4823 } 4824 /* IPCOMP needs 2-byte SPI */ 4825 if (saidx->proto == IPPROTO_IPCOMP) { 4826 u_int32_t t; 4827 if (min >= 0x10000) 4828 min = 0xffff; 4829 if (max >= 0x10000) 4830 max = 0xffff; 4831 if (min > max) { 4832 t = min; min = max; max = t; 4833 } 4834 } 4835 4836 if (min == max) { 4837 if (key_checkspidup(saidx, min) != NULL) { 4838 ipseclog((LOG_DEBUG, "%s: SPI %u exists already.\n", 4839 __func__, min)); 4840 return 0; 4841 } 4842 4843 count--; /* taking one cost. */ 4844 newspi = min; 4845 4846 } else { 4847 4848 /* init SPI */ 4849 newspi = 0; 4850 4851 /* when requesting to allocate spi ranged */ 4852 while (count--) { 4853 /* generate pseudo-random SPI value ranged. */ 4854 newspi = min + (key_random() % (max - min + 1)); 4855 4856 if (key_checkspidup(saidx, newspi) == NULL) 4857 break; 4858 } 4859 4860 if (count == 0 || newspi == 0) { 4861 ipseclog((LOG_DEBUG, "%s: to allocate spi is failed.\n", 4862 __func__)); 4863 return 0; 4864 } 4865 } 4866 4867 /* statistics */ 4868 keystat.getspi_count = 4869 (keystat.getspi_count + V_key_spi_trycnt - count) / 2; 4870 4871 return newspi; 4872 } 4873 4874 /* 4875 * SADB_UPDATE processing 4876 * receive 4877 * <base, SA, (SA2), (lifetime(HSC),) address(SD), (address(P),) 4878 * key(AE), (identity(SD),) (sensitivity)> 4879 * from the ikmpd, and update a secasvar entry whose status is SADB_SASTATE_LARVAL. 4880 * and send 4881 * <base, SA, (SA2), (lifetime(HSC),) address(SD), (address(P),) 4882 * (identity(SD),) (sensitivity)> 4883 * to the ikmpd. 4884 * 4885 * m will always be freed. 4886 */ 4887 static int 4888 key_update(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 4889 { 4890 struct sadb_sa *sa0; 4891 struct sadb_address *src0, *dst0; 4892 #ifdef IPSEC_NAT_T 4893 struct sadb_x_nat_t_type *type; 4894 struct sadb_x_nat_t_port *sport, *dport; 4895 struct sadb_address *iaddr, *raddr; 4896 struct sadb_x_nat_t_frag *frag; 4897 #endif 4898 struct secasindex saidx; 4899 struct secashead *sah; 4900 struct secasvar *sav; 4901 u_int16_t proto; 4902 u_int8_t mode; 4903 u_int32_t reqid; 4904 int error; 4905 4906 IPSEC_ASSERT(so != NULL, ("null socket")); 4907 IPSEC_ASSERT(m != NULL, ("null mbuf")); 4908 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 4909 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 4910 4911 /* map satype to proto */ 4912 if ((proto = key_satype2proto(mhp->msg->sadb_msg_satype)) == 0) { 4913 ipseclog((LOG_DEBUG, "%s: invalid satype is passed.\n", 4914 __func__)); 4915 return key_senderror(so, m, EINVAL); 4916 } 4917 4918 if (mhp->ext[SADB_EXT_SA] == NULL || 4919 mhp->ext[SADB_EXT_ADDRESS_SRC] == NULL || 4920 mhp->ext[SADB_EXT_ADDRESS_DST] == NULL || 4921 (mhp->msg->sadb_msg_satype == SADB_SATYPE_ESP && 4922 mhp->ext[SADB_EXT_KEY_ENCRYPT] == NULL) || 4923 (mhp->msg->sadb_msg_satype == SADB_SATYPE_AH && 4924 mhp->ext[SADB_EXT_KEY_AUTH] == NULL) || 4925 (mhp->ext[SADB_EXT_LIFETIME_HARD] != NULL && 4926 mhp->ext[SADB_EXT_LIFETIME_SOFT] == NULL) || 4927 (mhp->ext[SADB_EXT_LIFETIME_HARD] == NULL && 4928 mhp->ext[SADB_EXT_LIFETIME_SOFT] != NULL)) { 4929 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 4930 __func__)); 4931 return key_senderror(so, m, EINVAL); 4932 } 4933 if (mhp->extlen[SADB_EXT_SA] < sizeof(struct sadb_sa) || 4934 mhp->extlen[SADB_EXT_ADDRESS_SRC] < sizeof(struct sadb_address) || 4935 mhp->extlen[SADB_EXT_ADDRESS_DST] < sizeof(struct sadb_address)) { 4936 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 4937 __func__)); 4938 return key_senderror(so, m, EINVAL); 4939 } 4940 if (mhp->ext[SADB_X_EXT_SA2] != NULL) { 4941 mode = ((struct sadb_x_sa2 *)mhp->ext[SADB_X_EXT_SA2])->sadb_x_sa2_mode; 4942 reqid = ((struct sadb_x_sa2 *)mhp->ext[SADB_X_EXT_SA2])->sadb_x_sa2_reqid; 4943 } else { 4944 mode = IPSEC_MODE_ANY; 4945 reqid = 0; 4946 } 4947 /* XXX boundary checking for other extensions */ 4948 4949 sa0 = (struct sadb_sa *)mhp->ext[SADB_EXT_SA]; 4950 src0 = (struct sadb_address *)(mhp->ext[SADB_EXT_ADDRESS_SRC]); 4951 dst0 = (struct sadb_address *)(mhp->ext[SADB_EXT_ADDRESS_DST]); 4952 4953 /* XXX boundary check against sa_len */ 4954 KEY_SETSECASIDX(proto, mode, reqid, src0 + 1, dst0 + 1, &saidx); 4955 4956 /* 4957 * Make sure the port numbers are zero. 4958 * In case of NAT-T we will update them later if needed. 4959 */ 4960 KEY_PORTTOSADDR(&saidx.src, 0); 4961 KEY_PORTTOSADDR(&saidx.dst, 0); 4962 4963 #ifdef IPSEC_NAT_T 4964 /* 4965 * Handle NAT-T info if present. 4966 */ 4967 if (mhp->ext[SADB_X_EXT_NAT_T_TYPE] != NULL && 4968 mhp->ext[SADB_X_EXT_NAT_T_SPORT] != NULL && 4969 mhp->ext[SADB_X_EXT_NAT_T_DPORT] != NULL) { 4970 4971 if (mhp->extlen[SADB_X_EXT_NAT_T_TYPE] < sizeof(*type) || 4972 mhp->extlen[SADB_X_EXT_NAT_T_SPORT] < sizeof(*sport) || 4973 mhp->extlen[SADB_X_EXT_NAT_T_DPORT] < sizeof(*dport)) { 4974 ipseclog((LOG_DEBUG, "%s: invalid message.\n", 4975 __func__)); 4976 return key_senderror(so, m, EINVAL); 4977 } 4978 4979 type = (struct sadb_x_nat_t_type *) 4980 mhp->ext[SADB_X_EXT_NAT_T_TYPE]; 4981 sport = (struct sadb_x_nat_t_port *) 4982 mhp->ext[SADB_X_EXT_NAT_T_SPORT]; 4983 dport = (struct sadb_x_nat_t_port *) 4984 mhp->ext[SADB_X_EXT_NAT_T_DPORT]; 4985 } else { 4986 type = NULL; 4987 sport = dport = NULL; 4988 } 4989 if (mhp->ext[SADB_X_EXT_NAT_T_OAI] != NULL && 4990 mhp->ext[SADB_X_EXT_NAT_T_OAR] != NULL) { 4991 if (mhp->extlen[SADB_X_EXT_NAT_T_OAI] < sizeof(*iaddr) || 4992 mhp->extlen[SADB_X_EXT_NAT_T_OAR] < sizeof(*raddr)) { 4993 ipseclog((LOG_DEBUG, "%s: invalid message\n", 4994 __func__)); 4995 return key_senderror(so, m, EINVAL); 4996 } 4997 iaddr = (struct sadb_address *)mhp->ext[SADB_X_EXT_NAT_T_OAI]; 4998 raddr = (struct sadb_address *)mhp->ext[SADB_X_EXT_NAT_T_OAR]; 4999 ipseclog((LOG_DEBUG, "%s: NAT-T OAi/r present\n", __func__)); 5000 } else { 5001 iaddr = raddr = NULL; 5002 } 5003 if (mhp->ext[SADB_X_EXT_NAT_T_FRAG] != NULL) { 5004 if (mhp->extlen[SADB_X_EXT_NAT_T_FRAG] < sizeof(*frag)) { 5005 ipseclog((LOG_DEBUG, "%s: invalid message\n", 5006 __func__)); 5007 return key_senderror(so, m, EINVAL); 5008 } 5009 frag = (struct sadb_x_nat_t_frag *) 5010 mhp->ext[SADB_X_EXT_NAT_T_FRAG]; 5011 } else { 5012 frag = NULL; 5013 } 5014 #endif 5015 5016 /* get a SA header */ 5017 if ((sah = key_getsah(&saidx)) == NULL) { 5018 ipseclog((LOG_DEBUG, "%s: no SA index found.\n", __func__)); 5019 return key_senderror(so, m, ENOENT); 5020 } 5021 5022 /* set spidx if there */ 5023 /* XXX rewrite */ 5024 error = key_setident(sah, m, mhp); 5025 if (error) 5026 return key_senderror(so, m, error); 5027 5028 /* find a SA with sequence number. */ 5029 #ifdef IPSEC_DOSEQCHECK 5030 if (mhp->msg->sadb_msg_seq != 0 5031 && (sav = key_getsavbyseq(sah, mhp->msg->sadb_msg_seq)) == NULL) { 5032 ipseclog((LOG_DEBUG, "%s: no larval SA with sequence %u " 5033 "exists.\n", __func__, mhp->msg->sadb_msg_seq)); 5034 return key_senderror(so, m, ENOENT); 5035 } 5036 #else 5037 SAHTREE_LOCK(); 5038 sav = key_getsavbyspi(sah, sa0->sadb_sa_spi); 5039 SAHTREE_UNLOCK(); 5040 if (sav == NULL) { 5041 ipseclog((LOG_DEBUG, "%s: no such a SA found (spi:%u)\n", 5042 __func__, (u_int32_t)ntohl(sa0->sadb_sa_spi))); 5043 return key_senderror(so, m, EINVAL); 5044 } 5045 #endif 5046 5047 /* validity check */ 5048 if (sav->sah->saidx.proto != proto) { 5049 ipseclog((LOG_DEBUG, "%s: protocol mismatched " 5050 "(DB=%u param=%u)\n", __func__, 5051 sav->sah->saidx.proto, proto)); 5052 return key_senderror(so, m, EINVAL); 5053 } 5054 #ifdef IPSEC_DOSEQCHECK 5055 if (sav->spi != sa0->sadb_sa_spi) { 5056 ipseclog((LOG_DEBUG, "%s: SPI mismatched (DB:%u param:%u)\n", 5057 __func__, 5058 (u_int32_t)ntohl(sav->spi), 5059 (u_int32_t)ntohl(sa0->sadb_sa_spi))); 5060 return key_senderror(so, m, EINVAL); 5061 } 5062 #endif 5063 if (sav->pid != mhp->msg->sadb_msg_pid) { 5064 ipseclog((LOG_DEBUG, "%s: pid mismatched (DB:%u param:%u)\n", 5065 __func__, sav->pid, mhp->msg->sadb_msg_pid)); 5066 return key_senderror(so, m, EINVAL); 5067 } 5068 5069 /* copy sav values */ 5070 error = key_setsaval(sav, m, mhp); 5071 if (error) { 5072 KEY_FREESAV(&sav); 5073 return key_senderror(so, m, error); 5074 } 5075 5076 #ifdef IPSEC_NAT_T 5077 /* 5078 * Handle more NAT-T info if present, 5079 * now that we have a sav to fill. 5080 */ 5081 if (type) 5082 sav->natt_type = type->sadb_x_nat_t_type_type; 5083 5084 if (sport) 5085 KEY_PORTTOSADDR(&sav->sah->saidx.src, 5086 sport->sadb_x_nat_t_port_port); 5087 if (dport) 5088 KEY_PORTTOSADDR(&sav->sah->saidx.dst, 5089 dport->sadb_x_nat_t_port_port); 5090 5091 #if 0 5092 /* 5093 * In case SADB_X_EXT_NAT_T_FRAG was not given, leave it at 0. 5094 * We should actually check for a minimum MTU here, if we 5095 * want to support it in ip_output. 5096 */ 5097 if (frag) 5098 sav->natt_esp_frag_len = frag->sadb_x_nat_t_frag_fraglen; 5099 #endif 5100 #endif 5101 5102 /* check SA values to be mature. */ 5103 if ((mhp->msg->sadb_msg_errno = key_mature(sav)) != 0) { 5104 KEY_FREESAV(&sav); 5105 return key_senderror(so, m, 0); 5106 } 5107 5108 { 5109 struct mbuf *n; 5110 5111 /* set msg buf from mhp */ 5112 n = key_getmsgbuf_x1(m, mhp); 5113 if (n == NULL) { 5114 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 5115 return key_senderror(so, m, ENOBUFS); 5116 } 5117 5118 m_freem(m); 5119 return key_sendup_mbuf(so, n, KEY_SENDUP_ALL); 5120 } 5121 } 5122 5123 /* 5124 * search SAD with sequence for a SA which state is SADB_SASTATE_LARVAL. 5125 * only called by key_update(). 5126 * OUT: 5127 * NULL : not found 5128 * others : found, pointer to a SA. 5129 */ 5130 #ifdef IPSEC_DOSEQCHECK 5131 static struct secasvar * 5132 key_getsavbyseq(struct secashead *sah, u_int32_t seq) 5133 { 5134 struct secasvar *sav; 5135 u_int state; 5136 5137 state = SADB_SASTATE_LARVAL; 5138 5139 /* search SAD with sequence number ? */ 5140 LIST_FOREACH(sav, &sah->savtree[state], chain) { 5141 5142 KEY_CHKSASTATE(state, sav->state, __func__); 5143 5144 if (sav->seq == seq) { 5145 sa_addref(sav); 5146 KEYDEBUG(KEYDEBUG_IPSEC_STAMP, 5147 printf("DP %s cause refcnt++:%d SA:%p\n", 5148 __func__, sav->refcnt, sav)); 5149 return sav; 5150 } 5151 } 5152 5153 return NULL; 5154 } 5155 #endif 5156 5157 /* 5158 * SADB_ADD processing 5159 * add an entry to SA database, when received 5160 * <base, SA, (SA2), (lifetime(HSC),) address(SD), (address(P),) 5161 * key(AE), (identity(SD),) (sensitivity)> 5162 * from the ikmpd, 5163 * and send 5164 * <base, SA, (SA2), (lifetime(HSC),) address(SD), (address(P),) 5165 * (identity(SD),) (sensitivity)> 5166 * to the ikmpd. 5167 * 5168 * IGNORE identity and sensitivity messages. 5169 * 5170 * m will always be freed. 5171 */ 5172 static int 5173 key_add(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 5174 { 5175 struct sadb_sa *sa0; 5176 struct sadb_address *src0, *dst0; 5177 #ifdef IPSEC_NAT_T 5178 struct sadb_x_nat_t_type *type; 5179 struct sadb_address *iaddr, *raddr; 5180 struct sadb_x_nat_t_frag *frag; 5181 #endif 5182 struct secasindex saidx; 5183 struct secashead *newsah; 5184 struct secasvar *newsav; 5185 u_int16_t proto; 5186 u_int8_t mode; 5187 u_int32_t reqid; 5188 int error; 5189 5190 IPSEC_ASSERT(so != NULL, ("null socket")); 5191 IPSEC_ASSERT(m != NULL, ("null mbuf")); 5192 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 5193 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 5194 5195 /* map satype to proto */ 5196 if ((proto = key_satype2proto(mhp->msg->sadb_msg_satype)) == 0) { 5197 ipseclog((LOG_DEBUG, "%s: invalid satype is passed.\n", 5198 __func__)); 5199 return key_senderror(so, m, EINVAL); 5200 } 5201 5202 if (mhp->ext[SADB_EXT_SA] == NULL || 5203 mhp->ext[SADB_EXT_ADDRESS_SRC] == NULL || 5204 mhp->ext[SADB_EXT_ADDRESS_DST] == NULL || 5205 (mhp->msg->sadb_msg_satype == SADB_SATYPE_ESP && 5206 mhp->ext[SADB_EXT_KEY_ENCRYPT] == NULL) || 5207 (mhp->msg->sadb_msg_satype == SADB_SATYPE_AH && 5208 mhp->ext[SADB_EXT_KEY_AUTH] == NULL) || 5209 (mhp->ext[SADB_EXT_LIFETIME_HARD] != NULL && 5210 mhp->ext[SADB_EXT_LIFETIME_SOFT] == NULL) || 5211 (mhp->ext[SADB_EXT_LIFETIME_HARD] == NULL && 5212 mhp->ext[SADB_EXT_LIFETIME_SOFT] != NULL)) { 5213 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 5214 __func__)); 5215 return key_senderror(so, m, EINVAL); 5216 } 5217 if (mhp->extlen[SADB_EXT_SA] < sizeof(struct sadb_sa) || 5218 mhp->extlen[SADB_EXT_ADDRESS_SRC] < sizeof(struct sadb_address) || 5219 mhp->extlen[SADB_EXT_ADDRESS_DST] < sizeof(struct sadb_address)) { 5220 /* XXX need more */ 5221 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 5222 __func__)); 5223 return key_senderror(so, m, EINVAL); 5224 } 5225 if (mhp->ext[SADB_X_EXT_SA2] != NULL) { 5226 mode = ((struct sadb_x_sa2 *)mhp->ext[SADB_X_EXT_SA2])->sadb_x_sa2_mode; 5227 reqid = ((struct sadb_x_sa2 *)mhp->ext[SADB_X_EXT_SA2])->sadb_x_sa2_reqid; 5228 } else { 5229 mode = IPSEC_MODE_ANY; 5230 reqid = 0; 5231 } 5232 5233 sa0 = (struct sadb_sa *)mhp->ext[SADB_EXT_SA]; 5234 src0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_SRC]; 5235 dst0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_DST]; 5236 5237 /* XXX boundary check against sa_len */ 5238 KEY_SETSECASIDX(proto, mode, reqid, src0 + 1, dst0 + 1, &saidx); 5239 5240 /* 5241 * Make sure the port numbers are zero. 5242 * In case of NAT-T we will update them later if needed. 5243 */ 5244 KEY_PORTTOSADDR(&saidx.src, 0); 5245 KEY_PORTTOSADDR(&saidx.dst, 0); 5246 5247 #ifdef IPSEC_NAT_T 5248 /* 5249 * Handle NAT-T info if present. 5250 */ 5251 if (mhp->ext[SADB_X_EXT_NAT_T_TYPE] != NULL && 5252 mhp->ext[SADB_X_EXT_NAT_T_SPORT] != NULL && 5253 mhp->ext[SADB_X_EXT_NAT_T_DPORT] != NULL) { 5254 struct sadb_x_nat_t_port *sport, *dport; 5255 5256 if (mhp->extlen[SADB_X_EXT_NAT_T_TYPE] < sizeof(*type) || 5257 mhp->extlen[SADB_X_EXT_NAT_T_SPORT] < sizeof(*sport) || 5258 mhp->extlen[SADB_X_EXT_NAT_T_DPORT] < sizeof(*dport)) { 5259 ipseclog((LOG_DEBUG, "%s: invalid message.\n", 5260 __func__)); 5261 return key_senderror(so, m, EINVAL); 5262 } 5263 5264 type = (struct sadb_x_nat_t_type *) 5265 mhp->ext[SADB_X_EXT_NAT_T_TYPE]; 5266 sport = (struct sadb_x_nat_t_port *) 5267 mhp->ext[SADB_X_EXT_NAT_T_SPORT]; 5268 dport = (struct sadb_x_nat_t_port *) 5269 mhp->ext[SADB_X_EXT_NAT_T_DPORT]; 5270 5271 if (sport) 5272 KEY_PORTTOSADDR(&saidx.src, 5273 sport->sadb_x_nat_t_port_port); 5274 if (dport) 5275 KEY_PORTTOSADDR(&saidx.dst, 5276 dport->sadb_x_nat_t_port_port); 5277 } else { 5278 type = NULL; 5279 } 5280 if (mhp->ext[SADB_X_EXT_NAT_T_OAI] != NULL && 5281 mhp->ext[SADB_X_EXT_NAT_T_OAR] != NULL) { 5282 if (mhp->extlen[SADB_X_EXT_NAT_T_OAI] < sizeof(*iaddr) || 5283 mhp->extlen[SADB_X_EXT_NAT_T_OAR] < sizeof(*raddr)) { 5284 ipseclog((LOG_DEBUG, "%s: invalid message\n", 5285 __func__)); 5286 return key_senderror(so, m, EINVAL); 5287 } 5288 iaddr = (struct sadb_address *)mhp->ext[SADB_X_EXT_NAT_T_OAI]; 5289 raddr = (struct sadb_address *)mhp->ext[SADB_X_EXT_NAT_T_OAR]; 5290 ipseclog((LOG_DEBUG, "%s: NAT-T OAi/r present\n", __func__)); 5291 } else { 5292 iaddr = raddr = NULL; 5293 } 5294 if (mhp->ext[SADB_X_EXT_NAT_T_FRAG] != NULL) { 5295 if (mhp->extlen[SADB_X_EXT_NAT_T_FRAG] < sizeof(*frag)) { 5296 ipseclog((LOG_DEBUG, "%s: invalid message\n", 5297 __func__)); 5298 return key_senderror(so, m, EINVAL); 5299 } 5300 frag = (struct sadb_x_nat_t_frag *) 5301 mhp->ext[SADB_X_EXT_NAT_T_FRAG]; 5302 } else { 5303 frag = NULL; 5304 } 5305 #endif 5306 5307 /* get a SA header */ 5308 if ((newsah = key_getsah(&saidx)) == NULL) { 5309 /* create a new SA header */ 5310 if ((newsah = key_newsah(&saidx)) == NULL) { 5311 ipseclog((LOG_DEBUG, "%s: No more memory.\n",__func__)); 5312 return key_senderror(so, m, ENOBUFS); 5313 } 5314 } 5315 5316 /* set spidx if there */ 5317 /* XXX rewrite */ 5318 error = key_setident(newsah, m, mhp); 5319 if (error) { 5320 return key_senderror(so, m, error); 5321 } 5322 5323 /* create new SA entry. */ 5324 /* We can create new SA only if SPI is differenct. */ 5325 SAHTREE_LOCK(); 5326 newsav = key_getsavbyspi(newsah, sa0->sadb_sa_spi); 5327 SAHTREE_UNLOCK(); 5328 if (newsav != NULL) { 5329 ipseclog((LOG_DEBUG, "%s: SA already exists.\n", __func__)); 5330 return key_senderror(so, m, EEXIST); 5331 } 5332 newsav = KEY_NEWSAV(m, mhp, newsah, &error); 5333 if (newsav == NULL) { 5334 return key_senderror(so, m, error); 5335 } 5336 5337 #ifdef IPSEC_NAT_T 5338 /* 5339 * Handle more NAT-T info if present, 5340 * now that we have a sav to fill. 5341 */ 5342 if (type) 5343 newsav->natt_type = type->sadb_x_nat_t_type_type; 5344 5345 #if 0 5346 /* 5347 * In case SADB_X_EXT_NAT_T_FRAG was not given, leave it at 0. 5348 * We should actually check for a minimum MTU here, if we 5349 * want to support it in ip_output. 5350 */ 5351 if (frag) 5352 newsav->natt_esp_frag_len = frag->sadb_x_nat_t_frag_fraglen; 5353 #endif 5354 #endif 5355 5356 /* check SA values to be mature. */ 5357 if ((error = key_mature(newsav)) != 0) { 5358 KEY_FREESAV(&newsav); 5359 return key_senderror(so, m, error); 5360 } 5361 5362 /* 5363 * don't call key_freesav() here, as we would like to keep the SA 5364 * in the database on success. 5365 */ 5366 5367 { 5368 struct mbuf *n; 5369 5370 /* set msg buf from mhp */ 5371 n = key_getmsgbuf_x1(m, mhp); 5372 if (n == NULL) { 5373 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 5374 return key_senderror(so, m, ENOBUFS); 5375 } 5376 5377 m_freem(m); 5378 return key_sendup_mbuf(so, n, KEY_SENDUP_ALL); 5379 } 5380 } 5381 5382 /* m is retained */ 5383 static int 5384 key_setident(struct secashead *sah, struct mbuf *m, 5385 const struct sadb_msghdr *mhp) 5386 { 5387 const struct sadb_ident *idsrc, *iddst; 5388 int idsrclen, iddstlen; 5389 5390 IPSEC_ASSERT(sah != NULL, ("null secashead")); 5391 IPSEC_ASSERT(m != NULL, ("null mbuf")); 5392 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 5393 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 5394 5395 /* don't make buffer if not there */ 5396 if (mhp->ext[SADB_EXT_IDENTITY_SRC] == NULL && 5397 mhp->ext[SADB_EXT_IDENTITY_DST] == NULL) { 5398 sah->idents = NULL; 5399 sah->identd = NULL; 5400 return 0; 5401 } 5402 5403 if (mhp->ext[SADB_EXT_IDENTITY_SRC] == NULL || 5404 mhp->ext[SADB_EXT_IDENTITY_DST] == NULL) { 5405 ipseclog((LOG_DEBUG, "%s: invalid identity.\n", __func__)); 5406 return EINVAL; 5407 } 5408 5409 idsrc = (const struct sadb_ident *)mhp->ext[SADB_EXT_IDENTITY_SRC]; 5410 iddst = (const struct sadb_ident *)mhp->ext[SADB_EXT_IDENTITY_DST]; 5411 idsrclen = mhp->extlen[SADB_EXT_IDENTITY_SRC]; 5412 iddstlen = mhp->extlen[SADB_EXT_IDENTITY_DST]; 5413 5414 /* validity check */ 5415 if (idsrc->sadb_ident_type != iddst->sadb_ident_type) { 5416 ipseclog((LOG_DEBUG, "%s: ident type mismatch.\n", __func__)); 5417 return EINVAL; 5418 } 5419 5420 switch (idsrc->sadb_ident_type) { 5421 case SADB_IDENTTYPE_PREFIX: 5422 case SADB_IDENTTYPE_FQDN: 5423 case SADB_IDENTTYPE_USERFQDN: 5424 default: 5425 /* XXX do nothing */ 5426 sah->idents = NULL; 5427 sah->identd = NULL; 5428 return 0; 5429 } 5430 5431 /* make structure */ 5432 sah->idents = malloc(sizeof(struct secident), M_IPSEC_MISC, M_NOWAIT); 5433 if (sah->idents == NULL) { 5434 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 5435 return ENOBUFS; 5436 } 5437 sah->identd = malloc(sizeof(struct secident), M_IPSEC_MISC, M_NOWAIT); 5438 if (sah->identd == NULL) { 5439 free(sah->idents, M_IPSEC_MISC); 5440 sah->idents = NULL; 5441 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 5442 return ENOBUFS; 5443 } 5444 sah->idents->type = idsrc->sadb_ident_type; 5445 sah->idents->id = idsrc->sadb_ident_id; 5446 5447 sah->identd->type = iddst->sadb_ident_type; 5448 sah->identd->id = iddst->sadb_ident_id; 5449 5450 return 0; 5451 } 5452 5453 /* 5454 * m will not be freed on return. 5455 * it is caller's responsibility to free the result. 5456 */ 5457 static struct mbuf * 5458 key_getmsgbuf_x1(struct mbuf *m, const struct sadb_msghdr *mhp) 5459 { 5460 struct mbuf *n; 5461 5462 IPSEC_ASSERT(m != NULL, ("null mbuf")); 5463 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 5464 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 5465 5466 /* create new sadb_msg to reply. */ 5467 n = key_gather_mbuf(m, mhp, 1, 9, SADB_EXT_RESERVED, 5468 SADB_EXT_SA, SADB_X_EXT_SA2, 5469 SADB_EXT_ADDRESS_SRC, SADB_EXT_ADDRESS_DST, 5470 SADB_EXT_LIFETIME_HARD, SADB_EXT_LIFETIME_SOFT, 5471 SADB_EXT_IDENTITY_SRC, SADB_EXT_IDENTITY_DST); 5472 if (!n) 5473 return NULL; 5474 5475 if (n->m_len < sizeof(struct sadb_msg)) { 5476 n = m_pullup(n, sizeof(struct sadb_msg)); 5477 if (n == NULL) 5478 return NULL; 5479 } 5480 mtod(n, struct sadb_msg *)->sadb_msg_errno = 0; 5481 mtod(n, struct sadb_msg *)->sadb_msg_len = 5482 PFKEY_UNIT64(n->m_pkthdr.len); 5483 5484 return n; 5485 } 5486 5487 /* 5488 * SADB_DELETE processing 5489 * receive 5490 * <base, SA(*), address(SD)> 5491 * from the ikmpd, and set SADB_SASTATE_DEAD, 5492 * and send, 5493 * <base, SA(*), address(SD)> 5494 * to the ikmpd. 5495 * 5496 * m will always be freed. 5497 */ 5498 static int 5499 key_delete(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 5500 { 5501 struct sadb_sa *sa0; 5502 struct sadb_address *src0, *dst0; 5503 struct secasindex saidx; 5504 struct secashead *sah; 5505 struct secasvar *sav = NULL; 5506 u_int16_t proto; 5507 5508 IPSEC_ASSERT(so != NULL, ("null socket")); 5509 IPSEC_ASSERT(m != NULL, ("null mbuf")); 5510 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 5511 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 5512 5513 /* map satype to proto */ 5514 if ((proto = key_satype2proto(mhp->msg->sadb_msg_satype)) == 0) { 5515 ipseclog((LOG_DEBUG, "%s: invalid satype is passed.\n", 5516 __func__)); 5517 return key_senderror(so, m, EINVAL); 5518 } 5519 5520 if (mhp->ext[SADB_EXT_ADDRESS_SRC] == NULL || 5521 mhp->ext[SADB_EXT_ADDRESS_DST] == NULL) { 5522 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 5523 __func__)); 5524 return key_senderror(so, m, EINVAL); 5525 } 5526 5527 if (mhp->extlen[SADB_EXT_ADDRESS_SRC] < sizeof(struct sadb_address) || 5528 mhp->extlen[SADB_EXT_ADDRESS_DST] < sizeof(struct sadb_address)) { 5529 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 5530 __func__)); 5531 return key_senderror(so, m, EINVAL); 5532 } 5533 5534 if (mhp->ext[SADB_EXT_SA] == NULL) { 5535 /* 5536 * Caller wants us to delete all non-LARVAL SAs 5537 * that match the src/dst. This is used during 5538 * IKE INITIAL-CONTACT. 5539 */ 5540 ipseclog((LOG_DEBUG, "%s: doing delete all.\n", __func__)); 5541 return key_delete_all(so, m, mhp, proto); 5542 } else if (mhp->extlen[SADB_EXT_SA] < sizeof(struct sadb_sa)) { 5543 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 5544 __func__)); 5545 return key_senderror(so, m, EINVAL); 5546 } 5547 5548 sa0 = (struct sadb_sa *)mhp->ext[SADB_EXT_SA]; 5549 src0 = (struct sadb_address *)(mhp->ext[SADB_EXT_ADDRESS_SRC]); 5550 dst0 = (struct sadb_address *)(mhp->ext[SADB_EXT_ADDRESS_DST]); 5551 5552 /* XXX boundary check against sa_len */ 5553 KEY_SETSECASIDX(proto, IPSEC_MODE_ANY, 0, src0 + 1, dst0 + 1, &saidx); 5554 5555 /* 5556 * Make sure the port numbers are zero. 5557 * In case of NAT-T we will update them later if needed. 5558 */ 5559 KEY_PORTTOSADDR(&saidx.src, 0); 5560 KEY_PORTTOSADDR(&saidx.dst, 0); 5561 5562 #ifdef IPSEC_NAT_T 5563 /* 5564 * Handle NAT-T info if present. 5565 */ 5566 if (mhp->ext[SADB_X_EXT_NAT_T_SPORT] != NULL && 5567 mhp->ext[SADB_X_EXT_NAT_T_DPORT] != NULL) { 5568 struct sadb_x_nat_t_port *sport, *dport; 5569 5570 if (mhp->extlen[SADB_X_EXT_NAT_T_SPORT] < sizeof(*sport) || 5571 mhp->extlen[SADB_X_EXT_NAT_T_DPORT] < sizeof(*dport)) { 5572 ipseclog((LOG_DEBUG, "%s: invalid message.\n", 5573 __func__)); 5574 return key_senderror(so, m, EINVAL); 5575 } 5576 5577 sport = (struct sadb_x_nat_t_port *) 5578 mhp->ext[SADB_X_EXT_NAT_T_SPORT]; 5579 dport = (struct sadb_x_nat_t_port *) 5580 mhp->ext[SADB_X_EXT_NAT_T_DPORT]; 5581 5582 if (sport) 5583 KEY_PORTTOSADDR(&saidx.src, 5584 sport->sadb_x_nat_t_port_port); 5585 if (dport) 5586 KEY_PORTTOSADDR(&saidx.dst, 5587 dport->sadb_x_nat_t_port_port); 5588 } 5589 #endif 5590 5591 /* get a SA header */ 5592 SAHTREE_LOCK(); 5593 LIST_FOREACH(sah, &V_sahtree, chain) { 5594 if (sah->state == SADB_SASTATE_DEAD) 5595 continue; 5596 if (key_cmpsaidx(&sah->saidx, &saidx, CMP_HEAD) == 0) 5597 continue; 5598 5599 /* get a SA with SPI. */ 5600 sav = key_getsavbyspi(sah, sa0->sadb_sa_spi); 5601 if (sav) 5602 break; 5603 } 5604 if (sah == NULL) { 5605 SAHTREE_UNLOCK(); 5606 ipseclog((LOG_DEBUG, "%s: no SA found.\n", __func__)); 5607 return key_senderror(so, m, ENOENT); 5608 } 5609 5610 key_sa_chgstate(sav, SADB_SASTATE_DEAD); 5611 KEY_FREESAV(&sav); 5612 SAHTREE_UNLOCK(); 5613 5614 { 5615 struct mbuf *n; 5616 struct sadb_msg *newmsg; 5617 5618 /* create new sadb_msg to reply. */ 5619 /* XXX-BZ NAT-T extensions? */ 5620 n = key_gather_mbuf(m, mhp, 1, 4, SADB_EXT_RESERVED, 5621 SADB_EXT_SA, SADB_EXT_ADDRESS_SRC, SADB_EXT_ADDRESS_DST); 5622 if (!n) 5623 return key_senderror(so, m, ENOBUFS); 5624 5625 if (n->m_len < sizeof(struct sadb_msg)) { 5626 n = m_pullup(n, sizeof(struct sadb_msg)); 5627 if (n == NULL) 5628 return key_senderror(so, m, ENOBUFS); 5629 } 5630 newmsg = mtod(n, struct sadb_msg *); 5631 newmsg->sadb_msg_errno = 0; 5632 newmsg->sadb_msg_len = PFKEY_UNIT64(n->m_pkthdr.len); 5633 5634 m_freem(m); 5635 return key_sendup_mbuf(so, n, KEY_SENDUP_ALL); 5636 } 5637 } 5638 5639 /* 5640 * delete all SAs for src/dst. Called from key_delete(). 5641 */ 5642 static int 5643 key_delete_all(struct socket *so, struct mbuf *m, 5644 const struct sadb_msghdr *mhp, u_int16_t proto) 5645 { 5646 struct sadb_address *src0, *dst0; 5647 struct secasindex saidx; 5648 struct secashead *sah; 5649 struct secasvar *sav, *nextsav; 5650 u_int stateidx, state; 5651 5652 src0 = (struct sadb_address *)(mhp->ext[SADB_EXT_ADDRESS_SRC]); 5653 dst0 = (struct sadb_address *)(mhp->ext[SADB_EXT_ADDRESS_DST]); 5654 5655 /* XXX boundary check against sa_len */ 5656 KEY_SETSECASIDX(proto, IPSEC_MODE_ANY, 0, src0 + 1, dst0 + 1, &saidx); 5657 5658 /* 5659 * Make sure the port numbers are zero. 5660 * In case of NAT-T we will update them later if needed. 5661 */ 5662 KEY_PORTTOSADDR(&saidx.src, 0); 5663 KEY_PORTTOSADDR(&saidx.dst, 0); 5664 5665 #ifdef IPSEC_NAT_T 5666 /* 5667 * Handle NAT-T info if present. 5668 */ 5669 5670 if (mhp->ext[SADB_X_EXT_NAT_T_SPORT] != NULL && 5671 mhp->ext[SADB_X_EXT_NAT_T_DPORT] != NULL) { 5672 struct sadb_x_nat_t_port *sport, *dport; 5673 5674 if (mhp->extlen[SADB_X_EXT_NAT_T_SPORT] < sizeof(*sport) || 5675 mhp->extlen[SADB_X_EXT_NAT_T_DPORT] < sizeof(*dport)) { 5676 ipseclog((LOG_DEBUG, "%s: invalid message.\n", 5677 __func__)); 5678 return key_senderror(so, m, EINVAL); 5679 } 5680 5681 sport = (struct sadb_x_nat_t_port *) 5682 mhp->ext[SADB_X_EXT_NAT_T_SPORT]; 5683 dport = (struct sadb_x_nat_t_port *) 5684 mhp->ext[SADB_X_EXT_NAT_T_DPORT]; 5685 5686 if (sport) 5687 KEY_PORTTOSADDR(&saidx.src, 5688 sport->sadb_x_nat_t_port_port); 5689 if (dport) 5690 KEY_PORTTOSADDR(&saidx.dst, 5691 dport->sadb_x_nat_t_port_port); 5692 } 5693 #endif 5694 5695 SAHTREE_LOCK(); 5696 LIST_FOREACH(sah, &V_sahtree, chain) { 5697 if (sah->state == SADB_SASTATE_DEAD) 5698 continue; 5699 if (key_cmpsaidx(&sah->saidx, &saidx, CMP_HEAD) == 0) 5700 continue; 5701 5702 /* Delete all non-LARVAL SAs. */ 5703 for (stateidx = 0; 5704 stateidx < _ARRAYLEN(saorder_state_alive); 5705 stateidx++) { 5706 state = saorder_state_alive[stateidx]; 5707 if (state == SADB_SASTATE_LARVAL) 5708 continue; 5709 for (sav = LIST_FIRST(&sah->savtree[state]); 5710 sav != NULL; sav = nextsav) { 5711 nextsav = LIST_NEXT(sav, chain); 5712 /* sanity check */ 5713 if (sav->state != state) { 5714 ipseclog((LOG_DEBUG, "%s: invalid " 5715 "sav->state (queue %d SA %d)\n", 5716 __func__, state, sav->state)); 5717 continue; 5718 } 5719 5720 key_sa_chgstate(sav, SADB_SASTATE_DEAD); 5721 KEY_FREESAV(&sav); 5722 } 5723 } 5724 } 5725 SAHTREE_UNLOCK(); 5726 { 5727 struct mbuf *n; 5728 struct sadb_msg *newmsg; 5729 5730 /* create new sadb_msg to reply. */ 5731 /* XXX-BZ NAT-T extensions? */ 5732 n = key_gather_mbuf(m, mhp, 1, 3, SADB_EXT_RESERVED, 5733 SADB_EXT_ADDRESS_SRC, SADB_EXT_ADDRESS_DST); 5734 if (!n) 5735 return key_senderror(so, m, ENOBUFS); 5736 5737 if (n->m_len < sizeof(struct sadb_msg)) { 5738 n = m_pullup(n, sizeof(struct sadb_msg)); 5739 if (n == NULL) 5740 return key_senderror(so, m, ENOBUFS); 5741 } 5742 newmsg = mtod(n, struct sadb_msg *); 5743 newmsg->sadb_msg_errno = 0; 5744 newmsg->sadb_msg_len = PFKEY_UNIT64(n->m_pkthdr.len); 5745 5746 m_freem(m); 5747 return key_sendup_mbuf(so, n, KEY_SENDUP_ALL); 5748 } 5749 } 5750 5751 /* 5752 * SADB_GET processing 5753 * receive 5754 * <base, SA(*), address(SD)> 5755 * from the ikmpd, and get a SP and a SA to respond, 5756 * and send, 5757 * <base, SA, (lifetime(HSC),) address(SD), (address(P),) key(AE), 5758 * (identity(SD),) (sensitivity)> 5759 * to the ikmpd. 5760 * 5761 * m will always be freed. 5762 */ 5763 static int 5764 key_get(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 5765 { 5766 struct sadb_sa *sa0; 5767 struct sadb_address *src0, *dst0; 5768 struct secasindex saidx; 5769 struct secashead *sah; 5770 struct secasvar *sav = NULL; 5771 u_int16_t proto; 5772 5773 IPSEC_ASSERT(so != NULL, ("null socket")); 5774 IPSEC_ASSERT(m != NULL, ("null mbuf")); 5775 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 5776 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 5777 5778 /* map satype to proto */ 5779 if ((proto = key_satype2proto(mhp->msg->sadb_msg_satype)) == 0) { 5780 ipseclog((LOG_DEBUG, "%s: invalid satype is passed.\n", 5781 __func__)); 5782 return key_senderror(so, m, EINVAL); 5783 } 5784 5785 if (mhp->ext[SADB_EXT_SA] == NULL || 5786 mhp->ext[SADB_EXT_ADDRESS_SRC] == NULL || 5787 mhp->ext[SADB_EXT_ADDRESS_DST] == NULL) { 5788 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 5789 __func__)); 5790 return key_senderror(so, m, EINVAL); 5791 } 5792 if (mhp->extlen[SADB_EXT_SA] < sizeof(struct sadb_sa) || 5793 mhp->extlen[SADB_EXT_ADDRESS_SRC] < sizeof(struct sadb_address) || 5794 mhp->extlen[SADB_EXT_ADDRESS_DST] < sizeof(struct sadb_address)) { 5795 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 5796 __func__)); 5797 return key_senderror(so, m, EINVAL); 5798 } 5799 5800 sa0 = (struct sadb_sa *)mhp->ext[SADB_EXT_SA]; 5801 src0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_SRC]; 5802 dst0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_DST]; 5803 5804 /* XXX boundary check against sa_len */ 5805 KEY_SETSECASIDX(proto, IPSEC_MODE_ANY, 0, src0 + 1, dst0 + 1, &saidx); 5806 5807 /* 5808 * Make sure the port numbers are zero. 5809 * In case of NAT-T we will update them later if needed. 5810 */ 5811 KEY_PORTTOSADDR(&saidx.src, 0); 5812 KEY_PORTTOSADDR(&saidx.dst, 0); 5813 5814 #ifdef IPSEC_NAT_T 5815 /* 5816 * Handle NAT-T info if present. 5817 */ 5818 5819 if (mhp->ext[SADB_X_EXT_NAT_T_SPORT] != NULL && 5820 mhp->ext[SADB_X_EXT_NAT_T_DPORT] != NULL) { 5821 struct sadb_x_nat_t_port *sport, *dport; 5822 5823 if (mhp->extlen[SADB_X_EXT_NAT_T_SPORT] < sizeof(*sport) || 5824 mhp->extlen[SADB_X_EXT_NAT_T_DPORT] < sizeof(*dport)) { 5825 ipseclog((LOG_DEBUG, "%s: invalid message.\n", 5826 __func__)); 5827 return key_senderror(so, m, EINVAL); 5828 } 5829 5830 sport = (struct sadb_x_nat_t_port *) 5831 mhp->ext[SADB_X_EXT_NAT_T_SPORT]; 5832 dport = (struct sadb_x_nat_t_port *) 5833 mhp->ext[SADB_X_EXT_NAT_T_DPORT]; 5834 5835 if (sport) 5836 KEY_PORTTOSADDR(&saidx.src, 5837 sport->sadb_x_nat_t_port_port); 5838 if (dport) 5839 KEY_PORTTOSADDR(&saidx.dst, 5840 dport->sadb_x_nat_t_port_port); 5841 } 5842 #endif 5843 5844 /* get a SA header */ 5845 SAHTREE_LOCK(); 5846 LIST_FOREACH(sah, &V_sahtree, chain) { 5847 if (sah->state == SADB_SASTATE_DEAD) 5848 continue; 5849 if (key_cmpsaidx(&sah->saidx, &saidx, CMP_HEAD) == 0) 5850 continue; 5851 5852 /* get a SA with SPI. */ 5853 sav = key_getsavbyspi(sah, sa0->sadb_sa_spi); 5854 if (sav) 5855 break; 5856 } 5857 SAHTREE_UNLOCK(); 5858 if (sah == NULL) { 5859 ipseclog((LOG_DEBUG, "%s: no SA found.\n", __func__)); 5860 return key_senderror(so, m, ENOENT); 5861 } 5862 5863 { 5864 struct mbuf *n; 5865 u_int8_t satype; 5866 5867 /* map proto to satype */ 5868 if ((satype = key_proto2satype(sah->saidx.proto)) == 0) { 5869 ipseclog((LOG_DEBUG, "%s: there was invalid proto in SAD.\n", 5870 __func__)); 5871 return key_senderror(so, m, EINVAL); 5872 } 5873 5874 /* create new sadb_msg to reply. */ 5875 n = key_setdumpsa(sav, SADB_GET, satype, mhp->msg->sadb_msg_seq, 5876 mhp->msg->sadb_msg_pid); 5877 if (!n) 5878 return key_senderror(so, m, ENOBUFS); 5879 5880 m_freem(m); 5881 return key_sendup_mbuf(so, n, KEY_SENDUP_ONE); 5882 } 5883 } 5884 5885 /* XXX make it sysctl-configurable? */ 5886 static void 5887 key_getcomb_setlifetime(struct sadb_comb *comb) 5888 { 5889 5890 comb->sadb_comb_soft_allocations = 1; 5891 comb->sadb_comb_hard_allocations = 1; 5892 comb->sadb_comb_soft_bytes = 0; 5893 comb->sadb_comb_hard_bytes = 0; 5894 comb->sadb_comb_hard_addtime = 86400; /* 1 day */ 5895 comb->sadb_comb_soft_addtime = comb->sadb_comb_soft_addtime * 80 / 100; 5896 comb->sadb_comb_soft_usetime = 28800; /* 8 hours */ 5897 comb->sadb_comb_hard_usetime = comb->sadb_comb_hard_usetime * 80 / 100; 5898 } 5899 5900 /* 5901 * XXX reorder combinations by preference 5902 * XXX no idea if the user wants ESP authentication or not 5903 */ 5904 static struct mbuf * 5905 key_getcomb_esp() 5906 { 5907 struct sadb_comb *comb; 5908 struct enc_xform *algo; 5909 struct mbuf *result = NULL, *m, *n; 5910 int encmin; 5911 int i, off, o; 5912 int totlen; 5913 const int l = PFKEY_ALIGN8(sizeof(struct sadb_comb)); 5914 5915 m = NULL; 5916 for (i = 1; i <= SADB_EALG_MAX; i++) { 5917 algo = esp_algorithm_lookup(i); 5918 if (algo == NULL) 5919 continue; 5920 5921 /* discard algorithms with key size smaller than system min */ 5922 if (_BITS(algo->maxkey) < V_ipsec_esp_keymin) 5923 continue; 5924 if (_BITS(algo->minkey) < V_ipsec_esp_keymin) 5925 encmin = V_ipsec_esp_keymin; 5926 else 5927 encmin = _BITS(algo->minkey); 5928 5929 if (V_ipsec_esp_auth) 5930 m = key_getcomb_ah(); 5931 else { 5932 IPSEC_ASSERT(l <= MLEN, 5933 ("l=%u > MLEN=%lu", l, (u_long) MLEN)); 5934 MGET(m, M_NOWAIT, MT_DATA); 5935 if (m) { 5936 M_ALIGN(m, l); 5937 m->m_len = l; 5938 m->m_next = NULL; 5939 bzero(mtod(m, caddr_t), m->m_len); 5940 } 5941 } 5942 if (!m) 5943 goto fail; 5944 5945 totlen = 0; 5946 for (n = m; n; n = n->m_next) 5947 totlen += n->m_len; 5948 IPSEC_ASSERT((totlen % l) == 0, ("totlen=%u, l=%u", totlen, l)); 5949 5950 for (off = 0; off < totlen; off += l) { 5951 n = m_pulldown(m, off, l, &o); 5952 if (!n) { 5953 /* m is already freed */ 5954 goto fail; 5955 } 5956 comb = (struct sadb_comb *)(mtod(n, caddr_t) + o); 5957 bzero(comb, sizeof(*comb)); 5958 key_getcomb_setlifetime(comb); 5959 comb->sadb_comb_encrypt = i; 5960 comb->sadb_comb_encrypt_minbits = encmin; 5961 comb->sadb_comb_encrypt_maxbits = _BITS(algo->maxkey); 5962 } 5963 5964 if (!result) 5965 result = m; 5966 else 5967 m_cat(result, m); 5968 } 5969 5970 return result; 5971 5972 fail: 5973 if (result) 5974 m_freem(result); 5975 return NULL; 5976 } 5977 5978 static void 5979 key_getsizes_ah(const struct auth_hash *ah, int alg, u_int16_t* min, 5980 u_int16_t* max) 5981 { 5982 5983 *min = *max = ah->keysize; 5984 if (ah->keysize == 0) { 5985 /* 5986 * Transform takes arbitrary key size but algorithm 5987 * key size is restricted. Enforce this here. 5988 */ 5989 switch (alg) { 5990 case SADB_X_AALG_MD5: *min = *max = 16; break; 5991 case SADB_X_AALG_SHA: *min = *max = 20; break; 5992 case SADB_X_AALG_NULL: *min = 1; *max = 256; break; 5993 case SADB_X_AALG_SHA2_256: *min = *max = 32; break; 5994 case SADB_X_AALG_SHA2_384: *min = *max = 48; break; 5995 case SADB_X_AALG_SHA2_512: *min = *max = 64; break; 5996 default: 5997 DPRINTF(("%s: unknown AH algorithm %u\n", 5998 __func__, alg)); 5999 break; 6000 } 6001 } 6002 } 6003 6004 /* 6005 * XXX reorder combinations by preference 6006 */ 6007 static struct mbuf * 6008 key_getcomb_ah() 6009 { 6010 struct sadb_comb *comb; 6011 struct auth_hash *algo; 6012 struct mbuf *m; 6013 u_int16_t minkeysize, maxkeysize; 6014 int i; 6015 const int l = PFKEY_ALIGN8(sizeof(struct sadb_comb)); 6016 6017 m = NULL; 6018 for (i = 1; i <= SADB_AALG_MAX; i++) { 6019 #if 1 6020 /* we prefer HMAC algorithms, not old algorithms */ 6021 if (i != SADB_AALG_SHA1HMAC && 6022 i != SADB_AALG_MD5HMAC && 6023 i != SADB_X_AALG_SHA2_256 && 6024 i != SADB_X_AALG_SHA2_384 && 6025 i != SADB_X_AALG_SHA2_512) 6026 continue; 6027 #endif 6028 algo = ah_algorithm_lookup(i); 6029 if (!algo) 6030 continue; 6031 key_getsizes_ah(algo, i, &minkeysize, &maxkeysize); 6032 /* discard algorithms with key size smaller than system min */ 6033 if (_BITS(minkeysize) < V_ipsec_ah_keymin) 6034 continue; 6035 6036 if (!m) { 6037 IPSEC_ASSERT(l <= MLEN, 6038 ("l=%u > MLEN=%lu", l, (u_long) MLEN)); 6039 MGET(m, M_NOWAIT, MT_DATA); 6040 if (m) { 6041 M_ALIGN(m, l); 6042 m->m_len = l; 6043 m->m_next = NULL; 6044 } 6045 } else 6046 M_PREPEND(m, l, M_NOWAIT); 6047 if (!m) 6048 return NULL; 6049 6050 comb = mtod(m, struct sadb_comb *); 6051 bzero(comb, sizeof(*comb)); 6052 key_getcomb_setlifetime(comb); 6053 comb->sadb_comb_auth = i; 6054 comb->sadb_comb_auth_minbits = _BITS(minkeysize); 6055 comb->sadb_comb_auth_maxbits = _BITS(maxkeysize); 6056 } 6057 6058 return m; 6059 } 6060 6061 /* 6062 * not really an official behavior. discussed in pf_key@inner.net in Sep2000. 6063 * XXX reorder combinations by preference 6064 */ 6065 static struct mbuf * 6066 key_getcomb_ipcomp() 6067 { 6068 struct sadb_comb *comb; 6069 struct comp_algo *algo; 6070 struct mbuf *m; 6071 int i; 6072 const int l = PFKEY_ALIGN8(sizeof(struct sadb_comb)); 6073 6074 m = NULL; 6075 for (i = 1; i <= SADB_X_CALG_MAX; i++) { 6076 algo = ipcomp_algorithm_lookup(i); 6077 if (!algo) 6078 continue; 6079 6080 if (!m) { 6081 IPSEC_ASSERT(l <= MLEN, 6082 ("l=%u > MLEN=%lu", l, (u_long) MLEN)); 6083 MGET(m, M_NOWAIT, MT_DATA); 6084 if (m) { 6085 M_ALIGN(m, l); 6086 m->m_len = l; 6087 m->m_next = NULL; 6088 } 6089 } else 6090 M_PREPEND(m, l, M_NOWAIT); 6091 if (!m) 6092 return NULL; 6093 6094 comb = mtod(m, struct sadb_comb *); 6095 bzero(comb, sizeof(*comb)); 6096 key_getcomb_setlifetime(comb); 6097 comb->sadb_comb_encrypt = i; 6098 /* what should we set into sadb_comb_*_{min,max}bits? */ 6099 } 6100 6101 return m; 6102 } 6103 6104 /* 6105 * XXX no way to pass mode (transport/tunnel) to userland 6106 * XXX replay checking? 6107 * XXX sysctl interface to ipsec_{ah,esp}_keymin 6108 */ 6109 static struct mbuf * 6110 key_getprop(const struct secasindex *saidx) 6111 { 6112 struct sadb_prop *prop; 6113 struct mbuf *m, *n; 6114 const int l = PFKEY_ALIGN8(sizeof(struct sadb_prop)); 6115 int totlen; 6116 6117 switch (saidx->proto) { 6118 case IPPROTO_ESP: 6119 m = key_getcomb_esp(); 6120 break; 6121 case IPPROTO_AH: 6122 m = key_getcomb_ah(); 6123 break; 6124 case IPPROTO_IPCOMP: 6125 m = key_getcomb_ipcomp(); 6126 break; 6127 default: 6128 return NULL; 6129 } 6130 6131 if (!m) 6132 return NULL; 6133 M_PREPEND(m, l, M_NOWAIT); 6134 if (!m) 6135 return NULL; 6136 6137 totlen = 0; 6138 for (n = m; n; n = n->m_next) 6139 totlen += n->m_len; 6140 6141 prop = mtod(m, struct sadb_prop *); 6142 bzero(prop, sizeof(*prop)); 6143 prop->sadb_prop_len = PFKEY_UNIT64(totlen); 6144 prop->sadb_prop_exttype = SADB_EXT_PROPOSAL; 6145 prop->sadb_prop_replay = 32; /* XXX */ 6146 6147 return m; 6148 } 6149 6150 /* 6151 * SADB_ACQUIRE processing called by key_checkrequest() and key_acquire2(). 6152 * send 6153 * <base, SA, address(SD), (address(P)), x_policy, 6154 * (identity(SD),) (sensitivity,) proposal> 6155 * to KMD, and expect to receive 6156 * <base> with SADB_ACQUIRE if error occured, 6157 * or 6158 * <base, src address, dst address, (SPI range)> with SADB_GETSPI 6159 * from KMD by PF_KEY. 6160 * 6161 * XXX x_policy is outside of RFC2367 (KAME extension). 6162 * XXX sensitivity is not supported. 6163 * XXX for ipcomp, RFC2367 does not define how to fill in proposal. 6164 * see comment for key_getcomb_ipcomp(). 6165 * 6166 * OUT: 6167 * 0 : succeed 6168 * others: error number 6169 */ 6170 static int 6171 key_acquire(const struct secasindex *saidx, struct secpolicy *sp) 6172 { 6173 union sockaddr_union addr; 6174 struct mbuf *result, *m; 6175 struct secacq *newacq; 6176 u_int32_t seq; 6177 int error; 6178 u_int16_t ul_proto; 6179 u_int8_t mask, satype; 6180 6181 IPSEC_ASSERT(saidx != NULL, ("null saidx")); 6182 satype = key_proto2satype(saidx->proto); 6183 IPSEC_ASSERT(satype != 0, ("null satype, protocol %u", saidx->proto)); 6184 6185 error = -1; 6186 result = NULL; 6187 ul_proto = IPSEC_ULPROTO_ANY; 6188 /* 6189 * We never do anything about acquirng SA. There is anather 6190 * solution that kernel blocks to send SADB_ACQUIRE message until 6191 * getting something message from IKEd. In later case, to be 6192 * managed with ACQUIRING list. 6193 */ 6194 /* Get an entry to check whether sending message or not. */ 6195 if ((newacq = key_getacq(saidx)) != NULL) { 6196 if (V_key_blockacq_count < newacq->count) { 6197 /* reset counter and do send message. */ 6198 newacq->count = 0; 6199 } else { 6200 /* increment counter and do nothing. */ 6201 newacq->count++; 6202 return 0; 6203 } 6204 } else { 6205 /* make new entry for blocking to send SADB_ACQUIRE. */ 6206 if ((newacq = key_newacq(saidx)) == NULL) 6207 return ENOBUFS; 6208 } 6209 6210 6211 seq = newacq->seq; 6212 m = key_setsadbmsg(SADB_ACQUIRE, 0, satype, seq, 0, 0); 6213 if (!m) { 6214 error = ENOBUFS; 6215 goto fail; 6216 } 6217 result = m; 6218 6219 /* 6220 * No SADB_X_EXT_NAT_T_* here: we do not know 6221 * anything related to NAT-T at this time. 6222 */ 6223 6224 /* 6225 * set sadb_address for saidx's. 6226 * 6227 * Note that if sp is supplied, then we're being called from 6228 * key_checkrequest and should supply port and protocol information. 6229 */ 6230 if (sp != NULL && (sp->spidx.ul_proto == IPPROTO_TCP || 6231 sp->spidx.ul_proto == IPPROTO_UDP)) 6232 ul_proto = sp->spidx.ul_proto; 6233 6234 addr = saidx->src; 6235 mask = FULLMASK; 6236 if (ul_proto != IPSEC_ULPROTO_ANY) { 6237 switch (sp->spidx.src.sa.sa_family) { 6238 case AF_INET: 6239 if (sp->spidx.src.sin.sin_port != IPSEC_PORT_ANY) { 6240 addr.sin.sin_port = sp->spidx.src.sin.sin_port; 6241 mask = sp->spidx.prefs; 6242 } 6243 break; 6244 case AF_INET6: 6245 if (sp->spidx.src.sin6.sin6_port != IPSEC_PORT_ANY) { 6246 addr.sin6.sin6_port = sp->spidx.src.sin6.sin6_port; 6247 mask = sp->spidx.prefs; 6248 } 6249 break; 6250 default: 6251 break; 6252 } 6253 } 6254 m = key_setsadbaddr(SADB_EXT_ADDRESS_SRC, &addr.sa, mask, ul_proto); 6255 if (!m) { 6256 error = ENOBUFS; 6257 goto fail; 6258 } 6259 m_cat(result, m); 6260 6261 addr = saidx->dst; 6262 mask = FULLMASK; 6263 if (ul_proto != IPSEC_ULPROTO_ANY) { 6264 switch (sp->spidx.dst.sa.sa_family) { 6265 case AF_INET: 6266 if (sp->spidx.dst.sin.sin_port != IPSEC_PORT_ANY) { 6267 addr.sin.sin_port = sp->spidx.dst.sin.sin_port; 6268 mask = sp->spidx.prefd; 6269 } 6270 break; 6271 case AF_INET6: 6272 if (sp->spidx.dst.sin6.sin6_port != IPSEC_PORT_ANY) { 6273 addr.sin6.sin6_port = sp->spidx.dst.sin6.sin6_port; 6274 mask = sp->spidx.prefd; 6275 } 6276 break; 6277 default: 6278 break; 6279 } 6280 } 6281 m = key_setsadbaddr(SADB_EXT_ADDRESS_DST, &addr.sa, mask, ul_proto); 6282 if (!m) { 6283 error = ENOBUFS; 6284 goto fail; 6285 } 6286 m_cat(result, m); 6287 6288 /* XXX proxy address (optional) */ 6289 6290 /* set sadb_x_policy */ 6291 if (sp) { 6292 m = key_setsadbxpolicy(sp->policy, sp->spidx.dir, sp->id, sp->priority); 6293 if (!m) { 6294 error = ENOBUFS; 6295 goto fail; 6296 } 6297 m_cat(result, m); 6298 } 6299 6300 /* XXX identity (optional) */ 6301 #if 0 6302 if (idexttype && fqdn) { 6303 /* create identity extension (FQDN) */ 6304 struct sadb_ident *id; 6305 int fqdnlen; 6306 6307 fqdnlen = strlen(fqdn) + 1; /* +1 for terminating-NUL */ 6308 id = (struct sadb_ident *)p; 6309 bzero(id, sizeof(*id) + PFKEY_ALIGN8(fqdnlen)); 6310 id->sadb_ident_len = PFKEY_UNIT64(sizeof(*id) + PFKEY_ALIGN8(fqdnlen)); 6311 id->sadb_ident_exttype = idexttype; 6312 id->sadb_ident_type = SADB_IDENTTYPE_FQDN; 6313 bcopy(fqdn, id + 1, fqdnlen); 6314 p += sizeof(struct sadb_ident) + PFKEY_ALIGN8(fqdnlen); 6315 } 6316 6317 if (idexttype) { 6318 /* create identity extension (USERFQDN) */ 6319 struct sadb_ident *id; 6320 int userfqdnlen; 6321 6322 if (userfqdn) { 6323 /* +1 for terminating-NUL */ 6324 userfqdnlen = strlen(userfqdn) + 1; 6325 } else 6326 userfqdnlen = 0; 6327 id = (struct sadb_ident *)p; 6328 bzero(id, sizeof(*id) + PFKEY_ALIGN8(userfqdnlen)); 6329 id->sadb_ident_len = PFKEY_UNIT64(sizeof(*id) + PFKEY_ALIGN8(userfqdnlen)); 6330 id->sadb_ident_exttype = idexttype; 6331 id->sadb_ident_type = SADB_IDENTTYPE_USERFQDN; 6332 /* XXX is it correct? */ 6333 if (curproc && curproc->p_cred) 6334 id->sadb_ident_id = curproc->p_cred->p_ruid; 6335 if (userfqdn && userfqdnlen) 6336 bcopy(userfqdn, id + 1, userfqdnlen); 6337 p += sizeof(struct sadb_ident) + PFKEY_ALIGN8(userfqdnlen); 6338 } 6339 #endif 6340 6341 /* XXX sensitivity (optional) */ 6342 6343 /* create proposal/combination extension */ 6344 m = key_getprop(saidx); 6345 #if 0 6346 /* 6347 * spec conformant: always attach proposal/combination extension, 6348 * the problem is that we have no way to attach it for ipcomp, 6349 * due to the way sadb_comb is declared in RFC2367. 6350 */ 6351 if (!m) { 6352 error = ENOBUFS; 6353 goto fail; 6354 } 6355 m_cat(result, m); 6356 #else 6357 /* 6358 * outside of spec; make proposal/combination extension optional. 6359 */ 6360 if (m) 6361 m_cat(result, m); 6362 #endif 6363 6364 if ((result->m_flags & M_PKTHDR) == 0) { 6365 error = EINVAL; 6366 goto fail; 6367 } 6368 6369 if (result->m_len < sizeof(struct sadb_msg)) { 6370 result = m_pullup(result, sizeof(struct sadb_msg)); 6371 if (result == NULL) { 6372 error = ENOBUFS; 6373 goto fail; 6374 } 6375 } 6376 6377 result->m_pkthdr.len = 0; 6378 for (m = result; m; m = m->m_next) 6379 result->m_pkthdr.len += m->m_len; 6380 6381 mtod(result, struct sadb_msg *)->sadb_msg_len = 6382 PFKEY_UNIT64(result->m_pkthdr.len); 6383 6384 return key_sendup_mbuf(NULL, result, KEY_SENDUP_REGISTERED); 6385 6386 fail: 6387 if (result) 6388 m_freem(result); 6389 return error; 6390 } 6391 6392 static struct secacq * 6393 key_newacq(const struct secasindex *saidx) 6394 { 6395 struct secacq *newacq; 6396 6397 /* get new entry */ 6398 newacq = malloc(sizeof(struct secacq), M_IPSEC_SAQ, M_NOWAIT|M_ZERO); 6399 if (newacq == NULL) { 6400 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 6401 return NULL; 6402 } 6403 6404 /* copy secindex */ 6405 bcopy(saidx, &newacq->saidx, sizeof(newacq->saidx)); 6406 newacq->seq = (V_acq_seq == ~0 ? 1 : ++V_acq_seq); 6407 newacq->created = time_second; 6408 newacq->count = 0; 6409 6410 /* add to acqtree */ 6411 ACQ_LOCK(); 6412 LIST_INSERT_HEAD(&V_acqtree, newacq, chain); 6413 ACQ_UNLOCK(); 6414 6415 return newacq; 6416 } 6417 6418 static struct secacq * 6419 key_getacq(const struct secasindex *saidx) 6420 { 6421 struct secacq *acq; 6422 6423 ACQ_LOCK(); 6424 LIST_FOREACH(acq, &V_acqtree, chain) { 6425 if (key_cmpsaidx(saidx, &acq->saidx, CMP_EXACTLY)) 6426 break; 6427 } 6428 ACQ_UNLOCK(); 6429 6430 return acq; 6431 } 6432 6433 static struct secacq * 6434 key_getacqbyseq(u_int32_t seq) 6435 { 6436 struct secacq *acq; 6437 6438 ACQ_LOCK(); 6439 LIST_FOREACH(acq, &V_acqtree, chain) { 6440 if (acq->seq == seq) 6441 break; 6442 } 6443 ACQ_UNLOCK(); 6444 6445 return acq; 6446 } 6447 6448 static struct secspacq * 6449 key_newspacq(struct secpolicyindex *spidx) 6450 { 6451 struct secspacq *acq; 6452 6453 /* get new entry */ 6454 acq = malloc(sizeof(struct secspacq), M_IPSEC_SAQ, M_NOWAIT|M_ZERO); 6455 if (acq == NULL) { 6456 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 6457 return NULL; 6458 } 6459 6460 /* copy secindex */ 6461 bcopy(spidx, &acq->spidx, sizeof(acq->spidx)); 6462 acq->created = time_second; 6463 acq->count = 0; 6464 6465 /* add to spacqtree */ 6466 SPACQ_LOCK(); 6467 LIST_INSERT_HEAD(&V_spacqtree, acq, chain); 6468 SPACQ_UNLOCK(); 6469 6470 return acq; 6471 } 6472 6473 static struct secspacq * 6474 key_getspacq(struct secpolicyindex *spidx) 6475 { 6476 struct secspacq *acq; 6477 6478 SPACQ_LOCK(); 6479 LIST_FOREACH(acq, &V_spacqtree, chain) { 6480 if (key_cmpspidx_exactly(spidx, &acq->spidx)) { 6481 /* NB: return holding spacq_lock */ 6482 return acq; 6483 } 6484 } 6485 SPACQ_UNLOCK(); 6486 6487 return NULL; 6488 } 6489 6490 /* 6491 * SADB_ACQUIRE processing, 6492 * in first situation, is receiving 6493 * <base> 6494 * from the ikmpd, and clear sequence of its secasvar entry. 6495 * 6496 * In second situation, is receiving 6497 * <base, address(SD), (address(P),) (identity(SD),) (sensitivity,) proposal> 6498 * from a user land process, and return 6499 * <base, address(SD), (address(P),) (identity(SD),) (sensitivity,) proposal> 6500 * to the socket. 6501 * 6502 * m will always be freed. 6503 */ 6504 static int 6505 key_acquire2(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 6506 { 6507 const struct sadb_address *src0, *dst0; 6508 struct secasindex saidx; 6509 struct secashead *sah; 6510 u_int16_t proto; 6511 int error; 6512 6513 IPSEC_ASSERT(so != NULL, ("null socket")); 6514 IPSEC_ASSERT(m != NULL, ("null mbuf")); 6515 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 6516 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 6517 6518 /* 6519 * Error message from KMd. 6520 * We assume that if error was occured in IKEd, the length of PFKEY 6521 * message is equal to the size of sadb_msg structure. 6522 * We do not raise error even if error occured in this function. 6523 */ 6524 if (mhp->msg->sadb_msg_len == PFKEY_UNIT64(sizeof(struct sadb_msg))) { 6525 struct secacq *acq; 6526 6527 /* check sequence number */ 6528 if (mhp->msg->sadb_msg_seq == 0) { 6529 ipseclog((LOG_DEBUG, "%s: must specify sequence " 6530 "number.\n", __func__)); 6531 m_freem(m); 6532 return 0; 6533 } 6534 6535 if ((acq = key_getacqbyseq(mhp->msg->sadb_msg_seq)) == NULL) { 6536 /* 6537 * the specified larval SA is already gone, or we got 6538 * a bogus sequence number. we can silently ignore it. 6539 */ 6540 m_freem(m); 6541 return 0; 6542 } 6543 6544 /* reset acq counter in order to deletion by timehander. */ 6545 acq->created = time_second; 6546 acq->count = 0; 6547 m_freem(m); 6548 return 0; 6549 } 6550 6551 /* 6552 * This message is from user land. 6553 */ 6554 6555 /* map satype to proto */ 6556 if ((proto = key_satype2proto(mhp->msg->sadb_msg_satype)) == 0) { 6557 ipseclog((LOG_DEBUG, "%s: invalid satype is passed.\n", 6558 __func__)); 6559 return key_senderror(so, m, EINVAL); 6560 } 6561 6562 if (mhp->ext[SADB_EXT_ADDRESS_SRC] == NULL || 6563 mhp->ext[SADB_EXT_ADDRESS_DST] == NULL || 6564 mhp->ext[SADB_EXT_PROPOSAL] == NULL) { 6565 /* error */ 6566 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 6567 __func__)); 6568 return key_senderror(so, m, EINVAL); 6569 } 6570 if (mhp->extlen[SADB_EXT_ADDRESS_SRC] < sizeof(struct sadb_address) || 6571 mhp->extlen[SADB_EXT_ADDRESS_DST] < sizeof(struct sadb_address) || 6572 mhp->extlen[SADB_EXT_PROPOSAL] < sizeof(struct sadb_prop)) { 6573 /* error */ 6574 ipseclog((LOG_DEBUG, "%s: invalid message is passed.\n", 6575 __func__)); 6576 return key_senderror(so, m, EINVAL); 6577 } 6578 6579 src0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_SRC]; 6580 dst0 = (struct sadb_address *)mhp->ext[SADB_EXT_ADDRESS_DST]; 6581 6582 /* XXX boundary check against sa_len */ 6583 KEY_SETSECASIDX(proto, IPSEC_MODE_ANY, 0, src0 + 1, dst0 + 1, &saidx); 6584 6585 /* 6586 * Make sure the port numbers are zero. 6587 * In case of NAT-T we will update them later if needed. 6588 */ 6589 KEY_PORTTOSADDR(&saidx.src, 0); 6590 KEY_PORTTOSADDR(&saidx.dst, 0); 6591 6592 #ifndef IPSEC_NAT_T 6593 /* 6594 * Handle NAT-T info if present. 6595 */ 6596 6597 if (mhp->ext[SADB_X_EXT_NAT_T_SPORT] != NULL && 6598 mhp->ext[SADB_X_EXT_NAT_T_DPORT] != NULL) { 6599 struct sadb_x_nat_t_port *sport, *dport; 6600 6601 if (mhp->extlen[SADB_X_EXT_NAT_T_SPORT] < sizeof(*sport) || 6602 mhp->extlen[SADB_X_EXT_NAT_T_DPORT] < sizeof(*dport)) { 6603 ipseclog((LOG_DEBUG, "%s: invalid message.\n", 6604 __func__)); 6605 return key_senderror(so, m, EINVAL); 6606 } 6607 6608 sport = (struct sadb_x_nat_t_port *) 6609 mhp->ext[SADB_X_EXT_NAT_T_SPORT]; 6610 dport = (struct sadb_x_nat_t_port *) 6611 mhp->ext[SADB_X_EXT_NAT_T_DPORT]; 6612 6613 if (sport) 6614 KEY_PORTTOSADDR(&saidx.src, 6615 sport->sadb_x_nat_t_port_port); 6616 if (dport) 6617 KEY_PORTTOSADDR(&saidx.dst, 6618 dport->sadb_x_nat_t_port_port); 6619 } 6620 #endif 6621 6622 /* get a SA index */ 6623 SAHTREE_LOCK(); 6624 LIST_FOREACH(sah, &V_sahtree, chain) { 6625 if (sah->state == SADB_SASTATE_DEAD) 6626 continue; 6627 if (key_cmpsaidx(&sah->saidx, &saidx, CMP_MODE_REQID)) 6628 break; 6629 } 6630 SAHTREE_UNLOCK(); 6631 if (sah != NULL) { 6632 ipseclog((LOG_DEBUG, "%s: a SA exists already.\n", __func__)); 6633 return key_senderror(so, m, EEXIST); 6634 } 6635 6636 error = key_acquire(&saidx, NULL); 6637 if (error != 0) { 6638 ipseclog((LOG_DEBUG, "%s: error %d returned from key_acquire\n", 6639 __func__, mhp->msg->sadb_msg_errno)); 6640 return key_senderror(so, m, error); 6641 } 6642 6643 return key_sendup_mbuf(so, m, KEY_SENDUP_REGISTERED); 6644 } 6645 6646 /* 6647 * SADB_REGISTER processing. 6648 * If SATYPE_UNSPEC has been passed as satype, only return sabd_supported. 6649 * receive 6650 * <base> 6651 * from the ikmpd, and register a socket to send PF_KEY messages, 6652 * and send 6653 * <base, supported> 6654 * to KMD by PF_KEY. 6655 * If socket is detached, must free from regnode. 6656 * 6657 * m will always be freed. 6658 */ 6659 static int 6660 key_register(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 6661 { 6662 struct secreg *reg, *newreg = NULL; 6663 6664 IPSEC_ASSERT(so != NULL, ("null socket")); 6665 IPSEC_ASSERT(m != NULL, ("null mbuf")); 6666 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 6667 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 6668 6669 /* check for invalid register message */ 6670 if (mhp->msg->sadb_msg_satype >= sizeof(V_regtree)/sizeof(V_regtree[0])) 6671 return key_senderror(so, m, EINVAL); 6672 6673 /* When SATYPE_UNSPEC is specified, only return sabd_supported. */ 6674 if (mhp->msg->sadb_msg_satype == SADB_SATYPE_UNSPEC) 6675 goto setmsg; 6676 6677 /* check whether existing or not */ 6678 REGTREE_LOCK(); 6679 LIST_FOREACH(reg, &V_regtree[mhp->msg->sadb_msg_satype], chain) { 6680 if (reg->so == so) { 6681 REGTREE_UNLOCK(); 6682 ipseclog((LOG_DEBUG, "%s: socket exists already.\n", 6683 __func__)); 6684 return key_senderror(so, m, EEXIST); 6685 } 6686 } 6687 6688 /* create regnode */ 6689 newreg = malloc(sizeof(struct secreg), M_IPSEC_SAR, M_NOWAIT|M_ZERO); 6690 if (newreg == NULL) { 6691 REGTREE_UNLOCK(); 6692 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 6693 return key_senderror(so, m, ENOBUFS); 6694 } 6695 6696 newreg->so = so; 6697 ((struct keycb *)sotorawcb(so))->kp_registered++; 6698 6699 /* add regnode to regtree. */ 6700 LIST_INSERT_HEAD(&V_regtree[mhp->msg->sadb_msg_satype], newreg, chain); 6701 REGTREE_UNLOCK(); 6702 6703 setmsg: 6704 { 6705 struct mbuf *n; 6706 struct sadb_msg *newmsg; 6707 struct sadb_supported *sup; 6708 u_int len, alen, elen; 6709 int off; 6710 int i; 6711 struct sadb_alg *alg; 6712 6713 /* create new sadb_msg to reply. */ 6714 alen = 0; 6715 for (i = 1; i <= SADB_AALG_MAX; i++) { 6716 if (ah_algorithm_lookup(i)) 6717 alen += sizeof(struct sadb_alg); 6718 } 6719 if (alen) 6720 alen += sizeof(struct sadb_supported); 6721 elen = 0; 6722 for (i = 1; i <= SADB_EALG_MAX; i++) { 6723 if (esp_algorithm_lookup(i)) 6724 elen += sizeof(struct sadb_alg); 6725 } 6726 if (elen) 6727 elen += sizeof(struct sadb_supported); 6728 6729 len = sizeof(struct sadb_msg) + alen + elen; 6730 6731 if (len > MCLBYTES) 6732 return key_senderror(so, m, ENOBUFS); 6733 6734 MGETHDR(n, M_NOWAIT, MT_DATA); 6735 if (len > MHLEN) { 6736 if (!(MCLGET(n, M_NOWAIT))) { 6737 m_freem(n); 6738 n = NULL; 6739 } 6740 } 6741 if (!n) 6742 return key_senderror(so, m, ENOBUFS); 6743 6744 n->m_pkthdr.len = n->m_len = len; 6745 n->m_next = NULL; 6746 off = 0; 6747 6748 m_copydata(m, 0, sizeof(struct sadb_msg), mtod(n, caddr_t) + off); 6749 newmsg = mtod(n, struct sadb_msg *); 6750 newmsg->sadb_msg_errno = 0; 6751 newmsg->sadb_msg_len = PFKEY_UNIT64(len); 6752 off += PFKEY_ALIGN8(sizeof(struct sadb_msg)); 6753 6754 /* for authentication algorithm */ 6755 if (alen) { 6756 sup = (struct sadb_supported *)(mtod(n, caddr_t) + off); 6757 sup->sadb_supported_len = PFKEY_UNIT64(alen); 6758 sup->sadb_supported_exttype = SADB_EXT_SUPPORTED_AUTH; 6759 off += PFKEY_ALIGN8(sizeof(*sup)); 6760 6761 for (i = 1; i <= SADB_AALG_MAX; i++) { 6762 struct auth_hash *aalgo; 6763 u_int16_t minkeysize, maxkeysize; 6764 6765 aalgo = ah_algorithm_lookup(i); 6766 if (!aalgo) 6767 continue; 6768 alg = (struct sadb_alg *)(mtod(n, caddr_t) + off); 6769 alg->sadb_alg_id = i; 6770 alg->sadb_alg_ivlen = 0; 6771 key_getsizes_ah(aalgo, i, &minkeysize, &maxkeysize); 6772 alg->sadb_alg_minbits = _BITS(minkeysize); 6773 alg->sadb_alg_maxbits = _BITS(maxkeysize); 6774 off += PFKEY_ALIGN8(sizeof(*alg)); 6775 } 6776 } 6777 6778 /* for encryption algorithm */ 6779 if (elen) { 6780 sup = (struct sadb_supported *)(mtod(n, caddr_t) + off); 6781 sup->sadb_supported_len = PFKEY_UNIT64(elen); 6782 sup->sadb_supported_exttype = SADB_EXT_SUPPORTED_ENCRYPT; 6783 off += PFKEY_ALIGN8(sizeof(*sup)); 6784 6785 for (i = 1; i <= SADB_EALG_MAX; i++) { 6786 struct enc_xform *ealgo; 6787 6788 ealgo = esp_algorithm_lookup(i); 6789 if (!ealgo) 6790 continue; 6791 alg = (struct sadb_alg *)(mtod(n, caddr_t) + off); 6792 alg->sadb_alg_id = i; 6793 alg->sadb_alg_ivlen = ealgo->ivsize; 6794 alg->sadb_alg_minbits = _BITS(ealgo->minkey); 6795 alg->sadb_alg_maxbits = _BITS(ealgo->maxkey); 6796 off += PFKEY_ALIGN8(sizeof(struct sadb_alg)); 6797 } 6798 } 6799 6800 IPSEC_ASSERT(off == len, 6801 ("length assumption failed (off %u len %u)", off, len)); 6802 6803 m_freem(m); 6804 return key_sendup_mbuf(so, n, KEY_SENDUP_REGISTERED); 6805 } 6806 } 6807 6808 /* 6809 * free secreg entry registered. 6810 * XXX: I want to do free a socket marked done SADB_RESIGER to socket. 6811 */ 6812 void 6813 key_freereg(struct socket *so) 6814 { 6815 struct secreg *reg; 6816 int i; 6817 6818 IPSEC_ASSERT(so != NULL, ("NULL so")); 6819 6820 /* 6821 * check whether existing or not. 6822 * check all type of SA, because there is a potential that 6823 * one socket is registered to multiple type of SA. 6824 */ 6825 REGTREE_LOCK(); 6826 for (i = 0; i <= SADB_SATYPE_MAX; i++) { 6827 LIST_FOREACH(reg, &V_regtree[i], chain) { 6828 if (reg->so == so && __LIST_CHAINED(reg)) { 6829 LIST_REMOVE(reg, chain); 6830 free(reg, M_IPSEC_SAR); 6831 break; 6832 } 6833 } 6834 } 6835 REGTREE_UNLOCK(); 6836 } 6837 6838 /* 6839 * SADB_EXPIRE processing 6840 * send 6841 * <base, SA, SA2, lifetime(C and one of HS), address(SD)> 6842 * to KMD by PF_KEY. 6843 * NOTE: We send only soft lifetime extension. 6844 * 6845 * OUT: 0 : succeed 6846 * others : error number 6847 */ 6848 static int 6849 key_expire(struct secasvar *sav, int hard) 6850 { 6851 int satype; 6852 struct mbuf *result = NULL, *m; 6853 int len; 6854 int error = -1; 6855 struct sadb_lifetime *lt; 6856 6857 IPSEC_ASSERT (sav != NULL, ("null sav")); 6858 IPSEC_ASSERT (sav->sah != NULL, ("null sa header")); 6859 6860 /* set msg header */ 6861 satype = key_proto2satype(sav->sah->saidx.proto); 6862 IPSEC_ASSERT(satype != 0, ("invalid proto, satype %u", satype)); 6863 m = key_setsadbmsg(SADB_EXPIRE, 0, satype, sav->seq, 0, sav->refcnt); 6864 if (!m) { 6865 error = ENOBUFS; 6866 goto fail; 6867 } 6868 result = m; 6869 6870 /* create SA extension */ 6871 m = key_setsadbsa(sav); 6872 if (!m) { 6873 error = ENOBUFS; 6874 goto fail; 6875 } 6876 m_cat(result, m); 6877 6878 /* create SA extension */ 6879 m = key_setsadbxsa2(sav->sah->saidx.mode, 6880 sav->replay ? sav->replay->count : 0, 6881 sav->sah->saidx.reqid); 6882 if (!m) { 6883 error = ENOBUFS; 6884 goto fail; 6885 } 6886 m_cat(result, m); 6887 6888 /* create lifetime extension (current and soft) */ 6889 len = PFKEY_ALIGN8(sizeof(*lt)) * 2; 6890 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 6891 if (m == NULL) { 6892 error = ENOBUFS; 6893 goto fail; 6894 } 6895 m_align(m, len); 6896 m->m_len = len; 6897 bzero(mtod(m, caddr_t), len); 6898 lt = mtod(m, struct sadb_lifetime *); 6899 lt->sadb_lifetime_len = PFKEY_UNIT64(sizeof(struct sadb_lifetime)); 6900 lt->sadb_lifetime_exttype = SADB_EXT_LIFETIME_CURRENT; 6901 lt->sadb_lifetime_allocations = sav->lft_c->allocations; 6902 lt->sadb_lifetime_bytes = sav->lft_c->bytes; 6903 lt->sadb_lifetime_addtime = sav->lft_c->addtime; 6904 lt->sadb_lifetime_usetime = sav->lft_c->usetime; 6905 lt = (struct sadb_lifetime *)(mtod(m, caddr_t) + len / 2); 6906 lt->sadb_lifetime_len = PFKEY_UNIT64(sizeof(struct sadb_lifetime)); 6907 if (hard) { 6908 lt->sadb_lifetime_exttype = SADB_EXT_LIFETIME_HARD; 6909 lt->sadb_lifetime_allocations = sav->lft_h->allocations; 6910 lt->sadb_lifetime_bytes = sav->lft_h->bytes; 6911 lt->sadb_lifetime_addtime = sav->lft_h->addtime; 6912 lt->sadb_lifetime_usetime = sav->lft_h->usetime; 6913 } else { 6914 lt->sadb_lifetime_exttype = SADB_EXT_LIFETIME_SOFT; 6915 lt->sadb_lifetime_allocations = sav->lft_s->allocations; 6916 lt->sadb_lifetime_bytes = sav->lft_s->bytes; 6917 lt->sadb_lifetime_addtime = sav->lft_s->addtime; 6918 lt->sadb_lifetime_usetime = sav->lft_s->usetime; 6919 } 6920 m_cat(result, m); 6921 6922 /* set sadb_address for source */ 6923 m = key_setsadbaddr(SADB_EXT_ADDRESS_SRC, 6924 &sav->sah->saidx.src.sa, 6925 FULLMASK, IPSEC_ULPROTO_ANY); 6926 if (!m) { 6927 error = ENOBUFS; 6928 goto fail; 6929 } 6930 m_cat(result, m); 6931 6932 /* set sadb_address for destination */ 6933 m = key_setsadbaddr(SADB_EXT_ADDRESS_DST, 6934 &sav->sah->saidx.dst.sa, 6935 FULLMASK, IPSEC_ULPROTO_ANY); 6936 if (!m) { 6937 error = ENOBUFS; 6938 goto fail; 6939 } 6940 m_cat(result, m); 6941 6942 /* 6943 * XXX-BZ Handle NAT-T extensions here. 6944 */ 6945 6946 if ((result->m_flags & M_PKTHDR) == 0) { 6947 error = EINVAL; 6948 goto fail; 6949 } 6950 6951 if (result->m_len < sizeof(struct sadb_msg)) { 6952 result = m_pullup(result, sizeof(struct sadb_msg)); 6953 if (result == NULL) { 6954 error = ENOBUFS; 6955 goto fail; 6956 } 6957 } 6958 6959 result->m_pkthdr.len = 0; 6960 for (m = result; m; m = m->m_next) 6961 result->m_pkthdr.len += m->m_len; 6962 6963 mtod(result, struct sadb_msg *)->sadb_msg_len = 6964 PFKEY_UNIT64(result->m_pkthdr.len); 6965 6966 return key_sendup_mbuf(NULL, result, KEY_SENDUP_REGISTERED); 6967 6968 fail: 6969 if (result) 6970 m_freem(result); 6971 return error; 6972 } 6973 6974 /* 6975 * SADB_FLUSH processing 6976 * receive 6977 * <base> 6978 * from the ikmpd, and free all entries in secastree. 6979 * and send, 6980 * <base> 6981 * to the ikmpd. 6982 * NOTE: to do is only marking SADB_SASTATE_DEAD. 6983 * 6984 * m will always be freed. 6985 */ 6986 static int 6987 key_flush(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 6988 { 6989 struct sadb_msg *newmsg; 6990 struct secashead *sah, *nextsah; 6991 struct secasvar *sav, *nextsav; 6992 u_int16_t proto; 6993 u_int8_t state; 6994 u_int stateidx; 6995 6996 IPSEC_ASSERT(so != NULL, ("null socket")); 6997 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 6998 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 6999 7000 /* map satype to proto */ 7001 if ((proto = key_satype2proto(mhp->msg->sadb_msg_satype)) == 0) { 7002 ipseclog((LOG_DEBUG, "%s: invalid satype is passed.\n", 7003 __func__)); 7004 return key_senderror(so, m, EINVAL); 7005 } 7006 7007 /* no SATYPE specified, i.e. flushing all SA. */ 7008 SAHTREE_LOCK(); 7009 for (sah = LIST_FIRST(&V_sahtree); 7010 sah != NULL; 7011 sah = nextsah) { 7012 nextsah = LIST_NEXT(sah, chain); 7013 7014 if (mhp->msg->sadb_msg_satype != SADB_SATYPE_UNSPEC 7015 && proto != sah->saidx.proto) 7016 continue; 7017 7018 for (stateidx = 0; 7019 stateidx < _ARRAYLEN(saorder_state_alive); 7020 stateidx++) { 7021 state = saorder_state_any[stateidx]; 7022 for (sav = LIST_FIRST(&sah->savtree[state]); 7023 sav != NULL; 7024 sav = nextsav) { 7025 7026 nextsav = LIST_NEXT(sav, chain); 7027 7028 key_sa_chgstate(sav, SADB_SASTATE_DEAD); 7029 KEY_FREESAV(&sav); 7030 } 7031 } 7032 7033 sah->state = SADB_SASTATE_DEAD; 7034 } 7035 SAHTREE_UNLOCK(); 7036 7037 if (m->m_len < sizeof(struct sadb_msg) || 7038 sizeof(struct sadb_msg) > m->m_len + M_TRAILINGSPACE(m)) { 7039 ipseclog((LOG_DEBUG, "%s: No more memory.\n", __func__)); 7040 return key_senderror(so, m, ENOBUFS); 7041 } 7042 7043 if (m->m_next) 7044 m_freem(m->m_next); 7045 m->m_next = NULL; 7046 m->m_pkthdr.len = m->m_len = sizeof(struct sadb_msg); 7047 newmsg = mtod(m, struct sadb_msg *); 7048 newmsg->sadb_msg_errno = 0; 7049 newmsg->sadb_msg_len = PFKEY_UNIT64(m->m_pkthdr.len); 7050 7051 return key_sendup_mbuf(so, m, KEY_SENDUP_ALL); 7052 } 7053 7054 /* 7055 * SADB_DUMP processing 7056 * dump all entries including status of DEAD in SAD. 7057 * receive 7058 * <base> 7059 * from the ikmpd, and dump all secasvar leaves 7060 * and send, 7061 * <base> ..... 7062 * to the ikmpd. 7063 * 7064 * m will always be freed. 7065 */ 7066 static int 7067 key_dump(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 7068 { 7069 struct secashead *sah; 7070 struct secasvar *sav; 7071 u_int16_t proto; 7072 u_int stateidx; 7073 u_int8_t satype; 7074 u_int8_t state; 7075 int cnt; 7076 struct sadb_msg *newmsg; 7077 struct mbuf *n; 7078 7079 IPSEC_ASSERT(so != NULL, ("null socket")); 7080 IPSEC_ASSERT(m != NULL, ("null mbuf")); 7081 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 7082 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 7083 7084 /* map satype to proto */ 7085 if ((proto = key_satype2proto(mhp->msg->sadb_msg_satype)) == 0) { 7086 ipseclog((LOG_DEBUG, "%s: invalid satype is passed.\n", 7087 __func__)); 7088 return key_senderror(so, m, EINVAL); 7089 } 7090 7091 /* count sav entries to be sent to the userland. */ 7092 cnt = 0; 7093 SAHTREE_LOCK(); 7094 LIST_FOREACH(sah, &V_sahtree, chain) { 7095 if (mhp->msg->sadb_msg_satype != SADB_SATYPE_UNSPEC 7096 && proto != sah->saidx.proto) 7097 continue; 7098 7099 for (stateidx = 0; 7100 stateidx < _ARRAYLEN(saorder_state_any); 7101 stateidx++) { 7102 state = saorder_state_any[stateidx]; 7103 LIST_FOREACH(sav, &sah->savtree[state], chain) { 7104 cnt++; 7105 } 7106 } 7107 } 7108 7109 if (cnt == 0) { 7110 SAHTREE_UNLOCK(); 7111 return key_senderror(so, m, ENOENT); 7112 } 7113 7114 /* send this to the userland, one at a time. */ 7115 newmsg = NULL; 7116 LIST_FOREACH(sah, &V_sahtree, chain) { 7117 if (mhp->msg->sadb_msg_satype != SADB_SATYPE_UNSPEC 7118 && proto != sah->saidx.proto) 7119 continue; 7120 7121 /* map proto to satype */ 7122 if ((satype = key_proto2satype(sah->saidx.proto)) == 0) { 7123 SAHTREE_UNLOCK(); 7124 ipseclog((LOG_DEBUG, "%s: there was invalid proto in " 7125 "SAD.\n", __func__)); 7126 return key_senderror(so, m, EINVAL); 7127 } 7128 7129 for (stateidx = 0; 7130 stateidx < _ARRAYLEN(saorder_state_any); 7131 stateidx++) { 7132 state = saorder_state_any[stateidx]; 7133 LIST_FOREACH(sav, &sah->savtree[state], chain) { 7134 n = key_setdumpsa(sav, SADB_DUMP, satype, 7135 --cnt, mhp->msg->sadb_msg_pid); 7136 if (!n) { 7137 SAHTREE_UNLOCK(); 7138 return key_senderror(so, m, ENOBUFS); 7139 } 7140 key_sendup_mbuf(so, n, KEY_SENDUP_ONE); 7141 } 7142 } 7143 } 7144 SAHTREE_UNLOCK(); 7145 7146 m_freem(m); 7147 return 0; 7148 } 7149 7150 /* 7151 * SADB_X_PROMISC processing 7152 * 7153 * m will always be freed. 7154 */ 7155 static int 7156 key_promisc(struct socket *so, struct mbuf *m, const struct sadb_msghdr *mhp) 7157 { 7158 int olen; 7159 7160 IPSEC_ASSERT(so != NULL, ("null socket")); 7161 IPSEC_ASSERT(m != NULL, ("null mbuf")); 7162 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 7163 IPSEC_ASSERT(mhp->msg != NULL, ("null msg")); 7164 7165 olen = PFKEY_UNUNIT64(mhp->msg->sadb_msg_len); 7166 7167 if (olen < sizeof(struct sadb_msg)) { 7168 #if 1 7169 return key_senderror(so, m, EINVAL); 7170 #else 7171 m_freem(m); 7172 return 0; 7173 #endif 7174 } else if (olen == sizeof(struct sadb_msg)) { 7175 /* enable/disable promisc mode */ 7176 struct keycb *kp; 7177 7178 if ((kp = (struct keycb *)sotorawcb(so)) == NULL) 7179 return key_senderror(so, m, EINVAL); 7180 mhp->msg->sadb_msg_errno = 0; 7181 switch (mhp->msg->sadb_msg_satype) { 7182 case 0: 7183 case 1: 7184 kp->kp_promisc = mhp->msg->sadb_msg_satype; 7185 break; 7186 default: 7187 return key_senderror(so, m, EINVAL); 7188 } 7189 7190 /* send the original message back to everyone */ 7191 mhp->msg->sadb_msg_errno = 0; 7192 return key_sendup_mbuf(so, m, KEY_SENDUP_ALL); 7193 } else { 7194 /* send packet as is */ 7195 7196 m_adj(m, PFKEY_ALIGN8(sizeof(struct sadb_msg))); 7197 7198 /* TODO: if sadb_msg_seq is specified, send to specific pid */ 7199 return key_sendup_mbuf(so, m, KEY_SENDUP_ALL); 7200 } 7201 } 7202 7203 static int (*key_typesw[])(struct socket *, struct mbuf *, 7204 const struct sadb_msghdr *) = { 7205 NULL, /* SADB_RESERVED */ 7206 key_getspi, /* SADB_GETSPI */ 7207 key_update, /* SADB_UPDATE */ 7208 key_add, /* SADB_ADD */ 7209 key_delete, /* SADB_DELETE */ 7210 key_get, /* SADB_GET */ 7211 key_acquire2, /* SADB_ACQUIRE */ 7212 key_register, /* SADB_REGISTER */ 7213 NULL, /* SADB_EXPIRE */ 7214 key_flush, /* SADB_FLUSH */ 7215 key_dump, /* SADB_DUMP */ 7216 key_promisc, /* SADB_X_PROMISC */ 7217 NULL, /* SADB_X_PCHANGE */ 7218 key_spdadd, /* SADB_X_SPDUPDATE */ 7219 key_spdadd, /* SADB_X_SPDADD */ 7220 key_spddelete, /* SADB_X_SPDDELETE */ 7221 key_spdget, /* SADB_X_SPDGET */ 7222 NULL, /* SADB_X_SPDACQUIRE */ 7223 key_spddump, /* SADB_X_SPDDUMP */ 7224 key_spdflush, /* SADB_X_SPDFLUSH */ 7225 key_spdadd, /* SADB_X_SPDSETIDX */ 7226 NULL, /* SADB_X_SPDEXPIRE */ 7227 key_spddelete2, /* SADB_X_SPDDELETE2 */ 7228 }; 7229 7230 /* 7231 * parse sadb_msg buffer to process PFKEYv2, 7232 * and create a data to response if needed. 7233 * I think to be dealed with mbuf directly. 7234 * IN: 7235 * msgp : pointer to pointer to a received buffer pulluped. 7236 * This is rewrited to response. 7237 * so : pointer to socket. 7238 * OUT: 7239 * length for buffer to send to user process. 7240 */ 7241 int 7242 key_parse(struct mbuf *m, struct socket *so) 7243 { 7244 struct sadb_msg *msg; 7245 struct sadb_msghdr mh; 7246 u_int orglen; 7247 int error; 7248 int target; 7249 7250 IPSEC_ASSERT(so != NULL, ("null socket")); 7251 IPSEC_ASSERT(m != NULL, ("null mbuf")); 7252 7253 #if 0 /*kdebug_sadb assumes msg in linear buffer*/ 7254 KEYDEBUG(KEYDEBUG_KEY_DUMP, 7255 ipseclog((LOG_DEBUG, "%s: passed sadb_msg\n", __func__)); 7256 kdebug_sadb(msg)); 7257 #endif 7258 7259 if (m->m_len < sizeof(struct sadb_msg)) { 7260 m = m_pullup(m, sizeof(struct sadb_msg)); 7261 if (!m) 7262 return ENOBUFS; 7263 } 7264 msg = mtod(m, struct sadb_msg *); 7265 orglen = PFKEY_UNUNIT64(msg->sadb_msg_len); 7266 target = KEY_SENDUP_ONE; 7267 7268 if ((m->m_flags & M_PKTHDR) == 0 || m->m_pkthdr.len != orglen) { 7269 ipseclog((LOG_DEBUG, "%s: invalid message length.\n",__func__)); 7270 PFKEYSTAT_INC(out_invlen); 7271 error = EINVAL; 7272 goto senderror; 7273 } 7274 7275 if (msg->sadb_msg_version != PF_KEY_V2) { 7276 ipseclog((LOG_DEBUG, "%s: PF_KEY version %u is mismatched.\n", 7277 __func__, msg->sadb_msg_version)); 7278 PFKEYSTAT_INC(out_invver); 7279 error = EINVAL; 7280 goto senderror; 7281 } 7282 7283 if (msg->sadb_msg_type > SADB_MAX) { 7284 ipseclog((LOG_DEBUG, "%s: invalid type %u is passed.\n", 7285 __func__, msg->sadb_msg_type)); 7286 PFKEYSTAT_INC(out_invmsgtype); 7287 error = EINVAL; 7288 goto senderror; 7289 } 7290 7291 /* for old-fashioned code - should be nuked */ 7292 if (m->m_pkthdr.len > MCLBYTES) { 7293 m_freem(m); 7294 return ENOBUFS; 7295 } 7296 if (m->m_next) { 7297 struct mbuf *n; 7298 7299 MGETHDR(n, M_NOWAIT, MT_DATA); 7300 if (n && m->m_pkthdr.len > MHLEN) { 7301 if (!(MCLGET(n, M_NOWAIT))) { 7302 m_free(n); 7303 n = NULL; 7304 } 7305 } 7306 if (!n) { 7307 m_freem(m); 7308 return ENOBUFS; 7309 } 7310 m_copydata(m, 0, m->m_pkthdr.len, mtod(n, caddr_t)); 7311 n->m_pkthdr.len = n->m_len = m->m_pkthdr.len; 7312 n->m_next = NULL; 7313 m_freem(m); 7314 m = n; 7315 } 7316 7317 /* align the mbuf chain so that extensions are in contiguous region. */ 7318 error = key_align(m, &mh); 7319 if (error) 7320 return error; 7321 7322 msg = mh.msg; 7323 7324 /* check SA type */ 7325 switch (msg->sadb_msg_satype) { 7326 case SADB_SATYPE_UNSPEC: 7327 switch (msg->sadb_msg_type) { 7328 case SADB_GETSPI: 7329 case SADB_UPDATE: 7330 case SADB_ADD: 7331 case SADB_DELETE: 7332 case SADB_GET: 7333 case SADB_ACQUIRE: 7334 case SADB_EXPIRE: 7335 ipseclog((LOG_DEBUG, "%s: must specify satype " 7336 "when msg type=%u.\n", __func__, 7337 msg->sadb_msg_type)); 7338 PFKEYSTAT_INC(out_invsatype); 7339 error = EINVAL; 7340 goto senderror; 7341 } 7342 break; 7343 case SADB_SATYPE_AH: 7344 case SADB_SATYPE_ESP: 7345 case SADB_X_SATYPE_IPCOMP: 7346 case SADB_X_SATYPE_TCPSIGNATURE: 7347 switch (msg->sadb_msg_type) { 7348 case SADB_X_SPDADD: 7349 case SADB_X_SPDDELETE: 7350 case SADB_X_SPDGET: 7351 case SADB_X_SPDDUMP: 7352 case SADB_X_SPDFLUSH: 7353 case SADB_X_SPDSETIDX: 7354 case SADB_X_SPDUPDATE: 7355 case SADB_X_SPDDELETE2: 7356 ipseclog((LOG_DEBUG, "%s: illegal satype=%u\n", 7357 __func__, msg->sadb_msg_type)); 7358 PFKEYSTAT_INC(out_invsatype); 7359 error = EINVAL; 7360 goto senderror; 7361 } 7362 break; 7363 case SADB_SATYPE_RSVP: 7364 case SADB_SATYPE_OSPFV2: 7365 case SADB_SATYPE_RIPV2: 7366 case SADB_SATYPE_MIP: 7367 ipseclog((LOG_DEBUG, "%s: type %u isn't supported.\n", 7368 __func__, msg->sadb_msg_satype)); 7369 PFKEYSTAT_INC(out_invsatype); 7370 error = EOPNOTSUPP; 7371 goto senderror; 7372 case 1: /* XXX: What does it do? */ 7373 if (msg->sadb_msg_type == SADB_X_PROMISC) 7374 break; 7375 /*FALLTHROUGH*/ 7376 default: 7377 ipseclog((LOG_DEBUG, "%s: invalid type %u is passed.\n", 7378 __func__, msg->sadb_msg_satype)); 7379 PFKEYSTAT_INC(out_invsatype); 7380 error = EINVAL; 7381 goto senderror; 7382 } 7383 7384 /* check field of upper layer protocol and address family */ 7385 if (mh.ext[SADB_EXT_ADDRESS_SRC] != NULL 7386 && mh.ext[SADB_EXT_ADDRESS_DST] != NULL) { 7387 struct sadb_address *src0, *dst0; 7388 u_int plen; 7389 7390 src0 = (struct sadb_address *)(mh.ext[SADB_EXT_ADDRESS_SRC]); 7391 dst0 = (struct sadb_address *)(mh.ext[SADB_EXT_ADDRESS_DST]); 7392 7393 /* check upper layer protocol */ 7394 if (src0->sadb_address_proto != dst0->sadb_address_proto) { 7395 ipseclog((LOG_DEBUG, "%s: upper layer protocol " 7396 "mismatched.\n", __func__)); 7397 PFKEYSTAT_INC(out_invaddr); 7398 error = EINVAL; 7399 goto senderror; 7400 } 7401 7402 /* check family */ 7403 if (PFKEY_ADDR_SADDR(src0)->sa_family != 7404 PFKEY_ADDR_SADDR(dst0)->sa_family) { 7405 ipseclog((LOG_DEBUG, "%s: address family mismatched.\n", 7406 __func__)); 7407 PFKEYSTAT_INC(out_invaddr); 7408 error = EINVAL; 7409 goto senderror; 7410 } 7411 if (PFKEY_ADDR_SADDR(src0)->sa_len != 7412 PFKEY_ADDR_SADDR(dst0)->sa_len) { 7413 ipseclog((LOG_DEBUG, "%s: address struct size " 7414 "mismatched.\n", __func__)); 7415 PFKEYSTAT_INC(out_invaddr); 7416 error = EINVAL; 7417 goto senderror; 7418 } 7419 7420 switch (PFKEY_ADDR_SADDR(src0)->sa_family) { 7421 case AF_INET: 7422 if (PFKEY_ADDR_SADDR(src0)->sa_len != 7423 sizeof(struct sockaddr_in)) { 7424 PFKEYSTAT_INC(out_invaddr); 7425 error = EINVAL; 7426 goto senderror; 7427 } 7428 break; 7429 case AF_INET6: 7430 if (PFKEY_ADDR_SADDR(src0)->sa_len != 7431 sizeof(struct sockaddr_in6)) { 7432 PFKEYSTAT_INC(out_invaddr); 7433 error = EINVAL; 7434 goto senderror; 7435 } 7436 break; 7437 default: 7438 ipseclog((LOG_DEBUG, "%s: unsupported address family\n", 7439 __func__)); 7440 PFKEYSTAT_INC(out_invaddr); 7441 error = EAFNOSUPPORT; 7442 goto senderror; 7443 } 7444 7445 switch (PFKEY_ADDR_SADDR(src0)->sa_family) { 7446 case AF_INET: 7447 plen = sizeof(struct in_addr) << 3; 7448 break; 7449 case AF_INET6: 7450 plen = sizeof(struct in6_addr) << 3; 7451 break; 7452 default: 7453 plen = 0; /*fool gcc*/ 7454 break; 7455 } 7456 7457 /* check max prefix length */ 7458 if (src0->sadb_address_prefixlen > plen || 7459 dst0->sadb_address_prefixlen > plen) { 7460 ipseclog((LOG_DEBUG, "%s: illegal prefixlen.\n", 7461 __func__)); 7462 PFKEYSTAT_INC(out_invaddr); 7463 error = EINVAL; 7464 goto senderror; 7465 } 7466 7467 /* 7468 * prefixlen == 0 is valid because there can be a case when 7469 * all addresses are matched. 7470 */ 7471 } 7472 7473 if (msg->sadb_msg_type >= nitems(key_typesw) || 7474 key_typesw[msg->sadb_msg_type] == NULL) { 7475 PFKEYSTAT_INC(out_invmsgtype); 7476 error = EINVAL; 7477 goto senderror; 7478 } 7479 7480 return (*key_typesw[msg->sadb_msg_type])(so, m, &mh); 7481 7482 senderror: 7483 msg->sadb_msg_errno = error; 7484 return key_sendup_mbuf(so, m, target); 7485 } 7486 7487 static int 7488 key_senderror(struct socket *so, struct mbuf *m, int code) 7489 { 7490 struct sadb_msg *msg; 7491 7492 IPSEC_ASSERT(m->m_len >= sizeof(struct sadb_msg), 7493 ("mbuf too small, len %u", m->m_len)); 7494 7495 msg = mtod(m, struct sadb_msg *); 7496 msg->sadb_msg_errno = code; 7497 return key_sendup_mbuf(so, m, KEY_SENDUP_ONE); 7498 } 7499 7500 /* 7501 * set the pointer to each header into message buffer. 7502 * m will be freed on error. 7503 * XXX larger-than-MCLBYTES extension? 7504 */ 7505 static int 7506 key_align(struct mbuf *m, struct sadb_msghdr *mhp) 7507 { 7508 struct mbuf *n; 7509 struct sadb_ext *ext; 7510 size_t off, end; 7511 int extlen; 7512 int toff; 7513 7514 IPSEC_ASSERT(m != NULL, ("null mbuf")); 7515 IPSEC_ASSERT(mhp != NULL, ("null msghdr")); 7516 IPSEC_ASSERT(m->m_len >= sizeof(struct sadb_msg), 7517 ("mbuf too small, len %u", m->m_len)); 7518 7519 /* initialize */ 7520 bzero(mhp, sizeof(*mhp)); 7521 7522 mhp->msg = mtod(m, struct sadb_msg *); 7523 mhp->ext[0] = (struct sadb_ext *)mhp->msg; /*XXX backward compat */ 7524 7525 end = PFKEY_UNUNIT64(mhp->msg->sadb_msg_len); 7526 extlen = end; /*just in case extlen is not updated*/ 7527 for (off = sizeof(struct sadb_msg); off < end; off += extlen) { 7528 n = m_pulldown(m, off, sizeof(struct sadb_ext), &toff); 7529 if (!n) { 7530 /* m is already freed */ 7531 return ENOBUFS; 7532 } 7533 ext = (struct sadb_ext *)(mtod(n, caddr_t) + toff); 7534 7535 /* set pointer */ 7536 switch (ext->sadb_ext_type) { 7537 case SADB_EXT_SA: 7538 case SADB_EXT_ADDRESS_SRC: 7539 case SADB_EXT_ADDRESS_DST: 7540 case SADB_EXT_ADDRESS_PROXY: 7541 case SADB_EXT_LIFETIME_CURRENT: 7542 case SADB_EXT_LIFETIME_HARD: 7543 case SADB_EXT_LIFETIME_SOFT: 7544 case SADB_EXT_KEY_AUTH: 7545 case SADB_EXT_KEY_ENCRYPT: 7546 case SADB_EXT_IDENTITY_SRC: 7547 case SADB_EXT_IDENTITY_DST: 7548 case SADB_EXT_SENSITIVITY: 7549 case SADB_EXT_PROPOSAL: 7550 case SADB_EXT_SUPPORTED_AUTH: 7551 case SADB_EXT_SUPPORTED_ENCRYPT: 7552 case SADB_EXT_SPIRANGE: 7553 case SADB_X_EXT_POLICY: 7554 case SADB_X_EXT_SA2: 7555 #ifdef IPSEC_NAT_T 7556 case SADB_X_EXT_NAT_T_TYPE: 7557 case SADB_X_EXT_NAT_T_SPORT: 7558 case SADB_X_EXT_NAT_T_DPORT: 7559 case SADB_X_EXT_NAT_T_OAI: 7560 case SADB_X_EXT_NAT_T_OAR: 7561 case SADB_X_EXT_NAT_T_FRAG: 7562 #endif 7563 /* duplicate check */ 7564 /* 7565 * XXX Are there duplication payloads of either 7566 * KEY_AUTH or KEY_ENCRYPT ? 7567 */ 7568 if (mhp->ext[ext->sadb_ext_type] != NULL) { 7569 ipseclog((LOG_DEBUG, "%s: duplicate ext_type " 7570 "%u\n", __func__, ext->sadb_ext_type)); 7571 m_freem(m); 7572 PFKEYSTAT_INC(out_dupext); 7573 return EINVAL; 7574 } 7575 break; 7576 default: 7577 ipseclog((LOG_DEBUG, "%s: invalid ext_type %u\n", 7578 __func__, ext->sadb_ext_type)); 7579 m_freem(m); 7580 PFKEYSTAT_INC(out_invexttype); 7581 return EINVAL; 7582 } 7583 7584 extlen = PFKEY_UNUNIT64(ext->sadb_ext_len); 7585 7586 if (key_validate_ext(ext, extlen)) { 7587 m_freem(m); 7588 PFKEYSTAT_INC(out_invlen); 7589 return EINVAL; 7590 } 7591 7592 n = m_pulldown(m, off, extlen, &toff); 7593 if (!n) { 7594 /* m is already freed */ 7595 return ENOBUFS; 7596 } 7597 ext = (struct sadb_ext *)(mtod(n, caddr_t) + toff); 7598 7599 mhp->ext[ext->sadb_ext_type] = ext; 7600 mhp->extoff[ext->sadb_ext_type] = off; 7601 mhp->extlen[ext->sadb_ext_type] = extlen; 7602 } 7603 7604 if (off != end) { 7605 m_freem(m); 7606 PFKEYSTAT_INC(out_invlen); 7607 return EINVAL; 7608 } 7609 7610 return 0; 7611 } 7612 7613 static int 7614 key_validate_ext(const struct sadb_ext *ext, int len) 7615 { 7616 const struct sockaddr *sa; 7617 enum { NONE, ADDR } checktype = NONE; 7618 int baselen = 0; 7619 const int sal = offsetof(struct sockaddr, sa_len) + sizeof(sa->sa_len); 7620 7621 if (len != PFKEY_UNUNIT64(ext->sadb_ext_len)) 7622 return EINVAL; 7623 7624 /* if it does not match minimum/maximum length, bail */ 7625 if (ext->sadb_ext_type >= nitems(minsize) || 7626 ext->sadb_ext_type >= nitems(maxsize)) 7627 return EINVAL; 7628 if (!minsize[ext->sadb_ext_type] || len < minsize[ext->sadb_ext_type]) 7629 return EINVAL; 7630 if (maxsize[ext->sadb_ext_type] && len > maxsize[ext->sadb_ext_type]) 7631 return EINVAL; 7632 7633 /* more checks based on sadb_ext_type XXX need more */ 7634 switch (ext->sadb_ext_type) { 7635 case SADB_EXT_ADDRESS_SRC: 7636 case SADB_EXT_ADDRESS_DST: 7637 case SADB_EXT_ADDRESS_PROXY: 7638 baselen = PFKEY_ALIGN8(sizeof(struct sadb_address)); 7639 checktype = ADDR; 7640 break; 7641 case SADB_EXT_IDENTITY_SRC: 7642 case SADB_EXT_IDENTITY_DST: 7643 if (((const struct sadb_ident *)ext)->sadb_ident_type == 7644 SADB_X_IDENTTYPE_ADDR) { 7645 baselen = PFKEY_ALIGN8(sizeof(struct sadb_ident)); 7646 checktype = ADDR; 7647 } else 7648 checktype = NONE; 7649 break; 7650 default: 7651 checktype = NONE; 7652 break; 7653 } 7654 7655 switch (checktype) { 7656 case NONE: 7657 break; 7658 case ADDR: 7659 sa = (const struct sockaddr *)(((const u_int8_t*)ext)+baselen); 7660 if (len < baselen + sal) 7661 return EINVAL; 7662 if (baselen + PFKEY_ALIGN8(sa->sa_len) != len) 7663 return EINVAL; 7664 break; 7665 } 7666 7667 return 0; 7668 } 7669 7670 void 7671 key_init(void) 7672 { 7673 int i; 7674 7675 for (i = 0; i < IPSEC_DIR_MAX; i++) 7676 TAILQ_INIT(&V_sptree[i]); 7677 7678 LIST_INIT(&V_sahtree); 7679 7680 for (i = 0; i <= SADB_SATYPE_MAX; i++) 7681 LIST_INIT(&V_regtree[i]); 7682 7683 LIST_INIT(&V_acqtree); 7684 LIST_INIT(&V_spacqtree); 7685 7686 if (!IS_DEFAULT_VNET(curvnet)) 7687 return; 7688 7689 SPTREE_LOCK_INIT(); 7690 REGTREE_LOCK_INIT(); 7691 SAHTREE_LOCK_INIT(); 7692 ACQ_LOCK_INIT(); 7693 SPACQ_LOCK_INIT(); 7694 7695 #ifndef IPSEC_DEBUG2 7696 callout_init(&key_timer, 1); 7697 callout_reset(&key_timer, hz, key_timehandler, NULL); 7698 #endif /*IPSEC_DEBUG2*/ 7699 7700 /* initialize key statistics */ 7701 keystat.getspi_count = 1; 7702 7703 if (bootverbose) 7704 printf("IPsec: Initialized Security Association Processing.\n"); 7705 } 7706 7707 #ifdef VIMAGE 7708 void 7709 key_destroy(void) 7710 { 7711 TAILQ_HEAD(, secpolicy) drainq; 7712 struct secpolicy *sp, *nextsp; 7713 struct secacq *acq, *nextacq; 7714 struct secspacq *spacq, *nextspacq; 7715 struct secashead *sah, *nextsah; 7716 struct secreg *reg; 7717 int i; 7718 7719 TAILQ_INIT(&drainq); 7720 SPTREE_WLOCK(); 7721 for (i = 0; i < IPSEC_DIR_MAX; i++) { 7722 TAILQ_CONCAT(&drainq, &V_sptree[i], chain); 7723 } 7724 SPTREE_WUNLOCK(); 7725 sp = TAILQ_FIRST(&drainq); 7726 while (sp != NULL) { 7727 nextsp = TAILQ_NEXT(sp, chain); 7728 KEY_FREESP(&sp); 7729 sp = nextsp; 7730 } 7731 7732 SAHTREE_LOCK(); 7733 for (sah = LIST_FIRST(&V_sahtree); sah != NULL; sah = nextsah) { 7734 nextsah = LIST_NEXT(sah, chain); 7735 if (__LIST_CHAINED(sah)) { 7736 LIST_REMOVE(sah, chain); 7737 free(sah, M_IPSEC_SAH); 7738 } 7739 } 7740 SAHTREE_UNLOCK(); 7741 7742 REGTREE_LOCK(); 7743 for (i = 0; i <= SADB_SATYPE_MAX; i++) { 7744 LIST_FOREACH(reg, &V_regtree[i], chain) { 7745 if (__LIST_CHAINED(reg)) { 7746 LIST_REMOVE(reg, chain); 7747 free(reg, M_IPSEC_SAR); 7748 break; 7749 } 7750 } 7751 } 7752 REGTREE_UNLOCK(); 7753 7754 ACQ_LOCK(); 7755 for (acq = LIST_FIRST(&V_acqtree); acq != NULL; acq = nextacq) { 7756 nextacq = LIST_NEXT(acq, chain); 7757 if (__LIST_CHAINED(acq)) { 7758 LIST_REMOVE(acq, chain); 7759 free(acq, M_IPSEC_SAQ); 7760 } 7761 } 7762 ACQ_UNLOCK(); 7763 7764 SPACQ_LOCK(); 7765 for (spacq = LIST_FIRST(&V_spacqtree); spacq != NULL; 7766 spacq = nextspacq) { 7767 nextspacq = LIST_NEXT(spacq, chain); 7768 if (__LIST_CHAINED(spacq)) { 7769 LIST_REMOVE(spacq, chain); 7770 free(spacq, M_IPSEC_SAQ); 7771 } 7772 } 7773 SPACQ_UNLOCK(); 7774 } 7775 #endif 7776 7777 /* 7778 * XXX: maybe This function is called after INBOUND IPsec processing. 7779 * 7780 * Special check for tunnel-mode packets. 7781 * We must make some checks for consistency between inner and outer IP header. 7782 * 7783 * xxx more checks to be provided 7784 */ 7785 int 7786 key_checktunnelsanity(struct secasvar *sav, u_int family, caddr_t src, 7787 caddr_t dst) 7788 { 7789 IPSEC_ASSERT(sav->sah != NULL, ("null SA header")); 7790 7791 /* XXX: check inner IP header */ 7792 7793 return 1; 7794 } 7795 7796 /* record data transfer on SA, and update timestamps */ 7797 void 7798 key_sa_recordxfer(struct secasvar *sav, struct mbuf *m) 7799 { 7800 IPSEC_ASSERT(sav != NULL, ("Null secasvar")); 7801 IPSEC_ASSERT(m != NULL, ("Null mbuf")); 7802 if (!sav->lft_c) 7803 return; 7804 7805 /* 7806 * XXX Currently, there is a difference of bytes size 7807 * between inbound and outbound processing. 7808 */ 7809 sav->lft_c->bytes += m->m_pkthdr.len; 7810 /* to check bytes lifetime is done in key_timehandler(). */ 7811 7812 /* 7813 * We use the number of packets as the unit of 7814 * allocations. We increment the variable 7815 * whenever {esp,ah}_{in,out}put is called. 7816 */ 7817 sav->lft_c->allocations++; 7818 /* XXX check for expires? */ 7819 7820 /* 7821 * NOTE: We record CURRENT usetime by using wall clock, 7822 * in seconds. HARD and SOFT lifetime are measured by the time 7823 * difference (again in seconds) from usetime. 7824 * 7825 * usetime 7826 * v expire expire 7827 * -----+-----+--------+---> t 7828 * <--------------> HARD 7829 * <-----> SOFT 7830 */ 7831 sav->lft_c->usetime = time_second; 7832 /* XXX check for expires? */ 7833 7834 return; 7835 } 7836 7837 static void 7838 key_sa_chgstate(struct secasvar *sav, u_int8_t state) 7839 { 7840 IPSEC_ASSERT(sav != NULL, ("NULL sav")); 7841 SAHTREE_LOCK_ASSERT(); 7842 7843 if (sav->state != state) { 7844 if (__LIST_CHAINED(sav)) 7845 LIST_REMOVE(sav, chain); 7846 sav->state = state; 7847 LIST_INSERT_HEAD(&sav->sah->savtree[state], sav, chain); 7848 } 7849 } 7850 7851 /* 7852 * Take one of the kernel's security keys and convert it into a PF_KEY 7853 * structure within an mbuf, suitable for sending up to a waiting 7854 * application in user land. 7855 * 7856 * IN: 7857 * src: A pointer to a kernel security key. 7858 * exttype: Which type of key this is. Refer to the PF_KEY data structures. 7859 * OUT: 7860 * a valid mbuf or NULL indicating an error 7861 * 7862 */ 7863 7864 static struct mbuf * 7865 key_setkey(struct seckey *src, u_int16_t exttype) 7866 { 7867 struct mbuf *m; 7868 struct sadb_key *p; 7869 int len; 7870 7871 if (src == NULL) 7872 return NULL; 7873 7874 len = PFKEY_ALIGN8(sizeof(struct sadb_key) + _KEYLEN(src)); 7875 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 7876 if (m == NULL) 7877 return NULL; 7878 m_align(m, len); 7879 m->m_len = len; 7880 p = mtod(m, struct sadb_key *); 7881 bzero(p, len); 7882 p->sadb_key_len = PFKEY_UNIT64(len); 7883 p->sadb_key_exttype = exttype; 7884 p->sadb_key_bits = src->bits; 7885 bcopy(src->key_data, _KEYBUF(p), _KEYLEN(src)); 7886 7887 return m; 7888 } 7889 7890 /* 7891 * Take one of the kernel's lifetime data structures and convert it 7892 * into a PF_KEY structure within an mbuf, suitable for sending up to 7893 * a waiting application in user land. 7894 * 7895 * IN: 7896 * src: A pointer to a kernel lifetime structure. 7897 * exttype: Which type of lifetime this is. Refer to the PF_KEY 7898 * data structures for more information. 7899 * OUT: 7900 * a valid mbuf or NULL indicating an error 7901 * 7902 */ 7903 7904 static struct mbuf * 7905 key_setlifetime(struct seclifetime *src, u_int16_t exttype) 7906 { 7907 struct mbuf *m = NULL; 7908 struct sadb_lifetime *p; 7909 int len = PFKEY_ALIGN8(sizeof(struct sadb_lifetime)); 7910 7911 if (src == NULL) 7912 return NULL; 7913 7914 m = m_get2(len, M_NOWAIT, MT_DATA, 0); 7915 if (m == NULL) 7916 return m; 7917 m_align(m, len); 7918 m->m_len = len; 7919 p = mtod(m, struct sadb_lifetime *); 7920 7921 bzero(p, len); 7922 p->sadb_lifetime_len = PFKEY_UNIT64(len); 7923 p->sadb_lifetime_exttype = exttype; 7924 p->sadb_lifetime_allocations = src->allocations; 7925 p->sadb_lifetime_bytes = src->bytes; 7926 p->sadb_lifetime_addtime = src->addtime; 7927 p->sadb_lifetime_usetime = src->usetime; 7928 7929 return m; 7930 7931 } 7932