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> 7614972cbdSRoopa Prabhu #include <net/lwtunnel.h> 77*33b48679SDaniel Mack #include <linux/bpf-cgroup.h> 781da177e4SLinus Torvalds #include <linux/igmp.h> 791da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h> 801da177e4SLinus Torvalds #include <linux/netfilter_bridge.h> 811da177e4SLinus Torvalds #include <linux/netlink.h> 826cbb0df7SArnaldo Carvalho de Melo #include <linux/tcp.h> 831da177e4SLinus Torvalds 84694869b3SEric W. Biederman static int 85694869b3SEric W. Biederman ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 86c5501eb3SFlorian Westphal unsigned int mtu, 87694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)); 8849d16b23SAndy Zhou 891da177e4SLinus Torvalds /* Generate a checksum for an outgoing IP datagram. */ 902fbd9679SDenis Efremov void ip_send_check(struct iphdr *iph) 911da177e4SLinus Torvalds { 921da177e4SLinus Torvalds iph->check = 0; 931da177e4SLinus Torvalds iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl); 941da177e4SLinus Torvalds } 954bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_send_check); 961da177e4SLinus Torvalds 97cf91a99dSEric W. Biederman int __ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb) 98c439cb2eSHerbert Xu { 99c439cb2eSHerbert Xu struct iphdr *iph = ip_hdr(skb); 100c439cb2eSHerbert Xu 101c439cb2eSHerbert Xu iph->tot_len = htons(skb->len); 102c439cb2eSHerbert Xu ip_send_check(iph); 103a8e3e1a9SDavid Ahern 104a8e3e1a9SDavid Ahern /* if egress device is enslaved to an L3 master device pass the 105a8e3e1a9SDavid Ahern * skb to its handler for processing 106a8e3e1a9SDavid Ahern */ 107a8e3e1a9SDavid Ahern skb = l3mdev_ip_out(sk, skb); 108a8e3e1a9SDavid Ahern if (unlikely(!skb)) 109a8e3e1a9SDavid Ahern return 0; 110a8e3e1a9SDavid Ahern 11129a26a56SEric W. Biederman return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT, 11229a26a56SEric W. Biederman net, sk, skb, NULL, skb_dst(skb)->dev, 11313206b6bSEric W. Biederman dst_output); 1147026b1ddSDavid Miller } 1157026b1ddSDavid Miller 11633224b16SEric W. Biederman int ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb) 117c439cb2eSHerbert Xu { 118c439cb2eSHerbert Xu int err; 119c439cb2eSHerbert Xu 120cf91a99dSEric W. Biederman err = __ip_local_out(net, sk, skb); 121c439cb2eSHerbert Xu if (likely(err == 1)) 12213206b6bSEric W. Biederman err = dst_output(net, sk, skb); 123c439cb2eSHerbert Xu 124c439cb2eSHerbert Xu return err; 125c439cb2eSHerbert Xu } 126e2cb77dbSEric W. Biederman EXPORT_SYMBOL_GPL(ip_local_out); 127c439cb2eSHerbert Xu 1281da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst) 1291da177e4SLinus Torvalds { 1301da177e4SLinus Torvalds int ttl = inet->uc_ttl; 1311da177e4SLinus Torvalds 1321da177e4SLinus Torvalds if (ttl < 0) 133323e126fSDavid S. Miller ttl = ip4_dst_hoplimit(dst); 1341da177e4SLinus Torvalds return ttl; 1351da177e4SLinus Torvalds } 1361da177e4SLinus Torvalds 1371da177e4SLinus Torvalds /* 1381da177e4SLinus Torvalds * Add an ip header to a skbuff and send it out. 1391da177e4SLinus Torvalds * 1401da177e4SLinus Torvalds */ 141cfe673b0SEric Dumazet int ip_build_and_send_pkt(struct sk_buff *skb, const struct sock *sk, 142f6d8bd05SEric Dumazet __be32 saddr, __be32 daddr, struct ip_options_rcu *opt) 1431da177e4SLinus Torvalds { 1441da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 145511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 14677589ce0SEric W. Biederman struct net *net = sock_net(sk); 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; 16577589ce0SEric W. Biederman __ip_select_ident(net, 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. */ 17733224b16SEric W. Biederman return ip_local_out(net, skb->sk, 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 21014972cbdSRoopa Prabhu if (lwtunnel_xmit_redirect(dst->lwtstate)) { 21114972cbdSRoopa Prabhu int res = lwtunnel_xmit(skb); 21214972cbdSRoopa Prabhu 21314972cbdSRoopa Prabhu if (res < 0 || res == LWTUNNEL_XMIT_DONE) 21414972cbdSRoopa Prabhu return res; 21514972cbdSRoopa Prabhu } 21614972cbdSRoopa Prabhu 217a263b309SDavid S. Miller rcu_read_lock_bh(); 218155e8336SJulian Anastasov nexthop = (__force u32) rt_nexthop(rt, ip_hdr(skb)->daddr); 219a263b309SDavid S. Miller neigh = __ipv4_neigh_lookup_noref(dev, nexthop); 220a263b309SDavid S. Miller if (unlikely(!neigh)) 221a263b309SDavid S. Miller neigh = __neigh_create(&arp_tbl, &nexthop, dev, false); 2229871f1adSVasiliy Kulikov if (!IS_ERR(neigh)) { 2235110effeSDavid S. Miller int res = dst_neigh_output(dst, neigh, skb); 224f2c31e32SEric Dumazet 225a263b309SDavid S. Miller rcu_read_unlock_bh(); 226f2c31e32SEric Dumazet return res; 227f2c31e32SEric Dumazet } 228a263b309SDavid S. Miller rcu_read_unlock_bh(); 22905e3aa09SDavid S. Miller 230e87cc472SJoe Perches net_dbg_ratelimited("%s: No header cache and no neighbour!\n", 231e87cc472SJoe Perches __func__); 2321da177e4SLinus Torvalds kfree_skb(skb); 2331da177e4SLinus Torvalds return -EINVAL; 2341da177e4SLinus Torvalds } 2351da177e4SLinus Torvalds 236694869b3SEric W. Biederman static int ip_finish_output_gso(struct net *net, struct sock *sk, 237694869b3SEric W. Biederman struct sk_buff *skb, unsigned int mtu) 238c7ba65d7SFlorian Westphal { 239c7ba65d7SFlorian Westphal netdev_features_t features; 240c7ba65d7SFlorian Westphal struct sk_buff *segs; 241c7ba65d7SFlorian Westphal int ret = 0; 242c7ba65d7SFlorian Westphal 2439ee6c5dcSLance Richardson /* common case: seglen is <= mtu 244359ebda2SShmulik Ladkani */ 2459ee6c5dcSLance Richardson if (skb_gso_validate_mtu(skb, mtu)) 246694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 247c7ba65d7SFlorian Westphal 2480ace81ecSLance Richardson /* Slowpath - GSO segment length exceeds the egress MTU. 249c7ba65d7SFlorian Westphal * 2500ace81ecSLance Richardson * This can happen in several cases: 2510ace81ecSLance Richardson * - Forwarding of a TCP GRO skb, when DF flag is not set. 2520ace81ecSLance Richardson * - Forwarding of an skb that arrived on a virtualization interface 2530ace81ecSLance Richardson * (virtio-net/vhost/tap) with TSO/GSO size set by other network 2540ace81ecSLance Richardson * stack. 2550ace81ecSLance Richardson * - Local GSO skb transmitted on an NETIF_F_TSO tunnel stacked over an 2560ace81ecSLance Richardson * interface with a smaller MTU. 2570ace81ecSLance Richardson * - Arriving GRO skb (or GSO skb in a virtualized environment) that is 2580ace81ecSLance Richardson * bridged to a NETIF_F_TSO tunnel stacked over an interface with an 2590ace81ecSLance Richardson * insufficent MTU. 260c7ba65d7SFlorian Westphal */ 261c7ba65d7SFlorian Westphal features = netif_skb_features(skb); 2629207f9d4SKonstantin Khlebnikov BUILD_BUG_ON(sizeof(*IPCB(skb)) > SKB_SGO_CB_OFFSET); 263c7ba65d7SFlorian Westphal segs = skb_gso_segment(skb, features & ~NETIF_F_GSO_MASK); 264330966e5SFlorian Westphal if (IS_ERR_OR_NULL(segs)) { 265c7ba65d7SFlorian Westphal kfree_skb(skb); 266c7ba65d7SFlorian Westphal return -ENOMEM; 267c7ba65d7SFlorian Westphal } 268c7ba65d7SFlorian Westphal 269c7ba65d7SFlorian Westphal consume_skb(skb); 270c7ba65d7SFlorian Westphal 271c7ba65d7SFlorian Westphal do { 272c7ba65d7SFlorian Westphal struct sk_buff *nskb = segs->next; 273c7ba65d7SFlorian Westphal int err; 274c7ba65d7SFlorian Westphal 275c7ba65d7SFlorian Westphal segs->next = NULL; 276694869b3SEric W. Biederman err = ip_fragment(net, sk, segs, mtu, ip_finish_output2); 277c7ba65d7SFlorian Westphal 278c7ba65d7SFlorian Westphal if (err && ret == 0) 279c7ba65d7SFlorian Westphal ret = err; 280c7ba65d7SFlorian Westphal segs = nskb; 281c7ba65d7SFlorian Westphal } while (segs); 282c7ba65d7SFlorian Westphal 283c7ba65d7SFlorian Westphal return ret; 284c7ba65d7SFlorian Westphal } 285c7ba65d7SFlorian Westphal 2860c4b51f0SEric W. Biederman static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 2871da177e4SLinus Torvalds { 288c5501eb3SFlorian Westphal unsigned int mtu; 289*33b48679SDaniel Mack int ret; 290*33b48679SDaniel Mack 291*33b48679SDaniel Mack ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 292*33b48679SDaniel Mack if (ret) { 293*33b48679SDaniel Mack kfree_skb(skb); 294*33b48679SDaniel Mack return ret; 295*33b48679SDaniel Mack } 296c5501eb3SFlorian Westphal 2975c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM) 2985c901daaSPatrick McHardy /* Policy lookup after SNAT yielded a new policy */ 29900db4124SIan Morris if (skb_dst(skb)->xfrm) { 30048d5cad8SPatrick McHardy IPCB(skb)->flags |= IPSKB_REROUTED; 30113206b6bSEric W. Biederman return dst_output(net, sk, skb); 30248d5cad8SPatrick McHardy } 3035c901daaSPatrick McHardy #endif 304fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 305c7ba65d7SFlorian Westphal if (skb_is_gso(skb)) 306694869b3SEric W. Biederman return ip_finish_output_gso(net, sk, skb, mtu); 307c7ba65d7SFlorian Westphal 308d6b915e2SFlorian Westphal if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU)) 309694869b3SEric W. Biederman return ip_fragment(net, sk, skb, mtu, ip_finish_output2); 310c7ba65d7SFlorian Westphal 311694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 3121da177e4SLinus Torvalds } 3131da177e4SLinus Torvalds 314*33b48679SDaniel Mack static int ip_mc_finish_output(struct net *net, struct sock *sk, 315*33b48679SDaniel Mack struct sk_buff *skb) 316*33b48679SDaniel Mack { 317*33b48679SDaniel Mack int ret; 318*33b48679SDaniel Mack 319*33b48679SDaniel Mack ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 320*33b48679SDaniel Mack if (ret) { 321*33b48679SDaniel Mack kfree_skb(skb); 322*33b48679SDaniel Mack return ret; 323*33b48679SDaniel Mack } 324*33b48679SDaniel Mack 325*33b48679SDaniel Mack return dev_loopback_xmit(net, sk, skb); 326*33b48679SDaniel Mack } 327*33b48679SDaniel Mack 328ede2059dSEric W. Biederman int ip_mc_output(struct net *net, struct sock *sk, struct sk_buff *skb) 3291da177e4SLinus Torvalds { 330511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 331d8d1f30bSChangli Gao struct net_device *dev = rt->dst.dev; 3321da177e4SLinus Torvalds 3331da177e4SLinus Torvalds /* 3341da177e4SLinus Torvalds * If the indicated interface is up and running, send the packet. 3351da177e4SLinus Torvalds */ 33688f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3371da177e4SLinus Torvalds 3381da177e4SLinus Torvalds skb->dev = dev; 3391da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 3401da177e4SLinus Torvalds 3411da177e4SLinus Torvalds /* 3421da177e4SLinus Torvalds * Multicasts are looped back for other local users 3431da177e4SLinus Torvalds */ 3441da177e4SLinus Torvalds 3451da177e4SLinus Torvalds if (rt->rt_flags&RTCF_MULTICAST) { 3467ad6848cSOctavian Purdila if (sk_mc_loop(sk) 3471da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 3481da177e4SLinus Torvalds /* Small optimization: do not loopback not local frames, 3491da177e4SLinus Torvalds which returned after forwarding; they will be dropped 3501da177e4SLinus Torvalds by ip_mr_input in any case. 3511da177e4SLinus Torvalds Note, that local frames are looped back to be delivered 3521da177e4SLinus Torvalds to local recipients. 3531da177e4SLinus Torvalds 3541da177e4SLinus Torvalds This check is duplicated in ip_mr_input at the moment. 3551da177e4SLinus Torvalds */ 3569d4fb27dSJoe Perches && 3579d4fb27dSJoe Perches ((rt->rt_flags & RTCF_LOCAL) || 3589d4fb27dSJoe Perches !(IPCB(skb)->flags & IPSKB_FORWARDED)) 3591da177e4SLinus Torvalds #endif 3601da177e4SLinus Torvalds ) { 3611da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3621da177e4SLinus Torvalds if (newskb) 3639bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 36429a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 365*33b48679SDaniel Mack ip_mc_finish_output); 3661da177e4SLinus Torvalds } 3671da177e4SLinus Torvalds 3681da177e4SLinus Torvalds /* Multicasts with ttl 0 must not go beyond the host */ 3691da177e4SLinus Torvalds 370eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl == 0) { 3711da177e4SLinus Torvalds kfree_skb(skb); 3721da177e4SLinus Torvalds return 0; 3731da177e4SLinus Torvalds } 3741da177e4SLinus Torvalds } 3751da177e4SLinus Torvalds 3761da177e4SLinus Torvalds if (rt->rt_flags&RTCF_BROADCAST) { 3771da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3781da177e4SLinus Torvalds if (newskb) 37929a26a56SEric W. Biederman NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 38029a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 381*33b48679SDaniel Mack ip_mc_finish_output); 3821da177e4SLinus Torvalds } 3831da177e4SLinus Torvalds 38429a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 38529a26a56SEric W. Biederman net, sk, skb, NULL, skb->dev, 38629a26a56SEric W. Biederman ip_finish_output, 38748d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 3881da177e4SLinus Torvalds } 3891da177e4SLinus Torvalds 390ede2059dSEric W. Biederman int ip_output(struct net *net, struct sock *sk, struct sk_buff *skb) 3911da177e4SLinus Torvalds { 392adf30907SEric Dumazet struct net_device *dev = skb_dst(skb)->dev; 3931bd9bef6SPatrick McHardy 39488f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3951da177e4SLinus Torvalds 3961bd9bef6SPatrick McHardy skb->dev = dev; 3971bd9bef6SPatrick McHardy skb->protocol = htons(ETH_P_IP); 3981bd9bef6SPatrick McHardy 39929a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 40029a26a56SEric W. Biederman net, sk, skb, NULL, dev, 40148d5cad8SPatrick McHardy ip_finish_output, 40248d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 4031da177e4SLinus Torvalds } 4041da177e4SLinus Torvalds 40584f9307cSEric Dumazet /* 40684f9307cSEric Dumazet * copy saddr and daddr, possibly using 64bit load/stores 40784f9307cSEric Dumazet * Equivalent to : 40884f9307cSEric Dumazet * iph->saddr = fl4->saddr; 40984f9307cSEric Dumazet * iph->daddr = fl4->daddr; 41084f9307cSEric Dumazet */ 41184f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4) 41284f9307cSEric Dumazet { 41384f9307cSEric Dumazet BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) != 41484f9307cSEric Dumazet offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr)); 41584f9307cSEric Dumazet memcpy(&iph->saddr, &fl4->saddr, 41684f9307cSEric Dumazet sizeof(fl4->saddr) + sizeof(fl4->daddr)); 41784f9307cSEric Dumazet } 41884f9307cSEric Dumazet 419b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */ 420b0270e91SEric Dumazet int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl) 4211da177e4SLinus Torvalds { 4221da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 42377589ce0SEric W. Biederman struct net *net = sock_net(sk); 424f6d8bd05SEric Dumazet struct ip_options_rcu *inet_opt; 425b57ae01aSDavid S. Miller struct flowi4 *fl4; 4261da177e4SLinus Torvalds struct rtable *rt; 4271da177e4SLinus Torvalds struct iphdr *iph; 428ab6e3febSEric Dumazet int res; 4291da177e4SLinus Torvalds 4301da177e4SLinus Torvalds /* Skip all of this if the packet is already routed, 4311da177e4SLinus Torvalds * f.e. by something like SCTP. 4321da177e4SLinus Torvalds */ 433ab6e3febSEric Dumazet rcu_read_lock(); 434f6d8bd05SEric Dumazet inet_opt = rcu_dereference(inet->inet_opt); 435ea4fc0d6SDavid S. Miller fl4 = &fl->u.ip4; 436511c3f92SEric Dumazet rt = skb_rtable(skb); 43700db4124SIan Morris if (rt) 4381da177e4SLinus Torvalds goto packet_routed; 4391da177e4SLinus Torvalds 4401da177e4SLinus Torvalds /* Make sure we can route this packet. */ 4411da177e4SLinus Torvalds rt = (struct rtable *)__sk_dst_check(sk, 0); 44251456b29SIan Morris if (!rt) { 4433ca3c68eSAl Viro __be32 daddr; 4441da177e4SLinus Torvalds 4451da177e4SLinus Torvalds /* Use correct destination address if we have options. */ 446c720c7e8SEric Dumazet daddr = inet->inet_daddr; 447f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.srr) 448f6d8bd05SEric Dumazet daddr = inet_opt->opt.faddr; 4491da177e4SLinus Torvalds 4501da177e4SLinus Torvalds /* If this fails, retransmit mechanism of transport layer will 4511da177e4SLinus Torvalds * keep trying until route appears or the connection times 4521da177e4SLinus Torvalds * itself out. 4531da177e4SLinus Torvalds */ 45477589ce0SEric W. Biederman rt = ip_route_output_ports(net, fl4, sk, 45578fbfd8aSDavid S. Miller daddr, inet->inet_saddr, 45678fbfd8aSDavid S. Miller inet->inet_dport, 45778fbfd8aSDavid S. Miller inet->inet_sport, 45878fbfd8aSDavid S. Miller sk->sk_protocol, 45978fbfd8aSDavid S. Miller RT_CONN_FLAGS(sk), 46078fbfd8aSDavid S. Miller sk->sk_bound_dev_if); 461b23dd4feSDavid S. Miller if (IS_ERR(rt)) 4621da177e4SLinus Torvalds goto no_route; 463d8d1f30bSChangli Gao sk_setup_caps(sk, &rt->dst); 4641da177e4SLinus Torvalds } 465d8d1f30bSChangli Gao skb_dst_set_noref(skb, &rt->dst); 4661da177e4SLinus Torvalds 4671da177e4SLinus Torvalds packet_routed: 468155e8336SJulian Anastasov if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway) 4691da177e4SLinus Torvalds goto no_route; 4701da177e4SLinus Torvalds 4711da177e4SLinus Torvalds /* OK, we know where to send it, allocate and build IP header. */ 472f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0)); 4738856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 474eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 475714e85beSAl Viro *((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (inet->tos & 0xff)); 47660ff7467SWANG Cong if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df) 4771da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 4781da177e4SLinus Torvalds else 4791da177e4SLinus Torvalds iph->frag_off = 0; 480d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 4811da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 48284f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 48384f9307cSEric Dumazet 4841da177e4SLinus Torvalds /* Transport layer set skb->h.foo itself. */ 4851da177e4SLinus Torvalds 486f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.optlen) { 487f6d8bd05SEric Dumazet iph->ihl += inet_opt->opt.optlen >> 2; 488f6d8bd05SEric Dumazet ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0); 4891da177e4SLinus Torvalds } 4901da177e4SLinus Torvalds 49177589ce0SEric W. Biederman ip_select_ident_segs(net, skb, sk, 492b6a7719aSHannes Frederic Sowa skb_shinfo(skb)->gso_segs ?: 1); 4931da177e4SLinus Torvalds 494b0270e91SEric Dumazet /* TODO : should we use skb->sk here instead of sk ? */ 4951da177e4SLinus Torvalds skb->priority = sk->sk_priority; 4964a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 4971da177e4SLinus Torvalds 49833224b16SEric W. Biederman res = ip_local_out(net, sk, skb); 499ab6e3febSEric Dumazet rcu_read_unlock(); 500ab6e3febSEric Dumazet return res; 5011da177e4SLinus Torvalds 5021da177e4SLinus Torvalds no_route: 503ab6e3febSEric Dumazet rcu_read_unlock(); 50477589ce0SEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_OUTNOROUTES); 5051da177e4SLinus Torvalds kfree_skb(skb); 5061da177e4SLinus Torvalds return -EHOSTUNREACH; 5071da177e4SLinus Torvalds } 5084bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_queue_xmit); 5091da177e4SLinus Torvalds 5101da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from) 5111da177e4SLinus Torvalds { 5121da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 5131da177e4SLinus Torvalds to->priority = from->priority; 5141da177e4SLinus Torvalds to->protocol = from->protocol; 515adf30907SEric Dumazet skb_dst_drop(to); 516fe76cda3SEric Dumazet skb_dst_copy(to, from); 5171da177e4SLinus Torvalds to->dev = from->dev; 51882e91ffeSThomas Graf to->mark = from->mark; 5191da177e4SLinus Torvalds 5201da177e4SLinus Torvalds /* Copy the flags to each fragment. */ 5211da177e4SLinus Torvalds IPCB(to)->flags = IPCB(from)->flags; 5221da177e4SLinus Torvalds 5231da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 5241da177e4SLinus Torvalds to->tc_index = from->tc_index; 5251da177e4SLinus Torvalds #endif 526e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 5276ca40d4eSJavier Martinez Canillas #if IS_ENABLED(CONFIG_IP_VS) 528c98d80edSJulian Anastasov to->ipvs_property = from->ipvs_property; 529c98d80edSJulian Anastasov #endif 530984bc16cSJames Morris skb_copy_secmark(to, from); 5311da177e4SLinus Torvalds } 5321da177e4SLinus Torvalds 533694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 534c5501eb3SFlorian Westphal unsigned int mtu, 535694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 53649d16b23SAndy Zhou { 53749d16b23SAndy Zhou struct iphdr *iph = ip_hdr(skb); 53849d16b23SAndy Zhou 539d6b915e2SFlorian Westphal if ((iph->frag_off & htons(IP_DF)) == 0) 540694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 541d6b915e2SFlorian Westphal 542d6b915e2SFlorian Westphal if (unlikely(!skb->ignore_df || 54349d16b23SAndy Zhou (IPCB(skb)->frag_max_size && 54449d16b23SAndy Zhou IPCB(skb)->frag_max_size > mtu))) { 5459479b0afSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 54649d16b23SAndy Zhou icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, 54749d16b23SAndy Zhou htonl(mtu)); 54849d16b23SAndy Zhou kfree_skb(skb); 54949d16b23SAndy Zhou return -EMSGSIZE; 55049d16b23SAndy Zhou } 55149d16b23SAndy Zhou 552694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 55349d16b23SAndy Zhou } 55449d16b23SAndy Zhou 5551da177e4SLinus Torvalds /* 5561da177e4SLinus Torvalds * This IP datagram is too large to be sent in one piece. Break it up into 5571da177e4SLinus Torvalds * smaller pieces (each of size equal to IP header plus 5581da177e4SLinus Torvalds * a block of the data of the original IP data part) that will yet fit in a 5591da177e4SLinus Torvalds * single device frame, and queue such a frame for sending. 5601da177e4SLinus Torvalds */ 5611da177e4SLinus Torvalds 562694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 563694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 5641da177e4SLinus Torvalds { 5651da177e4SLinus Torvalds struct iphdr *iph; 5661da177e4SLinus Torvalds int ptr; 5671da177e4SLinus Torvalds struct sk_buff *skb2; 568c893b806SChangli Gao unsigned int mtu, hlen, left, len, ll_rs; 5691da177e4SLinus Torvalds int offset; 57076ab608dSAlexey Dobriyan __be16 not_last_frag; 571511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 5721da177e4SLinus Torvalds int err = 0; 5731da177e4SLinus Torvalds 574dbd3393cSHannes Frederic Sowa /* for offloaded checksums cleanup checksum before fragmentation */ 575dbd3393cSHannes Frederic Sowa if (skb->ip_summed == CHECKSUM_PARTIAL && 576dbd3393cSHannes Frederic Sowa (err = skb_checksum_help(skb))) 577dbd3393cSHannes Frederic Sowa goto fail; 578dbd3393cSHannes Frederic Sowa 5791da177e4SLinus Torvalds /* 5801da177e4SLinus Torvalds * Point into the IP datagram header. 5811da177e4SLinus Torvalds */ 5821da177e4SLinus Torvalds 583eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 5841da177e4SLinus Torvalds 585fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 586d6b915e2SFlorian Westphal if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu) 587d6b915e2SFlorian Westphal mtu = IPCB(skb)->frag_max_size; 5881da177e4SLinus Torvalds 5891da177e4SLinus Torvalds /* 5901da177e4SLinus Torvalds * Setup starting values. 5911da177e4SLinus Torvalds */ 5921da177e4SLinus Torvalds 5931da177e4SLinus Torvalds hlen = iph->ihl * 4; 594f87c10a8SHannes Frederic Sowa mtu = mtu - hlen; /* Size of data space */ 59589cee8b1SHerbert Xu IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE; 5961da177e4SLinus Torvalds 5971da177e4SLinus Torvalds /* When frag_list is given, use it. First, check its validity: 5981da177e4SLinus Torvalds * some transformers could create wrong frag_list or break existing 5991da177e4SLinus Torvalds * one, it is not prohibited. In this case fall back to copying. 6001da177e4SLinus Torvalds * 6011da177e4SLinus Torvalds * LATER: this step can be merged to real generation of fragments, 6021da177e4SLinus Torvalds * we can switch to copy when see the first bad fragment. 6031da177e4SLinus Torvalds */ 60421dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 6053d13008eSEric Dumazet struct sk_buff *frag, *frag2; 606c72d8cdaSAlexey Dobriyan unsigned int first_len = skb_pagelen(skb); 6071da177e4SLinus Torvalds 6081da177e4SLinus Torvalds if (first_len - hlen > mtu || 6091da177e4SLinus Torvalds ((first_len - hlen) & 7) || 61056f8a75cSPaul Gortmaker ip_is_fragment(iph) || 6111da177e4SLinus Torvalds skb_cloned(skb)) 6121da177e4SLinus Torvalds goto slow_path; 6131da177e4SLinus Torvalds 614d7fcf1a5SDavid S. Miller skb_walk_frags(skb, frag) { 6151da177e4SLinus Torvalds /* Correct geometry. */ 6161da177e4SLinus Torvalds if (frag->len > mtu || 6171da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 6181da177e4SLinus Torvalds skb_headroom(frag) < hlen) 6193d13008eSEric Dumazet goto slow_path_clean; 6201da177e4SLinus Torvalds 6211da177e4SLinus Torvalds /* Partially cloned skb? */ 6221da177e4SLinus Torvalds if (skb_shared(frag)) 6233d13008eSEric Dumazet goto slow_path_clean; 6242fdba6b0SHerbert Xu 6252fdba6b0SHerbert Xu BUG_ON(frag->sk); 6262fdba6b0SHerbert Xu if (skb->sk) { 6272fdba6b0SHerbert Xu frag->sk = skb->sk; 6282fdba6b0SHerbert Xu frag->destructor = sock_wfree; 6292fdba6b0SHerbert Xu } 6303d13008eSEric Dumazet skb->truesize -= frag->truesize; 6311da177e4SLinus Torvalds } 6321da177e4SLinus Torvalds 6331da177e4SLinus Torvalds /* Everything is OK. Generate! */ 6341da177e4SLinus Torvalds 6351da177e4SLinus Torvalds err = 0; 6361da177e4SLinus Torvalds offset = 0; 6371da177e4SLinus Torvalds frag = skb_shinfo(skb)->frag_list; 638d7fcf1a5SDavid S. Miller skb_frag_list_init(skb); 6391da177e4SLinus Torvalds skb->data_len = first_len - skb_headlen(skb); 6401da177e4SLinus Torvalds skb->len = first_len; 6411da177e4SLinus Torvalds iph->tot_len = htons(first_len); 6421da177e4SLinus Torvalds iph->frag_off = htons(IP_MF); 6431da177e4SLinus Torvalds ip_send_check(iph); 6441da177e4SLinus Torvalds 6451da177e4SLinus Torvalds for (;;) { 6461da177e4SLinus Torvalds /* Prepare header of the next frame, 6471da177e4SLinus Torvalds * before previous one went down. */ 6481da177e4SLinus Torvalds if (frag) { 6491da177e4SLinus Torvalds frag->ip_summed = CHECKSUM_NONE; 650badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(frag); 651e2d1bca7SArnaldo Carvalho de Melo __skb_push(frag, hlen); 652e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(frag); 653d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(frag), iph, hlen); 654eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(frag); 6551da177e4SLinus Torvalds iph->tot_len = htons(frag->len); 6561da177e4SLinus Torvalds ip_copy_metadata(frag, skb); 6571da177e4SLinus Torvalds if (offset == 0) 6581da177e4SLinus Torvalds ip_options_fragment(frag); 6591da177e4SLinus Torvalds offset += skb->len - hlen; 6601da177e4SLinus Torvalds iph->frag_off = htons(offset>>3); 66100db4124SIan Morris if (frag->next) 6621da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 6631da177e4SLinus Torvalds /* Ready, complete checksum */ 6641da177e4SLinus Torvalds ip_send_check(iph); 6651da177e4SLinus Torvalds } 6661da177e4SLinus Torvalds 667694869b3SEric W. Biederman err = output(net, sk, skb); 6681da177e4SLinus Torvalds 669dafee490SWei Dong if (!err) 67026a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 6711da177e4SLinus Torvalds if (err || !frag) 6721da177e4SLinus Torvalds break; 6731da177e4SLinus Torvalds 6741da177e4SLinus Torvalds skb = frag; 6751da177e4SLinus Torvalds frag = skb->next; 6761da177e4SLinus Torvalds skb->next = NULL; 6771da177e4SLinus Torvalds } 6781da177e4SLinus Torvalds 6791da177e4SLinus Torvalds if (err == 0) { 68026a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 6811da177e4SLinus Torvalds return 0; 6821da177e4SLinus Torvalds } 6831da177e4SLinus Torvalds 6841da177e4SLinus Torvalds while (frag) { 6851da177e4SLinus Torvalds skb = frag->next; 6861da177e4SLinus Torvalds kfree_skb(frag); 6871da177e4SLinus Torvalds frag = skb; 6881da177e4SLinus Torvalds } 68926a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 6901da177e4SLinus Torvalds return err; 6913d13008eSEric Dumazet 6923d13008eSEric Dumazet slow_path_clean: 6933d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 6943d13008eSEric Dumazet if (frag2 == frag) 6953d13008eSEric Dumazet break; 6963d13008eSEric Dumazet frag2->sk = NULL; 6973d13008eSEric Dumazet frag2->destructor = NULL; 6983d13008eSEric Dumazet skb->truesize += frag2->truesize; 6993d13008eSEric Dumazet } 7001da177e4SLinus Torvalds } 7011da177e4SLinus Torvalds 7021da177e4SLinus Torvalds slow_path: 703c9af6db4SPravin B Shelar iph = ip_hdr(skb); 704fc70fb64SAlexander Duyck 7051da177e4SLinus Torvalds left = skb->len - hlen; /* Space per frame */ 70649085bd7SGeorge Kadianakis ptr = hlen; /* Where to start from */ 7071da177e4SLinus Torvalds 7088d045163SFlorian Westphal ll_rs = LL_RESERVED_SPACE(rt->dst.dev); 7099bcfcaf5SStephen Hemminger 7101da177e4SLinus Torvalds /* 7111da177e4SLinus Torvalds * Fragment the datagram. 7121da177e4SLinus Torvalds */ 7131da177e4SLinus Torvalds 7141da177e4SLinus Torvalds offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3; 7151da177e4SLinus Torvalds not_last_frag = iph->frag_off & htons(IP_MF); 7161da177e4SLinus Torvalds 7171da177e4SLinus Torvalds /* 7181da177e4SLinus Torvalds * Keep copying data until we run out. 7191da177e4SLinus Torvalds */ 7201da177e4SLinus Torvalds 7211da177e4SLinus Torvalds while (left > 0) { 7221da177e4SLinus Torvalds len = left; 7231da177e4SLinus Torvalds /* IF: it doesn't fit, use 'mtu' - the data space left */ 7241da177e4SLinus Torvalds if (len > mtu) 7251da177e4SLinus Torvalds len = mtu; 7261da177e4SLinus Torvalds /* IF: we are not sending up to and including the packet end 7271da177e4SLinus Torvalds then align the next start on an eight byte boundary */ 7281da177e4SLinus Torvalds if (len < left) { 7291da177e4SLinus Torvalds len &= ~7; 7301da177e4SLinus Torvalds } 7311da177e4SLinus Torvalds 732cbffccc9SJoe Perches /* Allocate buffer */ 733cbffccc9SJoe Perches skb2 = alloc_skb(len + hlen + ll_rs, GFP_ATOMIC); 734cbffccc9SJoe Perches if (!skb2) { 7351da177e4SLinus Torvalds err = -ENOMEM; 7361da177e4SLinus Torvalds goto fail; 7371da177e4SLinus Torvalds } 7381da177e4SLinus Torvalds 7391da177e4SLinus Torvalds /* 7401da177e4SLinus Torvalds * Set up data on packet 7411da177e4SLinus Torvalds */ 7421da177e4SLinus Torvalds 7431da177e4SLinus Torvalds ip_copy_metadata(skb2, skb); 7441da177e4SLinus Torvalds skb_reserve(skb2, ll_rs); 7451da177e4SLinus Torvalds skb_put(skb2, len + hlen); 746c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb2); 747b0e380b1SArnaldo Carvalho de Melo skb2->transport_header = skb2->network_header + hlen; 7481da177e4SLinus Torvalds 7491da177e4SLinus Torvalds /* 7501da177e4SLinus Torvalds * Charge the memory for the fragment to any owner 7511da177e4SLinus Torvalds * it might possess 7521da177e4SLinus Torvalds */ 7531da177e4SLinus Torvalds 7541da177e4SLinus Torvalds if (skb->sk) 7551da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 7561da177e4SLinus Torvalds 7571da177e4SLinus Torvalds /* 7581da177e4SLinus Torvalds * Copy the packet header into the new buffer. 7591da177e4SLinus Torvalds */ 7601da177e4SLinus Torvalds 761d626f62bSArnaldo Carvalho de Melo skb_copy_from_linear_data(skb, skb_network_header(skb2), hlen); 7621da177e4SLinus Torvalds 7631da177e4SLinus Torvalds /* 7641da177e4SLinus Torvalds * Copy a block of the IP datagram. 7651da177e4SLinus Torvalds */ 766bff9b61cSArnaldo Carvalho de Melo if (skb_copy_bits(skb, ptr, skb_transport_header(skb2), len)) 7671da177e4SLinus Torvalds BUG(); 7681da177e4SLinus Torvalds left -= len; 7691da177e4SLinus Torvalds 7701da177e4SLinus Torvalds /* 7711da177e4SLinus Torvalds * Fill in the new header fields. 7721da177e4SLinus Torvalds */ 773eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb2); 7741da177e4SLinus Torvalds iph->frag_off = htons((offset >> 3)); 7751da177e4SLinus Torvalds 776d6b915e2SFlorian Westphal if (IPCB(skb)->flags & IPSKB_FRAG_PMTU) 777d6b915e2SFlorian Westphal iph->frag_off |= htons(IP_DF); 778d6b915e2SFlorian Westphal 7791da177e4SLinus Torvalds /* ANK: dirty, but effective trick. Upgrade options only if 7801da177e4SLinus Torvalds * the segment to be fragmented was THE FIRST (otherwise, 7811da177e4SLinus Torvalds * options are already fixed) and make it ONCE 7821da177e4SLinus Torvalds * on the initial skb, so that all the following fragments 7831da177e4SLinus Torvalds * will inherit fixed options. 7841da177e4SLinus Torvalds */ 7851da177e4SLinus Torvalds if (offset == 0) 7861da177e4SLinus Torvalds ip_options_fragment(skb); 7871da177e4SLinus Torvalds 7881da177e4SLinus Torvalds /* 7891da177e4SLinus Torvalds * Added AC : If we are fragmenting a fragment that's not the 7901da177e4SLinus Torvalds * last fragment then keep MF on each bit 7911da177e4SLinus Torvalds */ 7921da177e4SLinus Torvalds if (left > 0 || not_last_frag) 7931da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 7941da177e4SLinus Torvalds ptr += len; 7951da177e4SLinus Torvalds offset += len; 7961da177e4SLinus Torvalds 7971da177e4SLinus Torvalds /* 7981da177e4SLinus Torvalds * Put this fragment into the sending queue. 7991da177e4SLinus Torvalds */ 8001da177e4SLinus Torvalds iph->tot_len = htons(len + hlen); 8011da177e4SLinus Torvalds 8021da177e4SLinus Torvalds ip_send_check(iph); 8031da177e4SLinus Torvalds 804694869b3SEric W. Biederman err = output(net, sk, skb2); 8051da177e4SLinus Torvalds if (err) 8061da177e4SLinus Torvalds goto fail; 807dafee490SWei Dong 80826a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 8091da177e4SLinus Torvalds } 8105d0ba55bSEric Dumazet consume_skb(skb); 81126a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 8121da177e4SLinus Torvalds return err; 8131da177e4SLinus Torvalds 8141da177e4SLinus Torvalds fail: 8151da177e4SLinus Torvalds kfree_skb(skb); 81626a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 8171da177e4SLinus Torvalds return err; 8181da177e4SLinus Torvalds } 81949d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment); 8202e2f7aefSPatrick McHardy 8211da177e4SLinus Torvalds int 8221da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb) 8231da177e4SLinus Torvalds { 824f69e6d13SAl Viro struct msghdr *msg = from; 8251da177e4SLinus Torvalds 82684fa7933SPatrick McHardy if (skb->ip_summed == CHECKSUM_PARTIAL) { 82721226abbSAl Viro if (copy_from_iter(to, len, &msg->msg_iter) != len) 8281da177e4SLinus Torvalds return -EFAULT; 8291da177e4SLinus Torvalds } else { 83044bb9363SAl Viro __wsum csum = 0; 83121226abbSAl Viro if (csum_and_copy_from_iter(to, len, &csum, &msg->msg_iter) != len) 8321da177e4SLinus Torvalds return -EFAULT; 8331da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 8341da177e4SLinus Torvalds } 8351da177e4SLinus Torvalds return 0; 8361da177e4SLinus Torvalds } 8374bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag); 8381da177e4SLinus Torvalds 83944bb9363SAl Viro static inline __wsum 8401da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy) 8411da177e4SLinus Torvalds { 8421da177e4SLinus Torvalds char *kaddr; 84344bb9363SAl Viro __wsum csum; 8441da177e4SLinus Torvalds kaddr = kmap(page); 8451da177e4SLinus Torvalds csum = csum_partial(kaddr + offset, copy, 0); 8461da177e4SLinus Torvalds kunmap(page); 8471da177e4SLinus Torvalds return csum; 8481da177e4SLinus Torvalds } 8491da177e4SLinus Torvalds 8504b30b1c6SAdrian Bunk static inline int ip_ufo_append_data(struct sock *sk, 8511470ddf7SHerbert Xu struct sk_buff_head *queue, 852e89e9cf5SAnanda Raju int getfrag(void *from, char *to, int offset, int len, 853e89e9cf5SAnanda Raju int odd, struct sk_buff *skb), 854e89e9cf5SAnanda Raju void *from, int length, int hh_len, int fragheaderlen, 855d9be4f7aSBill Sommerfeld int transhdrlen, int maxfraglen, unsigned int flags) 856e89e9cf5SAnanda Raju { 857e89e9cf5SAnanda Raju struct sk_buff *skb; 858e89e9cf5SAnanda Raju int err; 859e89e9cf5SAnanda Raju 860e89e9cf5SAnanda Raju /* There is support for UDP fragmentation offload by network 861e89e9cf5SAnanda Raju * device, so create one single skb packet containing complete 862e89e9cf5SAnanda Raju * udp datagram 863e89e9cf5SAnanda Raju */ 86451456b29SIan Morris skb = skb_peek_tail(queue); 86551456b29SIan Morris if (!skb) { 866e89e9cf5SAnanda Raju skb = sock_alloc_send_skb(sk, 867e89e9cf5SAnanda Raju hh_len + fragheaderlen + transhdrlen + 20, 868e89e9cf5SAnanda Raju (flags & MSG_DONTWAIT), &err); 869e89e9cf5SAnanda Raju 87051456b29SIan Morris if (!skb) 871e89e9cf5SAnanda Raju return err; 872e89e9cf5SAnanda Raju 873e89e9cf5SAnanda Raju /* reserve space for Hardware header */ 874e89e9cf5SAnanda Raju skb_reserve(skb, hh_len); 875e89e9cf5SAnanda Raju 876e89e9cf5SAnanda Raju /* create space for UDP/IP header */ 877e89e9cf5SAnanda Raju skb_put(skb, fragheaderlen + transhdrlen); 878e89e9cf5SAnanda Raju 879e89e9cf5SAnanda Raju /* initialize network header pointer */ 880c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb); 881e89e9cf5SAnanda Raju 882e89e9cf5SAnanda Raju /* initialize protocol header pointer */ 883b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header + fragheaderlen; 884e89e9cf5SAnanda Raju 885e89e9cf5SAnanda Raju skb->csum = 0; 886e89e9cf5SAnanda Raju 887e93b7d74SJiri Pirko __skb_queue_tail(queue, skb); 888e93b7d74SJiri Pirko } else if (skb_is_gso(skb)) { 889e93b7d74SJiri Pirko goto append; 890e93b7d74SJiri Pirko } 891e93b7d74SJiri Pirko 892e93b7d74SJiri Pirko skb->ip_summed = CHECKSUM_PARTIAL; 893e89e9cf5SAnanda Raju /* specify the length of each IP datagram fragment */ 894d9be4f7aSBill Sommerfeld skb_shinfo(skb)->gso_size = maxfraglen - fragheaderlen; 895f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 896be9164e7SKostya B 897e93b7d74SJiri Pirko append: 898be9164e7SKostya B return skb_append_datato_frags(sk, skb, getfrag, from, 899be9164e7SKostya B (length - transhdrlen)); 900e89e9cf5SAnanda Raju } 901e89e9cf5SAnanda Raju 902f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk, 903f5fca608SDavid S. Miller struct flowi4 *fl4, 904f5fca608SDavid S. Miller struct sk_buff_head *queue, 9051470ddf7SHerbert Xu struct inet_cork *cork, 9065640f768SEric Dumazet struct page_frag *pfrag, 9071470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, 9081470ddf7SHerbert Xu int len, int odd, struct sk_buff *skb), 9091da177e4SLinus Torvalds void *from, int length, int transhdrlen, 9101da177e4SLinus Torvalds unsigned int flags) 9111da177e4SLinus Torvalds { 9121da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 9131da177e4SLinus Torvalds struct sk_buff *skb; 9141da177e4SLinus Torvalds 91507df5294SHerbert Xu struct ip_options *opt = cork->opt; 9161da177e4SLinus Torvalds int hh_len; 9171da177e4SLinus Torvalds int exthdrlen; 9181da177e4SLinus Torvalds int mtu; 9191da177e4SLinus Torvalds int copy; 9201da177e4SLinus Torvalds int err; 9211da177e4SLinus Torvalds int offset = 0; 922daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, maxnonfragsize; 9231da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 9241470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 92509c2d251SWillem de Bruijn u32 tskey = 0; 9261da177e4SLinus Torvalds 92796d7303eSSteffen Klassert skb = skb_peek_tail(queue); 92896d7303eSSteffen Klassert 92996d7303eSSteffen Klassert exthdrlen = !skb ? rt->dst.header_len : 0; 93007df5294SHerbert Xu mtu = cork->fragsize; 93109c2d251SWillem de Bruijn if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP && 93209c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 93309c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 9341470ddf7SHerbert Xu 935d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 9361da177e4SLinus Torvalds 9371da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 9381da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 93960ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 9401da177e4SLinus Torvalds 941daba287bSHannes Frederic Sowa if (cork->length + length > maxnonfragsize - fragheaderlen) { 942f5fca608SDavid S. Miller ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 94361e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 9441da177e4SLinus Torvalds return -EMSGSIZE; 9451da177e4SLinus Torvalds } 9461da177e4SLinus Torvalds 9471da177e4SLinus Torvalds /* 9481da177e4SLinus Torvalds * transhdrlen > 0 means that this is the first fragment and we wish 9491da177e4SLinus Torvalds * it won't be fragmented in the future. 9501da177e4SLinus Torvalds */ 9511da177e4SLinus Torvalds if (transhdrlen && 9521da177e4SLinus Torvalds length + fragheaderlen <= mtu && 953c8cd0989STom Herbert rt->dst.dev->features & (NETIF_F_HW_CSUM | NETIF_F_IP_CSUM) && 954d749c9cbSHannes Frederic Sowa !(flags & MSG_MORE) && 9551da177e4SLinus Torvalds !exthdrlen) 95684fa7933SPatrick McHardy csummode = CHECKSUM_PARTIAL; 9571da177e4SLinus Torvalds 9581470ddf7SHerbert Xu cork->length += length; 95926cde9f7SHerbert Xu if (((length > mtu) || (skb && skb_is_gso(skb))) && 960be9164e7SKostya B (sk->sk_protocol == IPPROTO_UDP) && 961acf8dd0aSMichal Kubeček (rt->dst.dev->features & NETIF_F_UFO) && !rt->dst.header_len && 96240ba3302SMichal Kubeček (sk->sk_type == SOCK_DGRAM) && !sk->sk_no_check_tx) { 9631470ddf7SHerbert Xu err = ip_ufo_append_data(sk, queue, getfrag, from, length, 9641470ddf7SHerbert Xu hh_len, fragheaderlen, transhdrlen, 965d9be4f7aSBill Sommerfeld maxfraglen, flags); 966baa829d8SPatrick McHardy if (err) 967e89e9cf5SAnanda Raju goto error; 968e89e9cf5SAnanda Raju return 0; 969e89e9cf5SAnanda Raju } 9701da177e4SLinus Torvalds 9711da177e4SLinus Torvalds /* So, what's going on in the loop below? 9721da177e4SLinus Torvalds * 9731da177e4SLinus Torvalds * We use calculated fragment length to generate chained skb, 9741da177e4SLinus Torvalds * each of segments is IP fragment ready for sending to network after 9751da177e4SLinus Torvalds * adding appropriate IP header. 9761da177e4SLinus Torvalds */ 9771da177e4SLinus Torvalds 97826cde9f7SHerbert Xu if (!skb) 9791da177e4SLinus Torvalds goto alloc_new_skb; 9801da177e4SLinus Torvalds 9811da177e4SLinus Torvalds while (length > 0) { 9821da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 9831da177e4SLinus Torvalds copy = mtu - skb->len; 9841da177e4SLinus Torvalds if (copy < length) 9851da177e4SLinus Torvalds copy = maxfraglen - skb->len; 9861da177e4SLinus Torvalds if (copy <= 0) { 9871da177e4SLinus Torvalds char *data; 9881da177e4SLinus Torvalds unsigned int datalen; 9891da177e4SLinus Torvalds unsigned int fraglen; 9901da177e4SLinus Torvalds unsigned int fraggap; 9911da177e4SLinus Torvalds unsigned int alloclen; 9921da177e4SLinus Torvalds struct sk_buff *skb_prev; 9931da177e4SLinus Torvalds alloc_new_skb: 9941da177e4SLinus Torvalds skb_prev = skb; 9951da177e4SLinus Torvalds if (skb_prev) 9961da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 9971da177e4SLinus Torvalds else 9981da177e4SLinus Torvalds fraggap = 0; 9991da177e4SLinus Torvalds 10001da177e4SLinus Torvalds /* 10011da177e4SLinus Torvalds * If remaining data exceeds the mtu, 10021da177e4SLinus Torvalds * we know we need more fragment(s). 10031da177e4SLinus Torvalds */ 10041da177e4SLinus Torvalds datalen = length + fraggap; 10051da177e4SLinus Torvalds if (datalen > mtu - fragheaderlen) 10061da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 10071da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 10081da177e4SLinus Torvalds 10091da177e4SLinus Torvalds if ((flags & MSG_MORE) && 1010d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 10111da177e4SLinus Torvalds alloclen = mtu; 10121da177e4SLinus Torvalds else 101359104f06SEric Dumazet alloclen = fraglen; 10141da177e4SLinus Torvalds 1015353e5c9aSSteffen Klassert alloclen += exthdrlen; 1016353e5c9aSSteffen Klassert 10171da177e4SLinus Torvalds /* The last fragment gets additional space at tail. 10181da177e4SLinus Torvalds * Note, with MSG_MORE we overallocate on fragments, 10191da177e4SLinus Torvalds * because we have no idea what fragment will be 10201da177e4SLinus Torvalds * the last. 10211da177e4SLinus Torvalds */ 102233f99dc7SSteffen Klassert if (datalen == length + fraggap) 1023d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 102433f99dc7SSteffen Klassert 10251da177e4SLinus Torvalds if (transhdrlen) { 10261da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 10271da177e4SLinus Torvalds alloclen + hh_len + 15, 10281da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 10291da177e4SLinus Torvalds } else { 10301da177e4SLinus Torvalds skb = NULL; 10311da177e4SLinus Torvalds if (atomic_read(&sk->sk_wmem_alloc) <= 10321da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 10331da177e4SLinus Torvalds skb = sock_wmalloc(sk, 10341da177e4SLinus Torvalds alloclen + hh_len + 15, 1, 10351da177e4SLinus Torvalds sk->sk_allocation); 103651456b29SIan Morris if (unlikely(!skb)) 10371da177e4SLinus Torvalds err = -ENOBUFS; 10381da177e4SLinus Torvalds } 103951456b29SIan Morris if (!skb) 10401da177e4SLinus Torvalds goto error; 10411da177e4SLinus Torvalds 10421da177e4SLinus Torvalds /* 10431da177e4SLinus Torvalds * Fill in the control structures 10441da177e4SLinus Torvalds */ 10451da177e4SLinus Torvalds skb->ip_summed = csummode; 10461da177e4SLinus Torvalds skb->csum = 0; 10471da177e4SLinus Torvalds skb_reserve(skb, hh_len); 104811878b40SWillem de Bruijn 104911878b40SWillem de Bruijn /* only the initial fragment is time stamped */ 10501470ddf7SHerbert Xu skb_shinfo(skb)->tx_flags = cork->tx_flags; 105111878b40SWillem de Bruijn cork->tx_flags = 0; 105209c2d251SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 105309c2d251SWillem de Bruijn tskey = 0; 10541da177e4SLinus Torvalds 10551da177e4SLinus Torvalds /* 10561da177e4SLinus Torvalds * Find where to start putting bytes. 10571da177e4SLinus Torvalds */ 1058353e5c9aSSteffen Klassert data = skb_put(skb, fraglen + exthdrlen); 1059c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 1060b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1061b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 1062353e5c9aSSteffen Klassert data += fragheaderlen + exthdrlen; 10631da177e4SLinus Torvalds 10641da177e4SLinus Torvalds if (fraggap) { 10651da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 10661da177e4SLinus Torvalds skb_prev, maxfraglen, 10671da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 10681da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 10691da177e4SLinus Torvalds skb->csum); 10701da177e4SLinus Torvalds data += fraggap; 1071e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 10721da177e4SLinus Torvalds } 10731da177e4SLinus Torvalds 10741da177e4SLinus Torvalds copy = datalen - transhdrlen - fraggap; 10751da177e4SLinus Torvalds if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 10761da177e4SLinus Torvalds err = -EFAULT; 10771da177e4SLinus Torvalds kfree_skb(skb); 10781da177e4SLinus Torvalds goto error; 10791da177e4SLinus Torvalds } 10801da177e4SLinus Torvalds 10811da177e4SLinus Torvalds offset += copy; 10821da177e4SLinus Torvalds length -= datalen - fraggap; 10831da177e4SLinus Torvalds transhdrlen = 0; 10841da177e4SLinus Torvalds exthdrlen = 0; 10851da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 10861da177e4SLinus Torvalds 10871da177e4SLinus Torvalds /* 10881da177e4SLinus Torvalds * Put the packet on the pending queue. 10891da177e4SLinus Torvalds */ 10901470ddf7SHerbert Xu __skb_queue_tail(queue, skb); 10911da177e4SLinus Torvalds continue; 10921da177e4SLinus Torvalds } 10931da177e4SLinus Torvalds 10941da177e4SLinus Torvalds if (copy > length) 10951da177e4SLinus Torvalds copy = length; 10961da177e4SLinus Torvalds 1097d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) { 10981da177e4SLinus Torvalds unsigned int off; 10991da177e4SLinus Torvalds 11001da177e4SLinus Torvalds off = skb->len; 11011da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 11021da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 11031da177e4SLinus Torvalds __skb_trim(skb, off); 11041da177e4SLinus Torvalds err = -EFAULT; 11051da177e4SLinus Torvalds goto error; 11061da177e4SLinus Torvalds } 11071da177e4SLinus Torvalds } else { 11081da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 11091da177e4SLinus Torvalds 11101da177e4SLinus Torvalds err = -ENOMEM; 11115640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 11121da177e4SLinus Torvalds goto error; 11131da177e4SLinus Torvalds 11145640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 11155640f768SEric Dumazet pfrag->offset)) { 11161da177e4SLinus Torvalds err = -EMSGSIZE; 11175640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 11181da177e4SLinus Torvalds goto error; 11195640f768SEric Dumazet 11205640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 11215640f768SEric Dumazet pfrag->offset, 0); 11225640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 11235640f768SEric Dumazet get_page(pfrag->page); 11241da177e4SLinus Torvalds } 11255640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 11265640f768SEric Dumazet if (getfrag(from, 11275640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 11285640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 11295640f768SEric Dumazet goto error_efault; 11305640f768SEric Dumazet 11315640f768SEric Dumazet pfrag->offset += copy; 11325640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 11331da177e4SLinus Torvalds skb->len += copy; 11341da177e4SLinus Torvalds skb->data_len += copy; 1135f945fa7aSHerbert Xu skb->truesize += copy; 1136f945fa7aSHerbert Xu atomic_add(copy, &sk->sk_wmem_alloc); 11371da177e4SLinus Torvalds } 11381da177e4SLinus Torvalds offset += copy; 11391da177e4SLinus Torvalds length -= copy; 11401da177e4SLinus Torvalds } 11411da177e4SLinus Torvalds 11421da177e4SLinus Torvalds return 0; 11431da177e4SLinus Torvalds 11445640f768SEric Dumazet error_efault: 11455640f768SEric Dumazet err = -EFAULT; 11461da177e4SLinus Torvalds error: 11471470ddf7SHerbert Xu cork->length -= length; 11485e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 11491da177e4SLinus Torvalds return err; 11501da177e4SLinus Torvalds } 11511da177e4SLinus Torvalds 11521470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork, 11531470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp) 11541470ddf7SHerbert Xu { 1155f6d8bd05SEric Dumazet struct ip_options_rcu *opt; 11561470ddf7SHerbert Xu struct rtable *rt; 11571470ddf7SHerbert Xu 11581470ddf7SHerbert Xu /* 11591470ddf7SHerbert Xu * setup for corking. 11601470ddf7SHerbert Xu */ 11611470ddf7SHerbert Xu opt = ipc->opt; 11621470ddf7SHerbert Xu if (opt) { 116351456b29SIan Morris if (!cork->opt) { 11641470ddf7SHerbert Xu cork->opt = kmalloc(sizeof(struct ip_options) + 40, 11651470ddf7SHerbert Xu sk->sk_allocation); 116651456b29SIan Morris if (unlikely(!cork->opt)) 11671470ddf7SHerbert Xu return -ENOBUFS; 11681470ddf7SHerbert Xu } 1169f6d8bd05SEric Dumazet memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen); 11701470ddf7SHerbert Xu cork->flags |= IPCORK_OPT; 11711470ddf7SHerbert Xu cork->addr = ipc->addr; 11721470ddf7SHerbert Xu } 11731470ddf7SHerbert Xu rt = *rtp; 11741470ddf7SHerbert Xu if (unlikely(!rt)) 11751470ddf7SHerbert Xu return -EFAULT; 11761470ddf7SHerbert Xu /* 11771470ddf7SHerbert Xu * We steal reference to this route, caller should not release it 11781470ddf7SHerbert Xu */ 11791470ddf7SHerbert Xu *rtp = NULL; 1180482fc609SHannes Frederic Sowa cork->fragsize = ip_sk_use_pmtu(sk) ? 1181482fc609SHannes Frederic Sowa dst_mtu(&rt->dst) : rt->dst.dev->mtu; 11821470ddf7SHerbert Xu cork->dst = &rt->dst; 11831470ddf7SHerbert Xu cork->length = 0; 1184aa661581SFrancesco Fusco cork->ttl = ipc->ttl; 1185aa661581SFrancesco Fusco cork->tos = ipc->tos; 1186aa661581SFrancesco Fusco cork->priority = ipc->priority; 11871470ddf7SHerbert Xu cork->tx_flags = ipc->tx_flags; 11881470ddf7SHerbert Xu 11891470ddf7SHerbert Xu return 0; 11901470ddf7SHerbert Xu } 11911470ddf7SHerbert Xu 11921470ddf7SHerbert Xu /* 11931470ddf7SHerbert Xu * ip_append_data() and ip_append_page() can make one large IP datagram 11941470ddf7SHerbert Xu * from many pieces of data. Each pieces will be holded on the socket 11951470ddf7SHerbert Xu * until ip_push_pending_frames() is called. Each piece can be a page 11961470ddf7SHerbert Xu * or non-page data. 11971470ddf7SHerbert Xu * 11981470ddf7SHerbert Xu * Not only UDP, other transport protocols - e.g. raw sockets - can use 11991470ddf7SHerbert Xu * this interface potentially. 12001470ddf7SHerbert Xu * 12011470ddf7SHerbert Xu * LATER: length must be adjusted by pad at tail, when it is required. 12021470ddf7SHerbert Xu */ 1203f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4, 12041470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, int len, 12051470ddf7SHerbert Xu int odd, struct sk_buff *skb), 12061470ddf7SHerbert Xu void *from, int length, int transhdrlen, 12071470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 12081470ddf7SHerbert Xu unsigned int flags) 12091470ddf7SHerbert Xu { 12101470ddf7SHerbert Xu struct inet_sock *inet = inet_sk(sk); 12111470ddf7SHerbert Xu int err; 12121470ddf7SHerbert Xu 12131470ddf7SHerbert Xu if (flags&MSG_PROBE) 12141470ddf7SHerbert Xu return 0; 12151470ddf7SHerbert Xu 12161470ddf7SHerbert Xu if (skb_queue_empty(&sk->sk_write_queue)) { 1217bdc712b4SDavid S. Miller err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp); 12181470ddf7SHerbert Xu if (err) 12191470ddf7SHerbert Xu return err; 12201470ddf7SHerbert Xu } else { 12211470ddf7SHerbert Xu transhdrlen = 0; 12221470ddf7SHerbert Xu } 12231470ddf7SHerbert Xu 12245640f768SEric Dumazet return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base, 12255640f768SEric Dumazet sk_page_frag(sk), getfrag, 12261470ddf7SHerbert Xu from, length, transhdrlen, flags); 12271470ddf7SHerbert Xu } 12281470ddf7SHerbert Xu 1229f5fca608SDavid S. Miller ssize_t ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page, 12301da177e4SLinus Torvalds int offset, size_t size, int flags) 12311da177e4SLinus Torvalds { 12321da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 12331da177e4SLinus Torvalds struct sk_buff *skb; 12341da177e4SLinus Torvalds struct rtable *rt; 12351da177e4SLinus Torvalds struct ip_options *opt = NULL; 1236bdc712b4SDavid S. Miller struct inet_cork *cork; 12371da177e4SLinus Torvalds int hh_len; 12381da177e4SLinus Torvalds int mtu; 12391da177e4SLinus Torvalds int len; 12401da177e4SLinus Torvalds int err; 1241daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize; 12421da177e4SLinus Torvalds 12431da177e4SLinus Torvalds if (inet->hdrincl) 12441da177e4SLinus Torvalds return -EPERM; 12451da177e4SLinus Torvalds 12461da177e4SLinus Torvalds if (flags&MSG_PROBE) 12471da177e4SLinus Torvalds return 0; 12481da177e4SLinus Torvalds 12491da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) 12501da177e4SLinus Torvalds return -EINVAL; 12511da177e4SLinus Torvalds 1252bdc712b4SDavid S. Miller cork = &inet->cork.base; 1253bdc712b4SDavid S. Miller rt = (struct rtable *)cork->dst; 1254bdc712b4SDavid S. Miller if (cork->flags & IPCORK_OPT) 1255bdc712b4SDavid S. Miller opt = cork->opt; 12561da177e4SLinus Torvalds 1257d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) 12581da177e4SLinus Torvalds return -EOPNOTSUPP; 12591da177e4SLinus Torvalds 1260d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 1261bdc712b4SDavid S. Miller mtu = cork->fragsize; 12621da177e4SLinus Torvalds 12631da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 12641da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 126560ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 12661da177e4SLinus Torvalds 1267daba287bSHannes Frederic Sowa if (cork->length + size > maxnonfragsize - fragheaderlen) { 126861e7f09dSHannes Frederic Sowa ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 126961e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 12701da177e4SLinus Torvalds return -EMSGSIZE; 12711da177e4SLinus Torvalds } 12721da177e4SLinus Torvalds 127351456b29SIan Morris skb = skb_peek_tail(&sk->sk_write_queue); 127451456b29SIan Morris if (!skb) 12751da177e4SLinus Torvalds return -EINVAL; 12761da177e4SLinus Torvalds 127726cde9f7SHerbert Xu if ((size + skb->len > mtu) && 127826cde9f7SHerbert Xu (sk->sk_protocol == IPPROTO_UDP) && 1279d8d1f30bSChangli Gao (rt->dst.dev->features & NETIF_F_UFO)) { 1280a8c4a252SHannes Frederic Sowa if (skb->ip_summed != CHECKSUM_PARTIAL) 1281a8c4a252SHannes Frederic Sowa return -EOPNOTSUPP; 1282a8c4a252SHannes Frederic Sowa 12837967168cSHerbert Xu skb_shinfo(skb)->gso_size = mtu - fragheaderlen; 1284f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 12857967168cSHerbert Xu } 1286a8c4a252SHannes Frederic Sowa cork->length += size; 1287e89e9cf5SAnanda Raju 12881da177e4SLinus Torvalds while (size > 0) { 1289be12a1feSHannes Frederic Sowa if (skb_is_gso(skb)) { 1290e89e9cf5SAnanda Raju len = size; 1291be12a1feSHannes Frederic Sowa } else { 1292e89e9cf5SAnanda Raju 12931da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 12941da177e4SLinus Torvalds len = mtu - skb->len; 12951da177e4SLinus Torvalds if (len < size) 12961da177e4SLinus Torvalds len = maxfraglen - skb->len; 1297e89e9cf5SAnanda Raju } 12981da177e4SLinus Torvalds if (len <= 0) { 12991da177e4SLinus Torvalds struct sk_buff *skb_prev; 13001da177e4SLinus Torvalds int alloclen; 13011da177e4SLinus Torvalds 13021da177e4SLinus Torvalds skb_prev = skb; 13031da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 13041da177e4SLinus Torvalds 13051da177e4SLinus Torvalds alloclen = fragheaderlen + hh_len + fraggap + 15; 13061da177e4SLinus Torvalds skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation); 13071da177e4SLinus Torvalds if (unlikely(!skb)) { 13081da177e4SLinus Torvalds err = -ENOBUFS; 13091da177e4SLinus Torvalds goto error; 13101da177e4SLinus Torvalds } 13111da177e4SLinus Torvalds 13121da177e4SLinus Torvalds /* 13131da177e4SLinus Torvalds * Fill in the control structures 13141da177e4SLinus Torvalds */ 13151da177e4SLinus Torvalds skb->ip_summed = CHECKSUM_NONE; 13161da177e4SLinus Torvalds skb->csum = 0; 13171da177e4SLinus Torvalds skb_reserve(skb, hh_len); 13181da177e4SLinus Torvalds 13191da177e4SLinus Torvalds /* 13201da177e4SLinus Torvalds * Find where to start putting bytes. 13211da177e4SLinus Torvalds */ 1322967b05f6SArnaldo Carvalho de Melo skb_put(skb, fragheaderlen + fraggap); 13232ca9e6f2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1324b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1325b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 13261da177e4SLinus Torvalds if (fraggap) { 1327967b05f6SArnaldo Carvalho de Melo skb->csum = skb_copy_and_csum_bits(skb_prev, 1328967b05f6SArnaldo Carvalho de Melo maxfraglen, 13299c70220bSArnaldo Carvalho de Melo skb_transport_header(skb), 1330967b05f6SArnaldo Carvalho de Melo fraggap, 0); 13311da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 13321da177e4SLinus Torvalds skb->csum); 1333e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 13341da177e4SLinus Torvalds } 13351da177e4SLinus Torvalds 13361da177e4SLinus Torvalds /* 13371da177e4SLinus Torvalds * Put the packet on the pending queue. 13381da177e4SLinus Torvalds */ 13391da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 13401da177e4SLinus Torvalds continue; 13411da177e4SLinus Torvalds } 13421da177e4SLinus Torvalds 13431da177e4SLinus Torvalds if (len > size) 13441da177e4SLinus Torvalds len = size; 1345be12a1feSHannes Frederic Sowa 1346be12a1feSHannes Frederic Sowa if (skb_append_pagefrags(skb, page, offset, len)) { 13471da177e4SLinus Torvalds err = -EMSGSIZE; 13481da177e4SLinus Torvalds goto error; 13491da177e4SLinus Torvalds } 13501da177e4SLinus Torvalds 13511da177e4SLinus Torvalds if (skb->ip_summed == CHECKSUM_NONE) { 135244bb9363SAl Viro __wsum csum; 13531da177e4SLinus Torvalds csum = csum_page(page, offset, len); 13541da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, skb->len); 13551da177e4SLinus Torvalds } 13561da177e4SLinus Torvalds 13571da177e4SLinus Torvalds skb->len += len; 13581da177e4SLinus Torvalds skb->data_len += len; 13591e34a11dSDavid S. Miller skb->truesize += len; 13601e34a11dSDavid S. Miller atomic_add(len, &sk->sk_wmem_alloc); 13611da177e4SLinus Torvalds offset += len; 13621da177e4SLinus Torvalds size -= len; 13631da177e4SLinus Torvalds } 13641da177e4SLinus Torvalds return 0; 13651da177e4SLinus Torvalds 13661da177e4SLinus Torvalds error: 1367bdc712b4SDavid S. Miller cork->length -= size; 13685e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 13691da177e4SLinus Torvalds return err; 13701da177e4SLinus Torvalds } 13711da177e4SLinus Torvalds 13721470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork) 1373429f08e9SPavel Emelyanov { 13741470ddf7SHerbert Xu cork->flags &= ~IPCORK_OPT; 13751470ddf7SHerbert Xu kfree(cork->opt); 13761470ddf7SHerbert Xu cork->opt = NULL; 13771470ddf7SHerbert Xu dst_release(cork->dst); 13781470ddf7SHerbert Xu cork->dst = NULL; 1379429f08e9SPavel Emelyanov } 1380429f08e9SPavel Emelyanov 13811da177e4SLinus Torvalds /* 13821da177e4SLinus Torvalds * Combined all pending IP fragments on the socket as one IP datagram 13831da177e4SLinus Torvalds * and push them out. 13841da177e4SLinus Torvalds */ 13851c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk, 138677968b78SDavid S. Miller struct flowi4 *fl4, 13871470ddf7SHerbert Xu struct sk_buff_head *queue, 13881470ddf7SHerbert Xu struct inet_cork *cork) 13891da177e4SLinus Torvalds { 13901da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 13911da177e4SLinus Torvalds struct sk_buff **tail_skb; 13921da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 13930388b004SPavel Emelyanov struct net *net = sock_net(sk); 13941da177e4SLinus Torvalds struct ip_options *opt = NULL; 13951470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 13961da177e4SLinus Torvalds struct iphdr *iph; 139776ab608dSAlexey Dobriyan __be16 df = 0; 13981da177e4SLinus Torvalds __u8 ttl; 13991da177e4SLinus Torvalds 140051456b29SIan Morris skb = __skb_dequeue(queue); 140151456b29SIan Morris if (!skb) 14021da177e4SLinus Torvalds goto out; 14031da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 14041da177e4SLinus Torvalds 14051da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1406d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1407bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 14081470ddf7SHerbert Xu while ((tmp_skb = __skb_dequeue(queue)) != NULL) { 1409cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 14101da177e4SLinus Torvalds *tail_skb = tmp_skb; 14111da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 14121da177e4SLinus Torvalds skb->len += tmp_skb->len; 14131da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 14141da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 14151da177e4SLinus Torvalds tmp_skb->destructor = NULL; 14161da177e4SLinus Torvalds tmp_skb->sk = NULL; 14171da177e4SLinus Torvalds } 14181da177e4SLinus Torvalds 14191da177e4SLinus Torvalds /* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow 14201da177e4SLinus Torvalds * to fragment the frame generated here. No matter, what transforms 14211da177e4SLinus Torvalds * how transforms change size of the packet, it will come out. 14221da177e4SLinus Torvalds */ 142360ff7467SWANG Cong skb->ignore_df = ip_sk_ignore_df(sk); 14241da177e4SLinus Torvalds 14251da177e4SLinus Torvalds /* DF bit is set when we want to see DF on outgoing frames. 142660ff7467SWANG Cong * If ignore_df is set too, we still allow to fragment this frame 14271da177e4SLinus Torvalds * locally. */ 1428482fc609SHannes Frederic Sowa if (inet->pmtudisc == IP_PMTUDISC_DO || 1429482fc609SHannes Frederic Sowa inet->pmtudisc == IP_PMTUDISC_PROBE || 1430d8d1f30bSChangli Gao (skb->len <= dst_mtu(&rt->dst) && 1431d8d1f30bSChangli Gao ip_dont_fragment(sk, &rt->dst))) 14321da177e4SLinus Torvalds df = htons(IP_DF); 14331da177e4SLinus Torvalds 14341470ddf7SHerbert Xu if (cork->flags & IPCORK_OPT) 14351470ddf7SHerbert Xu opt = cork->opt; 14361da177e4SLinus Torvalds 1437aa661581SFrancesco Fusco if (cork->ttl != 0) 1438aa661581SFrancesco Fusco ttl = cork->ttl; 1439aa661581SFrancesco Fusco else if (rt->rt_type == RTN_MULTICAST) 14401da177e4SLinus Torvalds ttl = inet->mc_ttl; 14411da177e4SLinus Torvalds else 1442d8d1f30bSChangli Gao ttl = ip_select_ttl(inet, &rt->dst); 14431da177e4SLinus Torvalds 1444749154aaSAnsis Atteka iph = ip_hdr(skb); 14451da177e4SLinus Torvalds iph->version = 4; 14461da177e4SLinus Torvalds iph->ihl = 5; 1447aa661581SFrancesco Fusco iph->tos = (cork->tos != -1) ? cork->tos : inet->tos; 14481da177e4SLinus Torvalds iph->frag_off = df; 14491da177e4SLinus Torvalds iph->ttl = ttl; 14501da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 145184f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 1452b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, sk); 14531da177e4SLinus Torvalds 145422f728f8SDavid S. Miller if (opt) { 145522f728f8SDavid S. Miller iph->ihl += opt->optlen>>2; 145622f728f8SDavid S. Miller ip_options_build(skb, opt, cork->addr, rt, 0); 145722f728f8SDavid S. Miller } 145822f728f8SDavid S. Miller 1459aa661581SFrancesco Fusco skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority; 14604a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1461a21bba94SEric Dumazet /* 1462a21bba94SEric Dumazet * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec 1463a21bba94SEric Dumazet * on dst refcount 1464a21bba94SEric Dumazet */ 14651470ddf7SHerbert Xu cork->dst = NULL; 1466d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 14671da177e4SLinus Torvalds 146896793b48SDavid L Stevens if (iph->protocol == IPPROTO_ICMP) 14690388b004SPavel Emelyanov icmp_out_count(net, ((struct icmphdr *) 147096793b48SDavid L Stevens skb_transport_header(skb))->type); 147196793b48SDavid L Stevens 14721c32c5adSHerbert Xu ip_cork_release(cork); 14731c32c5adSHerbert Xu out: 14741c32c5adSHerbert Xu return skb; 14751c32c5adSHerbert Xu } 14761c32c5adSHerbert Xu 1477b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb) 14781c32c5adSHerbert Xu { 14791c32c5adSHerbert Xu int err; 14801c32c5adSHerbert Xu 148133224b16SEric W. Biederman err = ip_local_out(net, skb->sk, skb); 14821da177e4SLinus Torvalds if (err) { 14831da177e4SLinus Torvalds if (err > 0) 14846ce9e7b5SEric Dumazet err = net_xmit_errno(err); 14851da177e4SLinus Torvalds if (err) 14861c32c5adSHerbert Xu IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS); 14871da177e4SLinus Torvalds } 14881da177e4SLinus Torvalds 14891da177e4SLinus Torvalds return err; 14901da177e4SLinus Torvalds } 14911da177e4SLinus Torvalds 149277968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4) 14931470ddf7SHerbert Xu { 14941c32c5adSHerbert Xu struct sk_buff *skb; 14951c32c5adSHerbert Xu 149677968b78SDavid S. Miller skb = ip_finish_skb(sk, fl4); 14971c32c5adSHerbert Xu if (!skb) 14981c32c5adSHerbert Xu return 0; 14991c32c5adSHerbert Xu 15001c32c5adSHerbert Xu /* Netfilter gets whole the not fragmented skb. */ 1501b5ec8eeaSEric Dumazet return ip_send_skb(sock_net(sk), skb); 15021470ddf7SHerbert Xu } 15031470ddf7SHerbert Xu 15041da177e4SLinus Torvalds /* 15051da177e4SLinus Torvalds * Throw away all pending data on the socket. 15061da177e4SLinus Torvalds */ 15071470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk, 15081470ddf7SHerbert Xu struct sk_buff_head *queue, 15091470ddf7SHerbert Xu struct inet_cork *cork) 15101da177e4SLinus Torvalds { 15111da177e4SLinus Torvalds struct sk_buff *skb; 15121da177e4SLinus Torvalds 15131470ddf7SHerbert Xu while ((skb = __skb_dequeue_tail(queue)) != NULL) 15141da177e4SLinus Torvalds kfree_skb(skb); 15151da177e4SLinus Torvalds 15161470ddf7SHerbert Xu ip_cork_release(cork); 15171470ddf7SHerbert Xu } 15181470ddf7SHerbert Xu 15191470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk) 15201470ddf7SHerbert Xu { 1521bdc712b4SDavid S. Miller __ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base); 15221da177e4SLinus Torvalds } 15231da177e4SLinus Torvalds 15241c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk, 152577968b78SDavid S. Miller struct flowi4 *fl4, 15261c32c5adSHerbert Xu int getfrag(void *from, char *to, int offset, 15271c32c5adSHerbert Xu int len, int odd, struct sk_buff *skb), 15281c32c5adSHerbert Xu void *from, int length, int transhdrlen, 15291c32c5adSHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 15301c32c5adSHerbert Xu unsigned int flags) 15311c32c5adSHerbert Xu { 1532b80d7226SDavid S. Miller struct inet_cork cork; 15331c32c5adSHerbert Xu struct sk_buff_head queue; 15341c32c5adSHerbert Xu int err; 15351c32c5adSHerbert Xu 15361c32c5adSHerbert Xu if (flags & MSG_PROBE) 15371c32c5adSHerbert Xu return NULL; 15381c32c5adSHerbert Xu 15391c32c5adSHerbert Xu __skb_queue_head_init(&queue); 15401c32c5adSHerbert Xu 1541b80d7226SDavid S. Miller cork.flags = 0; 1542b80d7226SDavid S. Miller cork.addr = 0; 154370652728SDavid S. Miller cork.opt = NULL; 15441c32c5adSHerbert Xu err = ip_setup_cork(sk, &cork, ipc, rtp); 15451c32c5adSHerbert Xu if (err) 15461c32c5adSHerbert Xu return ERR_PTR(err); 15471c32c5adSHerbert Xu 15485640f768SEric Dumazet err = __ip_append_data(sk, fl4, &queue, &cork, 15495640f768SEric Dumazet ¤t->task_frag, getfrag, 15501c32c5adSHerbert Xu from, length, transhdrlen, flags); 15511c32c5adSHerbert Xu if (err) { 15521c32c5adSHerbert Xu __ip_flush_pending_frames(sk, &queue, &cork); 15531c32c5adSHerbert Xu return ERR_PTR(err); 15541c32c5adSHerbert Xu } 15551c32c5adSHerbert Xu 155677968b78SDavid S. Miller return __ip_make_skb(sk, fl4, &queue, &cork); 15571c32c5adSHerbert Xu } 15581da177e4SLinus Torvalds 15591da177e4SLinus Torvalds /* 15601da177e4SLinus Torvalds * Fetch data from kernel space and fill in checksum if needed. 15611da177e4SLinus Torvalds */ 15621da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset, 15631da177e4SLinus Torvalds int len, int odd, struct sk_buff *skb) 15641da177e4SLinus Torvalds { 15655084205fSAl Viro __wsum csum; 15661da177e4SLinus Torvalds 15671da177e4SLinus Torvalds csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0); 15681da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 15691da177e4SLinus Torvalds return 0; 15701da177e4SLinus Torvalds } 15711da177e4SLinus Torvalds 15721da177e4SLinus Torvalds /* 15731da177e4SLinus Torvalds * Generic function to send a packet as reply to another packet. 1574be9f4a44SEric Dumazet * Used to send some TCP resets/acks so far. 15751da177e4SLinus Torvalds */ 1576bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb, 157724a2d43dSEric Dumazet const struct ip_options *sopt, 157824a2d43dSEric Dumazet __be32 daddr, __be32 saddr, 157924a2d43dSEric Dumazet const struct ip_reply_arg *arg, 158070e73416SDavid S. Miller unsigned int len) 15811da177e4SLinus Torvalds { 1582f6d8bd05SEric Dumazet struct ip_options_data replyopts; 15831da177e4SLinus Torvalds struct ipcm_cookie ipc; 158477968b78SDavid S. Miller struct flowi4 fl4; 1585511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1586bdbbb852SEric Dumazet struct net *net = sock_net(sk); 1587be9f4a44SEric Dumazet struct sk_buff *nskb; 15884062090eSVasily Averin int err; 1589f7ba868bSDavid Ahern int oif; 15901da177e4SLinus Torvalds 159124a2d43dSEric Dumazet if (__ip_options_echo(&replyopts.opt.opt, skb, sopt)) 15921da177e4SLinus Torvalds return; 15931da177e4SLinus Torvalds 15940a5ebb80SDavid S. Miller ipc.addr = daddr; 15951da177e4SLinus Torvalds ipc.opt = NULL; 15962244d07bSOliver Hartkopp ipc.tx_flags = 0; 1597aa661581SFrancesco Fusco ipc.ttl = 0; 1598aa661581SFrancesco Fusco ipc.tos = -1; 15991da177e4SLinus Torvalds 1600f6d8bd05SEric Dumazet if (replyopts.opt.opt.optlen) { 16011da177e4SLinus Torvalds ipc.opt = &replyopts.opt; 16021da177e4SLinus Torvalds 1603f6d8bd05SEric Dumazet if (replyopts.opt.opt.srr) 1604f6d8bd05SEric Dumazet daddr = replyopts.opt.opt.faddr; 16051da177e4SLinus Torvalds } 16061da177e4SLinus Torvalds 1607f7ba868bSDavid Ahern oif = arg->bound_dev_if; 16089b6c14d5SDavid Ahern if (!oif && netif_index_is_l3_master(net, skb->skb_iif)) 16099b6c14d5SDavid Ahern oif = skb->skb_iif; 1610f7ba868bSDavid Ahern 1611f7ba868bSDavid Ahern flowi4_init_output(&fl4, oif, 1612e110861fSLorenzo Colitti IP4_REPLY_MARK(net, skb->mark), 161366b13d99SEric Dumazet RT_TOS(arg->tos), 1614be9f4a44SEric Dumazet RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol, 1615538de0e0SDavid S. Miller ip_reply_arg_flowi_flags(arg), 161670e73416SDavid S. Miller daddr, saddr, 1617e2d118a1SLorenzo Colitti tcp_hdr(skb)->source, tcp_hdr(skb)->dest, 1618e2d118a1SLorenzo Colitti arg->uid); 16199d6ec938SDavid S. Miller security_skb_classify_flow(skb, flowi4_to_flowi(&fl4)); 1620be9f4a44SEric Dumazet rt = ip_route_output_key(net, &fl4); 1621b23dd4feSDavid S. Miller if (IS_ERR(rt)) 16221da177e4SLinus Torvalds return; 16231da177e4SLinus Torvalds 1624bdbbb852SEric Dumazet inet_sk(sk)->tos = arg->tos; 16251da177e4SLinus Torvalds 16261da177e4SLinus Torvalds sk->sk_priority = skb->priority; 1627eddc9ec5SArnaldo Carvalho de Melo sk->sk_protocol = ip_hdr(skb)->protocol; 1628f0e48dbfSPatrick McHardy sk->sk_bound_dev_if = arg->bound_dev_if; 1629be9f4a44SEric Dumazet sk->sk_sndbuf = sysctl_wmem_default; 16304062090eSVasily Averin err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base, 16314062090eSVasily Averin len, 0, &ipc, &rt, MSG_DONTWAIT); 16324062090eSVasily Averin if (unlikely(err)) { 16334062090eSVasily Averin ip_flush_pending_frames(sk); 16344062090eSVasily Averin goto out; 16354062090eSVasily Averin } 16364062090eSVasily Averin 1637be9f4a44SEric Dumazet nskb = skb_peek(&sk->sk_write_queue); 1638be9f4a44SEric Dumazet if (nskb) { 16391da177e4SLinus Torvalds if (arg->csumoffset >= 0) 1640be9f4a44SEric Dumazet *((__sum16 *)skb_transport_header(nskb) + 1641be9f4a44SEric Dumazet arg->csumoffset) = csum_fold(csum_add(nskb->csum, 16429c70220bSArnaldo Carvalho de Melo arg->csum)); 1643be9f4a44SEric Dumazet nskb->ip_summed = CHECKSUM_NONE; 164477968b78SDavid S. Miller ip_push_pending_frames(sk, &fl4); 16451da177e4SLinus Torvalds } 16464062090eSVasily Averin out: 16471da177e4SLinus Torvalds ip_rt_put(rt); 16481da177e4SLinus Torvalds } 16491da177e4SLinus Torvalds 16501da177e4SLinus Torvalds void __init ip_init(void) 16511da177e4SLinus Torvalds { 16521da177e4SLinus Torvalds ip_rt_init(); 16531da177e4SLinus Torvalds inet_initpeers(); 16541da177e4SLinus Torvalds 165572c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST) 165672c1d3bdSWANG Cong igmp_mc_init(); 16571da177e4SLinus Torvalds #endif 16581da177e4SLinus Torvalds } 1659