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 94c439cb2eSHerbert Xu int __ip_local_out(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); 1009bbc768aSJan Engelhardt return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT, skb, NULL, 1019bbc768aSJan Engelhardt skb_dst(skb)->dev, dst_output); 102c439cb2eSHerbert Xu } 103c439cb2eSHerbert Xu 104aad88724SEric Dumazet int ip_local_out_sk(struct sock *sk, struct sk_buff *skb) 105c439cb2eSHerbert Xu { 106c439cb2eSHerbert Xu int err; 107c439cb2eSHerbert Xu 108c439cb2eSHerbert Xu err = __ip_local_out(skb); 109c439cb2eSHerbert Xu if (likely(err == 1)) 110aad88724SEric Dumazet err = dst_output_sk(sk, skb); 111c439cb2eSHerbert Xu 112c439cb2eSHerbert Xu return err; 113c439cb2eSHerbert Xu } 114aad88724SEric Dumazet EXPORT_SYMBOL_GPL(ip_local_out_sk); 115c439cb2eSHerbert Xu 1161da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst) 1171da177e4SLinus Torvalds { 1181da177e4SLinus Torvalds int ttl = inet->uc_ttl; 1191da177e4SLinus Torvalds 1201da177e4SLinus Torvalds if (ttl < 0) 121323e126fSDavid S. Miller ttl = ip4_dst_hoplimit(dst); 1221da177e4SLinus Torvalds return ttl; 1231da177e4SLinus Torvalds } 1241da177e4SLinus Torvalds 1251da177e4SLinus Torvalds /* 1261da177e4SLinus Torvalds * Add an ip header to a skbuff and send it out. 1271da177e4SLinus Torvalds * 1281da177e4SLinus Torvalds */ 1291da177e4SLinus Torvalds int ip_build_and_send_pkt(struct sk_buff *skb, struct sock *sk, 130f6d8bd05SEric Dumazet __be32 saddr, __be32 daddr, struct ip_options_rcu *opt) 1311da177e4SLinus Torvalds { 1321da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 133511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1341da177e4SLinus Torvalds struct iphdr *iph; 1351da177e4SLinus Torvalds 1361da177e4SLinus Torvalds /* Build the IP header. */ 137f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (opt ? opt->opt.optlen : 0)); 1388856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 139eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 1401da177e4SLinus Torvalds iph->version = 4; 1411da177e4SLinus Torvalds iph->ihl = 5; 1421da177e4SLinus Torvalds iph->tos = inet->tos; 143d8d1f30bSChangli Gao if (ip_dont_fragment(sk, &rt->dst)) 1441da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 1451da177e4SLinus Torvalds else 1461da177e4SLinus Torvalds iph->frag_off = 0; 147d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 148dd927a26SDavid S. Miller iph->daddr = (opt && opt->opt.srr ? opt->opt.faddr : daddr); 149dd927a26SDavid S. Miller iph->saddr = saddr; 1501da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 15173f156a6SEric Dumazet ip_select_ident(skb, sk); 1521da177e4SLinus Torvalds 153f6d8bd05SEric Dumazet if (opt && opt->opt.optlen) { 154f6d8bd05SEric Dumazet iph->ihl += opt->opt.optlen>>2; 155f6d8bd05SEric Dumazet ip_options_build(skb, &opt->opt, daddr, rt, 0); 1561da177e4SLinus Torvalds } 1571da177e4SLinus Torvalds 1581da177e4SLinus Torvalds skb->priority = sk->sk_priority; 1594a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1601da177e4SLinus Torvalds 1611da177e4SLinus Torvalds /* Send it out. */ 162c439cb2eSHerbert Xu return ip_local_out(skb); 1631da177e4SLinus Torvalds } 164d8c97a94SArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip_build_and_send_pkt); 165d8c97a94SArnaldo Carvalho de Melo 1661da177e4SLinus Torvalds static inline int ip_finish_output2(struct sk_buff *skb) 1671da177e4SLinus Torvalds { 168adf30907SEric Dumazet struct dst_entry *dst = skb_dst(skb); 16980787ebcSMitsuru Chinen struct rtable *rt = (struct rtable *)dst; 1701da177e4SLinus Torvalds struct net_device *dev = dst->dev; 171c2636b4dSChuck Lever unsigned int hh_len = LL_RESERVED_SPACE(dev); 172f6b72b62SDavid S. Miller struct neighbour *neigh; 173a263b309SDavid S. Miller u32 nexthop; 1741da177e4SLinus Torvalds 175edf391ffSNeil Horman if (rt->rt_type == RTN_MULTICAST) { 176edf391ffSNeil Horman IP_UPD_PO_STATS(dev_net(dev), IPSTATS_MIB_OUTMCAST, skb->len); 177edf391ffSNeil Horman } else if (rt->rt_type == RTN_BROADCAST) 178edf391ffSNeil Horman IP_UPD_PO_STATS(dev_net(dev), IPSTATS_MIB_OUTBCAST, skb->len); 17980787ebcSMitsuru Chinen 1801da177e4SLinus Torvalds /* Be paranoid, rather than too clever. */ 1813b04dddeSStephen Hemminger if (unlikely(skb_headroom(skb) < hh_len && dev->header_ops)) { 1821da177e4SLinus Torvalds struct sk_buff *skb2; 1831da177e4SLinus Torvalds 1841da177e4SLinus Torvalds skb2 = skb_realloc_headroom(skb, LL_RESERVED_SPACE(dev)); 1851da177e4SLinus Torvalds if (skb2 == NULL) { 1861da177e4SLinus Torvalds kfree_skb(skb); 1871da177e4SLinus Torvalds return -ENOMEM; 1881da177e4SLinus Torvalds } 1891da177e4SLinus Torvalds if (skb->sk) 1901da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 1915d0ba55bSEric Dumazet consume_skb(skb); 1921da177e4SLinus Torvalds skb = skb2; 1931da177e4SLinus Torvalds } 1941da177e4SLinus Torvalds 195a263b309SDavid S. Miller rcu_read_lock_bh(); 196155e8336SJulian Anastasov nexthop = (__force u32) rt_nexthop(rt, ip_hdr(skb)->daddr); 197a263b309SDavid S. Miller neigh = __ipv4_neigh_lookup_noref(dev, nexthop); 198a263b309SDavid S. Miller if (unlikely(!neigh)) 199a263b309SDavid S. Miller neigh = __neigh_create(&arp_tbl, &nexthop, dev, false); 2009871f1adSVasiliy Kulikov if (!IS_ERR(neigh)) { 2015110effeSDavid S. Miller int res = dst_neigh_output(dst, neigh, skb); 202f2c31e32SEric Dumazet 203a263b309SDavid S. Miller rcu_read_unlock_bh(); 204f2c31e32SEric Dumazet return res; 205f2c31e32SEric Dumazet } 206a263b309SDavid S. Miller rcu_read_unlock_bh(); 20705e3aa09SDavid S. Miller 208e87cc472SJoe Perches net_dbg_ratelimited("%s: No header cache and no neighbour!\n", 209e87cc472SJoe Perches __func__); 2101da177e4SLinus Torvalds kfree_skb(skb); 2111da177e4SLinus Torvalds return -EINVAL; 2121da177e4SLinus Torvalds } 2131da177e4SLinus Torvalds 214c7ba65d7SFlorian Westphal static int ip_finish_output_gso(struct sk_buff *skb) 215c7ba65d7SFlorian Westphal { 216c7ba65d7SFlorian Westphal netdev_features_t features; 217c7ba65d7SFlorian Westphal struct sk_buff *segs; 218c7ba65d7SFlorian Westphal int ret = 0; 219c7ba65d7SFlorian Westphal 220c7ba65d7SFlorian Westphal /* common case: locally created skb or seglen is <= mtu */ 221c7ba65d7SFlorian Westphal if (((IPCB(skb)->flags & IPSKB_FORWARDED) == 0) || 222c7ba65d7SFlorian Westphal skb_gso_network_seglen(skb) <= ip_skb_dst_mtu(skb)) 223c7ba65d7SFlorian Westphal return ip_finish_output2(skb); 224c7ba65d7SFlorian Westphal 225c7ba65d7SFlorian Westphal /* Slowpath - GSO segment length is exceeding the dst MTU. 226c7ba65d7SFlorian Westphal * 227c7ba65d7SFlorian Westphal * This can happen in two cases: 228c7ba65d7SFlorian Westphal * 1) TCP GRO packet, DF bit not set 229c7ba65d7SFlorian Westphal * 2) skb arrived via virtio-net, we thus get TSO/GSO skbs directly 230c7ba65d7SFlorian Westphal * from host network stack. 231c7ba65d7SFlorian Westphal */ 232c7ba65d7SFlorian Westphal features = netif_skb_features(skb); 233c7ba65d7SFlorian Westphal segs = skb_gso_segment(skb, features & ~NETIF_F_GSO_MASK); 234330966e5SFlorian Westphal if (IS_ERR_OR_NULL(segs)) { 235c7ba65d7SFlorian Westphal kfree_skb(skb); 236c7ba65d7SFlorian Westphal return -ENOMEM; 237c7ba65d7SFlorian Westphal } 238c7ba65d7SFlorian Westphal 239c7ba65d7SFlorian Westphal consume_skb(skb); 240c7ba65d7SFlorian Westphal 241c7ba65d7SFlorian Westphal do { 242c7ba65d7SFlorian Westphal struct sk_buff *nskb = segs->next; 243c7ba65d7SFlorian Westphal int err; 244c7ba65d7SFlorian Westphal 245c7ba65d7SFlorian Westphal segs->next = NULL; 246c7ba65d7SFlorian Westphal err = ip_fragment(segs, ip_finish_output2); 247c7ba65d7SFlorian Westphal 248c7ba65d7SFlorian Westphal if (err && ret == 0) 249c7ba65d7SFlorian Westphal ret = err; 250c7ba65d7SFlorian Westphal segs = nskb; 251c7ba65d7SFlorian Westphal } while (segs); 252c7ba65d7SFlorian Westphal 253c7ba65d7SFlorian Westphal return ret; 254c7ba65d7SFlorian Westphal } 255c7ba65d7SFlorian Westphal 256861d0486SPatrick McHardy static int ip_finish_output(struct sk_buff *skb) 2571da177e4SLinus Torvalds { 2585c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM) 2595c901daaSPatrick McHardy /* Policy lookup after SNAT yielded a new policy */ 260adf30907SEric Dumazet if (skb_dst(skb)->xfrm != NULL) { 26148d5cad8SPatrick McHardy IPCB(skb)->flags |= IPSKB_REROUTED; 26248d5cad8SPatrick McHardy return dst_output(skb); 26348d5cad8SPatrick McHardy } 2645c901daaSPatrick McHardy #endif 265c7ba65d7SFlorian Westphal if (skb_is_gso(skb)) 266c7ba65d7SFlorian Westphal return ip_finish_output_gso(skb); 267c7ba65d7SFlorian Westphal 268c7ba65d7SFlorian Westphal if (skb->len > ip_skb_dst_mtu(skb)) 2691bd9bef6SPatrick McHardy return ip_fragment(skb, ip_finish_output2); 270c7ba65d7SFlorian Westphal 2711bd9bef6SPatrick McHardy return ip_finish_output2(skb); 2721da177e4SLinus Torvalds } 2731da177e4SLinus Torvalds 274aad88724SEric Dumazet int ip_mc_output(struct sock *sk, struct sk_buff *skb) 2751da177e4SLinus Torvalds { 276511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 277d8d1f30bSChangli Gao struct net_device *dev = rt->dst.dev; 2781da177e4SLinus Torvalds 2791da177e4SLinus Torvalds /* 2801da177e4SLinus Torvalds * If the indicated interface is up and running, send the packet. 2811da177e4SLinus Torvalds */ 282edf391ffSNeil Horman IP_UPD_PO_STATS(dev_net(dev), IPSTATS_MIB_OUT, skb->len); 2831da177e4SLinus Torvalds 2841da177e4SLinus Torvalds skb->dev = dev; 2851da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 2861da177e4SLinus Torvalds 2871da177e4SLinus Torvalds /* 2881da177e4SLinus Torvalds * Multicasts are looped back for other local users 2891da177e4SLinus Torvalds */ 2901da177e4SLinus Torvalds 2911da177e4SLinus Torvalds if (rt->rt_flags&RTCF_MULTICAST) { 2927ad6848cSOctavian Purdila if (sk_mc_loop(sk) 2931da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 2941da177e4SLinus Torvalds /* Small optimization: do not loopback not local frames, 2951da177e4SLinus Torvalds which returned after forwarding; they will be dropped 2961da177e4SLinus Torvalds by ip_mr_input in any case. 2971da177e4SLinus Torvalds Note, that local frames are looped back to be delivered 2981da177e4SLinus Torvalds to local recipients. 2991da177e4SLinus Torvalds 3001da177e4SLinus Torvalds This check is duplicated in ip_mr_input at the moment. 3011da177e4SLinus Torvalds */ 3029d4fb27dSJoe Perches && 3039d4fb27dSJoe Perches ((rt->rt_flags & RTCF_LOCAL) || 3049d4fb27dSJoe Perches !(IPCB(skb)->flags & IPSKB_FORWARDED)) 3051da177e4SLinus Torvalds #endif 3061da177e4SLinus Torvalds ) { 3071da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3081da177e4SLinus Torvalds if (newskb) 3099bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 3109bbc768aSJan Engelhardt newskb, NULL, newskb->dev, 31195603e22SMichel Machado dev_loopback_xmit); 3121da177e4SLinus Torvalds } 3131da177e4SLinus Torvalds 3141da177e4SLinus Torvalds /* Multicasts with ttl 0 must not go beyond the host */ 3151da177e4SLinus Torvalds 316eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl == 0) { 3171da177e4SLinus Torvalds kfree_skb(skb); 3181da177e4SLinus Torvalds return 0; 3191da177e4SLinus Torvalds } 3201da177e4SLinus Torvalds } 3211da177e4SLinus Torvalds 3221da177e4SLinus Torvalds if (rt->rt_flags&RTCF_BROADCAST) { 3231da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3241da177e4SLinus Torvalds if (newskb) 3259bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, newskb, 32695603e22SMichel Machado NULL, newskb->dev, dev_loopback_xmit); 3271da177e4SLinus Torvalds } 3281da177e4SLinus Torvalds 3299bbc768aSJan Engelhardt return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, skb, NULL, 3309bbc768aSJan Engelhardt skb->dev, ip_finish_output, 33148d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 3321da177e4SLinus Torvalds } 3331da177e4SLinus Torvalds 334aad88724SEric Dumazet int ip_output(struct sock *sk, struct sk_buff *skb) 3351da177e4SLinus Torvalds { 336adf30907SEric Dumazet struct net_device *dev = skb_dst(skb)->dev; 3371bd9bef6SPatrick McHardy 338edf391ffSNeil Horman IP_UPD_PO_STATS(dev_net(dev), IPSTATS_MIB_OUT, skb->len); 3391da177e4SLinus Torvalds 3401bd9bef6SPatrick McHardy skb->dev = dev; 3411bd9bef6SPatrick McHardy skb->protocol = htons(ETH_P_IP); 3421bd9bef6SPatrick McHardy 3439bbc768aSJan Engelhardt return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, skb, NULL, dev, 34448d5cad8SPatrick McHardy ip_finish_output, 34548d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 3461da177e4SLinus Torvalds } 3471da177e4SLinus Torvalds 34884f9307cSEric Dumazet /* 34984f9307cSEric Dumazet * copy saddr and daddr, possibly using 64bit load/stores 35084f9307cSEric Dumazet * Equivalent to : 35184f9307cSEric Dumazet * iph->saddr = fl4->saddr; 35284f9307cSEric Dumazet * iph->daddr = fl4->daddr; 35384f9307cSEric Dumazet */ 35484f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4) 35584f9307cSEric Dumazet { 35684f9307cSEric Dumazet BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) != 35784f9307cSEric Dumazet offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr)); 35884f9307cSEric Dumazet memcpy(&iph->saddr, &fl4->saddr, 35984f9307cSEric Dumazet sizeof(fl4->saddr) + sizeof(fl4->daddr)); 36084f9307cSEric Dumazet } 36184f9307cSEric Dumazet 362b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */ 363b0270e91SEric Dumazet int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl) 3641da177e4SLinus Torvalds { 3651da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 366f6d8bd05SEric Dumazet struct ip_options_rcu *inet_opt; 367b57ae01aSDavid S. Miller struct flowi4 *fl4; 3681da177e4SLinus Torvalds struct rtable *rt; 3691da177e4SLinus Torvalds struct iphdr *iph; 370ab6e3febSEric Dumazet int res; 3711da177e4SLinus Torvalds 3721da177e4SLinus Torvalds /* Skip all of this if the packet is already routed, 3731da177e4SLinus Torvalds * f.e. by something like SCTP. 3741da177e4SLinus Torvalds */ 375ab6e3febSEric Dumazet rcu_read_lock(); 376f6d8bd05SEric Dumazet inet_opt = rcu_dereference(inet->inet_opt); 377ea4fc0d6SDavid S. Miller fl4 = &fl->u.ip4; 378511c3f92SEric Dumazet rt = skb_rtable(skb); 3791da177e4SLinus Torvalds if (rt != NULL) 3801da177e4SLinus Torvalds goto packet_routed; 3811da177e4SLinus Torvalds 3821da177e4SLinus Torvalds /* Make sure we can route this packet. */ 3831da177e4SLinus Torvalds rt = (struct rtable *)__sk_dst_check(sk, 0); 3841da177e4SLinus Torvalds if (rt == NULL) { 3853ca3c68eSAl Viro __be32 daddr; 3861da177e4SLinus Torvalds 3871da177e4SLinus Torvalds /* Use correct destination address if we have options. */ 388c720c7e8SEric Dumazet daddr = inet->inet_daddr; 389f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.srr) 390f6d8bd05SEric Dumazet daddr = inet_opt->opt.faddr; 3911da177e4SLinus Torvalds 3921da177e4SLinus Torvalds /* If this fails, retransmit mechanism of transport layer will 3931da177e4SLinus Torvalds * keep trying until route appears or the connection times 3941da177e4SLinus Torvalds * itself out. 3951da177e4SLinus Torvalds */ 396b57ae01aSDavid S. Miller rt = ip_route_output_ports(sock_net(sk), fl4, sk, 39778fbfd8aSDavid S. Miller daddr, inet->inet_saddr, 39878fbfd8aSDavid S. Miller inet->inet_dport, 39978fbfd8aSDavid S. Miller inet->inet_sport, 40078fbfd8aSDavid S. Miller sk->sk_protocol, 40178fbfd8aSDavid S. Miller RT_CONN_FLAGS(sk), 40278fbfd8aSDavid S. Miller sk->sk_bound_dev_if); 403b23dd4feSDavid S. Miller if (IS_ERR(rt)) 4041da177e4SLinus Torvalds goto no_route; 405d8d1f30bSChangli Gao sk_setup_caps(sk, &rt->dst); 4061da177e4SLinus Torvalds } 407d8d1f30bSChangli Gao skb_dst_set_noref(skb, &rt->dst); 4081da177e4SLinus Torvalds 4091da177e4SLinus Torvalds packet_routed: 410155e8336SJulian Anastasov if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway) 4111da177e4SLinus Torvalds goto no_route; 4121da177e4SLinus Torvalds 4131da177e4SLinus Torvalds /* OK, we know where to send it, allocate and build IP header. */ 414f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0)); 4158856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 416eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 417714e85beSAl Viro *((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (inet->tos & 0xff)); 41860ff7467SWANG Cong if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df) 4191da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 4201da177e4SLinus Torvalds else 4211da177e4SLinus Torvalds iph->frag_off = 0; 422d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 4231da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 42484f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 42584f9307cSEric Dumazet 4261da177e4SLinus Torvalds /* Transport layer set skb->h.foo itself. */ 4271da177e4SLinus Torvalds 428f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.optlen) { 429f6d8bd05SEric Dumazet iph->ihl += inet_opt->opt.optlen >> 2; 430f6d8bd05SEric Dumazet ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0); 4311da177e4SLinus Torvalds } 4321da177e4SLinus Torvalds 43373f156a6SEric Dumazet ip_select_ident_segs(skb, sk, skb_shinfo(skb)->gso_segs ?: 1); 4341da177e4SLinus Torvalds 435b0270e91SEric Dumazet /* TODO : should we use skb->sk here instead of sk ? */ 4361da177e4SLinus Torvalds skb->priority = sk->sk_priority; 4374a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 4381da177e4SLinus Torvalds 439ab6e3febSEric Dumazet res = ip_local_out(skb); 440ab6e3febSEric Dumazet rcu_read_unlock(); 441ab6e3febSEric Dumazet return res; 4421da177e4SLinus Torvalds 4431da177e4SLinus Torvalds no_route: 444ab6e3febSEric Dumazet rcu_read_unlock(); 4455e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTNOROUTES); 4461da177e4SLinus Torvalds kfree_skb(skb); 4471da177e4SLinus Torvalds return -EHOSTUNREACH; 4481da177e4SLinus Torvalds } 4494bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_queue_xmit); 4501da177e4SLinus Torvalds 4511da177e4SLinus Torvalds 4521da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from) 4531da177e4SLinus Torvalds { 4541da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 4551da177e4SLinus Torvalds to->priority = from->priority; 4561da177e4SLinus Torvalds to->protocol = from->protocol; 457adf30907SEric Dumazet skb_dst_drop(to); 458fe76cda3SEric Dumazet skb_dst_copy(to, from); 4591da177e4SLinus Torvalds to->dev = from->dev; 46082e91ffeSThomas Graf to->mark = from->mark; 4611da177e4SLinus Torvalds 4621da177e4SLinus Torvalds /* Copy the flags to each fragment. */ 4631da177e4SLinus Torvalds IPCB(to)->flags = IPCB(from)->flags; 4641da177e4SLinus Torvalds 4651da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 4661da177e4SLinus Torvalds to->tc_index = from->tc_index; 4671da177e4SLinus Torvalds #endif 468e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 469c98d80edSJulian Anastasov #if defined(CONFIG_IP_VS) || defined(CONFIG_IP_VS_MODULE) 470c98d80edSJulian Anastasov to->ipvs_property = from->ipvs_property; 471c98d80edSJulian Anastasov #endif 472984bc16cSJames Morris skb_copy_secmark(to, from); 4731da177e4SLinus Torvalds } 4741da177e4SLinus Torvalds 4751da177e4SLinus Torvalds /* 4761da177e4SLinus Torvalds * This IP datagram is too large to be sent in one piece. Break it up into 4771da177e4SLinus Torvalds * smaller pieces (each of size equal to IP header plus 4781da177e4SLinus Torvalds * a block of the data of the original IP data part) that will yet fit in a 4791da177e4SLinus Torvalds * single device frame, and queue such a frame for sending. 4801da177e4SLinus Torvalds */ 4811da177e4SLinus Torvalds 4822e2f7aefSPatrick McHardy int ip_fragment(struct sk_buff *skb, int (*output)(struct sk_buff *)) 4831da177e4SLinus Torvalds { 4841da177e4SLinus Torvalds struct iphdr *iph; 4851da177e4SLinus Torvalds int ptr; 4861da177e4SLinus Torvalds struct net_device *dev; 4871da177e4SLinus Torvalds struct sk_buff *skb2; 488c893b806SChangli Gao unsigned int mtu, hlen, left, len, ll_rs; 4891da177e4SLinus Torvalds int offset; 49076ab608dSAlexey Dobriyan __be16 not_last_frag; 491511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 4921da177e4SLinus Torvalds int err = 0; 4931da177e4SLinus Torvalds 494d8d1f30bSChangli Gao dev = rt->dst.dev; 4951da177e4SLinus Torvalds 4961da177e4SLinus Torvalds /* 4971da177e4SLinus Torvalds * Point into the IP datagram header. 4981da177e4SLinus Torvalds */ 4991da177e4SLinus Torvalds 500eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 5011da177e4SLinus Torvalds 50269647ce4SHannes Frederic Sowa mtu = ip_skb_dst_mtu(skb); 50360ff7467SWANG Cong if (unlikely(((iph->frag_off & htons(IP_DF)) && !skb->ignore_df) || 5045f2d04f1SPatrick McHardy (IPCB(skb)->frag_max_size && 505f87c10a8SHannes Frederic Sowa IPCB(skb)->frag_max_size > mtu))) { 5065e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGFAILS); 5071da177e4SLinus Torvalds icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, 508f87c10a8SHannes Frederic Sowa htonl(mtu)); 5091da177e4SLinus Torvalds kfree_skb(skb); 5101da177e4SLinus Torvalds return -EMSGSIZE; 5111da177e4SLinus Torvalds } 5121da177e4SLinus Torvalds 5131da177e4SLinus Torvalds /* 5141da177e4SLinus Torvalds * Setup starting values. 5151da177e4SLinus Torvalds */ 5161da177e4SLinus Torvalds 5171da177e4SLinus Torvalds hlen = iph->ihl * 4; 518f87c10a8SHannes Frederic Sowa mtu = mtu - hlen; /* Size of data space */ 5191109a90cSPablo Neira Ayuso #if IS_ENABLED(CONFIG_BRIDGE_NETFILTER) 5206c79bf0fSBart De Schuymer if (skb->nf_bridge) 5216c79bf0fSBart De Schuymer mtu -= nf_bridge_mtu_reduction(skb); 5226c79bf0fSBart De Schuymer #endif 52389cee8b1SHerbert Xu IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE; 5241da177e4SLinus Torvalds 5251da177e4SLinus Torvalds /* When frag_list is given, use it. First, check its validity: 5261da177e4SLinus Torvalds * some transformers could create wrong frag_list or break existing 5271da177e4SLinus Torvalds * one, it is not prohibited. In this case fall back to copying. 5281da177e4SLinus Torvalds * 5291da177e4SLinus Torvalds * LATER: this step can be merged to real generation of fragments, 5301da177e4SLinus Torvalds * we can switch to copy when see the first bad fragment. 5311da177e4SLinus Torvalds */ 53221dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 5333d13008eSEric Dumazet struct sk_buff *frag, *frag2; 5341da177e4SLinus Torvalds int first_len = skb_pagelen(skb); 5351da177e4SLinus Torvalds 5361da177e4SLinus Torvalds if (first_len - hlen > mtu || 5371da177e4SLinus Torvalds ((first_len - hlen) & 7) || 53856f8a75cSPaul Gortmaker ip_is_fragment(iph) || 5391da177e4SLinus Torvalds skb_cloned(skb)) 5401da177e4SLinus Torvalds goto slow_path; 5411da177e4SLinus Torvalds 542d7fcf1a5SDavid S. Miller skb_walk_frags(skb, frag) { 5431da177e4SLinus Torvalds /* Correct geometry. */ 5441da177e4SLinus Torvalds if (frag->len > mtu || 5451da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 5461da177e4SLinus Torvalds skb_headroom(frag) < hlen) 5473d13008eSEric Dumazet goto slow_path_clean; 5481da177e4SLinus Torvalds 5491da177e4SLinus Torvalds /* Partially cloned skb? */ 5501da177e4SLinus Torvalds if (skb_shared(frag)) 5513d13008eSEric Dumazet goto slow_path_clean; 5522fdba6b0SHerbert Xu 5532fdba6b0SHerbert Xu BUG_ON(frag->sk); 5542fdba6b0SHerbert Xu if (skb->sk) { 5552fdba6b0SHerbert Xu frag->sk = skb->sk; 5562fdba6b0SHerbert Xu frag->destructor = sock_wfree; 5572fdba6b0SHerbert Xu } 5583d13008eSEric Dumazet skb->truesize -= frag->truesize; 5591da177e4SLinus Torvalds } 5601da177e4SLinus Torvalds 5611da177e4SLinus Torvalds /* Everything is OK. Generate! */ 5621da177e4SLinus Torvalds 5631da177e4SLinus Torvalds err = 0; 5641da177e4SLinus Torvalds offset = 0; 5651da177e4SLinus Torvalds frag = skb_shinfo(skb)->frag_list; 566d7fcf1a5SDavid S. Miller skb_frag_list_init(skb); 5671da177e4SLinus Torvalds skb->data_len = first_len - skb_headlen(skb); 5681da177e4SLinus Torvalds skb->len = first_len; 5691da177e4SLinus Torvalds iph->tot_len = htons(first_len); 5701da177e4SLinus Torvalds iph->frag_off = htons(IP_MF); 5711da177e4SLinus Torvalds ip_send_check(iph); 5721da177e4SLinus Torvalds 5731da177e4SLinus Torvalds for (;;) { 5741da177e4SLinus Torvalds /* Prepare header of the next frame, 5751da177e4SLinus Torvalds * before previous one went down. */ 5761da177e4SLinus Torvalds if (frag) { 5771da177e4SLinus Torvalds frag->ip_summed = CHECKSUM_NONE; 578badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(frag); 579e2d1bca7SArnaldo Carvalho de Melo __skb_push(frag, hlen); 580e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(frag); 581d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(frag), iph, hlen); 582eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(frag); 5831da177e4SLinus Torvalds iph->tot_len = htons(frag->len); 5841da177e4SLinus Torvalds ip_copy_metadata(frag, skb); 5851da177e4SLinus Torvalds if (offset == 0) 5861da177e4SLinus Torvalds ip_options_fragment(frag); 5871da177e4SLinus Torvalds offset += skb->len - hlen; 5881da177e4SLinus Torvalds iph->frag_off = htons(offset>>3); 5891da177e4SLinus Torvalds if (frag->next != NULL) 5901da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 5911da177e4SLinus Torvalds /* Ready, complete checksum */ 5921da177e4SLinus Torvalds ip_send_check(iph); 5931da177e4SLinus Torvalds } 5941da177e4SLinus Torvalds 5951da177e4SLinus Torvalds err = output(skb); 5961da177e4SLinus Torvalds 597dafee490SWei Dong if (!err) 5985e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGCREATES); 5991da177e4SLinus Torvalds if (err || !frag) 6001da177e4SLinus Torvalds break; 6011da177e4SLinus Torvalds 6021da177e4SLinus Torvalds skb = frag; 6031da177e4SLinus Torvalds frag = skb->next; 6041da177e4SLinus Torvalds skb->next = NULL; 6051da177e4SLinus Torvalds } 6061da177e4SLinus Torvalds 6071da177e4SLinus Torvalds if (err == 0) { 6085e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGOKS); 6091da177e4SLinus Torvalds return 0; 6101da177e4SLinus Torvalds } 6111da177e4SLinus Torvalds 6121da177e4SLinus Torvalds while (frag) { 6131da177e4SLinus Torvalds skb = frag->next; 6141da177e4SLinus Torvalds kfree_skb(frag); 6151da177e4SLinus Torvalds frag = skb; 6161da177e4SLinus Torvalds } 6175e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGFAILS); 6181da177e4SLinus Torvalds return err; 6193d13008eSEric Dumazet 6203d13008eSEric Dumazet slow_path_clean: 6213d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 6223d13008eSEric Dumazet if (frag2 == frag) 6233d13008eSEric Dumazet break; 6243d13008eSEric Dumazet frag2->sk = NULL; 6253d13008eSEric Dumazet frag2->destructor = NULL; 6263d13008eSEric Dumazet skb->truesize += frag2->truesize; 6273d13008eSEric Dumazet } 6281da177e4SLinus Torvalds } 6291da177e4SLinus Torvalds 6301da177e4SLinus Torvalds slow_path: 631fc70fb64SAlexander Duyck /* for offloaded checksums cleanup checksum before fragmentation */ 632fc70fb64SAlexander Duyck if ((skb->ip_summed == CHECKSUM_PARTIAL) && skb_checksum_help(skb)) 633fc70fb64SAlexander Duyck goto fail; 634c9af6db4SPravin B Shelar iph = ip_hdr(skb); 635fc70fb64SAlexander Duyck 6361da177e4SLinus Torvalds left = skb->len - hlen; /* Space per frame */ 63749085bd7SGeorge Kadianakis ptr = hlen; /* Where to start from */ 6381da177e4SLinus Torvalds 6391da177e4SLinus Torvalds /* for bridged IP traffic encapsulated inside f.e. a vlan header, 6409bcfcaf5SStephen Hemminger * we need to make room for the encapsulating header 6419bcfcaf5SStephen Hemminger */ 642c893b806SChangli Gao ll_rs = LL_RESERVED_SPACE_EXTRA(rt->dst.dev, nf_bridge_pad(skb)); 6439bcfcaf5SStephen Hemminger 6441da177e4SLinus Torvalds /* 6451da177e4SLinus Torvalds * Fragment the datagram. 6461da177e4SLinus Torvalds */ 6471da177e4SLinus Torvalds 6481da177e4SLinus Torvalds offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3; 6491da177e4SLinus Torvalds not_last_frag = iph->frag_off & htons(IP_MF); 6501da177e4SLinus Torvalds 6511da177e4SLinus Torvalds /* 6521da177e4SLinus Torvalds * Keep copying data until we run out. 6531da177e4SLinus Torvalds */ 6541da177e4SLinus Torvalds 6551da177e4SLinus Torvalds while (left > 0) { 6561da177e4SLinus Torvalds len = left; 6571da177e4SLinus Torvalds /* IF: it doesn't fit, use 'mtu' - the data space left */ 6581da177e4SLinus Torvalds if (len > mtu) 6591da177e4SLinus Torvalds len = mtu; 6601da177e4SLinus Torvalds /* IF: we are not sending up to and including the packet end 6611da177e4SLinus Torvalds then align the next start on an eight byte boundary */ 6621da177e4SLinus Torvalds if (len < left) { 6631da177e4SLinus Torvalds len &= ~7; 6641da177e4SLinus Torvalds } 6651da177e4SLinus Torvalds 666cbffccc9SJoe Perches /* Allocate buffer */ 667cbffccc9SJoe Perches skb2 = alloc_skb(len + hlen + ll_rs, GFP_ATOMIC); 668cbffccc9SJoe Perches if (!skb2) { 6691da177e4SLinus Torvalds err = -ENOMEM; 6701da177e4SLinus Torvalds goto fail; 6711da177e4SLinus Torvalds } 6721da177e4SLinus Torvalds 6731da177e4SLinus Torvalds /* 6741da177e4SLinus Torvalds * Set up data on packet 6751da177e4SLinus Torvalds */ 6761da177e4SLinus Torvalds 6771da177e4SLinus Torvalds ip_copy_metadata(skb2, skb); 6781da177e4SLinus Torvalds skb_reserve(skb2, ll_rs); 6791da177e4SLinus Torvalds skb_put(skb2, len + hlen); 680c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb2); 681b0e380b1SArnaldo Carvalho de Melo skb2->transport_header = skb2->network_header + hlen; 6821da177e4SLinus Torvalds 6831da177e4SLinus Torvalds /* 6841da177e4SLinus Torvalds * Charge the memory for the fragment to any owner 6851da177e4SLinus Torvalds * it might possess 6861da177e4SLinus Torvalds */ 6871da177e4SLinus Torvalds 6881da177e4SLinus Torvalds if (skb->sk) 6891da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 6901da177e4SLinus Torvalds 6911da177e4SLinus Torvalds /* 6921da177e4SLinus Torvalds * Copy the packet header into the new buffer. 6931da177e4SLinus Torvalds */ 6941da177e4SLinus Torvalds 695d626f62bSArnaldo Carvalho de Melo skb_copy_from_linear_data(skb, skb_network_header(skb2), hlen); 6961da177e4SLinus Torvalds 6971da177e4SLinus Torvalds /* 6981da177e4SLinus Torvalds * Copy a block of the IP datagram. 6991da177e4SLinus Torvalds */ 700bff9b61cSArnaldo Carvalho de Melo if (skb_copy_bits(skb, ptr, skb_transport_header(skb2), len)) 7011da177e4SLinus Torvalds BUG(); 7021da177e4SLinus Torvalds left -= len; 7031da177e4SLinus Torvalds 7041da177e4SLinus Torvalds /* 7051da177e4SLinus Torvalds * Fill in the new header fields. 7061da177e4SLinus Torvalds */ 707eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb2); 7081da177e4SLinus Torvalds iph->frag_off = htons((offset >> 3)); 7091da177e4SLinus Torvalds 7101da177e4SLinus Torvalds /* ANK: dirty, but effective trick. Upgrade options only if 7111da177e4SLinus Torvalds * the segment to be fragmented was THE FIRST (otherwise, 7121da177e4SLinus Torvalds * options are already fixed) and make it ONCE 7131da177e4SLinus Torvalds * on the initial skb, so that all the following fragments 7141da177e4SLinus Torvalds * will inherit fixed options. 7151da177e4SLinus Torvalds */ 7161da177e4SLinus Torvalds if (offset == 0) 7171da177e4SLinus Torvalds ip_options_fragment(skb); 7181da177e4SLinus Torvalds 7191da177e4SLinus Torvalds /* 7201da177e4SLinus Torvalds * Added AC : If we are fragmenting a fragment that's not the 7211da177e4SLinus Torvalds * last fragment then keep MF on each bit 7221da177e4SLinus Torvalds */ 7231da177e4SLinus Torvalds if (left > 0 || not_last_frag) 7241da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 7251da177e4SLinus Torvalds ptr += len; 7261da177e4SLinus Torvalds offset += len; 7271da177e4SLinus Torvalds 7281da177e4SLinus Torvalds /* 7291da177e4SLinus Torvalds * Put this fragment into the sending queue. 7301da177e4SLinus Torvalds */ 7311da177e4SLinus Torvalds iph->tot_len = htons(len + hlen); 7321da177e4SLinus Torvalds 7331da177e4SLinus Torvalds ip_send_check(iph); 7341da177e4SLinus Torvalds 7351da177e4SLinus Torvalds err = output(skb2); 7361da177e4SLinus Torvalds if (err) 7371da177e4SLinus Torvalds goto fail; 738dafee490SWei Dong 7395e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGCREATES); 7401da177e4SLinus Torvalds } 7415d0ba55bSEric Dumazet consume_skb(skb); 7425e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGOKS); 7431da177e4SLinus Torvalds return err; 7441da177e4SLinus Torvalds 7451da177e4SLinus Torvalds fail: 7461da177e4SLinus Torvalds kfree_skb(skb); 7475e38e270SPavel Emelyanov IP_INC_STATS(dev_net(dev), IPSTATS_MIB_FRAGFAILS); 7481da177e4SLinus Torvalds return err; 7491da177e4SLinus Torvalds } 7502e2f7aefSPatrick McHardy EXPORT_SYMBOL(ip_fragment); 7512e2f7aefSPatrick McHardy 7521da177e4SLinus Torvalds int 7531da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb) 7541da177e4SLinus Torvalds { 755f69e6d13SAl Viro struct msghdr *msg = from; 7561da177e4SLinus Torvalds 75784fa7933SPatrick McHardy if (skb->ip_summed == CHECKSUM_PARTIAL) { 75821226abbSAl Viro if (copy_from_iter(to, len, &msg->msg_iter) != len) 7591da177e4SLinus Torvalds return -EFAULT; 7601da177e4SLinus Torvalds } else { 76144bb9363SAl Viro __wsum csum = 0; 76221226abbSAl Viro if (csum_and_copy_from_iter(to, len, &csum, &msg->msg_iter) != len) 7631da177e4SLinus Torvalds return -EFAULT; 7641da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 7651da177e4SLinus Torvalds } 7661da177e4SLinus Torvalds return 0; 7671da177e4SLinus Torvalds } 7684bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag); 7691da177e4SLinus Torvalds 77044bb9363SAl Viro static inline __wsum 7711da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy) 7721da177e4SLinus Torvalds { 7731da177e4SLinus Torvalds char *kaddr; 77444bb9363SAl Viro __wsum csum; 7751da177e4SLinus Torvalds kaddr = kmap(page); 7761da177e4SLinus Torvalds csum = csum_partial(kaddr + offset, copy, 0); 7771da177e4SLinus Torvalds kunmap(page); 7781da177e4SLinus Torvalds return csum; 7791da177e4SLinus Torvalds } 7801da177e4SLinus Torvalds 7814b30b1c6SAdrian Bunk static inline int ip_ufo_append_data(struct sock *sk, 7821470ddf7SHerbert Xu struct sk_buff_head *queue, 783e89e9cf5SAnanda Raju int getfrag(void *from, char *to, int offset, int len, 784e89e9cf5SAnanda Raju int odd, struct sk_buff *skb), 785e89e9cf5SAnanda Raju void *from, int length, int hh_len, int fragheaderlen, 786d9be4f7aSBill Sommerfeld int transhdrlen, int maxfraglen, unsigned int flags) 787e89e9cf5SAnanda Raju { 788e89e9cf5SAnanda Raju struct sk_buff *skb; 789e89e9cf5SAnanda Raju int err; 790e89e9cf5SAnanda Raju 791e89e9cf5SAnanda Raju /* There is support for UDP fragmentation offload by network 792e89e9cf5SAnanda Raju * device, so create one single skb packet containing complete 793e89e9cf5SAnanda Raju * udp datagram 794e89e9cf5SAnanda Raju */ 7951470ddf7SHerbert Xu if ((skb = skb_peek_tail(queue)) == NULL) { 796e89e9cf5SAnanda Raju skb = sock_alloc_send_skb(sk, 797e89e9cf5SAnanda Raju hh_len + fragheaderlen + transhdrlen + 20, 798e89e9cf5SAnanda Raju (flags & MSG_DONTWAIT), &err); 799e89e9cf5SAnanda Raju 800e89e9cf5SAnanda Raju if (skb == NULL) 801e89e9cf5SAnanda Raju return err; 802e89e9cf5SAnanda Raju 803e89e9cf5SAnanda Raju /* reserve space for Hardware header */ 804e89e9cf5SAnanda Raju skb_reserve(skb, hh_len); 805e89e9cf5SAnanda Raju 806e89e9cf5SAnanda Raju /* create space for UDP/IP header */ 807e89e9cf5SAnanda Raju skb_put(skb, fragheaderlen + transhdrlen); 808e89e9cf5SAnanda Raju 809e89e9cf5SAnanda Raju /* initialize network header pointer */ 810c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb); 811e89e9cf5SAnanda Raju 812e89e9cf5SAnanda Raju /* initialize protocol header pointer */ 813b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header + fragheaderlen; 814e89e9cf5SAnanda Raju 815e89e9cf5SAnanda Raju skb->csum = 0; 816e89e9cf5SAnanda Raju 817e93b7d74SJiri Pirko 818e93b7d74SJiri Pirko __skb_queue_tail(queue, skb); 819e93b7d74SJiri Pirko } else if (skb_is_gso(skb)) { 820e93b7d74SJiri Pirko goto append; 821e93b7d74SJiri Pirko } 822e93b7d74SJiri Pirko 823e93b7d74SJiri Pirko skb->ip_summed = CHECKSUM_PARTIAL; 824e89e9cf5SAnanda Raju /* specify the length of each IP datagram fragment */ 825d9be4f7aSBill Sommerfeld skb_shinfo(skb)->gso_size = maxfraglen - fragheaderlen; 826f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 827be9164e7SKostya B 828e93b7d74SJiri Pirko append: 829be9164e7SKostya B return skb_append_datato_frags(sk, skb, getfrag, from, 830be9164e7SKostya B (length - transhdrlen)); 831e89e9cf5SAnanda Raju } 832e89e9cf5SAnanda Raju 833f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk, 834f5fca608SDavid S. Miller struct flowi4 *fl4, 835f5fca608SDavid S. Miller struct sk_buff_head *queue, 8361470ddf7SHerbert Xu struct inet_cork *cork, 8375640f768SEric Dumazet struct page_frag *pfrag, 8381470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, 8391470ddf7SHerbert Xu int len, int odd, struct sk_buff *skb), 8401da177e4SLinus Torvalds void *from, int length, int transhdrlen, 8411da177e4SLinus Torvalds unsigned int flags) 8421da177e4SLinus Torvalds { 8431da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 8441da177e4SLinus Torvalds struct sk_buff *skb; 8451da177e4SLinus Torvalds 84607df5294SHerbert Xu struct ip_options *opt = cork->opt; 8471da177e4SLinus Torvalds int hh_len; 8481da177e4SLinus Torvalds int exthdrlen; 8491da177e4SLinus Torvalds int mtu; 8501da177e4SLinus Torvalds int copy; 8511da177e4SLinus Torvalds int err; 8521da177e4SLinus Torvalds int offset = 0; 853daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, maxnonfragsize; 8541da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 8551470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 85609c2d251SWillem de Bruijn u32 tskey = 0; 8571da177e4SLinus Torvalds 85896d7303eSSteffen Klassert skb = skb_peek_tail(queue); 85996d7303eSSteffen Klassert 86096d7303eSSteffen Klassert exthdrlen = !skb ? rt->dst.header_len : 0; 86107df5294SHerbert Xu mtu = cork->fragsize; 86209c2d251SWillem de Bruijn if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP && 86309c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 86409c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 8651470ddf7SHerbert Xu 866d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 8671da177e4SLinus Torvalds 8681da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 8691da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 87060ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 8711da177e4SLinus Torvalds 872daba287bSHannes Frederic Sowa if (cork->length + length > maxnonfragsize - fragheaderlen) { 873f5fca608SDavid S. Miller ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 87461e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 8751da177e4SLinus Torvalds return -EMSGSIZE; 8761da177e4SLinus Torvalds } 8771da177e4SLinus Torvalds 8781da177e4SLinus Torvalds /* 8791da177e4SLinus Torvalds * transhdrlen > 0 means that this is the first fragment and we wish 8801da177e4SLinus Torvalds * it won't be fragmented in the future. 8811da177e4SLinus Torvalds */ 8821da177e4SLinus Torvalds if (transhdrlen && 8831da177e4SLinus Torvalds length + fragheaderlen <= mtu && 884d8d1f30bSChangli Gao rt->dst.dev->features & NETIF_F_V4_CSUM && 8851da177e4SLinus Torvalds !exthdrlen) 88684fa7933SPatrick McHardy csummode = CHECKSUM_PARTIAL; 8871da177e4SLinus Torvalds 8881470ddf7SHerbert Xu cork->length += length; 88926cde9f7SHerbert Xu if (((length > mtu) || (skb && skb_is_gso(skb))) && 890be9164e7SKostya B (sk->sk_protocol == IPPROTO_UDP) && 891*acf8dd0aSMichal Kubeček (rt->dst.dev->features & NETIF_F_UFO) && !rt->dst.header_len && 892*acf8dd0aSMichal Kubeček (sk->sk_type == SOCK_DGRAM)) { 8931470ddf7SHerbert Xu err = ip_ufo_append_data(sk, queue, getfrag, from, length, 8941470ddf7SHerbert Xu hh_len, fragheaderlen, transhdrlen, 895d9be4f7aSBill Sommerfeld maxfraglen, flags); 896baa829d8SPatrick McHardy if (err) 897e89e9cf5SAnanda Raju goto error; 898e89e9cf5SAnanda Raju return 0; 899e89e9cf5SAnanda Raju } 9001da177e4SLinus Torvalds 9011da177e4SLinus Torvalds /* So, what's going on in the loop below? 9021da177e4SLinus Torvalds * 9031da177e4SLinus Torvalds * We use calculated fragment length to generate chained skb, 9041da177e4SLinus Torvalds * each of segments is IP fragment ready for sending to network after 9051da177e4SLinus Torvalds * adding appropriate IP header. 9061da177e4SLinus Torvalds */ 9071da177e4SLinus Torvalds 90826cde9f7SHerbert Xu if (!skb) 9091da177e4SLinus Torvalds goto alloc_new_skb; 9101da177e4SLinus Torvalds 9111da177e4SLinus Torvalds while (length > 0) { 9121da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 9131da177e4SLinus Torvalds copy = mtu - skb->len; 9141da177e4SLinus Torvalds if (copy < length) 9151da177e4SLinus Torvalds copy = maxfraglen - skb->len; 9161da177e4SLinus Torvalds if (copy <= 0) { 9171da177e4SLinus Torvalds char *data; 9181da177e4SLinus Torvalds unsigned int datalen; 9191da177e4SLinus Torvalds unsigned int fraglen; 9201da177e4SLinus Torvalds unsigned int fraggap; 9211da177e4SLinus Torvalds unsigned int alloclen; 9221da177e4SLinus Torvalds struct sk_buff *skb_prev; 9231da177e4SLinus Torvalds alloc_new_skb: 9241da177e4SLinus Torvalds skb_prev = skb; 9251da177e4SLinus Torvalds if (skb_prev) 9261da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 9271da177e4SLinus Torvalds else 9281da177e4SLinus Torvalds fraggap = 0; 9291da177e4SLinus Torvalds 9301da177e4SLinus Torvalds /* 9311da177e4SLinus Torvalds * If remaining data exceeds the mtu, 9321da177e4SLinus Torvalds * we know we need more fragment(s). 9331da177e4SLinus Torvalds */ 9341da177e4SLinus Torvalds datalen = length + fraggap; 9351da177e4SLinus Torvalds if (datalen > mtu - fragheaderlen) 9361da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 9371da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 9381da177e4SLinus Torvalds 9391da177e4SLinus Torvalds if ((flags & MSG_MORE) && 940d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 9411da177e4SLinus Torvalds alloclen = mtu; 9421da177e4SLinus Torvalds else 94359104f06SEric Dumazet alloclen = fraglen; 9441da177e4SLinus Torvalds 945353e5c9aSSteffen Klassert alloclen += exthdrlen; 946353e5c9aSSteffen Klassert 9471da177e4SLinus Torvalds /* The last fragment gets additional space at tail. 9481da177e4SLinus Torvalds * Note, with MSG_MORE we overallocate on fragments, 9491da177e4SLinus Torvalds * because we have no idea what fragment will be 9501da177e4SLinus Torvalds * the last. 9511da177e4SLinus Torvalds */ 95233f99dc7SSteffen Klassert if (datalen == length + fraggap) 953d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 95433f99dc7SSteffen Klassert 9551da177e4SLinus Torvalds if (transhdrlen) { 9561da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 9571da177e4SLinus Torvalds alloclen + hh_len + 15, 9581da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 9591da177e4SLinus Torvalds } else { 9601da177e4SLinus Torvalds skb = NULL; 9611da177e4SLinus Torvalds if (atomic_read(&sk->sk_wmem_alloc) <= 9621da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 9631da177e4SLinus Torvalds skb = sock_wmalloc(sk, 9641da177e4SLinus Torvalds alloclen + hh_len + 15, 1, 9651da177e4SLinus Torvalds sk->sk_allocation); 9661da177e4SLinus Torvalds if (unlikely(skb == NULL)) 9671da177e4SLinus Torvalds err = -ENOBUFS; 9681da177e4SLinus Torvalds } 9691da177e4SLinus Torvalds if (skb == NULL) 9701da177e4SLinus Torvalds goto error; 9711da177e4SLinus Torvalds 9721da177e4SLinus Torvalds /* 9731da177e4SLinus Torvalds * Fill in the control structures 9741da177e4SLinus Torvalds */ 9751da177e4SLinus Torvalds skb->ip_summed = csummode; 9761da177e4SLinus Torvalds skb->csum = 0; 9771da177e4SLinus Torvalds skb_reserve(skb, hh_len); 97811878b40SWillem de Bruijn 97911878b40SWillem de Bruijn /* only the initial fragment is time stamped */ 9801470ddf7SHerbert Xu skb_shinfo(skb)->tx_flags = cork->tx_flags; 98111878b40SWillem de Bruijn cork->tx_flags = 0; 98209c2d251SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 98309c2d251SWillem de Bruijn tskey = 0; 9841da177e4SLinus Torvalds 9851da177e4SLinus Torvalds /* 9861da177e4SLinus Torvalds * Find where to start putting bytes. 9871da177e4SLinus Torvalds */ 988353e5c9aSSteffen Klassert data = skb_put(skb, fraglen + exthdrlen); 989c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 990b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 991b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 992353e5c9aSSteffen Klassert data += fragheaderlen + exthdrlen; 9931da177e4SLinus Torvalds 9941da177e4SLinus Torvalds if (fraggap) { 9951da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 9961da177e4SLinus Torvalds skb_prev, maxfraglen, 9971da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 9981da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 9991da177e4SLinus Torvalds skb->csum); 10001da177e4SLinus Torvalds data += fraggap; 1001e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 10021da177e4SLinus Torvalds } 10031da177e4SLinus Torvalds 10041da177e4SLinus Torvalds copy = datalen - transhdrlen - fraggap; 10051da177e4SLinus Torvalds if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 10061da177e4SLinus Torvalds err = -EFAULT; 10071da177e4SLinus Torvalds kfree_skb(skb); 10081da177e4SLinus Torvalds goto error; 10091da177e4SLinus Torvalds } 10101da177e4SLinus Torvalds 10111da177e4SLinus Torvalds offset += copy; 10121da177e4SLinus Torvalds length -= datalen - fraggap; 10131da177e4SLinus Torvalds transhdrlen = 0; 10141da177e4SLinus Torvalds exthdrlen = 0; 10151da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 10161da177e4SLinus Torvalds 10171da177e4SLinus Torvalds /* 10181da177e4SLinus Torvalds * Put the packet on the pending queue. 10191da177e4SLinus Torvalds */ 10201470ddf7SHerbert Xu __skb_queue_tail(queue, skb); 10211da177e4SLinus Torvalds continue; 10221da177e4SLinus Torvalds } 10231da177e4SLinus Torvalds 10241da177e4SLinus Torvalds if (copy > length) 10251da177e4SLinus Torvalds copy = length; 10261da177e4SLinus Torvalds 1027d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) { 10281da177e4SLinus Torvalds unsigned int off; 10291da177e4SLinus Torvalds 10301da177e4SLinus Torvalds off = skb->len; 10311da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 10321da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 10331da177e4SLinus Torvalds __skb_trim(skb, off); 10341da177e4SLinus Torvalds err = -EFAULT; 10351da177e4SLinus Torvalds goto error; 10361da177e4SLinus Torvalds } 10371da177e4SLinus Torvalds } else { 10381da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 10391da177e4SLinus Torvalds 10401da177e4SLinus Torvalds err = -ENOMEM; 10415640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 10421da177e4SLinus Torvalds goto error; 10431da177e4SLinus Torvalds 10445640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 10455640f768SEric Dumazet pfrag->offset)) { 10461da177e4SLinus Torvalds err = -EMSGSIZE; 10475640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 10481da177e4SLinus Torvalds goto error; 10495640f768SEric Dumazet 10505640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 10515640f768SEric Dumazet pfrag->offset, 0); 10525640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 10535640f768SEric Dumazet get_page(pfrag->page); 10541da177e4SLinus Torvalds } 10555640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 10565640f768SEric Dumazet if (getfrag(from, 10575640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 10585640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 10595640f768SEric Dumazet goto error_efault; 10605640f768SEric Dumazet 10615640f768SEric Dumazet pfrag->offset += copy; 10625640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 10631da177e4SLinus Torvalds skb->len += copy; 10641da177e4SLinus Torvalds skb->data_len += copy; 1065f945fa7aSHerbert Xu skb->truesize += copy; 1066f945fa7aSHerbert Xu atomic_add(copy, &sk->sk_wmem_alloc); 10671da177e4SLinus Torvalds } 10681da177e4SLinus Torvalds offset += copy; 10691da177e4SLinus Torvalds length -= copy; 10701da177e4SLinus Torvalds } 10711da177e4SLinus Torvalds 10721da177e4SLinus Torvalds return 0; 10731da177e4SLinus Torvalds 10745640f768SEric Dumazet error_efault: 10755640f768SEric Dumazet err = -EFAULT; 10761da177e4SLinus Torvalds error: 10771470ddf7SHerbert Xu cork->length -= length; 10785e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 10791da177e4SLinus Torvalds return err; 10801da177e4SLinus Torvalds } 10811da177e4SLinus Torvalds 10821470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork, 10831470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp) 10841470ddf7SHerbert Xu { 1085f6d8bd05SEric Dumazet struct ip_options_rcu *opt; 10861470ddf7SHerbert Xu struct rtable *rt; 10871470ddf7SHerbert Xu 10881470ddf7SHerbert Xu /* 10891470ddf7SHerbert Xu * setup for corking. 10901470ddf7SHerbert Xu */ 10911470ddf7SHerbert Xu opt = ipc->opt; 10921470ddf7SHerbert Xu if (opt) { 10931470ddf7SHerbert Xu if (cork->opt == NULL) { 10941470ddf7SHerbert Xu cork->opt = kmalloc(sizeof(struct ip_options) + 40, 10951470ddf7SHerbert Xu sk->sk_allocation); 10961470ddf7SHerbert Xu if (unlikely(cork->opt == NULL)) 10971470ddf7SHerbert Xu return -ENOBUFS; 10981470ddf7SHerbert Xu } 1099f6d8bd05SEric Dumazet memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen); 11001470ddf7SHerbert Xu cork->flags |= IPCORK_OPT; 11011470ddf7SHerbert Xu cork->addr = ipc->addr; 11021470ddf7SHerbert Xu } 11031470ddf7SHerbert Xu rt = *rtp; 11041470ddf7SHerbert Xu if (unlikely(!rt)) 11051470ddf7SHerbert Xu return -EFAULT; 11061470ddf7SHerbert Xu /* 11071470ddf7SHerbert Xu * We steal reference to this route, caller should not release it 11081470ddf7SHerbert Xu */ 11091470ddf7SHerbert Xu *rtp = NULL; 1110482fc609SHannes Frederic Sowa cork->fragsize = ip_sk_use_pmtu(sk) ? 1111482fc609SHannes Frederic Sowa dst_mtu(&rt->dst) : rt->dst.dev->mtu; 11121470ddf7SHerbert Xu cork->dst = &rt->dst; 11131470ddf7SHerbert Xu cork->length = 0; 1114aa661581SFrancesco Fusco cork->ttl = ipc->ttl; 1115aa661581SFrancesco Fusco cork->tos = ipc->tos; 1116aa661581SFrancesco Fusco cork->priority = ipc->priority; 11171470ddf7SHerbert Xu cork->tx_flags = ipc->tx_flags; 11181470ddf7SHerbert Xu 11191470ddf7SHerbert Xu return 0; 11201470ddf7SHerbert Xu } 11211470ddf7SHerbert Xu 11221470ddf7SHerbert Xu /* 11231470ddf7SHerbert Xu * ip_append_data() and ip_append_page() can make one large IP datagram 11241470ddf7SHerbert Xu * from many pieces of data. Each pieces will be holded on the socket 11251470ddf7SHerbert Xu * until ip_push_pending_frames() is called. Each piece can be a page 11261470ddf7SHerbert Xu * or non-page data. 11271470ddf7SHerbert Xu * 11281470ddf7SHerbert Xu * Not only UDP, other transport protocols - e.g. raw sockets - can use 11291470ddf7SHerbert Xu * this interface potentially. 11301470ddf7SHerbert Xu * 11311470ddf7SHerbert Xu * LATER: length must be adjusted by pad at tail, when it is required. 11321470ddf7SHerbert Xu */ 1133f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4, 11341470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, int len, 11351470ddf7SHerbert Xu int odd, struct sk_buff *skb), 11361470ddf7SHerbert Xu void *from, int length, int transhdrlen, 11371470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 11381470ddf7SHerbert Xu unsigned int flags) 11391470ddf7SHerbert Xu { 11401470ddf7SHerbert Xu struct inet_sock *inet = inet_sk(sk); 11411470ddf7SHerbert Xu int err; 11421470ddf7SHerbert Xu 11431470ddf7SHerbert Xu if (flags&MSG_PROBE) 11441470ddf7SHerbert Xu return 0; 11451470ddf7SHerbert Xu 11461470ddf7SHerbert Xu if (skb_queue_empty(&sk->sk_write_queue)) { 1147bdc712b4SDavid S. Miller err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp); 11481470ddf7SHerbert Xu if (err) 11491470ddf7SHerbert Xu return err; 11501470ddf7SHerbert Xu } else { 11511470ddf7SHerbert Xu transhdrlen = 0; 11521470ddf7SHerbert Xu } 11531470ddf7SHerbert Xu 11545640f768SEric Dumazet return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base, 11555640f768SEric Dumazet sk_page_frag(sk), getfrag, 11561470ddf7SHerbert Xu from, length, transhdrlen, flags); 11571470ddf7SHerbert Xu } 11581470ddf7SHerbert Xu 1159f5fca608SDavid S. Miller ssize_t ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page, 11601da177e4SLinus Torvalds int offset, size_t size, int flags) 11611da177e4SLinus Torvalds { 11621da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 11631da177e4SLinus Torvalds struct sk_buff *skb; 11641da177e4SLinus Torvalds struct rtable *rt; 11651da177e4SLinus Torvalds struct ip_options *opt = NULL; 1166bdc712b4SDavid S. Miller struct inet_cork *cork; 11671da177e4SLinus Torvalds int hh_len; 11681da177e4SLinus Torvalds int mtu; 11691da177e4SLinus Torvalds int len; 11701da177e4SLinus Torvalds int err; 1171daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize; 11721da177e4SLinus Torvalds 11731da177e4SLinus Torvalds if (inet->hdrincl) 11741da177e4SLinus Torvalds return -EPERM; 11751da177e4SLinus Torvalds 11761da177e4SLinus Torvalds if (flags&MSG_PROBE) 11771da177e4SLinus Torvalds return 0; 11781da177e4SLinus Torvalds 11791da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) 11801da177e4SLinus Torvalds return -EINVAL; 11811da177e4SLinus Torvalds 1182bdc712b4SDavid S. Miller cork = &inet->cork.base; 1183bdc712b4SDavid S. Miller rt = (struct rtable *)cork->dst; 1184bdc712b4SDavid S. Miller if (cork->flags & IPCORK_OPT) 1185bdc712b4SDavid S. Miller opt = cork->opt; 11861da177e4SLinus Torvalds 1187d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) 11881da177e4SLinus Torvalds return -EOPNOTSUPP; 11891da177e4SLinus Torvalds 1190d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 1191bdc712b4SDavid S. Miller mtu = cork->fragsize; 11921da177e4SLinus Torvalds 11931da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 11941da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 119560ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 11961da177e4SLinus Torvalds 1197daba287bSHannes Frederic Sowa if (cork->length + size > maxnonfragsize - fragheaderlen) { 119861e7f09dSHannes Frederic Sowa ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 119961e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 12001da177e4SLinus Torvalds return -EMSGSIZE; 12011da177e4SLinus Torvalds } 12021da177e4SLinus Torvalds 12031da177e4SLinus Torvalds if ((skb = skb_peek_tail(&sk->sk_write_queue)) == NULL) 12041da177e4SLinus Torvalds return -EINVAL; 12051da177e4SLinus Torvalds 1206bdc712b4SDavid S. Miller cork->length += size; 120726cde9f7SHerbert Xu if ((size + skb->len > mtu) && 120826cde9f7SHerbert Xu (sk->sk_protocol == IPPROTO_UDP) && 1209d8d1f30bSChangli Gao (rt->dst.dev->features & NETIF_F_UFO)) { 12107967168cSHerbert Xu skb_shinfo(skb)->gso_size = mtu - fragheaderlen; 1211f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 12127967168cSHerbert Xu } 1213e89e9cf5SAnanda Raju 12141da177e4SLinus Torvalds 12151da177e4SLinus Torvalds while (size > 0) { 12161da177e4SLinus Torvalds int i; 12171da177e4SLinus Torvalds 121889114afdSHerbert Xu if (skb_is_gso(skb)) 1219e89e9cf5SAnanda Raju len = size; 1220e89e9cf5SAnanda Raju else { 1221e89e9cf5SAnanda Raju 12221da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 12231da177e4SLinus Torvalds len = mtu - skb->len; 12241da177e4SLinus Torvalds if (len < size) 12251da177e4SLinus Torvalds len = maxfraglen - skb->len; 1226e89e9cf5SAnanda Raju } 12271da177e4SLinus Torvalds if (len <= 0) { 12281da177e4SLinus Torvalds struct sk_buff *skb_prev; 12291da177e4SLinus Torvalds int alloclen; 12301da177e4SLinus Torvalds 12311da177e4SLinus Torvalds skb_prev = skb; 12321da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 12331da177e4SLinus Torvalds 12341da177e4SLinus Torvalds alloclen = fragheaderlen + hh_len + fraggap + 15; 12351da177e4SLinus Torvalds skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation); 12361da177e4SLinus Torvalds if (unlikely(!skb)) { 12371da177e4SLinus Torvalds err = -ENOBUFS; 12381da177e4SLinus Torvalds goto error; 12391da177e4SLinus Torvalds } 12401da177e4SLinus Torvalds 12411da177e4SLinus Torvalds /* 12421da177e4SLinus Torvalds * Fill in the control structures 12431da177e4SLinus Torvalds */ 12441da177e4SLinus Torvalds skb->ip_summed = CHECKSUM_NONE; 12451da177e4SLinus Torvalds skb->csum = 0; 12461da177e4SLinus Torvalds skb_reserve(skb, hh_len); 12471da177e4SLinus Torvalds 12481da177e4SLinus Torvalds /* 12491da177e4SLinus Torvalds * Find where to start putting bytes. 12501da177e4SLinus Torvalds */ 1251967b05f6SArnaldo Carvalho de Melo skb_put(skb, fragheaderlen + fraggap); 12522ca9e6f2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1253b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1254b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 12551da177e4SLinus Torvalds if (fraggap) { 1256967b05f6SArnaldo Carvalho de Melo skb->csum = skb_copy_and_csum_bits(skb_prev, 1257967b05f6SArnaldo Carvalho de Melo maxfraglen, 12589c70220bSArnaldo Carvalho de Melo skb_transport_header(skb), 1259967b05f6SArnaldo Carvalho de Melo fraggap, 0); 12601da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 12611da177e4SLinus Torvalds skb->csum); 1262e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 12631da177e4SLinus Torvalds } 12641da177e4SLinus Torvalds 12651da177e4SLinus Torvalds /* 12661da177e4SLinus Torvalds * Put the packet on the pending queue. 12671da177e4SLinus Torvalds */ 12681da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 12691da177e4SLinus Torvalds continue; 12701da177e4SLinus Torvalds } 12711da177e4SLinus Torvalds 12721da177e4SLinus Torvalds i = skb_shinfo(skb)->nr_frags; 12731da177e4SLinus Torvalds if (len > size) 12741da177e4SLinus Torvalds len = size; 12751da177e4SLinus Torvalds if (skb_can_coalesce(skb, i, page, offset)) { 12769e903e08SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i-1], len); 12771da177e4SLinus Torvalds } else if (i < MAX_SKB_FRAGS) { 12781da177e4SLinus Torvalds get_page(page); 12791da177e4SLinus Torvalds skb_fill_page_desc(skb, i, page, offset, len); 12801da177e4SLinus Torvalds } else { 12811da177e4SLinus Torvalds err = -EMSGSIZE; 12821da177e4SLinus Torvalds goto error; 12831da177e4SLinus Torvalds } 12841da177e4SLinus Torvalds 12851da177e4SLinus Torvalds if (skb->ip_summed == CHECKSUM_NONE) { 128644bb9363SAl Viro __wsum csum; 12871da177e4SLinus Torvalds csum = csum_page(page, offset, len); 12881da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, skb->len); 12891da177e4SLinus Torvalds } 12901da177e4SLinus Torvalds 12911da177e4SLinus Torvalds skb->len += len; 12921da177e4SLinus Torvalds skb->data_len += len; 12931e34a11dSDavid S. Miller skb->truesize += len; 12941e34a11dSDavid S. Miller atomic_add(len, &sk->sk_wmem_alloc); 12951da177e4SLinus Torvalds offset += len; 12961da177e4SLinus Torvalds size -= len; 12971da177e4SLinus Torvalds } 12981da177e4SLinus Torvalds return 0; 12991da177e4SLinus Torvalds 13001da177e4SLinus Torvalds error: 1301bdc712b4SDavid S. Miller cork->length -= size; 13025e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 13031da177e4SLinus Torvalds return err; 13041da177e4SLinus Torvalds } 13051da177e4SLinus Torvalds 13061470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork) 1307429f08e9SPavel Emelyanov { 13081470ddf7SHerbert Xu cork->flags &= ~IPCORK_OPT; 13091470ddf7SHerbert Xu kfree(cork->opt); 13101470ddf7SHerbert Xu cork->opt = NULL; 13111470ddf7SHerbert Xu dst_release(cork->dst); 13121470ddf7SHerbert Xu cork->dst = NULL; 1313429f08e9SPavel Emelyanov } 1314429f08e9SPavel Emelyanov 13151da177e4SLinus Torvalds /* 13161da177e4SLinus Torvalds * Combined all pending IP fragments on the socket as one IP datagram 13171da177e4SLinus Torvalds * and push them out. 13181da177e4SLinus Torvalds */ 13191c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk, 132077968b78SDavid S. Miller struct flowi4 *fl4, 13211470ddf7SHerbert Xu struct sk_buff_head *queue, 13221470ddf7SHerbert Xu struct inet_cork *cork) 13231da177e4SLinus Torvalds { 13241da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 13251da177e4SLinus Torvalds struct sk_buff **tail_skb; 13261da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 13270388b004SPavel Emelyanov struct net *net = sock_net(sk); 13281da177e4SLinus Torvalds struct ip_options *opt = NULL; 13291470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 13301da177e4SLinus Torvalds struct iphdr *iph; 133176ab608dSAlexey Dobriyan __be16 df = 0; 13321da177e4SLinus Torvalds __u8 ttl; 13331da177e4SLinus Torvalds 13341470ddf7SHerbert Xu if ((skb = __skb_dequeue(queue)) == NULL) 13351da177e4SLinus Torvalds goto out; 13361da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 13371da177e4SLinus Torvalds 13381da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1339d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1340bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 13411470ddf7SHerbert Xu while ((tmp_skb = __skb_dequeue(queue)) != NULL) { 1342cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 13431da177e4SLinus Torvalds *tail_skb = tmp_skb; 13441da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 13451da177e4SLinus Torvalds skb->len += tmp_skb->len; 13461da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 13471da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 13481da177e4SLinus Torvalds tmp_skb->destructor = NULL; 13491da177e4SLinus Torvalds tmp_skb->sk = NULL; 13501da177e4SLinus Torvalds } 13511da177e4SLinus Torvalds 13521da177e4SLinus Torvalds /* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow 13531da177e4SLinus Torvalds * to fragment the frame generated here. No matter, what transforms 13541da177e4SLinus Torvalds * how transforms change size of the packet, it will come out. 13551da177e4SLinus Torvalds */ 135660ff7467SWANG Cong skb->ignore_df = ip_sk_ignore_df(sk); 13571da177e4SLinus Torvalds 13581da177e4SLinus Torvalds /* DF bit is set when we want to see DF on outgoing frames. 135960ff7467SWANG Cong * If ignore_df is set too, we still allow to fragment this frame 13601da177e4SLinus Torvalds * locally. */ 1361482fc609SHannes Frederic Sowa if (inet->pmtudisc == IP_PMTUDISC_DO || 1362482fc609SHannes Frederic Sowa inet->pmtudisc == IP_PMTUDISC_PROBE || 1363d8d1f30bSChangli Gao (skb->len <= dst_mtu(&rt->dst) && 1364d8d1f30bSChangli Gao ip_dont_fragment(sk, &rt->dst))) 13651da177e4SLinus Torvalds df = htons(IP_DF); 13661da177e4SLinus Torvalds 13671470ddf7SHerbert Xu if (cork->flags & IPCORK_OPT) 13681470ddf7SHerbert Xu opt = cork->opt; 13691da177e4SLinus Torvalds 1370aa661581SFrancesco Fusco if (cork->ttl != 0) 1371aa661581SFrancesco Fusco ttl = cork->ttl; 1372aa661581SFrancesco Fusco else if (rt->rt_type == RTN_MULTICAST) 13731da177e4SLinus Torvalds ttl = inet->mc_ttl; 13741da177e4SLinus Torvalds else 1375d8d1f30bSChangli Gao ttl = ip_select_ttl(inet, &rt->dst); 13761da177e4SLinus Torvalds 1377749154aaSAnsis Atteka iph = ip_hdr(skb); 13781da177e4SLinus Torvalds iph->version = 4; 13791da177e4SLinus Torvalds iph->ihl = 5; 1380aa661581SFrancesco Fusco iph->tos = (cork->tos != -1) ? cork->tos : inet->tos; 13811da177e4SLinus Torvalds iph->frag_off = df; 13821da177e4SLinus Torvalds iph->ttl = ttl; 13831da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 138484f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 138573f156a6SEric Dumazet ip_select_ident(skb, sk); 13861da177e4SLinus Torvalds 138722f728f8SDavid S. Miller if (opt) { 138822f728f8SDavid S. Miller iph->ihl += opt->optlen>>2; 138922f728f8SDavid S. Miller ip_options_build(skb, opt, cork->addr, rt, 0); 139022f728f8SDavid S. Miller } 139122f728f8SDavid S. Miller 1392aa661581SFrancesco Fusco skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority; 13934a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1394a21bba94SEric Dumazet /* 1395a21bba94SEric Dumazet * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec 1396a21bba94SEric Dumazet * on dst refcount 1397a21bba94SEric Dumazet */ 13981470ddf7SHerbert Xu cork->dst = NULL; 1399d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 14001da177e4SLinus Torvalds 140196793b48SDavid L Stevens if (iph->protocol == IPPROTO_ICMP) 14020388b004SPavel Emelyanov icmp_out_count(net, ((struct icmphdr *) 140396793b48SDavid L Stevens skb_transport_header(skb))->type); 140496793b48SDavid L Stevens 14051c32c5adSHerbert Xu ip_cork_release(cork); 14061c32c5adSHerbert Xu out: 14071c32c5adSHerbert Xu return skb; 14081c32c5adSHerbert Xu } 14091c32c5adSHerbert Xu 1410b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb) 14111c32c5adSHerbert Xu { 14121c32c5adSHerbert Xu int err; 14131c32c5adSHerbert Xu 1414c439cb2eSHerbert Xu err = ip_local_out(skb); 14151da177e4SLinus Torvalds if (err) { 14161da177e4SLinus Torvalds if (err > 0) 14176ce9e7b5SEric Dumazet err = net_xmit_errno(err); 14181da177e4SLinus Torvalds if (err) 14191c32c5adSHerbert Xu IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS); 14201da177e4SLinus Torvalds } 14211da177e4SLinus Torvalds 14221da177e4SLinus Torvalds return err; 14231da177e4SLinus Torvalds } 14241da177e4SLinus Torvalds 142577968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4) 14261470ddf7SHerbert Xu { 14271c32c5adSHerbert Xu struct sk_buff *skb; 14281c32c5adSHerbert Xu 142977968b78SDavid S. Miller skb = ip_finish_skb(sk, fl4); 14301c32c5adSHerbert Xu if (!skb) 14311c32c5adSHerbert Xu return 0; 14321c32c5adSHerbert Xu 14331c32c5adSHerbert Xu /* Netfilter gets whole the not fragmented skb. */ 1434b5ec8eeaSEric Dumazet return ip_send_skb(sock_net(sk), skb); 14351470ddf7SHerbert Xu } 14361470ddf7SHerbert Xu 14371da177e4SLinus Torvalds /* 14381da177e4SLinus Torvalds * Throw away all pending data on the socket. 14391da177e4SLinus Torvalds */ 14401470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk, 14411470ddf7SHerbert Xu struct sk_buff_head *queue, 14421470ddf7SHerbert Xu struct inet_cork *cork) 14431da177e4SLinus Torvalds { 14441da177e4SLinus Torvalds struct sk_buff *skb; 14451da177e4SLinus Torvalds 14461470ddf7SHerbert Xu while ((skb = __skb_dequeue_tail(queue)) != NULL) 14471da177e4SLinus Torvalds kfree_skb(skb); 14481da177e4SLinus Torvalds 14491470ddf7SHerbert Xu ip_cork_release(cork); 14501470ddf7SHerbert Xu } 14511470ddf7SHerbert Xu 14521470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk) 14531470ddf7SHerbert Xu { 1454bdc712b4SDavid S. Miller __ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base); 14551da177e4SLinus Torvalds } 14561da177e4SLinus Torvalds 14571c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk, 145877968b78SDavid S. Miller struct flowi4 *fl4, 14591c32c5adSHerbert Xu int getfrag(void *from, char *to, int offset, 14601c32c5adSHerbert Xu int len, int odd, struct sk_buff *skb), 14611c32c5adSHerbert Xu void *from, int length, int transhdrlen, 14621c32c5adSHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 14631c32c5adSHerbert Xu unsigned int flags) 14641c32c5adSHerbert Xu { 1465b80d7226SDavid S. Miller struct inet_cork cork; 14661c32c5adSHerbert Xu struct sk_buff_head queue; 14671c32c5adSHerbert Xu int err; 14681c32c5adSHerbert Xu 14691c32c5adSHerbert Xu if (flags & MSG_PROBE) 14701c32c5adSHerbert Xu return NULL; 14711c32c5adSHerbert Xu 14721c32c5adSHerbert Xu __skb_queue_head_init(&queue); 14731c32c5adSHerbert Xu 1474b80d7226SDavid S. Miller cork.flags = 0; 1475b80d7226SDavid S. Miller cork.addr = 0; 147670652728SDavid S. Miller cork.opt = NULL; 14771c32c5adSHerbert Xu err = ip_setup_cork(sk, &cork, ipc, rtp); 14781c32c5adSHerbert Xu if (err) 14791c32c5adSHerbert Xu return ERR_PTR(err); 14801c32c5adSHerbert Xu 14815640f768SEric Dumazet err = __ip_append_data(sk, fl4, &queue, &cork, 14825640f768SEric Dumazet ¤t->task_frag, getfrag, 14831c32c5adSHerbert Xu from, length, transhdrlen, flags); 14841c32c5adSHerbert Xu if (err) { 14851c32c5adSHerbert Xu __ip_flush_pending_frames(sk, &queue, &cork); 14861c32c5adSHerbert Xu return ERR_PTR(err); 14871c32c5adSHerbert Xu } 14881c32c5adSHerbert Xu 148977968b78SDavid S. Miller return __ip_make_skb(sk, fl4, &queue, &cork); 14901c32c5adSHerbert Xu } 14911da177e4SLinus Torvalds 14921da177e4SLinus Torvalds /* 14931da177e4SLinus Torvalds * Fetch data from kernel space and fill in checksum if needed. 14941da177e4SLinus Torvalds */ 14951da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset, 14961da177e4SLinus Torvalds int len, int odd, struct sk_buff *skb) 14971da177e4SLinus Torvalds { 14985084205fSAl Viro __wsum csum; 14991da177e4SLinus Torvalds 15001da177e4SLinus Torvalds csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0); 15011da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 15021da177e4SLinus Torvalds return 0; 15031da177e4SLinus Torvalds } 15041da177e4SLinus Torvalds 15051da177e4SLinus Torvalds /* 15061da177e4SLinus Torvalds * Generic function to send a packet as reply to another packet. 1507be9f4a44SEric Dumazet * Used to send some TCP resets/acks so far. 15081da177e4SLinus Torvalds */ 1509bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb, 151024a2d43dSEric Dumazet const struct ip_options *sopt, 151124a2d43dSEric Dumazet __be32 daddr, __be32 saddr, 151224a2d43dSEric Dumazet const struct ip_reply_arg *arg, 151370e73416SDavid S. Miller unsigned int len) 15141da177e4SLinus Torvalds { 1515f6d8bd05SEric Dumazet struct ip_options_data replyopts; 15161da177e4SLinus Torvalds struct ipcm_cookie ipc; 151777968b78SDavid S. Miller struct flowi4 fl4; 1518511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1519bdbbb852SEric Dumazet struct net *net = sock_net(sk); 1520be9f4a44SEric Dumazet struct sk_buff *nskb; 15214062090eSVasily Averin int err; 15221da177e4SLinus Torvalds 152324a2d43dSEric Dumazet if (__ip_options_echo(&replyopts.opt.opt, skb, sopt)) 15241da177e4SLinus Torvalds return; 15251da177e4SLinus Torvalds 15260a5ebb80SDavid S. Miller ipc.addr = daddr; 15271da177e4SLinus Torvalds ipc.opt = NULL; 15282244d07bSOliver Hartkopp ipc.tx_flags = 0; 1529aa661581SFrancesco Fusco ipc.ttl = 0; 1530aa661581SFrancesco Fusco ipc.tos = -1; 15311da177e4SLinus Torvalds 1532f6d8bd05SEric Dumazet if (replyopts.opt.opt.optlen) { 15331da177e4SLinus Torvalds ipc.opt = &replyopts.opt; 15341da177e4SLinus Torvalds 1535f6d8bd05SEric Dumazet if (replyopts.opt.opt.srr) 1536f6d8bd05SEric Dumazet daddr = replyopts.opt.opt.faddr; 15371da177e4SLinus Torvalds } 15381da177e4SLinus Torvalds 1539e110861fSLorenzo Colitti flowi4_init_output(&fl4, arg->bound_dev_if, 1540e110861fSLorenzo Colitti IP4_REPLY_MARK(net, skb->mark), 154166b13d99SEric Dumazet RT_TOS(arg->tos), 1542be9f4a44SEric Dumazet RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol, 1543538de0e0SDavid S. Miller ip_reply_arg_flowi_flags(arg), 154470e73416SDavid S. Miller daddr, saddr, 1545538de0e0SDavid S. Miller tcp_hdr(skb)->source, tcp_hdr(skb)->dest); 15469d6ec938SDavid S. Miller security_skb_classify_flow(skb, flowi4_to_flowi(&fl4)); 1547be9f4a44SEric Dumazet rt = ip_route_output_key(net, &fl4); 1548b23dd4feSDavid S. Miller if (IS_ERR(rt)) 15491da177e4SLinus Torvalds return; 15501da177e4SLinus Torvalds 1551bdbbb852SEric Dumazet inet_sk(sk)->tos = arg->tos; 15521da177e4SLinus Torvalds 15531da177e4SLinus Torvalds sk->sk_priority = skb->priority; 1554eddc9ec5SArnaldo Carvalho de Melo sk->sk_protocol = ip_hdr(skb)->protocol; 1555f0e48dbfSPatrick McHardy sk->sk_bound_dev_if = arg->bound_dev_if; 1556be9f4a44SEric Dumazet sk->sk_sndbuf = sysctl_wmem_default; 15574062090eSVasily Averin err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base, 15584062090eSVasily Averin len, 0, &ipc, &rt, MSG_DONTWAIT); 15594062090eSVasily Averin if (unlikely(err)) { 15604062090eSVasily Averin ip_flush_pending_frames(sk); 15614062090eSVasily Averin goto out; 15624062090eSVasily Averin } 15634062090eSVasily Averin 1564be9f4a44SEric Dumazet nskb = skb_peek(&sk->sk_write_queue); 1565be9f4a44SEric Dumazet if (nskb) { 15661da177e4SLinus Torvalds if (arg->csumoffset >= 0) 1567be9f4a44SEric Dumazet *((__sum16 *)skb_transport_header(nskb) + 1568be9f4a44SEric Dumazet arg->csumoffset) = csum_fold(csum_add(nskb->csum, 15699c70220bSArnaldo Carvalho de Melo arg->csum)); 1570be9f4a44SEric Dumazet nskb->ip_summed = CHECKSUM_NONE; 1571be9f4a44SEric Dumazet skb_set_queue_mapping(nskb, skb_get_queue_mapping(skb)); 157277968b78SDavid S. Miller ip_push_pending_frames(sk, &fl4); 15731da177e4SLinus Torvalds } 15744062090eSVasily Averin out: 15751da177e4SLinus Torvalds ip_rt_put(rt); 15761da177e4SLinus Torvalds } 15771da177e4SLinus Torvalds 15781da177e4SLinus Torvalds void __init ip_init(void) 15791da177e4SLinus Torvalds { 15801da177e4SLinus Torvalds ip_rt_init(); 15811da177e4SLinus Torvalds inet_initpeers(); 15821da177e4SLinus Torvalds 158372c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST) 158472c1d3bdSWANG Cong igmp_mc_init(); 15851da177e4SLinus Torvalds #endif 15861da177e4SLinus Torvalds } 1587