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> 405a0e3ad6STejun Heo #include <linux/slab.h> 411da177e4SLinus Torvalds 421da177e4SLinus Torvalds #include <linux/netfilter.h> 431da177e4SLinus Torvalds #include <linux/netfilter_ipv6.h> 441da177e4SLinus Torvalds 451da177e4SLinus Torvalds #include <net/sock.h> 461da177e4SLinus Torvalds #include <net/snmp.h> 471da177e4SLinus Torvalds 481da177e4SLinus Torvalds #include <net/ipv6.h> 491da177e4SLinus Torvalds #include <net/ndisc.h> 501da177e4SLinus Torvalds #include <net/protocol.h> 511da177e4SLinus Torvalds #include <net/ip6_route.h> 521da177e4SLinus Torvalds #include <net/addrconf.h> 531da177e4SLinus Torvalds #include <net/rawv6.h> 541da177e4SLinus Torvalds #include <net/icmp.h> 551da177e4SLinus Torvalds #include <net/xfrm.h> 561da177e4SLinus Torvalds #include <net/checksum.h> 577bc570c8SYOSHIFUJI Hideaki #include <linux/mroute6.h> 581da177e4SLinus Torvalds 599e508490SJan Engelhardt static int ip6_finish_output2(struct sk_buff *skb) 601da177e4SLinus Torvalds { 61adf30907SEric Dumazet struct dst_entry *dst = skb_dst(skb); 621da177e4SLinus Torvalds struct net_device *dev = dst->dev; 63f6b72b62SDavid S. Miller struct neighbour *neigh; 646fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 struct in6_addr *nexthop; 656fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 int ret; 661da177e4SLinus Torvalds 671da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IPV6); 681da177e4SLinus Torvalds skb->dev = dev; 691da177e4SLinus Torvalds 700660e03fSArnaldo Carvalho de Melo if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr)) { 71adf30907SEric Dumazet struct inet6_dev *idev = ip6_dst_idev(skb_dst(skb)); 721da177e4SLinus Torvalds 737ad6848cSOctavian Purdila if (!(dev->flags & IFF_LOOPBACK) && sk_mc_loop(skb->sk) && 74d1db275dSPatrick McHardy ((mroute6_socket(dev_net(dev), skb) && 75bd91b8bfSBenjamin Thery !(IP6CB(skb)->flags & IP6SKB_FORWARDED)) || 760660e03fSArnaldo Carvalho de Melo ipv6_chk_mcast_addr(dev, &ipv6_hdr(skb)->daddr, 777bc570c8SYOSHIFUJI Hideaki &ipv6_hdr(skb)->saddr))) { 781da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 791da177e4SLinus Torvalds 801da177e4SLinus Torvalds /* Do not check for IFF_ALLMULTI; multicast routing 811da177e4SLinus Torvalds is not supported in any case. 821da177e4SLinus Torvalds */ 831da177e4SLinus Torvalds if (newskb) 84b2e0b385SJan Engelhardt NF_HOOK(NFPROTO_IPV6, NF_INET_POST_ROUTING, 85b2e0b385SJan Engelhardt newskb, NULL, newskb->dev, 8695603e22SMichel Machado dev_loopback_xmit); 871da177e4SLinus Torvalds 880660e03fSArnaldo Carvalho de Melo if (ipv6_hdr(skb)->hop_limit == 0) { 893bd653c8SDenis V. Lunev IP6_INC_STATS(dev_net(dev), idev, 903bd653c8SDenis V. Lunev IPSTATS_MIB_OUTDISCARDS); 911da177e4SLinus Torvalds kfree_skb(skb); 921da177e4SLinus Torvalds return 0; 931da177e4SLinus Torvalds } 941da177e4SLinus Torvalds } 951da177e4SLinus Torvalds 96edf391ffSNeil Horman IP6_UPD_PO_STATS(dev_net(dev), idev, IPSTATS_MIB_OUTMCAST, 97edf391ffSNeil Horman skb->len); 98dd408515SHannes Frederic Sowa 99dd408515SHannes Frederic Sowa if (IPV6_ADDR_MC_SCOPE(&ipv6_hdr(skb)->daddr) <= 100dd408515SHannes Frederic Sowa IPV6_ADDR_SCOPE_NODELOCAL && 101dd408515SHannes Frederic Sowa !(dev->flags & IFF_LOOPBACK)) { 102dd408515SHannes Frederic Sowa kfree_skb(skb); 103dd408515SHannes Frederic Sowa return 0; 104dd408515SHannes Frederic Sowa } 1051da177e4SLinus Torvalds } 1061da177e4SLinus Torvalds 1076fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 rcu_read_lock_bh(); 108550bab42SJulian Anastasov nexthop = rt6_nexthop((struct rt6_info *)dst); 1096fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 neigh = __ipv6_neigh_lookup_noref(dst->dev, nexthop); 1106fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 if (unlikely(!neigh)) 1116fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 neigh = __neigh_create(&nd_tbl, nexthop, dst->dev, false); 1126fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 if (!IS_ERR(neigh)) { 1136fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 ret = dst_neigh_output(dst, neigh, skb); 1146fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 rcu_read_unlock_bh(); 1156fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 return ret; 1166fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 } 1176fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 rcu_read_unlock_bh(); 11805e3aa09SDavid S. Miller 1197f88c6b2SHannes Frederic Sowa IP6_INC_STATS(dev_net(dst->dev), 1209e508490SJan Engelhardt ip6_dst_idev(dst), IPSTATS_MIB_OUTNOROUTES); 1219e508490SJan Engelhardt kfree_skb(skb); 1229e508490SJan Engelhardt return -EINVAL; 1231da177e4SLinus Torvalds } 1241da177e4SLinus Torvalds 1259e508490SJan Engelhardt static int ip6_finish_output(struct sk_buff *skb) 1269e508490SJan Engelhardt { 1279e508490SJan Engelhardt if ((skb->len > ip6_skb_dst_mtu(skb) && !skb_is_gso(skb)) || 1289037c357SJiri Pirko dst_allfrag(skb_dst(skb)) || 1299037c357SJiri Pirko (IP6CB(skb)->frag_max_size && skb->len > IP6CB(skb)->frag_max_size)) 1309e508490SJan Engelhardt return ip6_fragment(skb, ip6_finish_output2); 1319e508490SJan Engelhardt else 1329e508490SJan Engelhardt return ip6_finish_output2(skb); 1339e508490SJan Engelhardt } 1349e508490SJan Engelhardt 135aad88724SEric Dumazet int ip6_output(struct sock *sk, struct sk_buff *skb) 1361da177e4SLinus Torvalds { 1379e508490SJan Engelhardt struct net_device *dev = skb_dst(skb)->dev; 138adf30907SEric Dumazet struct inet6_dev *idev = ip6_dst_idev(skb_dst(skb)); 139778d80beSYOSHIFUJI Hideaki if (unlikely(idev->cnf.disable_ipv6)) { 1409e508490SJan Engelhardt IP6_INC_STATS(dev_net(dev), idev, 1413bd653c8SDenis V. Lunev IPSTATS_MIB_OUTDISCARDS); 142778d80beSYOSHIFUJI Hideaki kfree_skb(skb); 143778d80beSYOSHIFUJI Hideaki return 0; 144778d80beSYOSHIFUJI Hideaki } 145778d80beSYOSHIFUJI Hideaki 1469c6eb28aSJan Engelhardt return NF_HOOK_COND(NFPROTO_IPV6, NF_INET_POST_ROUTING, skb, NULL, dev, 1479c6eb28aSJan Engelhardt ip6_finish_output, 1489c6eb28aSJan Engelhardt !(IP6CB(skb)->flags & IP6SKB_REROUTED)); 1491da177e4SLinus Torvalds } 1501da177e4SLinus Torvalds 1511da177e4SLinus Torvalds /* 152b5d43998SShan Wei * xmit an sk_buff (used by TCP, SCTP and DCCP) 1531da177e4SLinus Torvalds */ 1541da177e4SLinus Torvalds 1554c9483b2SDavid S. Miller int ip6_xmit(struct sock *sk, struct sk_buff *skb, struct flowi6 *fl6, 156b903d324SEric Dumazet struct ipv6_txoptions *opt, int tclass) 1571da177e4SLinus Torvalds { 1583bd653c8SDenis V. Lunev struct net *net = sock_net(sk); 159b30bd282SPatrick McHardy struct ipv6_pinfo *np = inet6_sk(sk); 1604c9483b2SDavid S. Miller struct in6_addr *first_hop = &fl6->daddr; 161adf30907SEric Dumazet struct dst_entry *dst = skb_dst(skb); 1621da177e4SLinus Torvalds struct ipv6hdr *hdr; 1634c9483b2SDavid S. Miller u8 proto = fl6->flowi6_proto; 1641da177e4SLinus Torvalds int seg_len = skb->len; 165e651f03aSGerrit Renker int hlimit = -1; 1661da177e4SLinus Torvalds u32 mtu; 1671da177e4SLinus Torvalds 1681da177e4SLinus Torvalds if (opt) { 169c2636b4dSChuck Lever unsigned int head_room; 1701da177e4SLinus Torvalds 1711da177e4SLinus Torvalds /* First: exthdrs may take lots of space (~8K for now) 1721da177e4SLinus Torvalds MAX_HEADER is not enough. 1731da177e4SLinus Torvalds */ 1741da177e4SLinus Torvalds head_room = opt->opt_nflen + opt->opt_flen; 1751da177e4SLinus Torvalds seg_len += head_room; 1761da177e4SLinus Torvalds head_room += sizeof(struct ipv6hdr) + LL_RESERVED_SPACE(dst->dev); 1771da177e4SLinus Torvalds 1781da177e4SLinus Torvalds if (skb_headroom(skb) < head_room) { 1791da177e4SLinus Torvalds struct sk_buff *skb2 = skb_realloc_headroom(skb, head_room); 180a11d206dSYOSHIFUJI Hideaki if (skb2 == NULL) { 181adf30907SEric Dumazet IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), 182a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_OUTDISCARDS); 1831da177e4SLinus Torvalds kfree_skb(skb); 1841da177e4SLinus Torvalds return -ENOBUFS; 1851da177e4SLinus Torvalds } 186808db80aSEric Dumazet consume_skb(skb); 187a11d206dSYOSHIFUJI Hideaki skb = skb2; 1881da177e4SLinus Torvalds skb_set_owner_w(skb, sk); 1891da177e4SLinus Torvalds } 1901da177e4SLinus Torvalds if (opt->opt_flen) 1911da177e4SLinus Torvalds ipv6_push_frag_opts(skb, opt, &proto); 1921da177e4SLinus Torvalds if (opt->opt_nflen) 1931da177e4SLinus Torvalds ipv6_push_nfrag_opts(skb, opt, &proto, &first_hop); 1941da177e4SLinus Torvalds } 1951da177e4SLinus Torvalds 196e2d1bca7SArnaldo Carvalho de Melo skb_push(skb, sizeof(struct ipv6hdr)); 197e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1980660e03fSArnaldo Carvalho de Melo hdr = ipv6_hdr(skb); 1991da177e4SLinus Torvalds 2001da177e4SLinus Torvalds /* 2011da177e4SLinus Torvalds * Fill in the IPv6 header 2021da177e4SLinus Torvalds */ 203b903d324SEric Dumazet if (np) 2041da177e4SLinus Torvalds hlimit = np->hop_limit; 2051da177e4SLinus Torvalds if (hlimit < 0) 2066b75d090SYOSHIFUJI Hideaki hlimit = ip6_dst_hoplimit(dst); 2071da177e4SLinus Torvalds 208cb1ce2efSTom Herbert ip6_flow_hdr(hdr, tclass, ip6_make_flowlabel(net, skb, fl6->flowlabel, 209cb1ce2efSTom Herbert np->autoflowlabel)); 21041a1f8eaSYOSHIFUJI Hideaki 2111da177e4SLinus Torvalds hdr->payload_len = htons(seg_len); 2121da177e4SLinus Torvalds hdr->nexthdr = proto; 2131da177e4SLinus Torvalds hdr->hop_limit = hlimit; 2141da177e4SLinus Torvalds 2154e3fd7a0SAlexey Dobriyan hdr->saddr = fl6->saddr; 2164e3fd7a0SAlexey Dobriyan hdr->daddr = *first_hop; 2171da177e4SLinus Torvalds 2189c9c9ad5SHannes Frederic Sowa skb->protocol = htons(ETH_P_IPV6); 219a2c2064fSPatrick McHardy skb->priority = sk->sk_priority; 2204a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 221a2c2064fSPatrick McHardy 2221da177e4SLinus Torvalds mtu = dst_mtu(dst); 22360ff7467SWANG Cong if ((skb->len <= mtu) || skb->ignore_df || skb_is_gso(skb)) { 224adf30907SEric Dumazet IP6_UPD_PO_STATS(net, ip6_dst_idev(skb_dst(skb)), 225edf391ffSNeil Horman IPSTATS_MIB_OUT, skb->len); 226b2e0b385SJan Engelhardt return NF_HOOK(NFPROTO_IPV6, NF_INET_LOCAL_OUT, skb, NULL, 227b2e0b385SJan Engelhardt dst->dev, dst_output); 2281da177e4SLinus Torvalds } 2291da177e4SLinus Torvalds 2301da177e4SLinus Torvalds skb->dev = dst->dev; 231f4e53e29SSteffen Klassert ipv6_local_error(sk, EMSGSIZE, fl6, mtu); 232adf30907SEric Dumazet IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_FRAGFAILS); 2331da177e4SLinus Torvalds kfree_skb(skb); 2341da177e4SLinus Torvalds return -EMSGSIZE; 2351da177e4SLinus Torvalds } 2367159039aSYOSHIFUJI Hideaki EXPORT_SYMBOL(ip6_xmit); 2377159039aSYOSHIFUJI Hideaki 2381da177e4SLinus Torvalds static int ip6_call_ra_chain(struct sk_buff *skb, int sel) 2391da177e4SLinus Torvalds { 2401da177e4SLinus Torvalds struct ip6_ra_chain *ra; 2411da177e4SLinus Torvalds struct sock *last = NULL; 2421da177e4SLinus Torvalds 2431da177e4SLinus Torvalds read_lock(&ip6_ra_lock); 2441da177e4SLinus Torvalds for (ra = ip6_ra_chain; ra; ra = ra->next) { 2451da177e4SLinus Torvalds struct sock *sk = ra->sk; 2460bd1b59bSAndrew McDonald if (sk && ra->sel == sel && 2470bd1b59bSAndrew McDonald (!sk->sk_bound_dev_if || 2480bd1b59bSAndrew McDonald sk->sk_bound_dev_if == skb->dev->ifindex)) { 2491da177e4SLinus Torvalds if (last) { 2501da177e4SLinus Torvalds struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC); 2511da177e4SLinus Torvalds if (skb2) 2521da177e4SLinus Torvalds rawv6_rcv(last, skb2); 2531da177e4SLinus Torvalds } 2541da177e4SLinus Torvalds last = sk; 2551da177e4SLinus Torvalds } 2561da177e4SLinus Torvalds } 2571da177e4SLinus Torvalds 2581da177e4SLinus Torvalds if (last) { 2591da177e4SLinus Torvalds rawv6_rcv(last, skb); 2601da177e4SLinus Torvalds read_unlock(&ip6_ra_lock); 2611da177e4SLinus Torvalds return 1; 2621da177e4SLinus Torvalds } 2631da177e4SLinus Torvalds read_unlock(&ip6_ra_lock); 2641da177e4SLinus Torvalds return 0; 2651da177e4SLinus Torvalds } 2661da177e4SLinus Torvalds 267e21e0b5fSVille Nuorvala static int ip6_forward_proxy_check(struct sk_buff *skb) 268e21e0b5fSVille Nuorvala { 2690660e03fSArnaldo Carvalho de Melo struct ipv6hdr *hdr = ipv6_hdr(skb); 270e21e0b5fSVille Nuorvala u8 nexthdr = hdr->nexthdr; 27175f2811cSJesse Gross __be16 frag_off; 272e21e0b5fSVille Nuorvala int offset; 273e21e0b5fSVille Nuorvala 274e21e0b5fSVille Nuorvala if (ipv6_ext_hdr(nexthdr)) { 27575f2811cSJesse Gross offset = ipv6_skip_exthdr(skb, sizeof(*hdr), &nexthdr, &frag_off); 276e21e0b5fSVille Nuorvala if (offset < 0) 277e21e0b5fSVille Nuorvala return 0; 278e21e0b5fSVille Nuorvala } else 279e21e0b5fSVille Nuorvala offset = sizeof(struct ipv6hdr); 280e21e0b5fSVille Nuorvala 281e21e0b5fSVille Nuorvala if (nexthdr == IPPROTO_ICMPV6) { 282e21e0b5fSVille Nuorvala struct icmp6hdr *icmp6; 283e21e0b5fSVille Nuorvala 284d56f90a7SArnaldo Carvalho de Melo if (!pskb_may_pull(skb, (skb_network_header(skb) + 285d56f90a7SArnaldo Carvalho de Melo offset + 1 - skb->data))) 286e21e0b5fSVille Nuorvala return 0; 287e21e0b5fSVille Nuorvala 288d56f90a7SArnaldo Carvalho de Melo icmp6 = (struct icmp6hdr *)(skb_network_header(skb) + offset); 289e21e0b5fSVille Nuorvala 290e21e0b5fSVille Nuorvala switch (icmp6->icmp6_type) { 291e21e0b5fSVille Nuorvala case NDISC_ROUTER_SOLICITATION: 292e21e0b5fSVille Nuorvala case NDISC_ROUTER_ADVERTISEMENT: 293e21e0b5fSVille Nuorvala case NDISC_NEIGHBOUR_SOLICITATION: 294e21e0b5fSVille Nuorvala case NDISC_NEIGHBOUR_ADVERTISEMENT: 295e21e0b5fSVille Nuorvala case NDISC_REDIRECT: 296e21e0b5fSVille Nuorvala /* For reaction involving unicast neighbor discovery 297e21e0b5fSVille Nuorvala * message destined to the proxied address, pass it to 298e21e0b5fSVille Nuorvala * input function. 299e21e0b5fSVille Nuorvala */ 300e21e0b5fSVille Nuorvala return 1; 301e21e0b5fSVille Nuorvala default: 302e21e0b5fSVille Nuorvala break; 303e21e0b5fSVille Nuorvala } 304e21e0b5fSVille Nuorvala } 305e21e0b5fSVille Nuorvala 30674553b09SVille Nuorvala /* 30774553b09SVille Nuorvala * The proxying router can't forward traffic sent to a link-local 30874553b09SVille Nuorvala * address, so signal the sender and discard the packet. This 30974553b09SVille Nuorvala * behavior is clarified by the MIPv6 specification. 31074553b09SVille Nuorvala */ 31174553b09SVille Nuorvala if (ipv6_addr_type(&hdr->daddr) & IPV6_ADDR_LINKLOCAL) { 31274553b09SVille Nuorvala dst_link_failure(skb); 31374553b09SVille Nuorvala return -1; 31474553b09SVille Nuorvala } 31574553b09SVille Nuorvala 316e21e0b5fSVille Nuorvala return 0; 317e21e0b5fSVille Nuorvala } 318e21e0b5fSVille Nuorvala 3191da177e4SLinus Torvalds static inline int ip6_forward_finish(struct sk_buff *skb) 3201da177e4SLinus Torvalds { 3211da177e4SLinus Torvalds return dst_output(skb); 3221da177e4SLinus Torvalds } 3231da177e4SLinus Torvalds 3240954cf9cSHannes Frederic Sowa static unsigned int ip6_dst_mtu_forward(const struct dst_entry *dst) 3250954cf9cSHannes Frederic Sowa { 3260954cf9cSHannes Frederic Sowa unsigned int mtu; 3270954cf9cSHannes Frederic Sowa struct inet6_dev *idev; 3280954cf9cSHannes Frederic Sowa 3290954cf9cSHannes Frederic Sowa if (dst_metric_locked(dst, RTAX_MTU)) { 3300954cf9cSHannes Frederic Sowa mtu = dst_metric_raw(dst, RTAX_MTU); 3310954cf9cSHannes Frederic Sowa if (mtu) 3320954cf9cSHannes Frederic Sowa return mtu; 3330954cf9cSHannes Frederic Sowa } 3340954cf9cSHannes Frederic Sowa 3350954cf9cSHannes Frederic Sowa mtu = IPV6_MIN_MTU; 3360954cf9cSHannes Frederic Sowa rcu_read_lock(); 3370954cf9cSHannes Frederic Sowa idev = __in6_dev_get(dst->dev); 3380954cf9cSHannes Frederic Sowa if (idev) 3390954cf9cSHannes Frederic Sowa mtu = idev->cnf.mtu6; 3400954cf9cSHannes Frederic Sowa rcu_read_unlock(); 3410954cf9cSHannes Frederic Sowa 3420954cf9cSHannes Frederic Sowa return mtu; 3430954cf9cSHannes Frederic Sowa } 3440954cf9cSHannes Frederic Sowa 345fe6cc55fSFlorian Westphal static bool ip6_pkt_too_big(const struct sk_buff *skb, unsigned int mtu) 346fe6cc55fSFlorian Westphal { 347418a3156SFlorian Westphal if (skb->len <= mtu) 348fe6cc55fSFlorian Westphal return false; 349fe6cc55fSFlorian Westphal 35060ff7467SWANG Cong /* ipv6 conntrack defrag sets max_frag_size + ignore_df */ 351fe6cc55fSFlorian Westphal if (IP6CB(skb)->frag_max_size && IP6CB(skb)->frag_max_size > mtu) 352fe6cc55fSFlorian Westphal return true; 353fe6cc55fSFlorian Westphal 35460ff7467SWANG Cong if (skb->ignore_df) 355418a3156SFlorian Westphal return false; 356418a3156SFlorian Westphal 357fe6cc55fSFlorian Westphal if (skb_is_gso(skb) && skb_gso_network_seglen(skb) <= mtu) 358fe6cc55fSFlorian Westphal return false; 359fe6cc55fSFlorian Westphal 360fe6cc55fSFlorian Westphal return true; 361fe6cc55fSFlorian Westphal } 362fe6cc55fSFlorian Westphal 3631da177e4SLinus Torvalds int ip6_forward(struct sk_buff *skb) 3641da177e4SLinus Torvalds { 365adf30907SEric Dumazet struct dst_entry *dst = skb_dst(skb); 3660660e03fSArnaldo Carvalho de Melo struct ipv6hdr *hdr = ipv6_hdr(skb); 3671da177e4SLinus Torvalds struct inet6_skb_parm *opt = IP6CB(skb); 368c346dca1SYOSHIFUJI Hideaki struct net *net = dev_net(dst->dev); 36914f3ad6fSUlrich Weber u32 mtu; 3701da177e4SLinus Torvalds 37153b7997fSYOSHIFUJI Hideaki if (net->ipv6.devconf_all->forwarding == 0) 3721da177e4SLinus Torvalds goto error; 3731da177e4SLinus Torvalds 374090f1166SLi RongQing if (skb->pkt_type != PACKET_HOST) 375090f1166SLi RongQing goto drop; 376090f1166SLi RongQing 3774497b076SBen Hutchings if (skb_warn_if_lro(skb)) 3784497b076SBen Hutchings goto drop; 3794497b076SBen Hutchings 3801da177e4SLinus Torvalds if (!xfrm6_policy_check(NULL, XFRM_POLICY_FWD, skb)) { 38115c77d8bSEric Dumazet IP6_INC_STATS_BH(net, ip6_dst_idev(dst), 38215c77d8bSEric Dumazet IPSTATS_MIB_INDISCARDS); 3831da177e4SLinus Torvalds goto drop; 3841da177e4SLinus Torvalds } 3851da177e4SLinus Torvalds 38635fc92a9SHerbert Xu skb_forward_csum(skb); 3871da177e4SLinus Torvalds 3881da177e4SLinus Torvalds /* 3891da177e4SLinus Torvalds * We DO NOT make any processing on 3901da177e4SLinus Torvalds * RA packets, pushing them to user level AS IS 3911da177e4SLinus Torvalds * without ane WARRANTY that application will be able 3921da177e4SLinus Torvalds * to interpret them. The reason is that we 3931da177e4SLinus Torvalds * cannot make anything clever here. 3941da177e4SLinus Torvalds * 3951da177e4SLinus Torvalds * We are not end-node, so that if packet contains 3961da177e4SLinus Torvalds * AH/ESP, we cannot make anything. 3971da177e4SLinus Torvalds * Defragmentation also would be mistake, RA packets 3981da177e4SLinus Torvalds * cannot be fragmented, because there is no warranty 3991da177e4SLinus Torvalds * that different fragments will go along one path. --ANK 4001da177e4SLinus Torvalds */ 401ab4eb353SYOSHIFUJI Hideaki / 吉藤英明 if (unlikely(opt->flags & IP6SKB_ROUTERALERT)) { 402ab4eb353SYOSHIFUJI Hideaki / 吉藤英明 if (ip6_call_ra_chain(skb, ntohs(opt->ra))) 4031da177e4SLinus Torvalds return 0; 4041da177e4SLinus Torvalds } 4051da177e4SLinus Torvalds 4061da177e4SLinus Torvalds /* 4071da177e4SLinus Torvalds * check and decrement ttl 4081da177e4SLinus Torvalds */ 4091da177e4SLinus Torvalds if (hdr->hop_limit <= 1) { 4101da177e4SLinus Torvalds /* Force OUTPUT device used as source address */ 4111da177e4SLinus Torvalds skb->dev = dst->dev; 4123ffe533cSAlexey Dobriyan icmpv6_send(skb, ICMPV6_TIME_EXCEED, ICMPV6_EXC_HOPLIMIT, 0); 41315c77d8bSEric Dumazet IP6_INC_STATS_BH(net, ip6_dst_idev(dst), 41415c77d8bSEric Dumazet IPSTATS_MIB_INHDRERRORS); 4151da177e4SLinus Torvalds 4161da177e4SLinus Torvalds kfree_skb(skb); 4171da177e4SLinus Torvalds return -ETIMEDOUT; 4181da177e4SLinus Torvalds } 4191da177e4SLinus Torvalds 420fbea49e1SYOSHIFUJI Hideaki /* XXX: idev->cnf.proxy_ndp? */ 42153b7997fSYOSHIFUJI Hideaki if (net->ipv6.devconf_all->proxy_ndp && 4228a3edd80SDaniel Lezcano pneigh_lookup(&nd_tbl, net, &hdr->daddr, skb->dev, 0)) { 42374553b09SVille Nuorvala int proxied = ip6_forward_proxy_check(skb); 42474553b09SVille Nuorvala if (proxied > 0) 425e21e0b5fSVille Nuorvala return ip6_input(skb); 42674553b09SVille Nuorvala else if (proxied < 0) { 42715c77d8bSEric Dumazet IP6_INC_STATS_BH(net, ip6_dst_idev(dst), 4283bd653c8SDenis V. Lunev IPSTATS_MIB_INDISCARDS); 42974553b09SVille Nuorvala goto drop; 43074553b09SVille Nuorvala } 431e21e0b5fSVille Nuorvala } 432e21e0b5fSVille Nuorvala 4331da177e4SLinus Torvalds if (!xfrm6_route_forward(skb)) { 43415c77d8bSEric Dumazet IP6_INC_STATS_BH(net, ip6_dst_idev(dst), 43515c77d8bSEric Dumazet IPSTATS_MIB_INDISCARDS); 4361da177e4SLinus Torvalds goto drop; 4371da177e4SLinus Torvalds } 438adf30907SEric Dumazet dst = skb_dst(skb); 4391da177e4SLinus Torvalds 4401da177e4SLinus Torvalds /* IPv6 specs say nothing about it, but it is clear that we cannot 4411da177e4SLinus Torvalds send redirects to source routed frames. 4421e5dc146SMasahide NAKAMURA We don't send redirects to frames decapsulated from IPsec. 4431da177e4SLinus Torvalds */ 444c45a3dfbSDavid S. Miller if (skb->dev == dst->dev && opt->srcrt == 0 && !skb_sec_path(skb)) { 4451da177e4SLinus Torvalds struct in6_addr *target = NULL; 446fbfe95a4SDavid S. Miller struct inet_peer *peer; 4471da177e4SLinus Torvalds struct rt6_info *rt; 4481da177e4SLinus Torvalds 4491da177e4SLinus Torvalds /* 4501da177e4SLinus Torvalds * incoming and outgoing devices are the same 4511da177e4SLinus Torvalds * send a redirect. 4521da177e4SLinus Torvalds */ 4531da177e4SLinus Torvalds 4541da177e4SLinus Torvalds rt = (struct rt6_info *) dst; 455c45a3dfbSDavid S. Miller if (rt->rt6i_flags & RTF_GATEWAY) 456c45a3dfbSDavid S. Miller target = &rt->rt6i_gateway; 4571da177e4SLinus Torvalds else 4581da177e4SLinus Torvalds target = &hdr->daddr; 4591da177e4SLinus Torvalds 4601d861aa4SDavid S. Miller peer = inet_getpeer_v6(net->ipv6.peers, &rt->rt6i_dst.addr, 1); 46192d86829SDavid S. Miller 4621da177e4SLinus Torvalds /* Limit redirects both by destination (here) 4631da177e4SLinus Torvalds and by source (inside ndisc_send_redirect) 4641da177e4SLinus Torvalds */ 465fbfe95a4SDavid S. Miller if (inet_peer_xrlim_allow(peer, 1*HZ)) 4664991969aSDavid S. Miller ndisc_send_redirect(skb, target); 4671d861aa4SDavid S. Miller if (peer) 4681d861aa4SDavid S. Miller inet_putpeer(peer); 4695bb1ab09SDavid L Stevens } else { 4705bb1ab09SDavid L Stevens int addrtype = ipv6_addr_type(&hdr->saddr); 4715bb1ab09SDavid L Stevens 4721da177e4SLinus Torvalds /* This check is security critical. */ 473f81b2e7dSYOSHIFUJI Hideaki if (addrtype == IPV6_ADDR_ANY || 474f81b2e7dSYOSHIFUJI Hideaki addrtype & (IPV6_ADDR_MULTICAST | IPV6_ADDR_LOOPBACK)) 4751da177e4SLinus Torvalds goto error; 4765bb1ab09SDavid L Stevens if (addrtype & IPV6_ADDR_LINKLOCAL) { 4775bb1ab09SDavid L Stevens icmpv6_send(skb, ICMPV6_DEST_UNREACH, 4783ffe533cSAlexey Dobriyan ICMPV6_NOT_NEIGHBOUR, 0); 4795bb1ab09SDavid L Stevens goto error; 4805bb1ab09SDavid L Stevens } 4811da177e4SLinus Torvalds } 4821da177e4SLinus Torvalds 4830954cf9cSHannes Frederic Sowa mtu = ip6_dst_mtu_forward(dst); 48414f3ad6fSUlrich Weber if (mtu < IPV6_MIN_MTU) 48514f3ad6fSUlrich Weber mtu = IPV6_MIN_MTU; 48614f3ad6fSUlrich Weber 487fe6cc55fSFlorian Westphal if (ip6_pkt_too_big(skb, mtu)) { 4881da177e4SLinus Torvalds /* Again, force OUTPUT device used as source address */ 4891da177e4SLinus Torvalds skb->dev = dst->dev; 49014f3ad6fSUlrich Weber icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu); 49115c77d8bSEric Dumazet IP6_INC_STATS_BH(net, ip6_dst_idev(dst), 49215c77d8bSEric Dumazet IPSTATS_MIB_INTOOBIGERRORS); 49315c77d8bSEric Dumazet IP6_INC_STATS_BH(net, ip6_dst_idev(dst), 49415c77d8bSEric Dumazet IPSTATS_MIB_FRAGFAILS); 4951da177e4SLinus Torvalds kfree_skb(skb); 4961da177e4SLinus Torvalds return -EMSGSIZE; 4971da177e4SLinus Torvalds } 4981da177e4SLinus Torvalds 4991da177e4SLinus Torvalds if (skb_cow(skb, dst->dev->hard_header_len)) { 50015c77d8bSEric Dumazet IP6_INC_STATS_BH(net, ip6_dst_idev(dst), 50115c77d8bSEric Dumazet IPSTATS_MIB_OUTDISCARDS); 5021da177e4SLinus Torvalds goto drop; 5031da177e4SLinus Torvalds } 5041da177e4SLinus Torvalds 5050660e03fSArnaldo Carvalho de Melo hdr = ipv6_hdr(skb); 5061da177e4SLinus Torvalds 5071da177e4SLinus Torvalds /* Mangling hops number delayed to point after skb COW */ 5081da177e4SLinus Torvalds 5091da177e4SLinus Torvalds hdr->hop_limit--; 5101da177e4SLinus Torvalds 511483a47d2SDenis V. Lunev IP6_INC_STATS_BH(net, ip6_dst_idev(dst), IPSTATS_MIB_OUTFORWDATAGRAMS); 5122d8dbb04SVincent Bernat IP6_ADD_STATS_BH(net, ip6_dst_idev(dst), IPSTATS_MIB_OUTOCTETS, skb->len); 513b2e0b385SJan Engelhardt return NF_HOOK(NFPROTO_IPV6, NF_INET_FORWARD, skb, skb->dev, dst->dev, 5146e23ae2aSPatrick McHardy ip6_forward_finish); 5151da177e4SLinus Torvalds 5161da177e4SLinus Torvalds error: 517483a47d2SDenis V. Lunev IP6_INC_STATS_BH(net, ip6_dst_idev(dst), IPSTATS_MIB_INADDRERRORS); 5181da177e4SLinus Torvalds drop: 5191da177e4SLinus Torvalds kfree_skb(skb); 5201da177e4SLinus Torvalds return -EINVAL; 5211da177e4SLinus Torvalds } 5221da177e4SLinus Torvalds 5231da177e4SLinus Torvalds static void ip6_copy_metadata(struct sk_buff *to, struct sk_buff *from) 5241da177e4SLinus Torvalds { 5251da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 5261da177e4SLinus Torvalds to->priority = from->priority; 5271da177e4SLinus Torvalds to->protocol = from->protocol; 528adf30907SEric Dumazet skb_dst_drop(to); 529adf30907SEric Dumazet skb_dst_set(to, dst_clone(skb_dst(from))); 5301da177e4SLinus Torvalds to->dev = from->dev; 53182e91ffeSThomas Graf to->mark = from->mark; 5321da177e4SLinus Torvalds 5331da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 5341da177e4SLinus Torvalds to->tc_index = from->tc_index; 5351da177e4SLinus Torvalds #endif 536e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 537984bc16cSJames Morris skb_copy_secmark(to, from); 5381da177e4SLinus Torvalds } 5391da177e4SLinus Torvalds 54073f156a6SEric Dumazet static void ipv6_select_ident(struct frag_hdr *fhdr, struct rt6_info *rt) 54173f156a6SEric Dumazet { 54273f156a6SEric Dumazet static u32 ip6_idents_hashrnd __read_mostly; 54373f156a6SEric Dumazet u32 hash, id; 54473f156a6SEric Dumazet 54573f156a6SEric Dumazet net_get_random_once(&ip6_idents_hashrnd, sizeof(ip6_idents_hashrnd)); 54673f156a6SEric Dumazet 54773f156a6SEric Dumazet hash = __ipv6_addr_jhash(&rt->rt6i_dst.addr, ip6_idents_hashrnd); 54804ca6973SEric Dumazet hash = __ipv6_addr_jhash(&rt->rt6i_src.addr, hash); 54904ca6973SEric Dumazet 55073f156a6SEric Dumazet id = ip_idents_reserve(hash, 1); 55173f156a6SEric Dumazet fhdr->identification = htonl(id); 55273f156a6SEric Dumazet } 55373f156a6SEric Dumazet 554ad0081e4SDavid Stevens int ip6_fragment(struct sk_buff *skb, int (*output)(struct sk_buff *)) 5551da177e4SLinus Torvalds { 5561da177e4SLinus Torvalds struct sk_buff *frag; 557adf30907SEric Dumazet struct rt6_info *rt = (struct rt6_info *)skb_dst(skb); 558d91675f9SYOSHIFUJI Hideaki struct ipv6_pinfo *np = skb->sk ? inet6_sk(skb->sk) : NULL; 5591da177e4SLinus Torvalds struct ipv6hdr *tmp_hdr; 5601da177e4SLinus Torvalds struct frag_hdr *fh; 5611da177e4SLinus Torvalds unsigned int mtu, hlen, left, len; 562a7ae1992SHerbert Xu int hroom, troom; 563ae08e1f0SAl Viro __be32 frag_id = 0; 5641da177e4SLinus Torvalds int ptr, offset = 0, err = 0; 5651da177e4SLinus Torvalds u8 *prevhdr, nexthdr = 0; 566adf30907SEric Dumazet struct net *net = dev_net(skb_dst(skb)->dev); 5671da177e4SLinus Torvalds 5681da177e4SLinus Torvalds hlen = ip6_find_1stfragopt(skb, &prevhdr); 5691da177e4SLinus Torvalds nexthdr = *prevhdr; 5701da177e4SLinus Torvalds 571628a5c56SJohn Heffner mtu = ip6_skb_dst_mtu(skb); 572b881ef76SJohn Heffner 573b881ef76SJohn Heffner /* We must not fragment if the socket is set to force MTU discovery 57414f3ad6fSUlrich Weber * or if the skb it not generated by a local socket. 575b881ef76SJohn Heffner */ 57660ff7467SWANG Cong if (unlikely(!skb->ignore_df && skb->len > mtu) || 5774cdd3408SPatrick McHardy (IP6CB(skb)->frag_max_size && 5784cdd3408SPatrick McHardy IP6CB(skb)->frag_max_size > mtu)) { 579a34a101eSEric Dumazet if (skb->sk && dst_allfrag(skb_dst(skb))) 580a34a101eSEric Dumazet sk_nocaps_add(skb->sk, NETIF_F_GSO_MASK); 581a34a101eSEric Dumazet 582adf30907SEric Dumazet skb->dev = skb_dst(skb)->dev; 5833ffe533cSAlexey Dobriyan icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu); 584adf30907SEric Dumazet IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), 5853bd653c8SDenis V. Lunev IPSTATS_MIB_FRAGFAILS); 586b881ef76SJohn Heffner kfree_skb(skb); 587b881ef76SJohn Heffner return -EMSGSIZE; 588b881ef76SJohn Heffner } 589b881ef76SJohn Heffner 590d91675f9SYOSHIFUJI Hideaki if (np && np->frag_size < mtu) { 591d91675f9SYOSHIFUJI Hideaki if (np->frag_size) 592d91675f9SYOSHIFUJI Hideaki mtu = np->frag_size; 593d91675f9SYOSHIFUJI Hideaki } 594d91675f9SYOSHIFUJI Hideaki mtu -= hlen + sizeof(struct frag_hdr); 5951da177e4SLinus Torvalds 59621dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 5971da177e4SLinus Torvalds int first_len = skb_pagelen(skb); 5983d13008eSEric Dumazet struct sk_buff *frag2; 5991da177e4SLinus Torvalds 6001da177e4SLinus Torvalds if (first_len - hlen > mtu || 6011da177e4SLinus Torvalds ((first_len - hlen) & 7) || 6021da177e4SLinus Torvalds skb_cloned(skb)) 6031da177e4SLinus Torvalds goto slow_path; 6041da177e4SLinus Torvalds 6054d9092bbSDavid S. Miller skb_walk_frags(skb, frag) { 6061da177e4SLinus Torvalds /* Correct geometry. */ 6071da177e4SLinus Torvalds if (frag->len > mtu || 6081da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 6091da177e4SLinus Torvalds skb_headroom(frag) < hlen) 6103d13008eSEric Dumazet goto slow_path_clean; 6111da177e4SLinus Torvalds 6121da177e4SLinus Torvalds /* Partially cloned skb? */ 6131da177e4SLinus Torvalds if (skb_shared(frag)) 6143d13008eSEric Dumazet goto slow_path_clean; 6152fdba6b0SHerbert Xu 6162fdba6b0SHerbert Xu BUG_ON(frag->sk); 6172fdba6b0SHerbert Xu if (skb->sk) { 6182fdba6b0SHerbert Xu frag->sk = skb->sk; 6192fdba6b0SHerbert Xu frag->destructor = sock_wfree; 6202fdba6b0SHerbert Xu } 6213d13008eSEric Dumazet skb->truesize -= frag->truesize; 6221da177e4SLinus Torvalds } 6231da177e4SLinus Torvalds 6241da177e4SLinus Torvalds err = 0; 6251da177e4SLinus Torvalds offset = 0; 6261da177e4SLinus Torvalds frag = skb_shinfo(skb)->frag_list; 6274d9092bbSDavid S. Miller skb_frag_list_init(skb); 6281da177e4SLinus Torvalds /* BUILD HEADER */ 6291da177e4SLinus Torvalds 6309a217a1cSYOSHIFUJI Hideaki *prevhdr = NEXTHDR_FRAGMENT; 631d56f90a7SArnaldo Carvalho de Melo tmp_hdr = kmemdup(skb_network_header(skb), hlen, GFP_ATOMIC); 6321da177e4SLinus Torvalds if (!tmp_hdr) { 633adf30907SEric Dumazet IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), 6343bd653c8SDenis V. Lunev IPSTATS_MIB_FRAGFAILS); 6351da177e4SLinus Torvalds return -ENOMEM; 6361da177e4SLinus Torvalds } 6371da177e4SLinus Torvalds 6381da177e4SLinus Torvalds __skb_pull(skb, hlen); 6391da177e4SLinus Torvalds fh = (struct frag_hdr *)__skb_push(skb, sizeof(struct frag_hdr)); 640e2d1bca7SArnaldo Carvalho de Melo __skb_push(skb, hlen); 641e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(skb); 642d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(skb), tmp_hdr, hlen); 6431da177e4SLinus Torvalds 64487c48fa3SEric Dumazet ipv6_select_ident(fh, rt); 6451da177e4SLinus Torvalds fh->nexthdr = nexthdr; 6461da177e4SLinus Torvalds fh->reserved = 0; 6471da177e4SLinus Torvalds fh->frag_off = htons(IP6_MF); 6481da177e4SLinus Torvalds frag_id = fh->identification; 6491da177e4SLinus Torvalds 6501da177e4SLinus Torvalds first_len = skb_pagelen(skb); 6511da177e4SLinus Torvalds skb->data_len = first_len - skb_headlen(skb); 6521da177e4SLinus Torvalds skb->len = first_len; 6530660e03fSArnaldo Carvalho de Melo ipv6_hdr(skb)->payload_len = htons(first_len - 6540660e03fSArnaldo Carvalho de Melo sizeof(struct ipv6hdr)); 6551da177e4SLinus Torvalds 656d8d1f30bSChangli Gao dst_hold(&rt->dst); 6571da177e4SLinus Torvalds 6581da177e4SLinus Torvalds for (;;) { 6591da177e4SLinus Torvalds /* Prepare header of the next frame, 6601da177e4SLinus Torvalds * before previous one went down. */ 6611da177e4SLinus Torvalds if (frag) { 6621da177e4SLinus Torvalds frag->ip_summed = CHECKSUM_NONE; 663badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(frag); 6641da177e4SLinus Torvalds fh = (struct frag_hdr *)__skb_push(frag, sizeof(struct frag_hdr)); 665e2d1bca7SArnaldo Carvalho de Melo __skb_push(frag, hlen); 666e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(frag); 667d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(frag), tmp_hdr, 668d56f90a7SArnaldo Carvalho de Melo hlen); 6691da177e4SLinus Torvalds offset += skb->len - hlen - sizeof(struct frag_hdr); 6701da177e4SLinus Torvalds fh->nexthdr = nexthdr; 6711da177e4SLinus Torvalds fh->reserved = 0; 6721da177e4SLinus Torvalds fh->frag_off = htons(offset); 6731da177e4SLinus Torvalds if (frag->next != NULL) 6741da177e4SLinus Torvalds fh->frag_off |= htons(IP6_MF); 6751da177e4SLinus Torvalds fh->identification = frag_id; 6760660e03fSArnaldo Carvalho de Melo ipv6_hdr(frag)->payload_len = 6770660e03fSArnaldo Carvalho de Melo htons(frag->len - 6780660e03fSArnaldo Carvalho de Melo sizeof(struct ipv6hdr)); 6791da177e4SLinus Torvalds ip6_copy_metadata(frag, skb); 6801da177e4SLinus Torvalds } 6811da177e4SLinus Torvalds 6821da177e4SLinus Torvalds err = output(skb); 683dafee490SWei Dong if (!err) 684d8d1f30bSChangli Gao IP6_INC_STATS(net, ip6_dst_idev(&rt->dst), 6853bd653c8SDenis V. Lunev IPSTATS_MIB_FRAGCREATES); 686dafee490SWei Dong 6871da177e4SLinus Torvalds if (err || !frag) 6881da177e4SLinus Torvalds break; 6891da177e4SLinus Torvalds 6901da177e4SLinus Torvalds skb = frag; 6911da177e4SLinus Torvalds frag = skb->next; 6921da177e4SLinus Torvalds skb->next = NULL; 6931da177e4SLinus Torvalds } 6941da177e4SLinus Torvalds 6951da177e4SLinus Torvalds kfree(tmp_hdr); 6961da177e4SLinus Torvalds 6971da177e4SLinus Torvalds if (err == 0) { 698d8d1f30bSChangli Gao IP6_INC_STATS(net, ip6_dst_idev(&rt->dst), 6993bd653c8SDenis V. Lunev IPSTATS_MIB_FRAGOKS); 70094e187c0SAmerigo Wang ip6_rt_put(rt); 7011da177e4SLinus Torvalds return 0; 7021da177e4SLinus Torvalds } 7031da177e4SLinus Torvalds 70446cfd725SFlorian Westphal kfree_skb_list(frag); 7051da177e4SLinus Torvalds 706d8d1f30bSChangli Gao IP6_INC_STATS(net, ip6_dst_idev(&rt->dst), 7073bd653c8SDenis V. Lunev IPSTATS_MIB_FRAGFAILS); 70894e187c0SAmerigo Wang ip6_rt_put(rt); 7091da177e4SLinus Torvalds return err; 7103d13008eSEric Dumazet 7113d13008eSEric Dumazet slow_path_clean: 7123d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 7133d13008eSEric Dumazet if (frag2 == frag) 7143d13008eSEric Dumazet break; 7153d13008eSEric Dumazet frag2->sk = NULL; 7163d13008eSEric Dumazet frag2->destructor = NULL; 7173d13008eSEric Dumazet skb->truesize += frag2->truesize; 7183d13008eSEric Dumazet } 7191da177e4SLinus Torvalds } 7201da177e4SLinus Torvalds 7211da177e4SLinus Torvalds slow_path: 72272e843bbSEric Dumazet if ((skb->ip_summed == CHECKSUM_PARTIAL) && 72372e843bbSEric Dumazet skb_checksum_help(skb)) 72472e843bbSEric Dumazet goto fail; 72572e843bbSEric Dumazet 7261da177e4SLinus Torvalds left = skb->len - hlen; /* Space per frame */ 7271da177e4SLinus Torvalds ptr = hlen; /* Where to start from */ 7281da177e4SLinus Torvalds 7291da177e4SLinus Torvalds /* 7301da177e4SLinus Torvalds * Fragment the datagram. 7311da177e4SLinus Torvalds */ 7321da177e4SLinus Torvalds 7331da177e4SLinus Torvalds *prevhdr = NEXTHDR_FRAGMENT; 734a7ae1992SHerbert Xu hroom = LL_RESERVED_SPACE(rt->dst.dev); 735a7ae1992SHerbert Xu troom = rt->dst.dev->needed_tailroom; 7361da177e4SLinus Torvalds 7371da177e4SLinus Torvalds /* 7381da177e4SLinus Torvalds * Keep copying data until we run out. 7391da177e4SLinus Torvalds */ 7401da177e4SLinus Torvalds while (left > 0) { 7411da177e4SLinus Torvalds len = left; 7421da177e4SLinus Torvalds /* IF: it doesn't fit, use 'mtu' - the data space left */ 7431da177e4SLinus Torvalds if (len > mtu) 7441da177e4SLinus Torvalds len = mtu; 7451da177e4SLinus Torvalds /* IF: we are not sending up to and including the packet end 7461da177e4SLinus Torvalds then align the next start on an eight byte boundary */ 7471da177e4SLinus Torvalds if (len < left) { 7481da177e4SLinus Torvalds len &= ~7; 7491da177e4SLinus Torvalds } 7501da177e4SLinus Torvalds 751*cbffccc9SJoe Perches /* Allocate buffer */ 752*cbffccc9SJoe Perches frag = alloc_skb(len + hlen + sizeof(struct frag_hdr) + 753*cbffccc9SJoe Perches hroom + troom, GFP_ATOMIC); 754*cbffccc9SJoe Perches if (!frag) { 755adf30907SEric Dumazet IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), 756a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_FRAGFAILS); 7571da177e4SLinus Torvalds err = -ENOMEM; 7581da177e4SLinus Torvalds goto fail; 7591da177e4SLinus Torvalds } 7601da177e4SLinus Torvalds 7611da177e4SLinus Torvalds /* 7621da177e4SLinus Torvalds * Set up data on packet 7631da177e4SLinus Torvalds */ 7641da177e4SLinus Torvalds 7651da177e4SLinus Torvalds ip6_copy_metadata(frag, skb); 766a7ae1992SHerbert Xu skb_reserve(frag, hroom); 7671da177e4SLinus Torvalds skb_put(frag, len + hlen + sizeof(struct frag_hdr)); 768c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(frag); 769badff6d0SArnaldo Carvalho de Melo fh = (struct frag_hdr *)(skb_network_header(frag) + hlen); 770b0e380b1SArnaldo Carvalho de Melo frag->transport_header = (frag->network_header + hlen + 771b0e380b1SArnaldo Carvalho de Melo sizeof(struct frag_hdr)); 7721da177e4SLinus Torvalds 7731da177e4SLinus Torvalds /* 7741da177e4SLinus Torvalds * Charge the memory for the fragment to any owner 7751da177e4SLinus Torvalds * it might possess 7761da177e4SLinus Torvalds */ 7771da177e4SLinus Torvalds if (skb->sk) 7781da177e4SLinus Torvalds skb_set_owner_w(frag, skb->sk); 7791da177e4SLinus Torvalds 7801da177e4SLinus Torvalds /* 7811da177e4SLinus Torvalds * Copy the packet header into the new buffer. 7821da177e4SLinus Torvalds */ 783d626f62bSArnaldo Carvalho de Melo skb_copy_from_linear_data(skb, skb_network_header(frag), hlen); 7841da177e4SLinus Torvalds 7851da177e4SLinus Torvalds /* 7861da177e4SLinus Torvalds * Build fragment header. 7871da177e4SLinus Torvalds */ 7881da177e4SLinus Torvalds fh->nexthdr = nexthdr; 7891da177e4SLinus Torvalds fh->reserved = 0; 790f36d6ab1SYan Zheng if (!frag_id) { 79187c48fa3SEric Dumazet ipv6_select_ident(fh, rt); 7921da177e4SLinus Torvalds frag_id = fh->identification; 7931da177e4SLinus Torvalds } else 7941da177e4SLinus Torvalds fh->identification = frag_id; 7951da177e4SLinus Torvalds 7961da177e4SLinus Torvalds /* 7971da177e4SLinus Torvalds * Copy a block of the IP datagram. 7981da177e4SLinus Torvalds */ 799e3f0b86bSHimangi Saraogi BUG_ON(skb_copy_bits(skb, ptr, skb_transport_header(frag), 800e3f0b86bSHimangi Saraogi len)); 8011da177e4SLinus Torvalds left -= len; 8021da177e4SLinus Torvalds 8031da177e4SLinus Torvalds fh->frag_off = htons(offset); 8041da177e4SLinus Torvalds if (left > 0) 8051da177e4SLinus Torvalds fh->frag_off |= htons(IP6_MF); 8060660e03fSArnaldo Carvalho de Melo ipv6_hdr(frag)->payload_len = htons(frag->len - 8070660e03fSArnaldo Carvalho de Melo sizeof(struct ipv6hdr)); 8081da177e4SLinus Torvalds 8091da177e4SLinus Torvalds ptr += len; 8101da177e4SLinus Torvalds offset += len; 8111da177e4SLinus Torvalds 8121da177e4SLinus Torvalds /* 8131da177e4SLinus Torvalds * Put this fragment into the sending queue. 8141da177e4SLinus Torvalds */ 8151da177e4SLinus Torvalds err = output(frag); 8161da177e4SLinus Torvalds if (err) 8171da177e4SLinus Torvalds goto fail; 818dafee490SWei Dong 819adf30907SEric Dumazet IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), 8203bd653c8SDenis V. Lunev IPSTATS_MIB_FRAGCREATES); 8211da177e4SLinus Torvalds } 822adf30907SEric Dumazet IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), 823a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_FRAGOKS); 824808db80aSEric Dumazet consume_skb(skb); 8251da177e4SLinus Torvalds return err; 8261da177e4SLinus Torvalds 8271da177e4SLinus Torvalds fail: 828adf30907SEric Dumazet IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), 829a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_FRAGFAILS); 8301da177e4SLinus Torvalds kfree_skb(skb); 8311da177e4SLinus Torvalds return err; 8321da177e4SLinus Torvalds } 8331da177e4SLinus Torvalds 834b71d1d42SEric Dumazet static inline int ip6_rt_check(const struct rt6key *rt_key, 835b71d1d42SEric Dumazet const struct in6_addr *fl_addr, 836b71d1d42SEric Dumazet const struct in6_addr *addr_cache) 837cf6b1982SYOSHIFUJI Hideaki { 838a02cec21SEric Dumazet return (rt_key->plen != 128 || !ipv6_addr_equal(fl_addr, &rt_key->addr)) && 839a02cec21SEric Dumazet (addr_cache == NULL || !ipv6_addr_equal(fl_addr, addr_cache)); 840cf6b1982SYOSHIFUJI Hideaki } 841cf6b1982SYOSHIFUJI Hideaki 842497c615aSHerbert Xu static struct dst_entry *ip6_sk_dst_check(struct sock *sk, 843497c615aSHerbert Xu struct dst_entry *dst, 844b71d1d42SEric Dumazet const struct flowi6 *fl6) 8451da177e4SLinus Torvalds { 8461da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 847a963a37dSEric Dumazet struct rt6_info *rt; 8481da177e4SLinus Torvalds 849497c615aSHerbert Xu if (!dst) 850497c615aSHerbert Xu goto out; 8511da177e4SLinus Torvalds 852a963a37dSEric Dumazet if (dst->ops->family != AF_INET6) { 853a963a37dSEric Dumazet dst_release(dst); 854a963a37dSEric Dumazet return NULL; 855a963a37dSEric Dumazet } 856a963a37dSEric Dumazet 857a963a37dSEric Dumazet rt = (struct rt6_info *)dst; 8581da177e4SLinus Torvalds /* Yes, checking route validity in not connected 859d76e60a5SDavid S. Miller * case is not very simple. Take into account, 860d76e60a5SDavid S. Miller * that we do not support routing by source, TOS, 861d76e60a5SDavid S. Miller * and MSG_DONTROUTE --ANK (980726) 862d76e60a5SDavid S. Miller * 863cf6b1982SYOSHIFUJI Hideaki * 1. ip6_rt_check(): If route was host route, 864cf6b1982SYOSHIFUJI Hideaki * check that cached destination is current. 865d76e60a5SDavid S. Miller * If it is network route, we still may 866d76e60a5SDavid S. Miller * check its validity using saved pointer 867d76e60a5SDavid S. Miller * to the last used address: daddr_cache. 868d76e60a5SDavid S. Miller * We do not want to save whole address now, 869d76e60a5SDavid S. Miller * (because main consumer of this service 870d76e60a5SDavid S. Miller * is tcp, which has not this problem), 871d76e60a5SDavid S. Miller * so that the last trick works only on connected 872d76e60a5SDavid S. Miller * sockets. 873d76e60a5SDavid S. Miller * 2. oif also should be the same. 8741da177e4SLinus Torvalds */ 8754c9483b2SDavid S. Miller if (ip6_rt_check(&rt->rt6i_dst, &fl6->daddr, np->daddr_cache) || 8768e1ef0a9SYOSHIFUJI Hideaki #ifdef CONFIG_IPV6_SUBTREES 8774c9483b2SDavid S. Miller ip6_rt_check(&rt->rt6i_src, &fl6->saddr, np->saddr_cache) || 8788e1ef0a9SYOSHIFUJI Hideaki #endif 8794c9483b2SDavid S. Miller (fl6->flowi6_oif && fl6->flowi6_oif != dst->dev->ifindex)) { 880497c615aSHerbert Xu dst_release(dst); 881497c615aSHerbert Xu dst = NULL; 8821da177e4SLinus Torvalds } 883497c615aSHerbert Xu 884497c615aSHerbert Xu out: 885497c615aSHerbert Xu return dst; 8861da177e4SLinus Torvalds } 887497c615aSHerbert Xu 888497c615aSHerbert Xu static int ip6_dst_lookup_tail(struct sock *sk, 8894c9483b2SDavid S. Miller struct dst_entry **dst, struct flowi6 *fl6) 890497c615aSHerbert Xu { 8913b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(sk); 89269cce1d1SDavid S. Miller #ifdef CONFIG_IPV6_OPTIMISTIC_DAD 89369cce1d1SDavid S. Miller struct neighbour *n; 89497cac082SDavid S. Miller struct rt6_info *rt; 89569cce1d1SDavid S. Miller #endif 89669cce1d1SDavid S. Miller int err; 8971da177e4SLinus Torvalds 8981da177e4SLinus Torvalds if (*dst == NULL) 8994c9483b2SDavid S. Miller *dst = ip6_route_output(net, sk, fl6); 9001da177e4SLinus Torvalds 9011da177e4SLinus Torvalds if ((err = (*dst)->error)) 9021da177e4SLinus Torvalds goto out_err_release; 9031da177e4SLinus Torvalds 9044c9483b2SDavid S. Miller if (ipv6_addr_any(&fl6->saddr)) { 905c3968a85SDaniel Walter struct rt6_info *rt = (struct rt6_info *) *dst; 906c3968a85SDaniel Walter err = ip6_route_get_saddr(net, rt, &fl6->daddr, 9077cbca67cSYOSHIFUJI Hideaki sk ? inet6_sk(sk)->srcprefs : 0, 9084c9483b2SDavid S. Miller &fl6->saddr); 90944456d37SOlaf Hering if (err) 9101da177e4SLinus Torvalds goto out_err_release; 9111da177e4SLinus Torvalds } 9121da177e4SLinus Torvalds 91395c385b4SNeil Horman #ifdef CONFIG_IPV6_OPTIMISTIC_DAD 91495c385b4SNeil Horman /* 91595c385b4SNeil Horman * Here if the dst entry we've looked up 91695c385b4SNeil Horman * has a neighbour entry that is in the INCOMPLETE 91795c385b4SNeil Horman * state and the src address from the flow is 91895c385b4SNeil Horman * marked as OPTIMISTIC, we release the found 91995c385b4SNeil Horman * dst entry and replace it instead with the 92095c385b4SNeil Horman * dst entry of the nexthop router 92195c385b4SNeil Horman */ 922c56bf6feSEric Dumazet rt = (struct rt6_info *) *dst; 923707be1ffSYOSHIFUJI Hideaki / 吉藤英明 rcu_read_lock_bh(); 924550bab42SJulian Anastasov n = __ipv6_neigh_lookup_noref(rt->dst.dev, rt6_nexthop(rt)); 925707be1ffSYOSHIFUJI Hideaki / 吉藤英明 err = n && !(n->nud_state & NUD_VALID) ? -EINVAL : 0; 926707be1ffSYOSHIFUJI Hideaki / 吉藤英明 rcu_read_unlock_bh(); 927707be1ffSYOSHIFUJI Hideaki / 吉藤英明 928707be1ffSYOSHIFUJI Hideaki / 吉藤英明 if (err) { 92995c385b4SNeil Horman struct inet6_ifaddr *ifp; 9304c9483b2SDavid S. Miller struct flowi6 fl_gw6; 93195c385b4SNeil Horman int redirect; 93295c385b4SNeil Horman 9334c9483b2SDavid S. Miller ifp = ipv6_get_ifaddr(net, &fl6->saddr, 9341cab3da6SDaniel Lezcano (*dst)->dev, 1); 93595c385b4SNeil Horman 93695c385b4SNeil Horman redirect = (ifp && ifp->flags & IFA_F_OPTIMISTIC); 93795c385b4SNeil Horman if (ifp) 93895c385b4SNeil Horman in6_ifa_put(ifp); 93995c385b4SNeil Horman 94095c385b4SNeil Horman if (redirect) { 94195c385b4SNeil Horman /* 94295c385b4SNeil Horman * We need to get the dst entry for the 94395c385b4SNeil Horman * default router instead 94495c385b4SNeil Horman */ 94595c385b4SNeil Horman dst_release(*dst); 9464c9483b2SDavid S. Miller memcpy(&fl_gw6, fl6, sizeof(struct flowi6)); 9474c9483b2SDavid S. Miller memset(&fl_gw6.daddr, 0, sizeof(struct in6_addr)); 9484c9483b2SDavid S. Miller *dst = ip6_route_output(net, sk, &fl_gw6); 94995c385b4SNeil Horman if ((err = (*dst)->error)) 95095c385b4SNeil Horman goto out_err_release; 95195c385b4SNeil Horman } 95295c385b4SNeil Horman } 95395c385b4SNeil Horman #endif 95495c385b4SNeil Horman 9551da177e4SLinus Torvalds return 0; 9561da177e4SLinus Torvalds 9571da177e4SLinus Torvalds out_err_release: 958ca46f9c8SMitsuru Chinen if (err == -ENETUNREACH) 9595ac68e7cSJohn Stultz IP6_INC_STATS(net, NULL, IPSTATS_MIB_OUTNOROUTES); 9601da177e4SLinus Torvalds dst_release(*dst); 9611da177e4SLinus Torvalds *dst = NULL; 9621da177e4SLinus Torvalds return err; 9631da177e4SLinus Torvalds } 96434a0b3cdSAdrian Bunk 965497c615aSHerbert Xu /** 966497c615aSHerbert Xu * ip6_dst_lookup - perform route lookup on flow 967497c615aSHerbert Xu * @sk: socket which provides route info 968497c615aSHerbert Xu * @dst: pointer to dst_entry * for result 9694c9483b2SDavid S. Miller * @fl6: flow to lookup 970497c615aSHerbert Xu * 971497c615aSHerbert Xu * This function performs a route lookup on the given flow. 972497c615aSHerbert Xu * 973497c615aSHerbert Xu * It returns zero on success, or a standard errno code on error. 974497c615aSHerbert Xu */ 9754c9483b2SDavid S. Miller int ip6_dst_lookup(struct sock *sk, struct dst_entry **dst, struct flowi6 *fl6) 976497c615aSHerbert Xu { 977497c615aSHerbert Xu *dst = NULL; 9784c9483b2SDavid S. Miller return ip6_dst_lookup_tail(sk, dst, fl6); 979497c615aSHerbert Xu } 9803cf3dc6cSArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip6_dst_lookup); 9813cf3dc6cSArnaldo Carvalho de Melo 982497c615aSHerbert Xu /** 98368d0c6d3SDavid S. Miller * ip6_dst_lookup_flow - perform route lookup on flow with ipsec 98468d0c6d3SDavid S. Miller * @sk: socket which provides route info 9854c9483b2SDavid S. Miller * @fl6: flow to lookup 98668d0c6d3SDavid S. Miller * @final_dst: final destination address for ipsec lookup 98768d0c6d3SDavid S. Miller * 98868d0c6d3SDavid S. Miller * This function performs a route lookup on the given flow. 98968d0c6d3SDavid S. Miller * 99068d0c6d3SDavid S. Miller * It returns a valid dst pointer on success, or a pointer encoded 99168d0c6d3SDavid S. Miller * error code. 99268d0c6d3SDavid S. Miller */ 9934c9483b2SDavid S. Miller struct dst_entry *ip6_dst_lookup_flow(struct sock *sk, struct flowi6 *fl6, 9940e0d44abSSteffen Klassert const struct in6_addr *final_dst) 99568d0c6d3SDavid S. Miller { 99668d0c6d3SDavid S. Miller struct dst_entry *dst = NULL; 99768d0c6d3SDavid S. Miller int err; 99868d0c6d3SDavid S. Miller 9994c9483b2SDavid S. Miller err = ip6_dst_lookup_tail(sk, &dst, fl6); 100068d0c6d3SDavid S. Miller if (err) 100168d0c6d3SDavid S. Miller return ERR_PTR(err); 100268d0c6d3SDavid S. Miller if (final_dst) 10034e3fd7a0SAlexey Dobriyan fl6->daddr = *final_dst; 10042774c131SDavid S. Miller 1005f92ee619SSteffen Klassert return xfrm_lookup_route(sock_net(sk), dst, flowi6_to_flowi(fl6), sk, 0); 100668d0c6d3SDavid S. Miller } 100768d0c6d3SDavid S. Miller EXPORT_SYMBOL_GPL(ip6_dst_lookup_flow); 100868d0c6d3SDavid S. Miller 100968d0c6d3SDavid S. Miller /** 101068d0c6d3SDavid S. Miller * ip6_sk_dst_lookup_flow - perform socket cached route lookup on flow 101168d0c6d3SDavid S. Miller * @sk: socket which provides the dst cache and route info 10124c9483b2SDavid S. Miller * @fl6: flow to lookup 101368d0c6d3SDavid S. Miller * @final_dst: final destination address for ipsec lookup 1014497c615aSHerbert Xu * 1015497c615aSHerbert Xu * This function performs a route lookup on the given flow with the 1016497c615aSHerbert Xu * possibility of using the cached route in the socket if it is valid. 1017497c615aSHerbert Xu * It will take the socket dst lock when operating on the dst cache. 1018497c615aSHerbert Xu * As a result, this function can only be used in process context. 1019497c615aSHerbert Xu * 102068d0c6d3SDavid S. Miller * It returns a valid dst pointer on success, or a pointer encoded 102168d0c6d3SDavid S. Miller * error code. 1022497c615aSHerbert Xu */ 10234c9483b2SDavid S. Miller struct dst_entry *ip6_sk_dst_lookup_flow(struct sock *sk, struct flowi6 *fl6, 10240e0d44abSSteffen Klassert const struct in6_addr *final_dst) 1025497c615aSHerbert Xu { 102668d0c6d3SDavid S. Miller struct dst_entry *dst = sk_dst_check(sk, inet6_sk(sk)->dst_cookie); 102768d0c6d3SDavid S. Miller int err; 1028497c615aSHerbert Xu 10294c9483b2SDavid S. Miller dst = ip6_sk_dst_check(sk, dst, fl6); 103068d0c6d3SDavid S. Miller 10314c9483b2SDavid S. Miller err = ip6_dst_lookup_tail(sk, &dst, fl6); 103268d0c6d3SDavid S. Miller if (err) 103368d0c6d3SDavid S. Miller return ERR_PTR(err); 103468d0c6d3SDavid S. Miller if (final_dst) 10354e3fd7a0SAlexey Dobriyan fl6->daddr = *final_dst; 10362774c131SDavid S. Miller 1037f92ee619SSteffen Klassert return xfrm_lookup_route(sock_net(sk), dst, flowi6_to_flowi(fl6), sk, 0); 103868d0c6d3SDavid S. Miller } 103968d0c6d3SDavid S. Miller EXPORT_SYMBOL_GPL(ip6_sk_dst_lookup_flow); 1040497c615aSHerbert Xu 104134a0b3cdSAdrian Bunk static inline int ip6_ufo_append_data(struct sock *sk, 1042e89e9cf5SAnanda Raju int getfrag(void *from, char *to, int offset, int len, 1043e89e9cf5SAnanda Raju int odd, struct sk_buff *skb), 1044e89e9cf5SAnanda Raju void *from, int length, int hh_len, int fragheaderlen, 104587c48fa3SEric Dumazet int transhdrlen, int mtu, unsigned int flags, 104687c48fa3SEric Dumazet struct rt6_info *rt) 1047e89e9cf5SAnanda Raju 1048e89e9cf5SAnanda Raju { 1049e89e9cf5SAnanda Raju struct sk_buff *skb; 1050c547dbf5SJiri Pirko struct frag_hdr fhdr; 1051e89e9cf5SAnanda Raju int err; 1052e89e9cf5SAnanda Raju 1053e89e9cf5SAnanda Raju /* There is support for UDP large send offload by network 1054e89e9cf5SAnanda Raju * device, so create one single skb packet containing complete 1055e89e9cf5SAnanda Raju * udp datagram 1056e89e9cf5SAnanda Raju */ 1057e89e9cf5SAnanda Raju if ((skb = skb_peek_tail(&sk->sk_write_queue)) == NULL) { 1058e89e9cf5SAnanda Raju skb = sock_alloc_send_skb(sk, 1059e89e9cf5SAnanda Raju hh_len + fragheaderlen + transhdrlen + 20, 1060e89e9cf5SAnanda Raju (flags & MSG_DONTWAIT), &err); 1061e89e9cf5SAnanda Raju if (skb == NULL) 1062504744e4SZheng Yan return err; 1063e89e9cf5SAnanda Raju 1064e89e9cf5SAnanda Raju /* reserve space for Hardware header */ 1065e89e9cf5SAnanda Raju skb_reserve(skb, hh_len); 1066e89e9cf5SAnanda Raju 1067e89e9cf5SAnanda Raju /* create space for UDP/IP header */ 1068e89e9cf5SAnanda Raju skb_put(skb, fragheaderlen + transhdrlen); 1069e89e9cf5SAnanda Raju 1070e89e9cf5SAnanda Raju /* initialize network header pointer */ 1071c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1072e89e9cf5SAnanda Raju 1073e89e9cf5SAnanda Raju /* initialize protocol header pointer */ 1074b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header + fragheaderlen; 1075e89e9cf5SAnanda Raju 10769c9c9ad5SHannes Frederic Sowa skb->protocol = htons(ETH_P_IPV6); 1077e89e9cf5SAnanda Raju skb->csum = 0; 1078e89e9cf5SAnanda Raju 1079c547dbf5SJiri Pirko __skb_queue_tail(&sk->sk_write_queue, skb); 1080c547dbf5SJiri Pirko } else if (skb_is_gso(skb)) { 1081c547dbf5SJiri Pirko goto append; 1082c547dbf5SJiri Pirko } 1083c547dbf5SJiri Pirko 1084c547dbf5SJiri Pirko skb->ip_summed = CHECKSUM_PARTIAL; 1085c31d5326SSridhar Samudrala /* Specify the length of each IPv6 datagram fragment. 1086c31d5326SSridhar Samudrala * It has to be a multiple of 8. 1087c31d5326SSridhar Samudrala */ 1088c31d5326SSridhar Samudrala skb_shinfo(skb)->gso_size = (mtu - fragheaderlen - 1089c31d5326SSridhar Samudrala sizeof(struct frag_hdr)) & ~7; 1090f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 109187c48fa3SEric Dumazet ipv6_select_ident(&fhdr, rt); 1092e89e9cf5SAnanda Raju skb_shinfo(skb)->ip6_frag_id = fhdr.identification; 1093e89e9cf5SAnanda Raju 1094c547dbf5SJiri Pirko append: 10952811ebacSHannes Frederic Sowa return skb_append_datato_frags(sk, skb, getfrag, from, 10962811ebacSHannes Frederic Sowa (length - transhdrlen)); 1097e89e9cf5SAnanda Raju } 10981da177e4SLinus Torvalds 10990178b695SHerbert Xu static inline struct ipv6_opt_hdr *ip6_opt_dup(struct ipv6_opt_hdr *src, 11000178b695SHerbert Xu gfp_t gfp) 11010178b695SHerbert Xu { 11020178b695SHerbert Xu return src ? kmemdup(src, (src->hdrlen + 1) * 8, gfp) : NULL; 11030178b695SHerbert Xu } 11040178b695SHerbert Xu 11050178b695SHerbert Xu static inline struct ipv6_rt_hdr *ip6_rthdr_dup(struct ipv6_rt_hdr *src, 11060178b695SHerbert Xu gfp_t gfp) 11070178b695SHerbert Xu { 11080178b695SHerbert Xu return src ? kmemdup(src, (src->hdrlen + 1) * 8, gfp) : NULL; 11090178b695SHerbert Xu } 11100178b695SHerbert Xu 111175a493e6SHannes Frederic Sowa static void ip6_append_data_mtu(unsigned int *mtu, 11120c183379SGao feng int *maxfraglen, 11130c183379SGao feng unsigned int fragheaderlen, 11140c183379SGao feng struct sk_buff *skb, 111575a493e6SHannes Frederic Sowa struct rt6_info *rt, 1116e367c2d0Slucien unsigned int orig_mtu) 11170c183379SGao feng { 11180c183379SGao feng if (!(rt->dst.flags & DST_XFRM_TUNNEL)) { 11190c183379SGao feng if (skb == NULL) { 11200c183379SGao feng /* first fragment, reserve header_len */ 1121e367c2d0Slucien *mtu = orig_mtu - rt->dst.header_len; 11220c183379SGao feng 11230c183379SGao feng } else { 11240c183379SGao feng /* 11250c183379SGao feng * this fragment is not first, the headers 11260c183379SGao feng * space is regarded as data space. 11270c183379SGao feng */ 1128e367c2d0Slucien *mtu = orig_mtu; 11290c183379SGao feng } 11300c183379SGao feng *maxfraglen = ((*mtu - fragheaderlen) & ~7) 11310c183379SGao feng + fragheaderlen - sizeof(struct frag_hdr); 11320c183379SGao feng } 11330c183379SGao feng } 11340c183379SGao feng 113541a1f8eaSYOSHIFUJI Hideaki int ip6_append_data(struct sock *sk, int getfrag(void *from, char *to, 113641a1f8eaSYOSHIFUJI Hideaki int offset, int len, int odd, struct sk_buff *skb), 11371da177e4SLinus Torvalds void *from, int length, int transhdrlen, 11384c9483b2SDavid S. Miller int hlimit, int tclass, struct ipv6_txoptions *opt, struct flowi6 *fl6, 113913b52cd4SBrian Haley struct rt6_info *rt, unsigned int flags, int dontfrag) 11401da177e4SLinus Torvalds { 11411da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 11421da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 1143bdc712b4SDavid S. Miller struct inet_cork *cork; 11440c183379SGao feng struct sk_buff *skb, *skb_prev = NULL; 1145e367c2d0Slucien unsigned int maxfraglen, fragheaderlen, mtu, orig_mtu; 11461da177e4SLinus Torvalds int exthdrlen; 1147299b0767SSteffen Klassert int dst_exthdrlen; 11481da177e4SLinus Torvalds int hh_len; 11491da177e4SLinus Torvalds int copy; 11501da177e4SLinus Torvalds int err; 11511da177e4SLinus Torvalds int offset = 0; 1152a693e698SAnders Berggren __u8 tx_flags = 0; 115309c2d251SWillem de Bruijn u32 tskey = 0; 11541da177e4SLinus Torvalds 11551da177e4SLinus Torvalds if (flags&MSG_PROBE) 11561da177e4SLinus Torvalds return 0; 1157bdc712b4SDavid S. Miller cork = &inet->cork.base; 11581da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) { 11591da177e4SLinus Torvalds /* 11601da177e4SLinus Torvalds * setup for corking 11611da177e4SLinus Torvalds */ 11621da177e4SLinus Torvalds if (opt) { 11630178b695SHerbert Xu if (WARN_ON(np->cork.opt)) 11640178b695SHerbert Xu return -EINVAL; 11650178b695SHerbert Xu 1166284041efSEric Dumazet np->cork.opt = kzalloc(opt->tot_len, sk->sk_allocation); 11671da177e4SLinus Torvalds if (unlikely(np->cork.opt == NULL)) 11681da177e4SLinus Torvalds return -ENOBUFS; 11690178b695SHerbert Xu 11700178b695SHerbert Xu np->cork.opt->tot_len = opt->tot_len; 11710178b695SHerbert Xu np->cork.opt->opt_flen = opt->opt_flen; 11720178b695SHerbert Xu np->cork.opt->opt_nflen = opt->opt_nflen; 11730178b695SHerbert Xu 11740178b695SHerbert Xu np->cork.opt->dst0opt = ip6_opt_dup(opt->dst0opt, 11750178b695SHerbert Xu sk->sk_allocation); 11760178b695SHerbert Xu if (opt->dst0opt && !np->cork.opt->dst0opt) 11770178b695SHerbert Xu return -ENOBUFS; 11780178b695SHerbert Xu 11790178b695SHerbert Xu np->cork.opt->dst1opt = ip6_opt_dup(opt->dst1opt, 11800178b695SHerbert Xu sk->sk_allocation); 11810178b695SHerbert Xu if (opt->dst1opt && !np->cork.opt->dst1opt) 11820178b695SHerbert Xu return -ENOBUFS; 11830178b695SHerbert Xu 11840178b695SHerbert Xu np->cork.opt->hopopt = ip6_opt_dup(opt->hopopt, 11850178b695SHerbert Xu sk->sk_allocation); 11860178b695SHerbert Xu if (opt->hopopt && !np->cork.opt->hopopt) 11870178b695SHerbert Xu return -ENOBUFS; 11880178b695SHerbert Xu 11890178b695SHerbert Xu np->cork.opt->srcrt = ip6_rthdr_dup(opt->srcrt, 11900178b695SHerbert Xu sk->sk_allocation); 11910178b695SHerbert Xu if (opt->srcrt && !np->cork.opt->srcrt) 11920178b695SHerbert Xu return -ENOBUFS; 11930178b695SHerbert Xu 11941da177e4SLinus Torvalds /* need source address above miyazawa*/ 11951da177e4SLinus Torvalds } 1196d8d1f30bSChangli Gao dst_hold(&rt->dst); 1197bdc712b4SDavid S. Miller cork->dst = &rt->dst; 11984c9483b2SDavid S. Miller inet->cork.fl.u.ip6 = *fl6; 11991da177e4SLinus Torvalds np->cork.hop_limit = hlimit; 120041a1f8eaSYOSHIFUJI Hideaki np->cork.tclass = tclass; 12010c183379SGao feng if (rt->dst.flags & DST_XFRM_TUNNEL) 120293b36cf3SHannes Frederic Sowa mtu = np->pmtudisc >= IPV6_PMTUDISC_PROBE ? 1203299b0767SSteffen Klassert rt->dst.dev->mtu : dst_mtu(&rt->dst); 12040c183379SGao feng else 120593b36cf3SHannes Frederic Sowa mtu = np->pmtudisc >= IPV6_PMTUDISC_PROBE ? 12060c183379SGao feng rt->dst.dev->mtu : dst_mtu(rt->dst.path); 1207c7503609SDave Jones if (np->frag_size < mtu) { 1208d91675f9SYOSHIFUJI Hideaki if (np->frag_size) 1209d91675f9SYOSHIFUJI Hideaki mtu = np->frag_size; 1210d91675f9SYOSHIFUJI Hideaki } 1211bdc712b4SDavid S. Miller cork->fragsize = mtu; 1212d8d1f30bSChangli Gao if (dst_allfrag(rt->dst.path)) 1213bdc712b4SDavid S. Miller cork->flags |= IPCORK_ALLFRAG; 1214bdc712b4SDavid S. Miller cork->length = 0; 12157efdba5bSRomain KUNTZ exthdrlen = (opt ? opt->opt_flen : 0); 12161da177e4SLinus Torvalds length += exthdrlen; 12171da177e4SLinus Torvalds transhdrlen += exthdrlen; 12187efdba5bSRomain KUNTZ dst_exthdrlen = rt->dst.header_len - rt->rt6i_nfheader_len; 12191da177e4SLinus Torvalds } else { 1220bdc712b4SDavid S. Miller rt = (struct rt6_info *)cork->dst; 12214c9483b2SDavid S. Miller fl6 = &inet->cork.fl.u.ip6; 12221da177e4SLinus Torvalds opt = np->cork.opt; 12231da177e4SLinus Torvalds transhdrlen = 0; 12241da177e4SLinus Torvalds exthdrlen = 0; 1225299b0767SSteffen Klassert dst_exthdrlen = 0; 1226bdc712b4SDavid S. Miller mtu = cork->fragsize; 12271da177e4SLinus Torvalds } 1228e367c2d0Slucien orig_mtu = mtu; 12291da177e4SLinus Torvalds 1230d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 12311da177e4SLinus Torvalds 1232a1b05140SMasahide NAKAMURA fragheaderlen = sizeof(struct ipv6hdr) + rt->rt6i_nfheader_len + 1233b4ce9277SHerbert Xu (opt ? opt->opt_nflen : 0); 12344df98e76SHannes Frederic Sowa maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen - 12354df98e76SHannes Frederic Sowa sizeof(struct frag_hdr); 12361da177e4SLinus Torvalds 12371da177e4SLinus Torvalds if (mtu <= sizeof(struct ipv6hdr) + IPV6_MAXPLEN) { 12384df98e76SHannes Frederic Sowa unsigned int maxnonfragsize, headersize; 12394df98e76SHannes Frederic Sowa 12404df98e76SHannes Frederic Sowa headersize = sizeof(struct ipv6hdr) + 12413a1cebe7SHannes Frederic Sowa (opt ? opt->opt_flen + opt->opt_nflen : 0) + 12424df98e76SHannes Frederic Sowa (dst_allfrag(&rt->dst) ? 12434df98e76SHannes Frederic Sowa sizeof(struct frag_hdr) : 0) + 12444df98e76SHannes Frederic Sowa rt->rt6i_nfheader_len; 12454df98e76SHannes Frederic Sowa 124660ff7467SWANG Cong if (ip6_sk_ignore_df(sk)) 12470b95227aSHannes Frederic Sowa maxnonfragsize = sizeof(struct ipv6hdr) + IPV6_MAXPLEN; 12480b95227aSHannes Frederic Sowa else 12490b95227aSHannes Frederic Sowa maxnonfragsize = mtu; 12504df98e76SHannes Frederic Sowa 12514df98e76SHannes Frederic Sowa /* dontfrag active */ 12524df98e76SHannes Frederic Sowa if ((cork->length + length > mtu - headersize) && dontfrag && 12534df98e76SHannes Frederic Sowa (sk->sk_protocol == IPPROTO_UDP || 12544df98e76SHannes Frederic Sowa sk->sk_protocol == IPPROTO_RAW)) { 12554df98e76SHannes Frederic Sowa ipv6_local_rxpmtu(sk, fl6, mtu - headersize + 12564df98e76SHannes Frederic Sowa sizeof(struct ipv6hdr)); 12574df98e76SHannes Frederic Sowa goto emsgsize; 12584df98e76SHannes Frederic Sowa } 12594df98e76SHannes Frederic Sowa 12604df98e76SHannes Frederic Sowa if (cork->length + length > maxnonfragsize - headersize) { 12614df98e76SHannes Frederic Sowa emsgsize: 12624df98e76SHannes Frederic Sowa ipv6_local_error(sk, EMSGSIZE, fl6, 12634df98e76SHannes Frederic Sowa mtu - headersize + 12644df98e76SHannes Frederic Sowa sizeof(struct ipv6hdr)); 12651da177e4SLinus Torvalds return -EMSGSIZE; 12661da177e4SLinus Torvalds } 12671da177e4SLinus Torvalds } 12681da177e4SLinus Torvalds 126909c2d251SWillem de Bruijn if (sk->sk_type == SOCK_DGRAM || sk->sk_type == SOCK_RAW) { 1270bf84a010SDaniel Borkmann sock_tx_timestamp(sk, &tx_flags); 127109c2d251SWillem de Bruijn if (tx_flags & SKBTX_ANY_SW_TSTAMP && 127209c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 127309c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 127409c2d251SWillem de Bruijn } 1275a693e698SAnders Berggren 12761da177e4SLinus Torvalds /* 12771da177e4SLinus Torvalds * Let's try using as much space as possible. 12781da177e4SLinus Torvalds * Use MTU if total length of the message fits into the MTU. 12791da177e4SLinus Torvalds * Otherwise, we need to reserve fragment header and 12801da177e4SLinus Torvalds * fragment alignment (= 8-15 octects, in total). 12811da177e4SLinus Torvalds * 12821da177e4SLinus Torvalds * Note that we may need to "move" the data from the tail of 12831da177e4SLinus Torvalds * of the buffer to the new fragment when we split 12841da177e4SLinus Torvalds * the message. 12851da177e4SLinus Torvalds * 12861da177e4SLinus Torvalds * FIXME: It may be fragmented into multiple chunks 12871da177e4SLinus Torvalds * at once if non-fragmentable extension headers 12881da177e4SLinus Torvalds * are too large. 12891da177e4SLinus Torvalds * --yoshfuji 12901da177e4SLinus Torvalds */ 12911da177e4SLinus Torvalds 12922811ebacSHannes Frederic Sowa skb = skb_peek_tail(&sk->sk_write_queue); 12932811ebacSHannes Frederic Sowa cork->length += length; 12942811ebacSHannes Frederic Sowa if (((length > mtu) || 12952811ebacSHannes Frederic Sowa (skb && skb_is_gso(skb))) && 12962811ebacSHannes Frederic Sowa (sk->sk_protocol == IPPROTO_UDP) && 1297d8d1f30bSChangli Gao (rt->dst.dev->features & NETIF_F_UFO)) { 12984b340ae2SBrian Haley err = ip6_ufo_append_data(sk, getfrag, from, length, 12994b340ae2SBrian Haley hh_len, fragheaderlen, 130087c48fa3SEric Dumazet transhdrlen, mtu, flags, rt); 1301baa829d8SPatrick McHardy if (err) 1302e89e9cf5SAnanda Raju goto error; 1303e89e9cf5SAnanda Raju return 0; 1304e89e9cf5SAnanda Raju } 13051da177e4SLinus Torvalds 13062811ebacSHannes Frederic Sowa if (!skb) 13071da177e4SLinus Torvalds goto alloc_new_skb; 13081da177e4SLinus Torvalds 13091da177e4SLinus Torvalds while (length > 0) { 13101da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 1311bdc712b4SDavid S. Miller copy = (cork->length <= mtu && !(cork->flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - skb->len; 13121da177e4SLinus Torvalds if (copy < length) 13131da177e4SLinus Torvalds copy = maxfraglen - skb->len; 13141da177e4SLinus Torvalds 13151da177e4SLinus Torvalds if (copy <= 0) { 13161da177e4SLinus Torvalds char *data; 13171da177e4SLinus Torvalds unsigned int datalen; 13181da177e4SLinus Torvalds unsigned int fraglen; 13191da177e4SLinus Torvalds unsigned int fraggap; 13201da177e4SLinus Torvalds unsigned int alloclen; 13211da177e4SLinus Torvalds alloc_new_skb: 13221da177e4SLinus Torvalds /* There's no room in the current skb */ 13230c183379SGao feng if (skb) 13240c183379SGao feng fraggap = skb->len - maxfraglen; 13251da177e4SLinus Torvalds else 13261da177e4SLinus Torvalds fraggap = 0; 13270c183379SGao feng /* update mtu and maxfraglen if necessary */ 13280c183379SGao feng if (skb == NULL || skb_prev == NULL) 13290c183379SGao feng ip6_append_data_mtu(&mtu, &maxfraglen, 133075a493e6SHannes Frederic Sowa fragheaderlen, skb, rt, 1331e367c2d0Slucien orig_mtu); 13320c183379SGao feng 13330c183379SGao feng skb_prev = skb; 13341da177e4SLinus Torvalds 13351da177e4SLinus Torvalds /* 13361da177e4SLinus Torvalds * If remaining data exceeds the mtu, 13371da177e4SLinus Torvalds * we know we need more fragment(s). 13381da177e4SLinus Torvalds */ 13391da177e4SLinus Torvalds datalen = length + fraggap; 13401da177e4SLinus Torvalds 13410c183379SGao feng if (datalen > (cork->length <= mtu && !(cork->flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - fragheaderlen) 13420c183379SGao feng datalen = maxfraglen - fragheaderlen - rt->dst.trailer_len; 13431da177e4SLinus Torvalds if ((flags & MSG_MORE) && 1344d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 13451da177e4SLinus Torvalds alloclen = mtu; 13461da177e4SLinus Torvalds else 13471da177e4SLinus Torvalds alloclen = datalen + fragheaderlen; 13481da177e4SLinus Torvalds 1349299b0767SSteffen Klassert alloclen += dst_exthdrlen; 1350299b0767SSteffen Klassert 13510c183379SGao feng if (datalen != length + fraggap) { 13521da177e4SLinus Torvalds /* 13530c183379SGao feng * this is not the last fragment, the trailer 13540c183379SGao feng * space is regarded as data space. 13551da177e4SLinus Torvalds */ 13560c183379SGao feng datalen += rt->dst.trailer_len; 13570c183379SGao feng } 13580c183379SGao feng 1359d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 13600c183379SGao feng fraglen = datalen + fragheaderlen; 13611da177e4SLinus Torvalds 13621da177e4SLinus Torvalds /* 13631da177e4SLinus Torvalds * We just reserve space for fragment header. 13641da177e4SLinus Torvalds * Note: this may be overallocation if the message 13651da177e4SLinus Torvalds * (without MSG_MORE) fits into the MTU. 13661da177e4SLinus Torvalds */ 13671da177e4SLinus Torvalds alloclen += sizeof(struct frag_hdr); 13681da177e4SLinus Torvalds 13691da177e4SLinus Torvalds if (transhdrlen) { 13701da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 13711da177e4SLinus Torvalds alloclen + hh_len, 13721da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 13731da177e4SLinus Torvalds } else { 13741da177e4SLinus Torvalds skb = NULL; 13751da177e4SLinus Torvalds if (atomic_read(&sk->sk_wmem_alloc) <= 13761da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 13771da177e4SLinus Torvalds skb = sock_wmalloc(sk, 13781da177e4SLinus Torvalds alloclen + hh_len, 1, 13791da177e4SLinus Torvalds sk->sk_allocation); 13801da177e4SLinus Torvalds if (unlikely(skb == NULL)) 13811da177e4SLinus Torvalds err = -ENOBUFS; 13821da177e4SLinus Torvalds } 13831da177e4SLinus Torvalds if (skb == NULL) 13841da177e4SLinus Torvalds goto error; 13851da177e4SLinus Torvalds /* 13861da177e4SLinus Torvalds * Fill in the control structures 13871da177e4SLinus Torvalds */ 13889c9c9ad5SHannes Frederic Sowa skb->protocol = htons(ETH_P_IPV6); 1389d7f7c0acSEric Dumazet skb->ip_summed = CHECKSUM_NONE; 13901da177e4SLinus Torvalds skb->csum = 0; 13911f85851eSGao feng /* reserve for fragmentation and ipsec header */ 13921f85851eSGao feng skb_reserve(skb, hh_len + sizeof(struct frag_hdr) + 13931f85851eSGao feng dst_exthdrlen); 13941da177e4SLinus Torvalds 139511878b40SWillem de Bruijn /* Only the initial fragment is time stamped */ 1396a693e698SAnders Berggren skb_shinfo(skb)->tx_flags = tx_flags; 139711878b40SWillem de Bruijn tx_flags = 0; 139809c2d251SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 139909c2d251SWillem de Bruijn tskey = 0; 1400a693e698SAnders Berggren 14011da177e4SLinus Torvalds /* 14021da177e4SLinus Torvalds * Find where to start putting bytes 14031da177e4SLinus Torvalds */ 14041f85851eSGao feng data = skb_put(skb, fraglen); 14051f85851eSGao feng skb_set_network_header(skb, exthdrlen); 14061f85851eSGao feng data += fragheaderlen; 1407b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1408b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 14091da177e4SLinus Torvalds if (fraggap) { 14101da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 14111da177e4SLinus Torvalds skb_prev, maxfraglen, 14121da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 14131da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 14141da177e4SLinus Torvalds skb->csum); 14151da177e4SLinus Torvalds data += fraggap; 1416e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 14171da177e4SLinus Torvalds } 14181da177e4SLinus Torvalds copy = datalen - transhdrlen - fraggap; 1419299b0767SSteffen Klassert 14201da177e4SLinus Torvalds if (copy < 0) { 14211da177e4SLinus Torvalds err = -EINVAL; 14221da177e4SLinus Torvalds kfree_skb(skb); 14231da177e4SLinus Torvalds goto error; 14241da177e4SLinus Torvalds } else if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 14251da177e4SLinus Torvalds err = -EFAULT; 14261da177e4SLinus Torvalds kfree_skb(skb); 14271da177e4SLinus Torvalds goto error; 14281da177e4SLinus Torvalds } 14291da177e4SLinus Torvalds 14301da177e4SLinus Torvalds offset += copy; 14311da177e4SLinus Torvalds length -= datalen - fraggap; 14321da177e4SLinus Torvalds transhdrlen = 0; 14331da177e4SLinus Torvalds exthdrlen = 0; 1434299b0767SSteffen Klassert dst_exthdrlen = 0; 14351da177e4SLinus Torvalds 14361da177e4SLinus Torvalds /* 14371da177e4SLinus Torvalds * Put the packet on the pending queue 14381da177e4SLinus Torvalds */ 14391da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 14401da177e4SLinus Torvalds continue; 14411da177e4SLinus Torvalds } 14421da177e4SLinus Torvalds 14431da177e4SLinus Torvalds if (copy > length) 14441da177e4SLinus Torvalds copy = length; 14451da177e4SLinus Torvalds 1446d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) { 14471da177e4SLinus Torvalds unsigned int off; 14481da177e4SLinus Torvalds 14491da177e4SLinus Torvalds off = skb->len; 14501da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 14511da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 14521da177e4SLinus Torvalds __skb_trim(skb, off); 14531da177e4SLinus Torvalds err = -EFAULT; 14541da177e4SLinus Torvalds goto error; 14551da177e4SLinus Torvalds } 14561da177e4SLinus Torvalds } else { 14571da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 14585640f768SEric Dumazet struct page_frag *pfrag = sk_page_frag(sk); 14591da177e4SLinus Torvalds 14601da177e4SLinus Torvalds err = -ENOMEM; 14615640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 14621da177e4SLinus Torvalds goto error; 14631da177e4SLinus Torvalds 14645640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 14655640f768SEric Dumazet pfrag->offset)) { 14661da177e4SLinus Torvalds err = -EMSGSIZE; 14675640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 14681da177e4SLinus Torvalds goto error; 14695640f768SEric Dumazet 14705640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 14715640f768SEric Dumazet pfrag->offset, 0); 14725640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 14735640f768SEric Dumazet get_page(pfrag->page); 14741da177e4SLinus Torvalds } 14755640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 14769e903e08SEric Dumazet if (getfrag(from, 14775640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 14785640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 14795640f768SEric Dumazet goto error_efault; 14805640f768SEric Dumazet 14815640f768SEric Dumazet pfrag->offset += copy; 14825640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 14831da177e4SLinus Torvalds skb->len += copy; 14841da177e4SLinus Torvalds skb->data_len += copy; 1485f945fa7aSHerbert Xu skb->truesize += copy; 1486f945fa7aSHerbert Xu atomic_add(copy, &sk->sk_wmem_alloc); 14871da177e4SLinus Torvalds } 14881da177e4SLinus Torvalds offset += copy; 14891da177e4SLinus Torvalds length -= copy; 14901da177e4SLinus Torvalds } 14915640f768SEric Dumazet 14921da177e4SLinus Torvalds return 0; 14935640f768SEric Dumazet 14945640f768SEric Dumazet error_efault: 14955640f768SEric Dumazet err = -EFAULT; 14961da177e4SLinus Torvalds error: 1497bdc712b4SDavid S. Miller cork->length -= length; 14983bd653c8SDenis V. Lunev IP6_INC_STATS(sock_net(sk), rt->rt6i_idev, IPSTATS_MIB_OUTDISCARDS); 14991da177e4SLinus Torvalds return err; 15001da177e4SLinus Torvalds } 1501a495f836SChris Elston EXPORT_SYMBOL_GPL(ip6_append_data); 15021da177e4SLinus Torvalds 1503bf138862SPavel Emelyanov static void ip6_cork_release(struct inet_sock *inet, struct ipv6_pinfo *np) 1504bf138862SPavel Emelyanov { 15050178b695SHerbert Xu if (np->cork.opt) { 15060178b695SHerbert Xu kfree(np->cork.opt->dst0opt); 15070178b695SHerbert Xu kfree(np->cork.opt->dst1opt); 15080178b695SHerbert Xu kfree(np->cork.opt->hopopt); 15090178b695SHerbert Xu kfree(np->cork.opt->srcrt); 1510bf138862SPavel Emelyanov kfree(np->cork.opt); 1511bf138862SPavel Emelyanov np->cork.opt = NULL; 15120178b695SHerbert Xu } 15130178b695SHerbert Xu 1514bdc712b4SDavid S. Miller if (inet->cork.base.dst) { 1515bdc712b4SDavid S. Miller dst_release(inet->cork.base.dst); 1516bdc712b4SDavid S. Miller inet->cork.base.dst = NULL; 1517bdc712b4SDavid S. Miller inet->cork.base.flags &= ~IPCORK_ALLFRAG; 1518bf138862SPavel Emelyanov } 1519bf138862SPavel Emelyanov memset(&inet->cork.fl, 0, sizeof(inet->cork.fl)); 1520bf138862SPavel Emelyanov } 1521bf138862SPavel Emelyanov 15221da177e4SLinus Torvalds int ip6_push_pending_frames(struct sock *sk) 15231da177e4SLinus Torvalds { 15241da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 15251da177e4SLinus Torvalds struct sk_buff **tail_skb; 15261da177e4SLinus Torvalds struct in6_addr final_dst_buf, *final_dst = &final_dst_buf; 15271da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 15281da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 15293bd653c8SDenis V. Lunev struct net *net = sock_net(sk); 15301da177e4SLinus Torvalds struct ipv6hdr *hdr; 15311da177e4SLinus Torvalds struct ipv6_txoptions *opt = np->cork.opt; 1532bdc712b4SDavid S. Miller struct rt6_info *rt = (struct rt6_info *)inet->cork.base.dst; 15334c9483b2SDavid S. Miller struct flowi6 *fl6 = &inet->cork.fl.u.ip6; 15344c9483b2SDavid S. Miller unsigned char proto = fl6->flowi6_proto; 15351da177e4SLinus Torvalds int err = 0; 15361da177e4SLinus Torvalds 15371da177e4SLinus Torvalds if ((skb = __skb_dequeue(&sk->sk_write_queue)) == NULL) 15381da177e4SLinus Torvalds goto out; 15391da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 15401da177e4SLinus Torvalds 15411da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1542d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1543bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 15441da177e4SLinus Torvalds while ((tmp_skb = __skb_dequeue(&sk->sk_write_queue)) != NULL) { 1545cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 15461da177e4SLinus Torvalds *tail_skb = tmp_skb; 15471da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 15481da177e4SLinus Torvalds skb->len += tmp_skb->len; 15491da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 15501da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 15511da177e4SLinus Torvalds tmp_skb->destructor = NULL; 15521da177e4SLinus Torvalds tmp_skb->sk = NULL; 15531da177e4SLinus Torvalds } 15541da177e4SLinus Torvalds 155528a89453SHerbert Xu /* Allow local fragmentation. */ 155660ff7467SWANG Cong skb->ignore_df = ip6_sk_ignore_df(sk); 155728a89453SHerbert Xu 15584e3fd7a0SAlexey Dobriyan *final_dst = fl6->daddr; 1559cfe1fc77SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_header_len(skb)); 15601da177e4SLinus Torvalds if (opt && opt->opt_flen) 15611da177e4SLinus Torvalds ipv6_push_frag_opts(skb, opt, &proto); 15621da177e4SLinus Torvalds if (opt && opt->opt_nflen) 15631da177e4SLinus Torvalds ipv6_push_nfrag_opts(skb, opt, &proto, &final_dst); 15641da177e4SLinus Torvalds 1565e2d1bca7SArnaldo Carvalho de Melo skb_push(skb, sizeof(struct ipv6hdr)); 1566e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(skb); 15670660e03fSArnaldo Carvalho de Melo hdr = ipv6_hdr(skb); 15681da177e4SLinus Torvalds 1569cb1ce2efSTom Herbert ip6_flow_hdr(hdr, np->cork.tclass, 1570cb1ce2efSTom Herbert ip6_make_flowlabel(net, skb, fl6->flowlabel, 1571cb1ce2efSTom Herbert np->autoflowlabel)); 15721da177e4SLinus Torvalds hdr->hop_limit = np->cork.hop_limit; 15731da177e4SLinus Torvalds hdr->nexthdr = proto; 15744e3fd7a0SAlexey Dobriyan hdr->saddr = fl6->saddr; 15754e3fd7a0SAlexey Dobriyan hdr->daddr = *final_dst; 15761da177e4SLinus Torvalds 1577a2c2064fSPatrick McHardy skb->priority = sk->sk_priority; 15784a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1579a2c2064fSPatrick McHardy 1580d8d1f30bSChangli Gao skb_dst_set(skb, dst_clone(&rt->dst)); 1581edf391ffSNeil Horman IP6_UPD_PO_STATS(net, rt->rt6i_idev, IPSTATS_MIB_OUT, skb->len); 158214878f75SDavid L Stevens if (proto == IPPROTO_ICMPV6) { 1583adf30907SEric Dumazet struct inet6_dev *idev = ip6_dst_idev(skb_dst(skb)); 158414878f75SDavid L Stevens 158543a43b60SHannes Frederic Sowa ICMP6MSGOUT_INC_STATS(net, idev, icmp6_hdr(skb)->icmp6_type); 158643a43b60SHannes Frederic Sowa ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTMSGS); 158714878f75SDavid L Stevens } 158814878f75SDavid L Stevens 1589ef76bc23SHerbert Xu err = ip6_local_out(skb); 15901da177e4SLinus Torvalds if (err) { 15911da177e4SLinus Torvalds if (err > 0) 15926ce9e7b5SEric Dumazet err = net_xmit_errno(err); 15931da177e4SLinus Torvalds if (err) 15941da177e4SLinus Torvalds goto error; 15951da177e4SLinus Torvalds } 15961da177e4SLinus Torvalds 15971da177e4SLinus Torvalds out: 1598bf138862SPavel Emelyanov ip6_cork_release(inet, np); 15991da177e4SLinus Torvalds return err; 16001da177e4SLinus Torvalds error: 160106254914SEric Dumazet IP6_INC_STATS(net, rt->rt6i_idev, IPSTATS_MIB_OUTDISCARDS); 16021da177e4SLinus Torvalds goto out; 16031da177e4SLinus Torvalds } 1604a495f836SChris Elston EXPORT_SYMBOL_GPL(ip6_push_pending_frames); 16051da177e4SLinus Torvalds 16061da177e4SLinus Torvalds void ip6_flush_pending_frames(struct sock *sk) 16071da177e4SLinus Torvalds { 16081da177e4SLinus Torvalds struct sk_buff *skb; 16091da177e4SLinus Torvalds 16101da177e4SLinus Torvalds while ((skb = __skb_dequeue_tail(&sk->sk_write_queue)) != NULL) { 1611adf30907SEric Dumazet if (skb_dst(skb)) 1612adf30907SEric Dumazet IP6_INC_STATS(sock_net(sk), ip6_dst_idev(skb_dst(skb)), 1613a11d206dSYOSHIFUJI Hideaki IPSTATS_MIB_OUTDISCARDS); 16141da177e4SLinus Torvalds kfree_skb(skb); 16151da177e4SLinus Torvalds } 16161da177e4SLinus Torvalds 1617bf138862SPavel Emelyanov ip6_cork_release(inet_sk(sk), inet6_sk(sk)); 16181da177e4SLinus Torvalds } 1619a495f836SChris Elston EXPORT_SYMBOL_GPL(ip6_flush_pending_frames); 1620