2 * xfrm6_input.c: based on net/ipv4/xfrm4_input.c
6 * Kazunori MIYAZAWA @USAGI
7 * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
8 * YOSHIFUJI Hideaki @USAGI
12 #include <linux/module.h>
13 #include <linux/string.h>
14 #include <linux/netfilter.h>
15 #include <linux/netfilter_ipv6.h>
19 int xfrm6_rcv_spi(struct sk_buff
*skb
, __be32 spi
)
23 struct xfrm_state
*xfrm_vec
[XFRM_MAX_DEPTH
];
30 nhoff
= IP6CB(skb
)->nhoff
;
31 nexthdr
= skb
->nh
.raw
[nhoff
];
34 if (!spi
&& (err
= xfrm_parse_spi(skb
, nexthdr
, &spi
, &seq
)) != 0)
38 struct ipv6hdr
*iph
= skb
->nh
.ipv6h
;
40 if (xfrm_nr
== XFRM_MAX_DEPTH
)
43 x
= xfrm_state_lookup((xfrm_address_t
*)&iph
->daddr
, spi
, nexthdr
, AF_INET6
);
47 if (unlikely(x
->km
.state
!= XFRM_STATE_VALID
))
50 if (x
->props
.replay_window
&& xfrm_replay_check(x
, seq
))
53 if (xfrm_state_check_expire(x
))
56 nexthdr
= x
->type
->input(x
, skb
);
60 skb
->nh
.raw
[nhoff
] = nexthdr
;
62 if (x
->props
.replay_window
)
63 xfrm_replay_advance(x
, seq
);
65 x
->curlft
.bytes
+= skb
->len
;
68 spin_unlock(&x
->lock
);
70 xfrm_vec
[xfrm_nr
++] = x
;
72 if (x
->mode
->input(x
, skb
))
75 if (x
->props
.mode
== XFRM_MODE_TUNNEL
) { /* XXX */
80 if ((err
= xfrm_parse_spi(skb
, nexthdr
, &spi
, &seq
)) < 0)
84 /* Allocate new secpath or COW existing one. */
85 if (!skb
->sp
|| atomic_read(&skb
->sp
->refcnt
) != 1) {
87 sp
= secpath_dup(skb
->sp
);
95 if (xfrm_nr
+ skb
->sp
->len
> XFRM_MAX_DEPTH
)
98 memcpy(skb
->sp
->xvec
+ skb
->sp
->len
, xfrm_vec
,
99 xfrm_nr
* sizeof(xfrm_vec
[0]));
100 skb
->sp
->len
+= xfrm_nr
;
101 skb
->ip_summed
= CHECKSUM_NONE
;
106 dst_release(skb
->dst
);
111 #ifdef CONFIG_NETFILTER
112 skb
->nh
.ipv6h
->payload_len
= htons(skb
->len
);
113 __skb_push(skb
, skb
->data
- skb
->nh
.raw
);
115 NF_HOOK(PF_INET6
, NF_IP6_PRE_ROUTING
, skb
, skb
->dev
, NULL
,
124 spin_unlock(&x
->lock
);
127 while (--xfrm_nr
>= 0)
128 xfrm_state_put(xfrm_vec
[xfrm_nr
]);
133 EXPORT_SYMBOL(xfrm6_rcv_spi
);
135 int xfrm6_rcv(struct sk_buff
**pskb
)
137 return xfrm6_rcv_spi(*pskb
, 0);
140 int xfrm6_input_addr(struct sk_buff
*skb
, xfrm_address_t
*daddr
,
141 xfrm_address_t
*saddr
, u8 proto
)
143 struct xfrm_state
*x
= NULL
;
146 xfrm_address_t
*xany
;
147 struct xfrm_state
*xfrm_vec_one
= NULL
;
151 ipv6_addr_set(&any
, 0, 0, 0, 0);
152 xany
= (xfrm_address_t
*)&any
;
154 for (i
= 0; i
< 3; i
++) {
155 xfrm_address_t
*dst
, *src
;
162 /* lookup state with wild-card source address */
169 /* lookup state with wild-card addresses */
170 wildcard
= 1; /* XXX */
176 x
= xfrm_state_lookup_byaddr(dst
, src
, proto
, AF_INET6
);
183 if ((x
->props
.flags
& XFRM_STATE_WILDRECV
) == 0) {
184 spin_unlock(&x
->lock
);
191 if (unlikely(x
->km
.state
!= XFRM_STATE_VALID
)) {
192 spin_unlock(&x
->lock
);
197 if (xfrm_state_check_expire(x
)) {
198 spin_unlock(&x
->lock
);
204 nh
= x
->type
->input(x
, skb
);
206 spin_unlock(&x
->lock
);
212 x
->curlft
.bytes
+= skb
->len
;
215 spin_unlock(&x
->lock
);
224 /* Allocate new secpath or COW existing one. */
225 if (!skb
->sp
|| atomic_read(&skb
->sp
->refcnt
) != 1) {
227 sp
= secpath_dup(skb
->sp
);
231 secpath_put(skb
->sp
);
235 if (1 + skb
->sp
->len
> XFRM_MAX_DEPTH
)
238 skb
->sp
->xvec
[skb
->sp
->len
] = xfrm_vec_one
;
244 xfrm_state_put(xfrm_vec_one
);