11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * INET An implementation of the TCP/IP protocol suite for the LINUX 31da177e4SLinus Torvalds * operating system. INET is implemented using the BSD Socket 41da177e4SLinus Torvalds * interface as the means of communication with the user level. 51da177e4SLinus Torvalds * 61da177e4SLinus Torvalds * The Internet Protocol (IP) output module. 71da177e4SLinus Torvalds * 802c30a84SJesper Juhl * Authors: Ross Biro 91da177e4SLinus Torvalds * Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG> 101da177e4SLinus Torvalds * Donald Becker, <becker@super.org> 111da177e4SLinus Torvalds * Alan Cox, <Alan.Cox@linux.org> 121da177e4SLinus Torvalds * Richard Underwood 131da177e4SLinus Torvalds * Stefan Becker, <stefanb@yello.ping.de> 141da177e4SLinus Torvalds * Jorge Cwik, <jorge@laser.satlink.net> 151da177e4SLinus Torvalds * Arnt Gulbrandsen, <agulbra@nvg.unit.no> 161da177e4SLinus Torvalds * Hirokazu Takahashi, <taka@valinux.co.jp> 171da177e4SLinus Torvalds * 181da177e4SLinus Torvalds * See ip_input.c for original log 191da177e4SLinus Torvalds * 201da177e4SLinus Torvalds * Fixes: 211da177e4SLinus Torvalds * Alan Cox : Missing nonblock feature in ip_build_xmit. 221da177e4SLinus Torvalds * Mike Kilburn : htons() missing in ip_build_xmit. 231da177e4SLinus Torvalds * Bradford Johnson: Fix faulty handling of some frames when 241da177e4SLinus Torvalds * no route is found. 251da177e4SLinus Torvalds * Alexander Demenshin: Missing sk/skb free in ip_queue_xmit 261da177e4SLinus Torvalds * (in case if packet not accepted by 271da177e4SLinus Torvalds * output firewall rules) 281da177e4SLinus Torvalds * Mike McLagan : Routing by source 291da177e4SLinus Torvalds * Alexey Kuznetsov: use new route cache 301da177e4SLinus Torvalds * Andi Kleen: Fix broken PMTU recovery and remove 311da177e4SLinus Torvalds * some redundant tests. 321da177e4SLinus Torvalds * Vitaly E. Lavrov : Transparent proxy revived after year coma. 331da177e4SLinus Torvalds * Andi Kleen : Replace ip_reply with ip_send_reply. 341da177e4SLinus Torvalds * Andi Kleen : Split fast and slow ip_build_xmit path 351da177e4SLinus Torvalds * for decreased register pressure on x86 361da177e4SLinus Torvalds * and more readibility. 371da177e4SLinus Torvalds * Marc Boucher : When call_out_firewall returns FW_QUEUE, 381da177e4SLinus Torvalds * silently drop skb instead of failing with -EPERM. 391da177e4SLinus Torvalds * Detlev Wengorz : Copy protocol for fragments. 401da177e4SLinus Torvalds * Hirokazu Takahashi: HW checksumming for outgoing UDP 411da177e4SLinus Torvalds * datagrams. 421da177e4SLinus Torvalds * Hirokazu Takahashi: sendfile() on UDP works now. 431da177e4SLinus Torvalds */ 441da177e4SLinus Torvalds 451da177e4SLinus Torvalds #include <asm/uaccess.h> 461da177e4SLinus Torvalds #include <linux/module.h> 471da177e4SLinus Torvalds #include <linux/types.h> 481da177e4SLinus Torvalds #include <linux/kernel.h> 491da177e4SLinus Torvalds #include <linux/mm.h> 501da177e4SLinus Torvalds #include <linux/string.h> 511da177e4SLinus Torvalds #include <linux/errno.h> 52a1f8e7f7SAl Viro #include <linux/highmem.h> 535a0e3ad6STejun Heo #include <linux/slab.h> 541da177e4SLinus Torvalds 551da177e4SLinus Torvalds #include <linux/socket.h> 561da177e4SLinus Torvalds #include <linux/sockios.h> 571da177e4SLinus Torvalds #include <linux/in.h> 581da177e4SLinus Torvalds #include <linux/inet.h> 591da177e4SLinus Torvalds #include <linux/netdevice.h> 601da177e4SLinus Torvalds #include <linux/etherdevice.h> 611da177e4SLinus Torvalds #include <linux/proc_fs.h> 621da177e4SLinus Torvalds #include <linux/stat.h> 631da177e4SLinus Torvalds #include <linux/init.h> 641da177e4SLinus Torvalds 651da177e4SLinus Torvalds #include <net/snmp.h> 661da177e4SLinus Torvalds #include <net/ip.h> 671da177e4SLinus Torvalds #include <net/protocol.h> 681da177e4SLinus Torvalds #include <net/route.h> 69cfacb057SPatrick McHardy #include <net/xfrm.h> 701da177e4SLinus Torvalds #include <linux/skbuff.h> 711da177e4SLinus Torvalds #include <net/sock.h> 721da177e4SLinus Torvalds #include <net/arp.h> 731da177e4SLinus Torvalds #include <net/icmp.h> 741da177e4SLinus Torvalds #include <net/checksum.h> 751da177e4SLinus Torvalds #include <net/inetpeer.h> 761da177e4SLinus Torvalds #include <linux/igmp.h> 771da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h> 781da177e4SLinus Torvalds #include <linux/netfilter_bridge.h> 791da177e4SLinus Torvalds #include <linux/mroute.h> 801da177e4SLinus Torvalds #include <linux/netlink.h> 816cbb0df7SArnaldo Carvalho de Melo #include <linux/tcp.h> 821da177e4SLinus Torvalds 83ab32ea5dSBrian Haley int sysctl_ip_default_ttl __read_mostly = IPDEFTTL; 84323e126fSDavid S. Miller EXPORT_SYMBOL(sysctl_ip_default_ttl); 851da177e4SLinus Torvalds 861da177e4SLinus Torvalds /* Generate a checksum for an outgoing IP datagram. */ 872fbd9679SDenis Efremov void ip_send_check(struct iphdr *iph) 881da177e4SLinus Torvalds { 891da177e4SLinus Torvalds iph->check = 0; 901da177e4SLinus Torvalds iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl); 911da177e4SLinus Torvalds } 924bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_send_check); 931da177e4SLinus Torvalds 94*7026b1ddSDavid Miller int __ip_local_out_sk(struct sock *sk, struct sk_buff *skb) 95c439cb2eSHerbert Xu { 96c439cb2eSHerbert Xu struct iphdr *iph = ip_hdr(skb); 97c439cb2eSHerbert Xu 98c439cb2eSHerbert Xu iph->tot_len = htons(skb->len); 99c439cb2eSHerbert Xu ip_send_check(iph); 100*7026b1ddSDavid Miller return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT, sk, skb, NULL, 101*7026b1ddSDavid Miller skb_dst(skb)->dev, dst_output_sk); 102*7026b1ddSDavid Miller } 103*7026b1ddSDavid Miller 104*7026b1ddSDavid Miller int __ip_local_out(struct sk_buff *skb) 105*7026b1ddSDavid Miller { 106*7026b1ddSDavid Miller return __ip_local_out_sk(skb->sk, skb); 107c439cb2eSHerbert Xu } 108c439cb2eSHerbert Xu 109aad88724SEric Dumazet int ip_local_out_sk(struct sock *sk, struct sk_buff *skb) 110c439cb2eSHerbert Xu { 111c439cb2eSHerbert Xu int err; 112c439cb2eSHerbert Xu 113c439cb2eSHerbert Xu err = __ip_local_out(skb); 114c439cb2eSHerbert Xu if (likely(err == 1)) 115aad88724SEric Dumazet err = dst_output_sk(sk, skb); 116c439cb2eSHerbert Xu 117c439cb2eSHerbert Xu return err; 118c439cb2eSHerbert Xu } 119aad88724SEric Dumazet EXPORT_SYMBOL_GPL(ip_local_out_sk); 120c439cb2eSHerbert Xu 1211da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst) 1221da177e4SLinus Torvalds { 1231da177e4SLinus Torvalds int ttl = inet->uc_ttl; 1241da177e4SLinus Torvalds 1251da177e4SLinus Torvalds if (ttl < 0) 126323e126fSDavid S. Miller ttl = ip4_dst_hoplimit(dst); 1271da177e4SLinus Torvalds return ttl; 1281da177e4SLinus Torvalds } 1291da177e4SLinus Torvalds 1301da177e4SLinus Torvalds /* 1311da177e4SLinus Torvalds * Add an ip header to a skbuff and send it out. 1321da177e4SLinus Torvalds * 1331da177e4SLinus Torvalds */ 1341da177e4SLinus Torvalds int ip_build_and_send_pkt(struct sk_buff *skb, struct sock *sk, 135f6d8bd05SEric Dumazet __be32 saddr, __be32 daddr, struct ip_options_rcu *opt) 1361da177e4SLinus Torvalds { 1371da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 138511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1391da177e4SLinus Torvalds struct iphdr *iph; 1401da177e4SLinus Torvalds 1411da177e4SLinus Torvalds /* Build the IP header. */ 142f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (opt ? opt->opt.optlen : 0)); 1438856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 144eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 1451da177e4SLinus Torvalds iph->version = 4; 1461da177e4SLinus Torvalds iph->ihl = 5; 1471da177e4SLinus Torvalds iph->tos = inet->tos; 148d8d1f30bSChangli Gao if (ip_dont_fragment(sk, &rt->dst)) 1491da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 1501da177e4SLinus Torvalds else 1511da177e4SLinus Torvalds iph->frag_off = 0; 152d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 153dd927a26SDavid S. Miller iph->daddr = (opt && opt->opt.srr ? opt->opt.faddr : daddr); 154dd927a26SDavid S. Miller iph->saddr = saddr; 1551da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 156b6a7719aSHannes Frederic Sowa ip_select_ident(sock_net(sk), skb, sk); 1571da177e4SLinus Torvalds 158f6d8bd05SEric Dumazet if (opt && opt->opt.optlen) { 159f6d8bd05SEric Dumazet iph->ihl += opt->opt.optlen>>2; 160f6d8bd05SEric Dumazet ip_options_build(skb, &opt->opt, daddr, rt, 0); 1611da177e4SLinus Torvalds } 1621da177e4SLinus Torvalds 1631da177e4SLinus Torvalds skb->priority = sk->sk_priority; 1644a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1651da177e4SLinus Torvalds 1661da177e4SLinus Torvalds /* Send it out. */ 167c439cb2eSHerbert Xu return ip_local_out(skb); 1681da177e4SLinus Torvalds } 169d8c97a94SArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip_build_and_send_pkt); 170d8c97a94SArnaldo Carvalho de Melo 171*7026b1ddSDavid Miller static inline int ip_finish_output2(struct sock *sk, struct sk_buff *skb) 1721da177e4SLinus Torvalds { 173adf30907SEric Dumazet struct dst_entry *dst = skb_dst(skb); 17480787ebcSMitsuru Chinen struct rtable *rt = (struct rtable *)dst; 1751da177e4SLinus Torvalds struct net_device *dev = dst->dev; 176c2636b4dSChuck Lever unsigned int hh_len = LL_RESERVED_SPACE(dev); 177f6b72b62SDavid S. Miller struct neighbour *neigh; 178a263b309SDavid S. Miller u32 nexthop; 1791da177e4SLinus Torvalds 180edf391ffSNeil Horman if (rt->rt_type == RTN_MULTICAST) { 181edf391ffSNeil Horman IP_UPD_PO_STATS(dev_net(dev), IPSTATS_MIB_OUTMCAST, skb->len); 182edf391ffSNeil Horman } else if (rt->rt_type == RTN_BROADCAST) 183edf391ffSNeil Horman IP_UPD_PO_STATS(dev_net(dev), IPSTATS_MIB_OUTBCAST, skb->len); 18480787ebcSMitsuru Chinen 1851da177e4SLinus Torvalds /* Be paranoid, rather than too clever. */ 1863b04dddeSStephen Hemminger if (unlikely(skb_headroom(skb) < hh_len && dev->header_ops)) { 1871da177e4SLinus Torvalds struct sk_buff *skb2; 1881da177e4SLinus Torvalds 1891da177e4SLinus Torvalds skb2 = skb_realloc_headroom(skb, LL_RESERVED_SPACE(dev)); 19051456b29SIan Morris if (!skb2) { 1911da177e4SLinus Torvalds kfree_skb(skb); 1921da177e4SLinus Torvalds return -ENOMEM; 1931da177e4SLinus Torvalds } 1941da177e4SLinus Torvalds if (skb->sk) 1951da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 1965d0ba55bSEric Dumazet consume_skb(skb); 1971da177e4SLinus Torvalds skb = skb2; 1981da177e4SLinus Torvalds } 1991da177e4SLinus Torvalds 200a263b309SDavid S. Miller rcu_read_lock_bh(); 201155e8336SJulian Anastasov nexthop = (__force u32) rt_nexthop(rt, ip_hdr(skb)->daddr); 202a263b309SDavid S. Miller neigh = __ipv4_neigh_lookup_noref(dev, nexthop); 203a263b309SDavid S. Miller if (unlikely(!neigh)) 204a263b309SDavid S. Miller neigh = __neigh_create(&arp_tbl, &nexthop, dev, false); 2059871f1adSVasiliy Kulikov if (!IS_ERR(neigh)) { 2065110effeSDavid S. Miller int res = dst_neigh_output(dst, neigh, skb); 207f2c31e32SEric Dumazet 208a263b309SDavid S. Miller rcu_read_unlock_bh(); 209f2c31e32SEric Dumazet return res; 210f2c31e32SEric Dumazet } 211a263b309SDavid S. Miller rcu_read_unlock_bh(); 21205e3aa09SDavid S. Miller 213e87cc472SJoe Perches net_dbg_ratelimited("%s: No header cache and no neighbour!\n", 214e87cc472SJoe Perches __func__); 2151da177e4SLinus Torvalds kfree_skb(skb); 2161da177e4SLinus Torvalds return -EINVAL; 2171da177e4SLinus Torvalds } 2181da177e4SLinus Torvalds 219*7026b1ddSDavid Miller static int ip_finish_output_gso(struct sock *sk, struct sk_buff *skb) 220c7ba65d7SFlorian Westphal { 221c7ba65d7SFlorian Westphal netdev_features_t features; 222c7ba65d7SFlorian Westphal struct sk_buff *segs; 223c7ba65d7SFlorian Westphal int ret = 0; 224c7ba65d7SFlorian Westphal 225c7ba65d7SFlorian Westphal /* common case: locally created skb or seglen is <= mtu */ 226c7ba65d7SFlorian Westphal if (((IPCB(skb)->flags & IPSKB_FORWARDED) == 0) || 227c7ba65d7SFlorian Westphal skb_gso_network_seglen(skb) <= ip_skb_dst_mtu(skb)) 228*7026b1ddSDavid Miller return ip_finish_output2(sk, skb); 229c7ba65d7SFlorian Westphal 230c7ba65d7SFlorian Westphal /* Slowpath - GSO segment length is exceeding the dst MTU. 231c7ba65d7SFlorian Westphal * 232c7ba65d7SFlorian Westphal * This can happen in two cases: 233c7ba65d7SFlorian Westphal * 1) TCP GRO packet, DF bit not set 234c7ba65d7SFlorian Westphal * 2) skb arrived via virtio-net, we thus get TSO/GSO skbs directly 235c7ba65d7SFlorian Westphal * from host network stack. 236c7ba65d7SFlorian Westphal */ 237c7ba65d7SFlorian Westphal features = netif_skb_features(skb); 238c7ba65d7SFlorian Westphal segs = skb_gso_segment(skb, features & ~NETIF_F_GSO_MASK); 239330966e5SFlorian Westphal if (IS_ERR_OR_NULL(segs)) { 240c7ba65d7SFlorian Westphal kfree_skb(skb); 241c7ba65d7SFlorian Westphal return -ENOMEM; 242c7ba65d7SFlorian Westphal } 243c7ba65d7SFlorian Westphal 244c7ba65d7SFlorian Westphal consume_skb(skb); 245c7ba65d7SFlorian Westphal 246c7ba65d7SFlorian Westphal do { 247c7ba65d7SFlorian Westphal struct sk_buff *nskb = segs->next; 248c7ba65d7SFlorian Westphal int err; 249c7ba65d7SFlorian Westphal 250c7ba65d7SFlorian Westphal segs->next = NULL; 251*7026b1ddSDavid Miller err = ip_fragment(sk, segs, ip_finish_output2); 252c7ba65d7SFlorian Westphal 253c7ba65d7SFlorian Westphal if (err && ret == 0) 254c7ba65d7SFlorian Westphal ret = err; 255c7ba65d7SFlorian Westphal segs = nskb; 256c7ba65d7SFlorian Westphal } while (segs); 257c7ba65d7SFlorian Westphal 258c7ba65d7SFlorian Westphal return ret; 259c7ba65d7SFlorian Westphal } 260c7ba65d7SFlorian Westphal 261*7026b1ddSDavid Miller static int ip_finish_output(struct sock *sk, struct sk_buff *skb) 2621da177e4SLinus Torvalds { 2635c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM) 2645c901daaSPatrick McHardy /* Policy lookup after SNAT yielded a new policy */ 26500db4124SIan Morris if (skb_dst(skb)->xfrm) { 26648d5cad8SPatrick McHardy IPCB(skb)->flags |= IPSKB_REROUTED; 267*7026b1ddSDavid Miller return dst_output_sk(sk, skb); 26848d5cad8SPatrick McHardy } 2695c901daaSPatrick McHardy #endif 270c7ba65d7SFlorian Westphal if (skb_is_gso(skb)) 271*7026b1ddSDavid Miller return ip_finish_output_gso(sk, skb); 272c7ba65d7SFlorian Westphal 273c7ba65d7SFlorian Westphal if (skb->len > ip_skb_dst_mtu(skb)) 274*7026b1ddSDavid Miller return ip_fragment(sk, skb, ip_finish_output2); 275c7ba65d7SFlorian Westphal 276*7026b1ddSDavid Miller return ip_finish_output2(sk, skb); 2771da177e4SLinus Torvalds } 2781da177e4SLinus Torvalds 279aad88724SEric Dumazet int ip_mc_output(struct sock *sk, struct sk_buff *skb) 2801da177e4SLinus Torvalds { 281511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 282d8d1f30bSChangli Gao struct net_device *dev = rt->dst.dev; 2831da177e4SLinus Torvalds 2841da177e4SLinus Torvalds /* 2851da177e4SLinus Torvalds * If the indicated interface is up and running, send the packet. 2861da177e4SLinus Torvalds */ 287edf391ffSNeil Horman IP_UPD_PO_STATS(dev_net(dev), IPSTATS_MIB_OUT, skb->len); 2881da177e4SLinus Torvalds 2891da177e4SLinus Torvalds skb->dev = dev; 2901da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 2911da177e4SLinus Torvalds 2921da177e4SLinus Torvalds /* 2931da177e4SLinus Torvalds * Multicasts are looped back for other local users 2941da177e4SLinus Torvalds */ 2951da177e4SLinus Torvalds 2961da177e4SLinus Torvalds if (rt->rt_flags&RTCF_MULTICAST) { 2977ad6848cSOctavian Purdila if (sk_mc_loop(sk) 2981da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 2991da177e4SLinus Torvalds /* Small optimization: do not loopback not local frames, 3001da177e4SLinus Torvalds which returned after forwarding; they will be dropped 3011da177e4SLinus Torvalds by ip_mr_input in any case. 3021da177e4SLinus Torvalds Note, that local frames are looped back to be delivered 3031da177e4SLinus Torvalds to local recipients. 3041da177e4SLinus Torvalds 3051da177e4SLinus Torvalds This check is duplicated in ip_mr_input at the moment. 3061da177e4SLinus Torvalds */ 3079d4fb27dSJoe Perches && 3089d4fb27dSJoe Perches ((rt->rt_flags & RTCF_LOCAL) || 3099d4fb27dSJoe Perches !(IPCB(skb)->flags & IPSKB_FORWARDED)) 3101da177e4SLinus Torvalds #endif 3111da177e4SLinus Torvalds ) { 3121da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3131da177e4SLinus Torvalds if (newskb) 3149bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 315*7026b1ddSDavid Miller sk, newskb, NULL, newskb->dev, 31695603e22SMichel Machado dev_loopback_xmit); 3171da177e4SLinus Torvalds } 3181da177e4SLinus Torvalds 3191da177e4SLinus Torvalds /* Multicasts with ttl 0 must not go beyond the host */ 3201da177e4SLinus Torvalds 321eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl == 0) { 3221da177e4SLinus Torvalds kfree_skb(skb); 3231da177e4SLinus Torvalds return 0; 3241da177e4SLinus Torvalds } 3251da177e4SLinus Torvalds } 3261da177e4SLinus Torvalds 3271da177e4SLinus Torvalds if (rt->rt_flags&RTCF_BROADCAST) { 3281da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3291da177e4SLinus Torvalds if (newskb) 330*7026b1ddSDavid Miller NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, sk, newskb, 33195603e22SMichel Machado NULL, newskb->dev, dev_loopback_xmit); 3321da177e4SLinus Torvalds } 3331da177e4SLinus Torvalds 334*7026b1ddSDavid Miller return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, sk, skb, NULL, 3359bbc768aSJan Engelhardt skb->dev, ip_finish_output, 33648d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 3371da177e4SLinus Torvalds } 3381da177e4SLinus Torvalds 339aad88724SEric Dumazet int ip_output(struct sock *sk, struct sk_buff *skb) 3401da177e4SLinus Torvalds { 341adf30907SEric Dumazet struct net_device *dev = skb_dst(skb)->dev; 3421bd9bef6SPatrick McHardy 343edf391ffSNeil Horman IP_UPD_PO_STATS(dev_net(dev), IPSTATS_MIB_OUT, skb->len); 3441da177e4SLinus Torvalds 3451bd9bef6SPatrick McHardy skb->dev = dev; 3461bd9bef6SPatrick McHardy skb->protocol = htons(ETH_P_IP); 3471bd9bef6SPatrick McHardy 348*7026b1ddSDavid Miller return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, sk, skb, 349*7026b1ddSDavid Miller NULL, dev, 35048d5cad8SPatrick McHardy ip_finish_output, 35148d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 3521da177e4SLinus Torvalds } 3531da177e4SLinus Torvalds 35484f9307cSEric Dumazet /* 35584f9307cSEric Dumazet * copy saddr and daddr, possibly using 64bit load/stores 35684f9307cSEric Dumazet * Equivalent to : 35784f9307cSEric Dumazet * iph->saddr = fl4->saddr; 35884f9307cSEric Dumazet * iph->daddr = fl4->daddr; 35984f9307cSEric Dumazet */ 36084f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4) 36184f9307cSEric Dumazet { 36284f9307cSEric Dumazet BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) != 36384f9307cSEric Dumazet offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr)); 36484f9307cSEric Dumazet memcpy(&iph->saddr, &fl4->saddr, 36584f9307cSEric Dumazet sizeof(fl4->saddr) + sizeof(fl4->daddr)); 36684f9307cSEric Dumazet } 36784f9307cSEric Dumazet 368b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */ 369b0270e91SEric Dumazet int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl) 3701da177e4SLinus Torvalds { 3711da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 372f6d8bd05SEric Dumazet struct ip_options_rcu *inet_opt; 373b57ae01aSDavid S. Miller struct flowi4 *fl4; 3741da177e4SLinus Torvalds struct rtable *rt; 3751da177e4SLinus Torvalds struct iphdr *iph; 376ab6e3febSEric Dumazet int res; 3771da177e4SLinus Torvalds 3781da177e4SLinus Torvalds /* Skip all of this if the packet is already routed, 3791da177e4SLinus Torvalds * f.e. by something like SCTP. 3801da177e4SLinus Torvalds */ 381ab6e3febSEric Dumazet rcu_read_lock(); 382f6d8bd05SEric Dumazet inet_opt = rcu_dereference(inet->inet_opt); 383ea4fc0d6SDavid S. Miller fl4 = &fl->u.ip4; 384511c3f92SEric Dumazet rt = skb_rtable(skb); 38500db4124SIan Morris if (rt) 3861da177e4SLinus Torvalds goto packet_routed; 3871da177e4SLinus Torvalds 3881da177e4SLinus Torvalds /* Make sure we can route this packet. */ 3891da177e4SLinus Torvalds rt = (struct rtable *)__sk_dst_check(sk, 0); 39051456b29SIan Morris if (!rt) { 3913ca3c68eSAl Viro __be32 daddr; 3921da177e4SLinus Torvalds 3931da177e4SLinus Torvalds /* Use correct destination address if we have options. */ 394c720c7e8SEric Dumazet daddr = inet->inet_daddr; 395f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.srr) 396f6d8bd05SEric Dumazet daddr = inet_opt->opt.faddr; 3971da177e4SLinus Torvalds 3981da177e4SLinus Torvalds /* If this fails, retransmit mechanism of transport layer will 3991da177e4SLinus Torvalds * keep trying until route appears or the connection times 4001da177e4SLinus Torvalds * itself out. 4011da177e4SLinus Torvalds */ 402b57ae01aSDavid S. Miller rt = ip_route_output_ports(sock_net(sk), fl4, sk, 40378fbfd8aSDavid S. Miller daddr, inet->inet_saddr, 40478fbfd8aSDavid S. Miller inet->inet_dport, 40578fbfd8aSDavid S. Miller inet->inet_sport, 40678fbfd8aSDavid S. Miller sk->sk_protocol, 40778fbfd8aSDavid S. Miller RT_CONN_FLAGS(sk), 40878fbfd8aSDavid S. Miller sk->sk_bound_dev_if); 409b23dd4feSDavid S. Miller if (IS_ERR(rt)) 4101da177e4SLinus Torvalds goto no_route; 411d8d1f30bSChangli Gao sk_setup_caps(sk, &rt->dst); 4121da177e4SLinus Torvalds } 413d8d1f30bSChangli Gao skb_dst_set_noref(skb, &rt->dst); 4141da177e4SLinus Torvalds 4151da177e4SLinus Torvalds packet_routed: 416155e8336SJulian Anastasov if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway) 4171da177e4SLinus Torvalds goto no_route; 4181da177e4SLinus Torvalds 4191da177e4SLinus Torvalds /* OK, we know where to send it, allocate and build IP header. */ 420f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0)); 4218856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 422eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 423714e85beSAl Viro *((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (inet->tos & 0xff)); 42460ff7467SWANG Cong if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df) 4251da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 4261da177e4SLinus Torvalds else 4271da177e4SLinus Torvalds iph->frag_off = 0; 428d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 4291da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 43084f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 43184f9307cSEric Dumazet 4321da177e4SLinus Torvalds /* Transport layer set skb->h.foo itself. */ 4331da177e4SLinus Torvalds 434f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.optlen) { 435f6d8bd05SEric Dumazet iph->ihl += inet_opt->opt.optlen >> 2; 436f6d8bd05SEric Dumazet ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0); 4371da177e4SLinus Torvalds } 4381da177e4SLinus Torvalds 439b6a7719aSHannes Frederic Sowa ip_select_ident_segs(sock_net(sk), skb, sk, 440b6a7719aSHannes Frederic Sowa skb_shinfo(skb)->gso_segs ?: 1); 4411da177e4SLinus Torvalds 442b0270e91SEric Dumazet /* TODO : should we use skb->sk here instead of sk ? */ 4431da177e4SLinus Torvalds skb->priority = sk->sk_priority; 4444a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 4451da177e4SLinus Torvalds 446ab6e3febSEric Dumazet res = ip_local_out(skb); 447ab6e3febSEric Dumazet rcu_read_unlock(); 448ab6e3febSEric Dumazet return res; 4491da177e4SLinus Torvalds 4501da177e4SLinus Torvalds no_route: 451ab6e3febSEric Dumazet rcu_read_unlock(); 4525e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTNOROUTES); 4531da177e4SLinus Torvalds kfree_skb(skb); 4541da177e4SLinus Torvalds return -EHOSTUNREACH; 4551da177e4SLinus Torvalds } 4564bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_queue_xmit); 4571da177e4SLinus Torvalds 4581da177e4SLinus Torvalds 4591da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from) 4601da177e4SLinus Torvalds { 4611da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 4621da177e4SLinus Torvalds to->priority = from->priority; 4631da177e4SLinus Torvalds to->protocol = from->protocol; 464adf30907SEric Dumazet skb_dst_drop(to); 465fe76cda3SEric Dumazet skb_dst_copy(to, from); 4661da177e4SLinus Torvalds to->dev = from->dev; 46782e91ffeSThomas Graf to->mark = from->mark; 4681da177e4SLinus Torvalds 4691da177e4SLinus Torvalds /* Copy the flags to each fragment. */ 4701da177e4SLinus Torvalds IPCB(to)->flags = IPCB(from)->flags; 4711da177e4SLinus Torvalds 4721da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 4731da177e4SLinus Torvalds to->tc_index = from->tc_index; 4741da177e4SLinus Torvalds #endif 475e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 476c98d80edSJulian Anastasov #if defined(CONFIG_IP_VS) || defined(CONFIG_IP_VS_MODULE) 477c98d80edSJulian Anastasov to->ipvs_property = from->ipvs_property; 478c98d80edSJulian Anastasov #endif 479984bc16cSJames Morris skb_copy_secmark(to, from); 4801da177e4SLinus Torvalds } 4811da177e4SLinus Torvalds 4821da177e4SLinus Torvalds /* 4831da177e4SLinus Torvalds * This IP datagram is too large to be sent in one piece. Break it up into 4841da177e4SLinus Torvalds * smaller pieces (each of size equal to IP header plus 4851da177e4SLinus Torvalds * a block of the data of the original IP data part) that will yet fit in a 4861da177e4SLinus Torvalds * single device frame, and queue such a frame for sending. 4871da177e4SLinus Torvalds */ 4881da177e4SLinus Torvalds 489*7026b1ddSDavid Miller int ip_fragment(struct sock *sk, struct sk_buff *skb, 490*7026b1ddSDavid Miller int (*output)(struct sock *, struct sk_buff *)) 4911da177e4SLinus Torvalds { 4921da177e4SLinus Torvalds struct iphdr *iph; 4931da177e4SLinus Torvalds int ptr; 4941da177e4SLinus Torvalds struct net_device *dev; 4951da177e4SLinus Torvalds struct sk_buff *skb2; 496c893b806SChangli Gao unsigned int mtu, hlen, left, len, ll_rs; 4971da177e4SLinus Torvalds int offset; 49876ab608dSAlexey Dobriyan __be16 not_last_frag; 499511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 5001da177e4SLinus Torvalds int err = 0; 5011da177e4SLinus Torvalds 502d8d1f30bSChangli Gao dev = rt->dst.dev; 5031da177e4SLinus Torvalds 5041da177e4SLinus Torvalds /* 5051da177e4SLinus Torvalds * Point into the IP datagram header. 5061da177e4SLinus Torvalds */ 5071da177e4SLinus Torvalds 508eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 5091da177e4SLinus Torvalds 51069647ce4SHannes Frederic Sowa mtu = ip_skb_dst_mtu(skb); 51160ff7467SWANG Cong if (unlikely(((iph->frag_off & htons(IP_DF)) && !skb->ignore_df) || 5125f2d04f1SPatrick McHardy (IPCB(skb)->frag_max_size && 513f87c10a8SHannes Frederic Sowa IPCB(skb)->frag_max_size > mtu))) { 5145e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGFAILS); 5151da177e4SLinus Torvalds icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, 516f87c10a8SHannes Frederic Sowa htonl(mtu)); 5171da177e4SLinus Torvalds kfree_skb(skb); 5181da177e4SLinus Torvalds return -EMSGSIZE; 5191da177e4SLinus Torvalds } 5201da177e4SLinus Torvalds 5211da177e4SLinus Torvalds /* 5221da177e4SLinus Torvalds * Setup starting values. 5231da177e4SLinus Torvalds */ 5241da177e4SLinus Torvalds 5251da177e4SLinus Torvalds hlen = iph->ihl * 4; 526f87c10a8SHannes Frederic Sowa mtu = mtu - hlen; /* Size of data space */ 5271109a90cSPablo Neira Ayuso #if IS_ENABLED(CONFIG_BRIDGE_NETFILTER) 5286c79bf0fSBart De Schuymer if (skb->nf_bridge) 5296c79bf0fSBart De Schuymer mtu -= nf_bridge_mtu_reduction(skb); 5306c79bf0fSBart De Schuymer #endif 53189cee8b1SHerbert Xu IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE; 5321da177e4SLinus Torvalds 5331da177e4SLinus Torvalds /* When frag_list is given, use it. First, check its validity: 5341da177e4SLinus Torvalds * some transformers could create wrong frag_list or break existing 5351da177e4SLinus Torvalds * one, it is not prohibited. In this case fall back to copying. 5361da177e4SLinus Torvalds * 5371da177e4SLinus Torvalds * LATER: this step can be merged to real generation of fragments, 5381da177e4SLinus Torvalds * we can switch to copy when see the first bad fragment. 5391da177e4SLinus Torvalds */ 54021dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 5413d13008eSEric Dumazet struct sk_buff *frag, *frag2; 5421da177e4SLinus Torvalds int first_len = skb_pagelen(skb); 5431da177e4SLinus Torvalds 5441da177e4SLinus Torvalds if (first_len - hlen > mtu || 5451da177e4SLinus Torvalds ((first_len - hlen) & 7) || 54656f8a75cSPaul Gortmaker ip_is_fragment(iph) || 5471da177e4SLinus Torvalds skb_cloned(skb)) 5481da177e4SLinus Torvalds goto slow_path; 5491da177e4SLinus Torvalds 550d7fcf1a5SDavid S. Miller skb_walk_frags(skb, frag) { 5511da177e4SLinus Torvalds /* Correct geometry. */ 5521da177e4SLinus Torvalds if (frag->len > mtu || 5531da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 5541da177e4SLinus Torvalds skb_headroom(frag) < hlen) 5553d13008eSEric Dumazet goto slow_path_clean; 5561da177e4SLinus Torvalds 5571da177e4SLinus Torvalds /* Partially cloned skb? */ 5581da177e4SLinus Torvalds if (skb_shared(frag)) 5593d13008eSEric Dumazet goto slow_path_clean; 5602fdba6b0SHerbert Xu 5612fdba6b0SHerbert Xu BUG_ON(frag->sk); 5622fdba6b0SHerbert Xu if (skb->sk) { 5632fdba6b0SHerbert Xu frag->sk = skb->sk; 5642fdba6b0SHerbert Xu frag->destructor = sock_wfree; 5652fdba6b0SHerbert Xu } 5663d13008eSEric Dumazet skb->truesize -= frag->truesize; 5671da177e4SLinus Torvalds } 5681da177e4SLinus Torvalds 5691da177e4SLinus Torvalds /* Everything is OK. Generate! */ 5701da177e4SLinus Torvalds 5711da177e4SLinus Torvalds err = 0; 5721da177e4SLinus Torvalds offset = 0; 5731da177e4SLinus Torvalds frag = skb_shinfo(skb)->frag_list; 574d7fcf1a5SDavid S. Miller skb_frag_list_init(skb); 5751da177e4SLinus Torvalds skb->data_len = first_len - skb_headlen(skb); 5761da177e4SLinus Torvalds skb->len = first_len; 5771da177e4SLinus Torvalds iph->tot_len = htons(first_len); 5781da177e4SLinus Torvalds iph->frag_off = htons(IP_MF); 5791da177e4SLinus Torvalds ip_send_check(iph); 5801da177e4SLinus Torvalds 5811da177e4SLinus Torvalds for (;;) { 5821da177e4SLinus Torvalds /* Prepare header of the next frame, 5831da177e4SLinus Torvalds * before previous one went down. */ 5841da177e4SLinus Torvalds if (frag) { 5851da177e4SLinus Torvalds frag->ip_summed = CHECKSUM_NONE; 586badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(frag); 587e2d1bca7SArnaldo Carvalho de Melo __skb_push(frag, hlen); 588e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(frag); 589d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(frag), iph, hlen); 590eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(frag); 5911da177e4SLinus Torvalds iph->tot_len = htons(frag->len); 5921da177e4SLinus Torvalds ip_copy_metadata(frag, skb); 5931da177e4SLinus Torvalds if (offset == 0) 5941da177e4SLinus Torvalds ip_options_fragment(frag); 5951da177e4SLinus Torvalds offset += skb->len - hlen; 5961da177e4SLinus Torvalds iph->frag_off = htons(offset>>3); 59700db4124SIan Morris if (frag->next) 5981da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 5991da177e4SLinus Torvalds /* Ready, complete checksum */ 6001da177e4SLinus Torvalds ip_send_check(iph); 6011da177e4SLinus Torvalds } 6021da177e4SLinus Torvalds 603*7026b1ddSDavid Miller err = output(sk, skb); 6041da177e4SLinus Torvalds 605dafee490SWei Dong if (!err) 6065e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGCREATES); 6071da177e4SLinus Torvalds if (err || !frag) 6081da177e4SLinus Torvalds break; 6091da177e4SLinus Torvalds 6101da177e4SLinus Torvalds skb = frag; 6111da177e4SLinus Torvalds frag = skb->next; 6121da177e4SLinus Torvalds skb->next = NULL; 6131da177e4SLinus Torvalds } 6141da177e4SLinus Torvalds 6151da177e4SLinus Torvalds if (err == 0) { 6165e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGOKS); 6171da177e4SLinus Torvalds return 0; 6181da177e4SLinus Torvalds } 6191da177e4SLinus Torvalds 6201da177e4SLinus Torvalds while (frag) { 6211da177e4SLinus Torvalds skb = frag->next; 6221da177e4SLinus Torvalds kfree_skb(frag); 6231da177e4SLinus Torvalds frag = skb; 6241da177e4SLinus Torvalds } 6255e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGFAILS); 6261da177e4SLinus Torvalds return err; 6273d13008eSEric Dumazet 6283d13008eSEric Dumazet slow_path_clean: 6293d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 6303d13008eSEric Dumazet if (frag2 == frag) 6313d13008eSEric Dumazet break; 6323d13008eSEric Dumazet frag2->sk = NULL; 6333d13008eSEric Dumazet frag2->destructor = NULL; 6343d13008eSEric Dumazet skb->truesize += frag2->truesize; 6353d13008eSEric Dumazet } 6361da177e4SLinus Torvalds } 6371da177e4SLinus Torvalds 6381da177e4SLinus Torvalds slow_path: 639fc70fb64SAlexander Duyck /* for offloaded checksums cleanup checksum before fragmentation */ 640fc70fb64SAlexander Duyck if ((skb->ip_summed == CHECKSUM_PARTIAL) && skb_checksum_help(skb)) 641fc70fb64SAlexander Duyck goto fail; 642c9af6db4SPravin B Shelar iph = ip_hdr(skb); 643fc70fb64SAlexander Duyck 6441da177e4SLinus Torvalds left = skb->len - hlen; /* Space per frame */ 64549085bd7SGeorge Kadianakis ptr = hlen; /* Where to start from */ 6461da177e4SLinus Torvalds 6478d045163SFlorian Westphal ll_rs = LL_RESERVED_SPACE(rt->dst.dev); 6489bcfcaf5SStephen Hemminger 6491da177e4SLinus Torvalds /* 6501da177e4SLinus Torvalds * Fragment the datagram. 6511da177e4SLinus Torvalds */ 6521da177e4SLinus Torvalds 6531da177e4SLinus Torvalds offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3; 6541da177e4SLinus Torvalds not_last_frag = iph->frag_off & htons(IP_MF); 6551da177e4SLinus Torvalds 6561da177e4SLinus Torvalds /* 6571da177e4SLinus Torvalds * Keep copying data until we run out. 6581da177e4SLinus Torvalds */ 6591da177e4SLinus Torvalds 6601da177e4SLinus Torvalds while (left > 0) { 6611da177e4SLinus Torvalds len = left; 6621da177e4SLinus Torvalds /* IF: it doesn't fit, use 'mtu' - the data space left */ 6631da177e4SLinus Torvalds if (len > mtu) 6641da177e4SLinus Torvalds len = mtu; 6651da177e4SLinus Torvalds /* IF: we are not sending up to and including the packet end 6661da177e4SLinus Torvalds then align the next start on an eight byte boundary */ 6671da177e4SLinus Torvalds if (len < left) { 6681da177e4SLinus Torvalds len &= ~7; 6691da177e4SLinus Torvalds } 6701da177e4SLinus Torvalds 671cbffccc9SJoe Perches /* Allocate buffer */ 672cbffccc9SJoe Perches skb2 = alloc_skb(len + hlen + ll_rs, GFP_ATOMIC); 673cbffccc9SJoe Perches if (!skb2) { 6741da177e4SLinus Torvalds err = -ENOMEM; 6751da177e4SLinus Torvalds goto fail; 6761da177e4SLinus Torvalds } 6771da177e4SLinus Torvalds 6781da177e4SLinus Torvalds /* 6791da177e4SLinus Torvalds * Set up data on packet 6801da177e4SLinus Torvalds */ 6811da177e4SLinus Torvalds 6821da177e4SLinus Torvalds ip_copy_metadata(skb2, skb); 6831da177e4SLinus Torvalds skb_reserve(skb2, ll_rs); 6841da177e4SLinus Torvalds skb_put(skb2, len + hlen); 685c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb2); 686b0e380b1SArnaldo Carvalho de Melo skb2->transport_header = skb2->network_header + hlen; 6871da177e4SLinus Torvalds 6881da177e4SLinus Torvalds /* 6891da177e4SLinus Torvalds * Charge the memory for the fragment to any owner 6901da177e4SLinus Torvalds * it might possess 6911da177e4SLinus Torvalds */ 6921da177e4SLinus Torvalds 6931da177e4SLinus Torvalds if (skb->sk) 6941da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 6951da177e4SLinus Torvalds 6961da177e4SLinus Torvalds /* 6971da177e4SLinus Torvalds * Copy the packet header into the new buffer. 6981da177e4SLinus Torvalds */ 6991da177e4SLinus Torvalds 700d626f62bSArnaldo Carvalho de Melo skb_copy_from_linear_data(skb, skb_network_header(skb2), hlen); 7011da177e4SLinus Torvalds 7021da177e4SLinus Torvalds /* 7031da177e4SLinus Torvalds * Copy a block of the IP datagram. 7041da177e4SLinus Torvalds */ 705bff9b61cSArnaldo Carvalho de Melo if (skb_copy_bits(skb, ptr, skb_transport_header(skb2), len)) 7061da177e4SLinus Torvalds BUG(); 7071da177e4SLinus Torvalds left -= len; 7081da177e4SLinus Torvalds 7091da177e4SLinus Torvalds /* 7101da177e4SLinus Torvalds * Fill in the new header fields. 7111da177e4SLinus Torvalds */ 712eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb2); 7131da177e4SLinus Torvalds iph->frag_off = htons((offset >> 3)); 7141da177e4SLinus Torvalds 7151da177e4SLinus Torvalds /* ANK: dirty, but effective trick. Upgrade options only if 7161da177e4SLinus Torvalds * the segment to be fragmented was THE FIRST (otherwise, 7171da177e4SLinus Torvalds * options are already fixed) and make it ONCE 7181da177e4SLinus Torvalds * on the initial skb, so that all the following fragments 7191da177e4SLinus Torvalds * will inherit fixed options. 7201da177e4SLinus Torvalds */ 7211da177e4SLinus Torvalds if (offset == 0) 7221da177e4SLinus Torvalds ip_options_fragment(skb); 7231da177e4SLinus Torvalds 7241da177e4SLinus Torvalds /* 7251da177e4SLinus Torvalds * Added AC : If we are fragmenting a fragment that's not the 7261da177e4SLinus Torvalds * last fragment then keep MF on each bit 7271da177e4SLinus Torvalds */ 7281da177e4SLinus Torvalds if (left > 0 || not_last_frag) 7291da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 7301da177e4SLinus Torvalds ptr += len; 7311da177e4SLinus Torvalds offset += len; 7321da177e4SLinus Torvalds 7331da177e4SLinus Torvalds /* 7341da177e4SLinus Torvalds * Put this fragment into the sending queue. 7351da177e4SLinus Torvalds */ 7361da177e4SLinus Torvalds iph->tot_len = htons(len + hlen); 7371da177e4SLinus Torvalds 7381da177e4SLinus Torvalds ip_send_check(iph); 7391da177e4SLinus Torvalds 740*7026b1ddSDavid Miller err = output(sk, skb2); 7411da177e4SLinus Torvalds if (err) 7421da177e4SLinus Torvalds goto fail; 743dafee490SWei Dong 7445e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGCREATES); 7451da177e4SLinus Torvalds } 7465d0ba55bSEric Dumazet consume_skb(skb); 7475e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGOKS); 7481da177e4SLinus Torvalds return err; 7491da177e4SLinus Torvalds 7501da177e4SLinus Torvalds fail: 7511da177e4SLinus Torvalds kfree_skb(skb); 7525e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGFAILS); 7531da177e4SLinus Torvalds return err; 7541da177e4SLinus Torvalds } 7552e2f7aefSPatrick McHardy EXPORT_SYMBOL(ip_fragment); 7562e2f7aefSPatrick McHardy 7571da177e4SLinus Torvalds int 7581da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb) 7591da177e4SLinus Torvalds { 760f69e6d13SAl Viro struct msghdr *msg = from; 7611da177e4SLinus Torvalds 76284fa7933SPatrick McHardy if (skb->ip_summed == CHECKSUM_PARTIAL) { 76321226abbSAl Viro if (copy_from_iter(to, len, &msg->msg_iter) != len) 7641da177e4SLinus Torvalds return -EFAULT; 7651da177e4SLinus Torvalds } else { 76644bb9363SAl Viro __wsum csum = 0; 76721226abbSAl Viro if (csum_and_copy_from_iter(to, len, &csum, &msg->msg_iter) != len) 7681da177e4SLinus Torvalds return -EFAULT; 7691da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 7701da177e4SLinus Torvalds } 7711da177e4SLinus Torvalds return 0; 7721da177e4SLinus Torvalds } 7734bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag); 7741da177e4SLinus Torvalds 77544bb9363SAl Viro static inline __wsum 7761da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy) 7771da177e4SLinus Torvalds { 7781da177e4SLinus Torvalds char *kaddr; 77944bb9363SAl Viro __wsum csum; 7801da177e4SLinus Torvalds kaddr = kmap(page); 7811da177e4SLinus Torvalds csum = csum_partial(kaddr + offset, copy, 0); 7821da177e4SLinus Torvalds kunmap(page); 7831da177e4SLinus Torvalds return csum; 7841da177e4SLinus Torvalds } 7851da177e4SLinus Torvalds 7864b30b1c6SAdrian Bunk static inline int ip_ufo_append_data(struct sock *sk, 7871470ddf7SHerbert Xu struct sk_buff_head *queue, 788e89e9cf5SAnanda Raju int getfrag(void *from, char *to, int offset, int len, 789e89e9cf5SAnanda Raju int odd, struct sk_buff *skb), 790e89e9cf5SAnanda Raju void *from, int length, int hh_len, int fragheaderlen, 791d9be4f7aSBill Sommerfeld int transhdrlen, int maxfraglen, unsigned int flags) 792e89e9cf5SAnanda Raju { 793e89e9cf5SAnanda Raju struct sk_buff *skb; 794e89e9cf5SAnanda Raju int err; 795e89e9cf5SAnanda Raju 796e89e9cf5SAnanda Raju /* There is support for UDP fragmentation offload by network 797e89e9cf5SAnanda Raju * device, so create one single skb packet containing complete 798e89e9cf5SAnanda Raju * udp datagram 799e89e9cf5SAnanda Raju */ 80051456b29SIan Morris skb = skb_peek_tail(queue); 80151456b29SIan Morris if (!skb) { 802e89e9cf5SAnanda Raju skb = sock_alloc_send_skb(sk, 803e89e9cf5SAnanda Raju hh_len + fragheaderlen + transhdrlen + 20, 804e89e9cf5SAnanda Raju (flags & MSG_DONTWAIT), &err); 805e89e9cf5SAnanda Raju 80651456b29SIan Morris if (!skb) 807e89e9cf5SAnanda Raju return err; 808e89e9cf5SAnanda Raju 809e89e9cf5SAnanda Raju /* reserve space for Hardware header */ 810e89e9cf5SAnanda Raju skb_reserve(skb, hh_len); 811e89e9cf5SAnanda Raju 812e89e9cf5SAnanda Raju /* create space for UDP/IP header */ 813e89e9cf5SAnanda Raju skb_put(skb, fragheaderlen + transhdrlen); 814e89e9cf5SAnanda Raju 815e89e9cf5SAnanda Raju /* initialize network header pointer */ 816c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb); 817e89e9cf5SAnanda Raju 818e89e9cf5SAnanda Raju /* initialize protocol header pointer */ 819b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header + fragheaderlen; 820e89e9cf5SAnanda Raju 821e89e9cf5SAnanda Raju skb->csum = 0; 822e89e9cf5SAnanda Raju 823e93b7d74SJiri Pirko 824e93b7d74SJiri Pirko __skb_queue_tail(queue, skb); 825e93b7d74SJiri Pirko } else if (skb_is_gso(skb)) { 826e93b7d74SJiri Pirko goto append; 827e93b7d74SJiri Pirko } 828e93b7d74SJiri Pirko 829e93b7d74SJiri Pirko skb->ip_summed = CHECKSUM_PARTIAL; 830e89e9cf5SAnanda Raju /* specify the length of each IP datagram fragment */ 831d9be4f7aSBill Sommerfeld skb_shinfo(skb)->gso_size = maxfraglen - fragheaderlen; 832f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 833be9164e7SKostya B 834e93b7d74SJiri Pirko append: 835be9164e7SKostya B return skb_append_datato_frags(sk, skb, getfrag, from, 836be9164e7SKostya B (length - transhdrlen)); 837e89e9cf5SAnanda Raju } 838e89e9cf5SAnanda Raju 839f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk, 840f5fca608SDavid S. Miller struct flowi4 *fl4, 841f5fca608SDavid S. Miller struct sk_buff_head *queue, 8421470ddf7SHerbert Xu struct inet_cork *cork, 8435640f768SEric Dumazet struct page_frag *pfrag, 8441470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, 8451470ddf7SHerbert Xu int len, int odd, struct sk_buff *skb), 8461da177e4SLinus Torvalds void *from, int length, int transhdrlen, 8471da177e4SLinus Torvalds unsigned int flags) 8481da177e4SLinus Torvalds { 8491da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 8501da177e4SLinus Torvalds struct sk_buff *skb; 8511da177e4SLinus Torvalds 85207df5294SHerbert Xu struct ip_options *opt = cork->opt; 8531da177e4SLinus Torvalds int hh_len; 8541da177e4SLinus Torvalds int exthdrlen; 8551da177e4SLinus Torvalds int mtu; 8561da177e4SLinus Torvalds int copy; 8571da177e4SLinus Torvalds int err; 8581da177e4SLinus Torvalds int offset = 0; 859daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, maxnonfragsize; 8601da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 8611470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 86209c2d251SWillem de Bruijn u32 tskey = 0; 8631da177e4SLinus Torvalds 86496d7303eSSteffen Klassert skb = skb_peek_tail(queue); 86596d7303eSSteffen Klassert 86696d7303eSSteffen Klassert exthdrlen = !skb ? rt->dst.header_len : 0; 86707df5294SHerbert Xu mtu = cork->fragsize; 86809c2d251SWillem de Bruijn if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP && 86909c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 87009c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 8711470ddf7SHerbert Xu 872d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 8731da177e4SLinus Torvalds 8741da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 8751da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 87660ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 8771da177e4SLinus Torvalds 878daba287bSHannes Frederic Sowa if (cork->length + length > maxnonfragsize - fragheaderlen) { 879f5fca608SDavid S. Miller ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 88061e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 8811da177e4SLinus Torvalds return -EMSGSIZE; 8821da177e4SLinus Torvalds } 8831da177e4SLinus Torvalds 8841da177e4SLinus Torvalds /* 8851da177e4SLinus Torvalds * transhdrlen > 0 means that this is the first fragment and we wish 8861da177e4SLinus Torvalds * it won't be fragmented in the future. 8871da177e4SLinus Torvalds */ 8881da177e4SLinus Torvalds if (transhdrlen && 8891da177e4SLinus Torvalds length + fragheaderlen <= mtu && 890d8d1f30bSChangli Gao rt->dst.dev->features & NETIF_F_V4_CSUM && 8911da177e4SLinus Torvalds !exthdrlen) 89284fa7933SPatrick McHardy csummode = CHECKSUM_PARTIAL; 8931da177e4SLinus Torvalds 8941470ddf7SHerbert Xu cork->length += length; 89526cde9f7SHerbert Xu if (((length > mtu) || (skb && skb_is_gso(skb))) && 896be9164e7SKostya B (sk->sk_protocol == IPPROTO_UDP) && 897acf8dd0aSMichal Kubeček (rt->dst.dev->features & NETIF_F_UFO) && !rt->dst.header_len && 898acf8dd0aSMichal Kubeček (sk->sk_type == SOCK_DGRAM)) { 8991470ddf7SHerbert Xu err = ip_ufo_append_data(sk, queue, getfrag, from, length, 9001470ddf7SHerbert Xu hh_len, fragheaderlen, transhdrlen, 901d9be4f7aSBill Sommerfeld maxfraglen, flags); 902baa829d8SPatrick McHardy if (err) 903e89e9cf5SAnanda Raju goto error; 904e89e9cf5SAnanda Raju return 0; 905e89e9cf5SAnanda Raju } 9061da177e4SLinus Torvalds 9071da177e4SLinus Torvalds /* So, what's going on in the loop below? 9081da177e4SLinus Torvalds * 9091da177e4SLinus Torvalds * We use calculated fragment length to generate chained skb, 9101da177e4SLinus Torvalds * each of segments is IP fragment ready for sending to network after 9111da177e4SLinus Torvalds * adding appropriate IP header. 9121da177e4SLinus Torvalds */ 9131da177e4SLinus Torvalds 91426cde9f7SHerbert Xu if (!skb) 9151da177e4SLinus Torvalds goto alloc_new_skb; 9161da177e4SLinus Torvalds 9171da177e4SLinus Torvalds while (length > 0) { 9181da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 9191da177e4SLinus Torvalds copy = mtu - skb->len; 9201da177e4SLinus Torvalds if (copy < length) 9211da177e4SLinus Torvalds copy = maxfraglen - skb->len; 9221da177e4SLinus Torvalds if (copy <= 0) { 9231da177e4SLinus Torvalds char *data; 9241da177e4SLinus Torvalds unsigned int datalen; 9251da177e4SLinus Torvalds unsigned int fraglen; 9261da177e4SLinus Torvalds unsigned int fraggap; 9271da177e4SLinus Torvalds unsigned int alloclen; 9281da177e4SLinus Torvalds struct sk_buff *skb_prev; 9291da177e4SLinus Torvalds alloc_new_skb: 9301da177e4SLinus Torvalds skb_prev = skb; 9311da177e4SLinus Torvalds if (skb_prev) 9321da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 9331da177e4SLinus Torvalds else 9341da177e4SLinus Torvalds fraggap = 0; 9351da177e4SLinus Torvalds 9361da177e4SLinus Torvalds /* 9371da177e4SLinus Torvalds * If remaining data exceeds the mtu, 9381da177e4SLinus Torvalds * we know we need more fragment(s). 9391da177e4SLinus Torvalds */ 9401da177e4SLinus Torvalds datalen = length + fraggap; 9411da177e4SLinus Torvalds if (datalen > mtu - fragheaderlen) 9421da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 9431da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 9441da177e4SLinus Torvalds 9451da177e4SLinus Torvalds if ((flags & MSG_MORE) && 946d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 9471da177e4SLinus Torvalds alloclen = mtu; 9481da177e4SLinus Torvalds else 94959104f06SEric Dumazet alloclen = fraglen; 9501da177e4SLinus Torvalds 951353e5c9aSSteffen Klassert alloclen += exthdrlen; 952353e5c9aSSteffen Klassert 9531da177e4SLinus Torvalds /* The last fragment gets additional space at tail. 9541da177e4SLinus Torvalds * Note, with MSG_MORE we overallocate on fragments, 9551da177e4SLinus Torvalds * because we have no idea what fragment will be 9561da177e4SLinus Torvalds * the last. 9571da177e4SLinus Torvalds */ 95833f99dc7SSteffen Klassert if (datalen == length + fraggap) 959d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 96033f99dc7SSteffen Klassert 9611da177e4SLinus Torvalds if (transhdrlen) { 9621da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 9631da177e4SLinus Torvalds alloclen + hh_len + 15, 9641da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 9651da177e4SLinus Torvalds } else { 9661da177e4SLinus Torvalds skb = NULL; 9671da177e4SLinus Torvalds if (atomic_read(&sk->sk_wmem_alloc) <= 9681da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 9691da177e4SLinus Torvalds skb = sock_wmalloc(sk, 9701da177e4SLinus Torvalds alloclen + hh_len + 15, 1, 9711da177e4SLinus Torvalds sk->sk_allocation); 97251456b29SIan Morris if (unlikely(!skb)) 9731da177e4SLinus Torvalds err = -ENOBUFS; 9741da177e4SLinus Torvalds } 97551456b29SIan Morris if (!skb) 9761da177e4SLinus Torvalds goto error; 9771da177e4SLinus Torvalds 9781da177e4SLinus Torvalds /* 9791da177e4SLinus Torvalds * Fill in the control structures 9801da177e4SLinus Torvalds */ 9811da177e4SLinus Torvalds skb->ip_summed = csummode; 9821da177e4SLinus Torvalds skb->csum = 0; 9831da177e4SLinus Torvalds skb_reserve(skb, hh_len); 98411878b40SWillem de Bruijn 98511878b40SWillem de Bruijn /* only the initial fragment is time stamped */ 9861470ddf7SHerbert Xu skb_shinfo(skb)->tx_flags = cork->tx_flags; 98711878b40SWillem de Bruijn cork->tx_flags = 0; 98809c2d251SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 98909c2d251SWillem de Bruijn tskey = 0; 9901da177e4SLinus Torvalds 9911da177e4SLinus Torvalds /* 9921da177e4SLinus Torvalds * Find where to start putting bytes. 9931da177e4SLinus Torvalds */ 994353e5c9aSSteffen Klassert data = skb_put(skb, fraglen + exthdrlen); 995c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 996b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 997b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 998353e5c9aSSteffen Klassert data += fragheaderlen + exthdrlen; 9991da177e4SLinus Torvalds 10001da177e4SLinus Torvalds if (fraggap) { 10011da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 10021da177e4SLinus Torvalds skb_prev, maxfraglen, 10031da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 10041da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 10051da177e4SLinus Torvalds skb->csum); 10061da177e4SLinus Torvalds data += fraggap; 1007e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 10081da177e4SLinus Torvalds } 10091da177e4SLinus Torvalds 10101da177e4SLinus Torvalds copy = datalen - transhdrlen - fraggap; 10111da177e4SLinus Torvalds if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 10121da177e4SLinus Torvalds err = -EFAULT; 10131da177e4SLinus Torvalds kfree_skb(skb); 10141da177e4SLinus Torvalds goto error; 10151da177e4SLinus Torvalds } 10161da177e4SLinus Torvalds 10171da177e4SLinus Torvalds offset += copy; 10181da177e4SLinus Torvalds length -= datalen - fraggap; 10191da177e4SLinus Torvalds transhdrlen = 0; 10201da177e4SLinus Torvalds exthdrlen = 0; 10211da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 10221da177e4SLinus Torvalds 10231da177e4SLinus Torvalds /* 10241da177e4SLinus Torvalds * Put the packet on the pending queue. 10251da177e4SLinus Torvalds */ 10261470ddf7SHerbert Xu __skb_queue_tail(queue, skb); 10271da177e4SLinus Torvalds continue; 10281da177e4SLinus Torvalds } 10291da177e4SLinus Torvalds 10301da177e4SLinus Torvalds if (copy > length) 10311da177e4SLinus Torvalds copy = length; 10321da177e4SLinus Torvalds 1033d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) { 10341da177e4SLinus Torvalds unsigned int off; 10351da177e4SLinus Torvalds 10361da177e4SLinus Torvalds off = skb->len; 10371da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 10381da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 10391da177e4SLinus Torvalds __skb_trim(skb, off); 10401da177e4SLinus Torvalds err = -EFAULT; 10411da177e4SLinus Torvalds goto error; 10421da177e4SLinus Torvalds } 10431da177e4SLinus Torvalds } else { 10441da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 10451da177e4SLinus Torvalds 10461da177e4SLinus Torvalds err = -ENOMEM; 10475640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 10481da177e4SLinus Torvalds goto error; 10491da177e4SLinus Torvalds 10505640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 10515640f768SEric Dumazet pfrag->offset)) { 10521da177e4SLinus Torvalds err = -EMSGSIZE; 10535640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 10541da177e4SLinus Torvalds goto error; 10555640f768SEric Dumazet 10565640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 10575640f768SEric Dumazet pfrag->offset, 0); 10585640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 10595640f768SEric Dumazet get_page(pfrag->page); 10601da177e4SLinus Torvalds } 10615640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 10625640f768SEric Dumazet if (getfrag(from, 10635640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 10645640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 10655640f768SEric Dumazet goto error_efault; 10665640f768SEric Dumazet 10675640f768SEric Dumazet pfrag->offset += copy; 10685640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 10691da177e4SLinus Torvalds skb->len += copy; 10701da177e4SLinus Torvalds skb->data_len += copy; 1071f945fa7aSHerbert Xu skb->truesize += copy; 1072f945fa7aSHerbert Xu atomic_add(copy, &sk->sk_wmem_alloc); 10731da177e4SLinus Torvalds } 10741da177e4SLinus Torvalds offset += copy; 10751da177e4SLinus Torvalds length -= copy; 10761da177e4SLinus Torvalds } 10771da177e4SLinus Torvalds 10781da177e4SLinus Torvalds return 0; 10791da177e4SLinus Torvalds 10805640f768SEric Dumazet error_efault: 10815640f768SEric Dumazet err = -EFAULT; 10821da177e4SLinus Torvalds error: 10831470ddf7SHerbert Xu cork->length -= length; 10845e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 10851da177e4SLinus Torvalds return err; 10861da177e4SLinus Torvalds } 10871da177e4SLinus Torvalds 10881470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork, 10891470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp) 10901470ddf7SHerbert Xu { 1091f6d8bd05SEric Dumazet struct ip_options_rcu *opt; 10921470ddf7SHerbert Xu struct rtable *rt; 10931470ddf7SHerbert Xu 10941470ddf7SHerbert Xu /* 10951470ddf7SHerbert Xu * setup for corking. 10961470ddf7SHerbert Xu */ 10971470ddf7SHerbert Xu opt = ipc->opt; 10981470ddf7SHerbert Xu if (opt) { 109951456b29SIan Morris if (!cork->opt) { 11001470ddf7SHerbert Xu cork->opt = kmalloc(sizeof(struct ip_options) + 40, 11011470ddf7SHerbert Xu sk->sk_allocation); 110251456b29SIan Morris if (unlikely(!cork->opt)) 11031470ddf7SHerbert Xu return -ENOBUFS; 11041470ddf7SHerbert Xu } 1105f6d8bd05SEric Dumazet memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen); 11061470ddf7SHerbert Xu cork->flags |= IPCORK_OPT; 11071470ddf7SHerbert Xu cork->addr = ipc->addr; 11081470ddf7SHerbert Xu } 11091470ddf7SHerbert Xu rt = *rtp; 11101470ddf7SHerbert Xu if (unlikely(!rt)) 11111470ddf7SHerbert Xu return -EFAULT; 11121470ddf7SHerbert Xu /* 11131470ddf7SHerbert Xu * We steal reference to this route, caller should not release it 11141470ddf7SHerbert Xu */ 11151470ddf7SHerbert Xu *rtp = NULL; 1116482fc609SHannes Frederic Sowa cork->fragsize = ip_sk_use_pmtu(sk) ? 1117482fc609SHannes Frederic Sowa dst_mtu(&rt->dst) : rt->dst.dev->mtu; 11181470ddf7SHerbert Xu cork->dst = &rt->dst; 11191470ddf7SHerbert Xu cork->length = 0; 1120aa661581SFrancesco Fusco cork->ttl = ipc->ttl; 1121aa661581SFrancesco Fusco cork->tos = ipc->tos; 1122aa661581SFrancesco Fusco cork->priority = ipc->priority; 11231470ddf7SHerbert Xu cork->tx_flags = ipc->tx_flags; 11241470ddf7SHerbert Xu 11251470ddf7SHerbert Xu return 0; 11261470ddf7SHerbert Xu } 11271470ddf7SHerbert Xu 11281470ddf7SHerbert Xu /* 11291470ddf7SHerbert Xu * ip_append_data() and ip_append_page() can make one large IP datagram 11301470ddf7SHerbert Xu * from many pieces of data. Each pieces will be holded on the socket 11311470ddf7SHerbert Xu * until ip_push_pending_frames() is called. Each piece can be a page 11321470ddf7SHerbert Xu * or non-page data. 11331470ddf7SHerbert Xu * 11341470ddf7SHerbert Xu * Not only UDP, other transport protocols - e.g. raw sockets - can use 11351470ddf7SHerbert Xu * this interface potentially. 11361470ddf7SHerbert Xu * 11371470ddf7SHerbert Xu * LATER: length must be adjusted by pad at tail, when it is required. 11381470ddf7SHerbert Xu */ 1139f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4, 11401470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, int len, 11411470ddf7SHerbert Xu int odd, struct sk_buff *skb), 11421470ddf7SHerbert Xu void *from, int length, int transhdrlen, 11431470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 11441470ddf7SHerbert Xu unsigned int flags) 11451470ddf7SHerbert Xu { 11461470ddf7SHerbert Xu struct inet_sock *inet = inet_sk(sk); 11471470ddf7SHerbert Xu int err; 11481470ddf7SHerbert Xu 11491470ddf7SHerbert Xu if (flags&MSG_PROBE) 11501470ddf7SHerbert Xu return 0; 11511470ddf7SHerbert Xu 11521470ddf7SHerbert Xu if (skb_queue_empty(&sk->sk_write_queue)) { 1153bdc712b4SDavid S. Miller err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp); 11541470ddf7SHerbert Xu if (err) 11551470ddf7SHerbert Xu return err; 11561470ddf7SHerbert Xu } else { 11571470ddf7SHerbert Xu transhdrlen = 0; 11581470ddf7SHerbert Xu } 11591470ddf7SHerbert Xu 11605640f768SEric Dumazet return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base, 11615640f768SEric Dumazet sk_page_frag(sk), getfrag, 11621470ddf7SHerbert Xu from, length, transhdrlen, flags); 11631470ddf7SHerbert Xu } 11641470ddf7SHerbert Xu 1165f5fca608SDavid S. Miller ssize_t ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page, 11661da177e4SLinus Torvalds int offset, size_t size, int flags) 11671da177e4SLinus Torvalds { 11681da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 11691da177e4SLinus Torvalds struct sk_buff *skb; 11701da177e4SLinus Torvalds struct rtable *rt; 11711da177e4SLinus Torvalds struct ip_options *opt = NULL; 1172bdc712b4SDavid S. Miller struct inet_cork *cork; 11731da177e4SLinus Torvalds int hh_len; 11741da177e4SLinus Torvalds int mtu; 11751da177e4SLinus Torvalds int len; 11761da177e4SLinus Torvalds int err; 1177daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize; 11781da177e4SLinus Torvalds 11791da177e4SLinus Torvalds if (inet->hdrincl) 11801da177e4SLinus Torvalds return -EPERM; 11811da177e4SLinus Torvalds 11821da177e4SLinus Torvalds if (flags&MSG_PROBE) 11831da177e4SLinus Torvalds return 0; 11841da177e4SLinus Torvalds 11851da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) 11861da177e4SLinus Torvalds return -EINVAL; 11871da177e4SLinus Torvalds 1188bdc712b4SDavid S. Miller cork = &inet->cork.base; 1189bdc712b4SDavid S. Miller rt = (struct rtable *)cork->dst; 1190bdc712b4SDavid S. Miller if (cork->flags & IPCORK_OPT) 1191bdc712b4SDavid S. Miller opt = cork->opt; 11921da177e4SLinus Torvalds 1193d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) 11941da177e4SLinus Torvalds return -EOPNOTSUPP; 11951da177e4SLinus Torvalds 1196d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 1197bdc712b4SDavid S. Miller mtu = cork->fragsize; 11981da177e4SLinus Torvalds 11991da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 12001da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 120160ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 12021da177e4SLinus Torvalds 1203daba287bSHannes Frederic Sowa if (cork->length + size > maxnonfragsize - fragheaderlen) { 120461e7f09dSHannes Frederic Sowa ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 120561e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 12061da177e4SLinus Torvalds return -EMSGSIZE; 12071da177e4SLinus Torvalds } 12081da177e4SLinus Torvalds 120951456b29SIan Morris skb = skb_peek_tail(&sk->sk_write_queue); 121051456b29SIan Morris if (!skb) 12111da177e4SLinus Torvalds return -EINVAL; 12121da177e4SLinus Torvalds 1213bdc712b4SDavid S. Miller cork->length += size; 121426cde9f7SHerbert Xu if ((size + skb->len > mtu) && 121526cde9f7SHerbert Xu (sk->sk_protocol == IPPROTO_UDP) && 1216d8d1f30bSChangli Gao (rt->dst.dev->features & NETIF_F_UFO)) { 12177967168cSHerbert Xu skb_shinfo(skb)->gso_size = mtu - fragheaderlen; 1218f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 12197967168cSHerbert Xu } 1220e89e9cf5SAnanda Raju 12211da177e4SLinus Torvalds 12221da177e4SLinus Torvalds while (size > 0) { 12231da177e4SLinus Torvalds int i; 12241da177e4SLinus Torvalds 122589114afdSHerbert Xu if (skb_is_gso(skb)) 1226e89e9cf5SAnanda Raju len = size; 1227e89e9cf5SAnanda Raju else { 1228e89e9cf5SAnanda Raju 12291da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 12301da177e4SLinus Torvalds len = mtu - skb->len; 12311da177e4SLinus Torvalds if (len < size) 12321da177e4SLinus Torvalds len = maxfraglen - skb->len; 1233e89e9cf5SAnanda Raju } 12341da177e4SLinus Torvalds if (len <= 0) { 12351da177e4SLinus Torvalds struct sk_buff *skb_prev; 12361da177e4SLinus Torvalds int alloclen; 12371da177e4SLinus Torvalds 12381da177e4SLinus Torvalds skb_prev = skb; 12391da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 12401da177e4SLinus Torvalds 12411da177e4SLinus Torvalds alloclen = fragheaderlen + hh_len + fraggap + 15; 12421da177e4SLinus Torvalds skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation); 12431da177e4SLinus Torvalds if (unlikely(!skb)) { 12441da177e4SLinus Torvalds err = -ENOBUFS; 12451da177e4SLinus Torvalds goto error; 12461da177e4SLinus Torvalds } 12471da177e4SLinus Torvalds 12481da177e4SLinus Torvalds /* 12491da177e4SLinus Torvalds * Fill in the control structures 12501da177e4SLinus Torvalds */ 12511da177e4SLinus Torvalds skb->ip_summed = CHECKSUM_NONE; 12521da177e4SLinus Torvalds skb->csum = 0; 12531da177e4SLinus Torvalds skb_reserve(skb, hh_len); 12541da177e4SLinus Torvalds 12551da177e4SLinus Torvalds /* 12561da177e4SLinus Torvalds * Find where to start putting bytes. 12571da177e4SLinus Torvalds */ 1258967b05f6SArnaldo Carvalho de Melo skb_put(skb, fragheaderlen + fraggap); 12592ca9e6f2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1260b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1261b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 12621da177e4SLinus Torvalds if (fraggap) { 1263967b05f6SArnaldo Carvalho de Melo skb->csum = skb_copy_and_csum_bits(skb_prev, 1264967b05f6SArnaldo Carvalho de Melo maxfraglen, 12659c70220bSArnaldo Carvalho de Melo skb_transport_header(skb), 1266967b05f6SArnaldo Carvalho de Melo fraggap, 0); 12671da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 12681da177e4SLinus Torvalds skb->csum); 1269e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 12701da177e4SLinus Torvalds } 12711da177e4SLinus Torvalds 12721da177e4SLinus Torvalds /* 12731da177e4SLinus Torvalds * Put the packet on the pending queue. 12741da177e4SLinus Torvalds */ 12751da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 12761da177e4SLinus Torvalds continue; 12771da177e4SLinus Torvalds } 12781da177e4SLinus Torvalds 12791da177e4SLinus Torvalds i = skb_shinfo(skb)->nr_frags; 12801da177e4SLinus Torvalds if (len > size) 12811da177e4SLinus Torvalds len = size; 12821da177e4SLinus Torvalds if (skb_can_coalesce(skb, i, page, offset)) { 12839e903e08SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i-1], len); 12841da177e4SLinus Torvalds } else if (i < MAX_SKB_FRAGS) { 12851da177e4SLinus Torvalds get_page(page); 12861da177e4SLinus Torvalds skb_fill_page_desc(skb, i, page, offset, len); 12871da177e4SLinus Torvalds } else { 12881da177e4SLinus Torvalds err = -EMSGSIZE; 12891da177e4SLinus Torvalds goto error; 12901da177e4SLinus Torvalds } 12911da177e4SLinus Torvalds 12921da177e4SLinus Torvalds if (skb->ip_summed == CHECKSUM_NONE) { 129344bb9363SAl Viro __wsum csum; 12941da177e4SLinus Torvalds csum = csum_page(page, offset, len); 12951da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, skb->len); 12961da177e4SLinus Torvalds } 12971da177e4SLinus Torvalds 12981da177e4SLinus Torvalds skb->len += len; 12991da177e4SLinus Torvalds skb->data_len += len; 13001e34a11dSDavid S. Miller skb->truesize += len; 13011e34a11dSDavid S. Miller atomic_add(len, &sk->sk_wmem_alloc); 13021da177e4SLinus Torvalds offset += len; 13031da177e4SLinus Torvalds size -= len; 13041da177e4SLinus Torvalds } 13051da177e4SLinus Torvalds return 0; 13061da177e4SLinus Torvalds 13071da177e4SLinus Torvalds error: 1308bdc712b4SDavid S. Miller cork->length -= size; 13095e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 13101da177e4SLinus Torvalds return err; 13111da177e4SLinus Torvalds } 13121da177e4SLinus Torvalds 13131470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork) 1314429f08e9SPavel Emelyanov { 13151470ddf7SHerbert Xu cork->flags &= ~IPCORK_OPT; 13161470ddf7SHerbert Xu kfree(cork->opt); 13171470ddf7SHerbert Xu cork->opt = NULL; 13181470ddf7SHerbert Xu dst_release(cork->dst); 13191470ddf7SHerbert Xu cork->dst = NULL; 1320429f08e9SPavel Emelyanov } 1321429f08e9SPavel Emelyanov 13221da177e4SLinus Torvalds /* 13231da177e4SLinus Torvalds * Combined all pending IP fragments on the socket as one IP datagram 13241da177e4SLinus Torvalds * and push them out. 13251da177e4SLinus Torvalds */ 13261c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk, 132777968b78SDavid S. Miller struct flowi4 *fl4, 13281470ddf7SHerbert Xu struct sk_buff_head *queue, 13291470ddf7SHerbert Xu struct inet_cork *cork) 13301da177e4SLinus Torvalds { 13311da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 13321da177e4SLinus Torvalds struct sk_buff **tail_skb; 13331da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 13340388b004SPavel Emelyanov struct net *net = sock_net(sk); 13351da177e4SLinus Torvalds struct ip_options *opt = NULL; 13361470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 13371da177e4SLinus Torvalds struct iphdr *iph; 133876ab608dSAlexey Dobriyan __be16 df = 0; 13391da177e4SLinus Torvalds __u8 ttl; 13401da177e4SLinus Torvalds 134151456b29SIan Morris skb = __skb_dequeue(queue); 134251456b29SIan Morris if (!skb) 13431da177e4SLinus Torvalds goto out; 13441da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 13451da177e4SLinus Torvalds 13461da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1347d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1348bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 13491470ddf7SHerbert Xu while ((tmp_skb = __skb_dequeue(queue)) != NULL) { 1350cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 13511da177e4SLinus Torvalds *tail_skb = tmp_skb; 13521da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 13531da177e4SLinus Torvalds skb->len += tmp_skb->len; 13541da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 13551da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 13561da177e4SLinus Torvalds tmp_skb->destructor = NULL; 13571da177e4SLinus Torvalds tmp_skb->sk = NULL; 13581da177e4SLinus Torvalds } 13591da177e4SLinus Torvalds 13601da177e4SLinus Torvalds /* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow 13611da177e4SLinus Torvalds * to fragment the frame generated here. No matter, what transforms 13621da177e4SLinus Torvalds * how transforms change size of the packet, it will come out. 13631da177e4SLinus Torvalds */ 136460ff7467SWANG Cong skb->ignore_df = ip_sk_ignore_df(sk); 13651da177e4SLinus Torvalds 13661da177e4SLinus Torvalds /* DF bit is set when we want to see DF on outgoing frames. 136760ff7467SWANG Cong * If ignore_df is set too, we still allow to fragment this frame 13681da177e4SLinus Torvalds * locally. */ 1369482fc609SHannes Frederic Sowa if (inet->pmtudisc == IP_PMTUDISC_DO || 1370482fc609SHannes Frederic Sowa inet->pmtudisc == IP_PMTUDISC_PROBE || 1371d8d1f30bSChangli Gao (skb->len <= dst_mtu(&rt->dst) && 1372d8d1f30bSChangli Gao ip_dont_fragment(sk, &rt->dst))) 13731da177e4SLinus Torvalds df = htons(IP_DF); 13741da177e4SLinus Torvalds 13751470ddf7SHerbert Xu if (cork->flags & IPCORK_OPT) 13761470ddf7SHerbert Xu opt = cork->opt; 13771da177e4SLinus Torvalds 1378aa661581SFrancesco Fusco if (cork->ttl != 0) 1379aa661581SFrancesco Fusco ttl = cork->ttl; 1380aa661581SFrancesco Fusco else if (rt->rt_type == RTN_MULTICAST) 13811da177e4SLinus Torvalds ttl = inet->mc_ttl; 13821da177e4SLinus Torvalds else 1383d8d1f30bSChangli Gao ttl = ip_select_ttl(inet, &rt->dst); 13841da177e4SLinus Torvalds 1385749154aaSAnsis Atteka iph = ip_hdr(skb); 13861da177e4SLinus Torvalds iph->version = 4; 13871da177e4SLinus Torvalds iph->ihl = 5; 1388aa661581SFrancesco Fusco iph->tos = (cork->tos != -1) ? cork->tos : inet->tos; 13891da177e4SLinus Torvalds iph->frag_off = df; 13901da177e4SLinus Torvalds iph->ttl = ttl; 13911da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 139284f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 1393b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, sk); 13941da177e4SLinus Torvalds 139522f728f8SDavid S. Miller if (opt) { 139622f728f8SDavid S. Miller iph->ihl += opt->optlen>>2; 139722f728f8SDavid S. Miller ip_options_build(skb, opt, cork->addr, rt, 0); 139822f728f8SDavid S. Miller } 139922f728f8SDavid S. Miller 1400aa661581SFrancesco Fusco skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority; 14014a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1402a21bba94SEric Dumazet /* 1403a21bba94SEric Dumazet * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec 1404a21bba94SEric Dumazet * on dst refcount 1405a21bba94SEric Dumazet */ 14061470ddf7SHerbert Xu cork->dst = NULL; 1407d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 14081da177e4SLinus Torvalds 140996793b48SDavid L Stevens if (iph->protocol == IPPROTO_ICMP) 14100388b004SPavel Emelyanov icmp_out_count(net, ((struct icmphdr *) 141196793b48SDavid L Stevens skb_transport_header(skb))->type); 141296793b48SDavid L Stevens 14131c32c5adSHerbert Xu ip_cork_release(cork); 14141c32c5adSHerbert Xu out: 14151c32c5adSHerbert Xu return skb; 14161c32c5adSHerbert Xu } 14171c32c5adSHerbert Xu 1418b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb) 14191c32c5adSHerbert Xu { 14201c32c5adSHerbert Xu int err; 14211c32c5adSHerbert Xu 1422c439cb2eSHerbert Xu err = ip_local_out(skb); 14231da177e4SLinus Torvalds if (err) { 14241da177e4SLinus Torvalds if (err > 0) 14256ce9e7b5SEric Dumazet err = net_xmit_errno(err); 14261da177e4SLinus Torvalds if (err) 14271c32c5adSHerbert Xu IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS); 14281da177e4SLinus Torvalds } 14291da177e4SLinus Torvalds 14301da177e4SLinus Torvalds return err; 14311da177e4SLinus Torvalds } 14321da177e4SLinus Torvalds 143377968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4) 14341470ddf7SHerbert Xu { 14351c32c5adSHerbert Xu struct sk_buff *skb; 14361c32c5adSHerbert Xu 143777968b78SDavid S. Miller skb = ip_finish_skb(sk, fl4); 14381c32c5adSHerbert Xu if (!skb) 14391c32c5adSHerbert Xu return 0; 14401c32c5adSHerbert Xu 14411c32c5adSHerbert Xu /* Netfilter gets whole the not fragmented skb. */ 1442b5ec8eeaSEric Dumazet return ip_send_skb(sock_net(sk), skb); 14431470ddf7SHerbert Xu } 14441470ddf7SHerbert Xu 14451da177e4SLinus Torvalds /* 14461da177e4SLinus Torvalds * Throw away all pending data on the socket. 14471da177e4SLinus Torvalds */ 14481470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk, 14491470ddf7SHerbert Xu struct sk_buff_head *queue, 14501470ddf7SHerbert Xu struct inet_cork *cork) 14511da177e4SLinus Torvalds { 14521da177e4SLinus Torvalds struct sk_buff *skb; 14531da177e4SLinus Torvalds 14541470ddf7SHerbert Xu while ((skb = __skb_dequeue_tail(queue)) != NULL) 14551da177e4SLinus Torvalds kfree_skb(skb); 14561da177e4SLinus Torvalds 14571470ddf7SHerbert Xu ip_cork_release(cork); 14581470ddf7SHerbert Xu } 14591470ddf7SHerbert Xu 14601470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk) 14611470ddf7SHerbert Xu { 1462bdc712b4SDavid S. Miller __ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base); 14631da177e4SLinus Torvalds } 14641da177e4SLinus Torvalds 14651c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk, 146677968b78SDavid S. Miller struct flowi4 *fl4, 14671c32c5adSHerbert Xu int getfrag(void *from, char *to, int offset, 14681c32c5adSHerbert Xu int len, int odd, struct sk_buff *skb), 14691c32c5adSHerbert Xu void *from, int length, int transhdrlen, 14701c32c5adSHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 14711c32c5adSHerbert Xu unsigned int flags) 14721c32c5adSHerbert Xu { 1473b80d7226SDavid S. Miller struct inet_cork cork; 14741c32c5adSHerbert Xu struct sk_buff_head queue; 14751c32c5adSHerbert Xu int err; 14761c32c5adSHerbert Xu 14771c32c5adSHerbert Xu if (flags & MSG_PROBE) 14781c32c5adSHerbert Xu return NULL; 14791c32c5adSHerbert Xu 14801c32c5adSHerbert Xu __skb_queue_head_init(&queue); 14811c32c5adSHerbert Xu 1482b80d7226SDavid S. Miller cork.flags = 0; 1483b80d7226SDavid S. Miller cork.addr = 0; 148470652728SDavid S. Miller cork.opt = NULL; 14851c32c5adSHerbert Xu err = ip_setup_cork(sk, &cork, ipc, rtp); 14861c32c5adSHerbert Xu if (err) 14871c32c5adSHerbert Xu return ERR_PTR(err); 14881c32c5adSHerbert Xu 14895640f768SEric Dumazet err = __ip_append_data(sk, fl4, &queue, &cork, 14905640f768SEric Dumazet ¤t->task_frag, getfrag, 14911c32c5adSHerbert Xu from, length, transhdrlen, flags); 14921c32c5adSHerbert Xu if (err) { 14931c32c5adSHerbert Xu __ip_flush_pending_frames(sk, &queue, &cork); 14941c32c5adSHerbert Xu return ERR_PTR(err); 14951c32c5adSHerbert Xu } 14961c32c5adSHerbert Xu 149777968b78SDavid S. Miller return __ip_make_skb(sk, fl4, &queue, &cork); 14981c32c5adSHerbert Xu } 14991da177e4SLinus Torvalds 15001da177e4SLinus Torvalds /* 15011da177e4SLinus Torvalds * Fetch data from kernel space and fill in checksum if needed. 15021da177e4SLinus Torvalds */ 15031da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset, 15041da177e4SLinus Torvalds int len, int odd, struct sk_buff *skb) 15051da177e4SLinus Torvalds { 15065084205fSAl Viro __wsum csum; 15071da177e4SLinus Torvalds 15081da177e4SLinus Torvalds csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0); 15091da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 15101da177e4SLinus Torvalds return 0; 15111da177e4SLinus Torvalds } 15121da177e4SLinus Torvalds 15131da177e4SLinus Torvalds /* 15141da177e4SLinus Torvalds * Generic function to send a packet as reply to another packet. 1515be9f4a44SEric Dumazet * Used to send some TCP resets/acks so far. 15161da177e4SLinus Torvalds */ 1517bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb, 151824a2d43dSEric Dumazet const struct ip_options *sopt, 151924a2d43dSEric Dumazet __be32 daddr, __be32 saddr, 152024a2d43dSEric Dumazet const struct ip_reply_arg *arg, 152170e73416SDavid S. Miller unsigned int len) 15221da177e4SLinus Torvalds { 1523f6d8bd05SEric Dumazet struct ip_options_data replyopts; 15241da177e4SLinus Torvalds struct ipcm_cookie ipc; 152577968b78SDavid S. Miller struct flowi4 fl4; 1526511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1527bdbbb852SEric Dumazet struct net *net = sock_net(sk); 1528be9f4a44SEric Dumazet struct sk_buff *nskb; 15294062090eSVasily Averin int err; 15301da177e4SLinus Torvalds 153124a2d43dSEric Dumazet if (__ip_options_echo(&replyopts.opt.opt, skb, sopt)) 15321da177e4SLinus Torvalds return; 15331da177e4SLinus Torvalds 15340a5ebb80SDavid S. Miller ipc.addr = daddr; 15351da177e4SLinus Torvalds ipc.opt = NULL; 15362244d07bSOliver Hartkopp ipc.tx_flags = 0; 1537aa661581SFrancesco Fusco ipc.ttl = 0; 1538aa661581SFrancesco Fusco ipc.tos = -1; 15391da177e4SLinus Torvalds 1540f6d8bd05SEric Dumazet if (replyopts.opt.opt.optlen) { 15411da177e4SLinus Torvalds ipc.opt = &replyopts.opt; 15421da177e4SLinus Torvalds 1543f6d8bd05SEric Dumazet if (replyopts.opt.opt.srr) 1544f6d8bd05SEric Dumazet daddr = replyopts.opt.opt.faddr; 15451da177e4SLinus Torvalds } 15461da177e4SLinus Torvalds 1547e110861fSLorenzo Colitti flowi4_init_output(&fl4, arg->bound_dev_if, 1548e110861fSLorenzo Colitti IP4_REPLY_MARK(net, skb->mark), 154966b13d99SEric Dumazet RT_TOS(arg->tos), 1550be9f4a44SEric Dumazet RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol, 1551538de0e0SDavid S. Miller ip_reply_arg_flowi_flags(arg), 155270e73416SDavid S. Miller daddr, saddr, 1553538de0e0SDavid S. Miller tcp_hdr(skb)->source, tcp_hdr(skb)->dest); 15549d6ec938SDavid S. Miller security_skb_classify_flow(skb, flowi4_to_flowi(&fl4)); 1555be9f4a44SEric Dumazet rt = ip_route_output_key(net, &fl4); 1556b23dd4feSDavid S. Miller if (IS_ERR(rt)) 15571da177e4SLinus Torvalds return; 15581da177e4SLinus Torvalds 1559bdbbb852SEric Dumazet inet_sk(sk)->tos = arg->tos; 15601da177e4SLinus Torvalds 15611da177e4SLinus Torvalds sk->sk_priority = skb->priority; 1562eddc9ec5SArnaldo Carvalho de Melo sk->sk_protocol = ip_hdr(skb)->protocol; 1563f0e48dbfSPatrick McHardy sk->sk_bound_dev_if = arg->bound_dev_if; 1564be9f4a44SEric Dumazet sk->sk_sndbuf = sysctl_wmem_default; 15654062090eSVasily Averin err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base, 15664062090eSVasily Averin len, 0, &ipc, &rt, MSG_DONTWAIT); 15674062090eSVasily Averin if (unlikely(err)) { 15684062090eSVasily Averin ip_flush_pending_frames(sk); 15694062090eSVasily Averin goto out; 15704062090eSVasily Averin } 15714062090eSVasily Averin 1572be9f4a44SEric Dumazet nskb = skb_peek(&sk->sk_write_queue); 1573be9f4a44SEric Dumazet if (nskb) { 15741da177e4SLinus Torvalds if (arg->csumoffset >= 0) 1575be9f4a44SEric Dumazet *((__sum16 *)skb_transport_header(nskb) + 1576be9f4a44SEric Dumazet arg->csumoffset) = csum_fold(csum_add(nskb->csum, 15779c70220bSArnaldo Carvalho de Melo arg->csum)); 1578be9f4a44SEric Dumazet nskb->ip_summed = CHECKSUM_NONE; 1579be9f4a44SEric Dumazet skb_set_queue_mapping(nskb, skb_get_queue_mapping(skb)); 158077968b78SDavid S. Miller ip_push_pending_frames(sk, &fl4); 15811da177e4SLinus Torvalds } 15824062090eSVasily Averin out: 15831da177e4SLinus Torvalds ip_rt_put(rt); 15841da177e4SLinus Torvalds } 15851da177e4SLinus Torvalds 15861da177e4SLinus Torvalds void __init ip_init(void) 15871da177e4SLinus Torvalds { 15881da177e4SLinus Torvalds ip_rt_init(); 15891da177e4SLinus Torvalds inet_initpeers(); 15901da177e4SLinus Torvalds 159172c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST) 159272c1d3bdSWANG Cong igmp_mc_init(); 15931da177e4SLinus Torvalds #endif 15941da177e4SLinus Torvalds } 1595