2 * xfrm6_policy.c: based on xfrm4_policy.c
6 * Kazunori MIYAZAWA @USAGI
7 * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
10 * Split up af-specific portion
14 #include <linux/err.h>
15 #include <linux/kernel.h>
16 #include <linux/netdevice.h>
17 #include <net/addrconf.h>
22 #include <net/ip6_route.h>
23 #if IS_ENABLED(CONFIG_IPV6_MIP6)
27 static struct xfrm_policy_afinfo xfrm6_policy_afinfo
;
29 static struct dst_entry
*xfrm6_dst_lookup(struct net
*net
, int tos
,
30 const xfrm_address_t
*saddr
,
31 const xfrm_address_t
*daddr
)
34 struct dst_entry
*dst
;
37 memset(&fl6
, 0, sizeof(fl6
));
38 memcpy(&fl6
.daddr
, daddr
, sizeof(fl6
.daddr
));
40 memcpy(&fl6
.saddr
, saddr
, sizeof(fl6
.saddr
));
42 dst
= ip6_route_output(net
, NULL
, &fl6
);
53 static int xfrm6_get_saddr(struct net
*net
,
54 xfrm_address_t
*saddr
, xfrm_address_t
*daddr
)
56 struct dst_entry
*dst
;
57 struct net_device
*dev
;
59 dst
= xfrm6_dst_lookup(net
, 0, NULL
, daddr
);
63 dev
= ip6_dst_idev(dst
)->dev
;
64 ipv6_dev_get_saddr(dev_net(dev
), dev
, &daddr
->in6
, 0, &saddr
->in6
);
69 static int xfrm6_get_tos(const struct flowi
*fl
)
74 static int xfrm6_init_path(struct xfrm_dst
*path
, struct dst_entry
*dst
,
77 if (dst
->ops
->family
== AF_INET6
) {
78 struct rt6_info
*rt
= (struct rt6_info
*)dst
;
79 path
->path_cookie
= rt6_get_cookie(rt
);
82 path
->u
.rt6
.rt6i_nfheader_len
= nfheader_len
;
87 static int xfrm6_fill_dst(struct xfrm_dst
*xdst
, struct net_device
*dev
,
88 const struct flowi
*fl
)
90 struct rt6_info
*rt
= (struct rt6_info
*)xdst
->route
;
92 xdst
->u
.dst
.dev
= dev
;
95 xdst
->u
.rt6
.rt6i_idev
= in6_dev_get(dev
);
96 if (!xdst
->u
.rt6
.rt6i_idev
) {
101 /* Sheit... I remember I did this right. Apparently,
102 * it was magically lost, so this code needs audit */
103 xdst
->u
.rt6
.rt6i_flags
= rt
->rt6i_flags
& (RTF_ANYCAST
|
105 xdst
->u
.rt6
.rt6i_metric
= rt
->rt6i_metric
;
106 xdst
->u
.rt6
.rt6i_node
= rt
->rt6i_node
;
107 xdst
->route_cookie
= rt6_get_cookie(rt
);
108 xdst
->u
.rt6
.rt6i_gateway
= rt
->rt6i_gateway
;
109 xdst
->u
.rt6
.rt6i_dst
= rt
->rt6i_dst
;
110 xdst
->u
.rt6
.rt6i_src
= rt
->rt6i_src
;
116 _decode_session6(struct sk_buff
*skb
, struct flowi
*fl
, int reverse
)
118 struct flowi6
*fl6
= &fl
->u
.ip6
;
120 const struct ipv6hdr
*hdr
= ipv6_hdr(skb
);
121 u16 offset
= sizeof(*hdr
);
122 struct ipv6_opt_hdr
*exthdr
;
123 const unsigned char *nh
= skb_network_header(skb
);
124 u16 nhoff
= IP6CB(skb
)->nhoff
;
129 nhoff
= offsetof(struct ipv6hdr
, nexthdr
);
134 oif
= skb_dst(skb
)->dev
->ifindex
;
136 memset(fl6
, 0, sizeof(struct flowi6
));
137 fl6
->flowi6_mark
= skb
->mark
;
138 fl6
->flowi6_oif
= reverse
? skb
->skb_iif
: oif
;
140 fl6
->daddr
= reverse
? hdr
->saddr
: hdr
->daddr
;
141 fl6
->saddr
= reverse
? hdr
->daddr
: hdr
->saddr
;
143 while (nh
+ offset
+ 1 < skb
->data
||
144 pskb_may_pull(skb
, nh
+ offset
+ 1 - skb
->data
)) {
145 nh
= skb_network_header(skb
);
146 exthdr
= (struct ipv6_opt_hdr
*)(nh
+ offset
);
149 case NEXTHDR_FRAGMENT
:
151 case NEXTHDR_ROUTING
:
154 offset
+= ipv6_optlen(exthdr
);
155 nexthdr
= exthdr
->nexthdr
;
156 exthdr
= (struct ipv6_opt_hdr
*)(nh
+ offset
);
160 case IPPROTO_UDPLITE
:
164 if (!onlyproto
&& (nh
+ offset
+ 4 < skb
->data
||
165 pskb_may_pull(skb
, nh
+ offset
+ 4 - skb
->data
))) {
168 nh
= skb_network_header(skb
);
169 ports
= (__be16
*)(nh
+ offset
);
170 fl6
->fl6_sport
= ports
[!!reverse
];
171 fl6
->fl6_dport
= ports
[!reverse
];
173 fl6
->flowi6_proto
= nexthdr
;
177 if (!onlyproto
&& pskb_may_pull(skb
, nh
+ offset
+ 2 - skb
->data
)) {
180 nh
= skb_network_header(skb
);
181 icmp
= (u8
*)(nh
+ offset
);
182 fl6
->fl6_icmp_type
= icmp
[0];
183 fl6
->fl6_icmp_code
= icmp
[1];
185 fl6
->flowi6_proto
= nexthdr
;
188 #if IS_ENABLED(CONFIG_IPV6_MIP6)
190 offset
+= ipv6_optlen(exthdr
);
191 if (!onlyproto
&& pskb_may_pull(skb
, nh
+ offset
+ 3 - skb
->data
)) {
194 nh
= skb_network_header(skb
);
195 mh
= (struct ip6_mh
*)(nh
+ offset
);
196 fl6
->fl6_mh_type
= mh
->ip6mh_type
;
198 fl6
->flowi6_proto
= nexthdr
;
202 /* XXX Why are there these headers? */
207 fl6
->fl6_ipsec_spi
= 0;
208 fl6
->flowi6_proto
= nexthdr
;
214 static inline int xfrm6_garbage_collect(struct dst_ops
*ops
)
216 struct net
*net
= container_of(ops
, struct net
, xfrm
.xfrm6_dst_ops
);
218 xfrm6_policy_afinfo
.garbage_collect(net
);
219 return dst_entries_get_fast(ops
) > ops
->gc_thresh
* 2;
222 static void xfrm6_update_pmtu(struct dst_entry
*dst
, struct sock
*sk
,
223 struct sk_buff
*skb
, u32 mtu
)
225 struct xfrm_dst
*xdst
= (struct xfrm_dst
*)dst
;
226 struct dst_entry
*path
= xdst
->route
;
228 path
->ops
->update_pmtu(path
, sk
, skb
, mtu
);
231 static void xfrm6_redirect(struct dst_entry
*dst
, struct sock
*sk
,
234 struct xfrm_dst
*xdst
= (struct xfrm_dst
*)dst
;
235 struct dst_entry
*path
= xdst
->route
;
237 path
->ops
->redirect(path
, sk
, skb
);
240 static void xfrm6_dst_destroy(struct dst_entry
*dst
)
242 struct xfrm_dst
*xdst
= (struct xfrm_dst
*)dst
;
244 if (likely(xdst
->u
.rt6
.rt6i_idev
))
245 in6_dev_put(xdst
->u
.rt6
.rt6i_idev
);
246 dst_destroy_metrics_generic(dst
);
247 xfrm_dst_destroy(xdst
);
250 static void xfrm6_dst_ifdown(struct dst_entry
*dst
, struct net_device
*dev
,
253 struct xfrm_dst
*xdst
;
258 xdst
= (struct xfrm_dst
*)dst
;
259 if (xdst
->u
.rt6
.rt6i_idev
->dev
== dev
) {
260 struct inet6_dev
*loopback_idev
=
261 in6_dev_get(dev_net(dev
)->loopback_dev
);
262 BUG_ON(!loopback_idev
);
265 in6_dev_put(xdst
->u
.rt6
.rt6i_idev
);
266 xdst
->u
.rt6
.rt6i_idev
= loopback_idev
;
267 in6_dev_hold(loopback_idev
);
268 xdst
= (struct xfrm_dst
*)xdst
->u
.dst
.child
;
269 } while (xdst
->u
.dst
.xfrm
);
271 __in6_dev_put(loopback_idev
);
274 xfrm_dst_ifdown(dst
, dev
);
277 static struct dst_ops xfrm6_dst_ops
= {
279 .gc
= xfrm6_garbage_collect
,
280 .update_pmtu
= xfrm6_update_pmtu
,
281 .redirect
= xfrm6_redirect
,
282 .cow_metrics
= dst_cow_metrics_generic
,
283 .destroy
= xfrm6_dst_destroy
,
284 .ifdown
= xfrm6_dst_ifdown
,
285 .local_out
= __ip6_local_out
,
289 static struct xfrm_policy_afinfo xfrm6_policy_afinfo
= {
291 .dst_ops
= &xfrm6_dst_ops
,
292 .dst_lookup
= xfrm6_dst_lookup
,
293 .get_saddr
= xfrm6_get_saddr
,
294 .decode_session
= _decode_session6
,
295 .get_tos
= xfrm6_get_tos
,
296 .init_path
= xfrm6_init_path
,
297 .fill_dst
= xfrm6_fill_dst
,
298 .blackhole_route
= ip6_blackhole_route
,
301 static int __init
xfrm6_policy_init(void)
303 return xfrm_policy_register_afinfo(&xfrm6_policy_afinfo
);
306 static void xfrm6_policy_fini(void)
308 xfrm_policy_unregister_afinfo(&xfrm6_policy_afinfo
);
312 static struct ctl_table xfrm6_policy_table
[] = {
314 .procname
= "xfrm6_gc_thresh",
315 .data
= &init_net
.xfrm
.xfrm6_dst_ops
.gc_thresh
,
316 .maxlen
= sizeof(int),
318 .proc_handler
= proc_dointvec
,
323 static int __net_init
xfrm6_net_init(struct net
*net
)
325 struct ctl_table
*table
;
326 struct ctl_table_header
*hdr
;
328 table
= xfrm6_policy_table
;
329 if (!net_eq(net
, &init_net
)) {
330 table
= kmemdup(table
, sizeof(xfrm6_policy_table
), GFP_KERNEL
);
334 table
[0].data
= &net
->xfrm
.xfrm6_dst_ops
.gc_thresh
;
337 hdr
= register_net_sysctl(net
, "net/ipv6", table
);
341 net
->ipv6
.sysctl
.xfrm6_hdr
= hdr
;
345 if (!net_eq(net
, &init_net
))
351 static void __net_exit
xfrm6_net_exit(struct net
*net
)
353 struct ctl_table
*table
;
355 if (!net
->ipv6
.sysctl
.xfrm6_hdr
)
358 table
= net
->ipv6
.sysctl
.xfrm6_hdr
->ctl_table_arg
;
359 unregister_net_sysctl_table(net
->ipv6
.sysctl
.xfrm6_hdr
);
360 if (!net_eq(net
, &init_net
))
364 static struct pernet_operations xfrm6_net_ops
= {
365 .init
= xfrm6_net_init
,
366 .exit
= xfrm6_net_exit
,
370 int __init
xfrm6_init(void)
374 dst_entries_init(&xfrm6_dst_ops
);
376 ret
= xfrm6_policy_init();
378 dst_entries_destroy(&xfrm6_dst_ops
);
381 ret
= xfrm6_state_init();
385 ret
= xfrm6_protocol_init();
390 register_pernet_subsys(&xfrm6_net_ops
);
401 void xfrm6_fini(void)
404 unregister_pernet_subsys(&xfrm6_net_ops
);
406 xfrm6_protocol_fini();
409 dst_entries_destroy(&xfrm6_dst_ops
);