]> git.saurik.com Git - apple/xnu.git/blob - bsd/netkey/key.c
projects / apple / xnu.git / blob
? search:


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