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 86694869b3SEric W. Biederman static int 87694869b3SEric W. Biederman ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 88c5501eb3SFlorian Westphal unsigned int mtu, 89694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)); 9049d16b23SAndy Zhou 911da177e4SLinus Torvalds /* Generate a checksum for an outgoing IP datagram. */ 922fbd9679SDenis Efremov void ip_send_check(struct iphdr *iph) 931da177e4SLinus Torvalds { 941da177e4SLinus Torvalds iph->check = 0; 951da177e4SLinus Torvalds iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl); 961da177e4SLinus Torvalds } 974bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_send_check); 981da177e4SLinus Torvalds 997d771aaaSEric Dumazet static int __ip_local_out_sk(struct sock *sk, struct sk_buff *skb) 100c439cb2eSHerbert Xu { 10129a26a56SEric W. Biederman struct net *net = dev_net(skb_dst(skb)->dev); 102c439cb2eSHerbert Xu struct iphdr *iph = ip_hdr(skb); 103c439cb2eSHerbert Xu 104c439cb2eSHerbert Xu iph->tot_len = htons(skb->len); 105c439cb2eSHerbert Xu ip_send_check(iph); 10629a26a56SEric W. Biederman return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT, 10729a26a56SEric W. Biederman net, sk, skb, NULL, skb_dst(skb)->dev, 108*13206b6bSEric W. Biederman dst_output); 1097026b1ddSDavid Miller } 1107026b1ddSDavid Miller 1117026b1ddSDavid Miller int __ip_local_out(struct sk_buff *skb) 1127026b1ddSDavid Miller { 1137026b1ddSDavid Miller return __ip_local_out_sk(skb->sk, skb); 114c439cb2eSHerbert Xu } 115c439cb2eSHerbert Xu 116aad88724SEric Dumazet int ip_local_out_sk(struct sock *sk, struct sk_buff *skb) 117c439cb2eSHerbert Xu { 118*13206b6bSEric W. Biederman struct net *net = dev_net(skb_dst(skb)->dev); 119c439cb2eSHerbert Xu int err; 120c439cb2eSHerbert Xu 121fd2874b3SEric W. Biederman err = __ip_local_out_sk(sk, skb); 122c439cb2eSHerbert Xu if (likely(err == 1)) 123*13206b6bSEric W. Biederman err = dst_output(net, sk, skb); 124c439cb2eSHerbert Xu 125c439cb2eSHerbert Xu return err; 126c439cb2eSHerbert Xu } 127aad88724SEric Dumazet EXPORT_SYMBOL_GPL(ip_local_out_sk); 128c439cb2eSHerbert Xu 1291da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst) 1301da177e4SLinus Torvalds { 1311da177e4SLinus Torvalds int ttl = inet->uc_ttl; 1321da177e4SLinus Torvalds 1331da177e4SLinus Torvalds if (ttl < 0) 134323e126fSDavid S. Miller ttl = ip4_dst_hoplimit(dst); 1351da177e4SLinus Torvalds return ttl; 1361da177e4SLinus Torvalds } 1371da177e4SLinus Torvalds 1381da177e4SLinus Torvalds /* 1391da177e4SLinus Torvalds * Add an ip header to a skbuff and send it out. 1401da177e4SLinus Torvalds * 1411da177e4SLinus Torvalds */ 142cfe673b0SEric Dumazet int ip_build_and_send_pkt(struct sk_buff *skb, const struct sock *sk, 143f6d8bd05SEric Dumazet __be32 saddr, __be32 daddr, struct ip_options_rcu *opt) 1441da177e4SLinus Torvalds { 1451da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 146511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1471da177e4SLinus Torvalds struct iphdr *iph; 1481da177e4SLinus Torvalds 1491da177e4SLinus Torvalds /* Build the IP header. */ 150f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (opt ? opt->opt.optlen : 0)); 1518856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 152eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 1531da177e4SLinus Torvalds iph->version = 4; 1541da177e4SLinus Torvalds iph->ihl = 5; 1551da177e4SLinus Torvalds iph->tos = inet->tos; 156d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 157dd927a26SDavid S. Miller iph->daddr = (opt && opt->opt.srr ? opt->opt.faddr : daddr); 158dd927a26SDavid S. Miller iph->saddr = saddr; 1591da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 160cfe673b0SEric Dumazet if (ip_dont_fragment(sk, &rt->dst)) { 161cfe673b0SEric Dumazet iph->frag_off = htons(IP_DF); 162cfe673b0SEric Dumazet iph->id = 0; 163cfe673b0SEric Dumazet } else { 164cfe673b0SEric Dumazet iph->frag_off = 0; 165cfe673b0SEric Dumazet __ip_select_ident(sock_net(sk), iph, 1); 166cfe673b0SEric Dumazet } 1671da177e4SLinus Torvalds 168f6d8bd05SEric Dumazet if (opt && opt->opt.optlen) { 169f6d8bd05SEric Dumazet iph->ihl += opt->opt.optlen>>2; 170f6d8bd05SEric Dumazet ip_options_build(skb, &opt->opt, daddr, rt, 0); 1711da177e4SLinus Torvalds } 1721da177e4SLinus Torvalds 1731da177e4SLinus Torvalds skb->priority = sk->sk_priority; 1744a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1751da177e4SLinus Torvalds 1761da177e4SLinus Torvalds /* Send it out. */ 177c439cb2eSHerbert Xu return ip_local_out(skb); 1781da177e4SLinus Torvalds } 179d8c97a94SArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip_build_and_send_pkt); 180d8c97a94SArnaldo Carvalho de Melo 181694869b3SEric W. Biederman static int ip_finish_output2(struct net *net, struct sock *sk, struct sk_buff *skb) 1821da177e4SLinus Torvalds { 183adf30907SEric Dumazet struct dst_entry *dst = skb_dst(skb); 18480787ebcSMitsuru Chinen struct rtable *rt = (struct rtable *)dst; 1851da177e4SLinus Torvalds struct net_device *dev = dst->dev; 186c2636b4dSChuck Lever unsigned int hh_len = LL_RESERVED_SPACE(dev); 187f6b72b62SDavid S. Miller struct neighbour *neigh; 188a263b309SDavid S. Miller u32 nexthop; 1891da177e4SLinus Torvalds 190edf391ffSNeil Horman if (rt->rt_type == RTN_MULTICAST) { 1914ba1bf42SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTMCAST, skb->len); 192edf391ffSNeil Horman } else if (rt->rt_type == RTN_BROADCAST) 1934ba1bf42SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTBCAST, skb->len); 19480787ebcSMitsuru Chinen 1951da177e4SLinus Torvalds /* Be paranoid, rather than too clever. */ 1963b04dddeSStephen Hemminger if (unlikely(skb_headroom(skb) < hh_len && dev->header_ops)) { 1971da177e4SLinus Torvalds struct sk_buff *skb2; 1981da177e4SLinus Torvalds 1991da177e4SLinus Torvalds skb2 = skb_realloc_headroom(skb, LL_RESERVED_SPACE(dev)); 20051456b29SIan Morris if (!skb2) { 2011da177e4SLinus Torvalds kfree_skb(skb); 2021da177e4SLinus Torvalds return -ENOMEM; 2031da177e4SLinus Torvalds } 2041da177e4SLinus Torvalds if (skb->sk) 2051da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 2065d0ba55bSEric Dumazet consume_skb(skb); 2071da177e4SLinus Torvalds skb = skb2; 2081da177e4SLinus Torvalds } 2091da177e4SLinus Torvalds 210a263b309SDavid S. Miller rcu_read_lock_bh(); 211155e8336SJulian Anastasov nexthop = (__force u32) rt_nexthop(rt, ip_hdr(skb)->daddr); 212a263b309SDavid S. Miller neigh = __ipv4_neigh_lookup_noref(dev, nexthop); 213a263b309SDavid S. Miller if (unlikely(!neigh)) 214a263b309SDavid S. Miller neigh = __neigh_create(&arp_tbl, &nexthop, dev, false); 2159871f1adSVasiliy Kulikov if (!IS_ERR(neigh)) { 2165110effeSDavid S. Miller int res = dst_neigh_output(dst, neigh, skb); 217f2c31e32SEric Dumazet 218a263b309SDavid S. Miller rcu_read_unlock_bh(); 219f2c31e32SEric Dumazet return res; 220f2c31e32SEric Dumazet } 221a263b309SDavid S. Miller rcu_read_unlock_bh(); 22205e3aa09SDavid S. Miller 223e87cc472SJoe Perches net_dbg_ratelimited("%s: No header cache and no neighbour!\n", 224e87cc472SJoe Perches __func__); 2251da177e4SLinus Torvalds kfree_skb(skb); 2261da177e4SLinus Torvalds return -EINVAL; 2271da177e4SLinus Torvalds } 2281da177e4SLinus Torvalds 229694869b3SEric W. Biederman static int ip_finish_output_gso(struct net *net, struct sock *sk, 230694869b3SEric W. Biederman struct sk_buff *skb, unsigned int mtu) 231c7ba65d7SFlorian Westphal { 232c7ba65d7SFlorian Westphal netdev_features_t features; 233c7ba65d7SFlorian Westphal struct sk_buff *segs; 234c7ba65d7SFlorian Westphal int ret = 0; 235c7ba65d7SFlorian Westphal 236c7ba65d7SFlorian Westphal /* common case: locally created skb or seglen is <= mtu */ 237c7ba65d7SFlorian Westphal if (((IPCB(skb)->flags & IPSKB_FORWARDED) == 0) || 238c5501eb3SFlorian Westphal skb_gso_network_seglen(skb) <= mtu) 239694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 240c7ba65d7SFlorian Westphal 241c7ba65d7SFlorian Westphal /* Slowpath - GSO segment length is exceeding the dst MTU. 242c7ba65d7SFlorian Westphal * 243c7ba65d7SFlorian Westphal * This can happen in two cases: 244c7ba65d7SFlorian Westphal * 1) TCP GRO packet, DF bit not set 245c7ba65d7SFlorian Westphal * 2) skb arrived via virtio-net, we thus get TSO/GSO skbs directly 246c7ba65d7SFlorian Westphal * from host network stack. 247c7ba65d7SFlorian Westphal */ 248c7ba65d7SFlorian Westphal features = netif_skb_features(skb); 249c7ba65d7SFlorian Westphal segs = skb_gso_segment(skb, features & ~NETIF_F_GSO_MASK); 250330966e5SFlorian Westphal if (IS_ERR_OR_NULL(segs)) { 251c7ba65d7SFlorian Westphal kfree_skb(skb); 252c7ba65d7SFlorian Westphal return -ENOMEM; 253c7ba65d7SFlorian Westphal } 254c7ba65d7SFlorian Westphal 255c7ba65d7SFlorian Westphal consume_skb(skb); 256c7ba65d7SFlorian Westphal 257c7ba65d7SFlorian Westphal do { 258c7ba65d7SFlorian Westphal struct sk_buff *nskb = segs->next; 259c7ba65d7SFlorian Westphal int err; 260c7ba65d7SFlorian Westphal 261c7ba65d7SFlorian Westphal segs->next = NULL; 262694869b3SEric W. Biederman err = ip_fragment(net, sk, segs, mtu, ip_finish_output2); 263c7ba65d7SFlorian Westphal 264c7ba65d7SFlorian Westphal if (err && ret == 0) 265c7ba65d7SFlorian Westphal ret = err; 266c7ba65d7SFlorian Westphal segs = nskb; 267c7ba65d7SFlorian Westphal } while (segs); 268c7ba65d7SFlorian Westphal 269c7ba65d7SFlorian Westphal return ret; 270c7ba65d7SFlorian Westphal } 271c7ba65d7SFlorian Westphal 2720c4b51f0SEric W. Biederman static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 2731da177e4SLinus Torvalds { 274c5501eb3SFlorian Westphal unsigned int mtu; 275c5501eb3SFlorian Westphal 2765c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM) 2775c901daaSPatrick McHardy /* Policy lookup after SNAT yielded a new policy */ 27800db4124SIan Morris if (skb_dst(skb)->xfrm) { 27948d5cad8SPatrick McHardy IPCB(skb)->flags |= IPSKB_REROUTED; 280*13206b6bSEric W. Biederman return dst_output(net, sk, skb); 28148d5cad8SPatrick McHardy } 2825c901daaSPatrick McHardy #endif 283c5501eb3SFlorian Westphal mtu = ip_skb_dst_mtu(skb); 284c7ba65d7SFlorian Westphal if (skb_is_gso(skb)) 285694869b3SEric W. Biederman return ip_finish_output_gso(net, sk, skb, mtu); 286c7ba65d7SFlorian Westphal 287d6b915e2SFlorian Westphal if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU)) 288694869b3SEric W. Biederman return ip_fragment(net, sk, skb, mtu, ip_finish_output2); 289c7ba65d7SFlorian Westphal 290694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 2911da177e4SLinus Torvalds } 2921da177e4SLinus Torvalds 293aad88724SEric Dumazet int ip_mc_output(struct sock *sk, struct sk_buff *skb) 2941da177e4SLinus Torvalds { 295511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 296d8d1f30bSChangli Gao struct net_device *dev = rt->dst.dev; 29788f5cc24SEric W. Biederman struct net *net = dev_net(dev); 2981da177e4SLinus Torvalds 2991da177e4SLinus Torvalds /* 3001da177e4SLinus Torvalds * If the indicated interface is up and running, send the packet. 3011da177e4SLinus Torvalds */ 30288f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3031da177e4SLinus Torvalds 3041da177e4SLinus Torvalds skb->dev = dev; 3051da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 3061da177e4SLinus Torvalds 3071da177e4SLinus Torvalds /* 3081da177e4SLinus Torvalds * Multicasts are looped back for other local users 3091da177e4SLinus Torvalds */ 3101da177e4SLinus Torvalds 3111da177e4SLinus Torvalds if (rt->rt_flags&RTCF_MULTICAST) { 3127ad6848cSOctavian Purdila if (sk_mc_loop(sk) 3131da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 3141da177e4SLinus Torvalds /* Small optimization: do not loopback not local frames, 3151da177e4SLinus Torvalds which returned after forwarding; they will be dropped 3161da177e4SLinus Torvalds by ip_mr_input in any case. 3171da177e4SLinus Torvalds Note, that local frames are looped back to be delivered 3181da177e4SLinus Torvalds to local recipients. 3191da177e4SLinus Torvalds 3201da177e4SLinus Torvalds This check is duplicated in ip_mr_input at the moment. 3211da177e4SLinus Torvalds */ 3229d4fb27dSJoe Perches && 3239d4fb27dSJoe Perches ((rt->rt_flags & RTCF_LOCAL) || 3249d4fb27dSJoe Perches !(IPCB(skb)->flags & IPSKB_FORWARDED)) 3251da177e4SLinus Torvalds #endif 3261da177e4SLinus Torvalds ) { 3271da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3281da177e4SLinus Torvalds if (newskb) 3299bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 33029a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 33195603e22SMichel Machado dev_loopback_xmit); 3321da177e4SLinus Torvalds } 3331da177e4SLinus Torvalds 3341da177e4SLinus Torvalds /* Multicasts with ttl 0 must not go beyond the host */ 3351da177e4SLinus Torvalds 336eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl == 0) { 3371da177e4SLinus Torvalds kfree_skb(skb); 3381da177e4SLinus Torvalds return 0; 3391da177e4SLinus Torvalds } 3401da177e4SLinus Torvalds } 3411da177e4SLinus Torvalds 3421da177e4SLinus Torvalds if (rt->rt_flags&RTCF_BROADCAST) { 3431da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3441da177e4SLinus Torvalds if (newskb) 34529a26a56SEric W. Biederman NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 34629a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 34729a26a56SEric W. Biederman dev_loopback_xmit); 3481da177e4SLinus Torvalds } 3491da177e4SLinus Torvalds 35029a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 35129a26a56SEric W. Biederman net, sk, skb, NULL, skb->dev, 35229a26a56SEric W. Biederman ip_finish_output, 35348d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 3541da177e4SLinus Torvalds } 3551da177e4SLinus Torvalds 356aad88724SEric Dumazet int ip_output(struct sock *sk, struct sk_buff *skb) 3571da177e4SLinus Torvalds { 358adf30907SEric Dumazet struct net_device *dev = skb_dst(skb)->dev; 35988f5cc24SEric W. Biederman struct net *net = dev_net(dev); 3601bd9bef6SPatrick McHardy 36188f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3621da177e4SLinus Torvalds 3631bd9bef6SPatrick McHardy skb->dev = dev; 3641bd9bef6SPatrick McHardy skb->protocol = htons(ETH_P_IP); 3651bd9bef6SPatrick McHardy 36629a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 36729a26a56SEric W. Biederman net, sk, skb, NULL, dev, 36848d5cad8SPatrick McHardy ip_finish_output, 36948d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 3701da177e4SLinus Torvalds } 3711da177e4SLinus Torvalds 37284f9307cSEric Dumazet /* 37384f9307cSEric Dumazet * copy saddr and daddr, possibly using 64bit load/stores 37484f9307cSEric Dumazet * Equivalent to : 37584f9307cSEric Dumazet * iph->saddr = fl4->saddr; 37684f9307cSEric Dumazet * iph->daddr = fl4->daddr; 37784f9307cSEric Dumazet */ 37884f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4) 37984f9307cSEric Dumazet { 38084f9307cSEric Dumazet BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) != 38184f9307cSEric Dumazet offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr)); 38284f9307cSEric Dumazet memcpy(&iph->saddr, &fl4->saddr, 38384f9307cSEric Dumazet sizeof(fl4->saddr) + sizeof(fl4->daddr)); 38484f9307cSEric Dumazet } 38584f9307cSEric Dumazet 386b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */ 387b0270e91SEric Dumazet int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl) 3881da177e4SLinus Torvalds { 3891da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 390f6d8bd05SEric Dumazet struct ip_options_rcu *inet_opt; 391b57ae01aSDavid S. Miller struct flowi4 *fl4; 3921da177e4SLinus Torvalds struct rtable *rt; 3931da177e4SLinus Torvalds struct iphdr *iph; 394ab6e3febSEric Dumazet int res; 3951da177e4SLinus Torvalds 3961da177e4SLinus Torvalds /* Skip all of this if the packet is already routed, 3971da177e4SLinus Torvalds * f.e. by something like SCTP. 3981da177e4SLinus Torvalds */ 399ab6e3febSEric Dumazet rcu_read_lock(); 400f6d8bd05SEric Dumazet inet_opt = rcu_dereference(inet->inet_opt); 401ea4fc0d6SDavid S. Miller fl4 = &fl->u.ip4; 402511c3f92SEric Dumazet rt = skb_rtable(skb); 40300db4124SIan Morris if (rt) 4041da177e4SLinus Torvalds goto packet_routed; 4051da177e4SLinus Torvalds 4061da177e4SLinus Torvalds /* Make sure we can route this packet. */ 4071da177e4SLinus Torvalds rt = (struct rtable *)__sk_dst_check(sk, 0); 40851456b29SIan Morris if (!rt) { 4093ca3c68eSAl Viro __be32 daddr; 4101da177e4SLinus Torvalds 4111da177e4SLinus Torvalds /* Use correct destination address if we have options. */ 412c720c7e8SEric Dumazet daddr = inet->inet_daddr; 413f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.srr) 414f6d8bd05SEric Dumazet daddr = inet_opt->opt.faddr; 4151da177e4SLinus Torvalds 4161da177e4SLinus Torvalds /* If this fails, retransmit mechanism of transport layer will 4171da177e4SLinus Torvalds * keep trying until route appears or the connection times 4181da177e4SLinus Torvalds * itself out. 4191da177e4SLinus Torvalds */ 420b57ae01aSDavid S. Miller rt = ip_route_output_ports(sock_net(sk), fl4, sk, 42178fbfd8aSDavid S. Miller daddr, inet->inet_saddr, 42278fbfd8aSDavid S. Miller inet->inet_dport, 42378fbfd8aSDavid S. Miller inet->inet_sport, 42478fbfd8aSDavid S. Miller sk->sk_protocol, 42578fbfd8aSDavid S. Miller RT_CONN_FLAGS(sk), 42678fbfd8aSDavid S. Miller sk->sk_bound_dev_if); 427b23dd4feSDavid S. Miller if (IS_ERR(rt)) 4281da177e4SLinus Torvalds goto no_route; 429d8d1f30bSChangli Gao sk_setup_caps(sk, &rt->dst); 4301da177e4SLinus Torvalds } 431d8d1f30bSChangli Gao skb_dst_set_noref(skb, &rt->dst); 4321da177e4SLinus Torvalds 4331da177e4SLinus Torvalds packet_routed: 434155e8336SJulian Anastasov if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway) 4351da177e4SLinus Torvalds goto no_route; 4361da177e4SLinus Torvalds 4371da177e4SLinus Torvalds /* OK, we know where to send it, allocate and build IP header. */ 438f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0)); 4398856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 440eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 441714e85beSAl Viro *((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (inet->tos & 0xff)); 44260ff7467SWANG Cong if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df) 4431da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 4441da177e4SLinus Torvalds else 4451da177e4SLinus Torvalds iph->frag_off = 0; 446d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 4471da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 44884f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 44984f9307cSEric Dumazet 4501da177e4SLinus Torvalds /* Transport layer set skb->h.foo itself. */ 4511da177e4SLinus Torvalds 452f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.optlen) { 453f6d8bd05SEric Dumazet iph->ihl += inet_opt->opt.optlen >> 2; 454f6d8bd05SEric Dumazet ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0); 4551da177e4SLinus Torvalds } 4561da177e4SLinus Torvalds 457b6a7719aSHannes Frederic Sowa ip_select_ident_segs(sock_net(sk), skb, sk, 458b6a7719aSHannes Frederic Sowa skb_shinfo(skb)->gso_segs ?: 1); 4591da177e4SLinus Torvalds 460b0270e91SEric Dumazet /* TODO : should we use skb->sk here instead of sk ? */ 4611da177e4SLinus Torvalds skb->priority = sk->sk_priority; 4624a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 4631da177e4SLinus Torvalds 464850dcc4dSEric W. Biederman res = ip_local_out_sk(sk, skb); 465ab6e3febSEric Dumazet rcu_read_unlock(); 466ab6e3febSEric Dumazet return res; 4671da177e4SLinus Torvalds 4681da177e4SLinus Torvalds no_route: 469ab6e3febSEric Dumazet rcu_read_unlock(); 4705e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTNOROUTES); 4711da177e4SLinus Torvalds kfree_skb(skb); 4721da177e4SLinus Torvalds return -EHOSTUNREACH; 4731da177e4SLinus Torvalds } 4744bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_queue_xmit); 4751da177e4SLinus Torvalds 4761da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from) 4771da177e4SLinus Torvalds { 4781da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 4791da177e4SLinus Torvalds to->priority = from->priority; 4801da177e4SLinus Torvalds to->protocol = from->protocol; 481adf30907SEric Dumazet skb_dst_drop(to); 482fe76cda3SEric Dumazet skb_dst_copy(to, from); 4831da177e4SLinus Torvalds to->dev = from->dev; 48482e91ffeSThomas Graf to->mark = from->mark; 4851da177e4SLinus Torvalds 4861da177e4SLinus Torvalds /* Copy the flags to each fragment. */ 4871da177e4SLinus Torvalds IPCB(to)->flags = IPCB(from)->flags; 4881da177e4SLinus Torvalds 4891da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 4901da177e4SLinus Torvalds to->tc_index = from->tc_index; 4911da177e4SLinus Torvalds #endif 492e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 493c98d80edSJulian Anastasov #if defined(CONFIG_IP_VS) || defined(CONFIG_IP_VS_MODULE) 494c98d80edSJulian Anastasov to->ipvs_property = from->ipvs_property; 495c98d80edSJulian Anastasov #endif 496984bc16cSJames Morris skb_copy_secmark(to, from); 4971da177e4SLinus Torvalds } 4981da177e4SLinus Torvalds 499694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 500c5501eb3SFlorian Westphal unsigned int mtu, 501694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 50249d16b23SAndy Zhou { 50349d16b23SAndy Zhou struct iphdr *iph = ip_hdr(skb); 50449d16b23SAndy Zhou 505d6b915e2SFlorian Westphal if ((iph->frag_off & htons(IP_DF)) == 0) 506694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 507d6b915e2SFlorian Westphal 508d6b915e2SFlorian Westphal if (unlikely(!skb->ignore_df || 50949d16b23SAndy Zhou (IPCB(skb)->frag_max_size && 51049d16b23SAndy Zhou IPCB(skb)->frag_max_size > mtu))) { 5119479b0afSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 51249d16b23SAndy Zhou icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, 51349d16b23SAndy Zhou htonl(mtu)); 51449d16b23SAndy Zhou kfree_skb(skb); 51549d16b23SAndy Zhou return -EMSGSIZE; 51649d16b23SAndy Zhou } 51749d16b23SAndy Zhou 518694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 51949d16b23SAndy Zhou } 52049d16b23SAndy Zhou 5211da177e4SLinus Torvalds /* 5221da177e4SLinus Torvalds * This IP datagram is too large to be sent in one piece. Break it up into 5231da177e4SLinus Torvalds * smaller pieces (each of size equal to IP header plus 5241da177e4SLinus Torvalds * a block of the data of the original IP data part) that will yet fit in a 5251da177e4SLinus Torvalds * single device frame, and queue such a frame for sending. 5261da177e4SLinus Torvalds */ 5271da177e4SLinus Torvalds 528694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 529694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 5301da177e4SLinus Torvalds { 5311da177e4SLinus Torvalds struct iphdr *iph; 5321da177e4SLinus Torvalds int ptr; 5331da177e4SLinus Torvalds struct net_device *dev; 5341da177e4SLinus Torvalds struct sk_buff *skb2; 535c893b806SChangli Gao unsigned int mtu, hlen, left, len, ll_rs; 5361da177e4SLinus Torvalds int offset; 53776ab608dSAlexey Dobriyan __be16 not_last_frag; 538511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 5391da177e4SLinus Torvalds int err = 0; 5401da177e4SLinus Torvalds 541d8d1f30bSChangli Gao dev = rt->dst.dev; 5421da177e4SLinus Torvalds 5431da177e4SLinus Torvalds /* 5441da177e4SLinus Torvalds * Point into the IP datagram header. 5451da177e4SLinus Torvalds */ 5461da177e4SLinus Torvalds 547eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 5481da177e4SLinus Torvalds 54969647ce4SHannes Frederic Sowa mtu = ip_skb_dst_mtu(skb); 550d6b915e2SFlorian Westphal if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu) 551d6b915e2SFlorian Westphal mtu = IPCB(skb)->frag_max_size; 5521da177e4SLinus Torvalds 5531da177e4SLinus Torvalds /* 5541da177e4SLinus Torvalds * Setup starting values. 5551da177e4SLinus Torvalds */ 5561da177e4SLinus Torvalds 5571da177e4SLinus Torvalds hlen = iph->ihl * 4; 558f87c10a8SHannes Frederic Sowa mtu = mtu - hlen; /* Size of data space */ 55989cee8b1SHerbert Xu IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE; 5601da177e4SLinus Torvalds 5611da177e4SLinus Torvalds /* When frag_list is given, use it. First, check its validity: 5621da177e4SLinus Torvalds * some transformers could create wrong frag_list or break existing 5631da177e4SLinus Torvalds * one, it is not prohibited. In this case fall back to copying. 5641da177e4SLinus Torvalds * 5651da177e4SLinus Torvalds * LATER: this step can be merged to real generation of fragments, 5661da177e4SLinus Torvalds * we can switch to copy when see the first bad fragment. 5671da177e4SLinus Torvalds */ 56821dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 5693d13008eSEric Dumazet struct sk_buff *frag, *frag2; 5701da177e4SLinus Torvalds int first_len = skb_pagelen(skb); 5711da177e4SLinus Torvalds 5721da177e4SLinus Torvalds if (first_len - hlen > mtu || 5731da177e4SLinus Torvalds ((first_len - hlen) & 7) || 57456f8a75cSPaul Gortmaker ip_is_fragment(iph) || 5751da177e4SLinus Torvalds skb_cloned(skb)) 5761da177e4SLinus Torvalds goto slow_path; 5771da177e4SLinus Torvalds 578d7fcf1a5SDavid S. Miller skb_walk_frags(skb, frag) { 5791da177e4SLinus Torvalds /* Correct geometry. */ 5801da177e4SLinus Torvalds if (frag->len > mtu || 5811da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 5821da177e4SLinus Torvalds skb_headroom(frag) < hlen) 5833d13008eSEric Dumazet goto slow_path_clean; 5841da177e4SLinus Torvalds 5851da177e4SLinus Torvalds /* Partially cloned skb? */ 5861da177e4SLinus Torvalds if (skb_shared(frag)) 5873d13008eSEric Dumazet goto slow_path_clean; 5882fdba6b0SHerbert Xu 5892fdba6b0SHerbert Xu BUG_ON(frag->sk); 5902fdba6b0SHerbert Xu if (skb->sk) { 5912fdba6b0SHerbert Xu frag->sk = skb->sk; 5922fdba6b0SHerbert Xu frag->destructor = sock_wfree; 5932fdba6b0SHerbert Xu } 5943d13008eSEric Dumazet skb->truesize -= frag->truesize; 5951da177e4SLinus Torvalds } 5961da177e4SLinus Torvalds 5971da177e4SLinus Torvalds /* Everything is OK. Generate! */ 5981da177e4SLinus Torvalds 5991da177e4SLinus Torvalds err = 0; 6001da177e4SLinus Torvalds offset = 0; 6011da177e4SLinus Torvalds frag = skb_shinfo(skb)->frag_list; 602d7fcf1a5SDavid S. Miller skb_frag_list_init(skb); 6031da177e4SLinus Torvalds skb->data_len = first_len - skb_headlen(skb); 6041da177e4SLinus Torvalds skb->len = first_len; 6051da177e4SLinus Torvalds iph->tot_len = htons(first_len); 6061da177e4SLinus Torvalds iph->frag_off = htons(IP_MF); 6071da177e4SLinus Torvalds ip_send_check(iph); 6081da177e4SLinus Torvalds 6091da177e4SLinus Torvalds for (;;) { 6101da177e4SLinus Torvalds /* Prepare header of the next frame, 6111da177e4SLinus Torvalds * before previous one went down. */ 6121da177e4SLinus Torvalds if (frag) { 6131da177e4SLinus Torvalds frag->ip_summed = CHECKSUM_NONE; 614badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(frag); 615e2d1bca7SArnaldo Carvalho de Melo __skb_push(frag, hlen); 616e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(frag); 617d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(frag), iph, hlen); 618eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(frag); 6191da177e4SLinus Torvalds iph->tot_len = htons(frag->len); 6201da177e4SLinus Torvalds ip_copy_metadata(frag, skb); 6211da177e4SLinus Torvalds if (offset == 0) 6221da177e4SLinus Torvalds ip_options_fragment(frag); 6231da177e4SLinus Torvalds offset += skb->len - hlen; 6241da177e4SLinus Torvalds iph->frag_off = htons(offset>>3); 62500db4124SIan Morris if (frag->next) 6261da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 6271da177e4SLinus Torvalds /* Ready, complete checksum */ 6281da177e4SLinus Torvalds ip_send_check(iph); 6291da177e4SLinus Torvalds } 6301da177e4SLinus Torvalds 631694869b3SEric W. Biederman err = output(net, sk, skb); 6321da177e4SLinus Torvalds 633dafee490SWei Dong if (!err) 63426a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 6351da177e4SLinus Torvalds if (err || !frag) 6361da177e4SLinus Torvalds break; 6371da177e4SLinus Torvalds 6381da177e4SLinus Torvalds skb = frag; 6391da177e4SLinus Torvalds frag = skb->next; 6401da177e4SLinus Torvalds skb->next = NULL; 6411da177e4SLinus Torvalds } 6421da177e4SLinus Torvalds 6431da177e4SLinus Torvalds if (err == 0) { 64426a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 6451da177e4SLinus Torvalds return 0; 6461da177e4SLinus Torvalds } 6471da177e4SLinus Torvalds 6481da177e4SLinus Torvalds while (frag) { 6491da177e4SLinus Torvalds skb = frag->next; 6501da177e4SLinus Torvalds kfree_skb(frag); 6511da177e4SLinus Torvalds frag = skb; 6521da177e4SLinus Torvalds } 65326a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 6541da177e4SLinus Torvalds return err; 6553d13008eSEric Dumazet 6563d13008eSEric Dumazet slow_path_clean: 6573d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 6583d13008eSEric Dumazet if (frag2 == frag) 6593d13008eSEric Dumazet break; 6603d13008eSEric Dumazet frag2->sk = NULL; 6613d13008eSEric Dumazet frag2->destructor = NULL; 6623d13008eSEric Dumazet skb->truesize += frag2->truesize; 6633d13008eSEric Dumazet } 6641da177e4SLinus Torvalds } 6651da177e4SLinus Torvalds 6661da177e4SLinus Torvalds slow_path: 667fc70fb64SAlexander Duyck /* for offloaded checksums cleanup checksum before fragmentation */ 668fc70fb64SAlexander Duyck if ((skb->ip_summed == CHECKSUM_PARTIAL) && skb_checksum_help(skb)) 669fc70fb64SAlexander Duyck goto fail; 670c9af6db4SPravin B Shelar iph = ip_hdr(skb); 671fc70fb64SAlexander Duyck 6721da177e4SLinus Torvalds left = skb->len - hlen; /* Space per frame */ 67349085bd7SGeorge Kadianakis ptr = hlen; /* Where to start from */ 6741da177e4SLinus Torvalds 6758d045163SFlorian Westphal ll_rs = LL_RESERVED_SPACE(rt->dst.dev); 6769bcfcaf5SStephen Hemminger 6771da177e4SLinus Torvalds /* 6781da177e4SLinus Torvalds * Fragment the datagram. 6791da177e4SLinus Torvalds */ 6801da177e4SLinus Torvalds 6811da177e4SLinus Torvalds offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3; 6821da177e4SLinus Torvalds not_last_frag = iph->frag_off & htons(IP_MF); 6831da177e4SLinus Torvalds 6841da177e4SLinus Torvalds /* 6851da177e4SLinus Torvalds * Keep copying data until we run out. 6861da177e4SLinus Torvalds */ 6871da177e4SLinus Torvalds 6881da177e4SLinus Torvalds while (left > 0) { 6891da177e4SLinus Torvalds len = left; 6901da177e4SLinus Torvalds /* IF: it doesn't fit, use 'mtu' - the data space left */ 6911da177e4SLinus Torvalds if (len > mtu) 6921da177e4SLinus Torvalds len = mtu; 6931da177e4SLinus Torvalds /* IF: we are not sending up to and including the packet end 6941da177e4SLinus Torvalds then align the next start on an eight byte boundary */ 6951da177e4SLinus Torvalds if (len < left) { 6961da177e4SLinus Torvalds len &= ~7; 6971da177e4SLinus Torvalds } 6981da177e4SLinus Torvalds 699cbffccc9SJoe Perches /* Allocate buffer */ 700cbffccc9SJoe Perches skb2 = alloc_skb(len + hlen + ll_rs, GFP_ATOMIC); 701cbffccc9SJoe Perches if (!skb2) { 7021da177e4SLinus Torvalds err = -ENOMEM; 7031da177e4SLinus Torvalds goto fail; 7041da177e4SLinus Torvalds } 7051da177e4SLinus Torvalds 7061da177e4SLinus Torvalds /* 7071da177e4SLinus Torvalds * Set up data on packet 7081da177e4SLinus Torvalds */ 7091da177e4SLinus Torvalds 7101da177e4SLinus Torvalds ip_copy_metadata(skb2, skb); 7111da177e4SLinus Torvalds skb_reserve(skb2, ll_rs); 7121da177e4SLinus Torvalds skb_put(skb2, len + hlen); 713c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb2); 714b0e380b1SArnaldo Carvalho de Melo skb2->transport_header = skb2->network_header + hlen; 7151da177e4SLinus Torvalds 7161da177e4SLinus Torvalds /* 7171da177e4SLinus Torvalds * Charge the memory for the fragment to any owner 7181da177e4SLinus Torvalds * it might possess 7191da177e4SLinus Torvalds */ 7201da177e4SLinus Torvalds 7211da177e4SLinus Torvalds if (skb->sk) 7221da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 7231da177e4SLinus Torvalds 7241da177e4SLinus Torvalds /* 7251da177e4SLinus Torvalds * Copy the packet header into the new buffer. 7261da177e4SLinus Torvalds */ 7271da177e4SLinus Torvalds 728d626f62bSArnaldo Carvalho de Melo skb_copy_from_linear_data(skb, skb_network_header(skb2), hlen); 7291da177e4SLinus Torvalds 7301da177e4SLinus Torvalds /* 7311da177e4SLinus Torvalds * Copy a block of the IP datagram. 7321da177e4SLinus Torvalds */ 733bff9b61cSArnaldo Carvalho de Melo if (skb_copy_bits(skb, ptr, skb_transport_header(skb2), len)) 7341da177e4SLinus Torvalds BUG(); 7351da177e4SLinus Torvalds left -= len; 7361da177e4SLinus Torvalds 7371da177e4SLinus Torvalds /* 7381da177e4SLinus Torvalds * Fill in the new header fields. 7391da177e4SLinus Torvalds */ 740eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb2); 7411da177e4SLinus Torvalds iph->frag_off = htons((offset >> 3)); 7421da177e4SLinus Torvalds 743d6b915e2SFlorian Westphal if (IPCB(skb)->flags & IPSKB_FRAG_PMTU) 744d6b915e2SFlorian Westphal iph->frag_off |= htons(IP_DF); 745d6b915e2SFlorian Westphal 7461da177e4SLinus Torvalds /* ANK: dirty, but effective trick. Upgrade options only if 7471da177e4SLinus Torvalds * the segment to be fragmented was THE FIRST (otherwise, 7481da177e4SLinus Torvalds * options are already fixed) and make it ONCE 7491da177e4SLinus Torvalds * on the initial skb, so that all the following fragments 7501da177e4SLinus Torvalds * will inherit fixed options. 7511da177e4SLinus Torvalds */ 7521da177e4SLinus Torvalds if (offset == 0) 7531da177e4SLinus Torvalds ip_options_fragment(skb); 7541da177e4SLinus Torvalds 7551da177e4SLinus Torvalds /* 7561da177e4SLinus Torvalds * Added AC : If we are fragmenting a fragment that's not the 7571da177e4SLinus Torvalds * last fragment then keep MF on each bit 7581da177e4SLinus Torvalds */ 7591da177e4SLinus Torvalds if (left > 0 || not_last_frag) 7601da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 7611da177e4SLinus Torvalds ptr += len; 7621da177e4SLinus Torvalds offset += len; 7631da177e4SLinus Torvalds 7641da177e4SLinus Torvalds /* 7651da177e4SLinus Torvalds * Put this fragment into the sending queue. 7661da177e4SLinus Torvalds */ 7671da177e4SLinus Torvalds iph->tot_len = htons(len + hlen); 7681da177e4SLinus Torvalds 7691da177e4SLinus Torvalds ip_send_check(iph); 7701da177e4SLinus Torvalds 771694869b3SEric W. Biederman err = output(net, sk, skb2); 7721da177e4SLinus Torvalds if (err) 7731da177e4SLinus Torvalds goto fail; 774dafee490SWei Dong 77526a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 7761da177e4SLinus Torvalds } 7775d0ba55bSEric Dumazet consume_skb(skb); 77826a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 7791da177e4SLinus Torvalds return err; 7801da177e4SLinus Torvalds 7811da177e4SLinus Torvalds fail: 7821da177e4SLinus Torvalds kfree_skb(skb); 78326a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 7841da177e4SLinus Torvalds return err; 7851da177e4SLinus Torvalds } 78649d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment); 7872e2f7aefSPatrick McHardy 7881da177e4SLinus Torvalds int 7891da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb) 7901da177e4SLinus Torvalds { 791f69e6d13SAl Viro struct msghdr *msg = from; 7921da177e4SLinus Torvalds 79384fa7933SPatrick McHardy if (skb->ip_summed == CHECKSUM_PARTIAL) { 79421226abbSAl Viro if (copy_from_iter(to, len, &msg->msg_iter) != len) 7951da177e4SLinus Torvalds return -EFAULT; 7961da177e4SLinus Torvalds } else { 79744bb9363SAl Viro __wsum csum = 0; 79821226abbSAl Viro if (csum_and_copy_from_iter(to, len, &csum, &msg->msg_iter) != len) 7991da177e4SLinus Torvalds return -EFAULT; 8001da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 8011da177e4SLinus Torvalds } 8021da177e4SLinus Torvalds return 0; 8031da177e4SLinus Torvalds } 8044bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag); 8051da177e4SLinus Torvalds 80644bb9363SAl Viro static inline __wsum 8071da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy) 8081da177e4SLinus Torvalds { 8091da177e4SLinus Torvalds char *kaddr; 81044bb9363SAl Viro __wsum csum; 8111da177e4SLinus Torvalds kaddr = kmap(page); 8121da177e4SLinus Torvalds csum = csum_partial(kaddr + offset, copy, 0); 8131da177e4SLinus Torvalds kunmap(page); 8141da177e4SLinus Torvalds return csum; 8151da177e4SLinus Torvalds } 8161da177e4SLinus Torvalds 8174b30b1c6SAdrian Bunk static inline int ip_ufo_append_data(struct sock *sk, 8181470ddf7SHerbert Xu struct sk_buff_head *queue, 819e89e9cf5SAnanda Raju int getfrag(void *from, char *to, int offset, int len, 820e89e9cf5SAnanda Raju int odd, struct sk_buff *skb), 821e89e9cf5SAnanda Raju void *from, int length, int hh_len, int fragheaderlen, 822d9be4f7aSBill Sommerfeld int transhdrlen, int maxfraglen, unsigned int flags) 823e89e9cf5SAnanda Raju { 824e89e9cf5SAnanda Raju struct sk_buff *skb; 825e89e9cf5SAnanda Raju int err; 826e89e9cf5SAnanda Raju 827e89e9cf5SAnanda Raju /* There is support for UDP fragmentation offload by network 828e89e9cf5SAnanda Raju * device, so create one single skb packet containing complete 829e89e9cf5SAnanda Raju * udp datagram 830e89e9cf5SAnanda Raju */ 83151456b29SIan Morris skb = skb_peek_tail(queue); 83251456b29SIan Morris if (!skb) { 833e89e9cf5SAnanda Raju skb = sock_alloc_send_skb(sk, 834e89e9cf5SAnanda Raju hh_len + fragheaderlen + transhdrlen + 20, 835e89e9cf5SAnanda Raju (flags & MSG_DONTWAIT), &err); 836e89e9cf5SAnanda Raju 83751456b29SIan Morris if (!skb) 838e89e9cf5SAnanda Raju return err; 839e89e9cf5SAnanda Raju 840e89e9cf5SAnanda Raju /* reserve space for Hardware header */ 841e89e9cf5SAnanda Raju skb_reserve(skb, hh_len); 842e89e9cf5SAnanda Raju 843e89e9cf5SAnanda Raju /* create space for UDP/IP header */ 844e89e9cf5SAnanda Raju skb_put(skb, fragheaderlen + transhdrlen); 845e89e9cf5SAnanda Raju 846e89e9cf5SAnanda Raju /* initialize network header pointer */ 847c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb); 848e89e9cf5SAnanda Raju 849e89e9cf5SAnanda Raju /* initialize protocol header pointer */ 850b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header + fragheaderlen; 851e89e9cf5SAnanda Raju 852e89e9cf5SAnanda Raju skb->csum = 0; 853e89e9cf5SAnanda Raju 854e93b7d74SJiri Pirko __skb_queue_tail(queue, skb); 855e93b7d74SJiri Pirko } else if (skb_is_gso(skb)) { 856e93b7d74SJiri Pirko goto append; 857e93b7d74SJiri Pirko } 858e93b7d74SJiri Pirko 859e93b7d74SJiri Pirko skb->ip_summed = CHECKSUM_PARTIAL; 860e89e9cf5SAnanda Raju /* specify the length of each IP datagram fragment */ 861d9be4f7aSBill Sommerfeld skb_shinfo(skb)->gso_size = maxfraglen - fragheaderlen; 862f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 863be9164e7SKostya B 864e93b7d74SJiri Pirko append: 865be9164e7SKostya B return skb_append_datato_frags(sk, skb, getfrag, from, 866be9164e7SKostya B (length - transhdrlen)); 867e89e9cf5SAnanda Raju } 868e89e9cf5SAnanda Raju 869f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk, 870f5fca608SDavid S. Miller struct flowi4 *fl4, 871f5fca608SDavid S. Miller struct sk_buff_head *queue, 8721470ddf7SHerbert Xu struct inet_cork *cork, 8735640f768SEric Dumazet struct page_frag *pfrag, 8741470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, 8751470ddf7SHerbert Xu int len, int odd, struct sk_buff *skb), 8761da177e4SLinus Torvalds void *from, int length, int transhdrlen, 8771da177e4SLinus Torvalds unsigned int flags) 8781da177e4SLinus Torvalds { 8791da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 8801da177e4SLinus Torvalds struct sk_buff *skb; 8811da177e4SLinus Torvalds 88207df5294SHerbert Xu struct ip_options *opt = cork->opt; 8831da177e4SLinus Torvalds int hh_len; 8841da177e4SLinus Torvalds int exthdrlen; 8851da177e4SLinus Torvalds int mtu; 8861da177e4SLinus Torvalds int copy; 8871da177e4SLinus Torvalds int err; 8881da177e4SLinus Torvalds int offset = 0; 889daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, maxnonfragsize; 8901da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 8911470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 89209c2d251SWillem de Bruijn u32 tskey = 0; 8931da177e4SLinus Torvalds 89496d7303eSSteffen Klassert skb = skb_peek_tail(queue); 89596d7303eSSteffen Klassert 89696d7303eSSteffen Klassert exthdrlen = !skb ? rt->dst.header_len : 0; 89707df5294SHerbert Xu mtu = cork->fragsize; 89809c2d251SWillem de Bruijn if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP && 89909c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 90009c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 9011470ddf7SHerbert Xu 902d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 9031da177e4SLinus Torvalds 9041da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 9051da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 90660ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 9071da177e4SLinus Torvalds 908daba287bSHannes Frederic Sowa if (cork->length + length > maxnonfragsize - fragheaderlen) { 909f5fca608SDavid S. Miller ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 91061e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 9111da177e4SLinus Torvalds return -EMSGSIZE; 9121da177e4SLinus Torvalds } 9131da177e4SLinus Torvalds 9141da177e4SLinus Torvalds /* 9151da177e4SLinus Torvalds * transhdrlen > 0 means that this is the first fragment and we wish 9161da177e4SLinus Torvalds * it won't be fragmented in the future. 9171da177e4SLinus Torvalds */ 9181da177e4SLinus Torvalds if (transhdrlen && 9191da177e4SLinus Torvalds length + fragheaderlen <= mtu && 920d8d1f30bSChangli Gao rt->dst.dev->features & NETIF_F_V4_CSUM && 9211da177e4SLinus Torvalds !exthdrlen) 92284fa7933SPatrick McHardy csummode = CHECKSUM_PARTIAL; 9231da177e4SLinus Torvalds 9241470ddf7SHerbert Xu cork->length += length; 92526cde9f7SHerbert Xu if (((length > mtu) || (skb && skb_is_gso(skb))) && 926be9164e7SKostya B (sk->sk_protocol == IPPROTO_UDP) && 927acf8dd0aSMichal Kubeček (rt->dst.dev->features & NETIF_F_UFO) && !rt->dst.header_len && 928acf8dd0aSMichal Kubeček (sk->sk_type == SOCK_DGRAM)) { 9291470ddf7SHerbert Xu err = ip_ufo_append_data(sk, queue, getfrag, from, length, 9301470ddf7SHerbert Xu hh_len, fragheaderlen, transhdrlen, 931d9be4f7aSBill Sommerfeld maxfraglen, flags); 932baa829d8SPatrick McHardy if (err) 933e89e9cf5SAnanda Raju goto error; 934e89e9cf5SAnanda Raju return 0; 935e89e9cf5SAnanda Raju } 9361da177e4SLinus Torvalds 9371da177e4SLinus Torvalds /* So, what's going on in the loop below? 9381da177e4SLinus Torvalds * 9391da177e4SLinus Torvalds * We use calculated fragment length to generate chained skb, 9401da177e4SLinus Torvalds * each of segments is IP fragment ready for sending to network after 9411da177e4SLinus Torvalds * adding appropriate IP header. 9421da177e4SLinus Torvalds */ 9431da177e4SLinus Torvalds 94426cde9f7SHerbert Xu if (!skb) 9451da177e4SLinus Torvalds goto alloc_new_skb; 9461da177e4SLinus Torvalds 9471da177e4SLinus Torvalds while (length > 0) { 9481da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 9491da177e4SLinus Torvalds copy = mtu - skb->len; 9501da177e4SLinus Torvalds if (copy < length) 9511da177e4SLinus Torvalds copy = maxfraglen - skb->len; 9521da177e4SLinus Torvalds if (copy <= 0) { 9531da177e4SLinus Torvalds char *data; 9541da177e4SLinus Torvalds unsigned int datalen; 9551da177e4SLinus Torvalds unsigned int fraglen; 9561da177e4SLinus Torvalds unsigned int fraggap; 9571da177e4SLinus Torvalds unsigned int alloclen; 9581da177e4SLinus Torvalds struct sk_buff *skb_prev; 9591da177e4SLinus Torvalds alloc_new_skb: 9601da177e4SLinus Torvalds skb_prev = skb; 9611da177e4SLinus Torvalds if (skb_prev) 9621da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 9631da177e4SLinus Torvalds else 9641da177e4SLinus Torvalds fraggap = 0; 9651da177e4SLinus Torvalds 9661da177e4SLinus Torvalds /* 9671da177e4SLinus Torvalds * If remaining data exceeds the mtu, 9681da177e4SLinus Torvalds * we know we need more fragment(s). 9691da177e4SLinus Torvalds */ 9701da177e4SLinus Torvalds datalen = length + fraggap; 9711da177e4SLinus Torvalds if (datalen > mtu - fragheaderlen) 9721da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 9731da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 9741da177e4SLinus Torvalds 9751da177e4SLinus Torvalds if ((flags & MSG_MORE) && 976d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 9771da177e4SLinus Torvalds alloclen = mtu; 9781da177e4SLinus Torvalds else 97959104f06SEric Dumazet alloclen = fraglen; 9801da177e4SLinus Torvalds 981353e5c9aSSteffen Klassert alloclen += exthdrlen; 982353e5c9aSSteffen Klassert 9831da177e4SLinus Torvalds /* The last fragment gets additional space at tail. 9841da177e4SLinus Torvalds * Note, with MSG_MORE we overallocate on fragments, 9851da177e4SLinus Torvalds * because we have no idea what fragment will be 9861da177e4SLinus Torvalds * the last. 9871da177e4SLinus Torvalds */ 98833f99dc7SSteffen Klassert if (datalen == length + fraggap) 989d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 99033f99dc7SSteffen Klassert 9911da177e4SLinus Torvalds if (transhdrlen) { 9921da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 9931da177e4SLinus Torvalds alloclen + hh_len + 15, 9941da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 9951da177e4SLinus Torvalds } else { 9961da177e4SLinus Torvalds skb = NULL; 9971da177e4SLinus Torvalds if (atomic_read(&sk->sk_wmem_alloc) <= 9981da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 9991da177e4SLinus Torvalds skb = sock_wmalloc(sk, 10001da177e4SLinus Torvalds alloclen + hh_len + 15, 1, 10011da177e4SLinus Torvalds sk->sk_allocation); 100251456b29SIan Morris if (unlikely(!skb)) 10031da177e4SLinus Torvalds err = -ENOBUFS; 10041da177e4SLinus Torvalds } 100551456b29SIan Morris if (!skb) 10061da177e4SLinus Torvalds goto error; 10071da177e4SLinus Torvalds 10081da177e4SLinus Torvalds /* 10091da177e4SLinus Torvalds * Fill in the control structures 10101da177e4SLinus Torvalds */ 10111da177e4SLinus Torvalds skb->ip_summed = csummode; 10121da177e4SLinus Torvalds skb->csum = 0; 10131da177e4SLinus Torvalds skb_reserve(skb, hh_len); 101411878b40SWillem de Bruijn 101511878b40SWillem de Bruijn /* only the initial fragment is time stamped */ 10161470ddf7SHerbert Xu skb_shinfo(skb)->tx_flags = cork->tx_flags; 101711878b40SWillem de Bruijn cork->tx_flags = 0; 101809c2d251SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 101909c2d251SWillem de Bruijn tskey = 0; 10201da177e4SLinus Torvalds 10211da177e4SLinus Torvalds /* 10221da177e4SLinus Torvalds * Find where to start putting bytes. 10231da177e4SLinus Torvalds */ 1024353e5c9aSSteffen Klassert data = skb_put(skb, fraglen + exthdrlen); 1025c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 1026b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1027b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 1028353e5c9aSSteffen Klassert data += fragheaderlen + exthdrlen; 10291da177e4SLinus Torvalds 10301da177e4SLinus Torvalds if (fraggap) { 10311da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 10321da177e4SLinus Torvalds skb_prev, maxfraglen, 10331da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 10341da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 10351da177e4SLinus Torvalds skb->csum); 10361da177e4SLinus Torvalds data += fraggap; 1037e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 10381da177e4SLinus Torvalds } 10391da177e4SLinus Torvalds 10401da177e4SLinus Torvalds copy = datalen - transhdrlen - fraggap; 10411da177e4SLinus Torvalds if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 10421da177e4SLinus Torvalds err = -EFAULT; 10431da177e4SLinus Torvalds kfree_skb(skb); 10441da177e4SLinus Torvalds goto error; 10451da177e4SLinus Torvalds } 10461da177e4SLinus Torvalds 10471da177e4SLinus Torvalds offset += copy; 10481da177e4SLinus Torvalds length -= datalen - fraggap; 10491da177e4SLinus Torvalds transhdrlen = 0; 10501da177e4SLinus Torvalds exthdrlen = 0; 10511da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 10521da177e4SLinus Torvalds 10531da177e4SLinus Torvalds /* 10541da177e4SLinus Torvalds * Put the packet on the pending queue. 10551da177e4SLinus Torvalds */ 10561470ddf7SHerbert Xu __skb_queue_tail(queue, skb); 10571da177e4SLinus Torvalds continue; 10581da177e4SLinus Torvalds } 10591da177e4SLinus Torvalds 10601da177e4SLinus Torvalds if (copy > length) 10611da177e4SLinus Torvalds copy = length; 10621da177e4SLinus Torvalds 1063d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) { 10641da177e4SLinus Torvalds unsigned int off; 10651da177e4SLinus Torvalds 10661da177e4SLinus Torvalds off = skb->len; 10671da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 10681da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 10691da177e4SLinus Torvalds __skb_trim(skb, off); 10701da177e4SLinus Torvalds err = -EFAULT; 10711da177e4SLinus Torvalds goto error; 10721da177e4SLinus Torvalds } 10731da177e4SLinus Torvalds } else { 10741da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 10751da177e4SLinus Torvalds 10761da177e4SLinus Torvalds err = -ENOMEM; 10775640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 10781da177e4SLinus Torvalds goto error; 10791da177e4SLinus Torvalds 10805640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 10815640f768SEric Dumazet pfrag->offset)) { 10821da177e4SLinus Torvalds err = -EMSGSIZE; 10835640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 10841da177e4SLinus Torvalds goto error; 10855640f768SEric Dumazet 10865640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 10875640f768SEric Dumazet pfrag->offset, 0); 10885640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 10895640f768SEric Dumazet get_page(pfrag->page); 10901da177e4SLinus Torvalds } 10915640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 10925640f768SEric Dumazet if (getfrag(from, 10935640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 10945640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 10955640f768SEric Dumazet goto error_efault; 10965640f768SEric Dumazet 10975640f768SEric Dumazet pfrag->offset += copy; 10985640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 10991da177e4SLinus Torvalds skb->len += copy; 11001da177e4SLinus Torvalds skb->data_len += copy; 1101f945fa7aSHerbert Xu skb->truesize += copy; 1102f945fa7aSHerbert Xu atomic_add(copy, &sk->sk_wmem_alloc); 11031da177e4SLinus Torvalds } 11041da177e4SLinus Torvalds offset += copy; 11051da177e4SLinus Torvalds length -= copy; 11061da177e4SLinus Torvalds } 11071da177e4SLinus Torvalds 11081da177e4SLinus Torvalds return 0; 11091da177e4SLinus Torvalds 11105640f768SEric Dumazet error_efault: 11115640f768SEric Dumazet err = -EFAULT; 11121da177e4SLinus Torvalds error: 11131470ddf7SHerbert Xu cork->length -= length; 11145e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 11151da177e4SLinus Torvalds return err; 11161da177e4SLinus Torvalds } 11171da177e4SLinus Torvalds 11181470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork, 11191470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp) 11201470ddf7SHerbert Xu { 1121f6d8bd05SEric Dumazet struct ip_options_rcu *opt; 11221470ddf7SHerbert Xu struct rtable *rt; 11231470ddf7SHerbert Xu 11241470ddf7SHerbert Xu /* 11251470ddf7SHerbert Xu * setup for corking. 11261470ddf7SHerbert Xu */ 11271470ddf7SHerbert Xu opt = ipc->opt; 11281470ddf7SHerbert Xu if (opt) { 112951456b29SIan Morris if (!cork->opt) { 11301470ddf7SHerbert Xu cork->opt = kmalloc(sizeof(struct ip_options) + 40, 11311470ddf7SHerbert Xu sk->sk_allocation); 113251456b29SIan Morris if (unlikely(!cork->opt)) 11331470ddf7SHerbert Xu return -ENOBUFS; 11341470ddf7SHerbert Xu } 1135f6d8bd05SEric Dumazet memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen); 11361470ddf7SHerbert Xu cork->flags |= IPCORK_OPT; 11371470ddf7SHerbert Xu cork->addr = ipc->addr; 11381470ddf7SHerbert Xu } 11391470ddf7SHerbert Xu rt = *rtp; 11401470ddf7SHerbert Xu if (unlikely(!rt)) 11411470ddf7SHerbert Xu return -EFAULT; 11421470ddf7SHerbert Xu /* 11431470ddf7SHerbert Xu * We steal reference to this route, caller should not release it 11441470ddf7SHerbert Xu */ 11451470ddf7SHerbert Xu *rtp = NULL; 1146482fc609SHannes Frederic Sowa cork->fragsize = ip_sk_use_pmtu(sk) ? 1147482fc609SHannes Frederic Sowa dst_mtu(&rt->dst) : rt->dst.dev->mtu; 11481470ddf7SHerbert Xu cork->dst = &rt->dst; 11491470ddf7SHerbert Xu cork->length = 0; 1150aa661581SFrancesco Fusco cork->ttl = ipc->ttl; 1151aa661581SFrancesco Fusco cork->tos = ipc->tos; 1152aa661581SFrancesco Fusco cork->priority = ipc->priority; 11531470ddf7SHerbert Xu cork->tx_flags = ipc->tx_flags; 11541470ddf7SHerbert Xu 11551470ddf7SHerbert Xu return 0; 11561470ddf7SHerbert Xu } 11571470ddf7SHerbert Xu 11581470ddf7SHerbert Xu /* 11591470ddf7SHerbert Xu * ip_append_data() and ip_append_page() can make one large IP datagram 11601470ddf7SHerbert Xu * from many pieces of data. Each pieces will be holded on the socket 11611470ddf7SHerbert Xu * until ip_push_pending_frames() is called. Each piece can be a page 11621470ddf7SHerbert Xu * or non-page data. 11631470ddf7SHerbert Xu * 11641470ddf7SHerbert Xu * Not only UDP, other transport protocols - e.g. raw sockets - can use 11651470ddf7SHerbert Xu * this interface potentially. 11661470ddf7SHerbert Xu * 11671470ddf7SHerbert Xu * LATER: length must be adjusted by pad at tail, when it is required. 11681470ddf7SHerbert Xu */ 1169f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4, 11701470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, int len, 11711470ddf7SHerbert Xu int odd, struct sk_buff *skb), 11721470ddf7SHerbert Xu void *from, int length, int transhdrlen, 11731470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 11741470ddf7SHerbert Xu unsigned int flags) 11751470ddf7SHerbert Xu { 11761470ddf7SHerbert Xu struct inet_sock *inet = inet_sk(sk); 11771470ddf7SHerbert Xu int err; 11781470ddf7SHerbert Xu 11791470ddf7SHerbert Xu if (flags&MSG_PROBE) 11801470ddf7SHerbert Xu return 0; 11811470ddf7SHerbert Xu 11821470ddf7SHerbert Xu if (skb_queue_empty(&sk->sk_write_queue)) { 1183bdc712b4SDavid S. Miller err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp); 11841470ddf7SHerbert Xu if (err) 11851470ddf7SHerbert Xu return err; 11861470ddf7SHerbert Xu } else { 11871470ddf7SHerbert Xu transhdrlen = 0; 11881470ddf7SHerbert Xu } 11891470ddf7SHerbert Xu 11905640f768SEric Dumazet return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base, 11915640f768SEric Dumazet sk_page_frag(sk), getfrag, 11921470ddf7SHerbert Xu from, length, transhdrlen, flags); 11931470ddf7SHerbert Xu } 11941470ddf7SHerbert Xu 1195f5fca608SDavid S. Miller ssize_t ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page, 11961da177e4SLinus Torvalds int offset, size_t size, int flags) 11971da177e4SLinus Torvalds { 11981da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 11991da177e4SLinus Torvalds struct sk_buff *skb; 12001da177e4SLinus Torvalds struct rtable *rt; 12011da177e4SLinus Torvalds struct ip_options *opt = NULL; 1202bdc712b4SDavid S. Miller struct inet_cork *cork; 12031da177e4SLinus Torvalds int hh_len; 12041da177e4SLinus Torvalds int mtu; 12051da177e4SLinus Torvalds int len; 12061da177e4SLinus Torvalds int err; 1207daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize; 12081da177e4SLinus Torvalds 12091da177e4SLinus Torvalds if (inet->hdrincl) 12101da177e4SLinus Torvalds return -EPERM; 12111da177e4SLinus Torvalds 12121da177e4SLinus Torvalds if (flags&MSG_PROBE) 12131da177e4SLinus Torvalds return 0; 12141da177e4SLinus Torvalds 12151da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) 12161da177e4SLinus Torvalds return -EINVAL; 12171da177e4SLinus Torvalds 1218bdc712b4SDavid S. Miller cork = &inet->cork.base; 1219bdc712b4SDavid S. Miller rt = (struct rtable *)cork->dst; 1220bdc712b4SDavid S. Miller if (cork->flags & IPCORK_OPT) 1221bdc712b4SDavid S. Miller opt = cork->opt; 12221da177e4SLinus Torvalds 1223d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) 12241da177e4SLinus Torvalds return -EOPNOTSUPP; 12251da177e4SLinus Torvalds 1226d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 1227bdc712b4SDavid S. Miller mtu = cork->fragsize; 12281da177e4SLinus Torvalds 12291da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 12301da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 123160ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 12321da177e4SLinus Torvalds 1233daba287bSHannes Frederic Sowa if (cork->length + size > maxnonfragsize - fragheaderlen) { 123461e7f09dSHannes Frederic Sowa ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 123561e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 12361da177e4SLinus Torvalds return -EMSGSIZE; 12371da177e4SLinus Torvalds } 12381da177e4SLinus Torvalds 123951456b29SIan Morris skb = skb_peek_tail(&sk->sk_write_queue); 124051456b29SIan Morris if (!skb) 12411da177e4SLinus Torvalds return -EINVAL; 12421da177e4SLinus Torvalds 1243bdc712b4SDavid S. Miller cork->length += size; 124426cde9f7SHerbert Xu if ((size + skb->len > mtu) && 124526cde9f7SHerbert Xu (sk->sk_protocol == IPPROTO_UDP) && 1246d8d1f30bSChangli Gao (rt->dst.dev->features & NETIF_F_UFO)) { 12477967168cSHerbert Xu skb_shinfo(skb)->gso_size = mtu - fragheaderlen; 1248f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 12497967168cSHerbert Xu } 1250e89e9cf5SAnanda Raju 12511da177e4SLinus Torvalds while (size > 0) { 1252be12a1feSHannes Frederic Sowa if (skb_is_gso(skb)) { 1253e89e9cf5SAnanda Raju len = size; 1254be12a1feSHannes Frederic Sowa } else { 1255e89e9cf5SAnanda Raju 12561da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 12571da177e4SLinus Torvalds len = mtu - skb->len; 12581da177e4SLinus Torvalds if (len < size) 12591da177e4SLinus Torvalds len = maxfraglen - skb->len; 1260e89e9cf5SAnanda Raju } 12611da177e4SLinus Torvalds if (len <= 0) { 12621da177e4SLinus Torvalds struct sk_buff *skb_prev; 12631da177e4SLinus Torvalds int alloclen; 12641da177e4SLinus Torvalds 12651da177e4SLinus Torvalds skb_prev = skb; 12661da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 12671da177e4SLinus Torvalds 12681da177e4SLinus Torvalds alloclen = fragheaderlen + hh_len + fraggap + 15; 12691da177e4SLinus Torvalds skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation); 12701da177e4SLinus Torvalds if (unlikely(!skb)) { 12711da177e4SLinus Torvalds err = -ENOBUFS; 12721da177e4SLinus Torvalds goto error; 12731da177e4SLinus Torvalds } 12741da177e4SLinus Torvalds 12751da177e4SLinus Torvalds /* 12761da177e4SLinus Torvalds * Fill in the control structures 12771da177e4SLinus Torvalds */ 12781da177e4SLinus Torvalds skb->ip_summed = CHECKSUM_NONE; 12791da177e4SLinus Torvalds skb->csum = 0; 12801da177e4SLinus Torvalds skb_reserve(skb, hh_len); 12811da177e4SLinus Torvalds 12821da177e4SLinus Torvalds /* 12831da177e4SLinus Torvalds * Find where to start putting bytes. 12841da177e4SLinus Torvalds */ 1285967b05f6SArnaldo Carvalho de Melo skb_put(skb, fragheaderlen + fraggap); 12862ca9e6f2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1287b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1288b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 12891da177e4SLinus Torvalds if (fraggap) { 1290967b05f6SArnaldo Carvalho de Melo skb->csum = skb_copy_and_csum_bits(skb_prev, 1291967b05f6SArnaldo Carvalho de Melo maxfraglen, 12929c70220bSArnaldo Carvalho de Melo skb_transport_header(skb), 1293967b05f6SArnaldo Carvalho de Melo fraggap, 0); 12941da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 12951da177e4SLinus Torvalds skb->csum); 1296e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 12971da177e4SLinus Torvalds } 12981da177e4SLinus Torvalds 12991da177e4SLinus Torvalds /* 13001da177e4SLinus Torvalds * Put the packet on the pending queue. 13011da177e4SLinus Torvalds */ 13021da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 13031da177e4SLinus Torvalds continue; 13041da177e4SLinus Torvalds } 13051da177e4SLinus Torvalds 13061da177e4SLinus Torvalds if (len > size) 13071da177e4SLinus Torvalds len = size; 1308be12a1feSHannes Frederic Sowa 1309be12a1feSHannes Frederic Sowa if (skb_append_pagefrags(skb, page, offset, len)) { 13101da177e4SLinus Torvalds err = -EMSGSIZE; 13111da177e4SLinus Torvalds goto error; 13121da177e4SLinus Torvalds } 13131da177e4SLinus Torvalds 13141da177e4SLinus Torvalds if (skb->ip_summed == CHECKSUM_NONE) { 131544bb9363SAl Viro __wsum csum; 13161da177e4SLinus Torvalds csum = csum_page(page, offset, len); 13171da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, skb->len); 13181da177e4SLinus Torvalds } 13191da177e4SLinus Torvalds 13201da177e4SLinus Torvalds skb->len += len; 13211da177e4SLinus Torvalds skb->data_len += len; 13221e34a11dSDavid S. Miller skb->truesize += len; 13231e34a11dSDavid S. Miller atomic_add(len, &sk->sk_wmem_alloc); 13241da177e4SLinus Torvalds offset += len; 13251da177e4SLinus Torvalds size -= len; 13261da177e4SLinus Torvalds } 13271da177e4SLinus Torvalds return 0; 13281da177e4SLinus Torvalds 13291da177e4SLinus Torvalds error: 1330bdc712b4SDavid S. Miller cork->length -= size; 13315e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 13321da177e4SLinus Torvalds return err; 13331da177e4SLinus Torvalds } 13341da177e4SLinus Torvalds 13351470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork) 1336429f08e9SPavel Emelyanov { 13371470ddf7SHerbert Xu cork->flags &= ~IPCORK_OPT; 13381470ddf7SHerbert Xu kfree(cork->opt); 13391470ddf7SHerbert Xu cork->opt = NULL; 13401470ddf7SHerbert Xu dst_release(cork->dst); 13411470ddf7SHerbert Xu cork->dst = NULL; 1342429f08e9SPavel Emelyanov } 1343429f08e9SPavel Emelyanov 13441da177e4SLinus Torvalds /* 13451da177e4SLinus Torvalds * Combined all pending IP fragments on the socket as one IP datagram 13461da177e4SLinus Torvalds * and push them out. 13471da177e4SLinus Torvalds */ 13481c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk, 134977968b78SDavid S. Miller struct flowi4 *fl4, 13501470ddf7SHerbert Xu struct sk_buff_head *queue, 13511470ddf7SHerbert Xu struct inet_cork *cork) 13521da177e4SLinus Torvalds { 13531da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 13541da177e4SLinus Torvalds struct sk_buff **tail_skb; 13551da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 13560388b004SPavel Emelyanov struct net *net = sock_net(sk); 13571da177e4SLinus Torvalds struct ip_options *opt = NULL; 13581470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 13591da177e4SLinus Torvalds struct iphdr *iph; 136076ab608dSAlexey Dobriyan __be16 df = 0; 13611da177e4SLinus Torvalds __u8 ttl; 13621da177e4SLinus Torvalds 136351456b29SIan Morris skb = __skb_dequeue(queue); 136451456b29SIan Morris if (!skb) 13651da177e4SLinus Torvalds goto out; 13661da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 13671da177e4SLinus Torvalds 13681da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1369d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1370bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 13711470ddf7SHerbert Xu while ((tmp_skb = __skb_dequeue(queue)) != NULL) { 1372cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 13731da177e4SLinus Torvalds *tail_skb = tmp_skb; 13741da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 13751da177e4SLinus Torvalds skb->len += tmp_skb->len; 13761da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 13771da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 13781da177e4SLinus Torvalds tmp_skb->destructor = NULL; 13791da177e4SLinus Torvalds tmp_skb->sk = NULL; 13801da177e4SLinus Torvalds } 13811da177e4SLinus Torvalds 13821da177e4SLinus Torvalds /* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow 13831da177e4SLinus Torvalds * to fragment the frame generated here. No matter, what transforms 13841da177e4SLinus Torvalds * how transforms change size of the packet, it will come out. 13851da177e4SLinus Torvalds */ 138660ff7467SWANG Cong skb->ignore_df = ip_sk_ignore_df(sk); 13871da177e4SLinus Torvalds 13881da177e4SLinus Torvalds /* DF bit is set when we want to see DF on outgoing frames. 138960ff7467SWANG Cong * If ignore_df is set too, we still allow to fragment this frame 13901da177e4SLinus Torvalds * locally. */ 1391482fc609SHannes Frederic Sowa if (inet->pmtudisc == IP_PMTUDISC_DO || 1392482fc609SHannes Frederic Sowa inet->pmtudisc == IP_PMTUDISC_PROBE || 1393d8d1f30bSChangli Gao (skb->len <= dst_mtu(&rt->dst) && 1394d8d1f30bSChangli Gao ip_dont_fragment(sk, &rt->dst))) 13951da177e4SLinus Torvalds df = htons(IP_DF); 13961da177e4SLinus Torvalds 13971470ddf7SHerbert Xu if (cork->flags & IPCORK_OPT) 13981470ddf7SHerbert Xu opt = cork->opt; 13991da177e4SLinus Torvalds 1400aa661581SFrancesco Fusco if (cork->ttl != 0) 1401aa661581SFrancesco Fusco ttl = cork->ttl; 1402aa661581SFrancesco Fusco else if (rt->rt_type == RTN_MULTICAST) 14031da177e4SLinus Torvalds ttl = inet->mc_ttl; 14041da177e4SLinus Torvalds else 1405d8d1f30bSChangli Gao ttl = ip_select_ttl(inet, &rt->dst); 14061da177e4SLinus Torvalds 1407749154aaSAnsis Atteka iph = ip_hdr(skb); 14081da177e4SLinus Torvalds iph->version = 4; 14091da177e4SLinus Torvalds iph->ihl = 5; 1410aa661581SFrancesco Fusco iph->tos = (cork->tos != -1) ? cork->tos : inet->tos; 14111da177e4SLinus Torvalds iph->frag_off = df; 14121da177e4SLinus Torvalds iph->ttl = ttl; 14131da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 141484f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 1415b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, sk); 14161da177e4SLinus Torvalds 141722f728f8SDavid S. Miller if (opt) { 141822f728f8SDavid S. Miller iph->ihl += opt->optlen>>2; 141922f728f8SDavid S. Miller ip_options_build(skb, opt, cork->addr, rt, 0); 142022f728f8SDavid S. Miller } 142122f728f8SDavid S. Miller 1422aa661581SFrancesco Fusco skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority; 14234a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1424a21bba94SEric Dumazet /* 1425a21bba94SEric Dumazet * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec 1426a21bba94SEric Dumazet * on dst refcount 1427a21bba94SEric Dumazet */ 14281470ddf7SHerbert Xu cork->dst = NULL; 1429d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 14301da177e4SLinus Torvalds 143196793b48SDavid L Stevens if (iph->protocol == IPPROTO_ICMP) 14320388b004SPavel Emelyanov icmp_out_count(net, ((struct icmphdr *) 143396793b48SDavid L Stevens skb_transport_header(skb))->type); 143496793b48SDavid L Stevens 14351c32c5adSHerbert Xu ip_cork_release(cork); 14361c32c5adSHerbert Xu out: 14371c32c5adSHerbert Xu return skb; 14381c32c5adSHerbert Xu } 14391c32c5adSHerbert Xu 1440b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb) 14411c32c5adSHerbert Xu { 14421c32c5adSHerbert Xu int err; 14431c32c5adSHerbert Xu 1444c439cb2eSHerbert Xu err = ip_local_out(skb); 14451da177e4SLinus Torvalds if (err) { 14461da177e4SLinus Torvalds if (err > 0) 14476ce9e7b5SEric Dumazet err = net_xmit_errno(err); 14481da177e4SLinus Torvalds if (err) 14491c32c5adSHerbert Xu IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS); 14501da177e4SLinus Torvalds } 14511da177e4SLinus Torvalds 14521da177e4SLinus Torvalds return err; 14531da177e4SLinus Torvalds } 14541da177e4SLinus Torvalds 145577968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4) 14561470ddf7SHerbert Xu { 14571c32c5adSHerbert Xu struct sk_buff *skb; 14581c32c5adSHerbert Xu 145977968b78SDavid S. Miller skb = ip_finish_skb(sk, fl4); 14601c32c5adSHerbert Xu if (!skb) 14611c32c5adSHerbert Xu return 0; 14621c32c5adSHerbert Xu 14631c32c5adSHerbert Xu /* Netfilter gets whole the not fragmented skb. */ 1464b5ec8eeaSEric Dumazet return ip_send_skb(sock_net(sk), skb); 14651470ddf7SHerbert Xu } 14661470ddf7SHerbert Xu 14671da177e4SLinus Torvalds /* 14681da177e4SLinus Torvalds * Throw away all pending data on the socket. 14691da177e4SLinus Torvalds */ 14701470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk, 14711470ddf7SHerbert Xu struct sk_buff_head *queue, 14721470ddf7SHerbert Xu struct inet_cork *cork) 14731da177e4SLinus Torvalds { 14741da177e4SLinus Torvalds struct sk_buff *skb; 14751da177e4SLinus Torvalds 14761470ddf7SHerbert Xu while ((skb = __skb_dequeue_tail(queue)) != NULL) 14771da177e4SLinus Torvalds kfree_skb(skb); 14781da177e4SLinus Torvalds 14791470ddf7SHerbert Xu ip_cork_release(cork); 14801470ddf7SHerbert Xu } 14811470ddf7SHerbert Xu 14821470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk) 14831470ddf7SHerbert Xu { 1484bdc712b4SDavid S. Miller __ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base); 14851da177e4SLinus Torvalds } 14861da177e4SLinus Torvalds 14871c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk, 148877968b78SDavid S. Miller struct flowi4 *fl4, 14891c32c5adSHerbert Xu int getfrag(void *from, char *to, int offset, 14901c32c5adSHerbert Xu int len, int odd, struct sk_buff *skb), 14911c32c5adSHerbert Xu void *from, int length, int transhdrlen, 14921c32c5adSHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 14931c32c5adSHerbert Xu unsigned int flags) 14941c32c5adSHerbert Xu { 1495b80d7226SDavid S. Miller struct inet_cork cork; 14961c32c5adSHerbert Xu struct sk_buff_head queue; 14971c32c5adSHerbert Xu int err; 14981c32c5adSHerbert Xu 14991c32c5adSHerbert Xu if (flags & MSG_PROBE) 15001c32c5adSHerbert Xu return NULL; 15011c32c5adSHerbert Xu 15021c32c5adSHerbert Xu __skb_queue_head_init(&queue); 15031c32c5adSHerbert Xu 1504b80d7226SDavid S. Miller cork.flags = 0; 1505b80d7226SDavid S. Miller cork.addr = 0; 150670652728SDavid S. Miller cork.opt = NULL; 15071c32c5adSHerbert Xu err = ip_setup_cork(sk, &cork, ipc, rtp); 15081c32c5adSHerbert Xu if (err) 15091c32c5adSHerbert Xu return ERR_PTR(err); 15101c32c5adSHerbert Xu 15115640f768SEric Dumazet err = __ip_append_data(sk, fl4, &queue, &cork, 15125640f768SEric Dumazet ¤t->task_frag, getfrag, 15131c32c5adSHerbert Xu from, length, transhdrlen, flags); 15141c32c5adSHerbert Xu if (err) { 15151c32c5adSHerbert Xu __ip_flush_pending_frames(sk, &queue, &cork); 15161c32c5adSHerbert Xu return ERR_PTR(err); 15171c32c5adSHerbert Xu } 15181c32c5adSHerbert Xu 151977968b78SDavid S. Miller return __ip_make_skb(sk, fl4, &queue, &cork); 15201c32c5adSHerbert Xu } 15211da177e4SLinus Torvalds 15221da177e4SLinus Torvalds /* 15231da177e4SLinus Torvalds * Fetch data from kernel space and fill in checksum if needed. 15241da177e4SLinus Torvalds */ 15251da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset, 15261da177e4SLinus Torvalds int len, int odd, struct sk_buff *skb) 15271da177e4SLinus Torvalds { 15285084205fSAl Viro __wsum csum; 15291da177e4SLinus Torvalds 15301da177e4SLinus Torvalds csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0); 15311da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 15321da177e4SLinus Torvalds return 0; 15331da177e4SLinus Torvalds } 15341da177e4SLinus Torvalds 15351da177e4SLinus Torvalds /* 15361da177e4SLinus Torvalds * Generic function to send a packet as reply to another packet. 1537be9f4a44SEric Dumazet * Used to send some TCP resets/acks so far. 15381da177e4SLinus Torvalds */ 1539bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb, 154024a2d43dSEric Dumazet const struct ip_options *sopt, 154124a2d43dSEric Dumazet __be32 daddr, __be32 saddr, 154224a2d43dSEric Dumazet const struct ip_reply_arg *arg, 154370e73416SDavid S. Miller unsigned int len) 15441da177e4SLinus Torvalds { 1545f6d8bd05SEric Dumazet struct ip_options_data replyopts; 15461da177e4SLinus Torvalds struct ipcm_cookie ipc; 154777968b78SDavid S. Miller struct flowi4 fl4; 1548511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1549bdbbb852SEric Dumazet struct net *net = sock_net(sk); 1550be9f4a44SEric Dumazet struct sk_buff *nskb; 15514062090eSVasily Averin int err; 1552f7ba868bSDavid Ahern int oif; 15531da177e4SLinus Torvalds 155424a2d43dSEric Dumazet if (__ip_options_echo(&replyopts.opt.opt, skb, sopt)) 15551da177e4SLinus Torvalds return; 15561da177e4SLinus Torvalds 15570a5ebb80SDavid S. Miller ipc.addr = daddr; 15581da177e4SLinus Torvalds ipc.opt = NULL; 15592244d07bSOliver Hartkopp ipc.tx_flags = 0; 1560aa661581SFrancesco Fusco ipc.ttl = 0; 1561aa661581SFrancesco Fusco ipc.tos = -1; 15621da177e4SLinus Torvalds 1563f6d8bd05SEric Dumazet if (replyopts.opt.opt.optlen) { 15641da177e4SLinus Torvalds ipc.opt = &replyopts.opt; 15651da177e4SLinus Torvalds 1566f6d8bd05SEric Dumazet if (replyopts.opt.opt.srr) 1567f6d8bd05SEric Dumazet daddr = replyopts.opt.opt.faddr; 15681da177e4SLinus Torvalds } 15691da177e4SLinus Torvalds 1570f7ba868bSDavid Ahern oif = arg->bound_dev_if; 1571007979eaSDavid Ahern if (!oif && netif_index_is_l3_master(net, skb->skb_iif)) 1572f7ba868bSDavid Ahern oif = skb->skb_iif; 1573f7ba868bSDavid Ahern 1574f7ba868bSDavid Ahern flowi4_init_output(&fl4, oif, 1575e110861fSLorenzo Colitti IP4_REPLY_MARK(net, skb->mark), 157666b13d99SEric Dumazet RT_TOS(arg->tos), 1577be9f4a44SEric Dumazet RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol, 1578538de0e0SDavid S. Miller ip_reply_arg_flowi_flags(arg), 157970e73416SDavid S. Miller daddr, saddr, 1580538de0e0SDavid S. Miller tcp_hdr(skb)->source, tcp_hdr(skb)->dest); 15819d6ec938SDavid S. Miller security_skb_classify_flow(skb, flowi4_to_flowi(&fl4)); 1582be9f4a44SEric Dumazet rt = ip_route_output_key(net, &fl4); 1583b23dd4feSDavid S. Miller if (IS_ERR(rt)) 15841da177e4SLinus Torvalds return; 15851da177e4SLinus Torvalds 1586bdbbb852SEric Dumazet inet_sk(sk)->tos = arg->tos; 15871da177e4SLinus Torvalds 15881da177e4SLinus Torvalds sk->sk_priority = skb->priority; 1589eddc9ec5SArnaldo Carvalho de Melo sk->sk_protocol = ip_hdr(skb)->protocol; 1590f0e48dbfSPatrick McHardy sk->sk_bound_dev_if = arg->bound_dev_if; 1591be9f4a44SEric Dumazet sk->sk_sndbuf = sysctl_wmem_default; 15924062090eSVasily Averin err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base, 15934062090eSVasily Averin len, 0, &ipc, &rt, MSG_DONTWAIT); 15944062090eSVasily Averin if (unlikely(err)) { 15954062090eSVasily Averin ip_flush_pending_frames(sk); 15964062090eSVasily Averin goto out; 15974062090eSVasily Averin } 15984062090eSVasily Averin 1599be9f4a44SEric Dumazet nskb = skb_peek(&sk->sk_write_queue); 1600be9f4a44SEric Dumazet if (nskb) { 16011da177e4SLinus Torvalds if (arg->csumoffset >= 0) 1602be9f4a44SEric Dumazet *((__sum16 *)skb_transport_header(nskb) + 1603be9f4a44SEric Dumazet arg->csumoffset) = csum_fold(csum_add(nskb->csum, 16049c70220bSArnaldo Carvalho de Melo arg->csum)); 1605be9f4a44SEric Dumazet nskb->ip_summed = CHECKSUM_NONE; 1606be9f4a44SEric Dumazet skb_set_queue_mapping(nskb, skb_get_queue_mapping(skb)); 160777968b78SDavid S. Miller ip_push_pending_frames(sk, &fl4); 16081da177e4SLinus Torvalds } 16094062090eSVasily Averin out: 16101da177e4SLinus Torvalds ip_rt_put(rt); 16111da177e4SLinus Torvalds } 16121da177e4SLinus Torvalds 16131da177e4SLinus Torvalds void __init ip_init(void) 16141da177e4SLinus Torvalds { 16151da177e4SLinus Torvalds ip_rt_init(); 16161da177e4SLinus Torvalds inet_initpeers(); 16171da177e4SLinus Torvalds 161872c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST) 161972c1d3bdSWANG Cong igmp_mc_init(); 16201da177e4SLinus Torvalds #endif 16211da177e4SLinus Torvalds } 1622