11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * xfrm4_policy.c 31da177e4SLinus Torvalds * 41da177e4SLinus Torvalds * Changes: 51da177e4SLinus Torvalds * Kazunori MIYAZAWA @USAGI 61da177e4SLinus Torvalds * YOSHIFUJI Hideaki @USAGI 71da177e4SLinus Torvalds * Split up af-specific portion 81da177e4SLinus Torvalds * 91da177e4SLinus Torvalds */ 101da177e4SLinus Torvalds 1166cdb3caSHerbert Xu #include <linux/err.h> 1266cdb3caSHerbert Xu #include <linux/kernel.h> 13aabc9761SHerbert Xu #include <linux/inetdevice.h> 1445ff5a3fSHerbert Xu #include <net/dst.h> 151da177e4SLinus Torvalds #include <net/xfrm.h> 161da177e4SLinus Torvalds #include <net/ip.h> 171da177e4SLinus Torvalds 181da177e4SLinus Torvalds static struct dst_ops xfrm4_dst_ops; 191da177e4SLinus Torvalds static struct xfrm_policy_afinfo xfrm4_policy_afinfo; 201da177e4SLinus Torvalds 21c5b3cf46SAlexey Dobriyan static struct dst_entry *xfrm4_dst_lookup(struct net *net, int tos, 22c5b3cf46SAlexey Dobriyan xfrm_address_t *saddr, 2366cdb3caSHerbert Xu xfrm_address_t *daddr) 241da177e4SLinus Torvalds { 2566cdb3caSHerbert Xu struct flowi fl = { 26a1e59abfSPatrick McHardy .nl_u = { 27a1e59abfSPatrick McHardy .ip4_u = { 2866cdb3caSHerbert Xu .tos = tos, 29a1e59abfSPatrick McHardy .daddr = daddr->a4, 30a1e59abfSPatrick McHardy }, 31a1e59abfSPatrick McHardy }, 32a1e59abfSPatrick McHardy }; 3366cdb3caSHerbert Xu struct dst_entry *dst; 3466cdb3caSHerbert Xu struct rtable *rt; 3566cdb3caSHerbert Xu int err; 36a1e59abfSPatrick McHardy 3766cdb3caSHerbert Xu if (saddr) 3866cdb3caSHerbert Xu fl.fl4_src = saddr->a4; 3966cdb3caSHerbert Xu 40c5b3cf46SAlexey Dobriyan err = __ip_route_output_key(net, &rt, &fl); 4166cdb3caSHerbert Xu dst = &rt->u.dst; 4266cdb3caSHerbert Xu if (err) 4366cdb3caSHerbert Xu dst = ERR_PTR(err); 4466cdb3caSHerbert Xu return dst; 45a1e59abfSPatrick McHardy } 4666cdb3caSHerbert Xu 47fbda33b2SAlexey Dobriyan static int xfrm4_get_saddr(struct net *net, 48fbda33b2SAlexey Dobriyan xfrm_address_t *saddr, xfrm_address_t *daddr) 4966cdb3caSHerbert Xu { 5066cdb3caSHerbert Xu struct dst_entry *dst; 5166cdb3caSHerbert Xu struct rtable *rt; 5266cdb3caSHerbert Xu 53fbda33b2SAlexey Dobriyan dst = xfrm4_dst_lookup(net, 0, NULL, daddr); 5466cdb3caSHerbert Xu if (IS_ERR(dst)) 55a1e59abfSPatrick McHardy return -EHOSTUNREACH; 5666cdb3caSHerbert Xu 5766cdb3caSHerbert Xu rt = (struct rtable *)dst; 5866cdb3caSHerbert Xu saddr->a4 = rt->rt_src; 5966cdb3caSHerbert Xu dst_release(dst); 6066cdb3caSHerbert Xu return 0; 61a1e59abfSPatrick McHardy } 62a1e59abfSPatrick McHardy 631da177e4SLinus Torvalds static struct dst_entry * 641da177e4SLinus Torvalds __xfrm4_find_bundle(struct flowi *fl, struct xfrm_policy *policy) 651da177e4SLinus Torvalds { 661da177e4SLinus Torvalds struct dst_entry *dst; 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds read_lock_bh(&policy->lock); 691da177e4SLinus Torvalds for (dst = policy->bundles; dst; dst = dst->next) { 701da177e4SLinus Torvalds struct xfrm_dst *xdst = (struct xfrm_dst *)dst; 711da177e4SLinus Torvalds if (xdst->u.rt.fl.oif == fl->oif && /*XXX*/ 721da177e4SLinus Torvalds xdst->u.rt.fl.fl4_dst == fl->fl4_dst && 731da177e4SLinus Torvalds xdst->u.rt.fl.fl4_src == fl->fl4_src && 744da3089fSHerbert Xu xdst->u.rt.fl.fl4_tos == fl->fl4_tos && 755b368e61SVenkat Yekkirala xfrm_bundle_ok(policy, xdst, fl, AF_INET, 0)) { 761da177e4SLinus Torvalds dst_clone(dst); 771da177e4SLinus Torvalds break; 781da177e4SLinus Torvalds } 791da177e4SLinus Torvalds } 801da177e4SLinus Torvalds read_unlock_bh(&policy->lock); 811da177e4SLinus Torvalds return dst; 821da177e4SLinus Torvalds } 831da177e4SLinus Torvalds 8425ee3286SHerbert Xu static int xfrm4_get_tos(struct flowi *fl) 851da177e4SLinus Torvalds { 8625ee3286SHerbert Xu return fl->fl4_tos; 871da177e4SLinus Torvalds } 881da177e4SLinus Torvalds 89a1b05140SMasahide NAKAMURA static int xfrm4_init_path(struct xfrm_dst *path, struct dst_entry *dst, 90a1b05140SMasahide NAKAMURA int nfheader_len) 91a1b05140SMasahide NAKAMURA { 92a1b05140SMasahide NAKAMURA return 0; 93a1b05140SMasahide NAKAMURA } 94a1b05140SMasahide NAKAMURA 9525ee3286SHerbert Xu static int xfrm4_fill_dst(struct xfrm_dst *xdst, struct net_device *dev) 9625ee3286SHerbert Xu { 9725ee3286SHerbert Xu struct rtable *rt = (struct rtable *)xdst->route; 981da177e4SLinus Torvalds 9925ee3286SHerbert Xu xdst->u.rt.fl = rt->fl; 1001da177e4SLinus Torvalds 10125ee3286SHerbert Xu xdst->u.dst.dev = dev; 10225ee3286SHerbert Xu dev_hold(dev); 10343372262SMiika Komu 10425ee3286SHerbert Xu xdst->u.rt.idev = in_dev_get(dev); 10525ee3286SHerbert Xu if (!xdst->u.rt.idev) 10625ee3286SHerbert Xu return -ENODEV; 1071da177e4SLinus Torvalds 10825ee3286SHerbert Xu xdst->u.rt.peer = rt->peer; 10925ee3286SHerbert Xu if (rt->peer) 11025ee3286SHerbert Xu atomic_inc(&rt->peer->refcnt); 11166cdb3caSHerbert Xu 1121da177e4SLinus Torvalds /* Sheit... I remember I did this right. Apparently, 1131da177e4SLinus Torvalds * it was magically lost, so this code needs audit */ 11425ee3286SHerbert Xu xdst->u.rt.rt_flags = rt->rt_flags & (RTCF_BROADCAST | RTCF_MULTICAST | 11525ee3286SHerbert Xu RTCF_LOCAL); 11625ee3286SHerbert Xu xdst->u.rt.rt_type = rt->rt_type; 11725ee3286SHerbert Xu xdst->u.rt.rt_src = rt->rt_src; 11825ee3286SHerbert Xu xdst->u.rt.rt_dst = rt->rt_dst; 11925ee3286SHerbert Xu xdst->u.rt.rt_gateway = rt->rt_gateway; 12025ee3286SHerbert Xu xdst->u.rt.rt_spec_dst = rt->rt_spec_dst; 1211da177e4SLinus Torvalds 1221da177e4SLinus Torvalds return 0; 1231da177e4SLinus Torvalds } 1241da177e4SLinus Torvalds 1251da177e4SLinus Torvalds static void 126d5422efeSHerbert Xu _decode_session4(struct sk_buff *skb, struct flowi *fl, int reverse) 1271da177e4SLinus Torvalds { 128eddc9ec5SArnaldo Carvalho de Melo struct iphdr *iph = ip_hdr(skb); 129d56f90a7SArnaldo Carvalho de Melo u8 *xprth = skb_network_header(skb) + iph->ihl * 4; 1301da177e4SLinus Torvalds 1311da177e4SLinus Torvalds memset(fl, 0, sizeof(struct flowi)); 1321da177e4SLinus Torvalds if (!(iph->frag_off & htons(IP_MF | IP_OFFSET))) { 1331da177e4SLinus Torvalds switch (iph->protocol) { 1341da177e4SLinus Torvalds case IPPROTO_UDP: 135ba4e58ecSGerrit Renker case IPPROTO_UDPLITE: 1361da177e4SLinus Torvalds case IPPROTO_TCP: 1371da177e4SLinus Torvalds case IPPROTO_SCTP: 1389e999993SPatrick McHardy case IPPROTO_DCCP: 139c615c9f3SWei Yongjun if (xprth + 4 < skb->data || 140c615c9f3SWei Yongjun pskb_may_pull(skb, xprth + 4 - skb->data)) { 1418c689a6eSAl Viro __be16 *ports = (__be16 *)xprth; 1421da177e4SLinus Torvalds 143d5422efeSHerbert Xu fl->fl_ip_sport = ports[!!reverse]; 144d5422efeSHerbert Xu fl->fl_ip_dport = ports[!reverse]; 1451da177e4SLinus Torvalds } 1461da177e4SLinus Torvalds break; 1471da177e4SLinus Torvalds 1481da177e4SLinus Torvalds case IPPROTO_ICMP: 1491da177e4SLinus Torvalds if (pskb_may_pull(skb, xprth + 2 - skb->data)) { 1501da177e4SLinus Torvalds u8 *icmp = xprth; 1511da177e4SLinus Torvalds 1521da177e4SLinus Torvalds fl->fl_icmp_type = icmp[0]; 1531da177e4SLinus Torvalds fl->fl_icmp_code = icmp[1]; 1541da177e4SLinus Torvalds } 1551da177e4SLinus Torvalds break; 1561da177e4SLinus Torvalds 1571da177e4SLinus Torvalds case IPPROTO_ESP: 1581da177e4SLinus Torvalds if (pskb_may_pull(skb, xprth + 4 - skb->data)) { 1594324a174SAl Viro __be32 *ehdr = (__be32 *)xprth; 1601da177e4SLinus Torvalds 1611da177e4SLinus Torvalds fl->fl_ipsec_spi = ehdr[0]; 1621da177e4SLinus Torvalds } 1631da177e4SLinus Torvalds break; 1641da177e4SLinus Torvalds 1651da177e4SLinus Torvalds case IPPROTO_AH: 1661da177e4SLinus Torvalds if (pskb_may_pull(skb, xprth + 8 - skb->data)) { 1674324a174SAl Viro __be32 *ah_hdr = (__be32*)xprth; 1681da177e4SLinus Torvalds 1691da177e4SLinus Torvalds fl->fl_ipsec_spi = ah_hdr[1]; 1701da177e4SLinus Torvalds } 1711da177e4SLinus Torvalds break; 1721da177e4SLinus Torvalds 1731da177e4SLinus Torvalds case IPPROTO_COMP: 1741da177e4SLinus Torvalds if (pskb_may_pull(skb, xprth + 4 - skb->data)) { 1754324a174SAl Viro __be16 *ipcomp_hdr = (__be16 *)xprth; 1761da177e4SLinus Torvalds 1774195f814SAlexey Dobriyan fl->fl_ipsec_spi = htonl(ntohs(ipcomp_hdr[1])); 1781da177e4SLinus Torvalds } 1791da177e4SLinus Torvalds break; 1801da177e4SLinus Torvalds default: 1811da177e4SLinus Torvalds fl->fl_ipsec_spi = 0; 1821da177e4SLinus Torvalds break; 1833ff50b79SStephen Hemminger } 1841da177e4SLinus Torvalds } 1851da177e4SLinus Torvalds fl->proto = iph->protocol; 186d5422efeSHerbert Xu fl->fl4_dst = reverse ? iph->saddr : iph->daddr; 187d5422efeSHerbert Xu fl->fl4_src = reverse ? iph->daddr : iph->saddr; 1884da3089fSHerbert Xu fl->fl4_tos = iph->tos; 1891da177e4SLinus Torvalds } 1901da177e4SLinus Torvalds 191569d3645SDaniel Lezcano static inline int xfrm4_garbage_collect(struct dst_ops *ops) 1921da177e4SLinus Torvalds { 193ddcfd796SAlexey Dobriyan xfrm4_policy_afinfo.garbage_collect(&init_net); 1941da177e4SLinus Torvalds return (atomic_read(&xfrm4_dst_ops.entries) > xfrm4_dst_ops.gc_thresh*2); 1951da177e4SLinus Torvalds } 1961da177e4SLinus Torvalds 1971da177e4SLinus Torvalds static void xfrm4_update_pmtu(struct dst_entry *dst, u32 mtu) 1981da177e4SLinus Torvalds { 1991da177e4SLinus Torvalds struct xfrm_dst *xdst = (struct xfrm_dst *)dst; 2001da177e4SLinus Torvalds struct dst_entry *path = xdst->route; 2011da177e4SLinus Torvalds 2021da177e4SLinus Torvalds path->ops->update_pmtu(path, mtu); 2031da177e4SLinus Torvalds } 2041da177e4SLinus Torvalds 205aabc9761SHerbert Xu static void xfrm4_dst_destroy(struct dst_entry *dst) 206aabc9761SHerbert Xu { 207aabc9761SHerbert Xu struct xfrm_dst *xdst = (struct xfrm_dst *)dst; 208aabc9761SHerbert Xu 209aabc9761SHerbert Xu if (likely(xdst->u.rt.idev)) 210aabc9761SHerbert Xu in_dev_put(xdst->u.rt.idev); 211ed3e37ddSHerbert Xu if (likely(xdst->u.rt.peer)) 21226db1677SDavid S. Miller inet_putpeer(xdst->u.rt.peer); 213aabc9761SHerbert Xu xfrm_dst_destroy(xdst); 214aabc9761SHerbert Xu } 215aabc9761SHerbert Xu 216aabc9761SHerbert Xu static void xfrm4_dst_ifdown(struct dst_entry *dst, struct net_device *dev, 217aabc9761SHerbert Xu int unregister) 218aabc9761SHerbert Xu { 219aabc9761SHerbert Xu struct xfrm_dst *xdst; 220aabc9761SHerbert Xu 221aabc9761SHerbert Xu if (!unregister) 222aabc9761SHerbert Xu return; 223aabc9761SHerbert Xu 224aabc9761SHerbert Xu xdst = (struct xfrm_dst *)dst; 225aabc9761SHerbert Xu if (xdst->u.rt.idev->dev == dev) { 2265a3e55d6SDenis V. Lunev struct in_device *loopback_idev = 227c346dca1SYOSHIFUJI Hideaki in_dev_get(dev_net(dev)->loopback_dev); 228aabc9761SHerbert Xu BUG_ON(!loopback_idev); 229aabc9761SHerbert Xu 230aabc9761SHerbert Xu do { 231aabc9761SHerbert Xu in_dev_put(xdst->u.rt.idev); 232aabc9761SHerbert Xu xdst->u.rt.idev = loopback_idev; 233aabc9761SHerbert Xu in_dev_hold(loopback_idev); 234aabc9761SHerbert Xu xdst = (struct xfrm_dst *)xdst->u.dst.child; 235aabc9761SHerbert Xu } while (xdst->u.dst.xfrm); 236aabc9761SHerbert Xu 237aabc9761SHerbert Xu __in_dev_put(loopback_idev); 238aabc9761SHerbert Xu } 239aabc9761SHerbert Xu 240aabc9761SHerbert Xu xfrm_dst_ifdown(dst, dev); 241aabc9761SHerbert Xu } 242aabc9761SHerbert Xu 2431da177e4SLinus Torvalds static struct dst_ops xfrm4_dst_ops = { 2441da177e4SLinus Torvalds .family = AF_INET, 24509640e63SHarvey Harrison .protocol = cpu_to_be16(ETH_P_IP), 2461da177e4SLinus Torvalds .gc = xfrm4_garbage_collect, 2471da177e4SLinus Torvalds .update_pmtu = xfrm4_update_pmtu, 248aabc9761SHerbert Xu .destroy = xfrm4_dst_destroy, 249aabc9761SHerbert Xu .ifdown = xfrm4_dst_ifdown, 250862b82c6SHerbert Xu .local_out = __ip_local_out, 2511da177e4SLinus Torvalds .gc_thresh = 1024, 252e2422970SEric Dumazet .entries = ATOMIC_INIT(0), 2531da177e4SLinus Torvalds }; 2541da177e4SLinus Torvalds 2551da177e4SLinus Torvalds static struct xfrm_policy_afinfo xfrm4_policy_afinfo = { 2561da177e4SLinus Torvalds .family = AF_INET, 2571da177e4SLinus Torvalds .dst_ops = &xfrm4_dst_ops, 2581da177e4SLinus Torvalds .dst_lookup = xfrm4_dst_lookup, 259a1e59abfSPatrick McHardy .get_saddr = xfrm4_get_saddr, 2601da177e4SLinus Torvalds .find_bundle = __xfrm4_find_bundle, 2611da177e4SLinus Torvalds .decode_session = _decode_session4, 26225ee3286SHerbert Xu .get_tos = xfrm4_get_tos, 263a1b05140SMasahide NAKAMURA .init_path = xfrm4_init_path, 26425ee3286SHerbert Xu .fill_dst = xfrm4_fill_dst, 2651da177e4SLinus Torvalds }; 2661da177e4SLinus Torvalds 267*a44a4a00SNeil Horman static struct ctl_table xfrm4_policy_table[] = { 268*a44a4a00SNeil Horman { 269*a44a4a00SNeil Horman .ctl_name = CTL_UNNUMBERED, 270*a44a4a00SNeil Horman .procname = "xfrm4_gc_thresh", 271*a44a4a00SNeil Horman .data = &xfrm4_dst_ops.gc_thresh, 272*a44a4a00SNeil Horman .maxlen = sizeof(int), 273*a44a4a00SNeil Horman .mode = 0644, 274*a44a4a00SNeil Horman .proc_handler = proc_dointvec, 275*a44a4a00SNeil Horman }, 276*a44a4a00SNeil Horman { } 277*a44a4a00SNeil Horman }; 278*a44a4a00SNeil Horman 279*a44a4a00SNeil Horman static struct ctl_table_header *sysctl_hdr; 280*a44a4a00SNeil Horman 2811da177e4SLinus Torvalds static void __init xfrm4_policy_init(void) 2821da177e4SLinus Torvalds { 2831da177e4SLinus Torvalds xfrm_policy_register_afinfo(&xfrm4_policy_afinfo); 2841da177e4SLinus Torvalds } 2851da177e4SLinus Torvalds 2861da177e4SLinus Torvalds static void __exit xfrm4_policy_fini(void) 2871da177e4SLinus Torvalds { 288*a44a4a00SNeil Horman if (sysctl_hdr) 289*a44a4a00SNeil Horman unregister_net_sysctl_table(sysctl_hdr); 2901da177e4SLinus Torvalds xfrm_policy_unregister_afinfo(&xfrm4_policy_afinfo); 2911da177e4SLinus Torvalds } 2921da177e4SLinus Torvalds 2931da177e4SLinus Torvalds void __init xfrm4_init(void) 2941da177e4SLinus Torvalds { 2951da177e4SLinus Torvalds xfrm4_state_init(); 2961da177e4SLinus Torvalds xfrm4_policy_init(); 297*a44a4a00SNeil Horman sysctl_hdr = register_net_sysctl_table(&init_net, net_ipv4_ctl_path, 298*a44a4a00SNeil Horman xfrm4_policy_table); 2991da177e4SLinus Torvalds } 3001da177e4SLinus Torvalds 301