11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * IPv6 output functions 31da177e4SLinus Torvalds * Linux INET6 implementation 41da177e4SLinus Torvalds * 51da177e4SLinus Torvalds * Authors: 61da177e4SLinus Torvalds * Pedro Roque <roque@di.fc.ul.pt> 71da177e4SLinus Torvalds * 81da177e4SLinus Torvalds * Based on linux/net/ipv4/ip_output.c 91da177e4SLinus Torvalds * 101da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or 111da177e4SLinus Torvalds * modify it under the terms of the GNU General Public License 121da177e4SLinus Torvalds * as published by the Free Software Foundation; either version 131da177e4SLinus Torvalds * 2 of the License, or (at your option) any later version. 141da177e4SLinus Torvalds * 151da177e4SLinus Torvalds * Changes: 161da177e4SLinus Torvalds * A.N.Kuznetsov : airthmetics in fragmentation. 171da177e4SLinus Torvalds * extension headers are implemented. 181da177e4SLinus Torvalds * route changes now work. 191da177e4SLinus Torvalds * ip6_forward does not confuse sniffers. 201da177e4SLinus Torvalds * etc. 211da177e4SLinus Torvalds * 221da177e4SLinus Torvalds * H. von Brand : Added missing #include <linux/string.h> 231da177e4SLinus Torvalds * Imran Patel : frag id should be in NBO 241da177e4SLinus Torvalds * Kazunori MIYAZAWA @USAGI 251da177e4SLinus Torvalds * : add ip6_append_data and related functions 261da177e4SLinus Torvalds * for datagram xmit 271da177e4SLinus Torvalds */ 281da177e4SLinus Torvalds 291da177e4SLinus Torvalds #include <linux/errno.h> 30ef76bc23SHerbert Xu #include <linux/kernel.h> 311da177e4SLinus Torvalds #include <linux/string.h> 321da177e4SLinus Torvalds #include <linux/socket.h> 331da177e4SLinus Torvalds #include <linux/net.h> 341da177e4SLinus Torvalds #include <linux/netdevice.h> 351da177e4SLinus Torvalds #include <linux/if_arp.h> 361da177e4SLinus Torvalds #include <linux/in6.h> 371da177e4SLinus Torvalds #include <linux/tcp.h> 381da177e4SLinus Torvalds #include <linux/route.h> 39b59f45d0SHerbert Xu #include <linux/module.h> 401da177e4SLinus Torvalds 411da177e4SLinus Torvalds #include <linux/netfilter.h> 421da177e4SLinus Torvalds #include <linux/netfilter_ipv6.h> 431da177e4SLinus Torvalds 441da177e4SLinus Torvalds #include <net/sock.h> 451da177e4SLinus Torvalds #include <net/snmp.h> 461da177e4SLinus Torvalds 471da177e4SLinus Torvalds #include <net/ipv6.h> 481da177e4SLinus Torvalds #include <net/ndisc.h> 491da177e4SLinus Torvalds #include <net/protocol.h> 501da177e4SLinus Torvalds #include <net/ip6_route.h> 511da177e4SLinus Torvalds #include <net/addrconf.h> 521da177e4SLinus Torvalds #include <net/rawv6.h> 531da177e4SLinus Torvalds #include <net/icmp.h> 541da177e4SLinus Torvalds #include <net/xfrm.h> 551da177e4SLinus Torvalds #include <net/checksum.h> 567bc570c8SYOSHIFUJI Hideaki #include <linux/mroute6.h> 571da177e4SLinus Torvalds 581da177e4SLinus Torvalds static int ip6_fragment(struct sk_buff *skb, int (*output)(struct sk_buff *)); 591da177e4SLinus Torvalds 601da177e4SLinus Torvalds static __inline__ void ipv6_select_ident(struct sk_buff *skb, struct frag_hdr *fhdr) 611da177e4SLinus Torvalds { 621da177e4SLinus Torvalds static u32 ipv6_fragmentation_id = 1; 631da177e4SLinus Torvalds static DEFINE_SPINLOCK(ip6_id_lock); 641da177e4SLinus Torvalds 651da177e4SLinus Torvalds spin_lock_bh(&ip6_id_lock); 661da177e4SLinus Torvalds fhdr->identification = htonl(ipv6_fragmentation_id); 671da177e4SLinus Torvalds if (++ipv6_fragmentation_id == 0) 681da177e4SLinus Torvalds ipv6_fragmentation_id = 1; 691da177e4SLinus Torvalds spin_unlock_bh(&ip6_id_lock); 701da177e4SLinus Torvalds } 711da177e4SLinus Torvalds 72ef76bc23SHerbert Xu int __ip6_local_out(struct sk_buff *skb) 73ef76bc23SHerbert Xu { 74ef76bc23SHerbert Xu int len; 75ef76bc23SHerbert Xu 76ef76bc23SHerbert Xu len = skb->len - sizeof(struct ipv6hdr); 77ef76bc23SHerbert Xu if (len > IPV6_MAXPLEN) 78ef76bc23SHerbert Xu len = 0; 79ef76bc23SHerbert Xu ipv6_hdr(skb)->payload_len = htons(len); 80ef76bc23SHerbert Xu 816e23ae2aSPatrick McHardy return nf_hook(PF_INET6, NF_INET_LOCAL_OUT, skb, NULL, skb->dst->dev, 82ef76bc23SHerbert Xu dst_output); 83ef76bc23SHerbert Xu } 84ef76bc23SHerbert Xu 85ef76bc23SHerbert Xu int ip6_local_out(struct sk_buff *skb) 86ef76bc23SHerbert Xu { 87ef76bc23SHerbert Xu int err; 88ef76bc23SHerbert Xu 89ef76bc23SHerbert Xu err = __ip6_local_out(skb); 90ef76bc23SHerbert Xu if (likely(err == 1)) 91ef76bc23SHerbert Xu err = dst_output(skb); 92ef76bc23SHerbert Xu 93ef76bc23SHerbert Xu return err; 94ef76bc23SHerbert Xu } 95ef76bc23SHerbert Xu EXPORT_SYMBOL_GPL(ip6_local_out); 96ef76bc23SHerbert Xu 97ad643a79SPatrick McHardy static int ip6_output_finish(struct sk_buff *skb) 981da177e4SLinus Torvalds { 991da177e4SLinus Torvalds struct dst_entry *dst = skb->dst; 1001da177e4SLinus Torvalds 1013644f0ceSStephen Hemminger if (dst->hh) 1023644f0ceSStephen Hemminger return neigh_hh_output(dst->hh, skb); 1033644f0ceSStephen Hemminger else if (dst->neighbour) 1041da177e4SLinus Torvalds return dst->neighbour->output(skb); 1051da177e4SLinus Torvalds 106a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_OUTNOROUTES); 1071da177e4SLinus Torvalds kfree_skb(skb); 1081da177e4SLinus Torvalds return -EINVAL; 1091da177e4SLinus Torvalds 1101da177e4SLinus Torvalds } 1111da177e4SLinus Torvalds 1121da177e4SLinus Torvalds /* dev_loopback_xmit for use with netfilter. */ 1131da177e4SLinus Torvalds static int ip6_dev_loopback_xmit(struct sk_buff *newskb) 1141da177e4SLinus Torvalds { 115459a98edSArnaldo Carvalho de Melo skb_reset_mac_header(newskb); 116bbe735e4SArnaldo Carvalho de Melo __skb_pull(newskb, skb_network_offset(newskb)); 1171da177e4SLinus Torvalds newskb->pkt_type = PACKET_LOOPBACK; 1181da177e4SLinus Torvalds newskb->ip_summed = CHECKSUM_UNNECESSARY; 1191da177e4SLinus Torvalds BUG_TRAP(newskb->dst); 1201da177e4SLinus Torvalds 1211da177e4SLinus Torvalds netif_rx(newskb); 1221da177e4SLinus Torvalds return 0; 1231da177e4SLinus Torvalds } 1241da177e4SLinus Torvalds 1251da177e4SLinus Torvalds 1261da177e4SLinus Torvalds static int ip6_output2(struct sk_buff *skb) 1271da177e4SLinus Torvalds { 1281da177e4SLinus Torvalds struct dst_entry *dst = skb->dst; 1291da177e4SLinus Torvalds struct net_device *dev = dst->dev; 1301da177e4SLinus Torvalds 1311da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IPV6); 1321da177e4SLinus Torvalds skb->dev = dev; 1331da177e4SLinus Torvalds 1340660e03fSArnaldo Carvalho de Melo if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr)) { 1351da177e4SLinus Torvalds struct ipv6_pinfo* np = skb->sk ? inet6_sk(skb->sk) : NULL; 136a11d206dSYOSHIFUJI Hideaki struct inet6_dev *idev = ip6_dst_idev(skb->dst); 1371da177e4SLinus Torvalds 1381da177e4SLinus Torvalds if (!(dev->flags & IFF_LOOPBACK) && (!np || np->mc_loop) && 1397bc570c8SYOSHIFUJI Hideaki ((mroute6_socket && !(IP6CB(skb)->flags & IP6SKB_FORWARDED)) || 1400660e03fSArnaldo Carvalho de Melo ipv6_chk_mcast_addr(dev, &ipv6_hdr(skb)->daddr, 1417bc570c8SYOSHIFUJI Hideaki &ipv6_hdr(skb)->saddr))) { 1421da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 1431da177e4SLinus Torvalds 1441da177e4SLinus Torvalds /* Do not check for IFF_ALLMULTI; multicast routing 1451da177e4SLinus Torvalds is not supported in any case. 1461da177e4SLinus Torvalds */ 1471da177e4SLinus Torvalds if (newskb) 1486e23ae2aSPatrick McHardy NF_HOOK(PF_INET6, NF_INET_POST_ROUTING, newskb, 1496e23ae2aSPatrick McHardy NULL, newskb->dev, 1501da177e4SLinus Torvalds ip6_dev_loopback_xmit); 1511da177e4SLinus Torvalds 1520660e03fSArnaldo Carvalho de Melo if (ipv6_hdr(skb)->hop_limit == 0) { 153a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(idev, IPSTATS_MIB_OUTDISCARDS); 1541da177e4SLinus Torvalds kfree_skb(skb); 1551da177e4SLinus Torvalds return 0; 1561da177e4SLinus Torvalds } 1571da177e4SLinus Torvalds } 1581da177e4SLinus Torvalds 159a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(idev, IPSTATS_MIB_OUTMCASTPKTS); 1601da177e4SLinus Torvalds } 1611da177e4SLinus Torvalds 1626e23ae2aSPatrick McHardy return NF_HOOK(PF_INET6, NF_INET_POST_ROUTING, skb, NULL, skb->dev, 1636e23ae2aSPatrick McHardy ip6_output_finish); 1641da177e4SLinus Torvalds } 1651da177e4SLinus Torvalds 166628a5c56SJohn Heffner static inline int ip6_skb_dst_mtu(struct sk_buff *skb) 167628a5c56SJohn Heffner { 168628a5c56SJohn Heffner struct ipv6_pinfo *np = skb->sk ? inet6_sk(skb->sk) : NULL; 169628a5c56SJohn Heffner 170628a5c56SJohn Heffner return (np && np->pmtudisc == IPV6_PMTUDISC_PROBE) ? 171628a5c56SJohn Heffner skb->dst->dev->mtu : dst_mtu(skb->dst); 172628a5c56SJohn Heffner } 173628a5c56SJohn Heffner 1741da177e4SLinus Torvalds int ip6_output(struct sk_buff *skb) 1751da177e4SLinus Torvalds { 176628a5c56SJohn Heffner if ((skb->len > ip6_skb_dst_mtu(skb) && !skb_is_gso(skb)) || 177e89e9cf5SAnanda Raju dst_allfrag(skb->dst)) 1781da177e4SLinus Torvalds return ip6_fragment(skb, ip6_output2); 1791da177e4SLinus Torvalds else 1801da177e4SLinus Torvalds return ip6_output2(skb); 1811da177e4SLinus Torvalds } 1821da177e4SLinus Torvalds 1831da177e4SLinus Torvalds /* 1841da177e4SLinus Torvalds * xmit an sk_buff (used by TCP) 1851da177e4SLinus Torvalds */ 1861da177e4SLinus Torvalds 1871da177e4SLinus Torvalds int ip6_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl, 1881da177e4SLinus Torvalds struct ipv6_txoptions *opt, int ipfragok) 1891da177e4SLinus Torvalds { 190b30bd282SPatrick McHardy struct ipv6_pinfo *np = inet6_sk(sk); 1911da177e4SLinus Torvalds struct in6_addr *first_hop = &fl->fl6_dst; 1921da177e4SLinus Torvalds struct dst_entry *dst = skb->dst; 1931da177e4SLinus Torvalds struct ipv6hdr *hdr; 1941da177e4SLinus Torvalds u8 proto = fl->proto; 1951da177e4SLinus Torvalds int seg_len = skb->len; 19641a1f8eaSYOSHIFUJI Hideaki int hlimit, tclass; 1971da177e4SLinus Torvalds u32 mtu; 1981da177e4SLinus Torvalds 1991da177e4SLinus Torvalds if (opt) { 200c2636b4dSChuck Lever unsigned int head_room; 2011da177e4SLinus Torvalds 2021da177e4SLinus Torvalds /* First: exthdrs may take lots of space (~8K for now) 2031da177e4SLinus Torvalds MAX_HEADER is not enough. 2041da177e4SLinus Torvalds */ 2051da177e4SLinus Torvalds head_room = opt->opt_nflen + opt->opt_flen; 2061da177e4SLinus Torvalds seg_len += head_room; 2071da177e4SLinus Torvalds head_room += sizeof(struct ipv6hdr) + LL_RESERVED_SPACE(dst->dev); 2081da177e4SLinus Torvalds 2091da177e4SLinus Torvalds if (skb_headroom(skb) < head_room) { 2101da177e4SLinus Torvalds struct sk_buff *skb2 = skb_realloc_headroom(skb, head_room); 211a11d206dSYOSHIFUJI Hideaki if (skb2 == NULL) { 212a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(skb->dst), 213a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_OUTDISCARDS); 2141da177e4SLinus Torvalds kfree_skb(skb); 2151da177e4SLinus Torvalds return -ENOBUFS; 2161da177e4SLinus Torvalds } 217a11d206dSYOSHIFUJI Hideaki kfree_skb(skb); 218a11d206dSYOSHIFUJI Hideaki skb = skb2; 2191da177e4SLinus Torvalds if (sk) 2201da177e4SLinus Torvalds skb_set_owner_w(skb, sk); 2211da177e4SLinus Torvalds } 2221da177e4SLinus Torvalds if (opt->opt_flen) 2231da177e4SLinus Torvalds ipv6_push_frag_opts(skb, opt, &proto); 2241da177e4SLinus Torvalds if (opt->opt_nflen) 2251da177e4SLinus Torvalds ipv6_push_nfrag_opts(skb, opt, &proto, &first_hop); 2261da177e4SLinus Torvalds } 2271da177e4SLinus Torvalds 228e2d1bca7SArnaldo Carvalho de Melo skb_push(skb, sizeof(struct ipv6hdr)); 229e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(skb); 2300660e03fSArnaldo Carvalho de Melo hdr = ipv6_hdr(skb); 2311da177e4SLinus Torvalds 2321da177e4SLinus Torvalds /* 2331da177e4SLinus Torvalds * Fill in the IPv6 header 2341da177e4SLinus Torvalds */ 2351da177e4SLinus Torvalds 2361da177e4SLinus Torvalds hlimit = -1; 2371da177e4SLinus Torvalds if (np) 2381da177e4SLinus Torvalds hlimit = np->hop_limit; 2391da177e4SLinus Torvalds if (hlimit < 0) 2406b75d090SYOSHIFUJI Hideaki hlimit = ip6_dst_hoplimit(dst); 2411da177e4SLinus Torvalds 24241a1f8eaSYOSHIFUJI Hideaki tclass = -1; 24341a1f8eaSYOSHIFUJI Hideaki if (np) 24441a1f8eaSYOSHIFUJI Hideaki tclass = np->tclass; 24541a1f8eaSYOSHIFUJI Hideaki if (tclass < 0) 24641a1f8eaSYOSHIFUJI Hideaki tclass = 0; 24741a1f8eaSYOSHIFUJI Hideaki 24890bcaf7bSAl Viro *(__be32 *)hdr = htonl(0x60000000 | (tclass << 20)) | fl->fl6_flowlabel; 24941a1f8eaSYOSHIFUJI Hideaki 2501da177e4SLinus Torvalds hdr->payload_len = htons(seg_len); 2511da177e4SLinus Torvalds hdr->nexthdr = proto; 2521da177e4SLinus Torvalds hdr->hop_limit = hlimit; 2531da177e4SLinus Torvalds 2541da177e4SLinus Torvalds ipv6_addr_copy(&hdr->saddr, &fl->fl6_src); 2551da177e4SLinus Torvalds ipv6_addr_copy(&hdr->daddr, first_hop); 2561da177e4SLinus Torvalds 257a2c2064fSPatrick McHardy skb->priority = sk->sk_priority; 2584a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 259a2c2064fSPatrick McHardy 2601da177e4SLinus Torvalds mtu = dst_mtu(dst); 26189114afdSHerbert Xu if ((skb->len <= mtu) || ipfragok || skb_is_gso(skb)) { 262a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(skb->dst), 263a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_OUTREQUESTS); 2646e23ae2aSPatrick McHardy return NF_HOOK(PF_INET6, NF_INET_LOCAL_OUT, skb, NULL, dst->dev, 2656869c4d8SHarald Welte dst_output); 2661da177e4SLinus Torvalds } 2671da177e4SLinus Torvalds 2681da177e4SLinus Torvalds if (net_ratelimit()) 2691da177e4SLinus Torvalds printk(KERN_DEBUG "IPv6: sending pkt_too_big to self\n"); 2701da177e4SLinus Torvalds skb->dev = dst->dev; 2711da177e4SLinus Torvalds icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu, skb->dev); 272a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS); 2731da177e4SLinus Torvalds kfree_skb(skb); 2741da177e4SLinus Torvalds return -EMSGSIZE; 2751da177e4SLinus Torvalds } 2761da177e4SLinus Torvalds 2777159039aSYOSHIFUJI Hideaki EXPORT_SYMBOL(ip6_xmit); 2787159039aSYOSHIFUJI Hideaki 2791da177e4SLinus Torvalds /* 2801da177e4SLinus Torvalds * To avoid extra problems ND packets are send through this 2811da177e4SLinus Torvalds * routine. It's code duplication but I really want to avoid 2821da177e4SLinus Torvalds * extra checks since ipv6_build_header is used by TCP (which 2831da177e4SLinus Torvalds * is for us performance critical) 2841da177e4SLinus Torvalds */ 2851da177e4SLinus Torvalds 2861da177e4SLinus Torvalds int ip6_nd_hdr(struct sock *sk, struct sk_buff *skb, struct net_device *dev, 2879acd9f3aSYOSHIFUJI Hideaki const struct in6_addr *saddr, const struct in6_addr *daddr, 2881da177e4SLinus Torvalds int proto, int len) 2891da177e4SLinus Torvalds { 2901da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 2911da177e4SLinus Torvalds struct ipv6hdr *hdr; 2921da177e4SLinus Torvalds int totlen; 2931da177e4SLinus Torvalds 2941da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IPV6); 2951da177e4SLinus Torvalds skb->dev = dev; 2961da177e4SLinus Torvalds 2971da177e4SLinus Torvalds totlen = len + sizeof(struct ipv6hdr); 2981da177e4SLinus Torvalds 29955f79cc0SArnaldo Carvalho de Melo skb_reset_network_header(skb); 30055f79cc0SArnaldo Carvalho de Melo skb_put(skb, sizeof(struct ipv6hdr)); 3010660e03fSArnaldo Carvalho de Melo hdr = ipv6_hdr(skb); 3021da177e4SLinus Torvalds 303ae08e1f0SAl Viro *(__be32*)hdr = htonl(0x60000000); 3041da177e4SLinus Torvalds 3051da177e4SLinus Torvalds hdr->payload_len = htons(len); 3061da177e4SLinus Torvalds hdr->nexthdr = proto; 3071da177e4SLinus Torvalds hdr->hop_limit = np->hop_limit; 3081da177e4SLinus Torvalds 3091da177e4SLinus Torvalds ipv6_addr_copy(&hdr->saddr, saddr); 3101da177e4SLinus Torvalds ipv6_addr_copy(&hdr->daddr, daddr); 3111da177e4SLinus Torvalds 3121da177e4SLinus Torvalds return 0; 3131da177e4SLinus Torvalds } 3141da177e4SLinus Torvalds 3151da177e4SLinus Torvalds static int ip6_call_ra_chain(struct sk_buff *skb, int sel) 3161da177e4SLinus Torvalds { 3171da177e4SLinus Torvalds struct ip6_ra_chain *ra; 3181da177e4SLinus Torvalds struct sock *last = NULL; 3191da177e4SLinus Torvalds 3201da177e4SLinus Torvalds read_lock(&ip6_ra_lock); 3211da177e4SLinus Torvalds for (ra = ip6_ra_chain; ra; ra = ra->next) { 3221da177e4SLinus Torvalds struct sock *sk = ra->sk; 3230bd1b59bSAndrew McDonald if (sk && ra->sel == sel && 3240bd1b59bSAndrew McDonald (!sk->sk_bound_dev_if || 3250bd1b59bSAndrew McDonald sk->sk_bound_dev_if == skb->dev->ifindex)) { 3261da177e4SLinus Torvalds if (last) { 3271da177e4SLinus Torvalds struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC); 3281da177e4SLinus Torvalds if (skb2) 3291da177e4SLinus Torvalds rawv6_rcv(last, skb2); 3301da177e4SLinus Torvalds } 3311da177e4SLinus Torvalds last = sk; 3321da177e4SLinus Torvalds } 3331da177e4SLinus Torvalds } 3341da177e4SLinus Torvalds 3351da177e4SLinus Torvalds if (last) { 3361da177e4SLinus Torvalds rawv6_rcv(last, skb); 3371da177e4SLinus Torvalds read_unlock(&ip6_ra_lock); 3381da177e4SLinus Torvalds return 1; 3391da177e4SLinus Torvalds } 3401da177e4SLinus Torvalds read_unlock(&ip6_ra_lock); 3411da177e4SLinus Torvalds return 0; 3421da177e4SLinus Torvalds } 3431da177e4SLinus Torvalds 344e21e0b5fSVille Nuorvala static int ip6_forward_proxy_check(struct sk_buff *skb) 345e21e0b5fSVille Nuorvala { 3460660e03fSArnaldo Carvalho de Melo struct ipv6hdr *hdr = ipv6_hdr(skb); 347e21e0b5fSVille Nuorvala u8 nexthdr = hdr->nexthdr; 348e21e0b5fSVille Nuorvala int offset; 349e21e0b5fSVille Nuorvala 350e21e0b5fSVille Nuorvala if (ipv6_ext_hdr(nexthdr)) { 351e21e0b5fSVille Nuorvala offset = ipv6_skip_exthdr(skb, sizeof(*hdr), &nexthdr); 352e21e0b5fSVille Nuorvala if (offset < 0) 353e21e0b5fSVille Nuorvala return 0; 354e21e0b5fSVille Nuorvala } else 355e21e0b5fSVille Nuorvala offset = sizeof(struct ipv6hdr); 356e21e0b5fSVille Nuorvala 357e21e0b5fSVille Nuorvala if (nexthdr == IPPROTO_ICMPV6) { 358e21e0b5fSVille Nuorvala struct icmp6hdr *icmp6; 359e21e0b5fSVille Nuorvala 360d56f90a7SArnaldo Carvalho de Melo if (!pskb_may_pull(skb, (skb_network_header(skb) + 361d56f90a7SArnaldo Carvalho de Melo offset + 1 - skb->data))) 362e21e0b5fSVille Nuorvala return 0; 363e21e0b5fSVille Nuorvala 364d56f90a7SArnaldo Carvalho de Melo icmp6 = (struct icmp6hdr *)(skb_network_header(skb) + offset); 365e21e0b5fSVille Nuorvala 366e21e0b5fSVille Nuorvala switch (icmp6->icmp6_type) { 367e21e0b5fSVille Nuorvala case NDISC_ROUTER_SOLICITATION: 368e21e0b5fSVille Nuorvala case NDISC_ROUTER_ADVERTISEMENT: 369e21e0b5fSVille Nuorvala case NDISC_NEIGHBOUR_SOLICITATION: 370e21e0b5fSVille Nuorvala case NDISC_NEIGHBOUR_ADVERTISEMENT: 371e21e0b5fSVille Nuorvala case NDISC_REDIRECT: 372e21e0b5fSVille Nuorvala /* For reaction involving unicast neighbor discovery 373e21e0b5fSVille Nuorvala * message destined to the proxied address, pass it to 374e21e0b5fSVille Nuorvala * input function. 375e21e0b5fSVille Nuorvala */ 376e21e0b5fSVille Nuorvala return 1; 377e21e0b5fSVille Nuorvala default: 378e21e0b5fSVille Nuorvala break; 379e21e0b5fSVille Nuorvala } 380e21e0b5fSVille Nuorvala } 381e21e0b5fSVille Nuorvala 38274553b09SVille Nuorvala /* 38374553b09SVille Nuorvala * The proxying router can't forward traffic sent to a link-local 38474553b09SVille Nuorvala * address, so signal the sender and discard the packet. This 38574553b09SVille Nuorvala * behavior is clarified by the MIPv6 specification. 38674553b09SVille Nuorvala */ 38774553b09SVille Nuorvala if (ipv6_addr_type(&hdr->daddr) & IPV6_ADDR_LINKLOCAL) { 38874553b09SVille Nuorvala dst_link_failure(skb); 38974553b09SVille Nuorvala return -1; 39074553b09SVille Nuorvala } 39174553b09SVille Nuorvala 392e21e0b5fSVille Nuorvala return 0; 393e21e0b5fSVille Nuorvala } 394e21e0b5fSVille Nuorvala 3951da177e4SLinus Torvalds static inline int ip6_forward_finish(struct sk_buff *skb) 3961da177e4SLinus Torvalds { 3971da177e4SLinus Torvalds return dst_output(skb); 3981da177e4SLinus Torvalds } 3991da177e4SLinus Torvalds 4001da177e4SLinus Torvalds int ip6_forward(struct sk_buff *skb) 4011da177e4SLinus Torvalds { 4021da177e4SLinus Torvalds struct dst_entry *dst = skb->dst; 4030660e03fSArnaldo Carvalho de Melo struct ipv6hdr *hdr = ipv6_hdr(skb); 4041da177e4SLinus Torvalds struct inet6_skb_parm *opt = IP6CB(skb); 405c346dca1SYOSHIFUJI Hideaki struct net *net = dev_net(dst->dev); 4061da177e4SLinus Torvalds 4071da177e4SLinus Torvalds if (ipv6_devconf.forwarding == 0) 4081da177e4SLinus Torvalds goto error; 4091da177e4SLinus Torvalds 4104497b076SBen Hutchings if (skb_warn_if_lro(skb)) 4114497b076SBen Hutchings goto drop; 4124497b076SBen Hutchings 4131da177e4SLinus Torvalds if (!xfrm6_policy_check(NULL, XFRM_POLICY_FWD, skb)) { 414a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_INDISCARDS); 4151da177e4SLinus Torvalds goto drop; 4161da177e4SLinus Torvalds } 4171da177e4SLinus Torvalds 41835fc92a9SHerbert Xu skb_forward_csum(skb); 4191da177e4SLinus Torvalds 4201da177e4SLinus Torvalds /* 4211da177e4SLinus Torvalds * We DO NOT make any processing on 4221da177e4SLinus Torvalds * RA packets, pushing them to user level AS IS 4231da177e4SLinus Torvalds * without ane WARRANTY that application will be able 4241da177e4SLinus Torvalds * to interpret them. The reason is that we 4251da177e4SLinus Torvalds * cannot make anything clever here. 4261da177e4SLinus Torvalds * 4271da177e4SLinus Torvalds * We are not end-node, so that if packet contains 4281da177e4SLinus Torvalds * AH/ESP, we cannot make anything. 4291da177e4SLinus Torvalds * Defragmentation also would be mistake, RA packets 4301da177e4SLinus Torvalds * cannot be fragmented, because there is no warranty 4311da177e4SLinus Torvalds * that different fragments will go along one path. --ANK 4321da177e4SLinus Torvalds */ 4331da177e4SLinus Torvalds if (opt->ra) { 434d56f90a7SArnaldo Carvalho de Melo u8 *ptr = skb_network_header(skb) + opt->ra; 4351da177e4SLinus Torvalds if (ip6_call_ra_chain(skb, (ptr[2]<<8) + ptr[3])) 4361da177e4SLinus Torvalds return 0; 4371da177e4SLinus Torvalds } 4381da177e4SLinus Torvalds 4391da177e4SLinus Torvalds /* 4401da177e4SLinus Torvalds * check and decrement ttl 4411da177e4SLinus Torvalds */ 4421da177e4SLinus Torvalds if (hdr->hop_limit <= 1) { 4431da177e4SLinus Torvalds /* Force OUTPUT device used as source address */ 4441da177e4SLinus Torvalds skb->dev = dst->dev; 4451da177e4SLinus Torvalds icmpv6_send(skb, ICMPV6_TIME_EXCEED, ICMPV6_EXC_HOPLIMIT, 4461da177e4SLinus Torvalds 0, skb->dev); 447a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_INHDRERRORS); 4481da177e4SLinus Torvalds 4491da177e4SLinus Torvalds kfree_skb(skb); 4501da177e4SLinus Torvalds return -ETIMEDOUT; 4511da177e4SLinus Torvalds } 4521da177e4SLinus Torvalds 453fbea49e1SYOSHIFUJI Hideaki /* XXX: idev->cnf.proxy_ndp? */ 454fbea49e1SYOSHIFUJI Hideaki if (ipv6_devconf.proxy_ndp && 4558a3edd80SDaniel Lezcano pneigh_lookup(&nd_tbl, net, &hdr->daddr, skb->dev, 0)) { 45674553b09SVille Nuorvala int proxied = ip6_forward_proxy_check(skb); 45774553b09SVille Nuorvala if (proxied > 0) 458e21e0b5fSVille Nuorvala return ip6_input(skb); 45974553b09SVille Nuorvala else if (proxied < 0) { 460a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_INDISCARDS); 46174553b09SVille Nuorvala goto drop; 46274553b09SVille Nuorvala } 463e21e0b5fSVille Nuorvala } 464e21e0b5fSVille Nuorvala 4651da177e4SLinus Torvalds if (!xfrm6_route_forward(skb)) { 466a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_INDISCARDS); 4671da177e4SLinus Torvalds goto drop; 4681da177e4SLinus Torvalds } 4691da177e4SLinus Torvalds dst = skb->dst; 4701da177e4SLinus Torvalds 4711da177e4SLinus Torvalds /* IPv6 specs say nothing about it, but it is clear that we cannot 4721da177e4SLinus Torvalds send redirects to source routed frames. 4731e5dc146SMasahide NAKAMURA We don't send redirects to frames decapsulated from IPsec. 4741da177e4SLinus Torvalds */ 4751e5dc146SMasahide NAKAMURA if (skb->dev == dst->dev && dst->neighbour && opt->srcrt == 0 && 4761e5dc146SMasahide NAKAMURA !skb->sp) { 4771da177e4SLinus Torvalds struct in6_addr *target = NULL; 4781da177e4SLinus Torvalds struct rt6_info *rt; 4791da177e4SLinus Torvalds struct neighbour *n = dst->neighbour; 4801da177e4SLinus Torvalds 4811da177e4SLinus Torvalds /* 4821da177e4SLinus Torvalds * incoming and outgoing devices are the same 4831da177e4SLinus Torvalds * send a redirect. 4841da177e4SLinus Torvalds */ 4851da177e4SLinus Torvalds 4861da177e4SLinus Torvalds rt = (struct rt6_info *) dst; 4871da177e4SLinus Torvalds if ((rt->rt6i_flags & RTF_GATEWAY)) 4881da177e4SLinus Torvalds target = (struct in6_addr*)&n->primary_key; 4891da177e4SLinus Torvalds else 4901da177e4SLinus Torvalds target = &hdr->daddr; 4911da177e4SLinus Torvalds 4921da177e4SLinus Torvalds /* Limit redirects both by destination (here) 4931da177e4SLinus Torvalds and by source (inside ndisc_send_redirect) 4941da177e4SLinus Torvalds */ 4951da177e4SLinus Torvalds if (xrlim_allow(dst, 1*HZ)) 4961da177e4SLinus Torvalds ndisc_send_redirect(skb, n, target); 4975bb1ab09SDavid L Stevens } else { 4985bb1ab09SDavid L Stevens int addrtype = ipv6_addr_type(&hdr->saddr); 4995bb1ab09SDavid L Stevens 5001da177e4SLinus Torvalds /* This check is security critical. */ 501*f81b2e7dSYOSHIFUJI Hideaki if (addrtype == IPV6_ADDR_ANY || 502*f81b2e7dSYOSHIFUJI Hideaki addrtype & (IPV6_ADDR_MULTICAST | IPV6_ADDR_LOOPBACK)) 5031da177e4SLinus Torvalds goto error; 5045bb1ab09SDavid L Stevens if (addrtype & IPV6_ADDR_LINKLOCAL) { 5055bb1ab09SDavid L Stevens icmpv6_send(skb, ICMPV6_DEST_UNREACH, 5065bb1ab09SDavid L Stevens ICMPV6_NOT_NEIGHBOUR, 0, skb->dev); 5075bb1ab09SDavid L Stevens goto error; 5085bb1ab09SDavid L Stevens } 5091da177e4SLinus Torvalds } 5101da177e4SLinus Torvalds 5111da177e4SLinus Torvalds if (skb->len > dst_mtu(dst)) { 5121da177e4SLinus Torvalds /* Again, force OUTPUT device used as source address */ 5131da177e4SLinus Torvalds skb->dev = dst->dev; 5141da177e4SLinus Torvalds icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, dst_mtu(dst), skb->dev); 515a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_INTOOBIGERRORS); 516a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_FRAGFAILS); 5171da177e4SLinus Torvalds kfree_skb(skb); 5181da177e4SLinus Torvalds return -EMSGSIZE; 5191da177e4SLinus Torvalds } 5201da177e4SLinus Torvalds 5211da177e4SLinus Torvalds if (skb_cow(skb, dst->dev->hard_header_len)) { 522a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_OUTDISCARDS); 5231da177e4SLinus Torvalds goto drop; 5241da177e4SLinus Torvalds } 5251da177e4SLinus Torvalds 5260660e03fSArnaldo Carvalho de Melo hdr = ipv6_hdr(skb); 5271da177e4SLinus Torvalds 5281da177e4SLinus Torvalds /* Mangling hops number delayed to point after skb COW */ 5291da177e4SLinus Torvalds 5301da177e4SLinus Torvalds hdr->hop_limit--; 5311da177e4SLinus Torvalds 532a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_OUTFORWDATAGRAMS); 5336e23ae2aSPatrick McHardy return NF_HOOK(PF_INET6, NF_INET_FORWARD, skb, skb->dev, dst->dev, 5346e23ae2aSPatrick McHardy ip6_forward_finish); 5351da177e4SLinus Torvalds 5361da177e4SLinus Torvalds error: 537a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_INADDRERRORS); 5381da177e4SLinus Torvalds drop: 5391da177e4SLinus Torvalds kfree_skb(skb); 5401da177e4SLinus Torvalds return -EINVAL; 5411da177e4SLinus Torvalds } 5421da177e4SLinus Torvalds 5431da177e4SLinus Torvalds static void ip6_copy_metadata(struct sk_buff *to, struct sk_buff *from) 5441da177e4SLinus Torvalds { 5451da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 5461da177e4SLinus Torvalds to->priority = from->priority; 5471da177e4SLinus Torvalds to->protocol = from->protocol; 5481da177e4SLinus Torvalds dst_release(to->dst); 5491da177e4SLinus Torvalds to->dst = dst_clone(from->dst); 5501da177e4SLinus Torvalds to->dev = from->dev; 55182e91ffeSThomas Graf to->mark = from->mark; 5521da177e4SLinus Torvalds 5531da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 5541da177e4SLinus Torvalds to->tc_index = from->tc_index; 5551da177e4SLinus Torvalds #endif 556e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 557ba9dda3aSJozsef Kadlecsik #if defined(CONFIG_NETFILTER_XT_TARGET_TRACE) || \ 558ba9dda3aSJozsef Kadlecsik defined(CONFIG_NETFILTER_XT_TARGET_TRACE_MODULE) 559ba9dda3aSJozsef Kadlecsik to->nf_trace = from->nf_trace; 560ba9dda3aSJozsef Kadlecsik #endif 561984bc16cSJames Morris skb_copy_secmark(to, from); 5621da177e4SLinus Torvalds } 5631da177e4SLinus Torvalds 5641da177e4SLinus Torvalds int ip6_find_1stfragopt(struct sk_buff *skb, u8 **nexthdr) 5651da177e4SLinus Torvalds { 5661da177e4SLinus Torvalds u16 offset = sizeof(struct ipv6hdr); 5670660e03fSArnaldo Carvalho de Melo struct ipv6_opt_hdr *exthdr = 5680660e03fSArnaldo Carvalho de Melo (struct ipv6_opt_hdr *)(ipv6_hdr(skb) + 1); 56927a884dcSArnaldo Carvalho de Melo unsigned int packet_len = skb->tail - skb->network_header; 5701da177e4SLinus Torvalds int found_rhdr = 0; 5710660e03fSArnaldo Carvalho de Melo *nexthdr = &ipv6_hdr(skb)->nexthdr; 5721da177e4SLinus Torvalds 5731da177e4SLinus Torvalds while (offset + 1 <= packet_len) { 5741da177e4SLinus Torvalds 5751da177e4SLinus Torvalds switch (**nexthdr) { 5761da177e4SLinus Torvalds 5771da177e4SLinus Torvalds case NEXTHDR_HOP: 57827637df9SMasahide NAKAMURA break; 5791da177e4SLinus Torvalds case NEXTHDR_ROUTING: 58027637df9SMasahide NAKAMURA found_rhdr = 1; 58127637df9SMasahide NAKAMURA break; 5821da177e4SLinus Torvalds case NEXTHDR_DEST: 58359fbb3a6SMasahide NAKAMURA #if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE) 58427637df9SMasahide NAKAMURA if (ipv6_find_tlv(skb, offset, IPV6_TLV_HAO) >= 0) 58527637df9SMasahide NAKAMURA break; 58627637df9SMasahide NAKAMURA #endif 58727637df9SMasahide NAKAMURA if (found_rhdr) 58827637df9SMasahide NAKAMURA return offset; 5891da177e4SLinus Torvalds break; 5901da177e4SLinus Torvalds default : 5911da177e4SLinus Torvalds return offset; 5921da177e4SLinus Torvalds } 59327637df9SMasahide NAKAMURA 59427637df9SMasahide NAKAMURA offset += ipv6_optlen(exthdr); 59527637df9SMasahide NAKAMURA *nexthdr = &exthdr->nexthdr; 596d56f90a7SArnaldo Carvalho de Melo exthdr = (struct ipv6_opt_hdr *)(skb_network_header(skb) + 597d56f90a7SArnaldo Carvalho de Melo offset); 5981da177e4SLinus Torvalds } 5991da177e4SLinus Torvalds 6001da177e4SLinus Torvalds return offset; 6011da177e4SLinus Torvalds } 6021da177e4SLinus Torvalds 6031da177e4SLinus Torvalds static int ip6_fragment(struct sk_buff *skb, int (*output)(struct sk_buff *)) 6041da177e4SLinus Torvalds { 6051da177e4SLinus Torvalds struct net_device *dev; 6061da177e4SLinus Torvalds struct sk_buff *frag; 6071da177e4SLinus Torvalds struct rt6_info *rt = (struct rt6_info*)skb->dst; 608d91675f9SYOSHIFUJI Hideaki struct ipv6_pinfo *np = skb->sk ? inet6_sk(skb->sk) : NULL; 6091da177e4SLinus Torvalds struct ipv6hdr *tmp_hdr; 6101da177e4SLinus Torvalds struct frag_hdr *fh; 6111da177e4SLinus Torvalds unsigned int mtu, hlen, left, len; 612ae08e1f0SAl Viro __be32 frag_id = 0; 6131da177e4SLinus Torvalds int ptr, offset = 0, err=0; 6141da177e4SLinus Torvalds u8 *prevhdr, nexthdr = 0; 6151da177e4SLinus Torvalds 6161da177e4SLinus Torvalds dev = rt->u.dst.dev; 6171da177e4SLinus Torvalds hlen = ip6_find_1stfragopt(skb, &prevhdr); 6181da177e4SLinus Torvalds nexthdr = *prevhdr; 6191da177e4SLinus Torvalds 620628a5c56SJohn Heffner mtu = ip6_skb_dst_mtu(skb); 621b881ef76SJohn Heffner 622b881ef76SJohn Heffner /* We must not fragment if the socket is set to force MTU discovery 623b881ef76SJohn Heffner * or if the skb it not generated by a local socket. (This last 624b881ef76SJohn Heffner * check should be redundant, but it's free.) 625b881ef76SJohn Heffner */ 626b5c15fc0SHerbert Xu if (!skb->local_df) { 627b881ef76SJohn Heffner skb->dev = skb->dst->dev; 628b881ef76SJohn Heffner icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu, skb->dev); 629b881ef76SJohn Heffner IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS); 630b881ef76SJohn Heffner kfree_skb(skb); 631b881ef76SJohn Heffner return -EMSGSIZE; 632b881ef76SJohn Heffner } 633b881ef76SJohn Heffner 634d91675f9SYOSHIFUJI Hideaki if (np && np->frag_size < mtu) { 635d91675f9SYOSHIFUJI Hideaki if (np->frag_size) 636d91675f9SYOSHIFUJI Hideaki mtu = np->frag_size; 637d91675f9SYOSHIFUJI Hideaki } 638d91675f9SYOSHIFUJI Hideaki mtu -= hlen + sizeof(struct frag_hdr); 6391da177e4SLinus Torvalds 6401da177e4SLinus Torvalds if (skb_shinfo(skb)->frag_list) { 6411da177e4SLinus Torvalds int first_len = skb_pagelen(skb); 64229ffe1a5SHerbert Xu int truesizes = 0; 6431da177e4SLinus Torvalds 6441da177e4SLinus Torvalds if (first_len - hlen > mtu || 6451da177e4SLinus Torvalds ((first_len - hlen) & 7) || 6461da177e4SLinus Torvalds skb_cloned(skb)) 6471da177e4SLinus Torvalds goto slow_path; 6481da177e4SLinus Torvalds 6491da177e4SLinus Torvalds for (frag = skb_shinfo(skb)->frag_list; frag; frag = frag->next) { 6501da177e4SLinus Torvalds /* Correct geometry. */ 6511da177e4SLinus Torvalds if (frag->len > mtu || 6521da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 6531da177e4SLinus Torvalds skb_headroom(frag) < hlen) 6541da177e4SLinus Torvalds goto slow_path; 6551da177e4SLinus Torvalds 6561da177e4SLinus Torvalds /* Partially cloned skb? */ 6571da177e4SLinus Torvalds if (skb_shared(frag)) 6581da177e4SLinus Torvalds goto slow_path; 6592fdba6b0SHerbert Xu 6602fdba6b0SHerbert Xu BUG_ON(frag->sk); 6612fdba6b0SHerbert Xu if (skb->sk) { 6622fdba6b0SHerbert Xu sock_hold(skb->sk); 6632fdba6b0SHerbert Xu frag->sk = skb->sk; 6642fdba6b0SHerbert Xu frag->destructor = sock_wfree; 66529ffe1a5SHerbert Xu truesizes += frag->truesize; 6662fdba6b0SHerbert Xu } 6671da177e4SLinus Torvalds } 6681da177e4SLinus Torvalds 6691da177e4SLinus Torvalds err = 0; 6701da177e4SLinus Torvalds offset = 0; 6711da177e4SLinus Torvalds frag = skb_shinfo(skb)->frag_list; 6721da177e4SLinus Torvalds skb_shinfo(skb)->frag_list = NULL; 6731da177e4SLinus Torvalds /* BUILD HEADER */ 6741da177e4SLinus Torvalds 6759a217a1cSYOSHIFUJI Hideaki *prevhdr = NEXTHDR_FRAGMENT; 676d56f90a7SArnaldo Carvalho de Melo tmp_hdr = kmemdup(skb_network_header(skb), hlen, GFP_ATOMIC); 6771da177e4SLinus Torvalds if (!tmp_hdr) { 678a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS); 6791da177e4SLinus Torvalds return -ENOMEM; 6801da177e4SLinus Torvalds } 6811da177e4SLinus Torvalds 6821da177e4SLinus Torvalds __skb_pull(skb, hlen); 6831da177e4SLinus Torvalds fh = (struct frag_hdr*)__skb_push(skb, sizeof(struct frag_hdr)); 684e2d1bca7SArnaldo Carvalho de Melo __skb_push(skb, hlen); 685e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(skb); 686d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(skb), tmp_hdr, hlen); 6871da177e4SLinus Torvalds 6881da177e4SLinus Torvalds ipv6_select_ident(skb, fh); 6891da177e4SLinus Torvalds fh->nexthdr = nexthdr; 6901da177e4SLinus Torvalds fh->reserved = 0; 6911da177e4SLinus Torvalds fh->frag_off = htons(IP6_MF); 6921da177e4SLinus Torvalds frag_id = fh->identification; 6931da177e4SLinus Torvalds 6941da177e4SLinus Torvalds first_len = skb_pagelen(skb); 6951da177e4SLinus Torvalds skb->data_len = first_len - skb_headlen(skb); 69629ffe1a5SHerbert Xu skb->truesize -= truesizes; 6971da177e4SLinus Torvalds skb->len = first_len; 6980660e03fSArnaldo Carvalho de Melo ipv6_hdr(skb)->payload_len = htons(first_len - 6990660e03fSArnaldo Carvalho de Melo sizeof(struct ipv6hdr)); 7001da177e4SLinus Torvalds 701a11d206dSYOSHIFUJI Hideaki dst_hold(&rt->u.dst); 7021da177e4SLinus Torvalds 7031da177e4SLinus Torvalds for (;;) { 7041da177e4SLinus Torvalds /* Prepare header of the next frame, 7051da177e4SLinus Torvalds * before previous one went down. */ 7061da177e4SLinus Torvalds if (frag) { 7071da177e4SLinus Torvalds frag->ip_summed = CHECKSUM_NONE; 708badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(frag); 7091da177e4SLinus Torvalds fh = (struct frag_hdr*)__skb_push(frag, sizeof(struct frag_hdr)); 710e2d1bca7SArnaldo Carvalho de Melo __skb_push(frag, hlen); 711e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(frag); 712d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(frag), tmp_hdr, 713d56f90a7SArnaldo Carvalho de Melo hlen); 7141da177e4SLinus Torvalds offset += skb->len - hlen - sizeof(struct frag_hdr); 7151da177e4SLinus Torvalds fh->nexthdr = nexthdr; 7161da177e4SLinus Torvalds fh->reserved = 0; 7171da177e4SLinus Torvalds fh->frag_off = htons(offset); 7181da177e4SLinus Torvalds if (frag->next != NULL) 7191da177e4SLinus Torvalds fh->frag_off |= htons(IP6_MF); 7201da177e4SLinus Torvalds fh->identification = frag_id; 7210660e03fSArnaldo Carvalho de Melo ipv6_hdr(frag)->payload_len = 7220660e03fSArnaldo Carvalho de Melo htons(frag->len - 7230660e03fSArnaldo Carvalho de Melo sizeof(struct ipv6hdr)); 7241da177e4SLinus Torvalds ip6_copy_metadata(frag, skb); 7251da177e4SLinus Torvalds } 7261da177e4SLinus Torvalds 7271da177e4SLinus Torvalds err = output(skb); 728dafee490SWei Dong if(!err) 729a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(&rt->u.dst), IPSTATS_MIB_FRAGCREATES); 730dafee490SWei Dong 7311da177e4SLinus Torvalds if (err || !frag) 7321da177e4SLinus Torvalds break; 7331da177e4SLinus Torvalds 7341da177e4SLinus Torvalds skb = frag; 7351da177e4SLinus Torvalds frag = skb->next; 7361da177e4SLinus Torvalds skb->next = NULL; 7371da177e4SLinus Torvalds } 7381da177e4SLinus Torvalds 7391da177e4SLinus Torvalds kfree(tmp_hdr); 7401da177e4SLinus Torvalds 7411da177e4SLinus Torvalds if (err == 0) { 742a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(&rt->u.dst), IPSTATS_MIB_FRAGOKS); 743a11d206dSYOSHIFUJI Hideaki dst_release(&rt->u.dst); 7441da177e4SLinus Torvalds return 0; 7451da177e4SLinus Torvalds } 7461da177e4SLinus Torvalds 7471da177e4SLinus Torvalds while (frag) { 7481da177e4SLinus Torvalds skb = frag->next; 7491da177e4SLinus Torvalds kfree_skb(frag); 7501da177e4SLinus Torvalds frag = skb; 7511da177e4SLinus Torvalds } 7521da177e4SLinus Torvalds 753a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(&rt->u.dst), IPSTATS_MIB_FRAGFAILS); 754a11d206dSYOSHIFUJI Hideaki dst_release(&rt->u.dst); 7551da177e4SLinus Torvalds return err; 7561da177e4SLinus Torvalds } 7571da177e4SLinus Torvalds 7581da177e4SLinus Torvalds slow_path: 7591da177e4SLinus Torvalds left = skb->len - hlen; /* Space per frame */ 7601da177e4SLinus Torvalds ptr = hlen; /* Where to start from */ 7611da177e4SLinus Torvalds 7621da177e4SLinus Torvalds /* 7631da177e4SLinus Torvalds * Fragment the datagram. 7641da177e4SLinus Torvalds */ 7651da177e4SLinus Torvalds 7661da177e4SLinus Torvalds *prevhdr = NEXTHDR_FRAGMENT; 7671da177e4SLinus Torvalds 7681da177e4SLinus Torvalds /* 7691da177e4SLinus Torvalds * Keep copying data until we run out. 7701da177e4SLinus Torvalds */ 7711da177e4SLinus Torvalds while(left > 0) { 7721da177e4SLinus Torvalds len = left; 7731da177e4SLinus Torvalds /* IF: it doesn't fit, use 'mtu' - the data space left */ 7741da177e4SLinus Torvalds if (len > mtu) 7751da177e4SLinus Torvalds len = mtu; 7761da177e4SLinus Torvalds /* IF: we are not sending upto and including the packet end 7771da177e4SLinus Torvalds then align the next start on an eight byte boundary */ 7781da177e4SLinus Torvalds if (len < left) { 7791da177e4SLinus Torvalds len &= ~7; 7801da177e4SLinus Torvalds } 7811da177e4SLinus Torvalds /* 7821da177e4SLinus Torvalds * Allocate buffer. 7831da177e4SLinus Torvalds */ 7841da177e4SLinus Torvalds 785f5184d26SJohannes Berg if ((frag = alloc_skb(len+hlen+sizeof(struct frag_hdr)+LL_ALLOCATED_SPACE(rt->u.dst.dev), GFP_ATOMIC)) == NULL) { 78664ce2073SPatrick McHardy NETDEBUG(KERN_INFO "IPv6: frag: no memory for new fragment!\n"); 787a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(skb->dst), 788a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_FRAGFAILS); 7891da177e4SLinus Torvalds err = -ENOMEM; 7901da177e4SLinus Torvalds goto fail; 7911da177e4SLinus Torvalds } 7921da177e4SLinus Torvalds 7931da177e4SLinus Torvalds /* 7941da177e4SLinus Torvalds * Set up data on packet 7951da177e4SLinus Torvalds */ 7961da177e4SLinus Torvalds 7971da177e4SLinus Torvalds ip6_copy_metadata(frag, skb); 7981da177e4SLinus Torvalds skb_reserve(frag, LL_RESERVED_SPACE(rt->u.dst.dev)); 7991da177e4SLinus Torvalds skb_put(frag, len + hlen + sizeof(struct frag_hdr)); 800c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(frag); 801badff6d0SArnaldo Carvalho de Melo fh = (struct frag_hdr *)(skb_network_header(frag) + hlen); 802b0e380b1SArnaldo Carvalho de Melo frag->transport_header = (frag->network_header + hlen + 803b0e380b1SArnaldo Carvalho de Melo sizeof(struct frag_hdr)); 8041da177e4SLinus Torvalds 8051da177e4SLinus Torvalds /* 8061da177e4SLinus Torvalds * Charge the memory for the fragment to any owner 8071da177e4SLinus Torvalds * it might possess 8081da177e4SLinus Torvalds */ 8091da177e4SLinus Torvalds if (skb->sk) 8101da177e4SLinus Torvalds skb_set_owner_w(frag, skb->sk); 8111da177e4SLinus Torvalds 8121da177e4SLinus Torvalds /* 8131da177e4SLinus Torvalds * Copy the packet header into the new buffer. 8141da177e4SLinus Torvalds */ 815d626f62bSArnaldo Carvalho de Melo skb_copy_from_linear_data(skb, skb_network_header(frag), hlen); 8161da177e4SLinus Torvalds 8171da177e4SLinus Torvalds /* 8181da177e4SLinus Torvalds * Build fragment header. 8191da177e4SLinus Torvalds */ 8201da177e4SLinus Torvalds fh->nexthdr = nexthdr; 8211da177e4SLinus Torvalds fh->reserved = 0; 822f36d6ab1SYan Zheng if (!frag_id) { 8231da177e4SLinus Torvalds ipv6_select_ident(skb, fh); 8241da177e4SLinus Torvalds frag_id = fh->identification; 8251da177e4SLinus Torvalds } else 8261da177e4SLinus Torvalds fh->identification = frag_id; 8271da177e4SLinus Torvalds 8281da177e4SLinus Torvalds /* 8291da177e4SLinus Torvalds * Copy a block of the IP datagram. 8301da177e4SLinus Torvalds */ 8318984e41dSWei Yongjun if (skb_copy_bits(skb, ptr, skb_transport_header(frag), len)) 8321da177e4SLinus Torvalds BUG(); 8331da177e4SLinus Torvalds left -= len; 8341da177e4SLinus Torvalds 8351da177e4SLinus Torvalds fh->frag_off = htons(offset); 8361da177e4SLinus Torvalds if (left > 0) 8371da177e4SLinus Torvalds fh->frag_off |= htons(IP6_MF); 8380660e03fSArnaldo Carvalho de Melo ipv6_hdr(frag)->payload_len = htons(frag->len - 8390660e03fSArnaldo Carvalho de Melo sizeof(struct ipv6hdr)); 8401da177e4SLinus Torvalds 8411da177e4SLinus Torvalds ptr += len; 8421da177e4SLinus Torvalds offset += len; 8431da177e4SLinus Torvalds 8441da177e4SLinus Torvalds /* 8451da177e4SLinus Torvalds * Put this fragment into the sending queue. 8461da177e4SLinus Torvalds */ 8471da177e4SLinus Torvalds err = output(frag); 8481da177e4SLinus Torvalds if (err) 8491da177e4SLinus Torvalds goto fail; 850dafee490SWei Dong 851a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGCREATES); 8521da177e4SLinus Torvalds } 853a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(skb->dst), 854a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_FRAGOKS); 8551da177e4SLinus Torvalds kfree_skb(skb); 8561da177e4SLinus Torvalds return err; 8571da177e4SLinus Torvalds 8581da177e4SLinus Torvalds fail: 859a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(skb->dst), 860a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_FRAGFAILS); 8611da177e4SLinus Torvalds kfree_skb(skb); 8621da177e4SLinus Torvalds return err; 8631da177e4SLinus Torvalds } 8641da177e4SLinus Torvalds 865cf6b1982SYOSHIFUJI Hideaki static inline int ip6_rt_check(struct rt6key *rt_key, 866cf6b1982SYOSHIFUJI Hideaki struct in6_addr *fl_addr, 867cf6b1982SYOSHIFUJI Hideaki struct in6_addr *addr_cache) 868cf6b1982SYOSHIFUJI Hideaki { 869cf6b1982SYOSHIFUJI Hideaki return ((rt_key->plen != 128 || !ipv6_addr_equal(fl_addr, &rt_key->addr)) && 870cf6b1982SYOSHIFUJI Hideaki (addr_cache == NULL || !ipv6_addr_equal(fl_addr, addr_cache))); 871cf6b1982SYOSHIFUJI Hideaki } 872cf6b1982SYOSHIFUJI Hideaki 873497c615aSHerbert Xu static struct dst_entry *ip6_sk_dst_check(struct sock *sk, 874497c615aSHerbert Xu struct dst_entry *dst, 875497c615aSHerbert Xu struct flowi *fl) 8761da177e4SLinus Torvalds { 8771da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 878497c615aSHerbert Xu struct rt6_info *rt = (struct rt6_info *)dst; 8791da177e4SLinus Torvalds 880497c615aSHerbert Xu if (!dst) 881497c615aSHerbert Xu goto out; 8821da177e4SLinus Torvalds 8831da177e4SLinus Torvalds /* Yes, checking route validity in not connected 884d76e60a5SDavid S. Miller * case is not very simple. Take into account, 885d76e60a5SDavid S. Miller * that we do not support routing by source, TOS, 886d76e60a5SDavid S. Miller * and MSG_DONTROUTE --ANK (980726) 887d76e60a5SDavid S. Miller * 888cf6b1982SYOSHIFUJI Hideaki * 1. ip6_rt_check(): If route was host route, 889cf6b1982SYOSHIFUJI Hideaki * check that cached destination is current. 890d76e60a5SDavid S. Miller * If it is network route, we still may 891d76e60a5SDavid S. Miller * check its validity using saved pointer 892d76e60a5SDavid S. Miller * to the last used address: daddr_cache. 893d76e60a5SDavid S. Miller * We do not want to save whole address now, 894d76e60a5SDavid S. Miller * (because main consumer of this service 895d76e60a5SDavid S. Miller * is tcp, which has not this problem), 896d76e60a5SDavid S. Miller * so that the last trick works only on connected 897d76e60a5SDavid S. Miller * sockets. 898d76e60a5SDavid S. Miller * 2. oif also should be the same. 8991da177e4SLinus Torvalds */ 900cf6b1982SYOSHIFUJI Hideaki if (ip6_rt_check(&rt->rt6i_dst, &fl->fl6_dst, np->daddr_cache) || 9018e1ef0a9SYOSHIFUJI Hideaki #ifdef CONFIG_IPV6_SUBTREES 9028e1ef0a9SYOSHIFUJI Hideaki ip6_rt_check(&rt->rt6i_src, &fl->fl6_src, np->saddr_cache) || 9038e1ef0a9SYOSHIFUJI Hideaki #endif 904cf6b1982SYOSHIFUJI Hideaki (fl->oif && fl->oif != dst->dev->ifindex)) { 905497c615aSHerbert Xu dst_release(dst); 906497c615aSHerbert Xu dst = NULL; 9071da177e4SLinus Torvalds } 908497c615aSHerbert Xu 909497c615aSHerbert Xu out: 910497c615aSHerbert Xu return dst; 9111da177e4SLinus Torvalds } 912497c615aSHerbert Xu 913497c615aSHerbert Xu static int ip6_dst_lookup_tail(struct sock *sk, 914497c615aSHerbert Xu struct dst_entry **dst, struct flowi *fl) 915497c615aSHerbert Xu { 916497c615aSHerbert Xu int err; 9173b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(sk); 9181da177e4SLinus Torvalds 9191da177e4SLinus Torvalds if (*dst == NULL) 9208a3edd80SDaniel Lezcano *dst = ip6_route_output(net, sk, fl); 9211da177e4SLinus Torvalds 9221da177e4SLinus Torvalds if ((err = (*dst)->error)) 9231da177e4SLinus Torvalds goto out_err_release; 9241da177e4SLinus Torvalds 9251da177e4SLinus Torvalds if (ipv6_addr_any(&fl->fl6_src)) { 9265e5f3f0fSYOSHIFUJI Hideaki err = ipv6_dev_get_saddr(ip6_dst_idev(*dst)->dev, 9277cbca67cSYOSHIFUJI Hideaki &fl->fl6_dst, 9287cbca67cSYOSHIFUJI Hideaki sk ? inet6_sk(sk)->srcprefs : 0, 9297cbca67cSYOSHIFUJI Hideaki &fl->fl6_src); 93044456d37SOlaf Hering if (err) 9311da177e4SLinus Torvalds goto out_err_release; 9321da177e4SLinus Torvalds } 9331da177e4SLinus Torvalds 93495c385b4SNeil Horman #ifdef CONFIG_IPV6_OPTIMISTIC_DAD 93595c385b4SNeil Horman /* 93695c385b4SNeil Horman * Here if the dst entry we've looked up 93795c385b4SNeil Horman * has a neighbour entry that is in the INCOMPLETE 93895c385b4SNeil Horman * state and the src address from the flow is 93995c385b4SNeil Horman * marked as OPTIMISTIC, we release the found 94095c385b4SNeil Horman * dst entry and replace it instead with the 94195c385b4SNeil Horman * dst entry of the nexthop router 94295c385b4SNeil Horman */ 94395c385b4SNeil Horman if (!((*dst)->neighbour->nud_state & NUD_VALID)) { 94495c385b4SNeil Horman struct inet6_ifaddr *ifp; 94595c385b4SNeil Horman struct flowi fl_gw; 94695c385b4SNeil Horman int redirect; 94795c385b4SNeil Horman 9488a3edd80SDaniel Lezcano ifp = ipv6_get_ifaddr(net, &fl->fl6_src, 9491cab3da6SDaniel Lezcano (*dst)->dev, 1); 95095c385b4SNeil Horman 95195c385b4SNeil Horman redirect = (ifp && ifp->flags & IFA_F_OPTIMISTIC); 95295c385b4SNeil Horman if (ifp) 95395c385b4SNeil Horman in6_ifa_put(ifp); 95495c385b4SNeil Horman 95595c385b4SNeil Horman if (redirect) { 95695c385b4SNeil Horman /* 95795c385b4SNeil Horman * We need to get the dst entry for the 95895c385b4SNeil Horman * default router instead 95995c385b4SNeil Horman */ 96095c385b4SNeil Horman dst_release(*dst); 96195c385b4SNeil Horman memcpy(&fl_gw, fl, sizeof(struct flowi)); 96295c385b4SNeil Horman memset(&fl_gw.fl6_dst, 0, sizeof(struct in6_addr)); 9638a3edd80SDaniel Lezcano *dst = ip6_route_output(net, sk, &fl_gw); 96495c385b4SNeil Horman if ((err = (*dst)->error)) 96595c385b4SNeil Horman goto out_err_release; 96695c385b4SNeil Horman } 96795c385b4SNeil Horman } 96895c385b4SNeil Horman #endif 96995c385b4SNeil Horman 9701da177e4SLinus Torvalds return 0; 9711da177e4SLinus Torvalds 9721da177e4SLinus Torvalds out_err_release: 973ca46f9c8SMitsuru Chinen if (err == -ENETUNREACH) 974ca46f9c8SMitsuru Chinen IP6_INC_STATS_BH(NULL, IPSTATS_MIB_OUTNOROUTES); 9751da177e4SLinus Torvalds dst_release(*dst); 9761da177e4SLinus Torvalds *dst = NULL; 9771da177e4SLinus Torvalds return err; 9781da177e4SLinus Torvalds } 97934a0b3cdSAdrian Bunk 980497c615aSHerbert Xu /** 981497c615aSHerbert Xu * ip6_dst_lookup - perform route lookup on flow 982497c615aSHerbert Xu * @sk: socket which provides route info 983497c615aSHerbert Xu * @dst: pointer to dst_entry * for result 984497c615aSHerbert Xu * @fl: flow to lookup 985497c615aSHerbert Xu * 986497c615aSHerbert Xu * This function performs a route lookup on the given flow. 987497c615aSHerbert Xu * 988497c615aSHerbert Xu * It returns zero on success, or a standard errno code on error. 989497c615aSHerbert Xu */ 990497c615aSHerbert Xu int ip6_dst_lookup(struct sock *sk, struct dst_entry **dst, struct flowi *fl) 991497c615aSHerbert Xu { 992497c615aSHerbert Xu *dst = NULL; 993497c615aSHerbert Xu return ip6_dst_lookup_tail(sk, dst, fl); 994497c615aSHerbert Xu } 9953cf3dc6cSArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip6_dst_lookup); 9963cf3dc6cSArnaldo Carvalho de Melo 997497c615aSHerbert Xu /** 998497c615aSHerbert Xu * ip6_sk_dst_lookup - perform socket cached route lookup on flow 999497c615aSHerbert Xu * @sk: socket which provides the dst cache and route info 1000497c615aSHerbert Xu * @dst: pointer to dst_entry * for result 1001497c615aSHerbert Xu * @fl: flow to lookup 1002497c615aSHerbert Xu * 1003497c615aSHerbert Xu * This function performs a route lookup on the given flow with the 1004497c615aSHerbert Xu * possibility of using the cached route in the socket if it is valid. 1005497c615aSHerbert Xu * It will take the socket dst lock when operating on the dst cache. 1006497c615aSHerbert Xu * As a result, this function can only be used in process context. 1007497c615aSHerbert Xu * 1008497c615aSHerbert Xu * It returns zero on success, or a standard errno code on error. 1009497c615aSHerbert Xu */ 1010497c615aSHerbert Xu int ip6_sk_dst_lookup(struct sock *sk, struct dst_entry **dst, struct flowi *fl) 1011497c615aSHerbert Xu { 1012497c615aSHerbert Xu *dst = NULL; 1013497c615aSHerbert Xu if (sk) { 1014497c615aSHerbert Xu *dst = sk_dst_check(sk, inet6_sk(sk)->dst_cookie); 1015497c615aSHerbert Xu *dst = ip6_sk_dst_check(sk, *dst, fl); 1016497c615aSHerbert Xu } 1017497c615aSHerbert Xu 1018497c615aSHerbert Xu return ip6_dst_lookup_tail(sk, dst, fl); 1019497c615aSHerbert Xu } 1020497c615aSHerbert Xu EXPORT_SYMBOL_GPL(ip6_sk_dst_lookup); 1021497c615aSHerbert Xu 102234a0b3cdSAdrian Bunk static inline int ip6_ufo_append_data(struct sock *sk, 1023e89e9cf5SAnanda Raju int getfrag(void *from, char *to, int offset, int len, 1024e89e9cf5SAnanda Raju int odd, struct sk_buff *skb), 1025e89e9cf5SAnanda Raju void *from, int length, int hh_len, int fragheaderlen, 1026e89e9cf5SAnanda Raju int transhdrlen, int mtu,unsigned int flags) 1027e89e9cf5SAnanda Raju 1028e89e9cf5SAnanda Raju { 1029e89e9cf5SAnanda Raju struct sk_buff *skb; 1030e89e9cf5SAnanda Raju int err; 1031e89e9cf5SAnanda Raju 1032e89e9cf5SAnanda Raju /* There is support for UDP large send offload by network 1033e89e9cf5SAnanda Raju * device, so create one single skb packet containing complete 1034e89e9cf5SAnanda Raju * udp datagram 1035e89e9cf5SAnanda Raju */ 1036e89e9cf5SAnanda Raju if ((skb = skb_peek_tail(&sk->sk_write_queue)) == NULL) { 1037e89e9cf5SAnanda Raju skb = sock_alloc_send_skb(sk, 1038e89e9cf5SAnanda Raju hh_len + fragheaderlen + transhdrlen + 20, 1039e89e9cf5SAnanda Raju (flags & MSG_DONTWAIT), &err); 1040e89e9cf5SAnanda Raju if (skb == NULL) 1041e89e9cf5SAnanda Raju return -ENOMEM; 1042e89e9cf5SAnanda Raju 1043e89e9cf5SAnanda Raju /* reserve space for Hardware header */ 1044e89e9cf5SAnanda Raju skb_reserve(skb, hh_len); 1045e89e9cf5SAnanda Raju 1046e89e9cf5SAnanda Raju /* create space for UDP/IP header */ 1047e89e9cf5SAnanda Raju skb_put(skb,fragheaderlen + transhdrlen); 1048e89e9cf5SAnanda Raju 1049e89e9cf5SAnanda Raju /* initialize network header pointer */ 1050c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1051e89e9cf5SAnanda Raju 1052e89e9cf5SAnanda Raju /* initialize protocol header pointer */ 1053b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header + fragheaderlen; 1054e89e9cf5SAnanda Raju 105584fa7933SPatrick McHardy skb->ip_summed = CHECKSUM_PARTIAL; 1056e89e9cf5SAnanda Raju skb->csum = 0; 1057e89e9cf5SAnanda Raju sk->sk_sndmsg_off = 0; 1058e89e9cf5SAnanda Raju } 1059e89e9cf5SAnanda Raju 1060e89e9cf5SAnanda Raju err = skb_append_datato_frags(sk,skb, getfrag, from, 1061e89e9cf5SAnanda Raju (length - transhdrlen)); 1062e89e9cf5SAnanda Raju if (!err) { 1063e89e9cf5SAnanda Raju struct frag_hdr fhdr; 1064e89e9cf5SAnanda Raju 1065e89e9cf5SAnanda Raju /* specify the length of each IP datagram fragment*/ 10667967168cSHerbert Xu skb_shinfo(skb)->gso_size = mtu - fragheaderlen - 1067e89e9cf5SAnanda Raju sizeof(struct frag_hdr); 1068f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 1069e89e9cf5SAnanda Raju ipv6_select_ident(skb, &fhdr); 1070e89e9cf5SAnanda Raju skb_shinfo(skb)->ip6_frag_id = fhdr.identification; 1071e89e9cf5SAnanda Raju __skb_queue_tail(&sk->sk_write_queue, skb); 1072e89e9cf5SAnanda Raju 1073e89e9cf5SAnanda Raju return 0; 1074e89e9cf5SAnanda Raju } 1075e89e9cf5SAnanda Raju /* There is not enough support do UPD LSO, 1076e89e9cf5SAnanda Raju * so follow normal path 1077e89e9cf5SAnanda Raju */ 1078e89e9cf5SAnanda Raju kfree_skb(skb); 1079e89e9cf5SAnanda Raju 1080e89e9cf5SAnanda Raju return err; 1081e89e9cf5SAnanda Raju } 10821da177e4SLinus Torvalds 108341a1f8eaSYOSHIFUJI Hideaki int ip6_append_data(struct sock *sk, int getfrag(void *from, char *to, 108441a1f8eaSYOSHIFUJI Hideaki int offset, int len, int odd, struct sk_buff *skb), 10851da177e4SLinus Torvalds void *from, int length, int transhdrlen, 108641a1f8eaSYOSHIFUJI Hideaki int hlimit, int tclass, struct ipv6_txoptions *opt, struct flowi *fl, 108741a1f8eaSYOSHIFUJI Hideaki struct rt6_info *rt, unsigned int flags) 10881da177e4SLinus Torvalds { 10891da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 10901da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 10911da177e4SLinus Torvalds struct sk_buff *skb; 10921da177e4SLinus Torvalds unsigned int maxfraglen, fragheaderlen; 10931da177e4SLinus Torvalds int exthdrlen; 10941da177e4SLinus Torvalds int hh_len; 10951da177e4SLinus Torvalds int mtu; 10961da177e4SLinus Torvalds int copy; 10971da177e4SLinus Torvalds int err; 10981da177e4SLinus Torvalds int offset = 0; 10991da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 11001da177e4SLinus Torvalds 11011da177e4SLinus Torvalds if (flags&MSG_PROBE) 11021da177e4SLinus Torvalds return 0; 11031da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) { 11041da177e4SLinus Torvalds /* 11051da177e4SLinus Torvalds * setup for corking 11061da177e4SLinus Torvalds */ 11071da177e4SLinus Torvalds if (opt) { 11081da177e4SLinus Torvalds if (np->cork.opt == NULL) { 11091da177e4SLinus Torvalds np->cork.opt = kmalloc(opt->tot_len, 11101da177e4SLinus Torvalds sk->sk_allocation); 11111da177e4SLinus Torvalds if (unlikely(np->cork.opt == NULL)) 11121da177e4SLinus Torvalds return -ENOBUFS; 11131da177e4SLinus Torvalds } else if (np->cork.opt->tot_len < opt->tot_len) { 11141da177e4SLinus Torvalds printk(KERN_DEBUG "ip6_append_data: invalid option length\n"); 11151da177e4SLinus Torvalds return -EINVAL; 11161da177e4SLinus Torvalds } 11171da177e4SLinus Torvalds memcpy(np->cork.opt, opt, opt->tot_len); 11181da177e4SLinus Torvalds inet->cork.flags |= IPCORK_OPT; 11191da177e4SLinus Torvalds /* need source address above miyazawa*/ 11201da177e4SLinus Torvalds } 11211da177e4SLinus Torvalds dst_hold(&rt->u.dst); 1122c8cdaf99SYOSHIFUJI Hideaki inet->cork.dst = &rt->u.dst; 11231da177e4SLinus Torvalds inet->cork.fl = *fl; 11241da177e4SLinus Torvalds np->cork.hop_limit = hlimit; 112541a1f8eaSYOSHIFUJI Hideaki np->cork.tclass = tclass; 1126628a5c56SJohn Heffner mtu = np->pmtudisc == IPV6_PMTUDISC_PROBE ? 1127628a5c56SJohn Heffner rt->u.dst.dev->mtu : dst_mtu(rt->u.dst.path); 1128c7503609SDave Jones if (np->frag_size < mtu) { 1129d91675f9SYOSHIFUJI Hideaki if (np->frag_size) 1130d91675f9SYOSHIFUJI Hideaki mtu = np->frag_size; 1131d91675f9SYOSHIFUJI Hideaki } 1132d91675f9SYOSHIFUJI Hideaki inet->cork.fragsize = mtu; 11331da177e4SLinus Torvalds if (dst_allfrag(rt->u.dst.path)) 11341da177e4SLinus Torvalds inet->cork.flags |= IPCORK_ALLFRAG; 11351da177e4SLinus Torvalds inet->cork.length = 0; 11361da177e4SLinus Torvalds sk->sk_sndmsg_page = NULL; 11371da177e4SLinus Torvalds sk->sk_sndmsg_off = 0; 113801488942SHerbert Xu exthdrlen = rt->u.dst.header_len + (opt ? opt->opt_flen : 0) - 1139a1b05140SMasahide NAKAMURA rt->rt6i_nfheader_len; 11401da177e4SLinus Torvalds length += exthdrlen; 11411da177e4SLinus Torvalds transhdrlen += exthdrlen; 11421da177e4SLinus Torvalds } else { 1143c8cdaf99SYOSHIFUJI Hideaki rt = (struct rt6_info *)inet->cork.dst; 11441da177e4SLinus Torvalds fl = &inet->cork.fl; 11451da177e4SLinus Torvalds if (inet->cork.flags & IPCORK_OPT) 11461da177e4SLinus Torvalds opt = np->cork.opt; 11471da177e4SLinus Torvalds transhdrlen = 0; 11481da177e4SLinus Torvalds exthdrlen = 0; 11491da177e4SLinus Torvalds mtu = inet->cork.fragsize; 11501da177e4SLinus Torvalds } 11511da177e4SLinus Torvalds 11521da177e4SLinus Torvalds hh_len = LL_RESERVED_SPACE(rt->u.dst.dev); 11531da177e4SLinus Torvalds 1154a1b05140SMasahide NAKAMURA fragheaderlen = sizeof(struct ipv6hdr) + rt->rt6i_nfheader_len + 1155b4ce9277SHerbert Xu (opt ? opt->opt_nflen : 0); 11561da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen - sizeof(struct frag_hdr); 11571da177e4SLinus Torvalds 11581da177e4SLinus Torvalds if (mtu <= sizeof(struct ipv6hdr) + IPV6_MAXPLEN) { 11591da177e4SLinus Torvalds if (inet->cork.length + length > sizeof(struct ipv6hdr) + IPV6_MAXPLEN - fragheaderlen) { 11601da177e4SLinus Torvalds ipv6_local_error(sk, EMSGSIZE, fl, mtu-exthdrlen); 11611da177e4SLinus Torvalds return -EMSGSIZE; 11621da177e4SLinus Torvalds } 11631da177e4SLinus Torvalds } 11641da177e4SLinus Torvalds 11651da177e4SLinus Torvalds /* 11661da177e4SLinus Torvalds * Let's try using as much space as possible. 11671da177e4SLinus Torvalds * Use MTU if total length of the message fits into the MTU. 11681da177e4SLinus Torvalds * Otherwise, we need to reserve fragment header and 11691da177e4SLinus Torvalds * fragment alignment (= 8-15 octects, in total). 11701da177e4SLinus Torvalds * 11711da177e4SLinus Torvalds * Note that we may need to "move" the data from the tail of 11721da177e4SLinus Torvalds * of the buffer to the new fragment when we split 11731da177e4SLinus Torvalds * the message. 11741da177e4SLinus Torvalds * 11751da177e4SLinus Torvalds * FIXME: It may be fragmented into multiple chunks 11761da177e4SLinus Torvalds * at once if non-fragmentable extension headers 11771da177e4SLinus Torvalds * are too large. 11781da177e4SLinus Torvalds * --yoshfuji 11791da177e4SLinus Torvalds */ 11801da177e4SLinus Torvalds 11811da177e4SLinus Torvalds inet->cork.length += length; 1182e89e9cf5SAnanda Raju if (((length > mtu) && (sk->sk_protocol == IPPROTO_UDP)) && 1183e89e9cf5SAnanda Raju (rt->u.dst.dev->features & NETIF_F_UFO)) { 1184e89e9cf5SAnanda Raju 1185baa829d8SPatrick McHardy err = ip6_ufo_append_data(sk, getfrag, from, length, hh_len, 1186baa829d8SPatrick McHardy fragheaderlen, transhdrlen, mtu, 1187baa829d8SPatrick McHardy flags); 1188baa829d8SPatrick McHardy if (err) 1189e89e9cf5SAnanda Raju goto error; 1190e89e9cf5SAnanda Raju return 0; 1191e89e9cf5SAnanda Raju } 11921da177e4SLinus Torvalds 11931da177e4SLinus Torvalds if ((skb = skb_peek_tail(&sk->sk_write_queue)) == NULL) 11941da177e4SLinus Torvalds goto alloc_new_skb; 11951da177e4SLinus Torvalds 11961da177e4SLinus Torvalds while (length > 0) { 11971da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 11981da177e4SLinus Torvalds copy = (inet->cork.length <= mtu && !(inet->cork.flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - skb->len; 11991da177e4SLinus Torvalds if (copy < length) 12001da177e4SLinus Torvalds copy = maxfraglen - skb->len; 12011da177e4SLinus Torvalds 12021da177e4SLinus Torvalds if (copy <= 0) { 12031da177e4SLinus Torvalds char *data; 12041da177e4SLinus Torvalds unsigned int datalen; 12051da177e4SLinus Torvalds unsigned int fraglen; 12061da177e4SLinus Torvalds unsigned int fraggap; 12071da177e4SLinus Torvalds unsigned int alloclen; 12081da177e4SLinus Torvalds struct sk_buff *skb_prev; 12091da177e4SLinus Torvalds alloc_new_skb: 12101da177e4SLinus Torvalds skb_prev = skb; 12111da177e4SLinus Torvalds 12121da177e4SLinus Torvalds /* There's no room in the current skb */ 12131da177e4SLinus Torvalds if (skb_prev) 12141da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 12151da177e4SLinus Torvalds else 12161da177e4SLinus Torvalds fraggap = 0; 12171da177e4SLinus Torvalds 12181da177e4SLinus Torvalds /* 12191da177e4SLinus Torvalds * If remaining data exceeds the mtu, 12201da177e4SLinus Torvalds * we know we need more fragment(s). 12211da177e4SLinus Torvalds */ 12221da177e4SLinus Torvalds datalen = length + fraggap; 12231da177e4SLinus Torvalds if (datalen > (inet->cork.length <= mtu && !(inet->cork.flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - fragheaderlen) 12241da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 12251da177e4SLinus Torvalds 12261da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 12271da177e4SLinus Torvalds if ((flags & MSG_MORE) && 12281da177e4SLinus Torvalds !(rt->u.dst.dev->features&NETIF_F_SG)) 12291da177e4SLinus Torvalds alloclen = mtu; 12301da177e4SLinus Torvalds else 12311da177e4SLinus Torvalds alloclen = datalen + fragheaderlen; 12321da177e4SLinus Torvalds 12331da177e4SLinus Torvalds /* 12341da177e4SLinus Torvalds * The last fragment gets additional space at tail. 12351da177e4SLinus Torvalds * Note: we overallocate on fragments with MSG_MODE 12361da177e4SLinus Torvalds * because we have no idea if we're the last one. 12371da177e4SLinus Torvalds */ 12381da177e4SLinus Torvalds if (datalen == length + fraggap) 12391da177e4SLinus Torvalds alloclen += rt->u.dst.trailer_len; 12401da177e4SLinus Torvalds 12411da177e4SLinus Torvalds /* 12421da177e4SLinus Torvalds * We just reserve space for fragment header. 12431da177e4SLinus Torvalds * Note: this may be overallocation if the message 12441da177e4SLinus Torvalds * (without MSG_MORE) fits into the MTU. 12451da177e4SLinus Torvalds */ 12461da177e4SLinus Torvalds alloclen += sizeof(struct frag_hdr); 12471da177e4SLinus Torvalds 12481da177e4SLinus Torvalds if (transhdrlen) { 12491da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 12501da177e4SLinus Torvalds alloclen + hh_len, 12511da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 12521da177e4SLinus Torvalds } else { 12531da177e4SLinus Torvalds skb = NULL; 12541da177e4SLinus Torvalds if (atomic_read(&sk->sk_wmem_alloc) <= 12551da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 12561da177e4SLinus Torvalds skb = sock_wmalloc(sk, 12571da177e4SLinus Torvalds alloclen + hh_len, 1, 12581da177e4SLinus Torvalds sk->sk_allocation); 12591da177e4SLinus Torvalds if (unlikely(skb == NULL)) 12601da177e4SLinus Torvalds err = -ENOBUFS; 12611da177e4SLinus Torvalds } 12621da177e4SLinus Torvalds if (skb == NULL) 12631da177e4SLinus Torvalds goto error; 12641da177e4SLinus Torvalds /* 12651da177e4SLinus Torvalds * Fill in the control structures 12661da177e4SLinus Torvalds */ 12671da177e4SLinus Torvalds skb->ip_summed = csummode; 12681da177e4SLinus Torvalds skb->csum = 0; 12691da177e4SLinus Torvalds /* reserve for fragmentation */ 12701da177e4SLinus Torvalds skb_reserve(skb, hh_len+sizeof(struct frag_hdr)); 12711da177e4SLinus Torvalds 12721da177e4SLinus Torvalds /* 12731da177e4SLinus Torvalds * Find where to start putting bytes 12741da177e4SLinus Torvalds */ 12751da177e4SLinus Torvalds data = skb_put(skb, fraglen); 1276c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 12771da177e4SLinus Torvalds data += fragheaderlen; 1278b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1279b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 12801da177e4SLinus Torvalds if (fraggap) { 12811da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 12821da177e4SLinus Torvalds skb_prev, maxfraglen, 12831da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 12841da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 12851da177e4SLinus Torvalds skb->csum); 12861da177e4SLinus Torvalds data += fraggap; 1287e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 12881da177e4SLinus Torvalds } 12891da177e4SLinus Torvalds copy = datalen - transhdrlen - fraggap; 12901da177e4SLinus Torvalds if (copy < 0) { 12911da177e4SLinus Torvalds err = -EINVAL; 12921da177e4SLinus Torvalds kfree_skb(skb); 12931da177e4SLinus Torvalds goto error; 12941da177e4SLinus Torvalds } else if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 12951da177e4SLinus Torvalds err = -EFAULT; 12961da177e4SLinus Torvalds kfree_skb(skb); 12971da177e4SLinus Torvalds goto error; 12981da177e4SLinus Torvalds } 12991da177e4SLinus Torvalds 13001da177e4SLinus Torvalds offset += copy; 13011da177e4SLinus Torvalds length -= datalen - fraggap; 13021da177e4SLinus Torvalds transhdrlen = 0; 13031da177e4SLinus Torvalds exthdrlen = 0; 13041da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 13051da177e4SLinus Torvalds 13061da177e4SLinus Torvalds /* 13071da177e4SLinus Torvalds * Put the packet on the pending queue 13081da177e4SLinus Torvalds */ 13091da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 13101da177e4SLinus Torvalds continue; 13111da177e4SLinus Torvalds } 13121da177e4SLinus Torvalds 13131da177e4SLinus Torvalds if (copy > length) 13141da177e4SLinus Torvalds copy = length; 13151da177e4SLinus Torvalds 13161da177e4SLinus Torvalds if (!(rt->u.dst.dev->features&NETIF_F_SG)) { 13171da177e4SLinus Torvalds unsigned int off; 13181da177e4SLinus Torvalds 13191da177e4SLinus Torvalds off = skb->len; 13201da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 13211da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 13221da177e4SLinus Torvalds __skb_trim(skb, off); 13231da177e4SLinus Torvalds err = -EFAULT; 13241da177e4SLinus Torvalds goto error; 13251da177e4SLinus Torvalds } 13261da177e4SLinus Torvalds } else { 13271da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 13281da177e4SLinus Torvalds skb_frag_t *frag = &skb_shinfo(skb)->frags[i-1]; 13291da177e4SLinus Torvalds struct page *page = sk->sk_sndmsg_page; 13301da177e4SLinus Torvalds int off = sk->sk_sndmsg_off; 13311da177e4SLinus Torvalds unsigned int left; 13321da177e4SLinus Torvalds 13331da177e4SLinus Torvalds if (page && (left = PAGE_SIZE - off) > 0) { 13341da177e4SLinus Torvalds if (copy >= left) 13351da177e4SLinus Torvalds copy = left; 13361da177e4SLinus Torvalds if (page != frag->page) { 13371da177e4SLinus Torvalds if (i == MAX_SKB_FRAGS) { 13381da177e4SLinus Torvalds err = -EMSGSIZE; 13391da177e4SLinus Torvalds goto error; 13401da177e4SLinus Torvalds } 13411da177e4SLinus Torvalds get_page(page); 13421da177e4SLinus Torvalds skb_fill_page_desc(skb, i, page, sk->sk_sndmsg_off, 0); 13431da177e4SLinus Torvalds frag = &skb_shinfo(skb)->frags[i]; 13441da177e4SLinus Torvalds } 13451da177e4SLinus Torvalds } else if(i < MAX_SKB_FRAGS) { 13461da177e4SLinus Torvalds if (copy > PAGE_SIZE) 13471da177e4SLinus Torvalds copy = PAGE_SIZE; 13481da177e4SLinus Torvalds page = alloc_pages(sk->sk_allocation, 0); 13491da177e4SLinus Torvalds if (page == NULL) { 13501da177e4SLinus Torvalds err = -ENOMEM; 13511da177e4SLinus Torvalds goto error; 13521da177e4SLinus Torvalds } 13531da177e4SLinus Torvalds sk->sk_sndmsg_page = page; 13541da177e4SLinus Torvalds sk->sk_sndmsg_off = 0; 13551da177e4SLinus Torvalds 13561da177e4SLinus Torvalds skb_fill_page_desc(skb, i, page, 0, 0); 13571da177e4SLinus Torvalds frag = &skb_shinfo(skb)->frags[i]; 13581da177e4SLinus Torvalds } else { 13591da177e4SLinus Torvalds err = -EMSGSIZE; 13601da177e4SLinus Torvalds goto error; 13611da177e4SLinus Torvalds } 13621da177e4SLinus Torvalds if (getfrag(from, page_address(frag->page)+frag->page_offset+frag->size, offset, copy, skb->len, skb) < 0) { 13631da177e4SLinus Torvalds err = -EFAULT; 13641da177e4SLinus Torvalds goto error; 13651da177e4SLinus Torvalds } 13661da177e4SLinus Torvalds sk->sk_sndmsg_off += copy; 13671da177e4SLinus Torvalds frag->size += copy; 13681da177e4SLinus Torvalds skb->len += copy; 13691da177e4SLinus Torvalds skb->data_len += copy; 1370f945fa7aSHerbert Xu skb->truesize += copy; 1371f945fa7aSHerbert Xu atomic_add(copy, &sk->sk_wmem_alloc); 13721da177e4SLinus Torvalds } 13731da177e4SLinus Torvalds offset += copy; 13741da177e4SLinus Torvalds length -= copy; 13751da177e4SLinus Torvalds } 13761da177e4SLinus Torvalds return 0; 13771da177e4SLinus Torvalds error: 13781da177e4SLinus Torvalds inet->cork.length -= length; 1379a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(rt->rt6i_idev, IPSTATS_MIB_OUTDISCARDS); 13801da177e4SLinus Torvalds return err; 13811da177e4SLinus Torvalds } 13821da177e4SLinus Torvalds 1383bf138862SPavel Emelyanov static void ip6_cork_release(struct inet_sock *inet, struct ipv6_pinfo *np) 1384bf138862SPavel Emelyanov { 1385bf138862SPavel Emelyanov inet->cork.flags &= ~IPCORK_OPT; 1386bf138862SPavel Emelyanov kfree(np->cork.opt); 1387bf138862SPavel Emelyanov np->cork.opt = NULL; 1388c8cdaf99SYOSHIFUJI Hideaki if (inet->cork.dst) { 1389c8cdaf99SYOSHIFUJI Hideaki dst_release(inet->cork.dst); 1390c8cdaf99SYOSHIFUJI Hideaki inet->cork.dst = NULL; 1391bf138862SPavel Emelyanov inet->cork.flags &= ~IPCORK_ALLFRAG; 1392bf138862SPavel Emelyanov } 1393bf138862SPavel Emelyanov memset(&inet->cork.fl, 0, sizeof(inet->cork.fl)); 1394bf138862SPavel Emelyanov } 1395bf138862SPavel Emelyanov 13961da177e4SLinus Torvalds int ip6_push_pending_frames(struct sock *sk) 13971da177e4SLinus Torvalds { 13981da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 13991da177e4SLinus Torvalds struct sk_buff **tail_skb; 14001da177e4SLinus Torvalds struct in6_addr final_dst_buf, *final_dst = &final_dst_buf; 14011da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 14021da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 14031da177e4SLinus Torvalds struct ipv6hdr *hdr; 14041da177e4SLinus Torvalds struct ipv6_txoptions *opt = np->cork.opt; 1405c8cdaf99SYOSHIFUJI Hideaki struct rt6_info *rt = (struct rt6_info *)inet->cork.dst; 14061da177e4SLinus Torvalds struct flowi *fl = &inet->cork.fl; 14071da177e4SLinus Torvalds unsigned char proto = fl->proto; 14081da177e4SLinus Torvalds int err = 0; 14091da177e4SLinus Torvalds 14101da177e4SLinus Torvalds if ((skb = __skb_dequeue(&sk->sk_write_queue)) == NULL) 14111da177e4SLinus Torvalds goto out; 14121da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 14131da177e4SLinus Torvalds 14141da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1415d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1416bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 14171da177e4SLinus Torvalds while ((tmp_skb = __skb_dequeue(&sk->sk_write_queue)) != NULL) { 1418cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 14191da177e4SLinus Torvalds *tail_skb = tmp_skb; 14201da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 14211da177e4SLinus Torvalds skb->len += tmp_skb->len; 14221da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 14231da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 14241da177e4SLinus Torvalds __sock_put(tmp_skb->sk); 14251da177e4SLinus Torvalds tmp_skb->destructor = NULL; 14261da177e4SLinus Torvalds tmp_skb->sk = NULL; 14271da177e4SLinus Torvalds } 14281da177e4SLinus Torvalds 142928a89453SHerbert Xu /* Allow local fragmentation. */ 1430b5c15fc0SHerbert Xu if (np->pmtudisc < IPV6_PMTUDISC_DO) 143128a89453SHerbert Xu skb->local_df = 1; 143228a89453SHerbert Xu 14331da177e4SLinus Torvalds ipv6_addr_copy(final_dst, &fl->fl6_dst); 1434cfe1fc77SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_header_len(skb)); 14351da177e4SLinus Torvalds if (opt && opt->opt_flen) 14361da177e4SLinus Torvalds ipv6_push_frag_opts(skb, opt, &proto); 14371da177e4SLinus Torvalds if (opt && opt->opt_nflen) 14381da177e4SLinus Torvalds ipv6_push_nfrag_opts(skb, opt, &proto, &final_dst); 14391da177e4SLinus Torvalds 1440e2d1bca7SArnaldo Carvalho de Melo skb_push(skb, sizeof(struct ipv6hdr)); 1441e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(skb); 14420660e03fSArnaldo Carvalho de Melo hdr = ipv6_hdr(skb); 14431da177e4SLinus Torvalds 144490bcaf7bSAl Viro *(__be32*)hdr = fl->fl6_flowlabel | 144541a1f8eaSYOSHIFUJI Hideaki htonl(0x60000000 | ((int)np->cork.tclass << 20)); 14461da177e4SLinus Torvalds 14471da177e4SLinus Torvalds hdr->hop_limit = np->cork.hop_limit; 14481da177e4SLinus Torvalds hdr->nexthdr = proto; 14491da177e4SLinus Torvalds ipv6_addr_copy(&hdr->saddr, &fl->fl6_src); 14501da177e4SLinus Torvalds ipv6_addr_copy(&hdr->daddr, final_dst); 14511da177e4SLinus Torvalds 1452a2c2064fSPatrick McHardy skb->priority = sk->sk_priority; 14534a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1454a2c2064fSPatrick McHardy 14551da177e4SLinus Torvalds skb->dst = dst_clone(&rt->u.dst); 1456a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(rt->rt6i_idev, IPSTATS_MIB_OUTREQUESTS); 145714878f75SDavid L Stevens if (proto == IPPROTO_ICMPV6) { 145814878f75SDavid L Stevens struct inet6_dev *idev = ip6_dst_idev(skb->dst); 145914878f75SDavid L Stevens 146014878f75SDavid L Stevens ICMP6MSGOUT_INC_STATS_BH(idev, icmp6_hdr(skb)->icmp6_type); 146114878f75SDavid L Stevens ICMP6_INC_STATS_BH(idev, ICMP6_MIB_OUTMSGS); 146214878f75SDavid L Stevens } 146314878f75SDavid L Stevens 1464ef76bc23SHerbert Xu err = ip6_local_out(skb); 14651da177e4SLinus Torvalds if (err) { 14661da177e4SLinus Torvalds if (err > 0) 14673320da89SHerbert Xu err = np->recverr ? net_xmit_errno(err) : 0; 14681da177e4SLinus Torvalds if (err) 14691da177e4SLinus Torvalds goto error; 14701da177e4SLinus Torvalds } 14711da177e4SLinus Torvalds 14721da177e4SLinus Torvalds out: 1473bf138862SPavel Emelyanov ip6_cork_release(inet, np); 14741da177e4SLinus Torvalds return err; 14751da177e4SLinus Torvalds error: 14761da177e4SLinus Torvalds goto out; 14771da177e4SLinus Torvalds } 14781da177e4SLinus Torvalds 14791da177e4SLinus Torvalds void ip6_flush_pending_frames(struct sock *sk) 14801da177e4SLinus Torvalds { 14811da177e4SLinus Torvalds struct sk_buff *skb; 14821da177e4SLinus Torvalds 14831da177e4SLinus Torvalds while ((skb = __skb_dequeue_tail(&sk->sk_write_queue)) != NULL) { 1484e1f52208SYOSHIFUJI Hideaki if (skb->dst) 1485a11d206dSYOSHIFUJI Hideaki IP6_INC_STATS(ip6_dst_idev(skb->dst), 1486a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_OUTDISCARDS); 14871da177e4SLinus Torvalds kfree_skb(skb); 14881da177e4SLinus Torvalds } 14891da177e4SLinus Torvalds 1490bf138862SPavel Emelyanov ip6_cork_release(inet_sk(sk), inet6_sk(sk)); 14911da177e4SLinus Torvalds } 1492