/*
- * Copyright (c) 2008-2013 Apple Inc. All rights reserved.
+ * Copyright (c) 2008-2014 Apple Inc. All rights reserved.
*
* @APPLE_OSREFERENCE_LICENSE_HEADER_START@
*
#include <net/if.h>
#include <net/route.h>
+#include <net/if_ipsec.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
static void ipsec_delpcbpolicy(struct inpcbpolicy *);
static struct secpolicy *ipsec_deepcopy_policy(struct secpolicy *src);
static int ipsec_set_policy(struct secpolicy **pcb_sp,
- int optname, caddr_t request, size_t len, int priv);
-static int ipsec_get_policy(struct secpolicy *pcb_sp, struct mbuf **mp);
+ int optname, caddr_t request, size_t len, int priv);
static void vshiftl(unsigned char *, int, int);
static int ipsec_in_reject(struct secpolicy *, struct mbuf *);
#if INET6
static struct ipsec_tag *ipsec_findaux(struct mbuf *);
static void ipsec_optaux(struct mbuf *, struct ipsec_tag *);
int ipsec_send_natt_keepalive(struct secasvar *sav);
+bool ipsec_fill_offload_frame(ifnet_t ifp, struct secasvar *sav, struct ipsec_offload_frame *frame, size_t frame_data_offset);
static int
sysctl_def_policy SYSCTL_HANDLER_ARGS
* NOTE: IPv6 mapped adddress concern is implemented here.
*/
struct secpolicy *
-ipsec4_getpolicybysock(m, dir, so, error)
- struct mbuf *m;
- u_int dir;
- struct socket *so;
- int *error;
+ipsec4_getpolicybysock(struct mbuf *m,
+ u_int dir,
+ struct socket *so,
+ int *error)
{
struct inpcbpolicy *pcbsp = NULL;
struct secpolicy *currsp = NULL; /* policy on socket */
struct secpolicy *kernsp = NULL; /* policy on kernel */
-
+
lck_mtx_assert(sadb_mutex, LCK_MTX_ASSERT_NOTOWNED);
/* sanity check */
if (m == NULL || so == NULL || error == NULL)
panic("ipsec4_getpolicybysock: NULL pointer was passed.\n");
-
- if (so->so_pcb == NULL) {
- printf("ipsec4_getpolicybysock: so->so_pcb == NULL\n");
- return ipsec4_getpolicybyaddr(m, dir, 0, error);
- }
+
+ if (so->so_pcb == NULL) {
+ printf("ipsec4_getpolicybysock: so->so_pcb == NULL\n");
+ return ipsec4_getpolicybyaddr(m, dir, 0, error);
+ }
switch (SOCK_DOM(so)) {
- case PF_INET:
- pcbsp = sotoinpcb(so)->inp_sp;
- break;
+ case PF_INET:
+ pcbsp = sotoinpcb(so)->inp_sp;
+ break;
#if INET6
- case PF_INET6:
- pcbsp = sotoin6pcb(so)->in6p_sp;
- break;
+ case PF_INET6:
+ pcbsp = sotoin6pcb(so)->in6p_sp;
+ break;
#endif
}
/* Socket has not specified an IPSEC policy */
return ipsec4_getpolicybyaddr(m, dir, 0, error);
}
-
+
KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_START, 0,0,0,0,0);
-
+
switch (SOCK_DOM(so)) {
- case PF_INET:
- /* set spidx in pcb */
- *error = ipsec4_setspidx_inpcb(m, sotoinpcb(so));
- break;
+ case PF_INET:
+ /* set spidx in pcb */
+ *error = ipsec4_setspidx_inpcb(m, sotoinpcb(so));
+ break;
#if INET6
- case PF_INET6:
- /* set spidx in pcb */
- *error = ipsec6_setspidx_in6pcb(m, sotoin6pcb(so));
- break;
+ case PF_INET6:
+ /* set spidx in pcb */
+ *error = ipsec6_setspidx_in6pcb(m, sotoin6pcb(so));
+ break;
#endif
- default:
- panic("ipsec4_getpolicybysock: unsupported address family\n");
+ default:
+ panic("ipsec4_getpolicybysock: unsupported address family\n");
}
if (*error) {
KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 1,*error,0,0,0);
return NULL;
}
-
+
/* sanity check */
if (pcbsp == NULL)
panic("ipsec4_getpolicybysock: pcbsp is NULL.\n");
-
- switch (dir) {
- case IPSEC_DIR_INBOUND:
- currsp = pcbsp->sp_in;
- break;
- case IPSEC_DIR_OUTBOUND:
- currsp = pcbsp->sp_out;
- break;
- default:
- panic("ipsec4_getpolicybysock: illegal direction.\n");
- }
-
+
+ switch (dir) {
+ case IPSEC_DIR_INBOUND:
+ currsp = pcbsp->sp_in;
+ break;
+ case IPSEC_DIR_OUTBOUND:
+ currsp = pcbsp->sp_out;
+ break;
+ default:
+ panic("ipsec4_getpolicybysock: illegal direction.\n");
+ }
+
/* sanity check */
if (currsp == NULL)
panic("ipsec4_getpolicybysock: currsp is NULL.\n");
-
+
/* when privilieged socket */
- if (pcbsp->priv) {
- switch (currsp->policy) {
+ if (pcbsp->priv) {
+ switch (currsp->policy) {
+ case IPSEC_POLICY_BYPASS:
+ lck_mtx_lock(sadb_mutex);
+ currsp->refcnt++;
+ lck_mtx_unlock(sadb_mutex);
+ *error = 0;
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 2,*error,0,0,0);
+ return currsp;
+
+ case IPSEC_POLICY_ENTRUST:
+ /* look for a policy in SPD */
+ kernsp = key_allocsp(&currsp->spidx, dir);
+
+ /* SP found */
+ if (kernsp != NULL) {
+ KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
+ printf("DP ipsec4_getpolicybysock called "
+ "to allocate SP:0x%llx\n",
+ (uint64_t)VM_KERNEL_ADDRPERM(kernsp)));
+ *error = 0;
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 3,*error,0,0,0);
+ return kernsp;
+ }
+
+ /* no SP found */
+ lck_mtx_lock(sadb_mutex);
+ if (ip4_def_policy.policy != IPSEC_POLICY_DISCARD
+ && ip4_def_policy.policy != IPSEC_POLICY_NONE) {
+ ipseclog((LOG_INFO,
+ "fixed system default policy: %d->%d\n",
+ ip4_def_policy.policy, IPSEC_POLICY_NONE));
+ ip4_def_policy.policy = IPSEC_POLICY_NONE;
+ }
+ ip4_def_policy.refcnt++;
+ lck_mtx_unlock(sadb_mutex);
+ *error = 0;
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 4,*error,0,0,0);
+ return &ip4_def_policy;
+
+ case IPSEC_POLICY_IPSEC:
+ lck_mtx_lock(sadb_mutex);
+ currsp->refcnt++;
+ lck_mtx_unlock(sadb_mutex);
+ *error = 0;
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 5,*error,0,0,0);
+ return currsp;
+
+ default:
+ ipseclog((LOG_ERR, "ipsec4_getpolicybysock: "
+ "Invalid policy for PCB %d\n", currsp->policy));
+ *error = EINVAL;
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 6,*error,0,0,0);
+ return NULL;
+ }
+ /* NOTREACHED */
+ }
+
+ /* when non-privilieged socket */
+ /* look for a policy in SPD */
+ kernsp = key_allocsp(&currsp->spidx, dir);
+
+ /* SP found */
+ if (kernsp != NULL) {
+ KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
+ printf("DP ipsec4_getpolicybysock called "
+ "to allocate SP:0x%llx\n",
+ (uint64_t)VM_KERNEL_ADDRPERM(kernsp)));
+ *error = 0;
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 7,*error,0,0,0);
+ return kernsp;
+ }
+
+ /* no SP found */
+ switch (currsp->policy) {
case IPSEC_POLICY_BYPASS:
- lck_mtx_lock(sadb_mutex);
- currsp->refcnt++;
- lck_mtx_unlock(sadb_mutex);
- *error = 0;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 2,*error,0,0,0);
- return currsp;
-
+ ipseclog((LOG_ERR, "ipsec4_getpolicybysock: "
+ "Illegal policy for non-priviliged defined %d\n",
+ currsp->policy));
+ *error = EINVAL;
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 8,*error,0,0,0);
+ return NULL;
+
case IPSEC_POLICY_ENTRUST:
- /* look for a policy in SPD */
- kernsp = key_allocsp(&currsp->spidx, dir);
-
- /* SP found */
- if (kernsp != NULL) {
- KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
- printf("DP ipsec4_getpolicybysock called "
- "to allocate SP:0x%llx\n",
- (uint64_t)VM_KERNEL_ADDRPERM(kernsp)));
- *error = 0;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 3,*error,0,0,0);
- return kernsp;
- }
-
- /* no SP found */
lck_mtx_lock(sadb_mutex);
if (ip4_def_policy.policy != IPSEC_POLICY_DISCARD
- && ip4_def_policy.policy != IPSEC_POLICY_NONE) {
+ && ip4_def_policy.policy != IPSEC_POLICY_NONE) {
ipseclog((LOG_INFO,
- "fixed system default policy: %d->%d\n",
- ip4_def_policy.policy, IPSEC_POLICY_NONE));
+ "fixed system default policy: %d->%d\n",
+ ip4_def_policy.policy, IPSEC_POLICY_NONE));
ip4_def_policy.policy = IPSEC_POLICY_NONE;
}
ip4_def_policy.refcnt++;
lck_mtx_unlock(sadb_mutex);
*error = 0;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 4,*error,0,0,0);
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 9,*error,0,0,0);
return &ip4_def_policy;
case IPSEC_POLICY_IPSEC:
currsp->refcnt++;
lck_mtx_unlock(sadb_mutex);
*error = 0;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 5,*error,0,0,0);
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 10,*error,0,0,0);
return currsp;
-
+
default:
ipseclog((LOG_ERR, "ipsec4_getpolicybysock: "
- "Invalid policy for PCB %d\n", currsp->policy));
+ "Invalid policy for PCB %d\n", currsp->policy));
*error = EINVAL;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 6,*error,0,0,0);
+ KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 11,*error,0,0,0);
return NULL;
- }
- /* NOTREACHED */
- }
-
- /* when non-privilieged socket */
- /* look for a policy in SPD */
- kernsp = key_allocsp(&currsp->spidx, dir);
-
- /* SP found */
- if (kernsp != NULL) {
- KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
- printf("DP ipsec4_getpolicybysock called "
- "to allocate SP:0x%llx\n",
- (uint64_t)VM_KERNEL_ADDRPERM(kernsp)));
- *error = 0;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 7,*error,0,0,0);
- return kernsp;
- }
-
- /* no SP found */
- switch (currsp->policy) {
- case IPSEC_POLICY_BYPASS:
- ipseclog((LOG_ERR, "ipsec4_getpolicybysock: "
- "Illegal policy for non-priviliged defined %d\n",
- currsp->policy));
- *error = EINVAL;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 8,*error,0,0,0);
- return NULL;
-
- case IPSEC_POLICY_ENTRUST:
- lck_mtx_lock(sadb_mutex);
- if (ip4_def_policy.policy != IPSEC_POLICY_DISCARD
- && ip4_def_policy.policy != IPSEC_POLICY_NONE) {
- ipseclog((LOG_INFO,
- "fixed system default policy: %d->%d\n",
- ip4_def_policy.policy, IPSEC_POLICY_NONE));
- ip4_def_policy.policy = IPSEC_POLICY_NONE;
- }
- ip4_def_policy.refcnt++;
- lck_mtx_unlock(sadb_mutex);
- *error = 0;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 9,*error,0,0,0);
- return &ip4_def_policy;
-
- case IPSEC_POLICY_IPSEC:
- lck_mtx_lock(sadb_mutex);
- currsp->refcnt++;
- lck_mtx_unlock(sadb_mutex);
- *error = 0;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 10,*error,0,0,0);
- return currsp;
-
- default:
- ipseclog((LOG_ERR, "ipsec4_getpolicybysock: "
- "Invalid policy for PCB %d\n", currsp->policy));
- *error = EINVAL;
- KERNEL_DEBUG(DBG_FNC_GETPOL_SOCK | DBG_FUNC_END, 11,*error,0,0,0);
- return NULL;
}
/* NOTREACHED */
}
* others: a pointer to SP
*/
struct secpolicy *
-ipsec6_getpolicybysock(m, dir, so, error)
- struct mbuf *m;
- u_int dir;
- struct socket *so;
- int *error;
+ipsec6_getpolicybysock(struct mbuf *m,
+ u_int dir,
+ struct socket *so,
+ int *error)
{
struct inpcbpolicy *pcbsp = NULL;
struct secpolicy *currsp = NULL; /* policy on socket */
struct secpolicy *kernsp = NULL; /* policy on kernel */
-
+
lck_mtx_assert(sadb_mutex, LCK_MTX_ASSERT_NOTOWNED);
/* sanity check */
if (m == NULL || so == NULL || error == NULL)
panic("ipsec6_getpolicybysock: NULL pointer was passed.\n");
-
+
#if DIAGNOSTIC
- if (SOCK_DOM(so) != PF_INET6)
- panic("ipsec6_getpolicybysock: socket domain != inet6\n");
+ if (SOCK_DOM(so) != PF_INET6)
+ panic("ipsec6_getpolicybysock: socket domain != inet6\n");
#endif
-
- pcbsp = sotoin6pcb(so)->in6p_sp;
+
+ pcbsp = sotoin6pcb(so)->in6p_sp;
+
+ if (!pcbsp){
+ return ipsec6_getpolicybyaddr(m, dir, 0, error);
+ }
- if (!pcbsp){
- return ipsec6_getpolicybyaddr(m, dir, 0, error);
- }
-
/* set spidx in pcb */
ipsec6_setspidx_in6pcb(m, sotoin6pcb(so));
-
+
/* sanity check */
if (pcbsp == NULL)
panic("ipsec6_getpolicybysock: pcbsp is NULL.\n");
-
- switch (dir) {
- case IPSEC_DIR_INBOUND:
- currsp = pcbsp->sp_in;
- break;
- case IPSEC_DIR_OUTBOUND:
- currsp = pcbsp->sp_out;
- break;
- default:
- panic("ipsec6_getpolicybysock: illegal direction.\n");
- }
-
+
+ switch (dir) {
+ case IPSEC_DIR_INBOUND:
+ currsp = pcbsp->sp_in;
+ break;
+ case IPSEC_DIR_OUTBOUND:
+ currsp = pcbsp->sp_out;
+ break;
+ default:
+ panic("ipsec6_getpolicybysock: illegal direction.\n");
+ }
+
/* sanity check */
if (currsp == NULL)
panic("ipsec6_getpolicybysock: currsp is NULL.\n");
-
+
/* when privilieged socket */
- if (pcbsp->priv) {
- switch (currsp->policy) {
+ if (pcbsp->priv) {
+ switch (currsp->policy) {
+ case IPSEC_POLICY_BYPASS:
+ lck_mtx_lock(sadb_mutex);
+ currsp->refcnt++;
+ lck_mtx_unlock(sadb_mutex);
+ *error = 0;
+ return currsp;
+
+ case IPSEC_POLICY_ENTRUST:
+ /* look for a policy in SPD */
+ kernsp = key_allocsp(&currsp->spidx, dir);
+
+ /* SP found */
+ if (kernsp != NULL) {
+ KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
+ printf("DP ipsec6_getpolicybysock called "
+ "to allocate SP:0x%llx\n",
+ (uint64_t)VM_KERNEL_ADDRPERM(kernsp)));
+ *error = 0;
+ return kernsp;
+ }
+
+ /* no SP found */
+ lck_mtx_lock(sadb_mutex);
+ if (ip6_def_policy.policy != IPSEC_POLICY_DISCARD
+ && ip6_def_policy.policy != IPSEC_POLICY_NONE) {
+ ipseclog((LOG_INFO,
+ "fixed system default policy: %d->%d\n",
+ ip6_def_policy.policy, IPSEC_POLICY_NONE));
+ ip6_def_policy.policy = IPSEC_POLICY_NONE;
+ }
+ ip6_def_policy.refcnt++;
+ lck_mtx_unlock(sadb_mutex);
+ *error = 0;
+ return &ip6_def_policy;
+
+ case IPSEC_POLICY_IPSEC:
+ lck_mtx_lock(sadb_mutex);
+ currsp->refcnt++;
+ lck_mtx_unlock(sadb_mutex);
+ *error = 0;
+ return currsp;
+
+ default:
+ ipseclog((LOG_ERR, "ipsec6_getpolicybysock: "
+ "Invalid policy for PCB %d\n", currsp->policy));
+ *error = EINVAL;
+ return NULL;
+ }
+ /* NOTREACHED */
+ }
+
+ /* when non-privilieged socket */
+ /* look for a policy in SPD */
+ kernsp = key_allocsp(&currsp->spidx, dir);
+
+ /* SP found */
+ if (kernsp != NULL) {
+ KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
+ printf("DP ipsec6_getpolicybysock called "
+ "to allocate SP:0x%llx\n",
+ (uint64_t)VM_KERNEL_ADDRPERM(kernsp)));
+ *error = 0;
+ return kernsp;
+ }
+
+ /* no SP found */
+ switch (currsp->policy) {
case IPSEC_POLICY_BYPASS:
- lck_mtx_lock(sadb_mutex);
- currsp->refcnt++;
- lck_mtx_unlock(sadb_mutex);
- *error = 0;
- return currsp;
-
+ ipseclog((LOG_ERR, "ipsec6_getpolicybysock: "
+ "Illegal policy for non-priviliged defined %d\n",
+ currsp->policy));
+ *error = EINVAL;
+ return NULL;
+
case IPSEC_POLICY_ENTRUST:
- /* look for a policy in SPD */
- kernsp = key_allocsp(&currsp->spidx, dir);
-
- /* SP found */
- if (kernsp != NULL) {
- KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
- printf("DP ipsec6_getpolicybysock called "
- "to allocate SP:0x%llx\n",
- (uint64_t)VM_KERNEL_ADDRPERM(kernsp)));
- *error = 0;
- return kernsp;
- }
-
- /* no SP found */
lck_mtx_lock(sadb_mutex);
if (ip6_def_policy.policy != IPSEC_POLICY_DISCARD
- && ip6_def_policy.policy != IPSEC_POLICY_NONE) {
+ && ip6_def_policy.policy != IPSEC_POLICY_NONE) {
ipseclog((LOG_INFO,
- "fixed system default policy: %d->%d\n",
- ip6_def_policy.policy, IPSEC_POLICY_NONE));
+ "fixed system default policy: %d->%d\n",
+ ip6_def_policy.policy, IPSEC_POLICY_NONE));
ip6_def_policy.policy = IPSEC_POLICY_NONE;
}
ip6_def_policy.refcnt++;
lck_mtx_unlock(sadb_mutex);
*error = 0;
return currsp;
-
+
default:
- ipseclog((LOG_ERR, "ipsec6_getpolicybysock: "
- "Invalid policy for PCB %d\n", currsp->policy));
+ ipseclog((LOG_ERR,
+ "ipsec6_policybysock: Invalid policy for PCB %d\n",
+ currsp->policy));
*error = EINVAL;
return NULL;
- }
- /* NOTREACHED */
- }
-
- /* when non-privilieged socket */
- /* look for a policy in SPD */
- kernsp = key_allocsp(&currsp->spidx, dir);
-
- /* SP found */
- if (kernsp != NULL) {
- KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
- printf("DP ipsec6_getpolicybysock called "
- "to allocate SP:0x%llx\n",
- (uint64_t)VM_KERNEL_ADDRPERM(kernsp)));
- *error = 0;
- return kernsp;
- }
-
- /* no SP found */
- switch (currsp->policy) {
- case IPSEC_POLICY_BYPASS:
- ipseclog((LOG_ERR, "ipsec6_getpolicybysock: "
- "Illegal policy for non-priviliged defined %d\n",
- currsp->policy));
- *error = EINVAL;
- return NULL;
-
- case IPSEC_POLICY_ENTRUST:
- lck_mtx_lock(sadb_mutex);
- if (ip6_def_policy.policy != IPSEC_POLICY_DISCARD
- && ip6_def_policy.policy != IPSEC_POLICY_NONE) {
- ipseclog((LOG_INFO,
- "fixed system default policy: %d->%d\n",
- ip6_def_policy.policy, IPSEC_POLICY_NONE));
- ip6_def_policy.policy = IPSEC_POLICY_NONE;
- }
- ip6_def_policy.refcnt++;
- lck_mtx_unlock(sadb_mutex);
- *error = 0;
- return &ip6_def_policy;
-
- case IPSEC_POLICY_IPSEC:
- lck_mtx_lock(sadb_mutex);
- currsp->refcnt++;
- lck_mtx_unlock(sadb_mutex);
- *error = 0;
- return currsp;
-
- default:
- ipseclog((LOG_ERR,
- "ipsec6_policybysock: Invalid policy for PCB %d\n",
- currsp->policy));
- *error = EINVAL;
- return NULL;
}
/* NOTREACHED */
}
static int
ipsec4_setspidx_inpcb(m, pcb)
- struct mbuf *m;
- struct inpcb *pcb;
+struct mbuf *m;
+struct inpcb *pcb;
{
struct secpolicyindex *spidx;
int error;
-
+
if (ipsec_bypass != 0)
return 0;
-
+
/* sanity check */
if (pcb == NULL)
panic("ipsec4_setspidx_inpcb: no PCB found.\n");
- if (pcb->inp_sp == NULL)
- panic("ipsec4_setspidx_inpcb: no inp_sp found.\n");
- if (pcb->inp_sp->sp_out == NULL || pcb->inp_sp->sp_in == NULL)
- panic("ipsec4_setspidx_inpcb: no sp_in/out found.\n");
-
- bzero(&pcb->inp_sp->sp_in->spidx, sizeof(*spidx));
- bzero(&pcb->inp_sp->sp_out->spidx, sizeof(*spidx));
-
- spidx = &pcb->inp_sp->sp_in->spidx;
- error = ipsec_setspidx(m, spidx, 1, 0);
- if (error)
- goto bad;
+ if (pcb->inp_sp == NULL)
+ panic("ipsec4_setspidx_inpcb: no inp_sp found.\n");
+ if (pcb->inp_sp->sp_out == NULL || pcb->inp_sp->sp_in == NULL)
+ panic("ipsec4_setspidx_inpcb: no sp_in/out found.\n");
+
+ bzero(&pcb->inp_sp->sp_in->spidx, sizeof(*spidx));
+ bzero(&pcb->inp_sp->sp_out->spidx, sizeof(*spidx));
+
+ spidx = &pcb->inp_sp->sp_in->spidx;
+ error = ipsec_setspidx(m, spidx, 1, 0);
+ if (error)
+ goto bad;
spidx->dir = IPSEC_DIR_INBOUND;
-
+
spidx = &pcb->inp_sp->sp_out->spidx;
error = ipsec_setspidx(m, spidx, 1, 0);
if (error)
goto bad;
spidx->dir = IPSEC_DIR_OUTBOUND;
-
+
return 0;
-
+
bad:
bzero(&pcb->inp_sp->sp_in->spidx, sizeof(*spidx));
bzero(&pcb->inp_sp->sp_out->spidx, sizeof(*spidx));
#if INET6
static int
ipsec6_setspidx_in6pcb(m, pcb)
- struct mbuf *m;
- struct in6pcb *pcb;
+struct mbuf *m;
+struct in6pcb *pcb;
{
struct secpolicyindex *spidx;
int error;
-
+
/* sanity check */
if (pcb == NULL)
panic("ipsec6_setspidx_in6pcb: no PCB found.\n");
- if (pcb->in6p_sp == NULL)
- panic("ipsec6_setspidx_in6pcb: no in6p_sp found.\n");
- if (pcb->in6p_sp->sp_out == NULL || pcb->in6p_sp->sp_in == NULL)
- panic("ipsec6_setspidx_in6pcb: no sp_in/out found.\n");
-
- bzero(&pcb->in6p_sp->sp_in->spidx, sizeof(*spidx));
- bzero(&pcb->in6p_sp->sp_out->spidx, sizeof(*spidx));
-
- spidx = &pcb->in6p_sp->sp_in->spidx;
- error = ipsec_setspidx(m, spidx, 1, 0);
- if (error)
- goto bad;
- spidx->dir = IPSEC_DIR_INBOUND;
-
- spidx = &pcb->in6p_sp->sp_out->spidx;
+ if (pcb->in6p_sp == NULL)
+ panic("ipsec6_setspidx_in6pcb: no in6p_sp found.\n");
+ if (pcb->in6p_sp->sp_out == NULL || pcb->in6p_sp->sp_in == NULL)
+ panic("ipsec6_setspidx_in6pcb: no sp_in/out found.\n");
+
+ bzero(&pcb->in6p_sp->sp_in->spidx, sizeof(*spidx));
+ bzero(&pcb->in6p_sp->sp_out->spidx, sizeof(*spidx));
+
+ spidx = &pcb->in6p_sp->sp_in->spidx;
+ error = ipsec_setspidx(m, spidx, 1, 0);
+ if (error)
+ goto bad;
+ spidx->dir = IPSEC_DIR_INBOUND;
+
+ spidx = &pcb->in6p_sp->sp_out->spidx;
error = ipsec_setspidx(m, spidx, 1, 0);
if (error)
goto bad;
spidx->dir = IPSEC_DIR_OUTBOUND;
-
+
return 0;
-
+
bad:
bzero(&pcb->in6p_sp->sp_in->spidx, sizeof(*spidx));
bzero(&pcb->in6p_sp->sp_out->spidx, sizeof(*spidx));
#if INET6
static void
-ipsec6_get_ulp(m, spidx, needport)
- struct mbuf *m;
- struct secpolicyindex *spidx;
- int needport;
+ipsec6_get_ulp(struct mbuf *m,
+ struct secpolicyindex *spidx,
+ int needport)
{
int off, nxt;
struct tcphdr th;
/* assumes that m is sane */
static int
-ipsec6_setspidx_ipaddr(m, spidx)
- struct mbuf *m;
- struct secpolicyindex *spidx;
+ipsec6_setspidx_ipaddr(struct mbuf *m,
+ struct secpolicyindex *spidx)
{
struct ip6_hdr *ip6 = NULL;
struct ip6_hdr ip6buf;
ipsec_newpcbpolicy()
{
struct inpcbpolicy *p;
-
+
p = (struct inpcbpolicy *)_MALLOC(sizeof(*p), M_SECA, M_WAITOK);
return p;
}
static void
-ipsec_delpcbpolicy(p)
- struct inpcbpolicy *p;
+ipsec_delpcbpolicy(struct inpcbpolicy *p)
{
FREE(p, M_SECA);
}
/* initialize policy in PCB */
int
-ipsec_init_policy(so, pcb_sp)
- struct socket *so;
- struct inpcbpolicy **pcb_sp;
+ipsec_init_policy(struct socket *so,
+ struct inpcbpolicy **pcb_sp)
{
struct inpcbpolicy *new;
-
+
/* sanity check. */
if (so == NULL || pcb_sp == NULL)
panic("ipsec_init_policy: NULL pointer was passed.\n");
-
- new = ipsec_newpcbpolicy();
- if (new == NULL) {
- ipseclog((LOG_DEBUG, "ipsec_init_policy: No more memory.\n"));
- return ENOBUFS;
- }
+
+ new = ipsec_newpcbpolicy();
+ if (new == NULL) {
+ ipseclog((LOG_DEBUG, "ipsec_init_policy: No more memory.\n"));
+ return ENOBUFS;
+ }
bzero(new, sizeof(*new));
-
+
#ifdef __APPLE__
if (kauth_cred_issuser(so->so_cred))
#else
- if (so->so_cred != 0 && !suser(so->so_cred->pc_ucred, NULL))
+ if (so->so_cred != 0 && !suser(so->so_cred->pc_ucred, NULL))
#endif
- new->priv = 1;
- else
- new->priv = 0;
-
- if ((new->sp_in = key_newsp()) == NULL) {
- ipsec_delpcbpolicy(new);
- return ENOBUFS;
- }
+ new->priv = 1;
+ else
+ new->priv = 0;
+
+ if ((new->sp_in = key_newsp()) == NULL) {
+ ipsec_delpcbpolicy(new);
+ return ENOBUFS;
+ }
new->sp_in->state = IPSEC_SPSTATE_ALIVE;
new->sp_in->policy = IPSEC_POLICY_ENTRUST;
-
+
if ((new->sp_out = key_newsp()) == NULL) {
key_freesp(new->sp_in, KEY_SADB_UNLOCKED);
ipsec_delpcbpolicy(new);
}
new->sp_out->state = IPSEC_SPSTATE_ALIVE;
new->sp_out->policy = IPSEC_POLICY_ENTRUST;
-
+
*pcb_sp = new;
-
+
return 0;
}
/* copy old ipsec policy into new */
int
-ipsec_copy_policy(old, new)
- struct inpcbpolicy *old, *new;
+ipsec_copy_policy(struct inpcbpolicy *old,
+ struct inpcbpolicy *new)
{
struct secpolicy *sp;
-
+
if (ipsec_bypass != 0)
return 0;
-
+
sp = ipsec_deepcopy_policy(old->sp_in);
if (sp) {
key_freesp(new->sp_in, KEY_SADB_UNLOCKED);
new->sp_in = sp;
} else
return ENOBUFS;
-
+
sp = ipsec_deepcopy_policy(old->sp_out);
if (sp) {
key_freesp(new->sp_out, KEY_SADB_UNLOCKED);
new->sp_out = sp;
} else
return ENOBUFS;
-
+
new->priv = old->priv;
-
+
return 0;
}
/* deep-copy a policy in PCB */
static struct secpolicy *
-ipsec_deepcopy_policy(src)
- struct secpolicy *src;
+ipsec_deepcopy_policy(struct secpolicy *src)
{
struct ipsecrequest *newchain = NULL;
struct ipsecrequest *p;
struct ipsecrequest **q;
struct ipsecrequest *r;
struct secpolicy *dst;
-
+
if (src == NULL)
return NULL;
dst = key_newsp();
if (dst == NULL)
return NULL;
-
+
/*
* deep-copy IPsec request chain. This is required since struct
* ipsecrequest is not reference counted.
q = &newchain;
for (p = src->req; p; p = p->next) {
*q = (struct ipsecrequest *)_MALLOC(sizeof(struct ipsecrequest),
- M_SECA, M_WAITOK);
+ M_SECA, M_WAITOK);
if (*q == NULL)
goto fail;
bzero(*q, sizeof(**q));
(*q)->next = NULL;
-
+
(*q)->saidx.proto = p->saidx.proto;
(*q)->saidx.mode = p->saidx.mode;
(*q)->level = p->level;
(*q)->saidx.reqid = p->saidx.reqid;
-
+
bcopy(&p->saidx.src, &(*q)->saidx.src, sizeof((*q)->saidx.src));
bcopy(&p->saidx.dst, &(*q)->saidx.dst, sizeof((*q)->saidx.dst));
-
+
(*q)->sp = dst;
-
+
q = &((*q)->next);
}
-
+
dst->req = newchain;
dst->state = src->state;
dst->policy = src->policy;
/* do not touch the refcnt fields */
-
+
return dst;
-
+
fail:
for (p = newchain; p; p = r) {
r = p->next;
/* set policy and ipsec request if present. */
static int
-ipsec_set_policy(
- struct secpolicy **pcb_sp,
- __unused int optname,
- caddr_t request,
- size_t len,
- int priv)
+ipsec_set_policy(struct secpolicy **pcb_sp,
+ __unused int optname,
+ caddr_t request,
+ size_t len,
+ int priv)
{
struct sadb_x_policy *xpl;
struct secpolicy *newsp = NULL;
int error;
-
+
/* sanity check. */
if (pcb_sp == NULL || *pcb_sp == NULL || request == NULL)
return EINVAL;
if (len < sizeof(*xpl))
return EINVAL;
xpl = (struct sadb_x_policy *)(void *)request;
-
+
KEYDEBUG(KEYDEBUG_IPSEC_DUMP,
- printf("ipsec_set_policy: passed policy\n");
- kdebug_sadb_x_policy((struct sadb_ext *)xpl));
-
+ printf("ipsec_set_policy: passed policy\n");
+ kdebug_sadb_x_policy((struct sadb_ext *)xpl));
+
/* check policy type */
/* ipsec_set_policy() accepts IPSEC, ENTRUST and BYPASS. */
if (xpl->sadb_x_policy_type == IPSEC_POLICY_DISCARD
|| xpl->sadb_x_policy_type == IPSEC_POLICY_NONE)
return EINVAL;
-
+
/* check privileged socket */
if (priv == 0 && xpl->sadb_x_policy_type == IPSEC_POLICY_BYPASS)
return EACCES;
-
+
/* allocation new SP entry */
if ((newsp = key_msg2sp(xpl, len, &error)) == NULL)
return error;
-
+
newsp->state = IPSEC_SPSTATE_ALIVE;
-
+
/* clear old SP and set new SP */
key_freesp(*pcb_sp, KEY_SADB_UNLOCKED);
*pcb_sp = newsp;
KEYDEBUG(KEYDEBUG_IPSEC_DUMP,
- printf("ipsec_set_policy: new policy\n");
- kdebug_secpolicy(newsp));
-
- return 0;
-}
-
-static int
-ipsec_get_policy(pcb_sp, mp)
- struct secpolicy *pcb_sp;
- struct mbuf **mp;
-{
-
-
- /* sanity check. */
- if (pcb_sp == NULL || mp == NULL)
- return EINVAL;
-
- *mp = key_sp2msg(pcb_sp);
- if (!*mp) {
- ipseclog((LOG_DEBUG, "ipsec_get_policy: No more memory.\n"));
- return ENOBUFS;
- }
-
- m_mchtype(*mp, MT_DATA);
- KEYDEBUG(KEYDEBUG_IPSEC_DUMP,
- printf("ipsec_get_policy:\n");
- kdebug_mbuf(*mp));
-
+ printf("ipsec_set_policy: new policy\n");
+ kdebug_secpolicy(newsp));
+
return 0;
}
int
-ipsec4_set_policy(inp, optname, request, len, priv)
- struct inpcb *inp;
- int optname;
- caddr_t request;
- size_t len;
- int priv;
+ipsec4_set_policy(struct inpcb *inp,
+ int optname,
+ caddr_t request,
+ size_t len,
+ int priv)
{
struct sadb_x_policy *xpl;
struct secpolicy **pcb_sp;
int error = 0;
struct sadb_x_policy xpl_aligned_buf;
u_int8_t *xpl_unaligned;
-
+
/* sanity check. */
if (inp == NULL || request == NULL)
return EINVAL;
if (len < sizeof(*xpl))
return EINVAL;
xpl = (struct sadb_x_policy *)(void *)request;
-
+
/* This is a new mbuf allocated by soopt_getm() */
if (IPSEC_IS_P2ALIGNED(xpl)) {
xpl_unaligned = NULL;
memcpy(&xpl_aligned_buf, xpl, sizeof(xpl_aligned_buf));
xpl = (__typeof__(xpl))&xpl_aligned_buf;
}
-
+
if (inp->inp_sp == NULL) {
error = ipsec_init_policy(inp->inp_socket, &inp->inp_sp);
if (error)
return error;
}
-
+
/* select direction */
switch (xpl->sadb_x_policy_dir) {
- case IPSEC_DIR_INBOUND:
- pcb_sp = &inp->inp_sp->sp_in;
- break;
- case IPSEC_DIR_OUTBOUND:
- pcb_sp = &inp->inp_sp->sp_out;
- break;
- default:
- ipseclog((LOG_ERR, "ipsec4_set_policy: invalid direction=%u\n",
- xpl->sadb_x_policy_dir));
- return EINVAL;
+ case IPSEC_DIR_INBOUND:
+ pcb_sp = &inp->inp_sp->sp_in;
+ break;
+ case IPSEC_DIR_OUTBOUND:
+ pcb_sp = &inp->inp_sp->sp_out;
+ break;
+ default:
+ ipseclog((LOG_ERR, "ipsec4_set_policy: invalid direction=%u\n",
+ xpl->sadb_x_policy_dir));
+ return EINVAL;
}
-
+
/* turn bypass off */
if (ipsec_bypass != 0)
ipsec_bypass = 0;
-
+
return ipsec_set_policy(pcb_sp, optname, request, len, priv);
}
-int
-ipsec4_get_policy(inp, request, len, mp)
- struct inpcb *inp;
- caddr_t request;
- size_t len;
- struct mbuf **mp;
-{
- struct sadb_x_policy *xpl;
- struct secpolicy *pcb_sp;
- int error = 0;
- struct sadb_x_policy xpl_aligned_buf;
- u_int8_t *xpl_unaligned;
-
- lck_mtx_assert(sadb_mutex, LCK_MTX_ASSERT_NOTOWNED);
-
- /* sanity check. */
- if (inp == NULL || request == NULL || mp == NULL)
- return EINVAL;
- if (len < sizeof(*xpl))
- return EINVAL;
- xpl = (struct sadb_x_policy *)(void *)request;
-
- /* This is a new mbuf allocated by soopt_getm() */
- if (IPSEC_IS_P2ALIGNED(xpl)) {
- xpl_unaligned = NULL;
- } else {
- xpl_unaligned = (__typeof__(xpl_unaligned))xpl;
- memcpy(&xpl_aligned_buf, xpl, sizeof(xpl_aligned_buf));
- xpl = (__typeof__(xpl))&xpl_aligned_buf;
- }
-
- if (inp->inp_sp == NULL) {
- error = ipsec_init_policy(inp->inp_socket, &inp->inp_sp);
- if (error)
- return error;
- }
-
- /* select direction */
- switch (xpl->sadb_x_policy_dir) {
- case IPSEC_DIR_INBOUND:
- pcb_sp = inp->inp_sp->sp_in;
- break;
- case IPSEC_DIR_OUTBOUND:
- pcb_sp = inp->inp_sp->sp_out;
- break;
- default:
- ipseclog((LOG_ERR, "ipsec4_set_policy: invalid direction=%u\n",
- xpl->sadb_x_policy_dir));
- return EINVAL;
- }
-
- return ipsec_get_policy(pcb_sp, mp);
-}
-
/* delete policy in PCB */
int
-ipsec4_delete_pcbpolicy(inp)
- struct inpcb *inp;
+ipsec4_delete_pcbpolicy(struct inpcb *inp)
{
-
+
/* sanity check. */
if (inp == NULL)
panic("ipsec4_delete_pcbpolicy: NULL pointer was passed.\n");
-
- if (inp->inp_sp == NULL)
- return 0;
-
+
+ if (inp->inp_sp == NULL)
+ return 0;
+
if (inp->inp_sp->sp_in != NULL) {
key_freesp(inp->inp_sp->sp_in, KEY_SADB_UNLOCKED);
inp->inp_sp->sp_in = NULL;
}
-
+
if (inp->inp_sp->sp_out != NULL) {
key_freesp(inp->inp_sp->sp_out, KEY_SADB_UNLOCKED);
inp->inp_sp->sp_out = NULL;
}
-
+
ipsec_delpcbpolicy(inp->inp_sp);
inp->inp_sp = NULL;
-
+
return 0;
}
#if INET6
int
-ipsec6_set_policy(in6p, optname, request, len, priv)
- struct in6pcb *in6p;
- int optname;
- caddr_t request;
- size_t len;
- int priv;
+ipsec6_set_policy(struct in6pcb *in6p,
+ int optname,
+ caddr_t request,
+ size_t len,
+ int priv)
{
struct sadb_x_policy *xpl;
struct secpolicy **pcb_sp;
int error = 0;
struct sadb_x_policy xpl_aligned_buf;
u_int8_t *xpl_unaligned;
-
+
/* sanity check. */
if (in6p == NULL || request == NULL)
return EINVAL;
if (len < sizeof(*xpl))
return EINVAL;
xpl = (struct sadb_x_policy *)(void *)request;
-
+
/* This is a new mbuf allocated by soopt_getm() */
if (IPSEC_IS_P2ALIGNED(xpl)) {
xpl_unaligned = NULL;
memcpy(&xpl_aligned_buf, xpl, sizeof(xpl_aligned_buf));
xpl = (__typeof__(xpl))&xpl_aligned_buf;
}
-
+
if (in6p->in6p_sp == NULL) {
error = ipsec_init_policy(in6p->inp_socket, &in6p->in6p_sp);
if (error)
return error;
}
-
+
/* select direction */
switch (xpl->sadb_x_policy_dir) {
- case IPSEC_DIR_INBOUND:
- pcb_sp = &in6p->in6p_sp->sp_in;
- break;
- case IPSEC_DIR_OUTBOUND:
- pcb_sp = &in6p->in6p_sp->sp_out;
- break;
- default:
- ipseclog((LOG_ERR, "ipsec6_set_policy: invalid direction=%u\n",
- xpl->sadb_x_policy_dir));
- return EINVAL;
+ case IPSEC_DIR_INBOUND:
+ pcb_sp = &in6p->in6p_sp->sp_in;
+ break;
+ case IPSEC_DIR_OUTBOUND:
+ pcb_sp = &in6p->in6p_sp->sp_out;
+ break;
+ default:
+ ipseclog((LOG_ERR, "ipsec6_set_policy: invalid direction=%u\n",
+ xpl->sadb_x_policy_dir));
+ return EINVAL;
}
- /* turn bypass off */
- if (ipsec_bypass != 0)
- ipsec_bypass = 0;
-
return ipsec_set_policy(pcb_sp, optname, request, len, priv);
}
int
-ipsec6_get_policy(in6p, request, len, mp)
- struct in6pcb *in6p;
- caddr_t request;
- size_t len;
- struct mbuf **mp;
-{
- struct sadb_x_policy *xpl;
- struct secpolicy *pcb_sp;
- int error = 0;
- struct sadb_x_policy xpl_aligned_buf;
- u_int8_t *xpl_unaligned;
-
- /* sanity check. */
- if (in6p == NULL || request == NULL || mp == NULL)
- return EINVAL;
- if (len < sizeof(*xpl))
- return EINVAL;
- xpl = (struct sadb_x_policy *)(void *)request;
-
- /* This is a new mbuf allocated by soopt_getm() */
- if (IPSEC_IS_P2ALIGNED(xpl)) {
- xpl_unaligned = NULL;
- } else {
- xpl_unaligned = (__typeof__(xpl_unaligned))xpl;
- memcpy(&xpl_aligned_buf, xpl, sizeof(xpl_aligned_buf));
- xpl = (__typeof__(xpl))&xpl_aligned_buf;
- }
-
- if (in6p->in6p_sp == NULL) {
- error = ipsec_init_policy(in6p->inp_socket, &in6p->in6p_sp);
- if (error)
- return error;
- }
-
- /* select direction */
- switch (xpl->sadb_x_policy_dir) {
- case IPSEC_DIR_INBOUND:
- pcb_sp = in6p->in6p_sp->sp_in;
- break;
- case IPSEC_DIR_OUTBOUND:
- pcb_sp = in6p->in6p_sp->sp_out;
- break;
- default:
- ipseclog((LOG_ERR, "ipsec6_set_policy: invalid direction=%u\n",
- xpl->sadb_x_policy_dir));
- return EINVAL;
- }
-
- return ipsec_get_policy(pcb_sp, mp);
-}
-
-int
-ipsec6_delete_pcbpolicy(in6p)
- struct in6pcb *in6p;
+ipsec6_delete_pcbpolicy(struct in6pcb *in6p)
{
-
+
/* sanity check. */
if (in6p == NULL)
panic("ipsec6_delete_pcbpolicy: NULL pointer was passed.\n");
-
- if (in6p->in6p_sp == NULL)
- return 0;
-
+
+ if (in6p->in6p_sp == NULL)
+ return 0;
+
if (in6p->in6p_sp->sp_in != NULL) {
key_freesp(in6p->in6p_sp->sp_in, KEY_SADB_UNLOCKED);
in6p->in6p_sp->sp_in = NULL;
}
-
+
if (in6p->in6p_sp->sp_out != NULL) {
key_freesp(in6p->in6p_sp->sp_out, KEY_SADB_UNLOCKED);
in6p->in6p_sp->sp_out = NULL;
}
-
+
ipsec_delpcbpolicy(in6p->in6p_sp);
in6p->in6p_sp = NULL;
-
+
return 0;
}
#endif
if (so == NULL)
sp = ipsec4_getpolicybyaddr(m, IPSEC_DIR_INBOUND, IP_FORWARDING, &error);
else
- sp = ipsec4_getpolicybysock(m, IPSEC_DIR_INBOUND, so, &error);
+ sp = ipsec4_getpolicybyaddr(m, IPSEC_DIR_INBOUND, 0, &error);
if (sp == NULL)
return 0; /* XXX should be panic ?
if (so == NULL)
sp = ipsec6_getpolicybyaddr(m, IPSEC_DIR_INBOUND, IP_FORWARDING, &error);
else
- sp = ipsec6_getpolicybysock(m, IPSEC_DIR_INBOUND, so, &error);
+ sp = ipsec6_getpolicybyaddr(m, IPSEC_DIR_INBOUND, 0, &error);
if (sp == NULL)
return 0; /* XXX should be panic ? */
if (inp == NULL)
sp = ipsec4_getpolicybyaddr(m, dir, IP_FORWARDING, &error);
else
- sp = ipsec4_getpolicybysock(m, dir, inp->inp_socket, &error);
+ sp = ipsec4_getpolicybyaddr(m, dir, 0, &error);
if (sp == NULL)
return 0; /* XXX should be panic ? */
if (in6p == NULL)
sp = ipsec6_getpolicybyaddr(m, dir, IP_FORWARDING, &error);
else
- sp = ipsec6_getpolicybysock(m, dir, in6p->in6p_socket, &error);
+ sp = ipsec6_getpolicybyaddr(m, dir, 0, &error);
if (sp == NULL)
return 0;
/*
* IPsec output logic for IPv4.
*/
-int
-ipsec4_output(
- struct ipsec_output_state *state,
- struct secpolicy *sp,
- __unused int flags)
+static int
+ipsec4_output_internal(struct ipsec_output_state *state, struct secasvar *sav)
{
struct ip *ip = NULL;
- struct ipsecrequest *isr = NULL;
- struct secasindex saidx;
- struct secasvar *sav = NULL;
int error = 0;
struct sockaddr_in *dst4;
- struct sockaddr_in *sin;
struct route *ro4;
+ /* validity check */
+ if (sav == NULL || sav->sah == NULL) {
+ error = EINVAL;
+ goto bad;
+ }
+
+ /*
+ * If there is no valid SA, we give up to process any
+ * more. In such a case, the SA's status is changed
+ * from DYING to DEAD after allocating. If a packet
+ * send to the receiver by dead SA, the receiver can
+ * not decode a packet because SA has been dead.
+ */
+ if (sav->state != SADB_SASTATE_MATURE
+ && sav->state != SADB_SASTATE_DYING) {
+ IPSEC_STAT_INCREMENT(ipsecstat.out_nosa);
+ error = EINVAL;
+ goto bad;
+ }
+
+ state->outgoing_if = sav->sah->outgoing_if;
+
+ /*
+ * There may be the case that SA status will be changed when
+ * we are refering to one. So calling splsoftnet().
+ */
+
+ if (sav->sah->saidx.mode == IPSEC_MODE_TUNNEL) {
+ /*
+ * build IPsec tunnel.
+ */
+ /* XXX should be processed with other familiy */
+ if (((struct sockaddr *)&sav->sah->saidx.src)->sa_family != AF_INET) {
+ ipseclog((LOG_ERR, "ipsec4_output: "
+ "family mismatched between inner and outer spi=%u\n",
+ (u_int32_t)ntohl(sav->spi)));
+ error = EAFNOSUPPORT;
+ goto bad;
+ }
+
+ state->m = ipsec4_splithdr(state->m);
+ if (!state->m) {
+ error = ENOMEM;
+ goto bad;
+ }
+ error = ipsec4_encapsulate(state->m, sav);
+ if (error) {
+ state->m = NULL;
+ goto bad;
+ }
+ ip = mtod(state->m, struct ip *);
+
+ // grab sadb_mutex, before updating sah's route cache
+ lck_mtx_lock(sadb_mutex);
+ ro4= &sav->sah->sa_route;
+ dst4 = (struct sockaddr_in *)(void *)&ro4->ro_dst;
+ if (ro4->ro_rt != NULL) {
+ RT_LOCK(ro4->ro_rt);
+ }
+ if (ROUTE_UNUSABLE(ro4) ||
+ dst4->sin_addr.s_addr != ip->ip_dst.s_addr) {
+ if (ro4->ro_rt != NULL)
+ RT_UNLOCK(ro4->ro_rt);
+ ROUTE_RELEASE(ro4);
+ }
+ if (ro4->ro_rt == 0) {
+ dst4->sin_family = AF_INET;
+ dst4->sin_len = sizeof(*dst4);
+ dst4->sin_addr = ip->ip_dst;
+ rtalloc(ro4);
+ if (ro4->ro_rt == 0) {
+ OSAddAtomic(1, &ipstat.ips_noroute);
+ error = EHOSTUNREACH;
+ // release sadb_mutex, after updating sah's route cache
+ lck_mtx_unlock(sadb_mutex);
+ goto bad;
+ }
+ RT_LOCK(ro4->ro_rt);
+ }
+
+ /*
+ * adjust state->dst if tunnel endpoint is offlink
+ *
+ * XXX: caching rt_gateway value in the state is
+ * not really good, since it may point elsewhere
+ * when the gateway gets modified to a larger
+ * sockaddr via rt_setgate(). This is currently
+ * addressed by SA_SIZE roundup in that routine.
+ */
+ if (ro4->ro_rt->rt_flags & RTF_GATEWAY)
+ dst4 = (struct sockaddr_in *)(void *)ro4->ro_rt->rt_gateway;
+ RT_UNLOCK(ro4->ro_rt);
+ ROUTE_RELEASE(&state->ro);
+ route_copyout(&state->ro, ro4, sizeof(state->ro));
+ state->dst = (struct sockaddr *)dst4;
+ state->tunneled = 4;
+ // release sadb_mutex, after updating sah's route cache
+ lck_mtx_unlock(sadb_mutex);
+ }
+
+ state->m = ipsec4_splithdr(state->m);
+ if (!state->m) {
+ error = ENOMEM;
+ goto bad;
+ }
+ switch (sav->sah->saidx.proto) {
+ case IPPROTO_ESP:
+#if IPSEC_ESP
+ if ((error = esp4_output(state->m, sav)) != 0) {
+ state->m = NULL;
+ goto bad;
+ }
+ break;
+#else
+ m_freem(state->m);
+ state->m = NULL;
+ error = EINVAL;
+ goto bad;
+#endif
+ case IPPROTO_AH:
+ if ((error = ah4_output(state->m, sav)) != 0) {
+ state->m = NULL;
+ goto bad;
+ }
+ break;
+ case IPPROTO_IPCOMP:
+ if ((error = ipcomp4_output(state->m, sav)) != 0) {
+ state->m = NULL;
+ goto bad;
+ }
+ break;
+ default:
+ ipseclog((LOG_ERR,
+ "ipsec4_output: unknown ipsec protocol %d\n",
+ sav->sah->saidx.proto));
+ m_freem(state->m);
+ state->m = NULL;
+ error = EINVAL;
+ goto bad;
+ }
+
+ if (state->m == 0) {
+ error = ENOMEM;
+ goto bad;
+ }
+
+ return 0;
+
+bad:
+ return error;
+}
+
+int
+ipsec4_interface_output(struct ipsec_output_state *state, ifnet_t interface)
+{
+ int error = 0;
+ struct secasvar *sav = NULL;
+
lck_mtx_assert(sadb_mutex, LCK_MTX_ASSERT_NOTOWNED);
if (!state)
panic("state->m == NULL in ipsec4_output");
if (!state->dst)
panic("state->dst == NULL in ipsec4_output");
+
+ sav = key_alloc_outbound_sav_for_interface(interface, AF_INET);
+ if (sav == NULL) {
+ goto bad;
+ }
+
+ if ((error = ipsec4_output_internal(state, sav)) != 0) {
+ goto bad;
+ }
+
+ KERNEL_DEBUG(DBG_FNC_IPSEC_OUT | DBG_FUNC_END, 0,0,0,0,0);
+ if (sav)
+ key_freesav(sav, KEY_SADB_UNLOCKED);
+ return 0;
+
+bad:
+ if (sav)
+ key_freesav(sav, KEY_SADB_UNLOCKED);
+ m_freem(state->m);
+ state->m = NULL;
+ KERNEL_DEBUG(DBG_FNC_IPSEC_OUT | DBG_FUNC_END, error,0,0,0,0);
+ return error;
+}
+int
+ipsec4_output(struct ipsec_output_state *state, struct secpolicy *sp, __unused int flags)
+{
+ struct ip *ip = NULL;
+ struct ipsecrequest *isr = NULL;
+ struct secasindex saidx;
+ struct secasvar *sav = NULL;
+ int error = 0;
+ struct sockaddr_in *sin;
+
+ lck_mtx_assert(sadb_mutex, LCK_MTX_ASSERT_NOTOWNED);
+
+ if (!state)
+ panic("state == NULL in ipsec4_output");
+ if (!state->m)
+ panic("state->m == NULL in ipsec4_output");
+ if (!state->dst)
+ panic("state->dst == NULL in ipsec4_output");
+
KERNEL_DEBUG(DBG_FNC_IPSEC_OUT | DBG_FUNC_START, 0,0,0,0,0);
-
+
KEYDEBUG(KEYDEBUG_IPSEC_DATA,
- printf("ipsec4_output: applyed SP\n");
- kdebug_secpolicy(sp));
-
+ printf("ipsec4_output: applied SP\n");
+ kdebug_secpolicy(sp));
+
for (isr = sp->req; isr != NULL; isr = isr->next) {
-
-#if 0 /* give up to check restriction of transport mode */
- /* XXX but should be checked somewhere */
- /*
- * some of the IPsec operation must be performed only in
- * originating case.
- */
- if (isr->saidx.mode == IPSEC_MODE_TRANSPORT
- && (flags & IP_FORWARDING))
- continue;
-#endif
-
/* make SA index for search proper SA */
ip = mtod(state->m, struct ip *);
bcopy(&isr->saidx, &saidx, sizeof(saidx));
sin->sin_family = AF_INET;
sin->sin_port = IPSEC_PORT_ANY;
bcopy(&ip->ip_src, &sin->sin_addr,
- sizeof(sin->sin_addr));
+ sizeof(sin->sin_addr));
}
sin = (struct sockaddr_in *)&saidx.dst;
if (sin->sin_len == 0) {
sin->sin_len = sizeof(*sin);
sin->sin_family = AF_INET;
sin->sin_port = IPSEC_PORT_ANY;
- /*
- * Get port from packet if upper layer is UDP and nat traversal
- * is enabled and transport mode.
- */
-
+ /*
+ * Get port from packet if upper layer is UDP and nat traversal
+ * is enabled and transport mode.
+ */
+
if ((esp_udp_encap_port & 0xFFFF) != 0 &&
- isr->saidx.mode == IPSEC_MODE_TRANSPORT) {
+ isr->saidx.mode == IPSEC_MODE_TRANSPORT) {
if (ip->ip_p == IPPROTO_UDP) {
struct udphdr *udp;
if (state->m->m_len < hlen + sizeof(struct udphdr)) {
state->m = m_pullup(state->m, hlen + sizeof(struct udphdr));
if (!state->m) {
- ipseclog((LOG_DEBUG,
- "IPv4 output: can't pullup UDP header\n"));
+ ipseclog((LOG_DEBUG, "IPv4 output: can't pullup UDP header\n"));
IPSEC_STAT_INCREMENT(ipsecstat.in_inval);
goto bad;
}
sin->sin_port = udp->uh_dport;
}
}
-
+
bcopy(&ip->ip_dst, &sin->sin_addr,
- sizeof(sin->sin_addr));
+ sizeof(sin->sin_addr));
}
-
+
if ((error = key_checkrequest(isr, &saidx, &sav)) != 0) {
/*
* IPsec processing is required, but no SA found.
IPSEC_STAT_INCREMENT(ipsecstat.out_nosa);
goto bad;
}
-
+
/* validity check */
if (sav == NULL) {
switch (ipsec_get_reqlevel(isr)) {
- case IPSEC_LEVEL_USE:
- continue;
- case IPSEC_LEVEL_REQUIRE:
- /* must be not reached here. */
- panic("ipsec4_output: no SA found, but required.");
- }
- }
-
- /*
- * If there is no valid SA, we give up to process any
- * more. In such a case, the SA's status is changed
- * from DYING to DEAD after allocating. If a packet
- * send to the receiver by dead SA, the receiver can
- * not decode a packet because SA has been dead.
- */
- if (sav->state != SADB_SASTATE_MATURE
- && sav->state != SADB_SASTATE_DYING) {
- IPSEC_STAT_INCREMENT(ipsecstat.out_nosa);
- error = EINVAL;
- goto bad;
- }
-
- /*
- * There may be the case that SA status will be changed when
- * we are refering to one. So calling splsoftnet().
- */
-
- if (isr->saidx.mode == IPSEC_MODE_TUNNEL) {
- /*
- * build IPsec tunnel.
- */
- /* XXX should be processed with other familiy */
- if (((struct sockaddr *)&sav->sah->saidx.src)->sa_family != AF_INET) {
- ipseclog((LOG_ERR, "ipsec4_output: "
- "family mismatched between inner and outer spi=%u\n",
- (u_int32_t)ntohl(sav->spi)));
- error = EAFNOSUPPORT;
- goto bad;
- }
-
- state->m = ipsec4_splithdr(state->m);
- if (!state->m) {
- error = ENOMEM;
- goto bad;
- }
- error = ipsec4_encapsulate(state->m, sav);
- if (error) {
- state->m = NULL;
- goto bad;
- }
- ip = mtod(state->m, struct ip *);
-
- // grab sadb_mutex, before updating sah's route cache
- lck_mtx_lock(sadb_mutex);
- ro4= &sav->sah->sa_route;
- dst4 = (struct sockaddr_in *)(void *)&ro4->ro_dst;
- if (ro4->ro_rt != NULL) {
- RT_LOCK(ro4->ro_rt);
- }
- if (ROUTE_UNUSABLE(ro4) ||
- dst4->sin_addr.s_addr != ip->ip_dst.s_addr) {
- if (ro4->ro_rt != NULL)
- RT_UNLOCK(ro4->ro_rt);
- ROUTE_RELEASE(ro4);
- }
- if (ro4->ro_rt == 0) {
- dst4->sin_family = AF_INET;
- dst4->sin_len = sizeof(*dst4);
- dst4->sin_addr = ip->ip_dst;
- rtalloc(ro4);
- if (ro4->ro_rt == 0) {
- OSAddAtomic(1, &ipstat.ips_noroute);
- error = EHOSTUNREACH;
- // release sadb_mutex, after updating sah's route cache
- lck_mtx_unlock(sadb_mutex);
- goto bad;
- }
- RT_LOCK(ro4->ro_rt);
- }
-
- /*
- * adjust state->dst if tunnel endpoint is offlink
- *
- * XXX: caching rt_gateway value in the state is
- * not really good, since it may point elsewhere
- * when the gateway gets modified to a larger
- * sockaddr via rt_setgate(). This is currently
- * addressed by SA_SIZE roundup in that routine.
- */
- if (ro4->ro_rt->rt_flags & RTF_GATEWAY)
- dst4 = (struct sockaddr_in *)(void *)ro4->ro_rt->rt_gateway;
- RT_UNLOCK(ro4->ro_rt);
- ROUTE_RELEASE(&state->ro);
- route_copyout(&state->ro, ro4, sizeof(state->ro));
- state->dst = (struct sockaddr *)dst4;
- state->tunneled = 4;
- // release sadb_mutex, after updating sah's route cache
- lck_mtx_unlock(sadb_mutex);
- }
-
- state->m = ipsec4_splithdr(state->m);
- if (!state->m) {
- error = ENOMEM;
- goto bad;
- }
- switch (isr->saidx.proto) {
- case IPPROTO_ESP:
-#if IPSEC_ESP
- if ((error = esp4_output(state->m, sav)) != 0) {
- state->m = NULL;
- goto bad;
- }
- break;
-#else
- m_freem(state->m);
- state->m = NULL;
- error = EINVAL;
- goto bad;
-#endif
- case IPPROTO_AH:
- if ((error = ah4_output(state->m, sav)) != 0) {
- state->m = NULL;
- goto bad;
- }
- break;
- case IPPROTO_IPCOMP:
- if ((error = ipcomp4_output(state->m, sav)) != 0) {
- state->m = NULL;
- goto bad;
+ case IPSEC_LEVEL_USE:
+ continue;
+ case IPSEC_LEVEL_REQUIRE:
+ /* must be not reached here. */
+ panic("ipsec4_output: no SA found, but required.");
}
- break;
- default:
- ipseclog((LOG_ERR,
- "ipsec4_output: unknown ipsec protocol %d\n",
- isr->saidx.proto));
- m_freem(state->m);
- state->m = NULL;
- error = EINVAL;
- goto bad;
}
-
- if (state->m == 0) {
- error = ENOMEM;
+
+ if ((error = ipsec4_output_internal(state, sav)) != 0) {
goto bad;
}
- ip = mtod(state->m, struct ip *);
}
-
+
KERNEL_DEBUG(DBG_FNC_IPSEC_OUT | DBG_FUNC_END, 0,0,0,0,0);
if (sav)
key_freesav(sav, KEY_SADB_UNLOCKED);
return 0;
-
+
bad:
if (sav)
key_freesav(sav, KEY_SADB_UNLOCKED);
KERNEL_DEBUG(DBG_FNC_IPSEC_OUT | DBG_FUNC_END, error,0,0,0,0);
return error;
}
+
#endif
#if INET6
/*
* IPsec output logic for IPv6, transport mode.
*/
-int
-ipsec6_output_trans(
+static int
+ipsec6_output_trans_internal(
struct ipsec_output_state *state,
+ struct secasvar *sav,
u_char *nexthdrp,
- struct mbuf *mprev,
- struct secpolicy *sp,
- __unused int flags,
- int *tun)
+ struct mbuf *mprev)
+{
+ struct ip6_hdr *ip6;
+ int error = 0;
+ int plen;
+
+ /* validity check */
+ if (sav == NULL || sav->sah == NULL) {
+ error = EINVAL;
+ goto bad;
+ }
+
+ /*
+ * If there is no valid SA, we give up to process.
+ * see same place at ipsec4_output().
+ */
+ if (sav->state != SADB_SASTATE_MATURE
+ && sav->state != SADB_SASTATE_DYING) {
+ IPSEC_STAT_INCREMENT(ipsec6stat.out_nosa);
+ error = EINVAL;
+ goto bad;
+ }
+
+ state->outgoing_if = sav->sah->outgoing_if;
+
+ switch (sav->sah->saidx.proto) {
+ case IPPROTO_ESP:
+#if IPSEC_ESP
+ error = esp6_output(state->m, nexthdrp, mprev->m_next, sav);
+#else
+ m_freem(state->m);
+ error = EINVAL;
+#endif
+ break;
+ case IPPROTO_AH:
+ error = ah6_output(state->m, nexthdrp, mprev->m_next, sav);
+ break;
+ case IPPROTO_IPCOMP:
+ error = ipcomp6_output(state->m, nexthdrp, mprev->m_next, sav);
+ break;
+ default:
+ ipseclog((LOG_ERR, "ipsec6_output_trans: "
+ "unknown ipsec protocol %d\n", sav->sah->saidx.proto));
+ m_freem(state->m);
+ IPSEC_STAT_INCREMENT(ipsec6stat.out_inval);
+ error = EINVAL;
+ break;
+ }
+ if (error) {
+ state->m = NULL;
+ goto bad;
+ }
+ plen = state->m->m_pkthdr.len - sizeof(struct ip6_hdr);
+ if (plen > IPV6_MAXPACKET) {
+ ipseclog((LOG_ERR, "ipsec6_output_trans: "
+ "IPsec with IPv6 jumbogram is not supported\n"));
+ IPSEC_STAT_INCREMENT(ipsec6stat.out_inval);
+ error = EINVAL; /*XXX*/
+ goto bad;
+ }
+ ip6 = mtod(state->m, struct ip6_hdr *);
+ ip6->ip6_plen = htons(plen);
+
+ return 0;
+bad:
+ return error;
+}
+
+int
+ipsec6_output_trans(
+ struct ipsec_output_state *state,
+ u_char *nexthdrp,
+ struct mbuf *mprev,
+ struct secpolicy *sp,
+ __unused int flags,
+ int *tun)
{
struct ip6_hdr *ip6;
struct ipsecrequest *isr = NULL;
struct secasindex saidx;
int error = 0;
- int plen;
struct sockaddr_in6 *sin6;
struct secasvar *sav = NULL;
-
+
lck_mtx_assert(sadb_mutex, LCK_MTX_ASSERT_NOTOWNED);
if (!state)
panic("sp == NULL in ipsec6_output_trans");
if (!tun)
panic("tun == NULL in ipsec6_output_trans");
-
+
KEYDEBUG(KEYDEBUG_IPSEC_DATA,
- printf("ipsec6_output_trans: applyed SP\n");
- kdebug_secpolicy(sp));
+ printf("ipsec6_output_trans: applyed SP\n");
+ kdebug_secpolicy(sp));
*tun = 0;
for (isr = sp->req; isr; isr = isr->next) {
/* the rest will be handled by ipsec6_output_tunnel() */
break;
}
-
+
/* make SA index for search proper SA */
ip6 = mtod(state->m, struct ip6_hdr *);
bcopy(&isr->saidx, &saidx, sizeof(saidx));
sin6->sin6_family = AF_INET6;
sin6->sin6_port = IPSEC_PORT_ANY;
bcopy(&ip6->ip6_src, &sin6->sin6_addr,
- sizeof(ip6->ip6_src));
+ sizeof(ip6->ip6_src));
if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_src)) {
/* fix scope id for comparing SPD */
sin6->sin6_addr.s6_addr16[1] = 0;
sin6->sin6_family = AF_INET6;
sin6->sin6_port = IPSEC_PORT_ANY;
bcopy(&ip6->ip6_dst, &sin6->sin6_addr,
- sizeof(ip6->ip6_dst));
+ sizeof(ip6->ip6_dst));
if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst)) {
/* fix scope id for comparing SPD */
sin6->sin6_addr.s6_addr16[1] = 0;
sin6->sin6_scope_id = ntohs(ip6->ip6_dst.s6_addr16[1]);
}
}
-
+
if (key_checkrequest(isr, &saidx, &sav) == ENOENT) {
/*
* IPsec processing is required, but no SA found.
*/
IPSEC_STAT_INCREMENT(ipsec6stat.out_nosa);
error = ENOENT;
-
+
/*
* Notify the fact that the packet is discarded
* to ourselves. I believe this is better than
* pfctlinputs?
*/
icmp6_error(state->m, ICMP6_DST_UNREACH,
- ICMP6_DST_UNREACH_ADMIN, 0);
+ ICMP6_DST_UNREACH_ADMIN, 0);
state->m = NULL; /* icmp6_error freed the mbuf */
goto bad;
}
-
+
/* validity check */
if (sav == NULL) {
switch (ipsec_get_reqlevel(isr)) {
- case IPSEC_LEVEL_USE:
- continue;
- case IPSEC_LEVEL_REQUIRE:
- /* must be not reached here. */
- panic("ipsec6_output_trans: no SA found, but required.");
+ case IPSEC_LEVEL_USE:
+ continue;
+ case IPSEC_LEVEL_REQUIRE:
+ /* must be not reached here. */
+ panic("ipsec6_output_trans: no SA found, but required.");
}
}
+
+ if ((error = ipsec6_output_trans_internal(state, sav, nexthdrp, mprev)) != 0) {
+ goto bad;
+ }
+ }
+
+ /* if we have more to go, we need a tunnel mode processing */
+ if (isr != NULL)
+ *tun = 1;
+
+ if (sav)
+ key_freesav(sav, KEY_SADB_UNLOCKED);
+ return 0;
+
+bad:
+ if (sav)
+ key_freesav(sav, KEY_SADB_UNLOCKED);
+ m_freem(state->m);
+ state->m = NULL;
+ return error;
+}
+/*
+ * IPsec output logic for IPv6, tunnel mode.
+ */
+static int
+ipsec6_output_tunnel_internal(struct ipsec_output_state *state, struct secasvar *sav, int *must_be_last)
+{
+ struct ip6_hdr *ip6;
+ int error = 0;
+ int plen;
+ struct sockaddr_in6* dst6;
+ struct route *ro6;
+
+ /* validity check */
+ if (sav == NULL || sav->sah == NULL || sav->sah->saidx.mode != IPSEC_MODE_TUNNEL) {
+ error = EINVAL;
+ goto bad;
+ }
+
+ /*
+ * If there is no valid SA, we give up to process.
+ * see same place at ipsec4_output().
+ */
+ if (sav->state != SADB_SASTATE_MATURE
+ && sav->state != SADB_SASTATE_DYING) {
+ IPSEC_STAT_INCREMENT(ipsec6stat.out_nosa);
+ error = EINVAL;
+ goto bad;
+ }
+
+ state->outgoing_if = sav->sah->outgoing_if;
+
+ if (sav->sah->saidx.mode == IPSEC_MODE_TUNNEL) {
/*
- * If there is no valid SA, we give up to process.
- * see same place at ipsec4_output().
+ * build IPsec tunnel.
*/
- if (sav->state != SADB_SASTATE_MATURE
- && sav->state != SADB_SASTATE_DYING) {
- IPSEC_STAT_INCREMENT(ipsec6stat.out_nosa);
- error = EINVAL;
+ state->m = ipsec6_splithdr(state->m);
+ if (!state->m) {
+ IPSEC_STAT_INCREMENT(ipsec6stat.out_nomem);
+ error = ENOMEM;
+ goto bad;
+ }
+
+ if (((struct sockaddr *)&sav->sah->saidx.src)->sa_family == AF_INET6) {
+ error = ipsec6_encapsulate(state->m, sav);
+ if (error) {
+ state->m = 0;
+ goto bad;
+ }
+ ip6 = mtod(state->m, struct ip6_hdr *);
+ } else if (((struct sockaddr *)&sav->sah->saidx.src)->sa_family == AF_INET) {
+
+ struct ip *ip;
+ struct sockaddr_in* dst4;
+ struct route *ro4 = NULL;
+ struct route ro4_copy;
+ struct ip_out_args ipoa = { IFSCOPE_NONE, { 0 },
+ IPOAF_SELECT_SRCIF, 0 };
+
+ if (must_be_last)
+ *must_be_last = 1;
+
+ state->tunneled = 4; /* must not process any further in ip6_output */
+ error = ipsec64_encapsulate(state->m, sav);
+ if (error) {
+ state->m = 0;
+ goto bad;
+ }
+ /* Now we have an IPv4 packet */
+ ip = mtod(state->m, struct ip *);
+
+ // grab sadb_mutex, to update sah's route cache and get a local copy of it
+ lck_mtx_lock(sadb_mutex);
+ ro4 = &sav->sah->sa_route;
+ dst4 = (struct sockaddr_in *)(void *)&ro4->ro_dst;
+ if (ro4->ro_rt) {
+ RT_LOCK(ro4->ro_rt);
+ }
+ if (ROUTE_UNUSABLE(ro4) ||
+ dst4->sin_addr.s_addr != ip->ip_dst.s_addr) {
+ if (ro4->ro_rt != NULL)
+ RT_UNLOCK(ro4->ro_rt);
+ ROUTE_RELEASE(ro4);
+ }
+ if (ro4->ro_rt == NULL) {
+ dst4->sin_family = AF_INET;
+ dst4->sin_len = sizeof(*dst4);
+ dst4->sin_addr = ip->ip_dst;
+ } else {
+ RT_UNLOCK(ro4->ro_rt);
+ }
+ route_copyout(&ro4_copy, ro4, sizeof(ro4_copy));
+ // release sadb_mutex, after updating sah's route cache and getting a local copy
+ lck_mtx_unlock(sadb_mutex);
+ state->m = ipsec4_splithdr(state->m);
+ if (!state->m) {
+ error = ENOMEM;
+ ROUTE_RELEASE(&ro4_copy);
+ goto bad;
+ }
+ switch (sav->sah->saidx.proto) {
+ case IPPROTO_ESP:
+#if IPSEC_ESP
+ if ((error = esp4_output(state->m, sav)) != 0) {
+ state->m = NULL;
+ ROUTE_RELEASE(&ro4_copy);
+ goto bad;
+ }
+ break;
+
+#else
+ m_freem(state->m);
+ state->m = NULL;
+ error = EINVAL;
+ ROUTE_RELEASE(&ro4_copy);
+ goto bad;
+#endif
+ case IPPROTO_AH:
+ if ((error = ah4_output(state->m, sav)) != 0) {
+ state->m = NULL;
+ ROUTE_RELEASE(&ro4_copy);
+ goto bad;
+ }
+ break;
+ case IPPROTO_IPCOMP:
+ if ((error = ipcomp4_output(state->m, sav)) != 0) {
+ state->m = NULL;
+ ROUTE_RELEASE(&ro4_copy);
+ goto bad;
+ }
+ break;
+ default:
+ ipseclog((LOG_ERR,
+ "ipsec4_output: unknown ipsec protocol %d\n",
+ sav->sah->saidx.proto));
+ m_freem(state->m);
+ state->m = NULL;
+ error = EINVAL;
+ ROUTE_RELEASE(&ro4_copy);
+ goto bad;
+ }
+
+ if (state->m == 0) {
+ error = ENOMEM;
+ ROUTE_RELEASE(&ro4_copy);
+ goto bad;
+ }
+ ipsec_set_pkthdr_for_interface(sav->sah->ipsec_if, state->m, AF_INET);
+ ip = mtod(state->m, struct ip *);
+ ip->ip_len = ntohs(ip->ip_len); /* flip len field before calling ip_output */
+ error = ip_output(state->m, NULL, &ro4_copy, IP_OUTARGS, NULL, &ipoa);
+ state->m = NULL;
+ // grab sadb_mutex, to synchronize the sah's route cache with the local copy
+ lck_mtx_lock(sadb_mutex);
+ route_copyin(&ro4_copy, ro4, sizeof(ro4_copy));
+ lck_mtx_unlock(sadb_mutex);
+ if (error != 0)
+ goto bad;
+ goto done;
+ } else {
+ ipseclog((LOG_ERR, "ipsec6_output_tunnel: "
+ "unsupported inner family, spi=%u\n",
+ (u_int32_t)ntohl(sav->spi)));
+ IPSEC_STAT_INCREMENT(ipsec6stat.out_inval);
+ error = EAFNOSUPPORT;
+ goto bad;
+ }
+
+ // grab sadb_mutex, before updating sah's route cache
+ lck_mtx_lock(sadb_mutex);
+ ro6 = &sav->sah->sa_route;
+ dst6 = (struct sockaddr_in6 *)(void *)&ro6->ro_dst;
+ if (ro6->ro_rt) {
+ RT_LOCK(ro6->ro_rt);
+ }
+ if (ROUTE_UNUSABLE(ro6) ||
+ !IN6_ARE_ADDR_EQUAL(&dst6->sin6_addr, &ip6->ip6_dst)) {
+ if (ro6->ro_rt != NULL)
+ RT_UNLOCK(ro6->ro_rt);
+ ROUTE_RELEASE(ro6);
+ }
+ if (ro6->ro_rt == 0) {
+ bzero(dst6, sizeof(*dst6));
+ dst6->sin6_family = AF_INET6;
+ dst6->sin6_len = sizeof(*dst6);
+ dst6->sin6_addr = ip6->ip6_dst;
+ rtalloc(ro6);
+ if (ro6->ro_rt) {
+ RT_LOCK(ro6->ro_rt);
+ }
+ }
+ if (ro6->ro_rt == 0) {
+ ip6stat.ip6s_noroute++;
+ IPSEC_STAT_INCREMENT(ipsec6stat.out_noroute);
+ error = EHOSTUNREACH;
+ // release sadb_mutex, after updating sah's route cache
+ lck_mtx_unlock(sadb_mutex);
goto bad;
}
-
- switch (isr->saidx.proto) {
+
+ /*
+ * adjust state->dst if tunnel endpoint is offlink
+ *
+ * XXX: caching rt_gateway value in the state is
+ * not really good, since it may point elsewhere
+ * when the gateway gets modified to a larger
+ * sockaddr via rt_setgate(). This is currently
+ * addressed by SA_SIZE roundup in that routine.
+ */
+ if (ro6->ro_rt->rt_flags & RTF_GATEWAY)
+ dst6 = (struct sockaddr_in6 *)(void *)ro6->ro_rt->rt_gateway;
+ RT_UNLOCK(ro6->ro_rt);
+ ROUTE_RELEASE(&state->ro);
+ route_copyout(&state->ro, ro6, sizeof(state->ro));
+ state->dst = (struct sockaddr *)dst6;
+ state->tunneled = 6;
+ // release sadb_mutex, after updating sah's route cache
+ lck_mtx_unlock(sadb_mutex);
+ }
+
+ state->m = ipsec6_splithdr(state->m);
+ if (!state->m) {
+ IPSEC_STAT_INCREMENT(ipsec6stat.out_nomem);
+ error = ENOMEM;
+ goto bad;
+ }
+ ip6 = mtod(state->m, struct ip6_hdr *);
+ switch (sav->sah->saidx.proto) {
case IPPROTO_ESP:
#if IPSEC_ESP
- error = esp6_output(state->m, nexthdrp, mprev->m_next, sav);
+ error = esp6_output(state->m, &ip6->ip6_nxt, state->m->m_next, sav);
#else
m_freem(state->m);
error = EINVAL;
#endif
break;
case IPPROTO_AH:
- error = ah6_output(state->m, nexthdrp, mprev->m_next, sav);
+ error = ah6_output(state->m, &ip6->ip6_nxt, state->m->m_next, sav);
break;
case IPPROTO_IPCOMP:
- error = ipcomp6_output(state->m, nexthdrp, mprev->m_next, sav);
- break;
+ /* XXX code should be here */
+ /*FALLTHROUGH*/
default:
- ipseclog((LOG_ERR, "ipsec6_output_trans: "
- "unknown ipsec protocol %d\n", isr->saidx.proto));
+ ipseclog((LOG_ERR, "ipsec6_output_tunnel: "
+ "unknown ipsec protocol %d\n", sav->sah->saidx.proto));
m_freem(state->m);
IPSEC_STAT_INCREMENT(ipsec6stat.out_inval);
error = EINVAL;
break;
- }
- if (error) {
- state->m = NULL;
- goto bad;
- }
- plen = state->m->m_pkthdr.len - sizeof(struct ip6_hdr);
- if (plen > IPV6_MAXPACKET) {
- ipseclog((LOG_ERR, "ipsec6_output_trans: "
- "IPsec with IPv6 jumbogram is not supported\n"));
- IPSEC_STAT_INCREMENT(ipsec6stat.out_inval);
- error = EINVAL; /*XXX*/
- goto bad;
- }
- ip6 = mtod(state->m, struct ip6_hdr *);
- ip6->ip6_plen = htons(plen);
}
-
- /* if we have more to go, we need a tunnel mode processing */
- if (isr != NULL)
- *tun = 1;
-
- if (sav)
- key_freesav(sav, KEY_SADB_UNLOCKED);
+ if (error) {
+ state->m = NULL;
+ goto bad;
+ }
+ plen = state->m->m_pkthdr.len - sizeof(struct ip6_hdr);
+ if (plen > IPV6_MAXPACKET) {
+ ipseclog((LOG_ERR, "ipsec6_output_tunnel: "
+ "IPsec with IPv6 jumbogram is not supported\n"));
+ IPSEC_STAT_INCREMENT(ipsec6stat.out_inval);
+ error = EINVAL; /*XXX*/
+ goto bad;
+ }
+ ip6 = mtod(state->m, struct ip6_hdr *);
+ ip6->ip6_plen = htons(plen);
+done:
return 0;
-
+
bad:
- if (sav)
- key_freesav(sav, KEY_SADB_UNLOCKED);
- m_freem(state->m);
- state->m = NULL;
return error;
}
-/*
- * IPsec output logic for IPv6, tunnel mode.
- */
int
ipsec6_output_tunnel(
struct ipsec_output_state *state,
struct secasindex saidx;
struct secasvar *sav = NULL;
int error = 0;
- int plen;
- struct sockaddr_in6* dst6;
- struct route *ro6;
lck_mtx_assert(sadb_mutex, LCK_MTX_ASSERT_NOTOWNED);
error = EINVAL;
goto bad;
}
-
- if (isr->saidx.mode == IPSEC_MODE_TUNNEL) {
- /*
- * build IPsec tunnel.
- */
- state->m = ipsec6_splithdr(state->m);
- if (!state->m) {
- IPSEC_STAT_INCREMENT(ipsec6stat.out_nomem);
- error = ENOMEM;
- goto bad;
- }
-
- if (((struct sockaddr *)&sav->sah->saidx.src)->sa_family == AF_INET6) {
- error = ipsec6_encapsulate(state->m, sav);
- if (error) {
- state->m = 0;
- goto bad;
- }
- ip6 = mtod(state->m, struct ip6_hdr *);
- } else if (((struct sockaddr *)&sav->sah->saidx.src)->sa_family == AF_INET) {
-
- struct ip *ip;
- struct sockaddr_in* dst4;
- struct route *ro4 = NULL;
- struct route ro4_copy;
- struct ip_out_args ipoa = { IFSCOPE_NONE, { 0 },
- IPOAF_SELECT_SRCIF, 0 };
-
- /*
- * must be last isr because encapsulated IPv6 packet
- * will be sent by calling ip_output
- */
- if (isr->next) {
- ipseclog((LOG_ERR, "ipsec6_output_tunnel: "
- "IPv4 must be outer layer, spi=%u\n",
- (u_int32_t)ntohl(sav->spi)));
- error = EINVAL;
- goto bad;
- }
- state->tunneled = 4; /* must not process any further in ip6_output */
- error = ipsec64_encapsulate(state->m, sav);
- if (error) {
- state->m = 0;
- goto bad;
- }
- /* Now we have an IPv4 packet */
- ip = mtod(state->m, struct ip *);
-
- // grab sadb_mutex, to update sah's route cache and get a local copy of it
- lck_mtx_lock(sadb_mutex);
- ro4 = &sav->sah->sa_route;
- dst4 = (struct sockaddr_in *)(void *)&ro4->ro_dst;
- if (ro4->ro_rt) {
- RT_LOCK(ro4->ro_rt);
- }
- if (ROUTE_UNUSABLE(ro4) ||
- dst4->sin_addr.s_addr != ip->ip_dst.s_addr) {
- if (ro4->ro_rt != NULL)
- RT_UNLOCK(ro4->ro_rt);
- ROUTE_RELEASE(ro4);
- }
- if (ro4->ro_rt == NULL) {
- dst4->sin_family = AF_INET;
- dst4->sin_len = sizeof(*dst4);
- dst4->sin_addr = ip->ip_dst;
- } else {
- RT_UNLOCK(ro4->ro_rt);
- }
- route_copyout(&ro4_copy, ro4, sizeof(ro4_copy));
- // release sadb_mutex, after updating sah's route cache and getting a local copy
- lck_mtx_unlock(sadb_mutex);
- state->m = ipsec4_splithdr(state->m);
- if (!state->m) {
- error = ENOMEM;
- ROUTE_RELEASE(&ro4_copy);
- goto bad;
- }
- switch (isr->saidx.proto) {
- case IPPROTO_ESP:
-#if IPSEC_ESP
- if ((error = esp4_output(state->m, sav)) != 0) {
- state->m = NULL;
- ROUTE_RELEASE(&ro4_copy);
- goto bad;
- }
- break;
-
-#else
- m_freem(state->m);
- state->m = NULL;
- error = EINVAL;
- ROUTE_RELEASE(&ro4_copy);
- goto bad;
-#endif
- case IPPROTO_AH:
- if ((error = ah4_output(state->m, sav)) != 0) {
- state->m = NULL;
- ROUTE_RELEASE(&ro4_copy);
- goto bad;
- }
- break;
- case IPPROTO_IPCOMP:
- if ((error = ipcomp4_output(state->m, sav)) != 0) {
- state->m = NULL;
- ROUTE_RELEASE(&ro4_copy);
- goto bad;
- }
- break;
- default:
- ipseclog((LOG_ERR,
- "ipsec4_output: unknown ipsec protocol %d\n",
- isr->saidx.proto));
- m_freem(state->m);
- state->m = NULL;
- error = EINVAL;
- ROUTE_RELEASE(&ro4_copy);
- goto bad;
- }
- if (state->m == 0) {
- error = ENOMEM;
- ROUTE_RELEASE(&ro4_copy);
- goto bad;
- }
- ip = mtod(state->m, struct ip *);
- ip->ip_len = ntohs(ip->ip_len); /* flip len field before calling ip_output */
- error = ip_output(state->m, NULL, &ro4_copy, IP_OUTARGS, NULL, &ipoa);
- state->m = NULL;
- // grab sadb_mutex, to synchronize the sah's route cache with the local copy
- lck_mtx_lock(sadb_mutex);
- route_copyin(&ro4_copy, ro4, sizeof(ro4_copy));
- lck_mtx_unlock(sadb_mutex);
- if (error != 0)
- goto bad;
- goto done;
- } else {
- ipseclog((LOG_ERR, "ipsec6_output_tunnel: "
- "unsupported inner family, spi=%u\n",
- (u_int32_t)ntohl(sav->spi)));
- IPSEC_STAT_INCREMENT(ipsec6stat.out_inval);
- error = EAFNOSUPPORT;
- goto bad;
- }
-
- // grab sadb_mutex, before updating sah's route cache
- lck_mtx_lock(sadb_mutex);
- ro6 = &sav->sah->sa_route;
- dst6 = (struct sockaddr_in6 *)(void *)&ro6->ro_dst;
- if (ro6->ro_rt) {
- RT_LOCK(ro6->ro_rt);
- }
- if (ROUTE_UNUSABLE(ro6) ||
- !IN6_ARE_ADDR_EQUAL(&dst6->sin6_addr, &ip6->ip6_dst)) {
- if (ro6->ro_rt != NULL)
- RT_UNLOCK(ro6->ro_rt);
- ROUTE_RELEASE(ro6);
- }
- if (ro6->ro_rt == 0) {
- bzero(dst6, sizeof(*dst6));
- dst6->sin6_family = AF_INET6;
- dst6->sin6_len = sizeof(*dst6);
- dst6->sin6_addr = ip6->ip6_dst;
- rtalloc(ro6);
- if (ro6->ro_rt) {
- RT_LOCK(ro6->ro_rt);
- }
- }
- if (ro6->ro_rt == 0) {
- ip6stat.ip6s_noroute++;
- IPSEC_STAT_INCREMENT(ipsec6stat.out_noroute);
- error = EHOSTUNREACH;
- // release sadb_mutex, after updating sah's route cache
- lck_mtx_unlock(sadb_mutex);
- goto bad;
- }
-
- /*
- * adjust state->dst if tunnel endpoint is offlink
- *
- * XXX: caching rt_gateway value in the state is
- * not really good, since it may point elsewhere
- * when the gateway gets modified to a larger
- * sockaddr via rt_setgate(). This is currently
- * addressed by SA_SIZE roundup in that routine.
- */
- if (ro6->ro_rt->rt_flags & RTF_GATEWAY)
- dst6 = (struct sockaddr_in6 *)(void *)ro6->ro_rt->rt_gateway;
- RT_UNLOCK(ro6->ro_rt);
- ROUTE_RELEASE(&state->ro);
- route_copyout(&state->ro, ro6, sizeof(state->ro));
- state->dst = (struct sockaddr *)dst6;
- state->tunneled = 6;
- // release sadb_mutex, after updating sah's route cache
- lck_mtx_unlock(sadb_mutex);
- }
-
- state->m = ipsec6_splithdr(state->m);
- if (!state->m) {
- IPSEC_STAT_INCREMENT(ipsec6stat.out_nomem);
- error = ENOMEM;
+ int must_be_last = 0;
+
+ if ((error = ipsec6_output_tunnel_internal(state, sav, &must_be_last)) != 0) {
goto bad;
}
- ip6 = mtod(state->m, struct ip6_hdr *);
- switch (isr->saidx.proto) {
- case IPPROTO_ESP:
-#if IPSEC_ESP
- error = esp6_output(state->m, &ip6->ip6_nxt, state->m->m_next, sav);
-#else
- m_freem(state->m);
- error = EINVAL;
-#endif
- break;
- case IPPROTO_AH:
- error = ah6_output(state->m, &ip6->ip6_nxt, state->m->m_next, sav);
- break;
- case IPPROTO_IPCOMP:
- /* XXX code should be here */
- /*FALLTHROUGH*/
- default:
+
+ if (must_be_last && isr->next) {
ipseclog((LOG_ERR, "ipsec6_output_tunnel: "
- "unknown ipsec protocol %d\n", isr->saidx.proto));
- m_freem(state->m);
- IPSEC_STAT_INCREMENT(ipsec6stat.out_inval);
+ "IPv4 must be outer layer, spi=%u\n",
+ (u_int32_t)ntohl(sav->spi)));
error = EINVAL;
- break;
- }
- if (error) {
- state->m = NULL;
- goto bad;
- }
- plen = state->m->m_pkthdr.len - sizeof(struct ip6_hdr);
- if (plen > IPV6_MAXPACKET) {
- ipseclog((LOG_ERR, "ipsec6_output_tunnel: "
- "IPsec with IPv6 jumbogram is not supported\n"));
- IPSEC_STAT_INCREMENT(ipsec6stat.out_inval);
- error = EINVAL; /*XXX*/
goto bad;
}
- ip6 = mtod(state->m, struct ip6_hdr *);
- ip6->ip6_plen = htons(plen);
}
-done:
+
if (sav)
key_freesav(sav, KEY_SADB_UNLOCKED);
return 0;
state->m = NULL;
return error;
}
+
+int
+ipsec6_interface_output(struct ipsec_output_state *state, ifnet_t interface, u_char *nexthdrp, struct mbuf *mprev)
+{
+ int error = 0;
+ struct secasvar *sav = NULL;
+
+ lck_mtx_assert(sadb_mutex, LCK_MTX_ASSERT_NOTOWNED);
+
+ if (!state)
+ panic("state == NULL in ipsec6_output");
+ if (!state->m)
+ panic("state->m == NULL in ipsec6_output");
+ if (!nexthdrp)
+ panic("nexthdrp == NULL in ipsec6_output");
+ if (!mprev)
+ panic("mprev == NULL in ipsec6_output");
+
+ sav = key_alloc_outbound_sav_for_interface(interface, AF_INET6);
+ if (sav == NULL) {
+ goto bad;
+ }
+
+ if (sav->sah && sav->sah->saidx.mode == IPSEC_MODE_TUNNEL) {
+ if ((error = ipsec6_output_tunnel_internal(state, sav, NULL)) != 0) {
+ goto bad;
+ }
+ }
+ else {
+ if ((error = ipsec6_output_trans_internal(state, sav, nexthdrp, mprev)) != 0) {
+ goto bad;
+ }
+ }
+
+ if (sav)
+ key_freesav(sav, KEY_SADB_UNLOCKED);
+ return 0;
+
+bad:
+ if (sav)
+ key_freesav(sav, KEY_SADB_UNLOCKED);
+ m_freem(state->m);
+ state->m = NULL;
+ return error;
+}
#endif /*INET6*/
#if INET
if (bcmp(&oip->ip_dst, &sin->sin_addr, sizeof(oip->ip_dst)) != 0)
return 0;
- if (sav->utun_in_fn) {
- // the utun SAs don't have a policy (yet).
+ if (sav->utun_in_fn ||
+ sav->sah->ipsec_if != NULL) {
+ // the ipsec/utun interface SAs don't have a policies.
if (nxt == IPPROTO_IPV4) {
*ifamily = AF_INET;
} else if (nxt == IPPROTO_IPV6) {
}
int
-ipsec_setsocket(
- struct mbuf *m,
- struct socket *so)
+ipsec_setsocket(struct mbuf *m, struct socket *so)
{
struct ipsec_tag *tag;
-
+
/* if so == NULL, don't insist on getting the aux mbuf */
if (so) {
tag = ipsec_addaux(m);
}
struct socket *
-ipsec_getsocket(
- struct mbuf *m)
+ipsec_getsocket(struct mbuf *m)
{
struct ipsec_tag *itag;
struct ip_out_args ipoa =
{ IFSCOPE_NONE, { 0 }, IPOAF_SELECT_SRCIF, 0 };
struct route ro;
+ int keepalive_interval = natt_keepalive_interval;
lck_mtx_assert(sadb_mutex, LCK_MTX_ASSERT_NOTOWNED);
if ((esp_udp_encap_port & 0xFFFF) == 0 || sav->remote_ike_port == 0) return FALSE;
+ if (sav->natt_interval != 0) {
+ keepalive_interval = (int)sav->natt_interval;
+ }
+
// natt timestamp may have changed... reverify
- if ((natt_now - sav->natt_last_activity) < natt_keepalive_interval) return FALSE;
+ if ((natt_now - sav->natt_last_activity) < keepalive_interval) return FALSE;
if (sav->flags & SADB_X_EXT_ESP_KEEPALIVE) return FALSE; // don't send these from the kernel
route_copyout(&ro, &sav->sah->sa_route, sizeof(ro));
lck_mtx_unlock(sadb_mutex);
+
+ necp_mark_packet_as_keepalive(m, TRUE);
error = ip_output(m, NULL, &ro, IP_OUTARGS | IP_NOIPSEC, NULL, &ipoa);
}
return FALSE;
}
+
+__private_extern__ bool
+ipsec_fill_offload_frame(ifnet_t ifp,
+ struct secasvar *sav,
+ struct ipsec_offload_frame *frame,
+ size_t frame_data_offset)
+{
+ u_int8_t *data = NULL;
+ struct ip *ip = NULL;
+ struct udphdr *uh = NULL;
+
+ if (sav == NULL || sav->sah == NULL || frame == NULL ||
+ (ifp != NULL && ifp->if_index != sav->sah->outgoing_if) ||
+ sav->sah->saidx.dst.ss_family != AF_INET ||
+ !(sav->flags & SADB_X_EXT_NATT) ||
+ !(sav->flags & SADB_X_EXT_NATT_KEEPALIVE) ||
+ !(sav->flags & SADB_X_EXT_NATT_KEEPALIVE_OFFLOAD) ||
+ sav->flags & SADB_X_EXT_ESP_KEEPALIVE ||
+ (esp_udp_encap_port & 0xFFFF) == 0 ||
+ sav->remote_ike_port == 0 ||
+ (natt_keepalive_interval == 0 && sav->natt_interval == 0)) {
+ /* SA is not eligible for keepalive offload on this interface */
+ return (FALSE);
+ }
+
+ if (frame_data_offset + sizeof(struct udpiphdr) + 1 > IPSEC_OFFLOAD_FRAME_DATA_SIZE) {
+ /* Not enough room in this data frame */
+ return (FALSE);
+ }
+
+ data = frame->data;
+ ip = (__typeof__(ip))(void *)(data + frame_data_offset);
+ uh = (__typeof__(uh))(void *)(data + frame_data_offset + sizeof(*ip));
+
+ frame->length = frame_data_offset + sizeof(struct udpiphdr) + 1;
+ bzero(data, IPSEC_OFFLOAD_FRAME_DATA_SIZE);
+
+ ip->ip_v = IPVERSION;
+ ip->ip_hl = sizeof(struct ip) >> 2;
+ ip->ip_off &= htons(~IP_OFFMASK);
+ ip->ip_off &= htons(~IP_MF);
+ switch (ip4_ipsec_dfbit) {
+ case 0: /* clear DF bit */
+ ip->ip_off &= htons(~IP_DF);
+ break;
+ case 1: /* set DF bit */
+ ip->ip_off |= htons(IP_DF);
+ break;
+ default: /* copy DF bit */
+ break;
+ }
+ ip->ip_len = htons(sizeof(struct udpiphdr) + 1);
+ ip->ip_id = ip_randomid();
+ ip->ip_ttl = ip_defttl;
+ ip->ip_p = IPPROTO_UDP;
+ ip->ip_sum = 0;
+ if (sav->sah->dir != IPSEC_DIR_INBOUND) {
+ ip->ip_src = ((struct sockaddr_in*)&sav->sah->saidx.src)->sin_addr;
+ ip->ip_dst = ((struct sockaddr_in*)&sav->sah->saidx.dst)->sin_addr;
+ } else {
+ ip->ip_src = ((struct sockaddr_in*)&sav->sah->saidx.dst)->sin_addr;
+ ip->ip_dst = ((struct sockaddr_in*)&sav->sah->saidx.src)->sin_addr;
+ }
+ ip->ip_sum = in_cksum_hdr_opt(ip);
+ uh->uh_sport = htons((u_short)esp_udp_encap_port);
+ uh->uh_dport = htons(sav->remote_ike_port);
+ uh->uh_ulen = htons(1 + sizeof(*uh));
+ uh->uh_sum = 0;
+ *(u_int8_t*)(data + frame_data_offset + sizeof(*ip) + sizeof(*uh)) = 0xFF;
+
+ if (sav->natt_interval != 0) {
+ frame->interval = sav->natt_interval;
+ } else {
+ frame->interval = natt_keepalive_interval;
+ }
+ return (TRUE);
+}