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