5 * YOSHIFUJI Hideaki @USAGI
6 * Split up af-specific portion
10 #include <linux/slab.h>
11 #include <linux/module.h>
12 #include <linux/netdevice.h>
17 static struct kmem_cache
*secpath_cachep __read_mostly
;
19 void __secpath_destroy(struct sec_path
*sp
)
22 for (i
= 0; i
< sp
->len
; i
++)
23 xfrm_state_put(sp
->xvec
[i
]);
24 kmem_cache_free(secpath_cachep
, sp
);
26 EXPORT_SYMBOL(__secpath_destroy
);
28 struct sec_path
*secpath_dup(struct sec_path
*src
)
32 sp
= kmem_cache_alloc(secpath_cachep
, GFP_ATOMIC
);
40 memcpy(sp
, src
, sizeof(*sp
));
41 for (i
= 0; i
< sp
->len
; i
++)
42 xfrm_state_hold(sp
->xvec
[i
]);
44 atomic_set(&sp
->refcnt
, 1);
47 EXPORT_SYMBOL(secpath_dup
);
49 /* Fetch spi and seq from ipsec header */
51 int xfrm_parse_spi(struct sk_buff
*skb
, u8 nexthdr
, __be32
*spi
, __be32
*seq
)
53 int offset
, offset_seq
;
58 hlen
= sizeof(struct ip_auth_hdr
);
59 offset
= offsetof(struct ip_auth_hdr
, spi
);
60 offset_seq
= offsetof(struct ip_auth_hdr
, seq_no
);
63 hlen
= sizeof(struct ip_esp_hdr
);
64 offset
= offsetof(struct ip_esp_hdr
, spi
);
65 offset_seq
= offsetof(struct ip_esp_hdr
, seq_no
);
68 if (!pskb_may_pull(skb
, sizeof(struct ip_comp_hdr
)))
70 *spi
= htonl(ntohs(*(__be16
*)(skb_transport_header(skb
) + 2)));
77 if (!pskb_may_pull(skb
, hlen
))
80 *spi
= *(__be32
*)(skb_transport_header(skb
) + offset
);
81 *seq
= *(__be32
*)(skb_transport_header(skb
) + offset_seq
);
84 EXPORT_SYMBOL(xfrm_parse_spi
);
86 int xfrm_prepare_input(struct xfrm_state
*x
, struct sk_buff
*skb
)
90 err
= x
->outer_mode
->afinfo
->extract_input(x
, skb
);
94 skb
->protocol
= x
->inner_mode
->afinfo
->eth_proto
;
95 return x
->inner_mode
->input2(x
, skb
);
97 EXPORT_SYMBOL(xfrm_prepare_input
);
99 int xfrm_input(struct sk_buff
*skb
, int nexthdr
, __be32 spi
, int encap_type
)
103 struct xfrm_state
*xfrm_vec
[XFRM_MAX_DEPTH
];
104 struct xfrm_state
*x
;
107 unsigned int nhoff
= XFRM_SPI_SKB_CB(skb
)->nhoff
;
108 unsigned int daddroff
= XFRM_SPI_SKB_CB(skb
)->daddroff
;
111 if (!spi
&& (err
= xfrm_parse_spi(skb
, nexthdr
, &spi
, &seq
)) != 0)
115 if (xfrm_nr
== XFRM_MAX_DEPTH
)
118 x
= xfrm_state_lookup((xfrm_address_t
*)
119 (skb_network_header(skb
) + daddroff
),
120 spi
, nexthdr
, AF_INET
);
125 if (unlikely(x
->km
.state
!= XFRM_STATE_VALID
))
128 if ((x
->encap
? x
->encap
->encap_type
: 0) != encap_type
)
131 if (x
->props
.replay_window
&& xfrm_replay_check(x
, seq
))
134 if (xfrm_state_check_expire(x
))
137 nexthdr
= x
->type
->input(x
, skb
);
141 skb_network_header(skb
)[nhoff
] = nexthdr
;
143 /* only the first xfrm gets the encap type */
146 if (x
->props
.replay_window
)
147 xfrm_replay_advance(x
, seq
);
149 x
->curlft
.bytes
+= skb
->len
;
152 spin_unlock(&x
->lock
);
154 xfrm_vec
[xfrm_nr
++] = x
;
156 if (x
->inner_mode
->input(x
, skb
))
159 if (x
->outer_mode
->flags
& XFRM_MODE_FLAG_TUNNEL
) {
164 err
= xfrm_parse_spi(skb
, nexthdr
, &spi
, &seq
);
169 /* Allocate new secpath or COW existing one. */
171 if (!skb
->sp
|| atomic_read(&skb
->sp
->refcnt
) != 1) {
173 sp
= secpath_dup(skb
->sp
);
177 secpath_put(skb
->sp
);
180 if (xfrm_nr
+ skb
->sp
->len
> XFRM_MAX_DEPTH
)
183 memcpy(skb
->sp
->xvec
+ skb
->sp
->len
, xfrm_vec
,
184 xfrm_nr
* sizeof(xfrm_vec
[0]));
185 skb
->sp
->len
+= xfrm_nr
;
190 dst_release(skb
->dst
);
195 return x
->inner_mode
->afinfo
->transport_finish(skb
, 0);
199 spin_unlock(&x
->lock
);
202 while (--xfrm_nr
>= 0)
203 xfrm_state_put(xfrm_vec
[xfrm_nr
]);
208 EXPORT_SYMBOL(xfrm_input
);
210 void __init
xfrm_input_init(void)
212 secpath_cachep
= kmem_cache_create("secpath_cache",
213 sizeof(struct sec_path
),
214 0, SLAB_HWCACHE_ALIGN
|SLAB_PANIC
,