2005-04-17 00:20:36 +02:00
|
|
|
/*
|
|
|
|
* xfrm6_state.c: based on xfrm4_state.c
|
|
|
|
*
|
|
|
|
* Authors:
|
|
|
|
* Mitsuru KANDA @USAGI
|
|
|
|
* Kazunori MIYAZAWA @USAGI
|
|
|
|
* Kunihiro Ishiguro <kunihiro@ipinfusion.com>
|
|
|
|
* IPv6 support
|
|
|
|
* YOSHIFUJI Hideaki @USAGI
|
|
|
|
* Split up af-specific portion
|
2007-02-09 15:24:49 +01:00
|
|
|
*
|
2005-04-17 00:20:36 +02:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <net/xfrm.h>
|
|
|
|
#include <linux/pfkeyv2.h>
|
|
|
|
#include <linux/ipsec.h>
|
2007-11-14 06:43:11 +01:00
|
|
|
#include <linux/netfilter_ipv6.h>
|
2007-11-14 06:40:52 +01:00
|
|
|
#include <net/dsfield.h>
|
2005-04-17 00:20:36 +02:00
|
|
|
#include <net/ipv6.h>
|
2006-01-13 23:34:36 +01:00
|
|
|
#include <net/addrconf.h>
|
2005-04-17 00:20:36 +02:00
|
|
|
|
|
|
|
static void
|
2011-02-23 02:51:44 +01:00
|
|
|
__xfrm6_init_tempsel(struct xfrm_selector *sel, const struct flowi *fl)
|
2005-04-17 00:20:36 +02:00
|
|
|
{
|
|
|
|
/* Initialize temporary selector matching only
|
|
|
|
* to current session. */
|
2010-09-20 20:11:38 +02:00
|
|
|
ipv6_addr_copy((struct in6_addr *)&sel->daddr, &fl->fl6_dst);
|
|
|
|
ipv6_addr_copy((struct in6_addr *)&sel->saddr, &fl->fl6_src);
|
|
|
|
sel->dport = xfrm_flowi_dport(fl);
|
|
|
|
sel->dport_mask = htons(0xffff);
|
|
|
|
sel->sport = xfrm_flowi_sport(fl);
|
|
|
|
sel->sport_mask = htons(0xffff);
|
|
|
|
sel->family = AF_INET6;
|
|
|
|
sel->prefixlen_d = 128;
|
|
|
|
sel->prefixlen_s = 128;
|
|
|
|
sel->proto = fl->proto;
|
|
|
|
sel->ifindex = fl->oif;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void
|
|
|
|
xfrm6_init_temprop(struct xfrm_state *x, struct xfrm_tmpl *tmpl,
|
|
|
|
xfrm_address_t *daddr, xfrm_address_t *saddr)
|
|
|
|
{
|
2005-04-17 00:20:36 +02:00
|
|
|
x->id = tmpl->id;
|
|
|
|
if (ipv6_addr_any((struct in6_addr*)&x->id.daddr))
|
|
|
|
memcpy(&x->id.daddr, daddr, sizeof(x->sel.daddr));
|
|
|
|
memcpy(&x->props.saddr, &tmpl->saddr, sizeof(x->props.saddr));
|
|
|
|
if (ipv6_addr_any((struct in6_addr*)&x->props.saddr))
|
|
|
|
memcpy(&x->props.saddr, saddr, sizeof(x->props.saddr));
|
|
|
|
x->props.mode = tmpl->mode;
|
|
|
|
x->props.reqid = tmpl->reqid;
|
|
|
|
x->props.family = AF_INET6;
|
|
|
|
}
|
|
|
|
|
2008-02-19 02:15:27 +01:00
|
|
|
/* distribution counting sort function for xfrm_state and xfrm_tmpl */
|
2006-08-24 07:51:02 +02:00
|
|
|
static int
|
2008-02-19 02:15:27 +01:00
|
|
|
__xfrm6_sort(void **dst, void **src, int n, int (*cmp)(void *p), int maxclass)
|
2006-08-24 07:51:02 +02:00
|
|
|
{
|
|
|
|
int i;
|
2008-02-19 02:15:27 +01:00
|
|
|
int class[XFRM_MAX_DEPTH];
|
|
|
|
int count[maxclass];
|
2006-08-24 07:51:02 +02:00
|
|
|
|
2008-02-19 02:15:27 +01:00
|
|
|
memset(count, 0, sizeof(count));
|
2006-08-24 07:51:02 +02:00
|
|
|
|
2006-08-24 07:54:07 +02:00
|
|
|
for (i = 0; i < n; i++) {
|
2008-02-19 02:15:27 +01:00
|
|
|
int c;
|
|
|
|
class[i] = c = cmp(src[i]);
|
|
|
|
count[c]++;
|
2006-08-24 07:54:07 +02:00
|
|
|
}
|
2006-08-24 07:51:02 +02:00
|
|
|
|
2008-02-19 02:15:27 +01:00
|
|
|
for (i = 2; i < maxclass; i++)
|
|
|
|
count[i] += count[i - 1];
|
2006-08-24 07:51:02 +02:00
|
|
|
|
|
|
|
for (i = 0; i < n; i++) {
|
2008-02-19 02:15:27 +01:00
|
|
|
dst[count[class[i] - 1]++] = src[i];
|
2009-02-22 08:37:10 +01:00
|
|
|
src[i] = NULL;
|
2006-08-24 07:51:02 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2008-02-19 02:15:27 +01:00
|
|
|
/*
|
|
|
|
* Rule for xfrm_state:
|
|
|
|
*
|
|
|
|
* rule 1: select IPsec transport except AH
|
|
|
|
* rule 2: select MIPv6 RO or inbound trigger
|
|
|
|
* rule 3: select IPsec transport AH
|
|
|
|
* rule 4: select IPsec tunnel
|
|
|
|
* rule 5: others
|
|
|
|
*/
|
|
|
|
static int __xfrm6_state_sort_cmp(void *p)
|
2006-08-24 07:51:02 +02:00
|
|
|
{
|
2008-02-19 02:15:27 +01:00
|
|
|
struct xfrm_state *v = p;
|
|
|
|
|
|
|
|
switch (v->props.mode) {
|
|
|
|
case XFRM_MODE_TRANSPORT:
|
|
|
|
if (v->id.proto != IPPROTO_AH)
|
|
|
|
return 1;
|
|
|
|
else
|
|
|
|
return 3;
|
2007-06-27 08:56:32 +02:00
|
|
|
#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
|
2008-02-19 02:15:27 +01:00
|
|
|
case XFRM_MODE_ROUTEOPTIMIZATION:
|
|
|
|
case XFRM_MODE_IN_TRIGGER:
|
|
|
|
return 2;
|
2006-08-24 07:54:07 +02:00
|
|
|
#endif
|
2008-02-19 02:15:27 +01:00
|
|
|
case XFRM_MODE_TUNNEL:
|
|
|
|
case XFRM_MODE_BEET:
|
|
|
|
return 4;
|
2006-08-24 07:51:02 +02:00
|
|
|
}
|
2008-02-19 02:15:27 +01:00
|
|
|
return 5;
|
|
|
|
}
|
2006-08-24 07:51:02 +02:00
|
|
|
|
2008-02-19 02:15:27 +01:00
|
|
|
static int
|
|
|
|
__xfrm6_state_sort(struct xfrm_state **dst, struct xfrm_state **src, int n)
|
|
|
|
{
|
|
|
|
return __xfrm6_sort((void **)dst, (void **)src, n,
|
|
|
|
__xfrm6_state_sort_cmp, 6);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Rule for xfrm_tmpl:
|
|
|
|
*
|
|
|
|
* rule 1: select IPsec transport
|
|
|
|
* rule 2: select MIPv6 RO or inbound trigger
|
|
|
|
* rule 3: select IPsec tunnel
|
|
|
|
* rule 4: others
|
|
|
|
*/
|
|
|
|
static int __xfrm6_tmpl_sort_cmp(void *p)
|
|
|
|
{
|
|
|
|
struct xfrm_tmpl *v = p;
|
|
|
|
switch (v->mode) {
|
|
|
|
case XFRM_MODE_TRANSPORT:
|
|
|
|
return 1;
|
|
|
|
#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
|
|
|
|
case XFRM_MODE_ROUTEOPTIMIZATION:
|
|
|
|
case XFRM_MODE_IN_TRIGGER:
|
|
|
|
return 2;
|
|
|
|
#endif
|
|
|
|
case XFRM_MODE_TUNNEL:
|
|
|
|
case XFRM_MODE_BEET:
|
|
|
|
return 3;
|
2006-08-24 07:51:02 +02:00
|
|
|
}
|
2008-02-19 02:15:27 +01:00
|
|
|
return 4;
|
|
|
|
}
|
2006-08-24 07:51:02 +02:00
|
|
|
|
2008-02-19 02:15:27 +01:00
|
|
|
static int
|
|
|
|
__xfrm6_tmpl_sort(struct xfrm_tmpl **dst, struct xfrm_tmpl **src, int n)
|
|
|
|
{
|
|
|
|
return __xfrm6_sort((void **)dst, (void **)src, n,
|
|
|
|
__xfrm6_tmpl_sort_cmp, 5);
|
2006-08-24 07:51:02 +02:00
|
|
|
}
|
|
|
|
|
2007-11-14 06:40:52 +01:00
|
|
|
int xfrm6_extract_header(struct sk_buff *skb)
|
|
|
|
{
|
|
|
|
struct ipv6hdr *iph = ipv6_hdr(skb);
|
|
|
|
|
2008-03-27 00:51:09 +01:00
|
|
|
XFRM_MODE_SKB_CB(skb)->ihl = sizeof(*iph);
|
2007-11-14 06:40:52 +01:00
|
|
|
XFRM_MODE_SKB_CB(skb)->id = 0;
|
|
|
|
XFRM_MODE_SKB_CB(skb)->frag_off = htons(IP_DF);
|
|
|
|
XFRM_MODE_SKB_CB(skb)->tos = ipv6_get_dsfield(iph);
|
|
|
|
XFRM_MODE_SKB_CB(skb)->ttl = iph->hop_limit;
|
2008-03-27 00:51:09 +01:00
|
|
|
XFRM_MODE_SKB_CB(skb)->optlen = 0;
|
2007-11-14 06:40:52 +01:00
|
|
|
memcpy(XFRM_MODE_SKB_CB(skb)->flow_lbl, iph->flow_lbl,
|
|
|
|
sizeof(XFRM_MODE_SKB_CB(skb)->flow_lbl));
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2005-04-17 00:20:36 +02:00
|
|
|
static struct xfrm_state_afinfo xfrm6_state_afinfo = {
|
|
|
|
.family = AF_INET6,
|
2007-11-14 06:40:52 +01:00
|
|
|
.proto = IPPROTO_IPV6,
|
2007-11-14 06:41:28 +01:00
|
|
|
.eth_proto = htons(ETH_P_IPV6),
|
2007-10-18 06:33:12 +02:00
|
|
|
.owner = THIS_MODULE,
|
2005-04-17 00:20:36 +02:00
|
|
|
.init_tempsel = __xfrm6_init_tempsel,
|
2010-09-20 20:11:38 +02:00
|
|
|
.init_temprop = xfrm6_init_temprop,
|
2006-08-24 07:51:02 +02:00
|
|
|
.tmpl_sort = __xfrm6_tmpl_sort,
|
|
|
|
.state_sort = __xfrm6_state_sort,
|
2007-02-06 23:24:56 +01:00
|
|
|
.output = xfrm6_output,
|
2007-11-14 06:41:28 +01:00
|
|
|
.extract_input = xfrm6_extract_input,
|
2007-11-14 06:40:52 +01:00
|
|
|
.extract_output = xfrm6_extract_output,
|
2007-11-14 06:44:23 +01:00
|
|
|
.transport_finish = xfrm6_transport_finish,
|
2005-04-17 00:20:36 +02:00
|
|
|
};
|
|
|
|
|
2007-12-07 09:42:11 +01:00
|
|
|
int __init xfrm6_state_init(void)
|
2005-04-17 00:20:36 +02:00
|
|
|
{
|
2007-12-07 09:42:11 +01:00
|
|
|
return xfrm_state_register_afinfo(&xfrm6_state_afinfo);
|
2005-04-17 00:20:36 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void xfrm6_state_fini(void)
|
|
|
|
{
|
|
|
|
xfrm_state_unregister_afinfo(&xfrm6_state_afinfo);
|
|
|
|
}
|
|
|
|
|