1 /* $NetBSD: ipsec_output.c,v 1.8 2004/01/16 11:06:27 scw Exp $ */ 2 /* $FreeBSD: src/sys/netipsec/ipsec_output.c,v 1.3.2.1 2003/01/24 05:11:35 sam Exp $ */ 3 /* $KAME: ipsec.c,v 1.103 2001/05/24 07:14:18 sakane Exp $ */ 4 5 #include <sys/cdefs.h> 6 __KERNEL_RCSID(0, "$NetBSD: ipsec_output.c,v 1.8 2004/01/16 11:06:27 scw Exp $"); 7 8 /* 9 * IPsec output processing. 10 */ 11 #include "opt_inet.h" 12 #ifdef __FreeBSD__ 13 #include "opt_inet6.h" 14 #endif 15 #include "opt_ipsec.h" 16 17 #include <sys/param.h> 18 #include <sys/systm.h> 19 #include <sys/mbuf.h> 20 #include <sys/domain.h> 21 #include <sys/protosw.h> 22 #include <sys/socket.h> 23 #include <sys/errno.h> 24 #include <sys/syslog.h> 25 26 #include <net/if.h> 27 #include <net/route.h> 28 29 #include <netinet/in.h> 30 #include <netinet/in_systm.h> 31 #include <netinet/ip.h> 32 #include <netinet/ip_var.h> 33 #include <netinet/in_var.h> 34 #include <netinet/ip_ecn.h> 35 #ifdef INET6 36 #include <netinet6/ip6_ecn.h> 37 #endif 38 39 #include <netinet/ip6.h> 40 #ifdef INET6 41 #include <netinet6/ip6_var.h> 42 #endif 43 #include <netinet/in_pcb.h> 44 #ifdef INET6 45 #include <netinet/icmp6.h> 46 #endif 47 48 #include <netipsec/ipsec.h> 49 #ifdef INET6 50 #include <netipsec/ipsec6.h> 51 #endif 52 #include <netipsec/ah_var.h> 53 #include <netipsec/esp_var.h> 54 #include <netipsec/ipcomp_var.h> 55 56 #include <netipsec/xform.h> 57 58 #include <netipsec/key.h> 59 #include <netipsec/keydb.h> 60 #include <netipsec/key_debug.h> 61 #include <netipsec/ipsec_osdep.h> 62 63 int 64 ipsec_process_done(struct mbuf *m, struct ipsecrequest *isr) 65 { 66 struct tdb_ident *tdbi; 67 struct m_tag *mtag; 68 struct secasvar *sav; 69 struct secasindex *saidx; 70 int error; 71 72 IPSEC_SPLASSERT_SOFTNET("ipsec_process_done"); 73 74 IPSEC_ASSERT(m != NULL, ("ipsec_process_done: null mbuf")); 75 IPSEC_ASSERT(isr != NULL, ("ipsec_process_done: null ISR")); 76 sav = isr->sav; 77 IPSEC_ASSERT(sav != NULL, ("ipsec_process_done: null SA")); 78 IPSEC_ASSERT(sav->sah != NULL, ("ipsec_process_done: null SAH")); 79 80 saidx = &sav->sah->saidx; 81 switch (saidx->dst.sa.sa_family) { 82 #ifdef INET 83 case AF_INET: 84 /* Fix the header length, for AH processing. */ 85 mtod(m, struct ip *)->ip_len = htons(m->m_pkthdr.len); 86 break; 87 #endif /* INET */ 88 #ifdef INET6 89 case AF_INET6: 90 /* Fix the header length, for AH processing. */ 91 if (m->m_pkthdr.len < sizeof (struct ip6_hdr)) { 92 error = ENXIO; 93 goto bad; 94 } 95 if (m->m_pkthdr.len - sizeof (struct ip6_hdr) > IPV6_MAXPACKET) { 96 /* No jumbogram support. */ 97 error = ENXIO; /*?*/ 98 goto bad; 99 } 100 mtod(m, struct ip6_hdr *)->ip6_plen = 101 htons(m->m_pkthdr.len - sizeof(struct ip6_hdr)); 102 break; 103 #endif /* INET6 */ 104 default: 105 DPRINTF(("ipsec_process_done: unknown protocol family %u\n", 106 saidx->dst.sa.sa_family)); 107 error = ENXIO; 108 goto bad; 109 } 110 111 /* 112 * Add a record of what we've done or what needs to be done to the 113 * packet. 114 */ 115 mtag = m_tag_get(PACKET_TAG_IPSEC_OUT_DONE, 116 sizeof(struct tdb_ident), M_NOWAIT); 117 if (mtag == NULL) { 118 DPRINTF(("ipsec_process_done: could not get packet tag\n")); 119 error = ENOMEM; 120 goto bad; 121 } 122 123 tdbi = (struct tdb_ident *)(mtag + 1); 124 tdbi->dst = saidx->dst; 125 tdbi->proto = saidx->proto; 126 tdbi->spi = sav->spi; 127 m_tag_prepend(m, mtag); 128 129 /* 130 * If there's another (bundled) SA to apply, do so. 131 * Note that this puts a burden on the kernel stack size. 132 * If this is a problem we'll need to introduce a queue 133 * to set the packet on so we can unwind the stack before 134 * doing further processing. 135 */ 136 if (isr->next) { 137 newipsecstat.ips_out_bundlesa++; 138 return ipsec4_process_packet(m, isr->next, 0, 0); 139 } 140 141 /* 142 * We're done with IPsec processing, transmit the packet using the 143 * appropriate network protocol (IP or IPv6). SPD lookup will be 144 * performed again there. 145 */ 146 switch (saidx->dst.sa.sa_family) { 147 #ifdef INET 148 struct ip *ip; 149 case AF_INET: 150 ip = mtod(m, struct ip *); 151 #ifdef __FreeBSD__ 152 /* FreeBSD ip_output() expects ip_len, ip_off in host endian */ 153 ip->ip_len = ntohs(ip->ip_len); 154 ip->ip_off = ntohs(ip->ip_off); 155 #endif /* __FreeBSD_ */ 156 return ip_output(m, NULL, NULL, IP_RAWOUTPUT, 157 (struct ip_moptions *)NULL, (struct socket *)NULL); 158 159 #endif /* INET */ 160 #ifdef INET6 161 case AF_INET6: 162 /* 163 * We don't need massage, IPv6 header fields are always in 164 * net endian. 165 */ 166 return ip6_output(m, NULL, NULL, 0, NULL, NULL, NULL); 167 #endif /* INET6 */ 168 } 169 panic("ipsec_process_done"); 170 bad: 171 m_freem(m); 172 KEY_FREESAV(&sav); 173 return (error); 174 } 175 176 static struct ipsecrequest * 177 ipsec_nextisr( 178 struct mbuf *m, 179 struct ipsecrequest *isr, 180 int af, 181 struct secasindex *saidx, 182 int *error 183 ) 184 { 185 #define IPSEC_OSTAT(x,y,z) (isr->saidx.proto == IPPROTO_ESP ? (x)++ : \ 186 isr->saidx.proto == IPPROTO_AH ? (y)++ : (z)++) 187 struct secasvar *sav; 188 189 IPSEC_SPLASSERT_SOFTNET("ipsec_nextisr"); 190 IPSEC_ASSERT(af == AF_INET || af == AF_INET6, 191 ("ipsec_nextisr: invalid address family %u", af)); 192 again: 193 /* 194 * Craft SA index to search for proper SA. Note that 195 * we only fillin unspecified SA peers for transport 196 * mode; for tunnel mode they must already be filled in. 197 */ 198 *saidx = isr->saidx; 199 if (isr->saidx.mode == IPSEC_MODE_TRANSPORT) { 200 /* Fillin unspecified SA peers only for transport mode */ 201 if (af == AF_INET) { 202 struct sockaddr_in *sin; 203 struct ip *ip = mtod(m, struct ip *); 204 205 if (saidx->src.sa.sa_len == 0) { 206 sin = &saidx->src.sin; 207 sin->sin_len = sizeof(*sin); 208 sin->sin_family = AF_INET; 209 sin->sin_port = IPSEC_PORT_ANY; 210 sin->sin_addr = ip->ip_src; 211 } 212 if (saidx->dst.sa.sa_len == 0) { 213 sin = &saidx->dst.sin; 214 sin->sin_len = sizeof(*sin); 215 sin->sin_family = AF_INET; 216 sin->sin_port = IPSEC_PORT_ANY; 217 sin->sin_addr = ip->ip_dst; 218 } 219 } else { 220 struct sockaddr_in6 *sin6; 221 struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *); 222 223 if (saidx->src.sin6.sin6_len == 0) { 224 sin6 = (struct sockaddr_in6 *)&saidx->src; 225 sin6->sin6_len = sizeof(*sin6); 226 sin6->sin6_family = AF_INET6; 227 sin6->sin6_port = IPSEC_PORT_ANY; 228 sin6->sin6_addr = ip6->ip6_src; 229 if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_src)) { 230 /* fix scope id for comparing SPD */ 231 sin6->sin6_addr.s6_addr16[1] = 0; 232 sin6->sin6_scope_id = 233 ntohs(ip6->ip6_src.s6_addr16[1]); 234 } 235 } 236 if (saidx->dst.sin6.sin6_len == 0) { 237 sin6 = (struct sockaddr_in6 *)&saidx->dst; 238 sin6->sin6_len = sizeof(*sin6); 239 sin6->sin6_family = AF_INET6; 240 sin6->sin6_port = IPSEC_PORT_ANY; 241 sin6->sin6_addr = ip6->ip6_dst; 242 if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst)) { 243 /* fix scope id for comparing SPD */ 244 sin6->sin6_addr.s6_addr16[1] = 0; 245 sin6->sin6_scope_id = 246 ntohs(ip6->ip6_dst.s6_addr16[1]); 247 } 248 } 249 } 250 } 251 252 /* 253 * Lookup SA and validate it. 254 */ 255 *error = key_checkrequest(isr, saidx); 256 if (*error != 0) { 257 /* 258 * IPsec processing is required, but no SA found. 259 * I assume that key_acquire() had been called 260 * to get/establish the SA. Here I discard 261 * this packet because it is responsibility for 262 * upper layer to retransmit the packet. 263 */ 264 newipsecstat.ips_out_nosa++; 265 goto bad; 266 } 267 sav = isr->sav; 268 if (sav == NULL) { /* XXX valid return */ 269 IPSEC_ASSERT(ipsec_get_reqlevel(isr) == IPSEC_LEVEL_USE, 270 ("ipsec_nextisr: no SA found, but required; level %u", 271 ipsec_get_reqlevel(isr))); 272 isr = isr->next; 273 if (isr == NULL) { 274 /*XXXstatistic??*/ 275 *error = EINVAL; /*XXX*/ 276 return isr; 277 } 278 goto again; 279 } 280 281 /* 282 * Check system global policy controls. 283 */ 284 if ((isr->saidx.proto == IPPROTO_ESP && !esp_enable) || 285 (isr->saidx.proto == IPPROTO_AH && !ah_enable) || 286 (isr->saidx.proto == IPPROTO_IPCOMP && !ipcomp_enable)) { 287 DPRINTF(("ipsec_nextisr: IPsec outbound packet dropped due" 288 " to policy (check your sysctls)\n")); 289 IPSEC_OSTAT(espstat.esps_pdrops, ahstat.ahs_pdrops, 290 ipcompstat.ipcomps_pdrops); 291 *error = EHOSTUNREACH; 292 goto bad; 293 } 294 295 /* 296 * Sanity check the SA contents for the caller 297 * before they invoke the xform output method. 298 */ 299 if (sav->tdb_xform == NULL) { 300 DPRINTF(("ipsec_nextisr: no transform for SA\n")); 301 IPSEC_OSTAT(espstat.esps_noxform, ahstat.ahs_noxform, 302 ipcompstat.ipcomps_noxform); 303 *error = EHOSTUNREACH; 304 goto bad; 305 } 306 return isr; 307 bad: 308 IPSEC_ASSERT(*error != 0, ("ipsec_nextisr: error return w/ no error code")); 309 return NULL; 310 #undef IPSEC_OSTAT 311 } 312 313 #ifdef INET 314 /* 315 * IPsec output logic for IPv4. 316 */ 317 int 318 ipsec4_process_packet( 319 struct mbuf *m, 320 struct ipsecrequest *isr, 321 int flags, 322 int tunalready) 323 { 324 struct secasindex saidx; 325 struct secasvar *sav; 326 struct ip *ip; 327 int s, error, i, off; 328 329 IPSEC_ASSERT(m != NULL, ("ipsec4_process_packet: null mbuf")); 330 IPSEC_ASSERT(isr != NULL, ("ipsec4_process_packet: null isr")); 331 332 s = splsoftnet(); /* insure SA contents don't change */ 333 334 isr = ipsec_nextisr(m, isr, AF_INET, &saidx, &error); 335 if (isr == NULL) 336 goto bad; 337 338 sav = isr->sav; 339 if (!tunalready) { 340 union sockaddr_union *dst = &sav->sah->saidx.dst; 341 int setdf; 342 343 /* 344 * Collect IP_DF state from the outer header. 345 */ 346 if (dst->sa.sa_family == AF_INET) { 347 if (m->m_len < sizeof (struct ip) && 348 (m = m_pullup(m, sizeof (struct ip))) == NULL) { 349 error = ENOBUFS; 350 goto bad; 351 } 352 ip = mtod(m, struct ip *); 353 /* Honor system-wide control of how to handle IP_DF */ 354 switch (ip4_ipsec_dfbit) { 355 case 0: /* clear in outer header */ 356 case 1: /* set in outer header */ 357 setdf = ip4_ipsec_dfbit; 358 break; 359 default: /* propagate to outer header */ 360 setdf = ip->ip_off; 361 #ifndef __FreeBSD__ 362 /* On FreeBSD, ip_off and ip_len assumed in host endian. */ 363 setdf = ntohs(setdf); 364 #endif 365 setdf = htons(setdf & IP_DF); 366 break; 367 } 368 } else { 369 ip = NULL; /* keep compiler happy */ 370 setdf = 0; 371 } 372 /* Do the appropriate encapsulation, if necessary */ 373 if (isr->saidx.mode == IPSEC_MODE_TUNNEL || /* Tunnel requ'd */ 374 dst->sa.sa_family != AF_INET || /* PF mismatch */ 375 #if 0 376 (sav->flags & SADB_X_SAFLAGS_TUNNEL) || /* Tunnel requ'd */ 377 sav->tdb_xform->xf_type == XF_IP4 || /* ditto */ 378 #endif 379 (dst->sa.sa_family == AF_INET && /* Proxy */ 380 dst->sin.sin_addr.s_addr != INADDR_ANY && 381 dst->sin.sin_addr.s_addr != ip->ip_dst.s_addr)) { 382 struct mbuf *mp; 383 384 /* Fix IPv4 header checksum and length */ 385 if (m->m_len < sizeof (struct ip) && 386 (m = m_pullup(m, sizeof (struct ip))) == NULL) { 387 error = ENOBUFS; 388 goto bad; 389 } 390 ip = mtod(m, struct ip *); 391 ip->ip_len = htons(m->m_pkthdr.len); 392 ip->ip_sum = 0; 393 #ifdef _IP_VHL 394 if (ip->ip_vhl == IP_VHL_BORING) 395 ip->ip_sum = in_cksum_hdr(ip); 396 else 397 ip->ip_sum = in_cksum(m, 398 _IP_VHL_HL(ip->ip_vhl) << 2); 399 #else 400 ip->ip_sum = in_cksum(m, ip->ip_hl << 2); 401 #endif 402 403 /* Encapsulate the packet */ 404 error = ipip_output(m, isr, &mp, 0, 0); 405 if (mp == NULL && !error) { 406 /* Should never happen. */ 407 DPRINTF(("ipsec4_process_packet: ipip_output " 408 "returns no mbuf and no error!")); 409 error = EFAULT; 410 } 411 if (error) { 412 if (mp) { 413 /* XXX: Should never happen! */ 414 m_freem(mp); 415 } 416 m = NULL; /* ipip_output() already freed it */ 417 goto bad; 418 } 419 m = mp, mp = NULL; 420 /* 421 * ipip_output clears IP_DF in the new header. If 422 * we need to propagate IP_DF from the outer header, 423 * then we have to do it here. 424 * 425 * XXX shouldn't assume what ipip_output does. 426 */ 427 if (dst->sa.sa_family == AF_INET && setdf) { 428 if (m->m_len < sizeof (struct ip) && 429 (m = m_pullup(m, sizeof (struct ip))) == NULL) { 430 error = ENOBUFS; 431 goto bad; 432 } 433 ip = mtod(m, struct ip *); 434 ip->ip_off = ntohs(ip->ip_off); 435 ip->ip_off |= IP_DF; 436 ip->ip_off = htons(ip->ip_off); 437 } 438 } 439 } 440 441 /* 442 * Dispatch to the appropriate IPsec transform logic. The 443 * packet will be returned for transmission after crypto 444 * processing, etc. are completed. For encapsulation we 445 * bypass this call because of the explicit call done above 446 * (necessary to deal with IP_DF handling for IPv4). 447 * 448 * NB: m & sav are ``passed to caller'' who's reponsible for 449 * for reclaiming their resources. 450 */ 451 if (sav->tdb_xform->xf_type != XF_IP4) { 452 ip = mtod(m, struct ip *); 453 i = ip->ip_hl << 2; 454 off = offsetof(struct ip, ip_p); 455 error = (*sav->tdb_xform->xf_output)(m, isr, NULL, i, off); 456 } else { 457 error = ipsec_process_done(m, isr); 458 } 459 splx(s); 460 return error; 461 bad: 462 splx(s); 463 if (m) 464 m_freem(m); 465 return error; 466 } 467 #endif 468 469 #ifdef INET6 470 /* 471 * Chop IP6 header from the payload. 472 */ 473 static struct mbuf * 474 ipsec6_splithdr(struct mbuf *m) 475 { 476 struct mbuf *mh; 477 struct ip6_hdr *ip6; 478 int hlen; 479 480 IPSEC_ASSERT(m->m_len >= sizeof (struct ip6_hdr), 481 ("ipsec6_splithdr: first mbuf too short, len %u", m->m_len)); 482 ip6 = mtod(m, struct ip6_hdr *); 483 hlen = sizeof(struct ip6_hdr); 484 if (m->m_len > hlen) { 485 MGETHDR(mh, M_DONTWAIT, MT_HEADER); 486 if (!mh) { 487 m_freem(m); 488 return NULL; 489 } 490 M_MOVE_PKTHDR(mh, m); 491 MH_ALIGN(mh, hlen); 492 m->m_len -= hlen; 493 m->m_data += hlen; 494 mh->m_next = m; 495 m = mh; 496 m->m_len = hlen; 497 bcopy((caddr_t)ip6, mtod(m, caddr_t), hlen); 498 } else if (m->m_len < hlen) { 499 m = m_pullup(m, hlen); 500 if (!m) 501 return NULL; 502 } 503 return m; 504 } 505 506 /* 507 * IPsec output logic for IPv6, transport mode. 508 */ 509 int 510 ipsec6_output_trans( 511 struct ipsec_output_state *state, 512 u_char *nexthdrp, 513 struct mbuf *mprev, 514 struct secpolicy *sp, 515 int flags, 516 int *tun) 517 { 518 struct ipsecrequest *isr; 519 struct secasindex saidx; 520 int error = 0; 521 struct mbuf *m; 522 523 IPSEC_ASSERT(state != NULL, ("ipsec6_output: null state")); 524 IPSEC_ASSERT(state->m != NULL, ("ipsec6_output: null m")); 525 IPSEC_ASSERT(nexthdrp != NULL, ("ipsec6_output: null nexthdrp")); 526 IPSEC_ASSERT(mprev != NULL, ("ipsec6_output: null mprev")); 527 IPSEC_ASSERT(sp != NULL, ("ipsec6_output: null sp")); 528 IPSEC_ASSERT(tun != NULL, ("ipsec6_output: null tun")); 529 530 KEYDEBUG(KEYDEBUG_IPSEC_DATA, 531 printf("ipsec6_output_trans: applyed SP\n"); 532 kdebug_secpolicy(sp)); 533 534 isr = sp->req; 535 if (isr->saidx.mode == IPSEC_MODE_TUNNEL) { 536 /* the rest will be handled by ipsec6_output_tunnel() */ 537 *tun = 1; /* need tunnel-mode processing */ 538 return 0; 539 } 540 541 *tun = 0; 542 m = state->m; 543 544 isr = ipsec_nextisr(m, isr, AF_INET6, &saidx, &error); 545 if (isr == NULL) { 546 #ifdef notdef 547 /* XXX should notification be done for all errors ? */ 548 /* 549 * Notify the fact that the packet is discarded 550 * to ourselves. I believe this is better than 551 * just silently discarding. (jinmei@kame.net) 552 * XXX: should we restrict the error to TCP packets? 553 * XXX: should we directly notify sockets via 554 * pfctlinputs? 555 */ 556 icmp6_error(m, ICMP6_DST_UNREACH, 557 ICMP6_DST_UNREACH_ADMIN, 0); 558 m = NULL; /* NB: icmp6_error frees mbuf */ 559 #endif 560 goto bad; 561 } 562 563 return (*isr->sav->tdb_xform->xf_output)(m, isr, NULL, 564 sizeof (struct ip6_hdr), 565 offsetof(struct ip6_hdr, ip6_nxt)); 566 bad: 567 if (m) 568 m_freem(m); 569 state->m = NULL; 570 return error; 571 } 572 573 static int 574 ipsec6_encapsulate(struct mbuf *m, struct secasvar *sav) 575 { 576 struct ip6_hdr *oip6; 577 struct ip6_hdr *ip6; 578 size_t plen; 579 580 /* can't tunnel between different AFs */ 581 if (sav->sah->saidx.src.sa.sa_family != AF_INET6 || 582 sav->sah->saidx.dst.sa.sa_family != AF_INET6) { 583 m_freem(m); 584 return EINVAL; 585 } 586 IPSEC_ASSERT(m->m_len != sizeof (struct ip6_hdr), 587 ("ipsec6_encapsulate: mbuf wrong size; len %u", m->m_len)); 588 589 590 /* 591 * grow the mbuf to accomodate the new IPv6 header. 592 */ 593 plen = m->m_pkthdr.len; 594 if (M_LEADINGSPACE(m->m_next) < sizeof(struct ip6_hdr)) { 595 struct mbuf *n; 596 MGET(n, M_DONTWAIT, MT_DATA); 597 if (!n) { 598 m_freem(m); 599 return ENOBUFS; 600 } 601 n->m_len = sizeof(struct ip6_hdr); 602 n->m_next = m->m_next; 603 m->m_next = n; 604 m->m_pkthdr.len += sizeof(struct ip6_hdr); 605 oip6 = mtod(n, struct ip6_hdr *); 606 } else { 607 m->m_next->m_len += sizeof(struct ip6_hdr); 608 m->m_next->m_data -= sizeof(struct ip6_hdr); 609 m->m_pkthdr.len += sizeof(struct ip6_hdr); 610 oip6 = mtod(m->m_next, struct ip6_hdr *); 611 } 612 ip6 = mtod(m, struct ip6_hdr *); 613 ovbcopy((caddr_t)ip6, (caddr_t)oip6, sizeof(struct ip6_hdr)); 614 615 /* Fake link-local scope-class addresses */ 616 if (IN6_IS_SCOPE_LINKLOCAL(&oip6->ip6_src)) 617 oip6->ip6_src.s6_addr16[1] = 0; 618 if (IN6_IS_SCOPE_LINKLOCAL(&oip6->ip6_dst)) 619 oip6->ip6_dst.s6_addr16[1] = 0; 620 621 /* construct new IPv6 header. see RFC 2401 5.1.2.2 */ 622 /* ECN consideration. */ 623 ip6_ecn_ingress(ip6_ipsec_ecn, &ip6->ip6_flow, &oip6->ip6_flow); 624 if (plen < IPV6_MAXPACKET - sizeof(struct ip6_hdr)) 625 ip6->ip6_plen = htons(plen); 626 else { 627 /* ip6->ip6_plen will be updated in ip6_output() */ 628 } 629 ip6->ip6_nxt = IPPROTO_IPV6; 630 sav->sah->saidx.src.sin6.sin6_addr = ip6->ip6_src; 631 sav->sah->saidx.dst.sin6.sin6_addr = ip6->ip6_dst; 632 ip6->ip6_hlim = IPV6_DEFHLIM; 633 634 /* XXX Should ip6_src be updated later ? */ 635 636 return 0; 637 } 638 639 /* 640 * IPsec output logic for IPv6, tunnel mode. 641 */ 642 int 643 ipsec6_output_tunnel(struct ipsec_output_state *state, struct secpolicy *sp, int flags) 644 { 645 struct ip6_hdr *ip6; 646 struct ipsecrequest *isr; 647 struct secasindex saidx; 648 int error; 649 struct sockaddr_in6* dst6; 650 struct mbuf *m; 651 652 IPSEC_ASSERT(state != NULL, ("ipsec6_output: null state")); 653 IPSEC_ASSERT(state->m != NULL, ("ipsec6_output: null m")); 654 IPSEC_ASSERT(sp != NULL, ("ipsec6_output: null sp")); 655 656 KEYDEBUG(KEYDEBUG_IPSEC_DATA, 657 printf("ipsec6_output_tunnel: applyed SP\n"); 658 kdebug_secpolicy(sp)); 659 660 m = state->m; 661 /* 662 * transport mode ipsec (before the 1st tunnel mode) is already 663 * processed by ipsec6_output_trans(). 664 */ 665 for (isr = sp->req; isr; isr = isr->next) { 666 if (isr->saidx.mode == IPSEC_MODE_TUNNEL) 667 break; 668 } 669 isr = ipsec_nextisr(m, isr, AF_INET6, &saidx, &error); 670 if (isr == NULL) 671 goto bad; 672 673 /* 674 * There may be the case that SA status will be changed when 675 * we are refering to one. So calling splsoftnet(). 676 */ 677 if (isr->saidx.mode == IPSEC_MODE_TUNNEL) { 678 /* 679 * build IPsec tunnel. 680 */ 681 /* XXX should be processed with other familiy */ 682 if (isr->sav->sah->saidx.src.sa.sa_family != AF_INET6) { 683 ipseclog((LOG_ERR, "ipsec6_output_tunnel: " 684 "family mismatched between inner and outer, spi=%lu\n", 685 ntohl(isr->sav->spi))); 686 newipsecstat.ips_out_inval++; 687 error = EAFNOSUPPORT; 688 goto bad; 689 } 690 691 m = ipsec6_splithdr(m); 692 if (!m) { 693 newipsecstat.ips_out_nomem++; 694 error = ENOMEM; 695 goto bad; 696 } 697 error = ipsec6_encapsulate(m, isr->sav); 698 if (error) { 699 m = NULL; 700 goto bad; 701 } 702 ip6 = mtod(m, struct ip6_hdr *); 703 704 state->ro = &isr->sav->sah->sa_route; 705 state->dst = (struct sockaddr *)&state->ro->ro_dst; 706 dst6 = (struct sockaddr_in6 *)state->dst; 707 if (state->ro->ro_rt 708 && ((state->ro->ro_rt->rt_flags & RTF_UP) == 0 709 || !IN6_ARE_ADDR_EQUAL(&dst6->sin6_addr, &ip6->ip6_dst))) { 710 RTFREE(state->ro->ro_rt); 711 state->ro->ro_rt = NULL; 712 } 713 if (state->ro->ro_rt == 0) { 714 bzero(dst6, sizeof(*dst6)); 715 dst6->sin6_family = AF_INET6; 716 dst6->sin6_len = sizeof(*dst6); 717 dst6->sin6_addr = ip6->ip6_dst; 718 rtalloc(state->ro); 719 } 720 if (state->ro->ro_rt == 0) { 721 ip6stat.ip6s_noroute++; 722 newipsecstat.ips_out_noroute++; 723 error = EHOSTUNREACH; 724 goto bad; 725 } 726 727 /* adjust state->dst if tunnel endpoint is offlink */ 728 if (state->ro->ro_rt->rt_flags & RTF_GATEWAY) { 729 state->dst = (struct sockaddr *)state->ro->ro_rt->rt_gateway; 730 dst6 = (struct sockaddr_in6 *)state->dst; 731 } 732 } 733 734 m = ipsec6_splithdr(m); 735 if (!m) { 736 newipsecstat.ips_out_nomem++; 737 error = ENOMEM; 738 goto bad; 739 } 740 ip6 = mtod(m, struct ip6_hdr *); 741 return (*isr->sav->tdb_xform->xf_output)(m, isr, NULL, 742 sizeof (struct ip6_hdr), 743 offsetof(struct ip6_hdr, ip6_nxt)); 744 bad: 745 if (m) 746 m_freem(m); 747 state->m = NULL; 748 return error; 749 } 750 #endif /*INET6*/ 751