blob: f04516c880fb2daa9a29ce68287d136e863b3c6c [file] [log] [blame]
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 * xfrm4_policy.c
3 *
4 * Changes:
5 * Kazunori MIYAZAWA @USAGI
6 * YOSHIFUJI Hideaki @USAGI
7 * Split up af-specific portion
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09008 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 */
10
Herbert Xu66cdb3c2007-11-13 21:37:28 -080011#include <linux/err.h>
12#include <linux/kernel.h>
Herbert Xuaabc9762005-05-03 16:27:10 -070013#include <linux/inetdevice.h>
Herbert Xu45ff5a32007-11-13 21:35:32 -080014#include <net/dst.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <net/xfrm.h>
16#include <net/ip.h>
17
18static struct dst_ops xfrm4_dst_ops;
19static struct xfrm_policy_afinfo xfrm4_policy_afinfo;
20
Herbert Xu66cdb3c2007-11-13 21:37:28 -080021static struct dst_entry *xfrm4_dst_lookup(int tos, xfrm_address_t *saddr,
22 xfrm_address_t *daddr)
Linus Torvalds1da177e2005-04-16 15:20:36 -070023{
Herbert Xu66cdb3c2007-11-13 21:37:28 -080024 struct flowi fl = {
Patrick McHardya1e59ab2006-09-19 12:57:34 -070025 .nl_u = {
26 .ip4_u = {
Herbert Xu66cdb3c2007-11-13 21:37:28 -080027 .tos = tos,
Patrick McHardya1e59ab2006-09-19 12:57:34 -070028 .daddr = daddr->a4,
29 },
30 },
31 };
Herbert Xu66cdb3c2007-11-13 21:37:28 -080032 struct dst_entry *dst;
33 struct rtable *rt;
34 int err;
Patrick McHardya1e59ab2006-09-19 12:57:34 -070035
Herbert Xu66cdb3c2007-11-13 21:37:28 -080036 if (saddr)
37 fl.fl4_src = saddr->a4;
38
39 err = __ip_route_output_key(&rt, &fl);
40 dst = &rt->u.dst;
41 if (err)
42 dst = ERR_PTR(err);
43 return dst;
44}
45
46static int xfrm4_get_saddr(xfrm_address_t *saddr, xfrm_address_t *daddr)
47{
48 struct dst_entry *dst;
49 struct rtable *rt;
50
51 dst = xfrm4_dst_lookup(0, NULL, daddr);
52 if (IS_ERR(dst))
53 return -EHOSTUNREACH;
54
55 rt = (struct rtable *)dst;
56 saddr->a4 = rt->rt_src;
57 dst_release(dst);
58 return 0;
Patrick McHardya1e59ab2006-09-19 12:57:34 -070059}
60
Linus Torvalds1da177e2005-04-16 15:20:36 -070061static struct dst_entry *
62__xfrm4_find_bundle(struct flowi *fl, struct xfrm_policy *policy)
63{
64 struct dst_entry *dst;
65
66 read_lock_bh(&policy->lock);
67 for (dst = policy->bundles; dst; dst = dst->next) {
68 struct xfrm_dst *xdst = (struct xfrm_dst*)dst;
69 if (xdst->u.rt.fl.oif == fl->oif && /*XXX*/
70 xdst->u.rt.fl.fl4_dst == fl->fl4_dst &&
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090071 xdst->u.rt.fl.fl4_src == fl->fl4_src &&
72 xdst->u.rt.fl.fl4_tos == fl->fl4_tos &&
Venkat Yekkirala5b368e62006-10-05 15:42:18 -050073 xfrm_bundle_ok(policy, xdst, fl, AF_INET, 0)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -070074 dst_clone(dst);
75 break;
76 }
77 }
78 read_unlock_bh(&policy->lock);
79 return dst;
80}
81
Herbert Xu25ee3282007-12-11 09:32:34 -080082static int xfrm4_get_tos(struct flowi *fl)
Linus Torvalds1da177e2005-04-16 15:20:36 -070083{
Herbert Xu25ee3282007-12-11 09:32:34 -080084 return fl->fl4_tos;
85}
Linus Torvalds1da177e2005-04-16 15:20:36 -070086
Masahide NAKAMURAa1b05142007-12-20 20:41:12 -080087static int xfrm4_init_path(struct xfrm_dst *path, struct dst_entry *dst,
88 int nfheader_len)
89{
90 return 0;
91}
92
Herbert Xu25ee3282007-12-11 09:32:34 -080093static int xfrm4_fill_dst(struct xfrm_dst *xdst, struct net_device *dev)
94{
95 struct rtable *rt = (struct rtable *)xdst->route;
Linus Torvalds1da177e2005-04-16 15:20:36 -070096
Herbert Xu25ee3282007-12-11 09:32:34 -080097 xdst->u.rt.fl = rt->fl;
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
Herbert Xu25ee3282007-12-11 09:32:34 -080099 xdst->u.dst.dev = dev;
100 dev_hold(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700101
Herbert Xu25ee3282007-12-11 09:32:34 -0800102 xdst->u.rt.idev = in_dev_get(dev);
103 if (!xdst->u.rt.idev)
104 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105
Herbert Xu25ee3282007-12-11 09:32:34 -0800106 xdst->u.rt.peer = rt->peer;
107 if (rt->peer)
108 atomic_inc(&rt->peer->refcnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109
Herbert Xu25ee3282007-12-11 09:32:34 -0800110 /* Sheit... I remember I did this right. Apparently,
111 * it was magically lost, so this code needs audit */
112 xdst->u.rt.rt_flags = rt->rt_flags & (RTCF_BROADCAST | RTCF_MULTICAST |
113 RTCF_LOCAL);
114 xdst->u.rt.rt_type = rt->rt_type;
115 xdst->u.rt.rt_src = rt->rt_src;
116 xdst->u.rt.rt_dst = rt->rt_dst;
117 xdst->u.rt.rt_gateway = rt->rt_gateway;
118 xdst->u.rt.rt_spec_dst = rt->rt_spec_dst;
Miika Komu43372262007-02-06 14:27:32 -0800119
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121}
122
123static void
Herbert Xud5422ef2007-12-12 10:44:16 -0800124_decode_session4(struct sk_buff *skb, struct flowi *fl, int reverse)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125{
Arnaldo Carvalho de Meloeddc9ec2007-04-20 22:47:35 -0700126 struct iphdr *iph = ip_hdr(skb);
Arnaldo Carvalho de Melod56f90a2007-04-10 20:50:43 -0700127 u8 *xprth = skb_network_header(skb) + iph->ihl * 4;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128
129 memset(fl, 0, sizeof(struct flowi));
130 if (!(iph->frag_off & htons(IP_MF | IP_OFFSET))) {
131 switch (iph->protocol) {
132 case IPPROTO_UDP:
Gerrit Renkerba4e58e2006-11-27 11:10:57 -0800133 case IPPROTO_UDPLITE:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134 case IPPROTO_TCP:
135 case IPPROTO_SCTP:
Patrick McHardy9e999992005-12-19 14:03:46 -0800136 case IPPROTO_DCCP:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137 if (pskb_may_pull(skb, xprth + 4 - skb->data)) {
Al Viro8c689a62006-11-08 00:20:21 -0800138 __be16 *ports = (__be16 *)xprth;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700139
Herbert Xud5422ef2007-12-12 10:44:16 -0800140 fl->fl_ip_sport = ports[!!reverse];
141 fl->fl_ip_dport = ports[!reverse];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142 }
143 break;
144
145 case IPPROTO_ICMP:
146 if (pskb_may_pull(skb, xprth + 2 - skb->data)) {
147 u8 *icmp = xprth;
148
149 fl->fl_icmp_type = icmp[0];
150 fl->fl_icmp_code = icmp[1];
151 }
152 break;
153
154 case IPPROTO_ESP:
155 if (pskb_may_pull(skb, xprth + 4 - skb->data)) {
Al Viro4324a172006-09-27 18:49:07 -0700156 __be32 *ehdr = (__be32 *)xprth;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157
158 fl->fl_ipsec_spi = ehdr[0];
159 }
160 break;
161
162 case IPPROTO_AH:
163 if (pskb_may_pull(skb, xprth + 8 - skb->data)) {
Al Viro4324a172006-09-27 18:49:07 -0700164 __be32 *ah_hdr = (__be32*)xprth;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165
166 fl->fl_ipsec_spi = ah_hdr[1];
167 }
168 break;
169
170 case IPPROTO_COMP:
171 if (pskb_may_pull(skb, xprth + 4 - skb->data)) {
Al Viro4324a172006-09-27 18:49:07 -0700172 __be16 *ipcomp_hdr = (__be16 *)xprth;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700173
Alexey Dobriyan4195f812006-05-22 16:53:22 -0700174 fl->fl_ipsec_spi = htonl(ntohs(ipcomp_hdr[1]));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175 }
176 break;
177 default:
178 fl->fl_ipsec_spi = 0;
179 break;
Stephen Hemminger3ff50b72007-04-20 17:09:22 -0700180 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181 }
182 fl->proto = iph->protocol;
Herbert Xud5422ef2007-12-12 10:44:16 -0800183 fl->fl4_dst = reverse ? iph->saddr : iph->daddr;
184 fl->fl4_src = reverse ? iph->daddr : iph->saddr;
Herbert Xu4da30892006-02-23 16:19:26 -0800185 fl->fl4_tos = iph->tos;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186}
187
Daniel Lezcano569d3642008-01-18 03:56:57 -0800188static inline int xfrm4_garbage_collect(struct dst_ops *ops)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700190 xfrm4_policy_afinfo.garbage_collect();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191 return (atomic_read(&xfrm4_dst_ops.entries) > xfrm4_dst_ops.gc_thresh*2);
192}
193
194static void xfrm4_update_pmtu(struct dst_entry *dst, u32 mtu)
195{
196 struct xfrm_dst *xdst = (struct xfrm_dst *)dst;
197 struct dst_entry *path = xdst->route;
198
199 path->ops->update_pmtu(path, mtu);
200}
201
Herbert Xuaabc9762005-05-03 16:27:10 -0700202static void xfrm4_dst_destroy(struct dst_entry *dst)
203{
204 struct xfrm_dst *xdst = (struct xfrm_dst *)dst;
205
206 if (likely(xdst->u.rt.idev))
207 in_dev_put(xdst->u.rt.idev);
Herbert Xued3e37d2007-10-17 21:34:46 -0700208 if (likely(xdst->u.rt.peer))
David S. Miller26db1672006-12-06 23:45:15 -0800209 inet_putpeer(xdst->u.rt.peer);
Herbert Xuaabc9762005-05-03 16:27:10 -0700210 xfrm_dst_destroy(xdst);
211}
212
213static void xfrm4_dst_ifdown(struct dst_entry *dst, struct net_device *dev,
214 int unregister)
215{
216 struct xfrm_dst *xdst;
217
218 if (!unregister)
219 return;
220
221 xdst = (struct xfrm_dst *)dst;
222 if (xdst->u.rt.idev->dev == dev) {
Denis V. Lunev5a3e55d2007-12-07 00:38:10 -0800223 struct in_device *loopback_idev =
224 in_dev_get(dev->nd_net->loopback_dev);
Herbert Xuaabc9762005-05-03 16:27:10 -0700225 BUG_ON(!loopback_idev);
226
227 do {
228 in_dev_put(xdst->u.rt.idev);
229 xdst->u.rt.idev = loopback_idev;
230 in_dev_hold(loopback_idev);
231 xdst = (struct xfrm_dst *)xdst->u.dst.child;
232 } while (xdst->u.dst.xfrm);
233
234 __in_dev_put(loopback_idev);
235 }
236
237 xfrm_dst_ifdown(dst, dev);
238}
239
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240static struct dst_ops xfrm4_dst_ops = {
241 .family = AF_INET,
242 .protocol = __constant_htons(ETH_P_IP),
243 .gc = xfrm4_garbage_collect,
244 .update_pmtu = xfrm4_update_pmtu,
Herbert Xuaabc9762005-05-03 16:27:10 -0700245 .destroy = xfrm4_dst_destroy,
246 .ifdown = xfrm4_dst_ifdown,
Herbert Xu862b82c2007-11-13 21:43:11 -0800247 .local_out = __ip_local_out,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248 .gc_thresh = 1024,
249 .entry_size = sizeof(struct xfrm_dst),
250};
251
252static struct xfrm_policy_afinfo xfrm4_policy_afinfo = {
253 .family = AF_INET,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700254 .dst_ops = &xfrm4_dst_ops,
255 .dst_lookup = xfrm4_dst_lookup,
Patrick McHardya1e59ab2006-09-19 12:57:34 -0700256 .get_saddr = xfrm4_get_saddr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257 .find_bundle = __xfrm4_find_bundle,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700258 .decode_session = _decode_session4,
Herbert Xu25ee3282007-12-11 09:32:34 -0800259 .get_tos = xfrm4_get_tos,
Masahide NAKAMURAa1b05142007-12-20 20:41:12 -0800260 .init_path = xfrm4_init_path,
Herbert Xu25ee3282007-12-11 09:32:34 -0800261 .fill_dst = xfrm4_fill_dst,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262};
263
264static void __init xfrm4_policy_init(void)
265{
266 xfrm_policy_register_afinfo(&xfrm4_policy_afinfo);
267}
268
269static void __exit xfrm4_policy_fini(void)
270{
271 xfrm_policy_unregister_afinfo(&xfrm4_policy_afinfo);
272}
273
274void __init xfrm4_init(void)
275{
276 xfrm4_state_init();
277 xfrm4_policy_init();
278}
279