1*457c8996SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 21da177e4SLinus Torvalds /* 31da177e4SLinus Torvalds * INET An implementation of the TCP/IP protocol suite for the LINUX 41da177e4SLinus Torvalds * operating system. INET is implemented using the BSD Socket 51da177e4SLinus Torvalds * interface as the means of communication with the user level. 61da177e4SLinus Torvalds * 71da177e4SLinus Torvalds * The Internet Protocol (IP) output module. 81da177e4SLinus Torvalds * 902c30a84SJesper Juhl * Authors: Ross Biro 101da177e4SLinus Torvalds * Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG> 111da177e4SLinus Torvalds * Donald Becker, <becker@super.org> 121da177e4SLinus Torvalds * Alan Cox, <Alan.Cox@linux.org> 131da177e4SLinus Torvalds * Richard Underwood 141da177e4SLinus Torvalds * Stefan Becker, <stefanb@yello.ping.de> 151da177e4SLinus Torvalds * Jorge Cwik, <jorge@laser.satlink.net> 161da177e4SLinus Torvalds * Arnt Gulbrandsen, <agulbra@nvg.unit.no> 171da177e4SLinus Torvalds * Hirokazu Takahashi, <taka@valinux.co.jp> 181da177e4SLinus Torvalds * 191da177e4SLinus Torvalds * See ip_input.c for original log 201da177e4SLinus Torvalds * 211da177e4SLinus Torvalds * Fixes: 221da177e4SLinus Torvalds * Alan Cox : Missing nonblock feature in ip_build_xmit. 231da177e4SLinus Torvalds * Mike Kilburn : htons() missing in ip_build_xmit. 241da177e4SLinus Torvalds * Bradford Johnson: Fix faulty handling of some frames when 251da177e4SLinus Torvalds * no route is found. 261da177e4SLinus Torvalds * Alexander Demenshin: Missing sk/skb free in ip_queue_xmit 271da177e4SLinus Torvalds * (in case if packet not accepted by 281da177e4SLinus Torvalds * output firewall rules) 291da177e4SLinus Torvalds * Mike McLagan : Routing by source 301da177e4SLinus Torvalds * Alexey Kuznetsov: use new route cache 311da177e4SLinus Torvalds * Andi Kleen: Fix broken PMTU recovery and remove 321da177e4SLinus Torvalds * some redundant tests. 331da177e4SLinus Torvalds * Vitaly E. Lavrov : Transparent proxy revived after year coma. 341da177e4SLinus Torvalds * Andi Kleen : Replace ip_reply with ip_send_reply. 351da177e4SLinus Torvalds * Andi Kleen : Split fast and slow ip_build_xmit path 361da177e4SLinus Torvalds * for decreased register pressure on x86 371da177e4SLinus Torvalds * and more readibility. 381da177e4SLinus Torvalds * Marc Boucher : When call_out_firewall returns FW_QUEUE, 391da177e4SLinus Torvalds * silently drop skb instead of failing with -EPERM. 401da177e4SLinus Torvalds * Detlev Wengorz : Copy protocol for fragments. 411da177e4SLinus Torvalds * Hirokazu Takahashi: HW checksumming for outgoing UDP 421da177e4SLinus Torvalds * datagrams. 431da177e4SLinus Torvalds * Hirokazu Takahashi: sendfile() on UDP works now. 441da177e4SLinus Torvalds */ 451da177e4SLinus Torvalds 467c0f6ba6SLinus Torvalds #include <linux/uaccess.h> 471da177e4SLinus Torvalds #include <linux/module.h> 481da177e4SLinus Torvalds #include <linux/types.h> 491da177e4SLinus Torvalds #include <linux/kernel.h> 501da177e4SLinus Torvalds #include <linux/mm.h> 511da177e4SLinus Torvalds #include <linux/string.h> 521da177e4SLinus Torvalds #include <linux/errno.h> 53a1f8e7f7SAl Viro #include <linux/highmem.h> 545a0e3ad6STejun Heo #include <linux/slab.h> 551da177e4SLinus Torvalds 561da177e4SLinus Torvalds #include <linux/socket.h> 571da177e4SLinus Torvalds #include <linux/sockios.h> 581da177e4SLinus Torvalds #include <linux/in.h> 591da177e4SLinus Torvalds #include <linux/inet.h> 601da177e4SLinus Torvalds #include <linux/netdevice.h> 611da177e4SLinus Torvalds #include <linux/etherdevice.h> 621da177e4SLinus Torvalds #include <linux/proc_fs.h> 631da177e4SLinus Torvalds #include <linux/stat.h> 641da177e4SLinus Torvalds #include <linux/init.h> 651da177e4SLinus Torvalds 661da177e4SLinus Torvalds #include <net/snmp.h> 671da177e4SLinus Torvalds #include <net/ip.h> 681da177e4SLinus Torvalds #include <net/protocol.h> 691da177e4SLinus Torvalds #include <net/route.h> 70cfacb057SPatrick McHardy #include <net/xfrm.h> 711da177e4SLinus Torvalds #include <linux/skbuff.h> 721da177e4SLinus Torvalds #include <net/sock.h> 731da177e4SLinus Torvalds #include <net/arp.h> 741da177e4SLinus Torvalds #include <net/icmp.h> 751da177e4SLinus Torvalds #include <net/checksum.h> 761da177e4SLinus Torvalds #include <net/inetpeer.h> 7714972cbdSRoopa Prabhu #include <net/lwtunnel.h> 7833b48679SDaniel Mack #include <linux/bpf-cgroup.h> 791da177e4SLinus Torvalds #include <linux/igmp.h> 801da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h> 811da177e4SLinus Torvalds #include <linux/netfilter_bridge.h> 821da177e4SLinus Torvalds #include <linux/netlink.h> 836cbb0df7SArnaldo Carvalho de Melo #include <linux/tcp.h> 841da177e4SLinus Torvalds 85694869b3SEric W. Biederman static int 86694869b3SEric W. Biederman ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 87c5501eb3SFlorian Westphal unsigned int mtu, 88694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)); 8949d16b23SAndy Zhou 901da177e4SLinus Torvalds /* Generate a checksum for an outgoing IP datagram. */ 912fbd9679SDenis Efremov void ip_send_check(struct iphdr *iph) 921da177e4SLinus Torvalds { 931da177e4SLinus Torvalds iph->check = 0; 941da177e4SLinus Torvalds iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl); 951da177e4SLinus Torvalds } 964bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_send_check); 971da177e4SLinus Torvalds 98cf91a99dSEric W. Biederman int __ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb) 99c439cb2eSHerbert Xu { 100c439cb2eSHerbert Xu struct iphdr *iph = ip_hdr(skb); 101c439cb2eSHerbert Xu 102c439cb2eSHerbert Xu iph->tot_len = htons(skb->len); 103c439cb2eSHerbert Xu ip_send_check(iph); 104a8e3e1a9SDavid Ahern 105a8e3e1a9SDavid Ahern /* if egress device is enslaved to an L3 master device pass the 106a8e3e1a9SDavid Ahern * skb to its handler for processing 107a8e3e1a9SDavid Ahern */ 108a8e3e1a9SDavid Ahern skb = l3mdev_ip_out(sk, skb); 109a8e3e1a9SDavid Ahern if (unlikely(!skb)) 110a8e3e1a9SDavid Ahern return 0; 111a8e3e1a9SDavid Ahern 112f4180439SEli Cooper skb->protocol = htons(ETH_P_IP); 113f4180439SEli Cooper 11429a26a56SEric W. Biederman return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT, 11529a26a56SEric W. Biederman net, sk, skb, NULL, skb_dst(skb)->dev, 11613206b6bSEric W. Biederman dst_output); 1177026b1ddSDavid Miller } 1187026b1ddSDavid Miller 11933224b16SEric W. Biederman int ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb) 120c439cb2eSHerbert Xu { 121c439cb2eSHerbert Xu int err; 122c439cb2eSHerbert Xu 123cf91a99dSEric W. Biederman err = __ip_local_out(net, sk, skb); 124c439cb2eSHerbert Xu if (likely(err == 1)) 12513206b6bSEric W. Biederman err = dst_output(net, sk, skb); 126c439cb2eSHerbert Xu 127c439cb2eSHerbert Xu return err; 128c439cb2eSHerbert Xu } 129e2cb77dbSEric W. Biederman EXPORT_SYMBOL_GPL(ip_local_out); 130c439cb2eSHerbert Xu 1311da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst) 1321da177e4SLinus Torvalds { 1331da177e4SLinus Torvalds int ttl = inet->uc_ttl; 1341da177e4SLinus Torvalds 1351da177e4SLinus Torvalds if (ttl < 0) 136323e126fSDavid S. Miller ttl = ip4_dst_hoplimit(dst); 1371da177e4SLinus Torvalds return ttl; 1381da177e4SLinus Torvalds } 1391da177e4SLinus Torvalds 1401da177e4SLinus Torvalds /* 1411da177e4SLinus Torvalds * Add an ip header to a skbuff and send it out. 1421da177e4SLinus Torvalds * 1431da177e4SLinus Torvalds */ 144cfe673b0SEric Dumazet int ip_build_and_send_pkt(struct sk_buff *skb, const struct sock *sk, 145f6d8bd05SEric Dumazet __be32 saddr, __be32 daddr, struct ip_options_rcu *opt) 1461da177e4SLinus Torvalds { 1471da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 148511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 14977589ce0SEric W. Biederman struct net *net = sock_net(sk); 1501da177e4SLinus Torvalds struct iphdr *iph; 1511da177e4SLinus Torvalds 1521da177e4SLinus Torvalds /* Build the IP header. */ 153f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (opt ? opt->opt.optlen : 0)); 1548856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 155eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 1561da177e4SLinus Torvalds iph->version = 4; 1571da177e4SLinus Torvalds iph->ihl = 5; 1581da177e4SLinus Torvalds iph->tos = inet->tos; 159d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 160dd927a26SDavid S. Miller iph->daddr = (opt && opt->opt.srr ? opt->opt.faddr : daddr); 161dd927a26SDavid S. Miller iph->saddr = saddr; 1621da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 163cfe673b0SEric Dumazet if (ip_dont_fragment(sk, &rt->dst)) { 164cfe673b0SEric Dumazet iph->frag_off = htons(IP_DF); 165cfe673b0SEric Dumazet iph->id = 0; 166cfe673b0SEric Dumazet } else { 167cfe673b0SEric Dumazet iph->frag_off = 0; 16877589ce0SEric W. Biederman __ip_select_ident(net, iph, 1); 169cfe673b0SEric Dumazet } 1701da177e4SLinus Torvalds 171f6d8bd05SEric Dumazet if (opt && opt->opt.optlen) { 172f6d8bd05SEric Dumazet iph->ihl += opt->opt.optlen>>2; 173f6d8bd05SEric Dumazet ip_options_build(skb, &opt->opt, daddr, rt, 0); 1741da177e4SLinus Torvalds } 1751da177e4SLinus Torvalds 1761da177e4SLinus Torvalds skb->priority = sk->sk_priority; 177e05a90ecSJamal Hadi Salim if (!skb->mark) 1784a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1791da177e4SLinus Torvalds 1801da177e4SLinus Torvalds /* Send it out. */ 18133224b16SEric W. Biederman return ip_local_out(net, skb->sk, skb); 1821da177e4SLinus Torvalds } 183d8c97a94SArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip_build_and_send_pkt); 184d8c97a94SArnaldo Carvalho de Melo 185694869b3SEric W. Biederman static int ip_finish_output2(struct net *net, struct sock *sk, struct sk_buff *skb) 1861da177e4SLinus Torvalds { 187adf30907SEric Dumazet struct dst_entry *dst = skb_dst(skb); 18880787ebcSMitsuru Chinen struct rtable *rt = (struct rtable *)dst; 1891da177e4SLinus Torvalds struct net_device *dev = dst->dev; 190c2636b4dSChuck Lever unsigned int hh_len = LL_RESERVED_SPACE(dev); 191f6b72b62SDavid S. Miller struct neighbour *neigh; 1925c9f7c1dSDavid Ahern bool is_v6gw = false; 1931da177e4SLinus Torvalds 194edf391ffSNeil Horman if (rt->rt_type == RTN_MULTICAST) { 1954ba1bf42SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTMCAST, skb->len); 196edf391ffSNeil Horman } else if (rt->rt_type == RTN_BROADCAST) 1974ba1bf42SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTBCAST, skb->len); 19880787ebcSMitsuru Chinen 1991da177e4SLinus Torvalds /* Be paranoid, rather than too clever. */ 2003b04dddeSStephen Hemminger if (unlikely(skb_headroom(skb) < hh_len && dev->header_ops)) { 2011da177e4SLinus Torvalds struct sk_buff *skb2; 2021da177e4SLinus Torvalds 2031da177e4SLinus Torvalds skb2 = skb_realloc_headroom(skb, LL_RESERVED_SPACE(dev)); 20451456b29SIan Morris if (!skb2) { 2051da177e4SLinus Torvalds kfree_skb(skb); 2061da177e4SLinus Torvalds return -ENOMEM; 2071da177e4SLinus Torvalds } 2081da177e4SLinus Torvalds if (skb->sk) 2091da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 2105d0ba55bSEric Dumazet consume_skb(skb); 2111da177e4SLinus Torvalds skb = skb2; 2121da177e4SLinus Torvalds } 2131da177e4SLinus Torvalds 21414972cbdSRoopa Prabhu if (lwtunnel_xmit_redirect(dst->lwtstate)) { 21514972cbdSRoopa Prabhu int res = lwtunnel_xmit(skb); 21614972cbdSRoopa Prabhu 21714972cbdSRoopa Prabhu if (res < 0 || res == LWTUNNEL_XMIT_DONE) 21814972cbdSRoopa Prabhu return res; 21914972cbdSRoopa Prabhu } 22014972cbdSRoopa Prabhu 221a263b309SDavid S. Miller rcu_read_lock_bh(); 2225c9f7c1dSDavid Ahern neigh = ip_neigh_for_gw(rt, skb, &is_v6gw); 2239871f1adSVasiliy Kulikov if (!IS_ERR(neigh)) { 2244ff06203SJulian Anastasov int res; 2254ff06203SJulian Anastasov 2264ff06203SJulian Anastasov sock_confirm_neigh(skb, neigh); 2275c9f7c1dSDavid Ahern /* if crossing protocols, can not use the cached header */ 2285c9f7c1dSDavid Ahern res = neigh_output(neigh, skb, is_v6gw); 229a263b309SDavid S. Miller rcu_read_unlock_bh(); 230f2c31e32SEric Dumazet return res; 231f2c31e32SEric Dumazet } 232a263b309SDavid S. Miller rcu_read_unlock_bh(); 23305e3aa09SDavid S. Miller 234e87cc472SJoe Perches net_dbg_ratelimited("%s: No header cache and no neighbour!\n", 235e87cc472SJoe Perches __func__); 2361da177e4SLinus Torvalds kfree_skb(skb); 2371da177e4SLinus Torvalds return -EINVAL; 2381da177e4SLinus Torvalds } 2391da177e4SLinus Torvalds 240694869b3SEric W. Biederman static int ip_finish_output_gso(struct net *net, struct sock *sk, 241694869b3SEric W. Biederman struct sk_buff *skb, unsigned int mtu) 242c7ba65d7SFlorian Westphal { 243c7ba65d7SFlorian Westphal netdev_features_t features; 244c7ba65d7SFlorian Westphal struct sk_buff *segs; 245c7ba65d7SFlorian Westphal int ret = 0; 246c7ba65d7SFlorian Westphal 2479ee6c5dcSLance Richardson /* common case: seglen is <= mtu 248359ebda2SShmulik Ladkani */ 249779b7931SDaniel Axtens if (skb_gso_validate_network_len(skb, mtu)) 250694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 251c7ba65d7SFlorian Westphal 2520ace81ecSLance Richardson /* Slowpath - GSO segment length exceeds the egress MTU. 253c7ba65d7SFlorian Westphal * 2540ace81ecSLance Richardson * This can happen in several cases: 2550ace81ecSLance Richardson * - Forwarding of a TCP GRO skb, when DF flag is not set. 2560ace81ecSLance Richardson * - Forwarding of an skb that arrived on a virtualization interface 2570ace81ecSLance Richardson * (virtio-net/vhost/tap) with TSO/GSO size set by other network 2580ace81ecSLance Richardson * stack. 2590ace81ecSLance Richardson * - Local GSO skb transmitted on an NETIF_F_TSO tunnel stacked over an 2600ace81ecSLance Richardson * interface with a smaller MTU. 2610ace81ecSLance Richardson * - Arriving GRO skb (or GSO skb in a virtualized environment) that is 2620ace81ecSLance Richardson * bridged to a NETIF_F_TSO tunnel stacked over an interface with an 2630ace81ecSLance Richardson * insufficent MTU. 264c7ba65d7SFlorian Westphal */ 265c7ba65d7SFlorian Westphal features = netif_skb_features(skb); 2669207f9d4SKonstantin Khlebnikov BUILD_BUG_ON(sizeof(*IPCB(skb)) > SKB_SGO_CB_OFFSET); 267c7ba65d7SFlorian Westphal segs = skb_gso_segment(skb, features & ~NETIF_F_GSO_MASK); 268330966e5SFlorian Westphal if (IS_ERR_OR_NULL(segs)) { 269c7ba65d7SFlorian Westphal kfree_skb(skb); 270c7ba65d7SFlorian Westphal return -ENOMEM; 271c7ba65d7SFlorian Westphal } 272c7ba65d7SFlorian Westphal 273c7ba65d7SFlorian Westphal consume_skb(skb); 274c7ba65d7SFlorian Westphal 275c7ba65d7SFlorian Westphal do { 276c7ba65d7SFlorian Westphal struct sk_buff *nskb = segs->next; 277c7ba65d7SFlorian Westphal int err; 278c7ba65d7SFlorian Westphal 279a8305bffSDavid S. Miller skb_mark_not_on_list(segs); 280694869b3SEric W. Biederman err = ip_fragment(net, sk, segs, mtu, ip_finish_output2); 281c7ba65d7SFlorian Westphal 282c7ba65d7SFlorian Westphal if (err && ret == 0) 283c7ba65d7SFlorian Westphal ret = err; 284c7ba65d7SFlorian Westphal segs = nskb; 285c7ba65d7SFlorian Westphal } while (segs); 286c7ba65d7SFlorian Westphal 287c7ba65d7SFlorian Westphal return ret; 288c7ba65d7SFlorian Westphal } 289c7ba65d7SFlorian Westphal 2900c4b51f0SEric W. Biederman static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 2911da177e4SLinus Torvalds { 292c5501eb3SFlorian Westphal unsigned int mtu; 29333b48679SDaniel Mack int ret; 29433b48679SDaniel Mack 29533b48679SDaniel Mack ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 29633b48679SDaniel Mack if (ret) { 29733b48679SDaniel Mack kfree_skb(skb); 29833b48679SDaniel Mack return ret; 29933b48679SDaniel Mack } 300c5501eb3SFlorian Westphal 3015c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM) 3025c901daaSPatrick McHardy /* Policy lookup after SNAT yielded a new policy */ 30300db4124SIan Morris if (skb_dst(skb)->xfrm) { 30448d5cad8SPatrick McHardy IPCB(skb)->flags |= IPSKB_REROUTED; 30513206b6bSEric W. Biederman return dst_output(net, sk, skb); 30648d5cad8SPatrick McHardy } 3075c901daaSPatrick McHardy #endif 308fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 309c7ba65d7SFlorian Westphal if (skb_is_gso(skb)) 310694869b3SEric W. Biederman return ip_finish_output_gso(net, sk, skb, mtu); 311c7ba65d7SFlorian Westphal 312d6b915e2SFlorian Westphal if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU)) 313694869b3SEric W. Biederman return ip_fragment(net, sk, skb, mtu, ip_finish_output2); 314c7ba65d7SFlorian Westphal 315694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 3161da177e4SLinus Torvalds } 3171da177e4SLinus Torvalds 31833b48679SDaniel Mack static int ip_mc_finish_output(struct net *net, struct sock *sk, 31933b48679SDaniel Mack struct sk_buff *skb) 32033b48679SDaniel Mack { 32133b48679SDaniel Mack int ret; 32233b48679SDaniel Mack 32333b48679SDaniel Mack ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 32433b48679SDaniel Mack if (ret) { 32533b48679SDaniel Mack kfree_skb(skb); 32633b48679SDaniel Mack return ret; 32733b48679SDaniel Mack } 32833b48679SDaniel Mack 32933b48679SDaniel Mack return dev_loopback_xmit(net, sk, skb); 33033b48679SDaniel Mack } 33133b48679SDaniel Mack 332ede2059dSEric W. Biederman int ip_mc_output(struct net *net, struct sock *sk, struct sk_buff *skb) 3331da177e4SLinus Torvalds { 334511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 335d8d1f30bSChangli Gao struct net_device *dev = rt->dst.dev; 3361da177e4SLinus Torvalds 3371da177e4SLinus Torvalds /* 3381da177e4SLinus Torvalds * If the indicated interface is up and running, send the packet. 3391da177e4SLinus Torvalds */ 34088f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3411da177e4SLinus Torvalds 3421da177e4SLinus Torvalds skb->dev = dev; 3431da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 3441da177e4SLinus Torvalds 3451da177e4SLinus Torvalds /* 3461da177e4SLinus Torvalds * Multicasts are looped back for other local users 3471da177e4SLinus Torvalds */ 3481da177e4SLinus Torvalds 3491da177e4SLinus Torvalds if (rt->rt_flags&RTCF_MULTICAST) { 3507ad6848cSOctavian Purdila if (sk_mc_loop(sk) 3511da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 3521da177e4SLinus Torvalds /* Small optimization: do not loopback not local frames, 3531da177e4SLinus Torvalds which returned after forwarding; they will be dropped 3541da177e4SLinus Torvalds by ip_mr_input in any case. 3551da177e4SLinus Torvalds Note, that local frames are looped back to be delivered 3561da177e4SLinus Torvalds to local recipients. 3571da177e4SLinus Torvalds 3581da177e4SLinus Torvalds This check is duplicated in ip_mr_input at the moment. 3591da177e4SLinus Torvalds */ 3609d4fb27dSJoe Perches && 3619d4fb27dSJoe Perches ((rt->rt_flags & RTCF_LOCAL) || 3629d4fb27dSJoe Perches !(IPCB(skb)->flags & IPSKB_FORWARDED)) 3631da177e4SLinus Torvalds #endif 3641da177e4SLinus Torvalds ) { 3651da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3661da177e4SLinus Torvalds if (newskb) 3679bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 36829a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 36933b48679SDaniel Mack ip_mc_finish_output); 3701da177e4SLinus Torvalds } 3711da177e4SLinus Torvalds 3721da177e4SLinus Torvalds /* Multicasts with ttl 0 must not go beyond the host */ 3731da177e4SLinus Torvalds 374eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl == 0) { 3751da177e4SLinus Torvalds kfree_skb(skb); 3761da177e4SLinus Torvalds return 0; 3771da177e4SLinus Torvalds } 3781da177e4SLinus Torvalds } 3791da177e4SLinus Torvalds 3801da177e4SLinus Torvalds if (rt->rt_flags&RTCF_BROADCAST) { 3811da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3821da177e4SLinus Torvalds if (newskb) 38329a26a56SEric W. Biederman NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 38429a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 38533b48679SDaniel Mack ip_mc_finish_output); 3861da177e4SLinus Torvalds } 3871da177e4SLinus Torvalds 38829a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 38929a26a56SEric W. Biederman net, sk, skb, NULL, skb->dev, 39029a26a56SEric W. Biederman ip_finish_output, 39148d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 3921da177e4SLinus Torvalds } 3931da177e4SLinus Torvalds 394ede2059dSEric W. Biederman int ip_output(struct net *net, struct sock *sk, struct sk_buff *skb) 3951da177e4SLinus Torvalds { 396adf30907SEric Dumazet struct net_device *dev = skb_dst(skb)->dev; 3971bd9bef6SPatrick McHardy 39888f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3991da177e4SLinus Torvalds 4001bd9bef6SPatrick McHardy skb->dev = dev; 4011bd9bef6SPatrick McHardy skb->protocol = htons(ETH_P_IP); 4021bd9bef6SPatrick McHardy 40329a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 40429a26a56SEric W. Biederman net, sk, skb, NULL, dev, 40548d5cad8SPatrick McHardy ip_finish_output, 40648d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 4071da177e4SLinus Torvalds } 4081da177e4SLinus Torvalds 40984f9307cSEric Dumazet /* 41084f9307cSEric Dumazet * copy saddr and daddr, possibly using 64bit load/stores 41184f9307cSEric Dumazet * Equivalent to : 41284f9307cSEric Dumazet * iph->saddr = fl4->saddr; 41384f9307cSEric Dumazet * iph->daddr = fl4->daddr; 41484f9307cSEric Dumazet */ 41584f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4) 41684f9307cSEric Dumazet { 41784f9307cSEric Dumazet BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) != 41884f9307cSEric Dumazet offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr)); 41984f9307cSEric Dumazet memcpy(&iph->saddr, &fl4->saddr, 42084f9307cSEric Dumazet sizeof(fl4->saddr) + sizeof(fl4->daddr)); 42184f9307cSEric Dumazet } 42284f9307cSEric Dumazet 423b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */ 42469b9e1e0SXin Long int __ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl, 42569b9e1e0SXin Long __u8 tos) 4261da177e4SLinus Torvalds { 4271da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 42877589ce0SEric W. Biederman struct net *net = sock_net(sk); 429f6d8bd05SEric Dumazet struct ip_options_rcu *inet_opt; 430b57ae01aSDavid S. Miller struct flowi4 *fl4; 4311da177e4SLinus Torvalds struct rtable *rt; 4321da177e4SLinus Torvalds struct iphdr *iph; 433ab6e3febSEric Dumazet int res; 4341da177e4SLinus Torvalds 4351da177e4SLinus Torvalds /* Skip all of this if the packet is already routed, 4361da177e4SLinus Torvalds * f.e. by something like SCTP. 4371da177e4SLinus Torvalds */ 438ab6e3febSEric Dumazet rcu_read_lock(); 439f6d8bd05SEric Dumazet inet_opt = rcu_dereference(inet->inet_opt); 440ea4fc0d6SDavid S. Miller fl4 = &fl->u.ip4; 441511c3f92SEric Dumazet rt = skb_rtable(skb); 44200db4124SIan Morris if (rt) 4431da177e4SLinus Torvalds goto packet_routed; 4441da177e4SLinus Torvalds 4451da177e4SLinus Torvalds /* Make sure we can route this packet. */ 4461da177e4SLinus Torvalds rt = (struct rtable *)__sk_dst_check(sk, 0); 44751456b29SIan Morris if (!rt) { 4483ca3c68eSAl Viro __be32 daddr; 4491da177e4SLinus Torvalds 4501da177e4SLinus Torvalds /* Use correct destination address if we have options. */ 451c720c7e8SEric Dumazet daddr = inet->inet_daddr; 452f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.srr) 453f6d8bd05SEric Dumazet daddr = inet_opt->opt.faddr; 4541da177e4SLinus Torvalds 4551da177e4SLinus Torvalds /* If this fails, retransmit mechanism of transport layer will 4561da177e4SLinus Torvalds * keep trying until route appears or the connection times 4571da177e4SLinus Torvalds * itself out. 4581da177e4SLinus Torvalds */ 45977589ce0SEric W. Biederman rt = ip_route_output_ports(net, fl4, sk, 46078fbfd8aSDavid S. Miller daddr, inet->inet_saddr, 46178fbfd8aSDavid S. Miller inet->inet_dport, 46278fbfd8aSDavid S. Miller inet->inet_sport, 46378fbfd8aSDavid S. Miller sk->sk_protocol, 46469b9e1e0SXin Long RT_CONN_FLAGS_TOS(sk, tos), 46578fbfd8aSDavid S. Miller sk->sk_bound_dev_if); 466b23dd4feSDavid S. Miller if (IS_ERR(rt)) 4671da177e4SLinus Torvalds goto no_route; 468d8d1f30bSChangli Gao sk_setup_caps(sk, &rt->dst); 4691da177e4SLinus Torvalds } 470d8d1f30bSChangli Gao skb_dst_set_noref(skb, &rt->dst); 4711da177e4SLinus Torvalds 4721da177e4SLinus Torvalds packet_routed: 4731550c171SDavid Ahern if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_gw_family) 4741da177e4SLinus Torvalds goto no_route; 4751da177e4SLinus Torvalds 4761da177e4SLinus Torvalds /* OK, we know where to send it, allocate and build IP header. */ 477f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0)); 4788856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 479eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 48069b9e1e0SXin Long *((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (tos & 0xff)); 48160ff7467SWANG Cong if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df) 4821da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 4831da177e4SLinus Torvalds else 4841da177e4SLinus Torvalds iph->frag_off = 0; 485d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 4861da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 48784f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 48884f9307cSEric Dumazet 4891da177e4SLinus Torvalds /* Transport layer set skb->h.foo itself. */ 4901da177e4SLinus Torvalds 491f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.optlen) { 492f6d8bd05SEric Dumazet iph->ihl += inet_opt->opt.optlen >> 2; 493f6d8bd05SEric Dumazet ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0); 4941da177e4SLinus Torvalds } 4951da177e4SLinus Torvalds 49677589ce0SEric W. Biederman ip_select_ident_segs(net, skb, sk, 497b6a7719aSHannes Frederic Sowa skb_shinfo(skb)->gso_segs ?: 1); 4981da177e4SLinus Torvalds 499b0270e91SEric Dumazet /* TODO : should we use skb->sk here instead of sk ? */ 5001da177e4SLinus Torvalds skb->priority = sk->sk_priority; 5014a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 5021da177e4SLinus Torvalds 50333224b16SEric W. Biederman res = ip_local_out(net, sk, skb); 504ab6e3febSEric Dumazet rcu_read_unlock(); 505ab6e3febSEric Dumazet return res; 5061da177e4SLinus Torvalds 5071da177e4SLinus Torvalds no_route: 508ab6e3febSEric Dumazet rcu_read_unlock(); 50977589ce0SEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_OUTNOROUTES); 5101da177e4SLinus Torvalds kfree_skb(skb); 5111da177e4SLinus Torvalds return -EHOSTUNREACH; 5121da177e4SLinus Torvalds } 51369b9e1e0SXin Long EXPORT_SYMBOL(__ip_queue_xmit); 5141da177e4SLinus Torvalds 5151da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from) 5161da177e4SLinus Torvalds { 5171da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 5181da177e4SLinus Torvalds to->priority = from->priority; 5191da177e4SLinus Torvalds to->protocol = from->protocol; 520d2f0c961SShmulik Ladkani to->skb_iif = from->skb_iif; 521adf30907SEric Dumazet skb_dst_drop(to); 522fe76cda3SEric Dumazet skb_dst_copy(to, from); 5231da177e4SLinus Torvalds to->dev = from->dev; 52482e91ffeSThomas Graf to->mark = from->mark; 5251da177e4SLinus Torvalds 5263dd1c9a1SPaolo Abeni skb_copy_hash(to, from); 5273dd1c9a1SPaolo Abeni 5281da177e4SLinus Torvalds /* Copy the flags to each fragment. */ 5291da177e4SLinus Torvalds IPCB(to)->flags = IPCB(from)->flags; 5301da177e4SLinus Torvalds 5311da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 5321da177e4SLinus Torvalds to->tc_index = from->tc_index; 5331da177e4SLinus Torvalds #endif 534e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 535df5042f4SFlorian Westphal skb_ext_copy(to, from); 5366ca40d4eSJavier Martinez Canillas #if IS_ENABLED(CONFIG_IP_VS) 537c98d80edSJulian Anastasov to->ipvs_property = from->ipvs_property; 538c98d80edSJulian Anastasov #endif 539984bc16cSJames Morris skb_copy_secmark(to, from); 5401da177e4SLinus Torvalds } 5411da177e4SLinus Torvalds 542694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 543c5501eb3SFlorian Westphal unsigned int mtu, 544694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 54549d16b23SAndy Zhou { 54649d16b23SAndy Zhou struct iphdr *iph = ip_hdr(skb); 54749d16b23SAndy Zhou 548d6b915e2SFlorian Westphal if ((iph->frag_off & htons(IP_DF)) == 0) 549694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 550d6b915e2SFlorian Westphal 551d6b915e2SFlorian Westphal if (unlikely(!skb->ignore_df || 55249d16b23SAndy Zhou (IPCB(skb)->frag_max_size && 55349d16b23SAndy Zhou IPCB(skb)->frag_max_size > mtu))) { 5549479b0afSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 55549d16b23SAndy Zhou icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, 55649d16b23SAndy Zhou htonl(mtu)); 55749d16b23SAndy Zhou kfree_skb(skb); 55849d16b23SAndy Zhou return -EMSGSIZE; 55949d16b23SAndy Zhou } 56049d16b23SAndy Zhou 561694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 56249d16b23SAndy Zhou } 56349d16b23SAndy Zhou 5641da177e4SLinus Torvalds /* 5651da177e4SLinus Torvalds * This IP datagram is too large to be sent in one piece. Break it up into 5661da177e4SLinus Torvalds * smaller pieces (each of size equal to IP header plus 5671da177e4SLinus Torvalds * a block of the data of the original IP data part) that will yet fit in a 5681da177e4SLinus Torvalds * single device frame, and queue such a frame for sending. 5691da177e4SLinus Torvalds */ 5701da177e4SLinus Torvalds 571694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 572694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 5731da177e4SLinus Torvalds { 5741da177e4SLinus Torvalds struct iphdr *iph; 5751da177e4SLinus Torvalds int ptr; 5761da177e4SLinus Torvalds struct sk_buff *skb2; 577c893b806SChangli Gao unsigned int mtu, hlen, left, len, ll_rs; 5781da177e4SLinus Torvalds int offset; 57976ab608dSAlexey Dobriyan __be16 not_last_frag; 580511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 5811da177e4SLinus Torvalds int err = 0; 5821da177e4SLinus Torvalds 583dbd3393cSHannes Frederic Sowa /* for offloaded checksums cleanup checksum before fragmentation */ 584dbd3393cSHannes Frederic Sowa if (skb->ip_summed == CHECKSUM_PARTIAL && 585dbd3393cSHannes Frederic Sowa (err = skb_checksum_help(skb))) 586dbd3393cSHannes Frederic Sowa goto fail; 587dbd3393cSHannes Frederic Sowa 5881da177e4SLinus Torvalds /* 5891da177e4SLinus Torvalds * Point into the IP datagram header. 5901da177e4SLinus Torvalds */ 5911da177e4SLinus Torvalds 592eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 5931da177e4SLinus Torvalds 594fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 595d6b915e2SFlorian Westphal if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu) 596d6b915e2SFlorian Westphal mtu = IPCB(skb)->frag_max_size; 5971da177e4SLinus Torvalds 5981da177e4SLinus Torvalds /* 5991da177e4SLinus Torvalds * Setup starting values. 6001da177e4SLinus Torvalds */ 6011da177e4SLinus Torvalds 6021da177e4SLinus Torvalds hlen = iph->ihl * 4; 603f87c10a8SHannes Frederic Sowa mtu = mtu - hlen; /* Size of data space */ 60489cee8b1SHerbert Xu IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE; 605254d900bSVasily Averin ll_rs = LL_RESERVED_SPACE(rt->dst.dev); 6061da177e4SLinus Torvalds 6071da177e4SLinus Torvalds /* When frag_list is given, use it. First, check its validity: 6081da177e4SLinus Torvalds * some transformers could create wrong frag_list or break existing 6091da177e4SLinus Torvalds * one, it is not prohibited. In this case fall back to copying. 6101da177e4SLinus Torvalds * 6111da177e4SLinus Torvalds * LATER: this step can be merged to real generation of fragments, 6121da177e4SLinus Torvalds * we can switch to copy when see the first bad fragment. 6131da177e4SLinus Torvalds */ 61421dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 6153d13008eSEric Dumazet struct sk_buff *frag, *frag2; 616c72d8cdaSAlexey Dobriyan unsigned int first_len = skb_pagelen(skb); 6171da177e4SLinus Torvalds 6181da177e4SLinus Torvalds if (first_len - hlen > mtu || 6191da177e4SLinus Torvalds ((first_len - hlen) & 7) || 62056f8a75cSPaul Gortmaker ip_is_fragment(iph) || 621254d900bSVasily Averin skb_cloned(skb) || 622254d900bSVasily Averin skb_headroom(skb) < ll_rs) 6231da177e4SLinus Torvalds goto slow_path; 6241da177e4SLinus Torvalds 625d7fcf1a5SDavid S. Miller skb_walk_frags(skb, frag) { 6261da177e4SLinus Torvalds /* Correct geometry. */ 6271da177e4SLinus Torvalds if (frag->len > mtu || 6281da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 629254d900bSVasily Averin skb_headroom(frag) < hlen + ll_rs) 6303d13008eSEric Dumazet goto slow_path_clean; 6311da177e4SLinus Torvalds 6321da177e4SLinus Torvalds /* Partially cloned skb? */ 6331da177e4SLinus Torvalds if (skb_shared(frag)) 6343d13008eSEric Dumazet goto slow_path_clean; 6352fdba6b0SHerbert Xu 6362fdba6b0SHerbert Xu BUG_ON(frag->sk); 6372fdba6b0SHerbert Xu if (skb->sk) { 6382fdba6b0SHerbert Xu frag->sk = skb->sk; 6392fdba6b0SHerbert Xu frag->destructor = sock_wfree; 6402fdba6b0SHerbert Xu } 6413d13008eSEric Dumazet skb->truesize -= frag->truesize; 6421da177e4SLinus Torvalds } 6431da177e4SLinus Torvalds 6441da177e4SLinus Torvalds /* Everything is OK. Generate! */ 6451da177e4SLinus Torvalds 6461da177e4SLinus Torvalds err = 0; 6471da177e4SLinus Torvalds offset = 0; 6481da177e4SLinus Torvalds frag = skb_shinfo(skb)->frag_list; 649d7fcf1a5SDavid S. Miller skb_frag_list_init(skb); 6501da177e4SLinus Torvalds skb->data_len = first_len - skb_headlen(skb); 6511da177e4SLinus Torvalds skb->len = first_len; 6521da177e4SLinus Torvalds iph->tot_len = htons(first_len); 6531da177e4SLinus Torvalds iph->frag_off = htons(IP_MF); 6541da177e4SLinus Torvalds ip_send_check(iph); 6551da177e4SLinus Torvalds 6561da177e4SLinus Torvalds for (;;) { 6571da177e4SLinus Torvalds /* Prepare header of the next frame, 6581da177e4SLinus Torvalds * before previous one went down. */ 6591da177e4SLinus Torvalds if (frag) { 6601da177e4SLinus Torvalds frag->ip_summed = CHECKSUM_NONE; 661badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(frag); 662e2d1bca7SArnaldo Carvalho de Melo __skb_push(frag, hlen); 663e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(frag); 664d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(frag), iph, hlen); 665eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(frag); 6661da177e4SLinus Torvalds iph->tot_len = htons(frag->len); 6671da177e4SLinus Torvalds ip_copy_metadata(frag, skb); 6681da177e4SLinus Torvalds if (offset == 0) 6691da177e4SLinus Torvalds ip_options_fragment(frag); 6701da177e4SLinus Torvalds offset += skb->len - hlen; 6711da177e4SLinus Torvalds iph->frag_off = htons(offset>>3); 67200db4124SIan Morris if (frag->next) 6731da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 6741da177e4SLinus Torvalds /* Ready, complete checksum */ 6751da177e4SLinus Torvalds ip_send_check(iph); 6761da177e4SLinus Torvalds } 6771da177e4SLinus Torvalds 678694869b3SEric W. Biederman err = output(net, sk, skb); 6791da177e4SLinus Torvalds 680dafee490SWei Dong if (!err) 68126a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 6821da177e4SLinus Torvalds if (err || !frag) 6831da177e4SLinus Torvalds break; 6841da177e4SLinus Torvalds 6851da177e4SLinus Torvalds skb = frag; 6861da177e4SLinus Torvalds frag = skb->next; 687a8305bffSDavid S. Miller skb_mark_not_on_list(skb); 6881da177e4SLinus Torvalds } 6891da177e4SLinus Torvalds 6901da177e4SLinus Torvalds if (err == 0) { 69126a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 6921da177e4SLinus Torvalds return 0; 6931da177e4SLinus Torvalds } 6941da177e4SLinus Torvalds 695942f146aSPablo Neira Ayuso kfree_skb_list(frag); 696942f146aSPablo Neira Ayuso 69726a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 6981da177e4SLinus Torvalds return err; 6993d13008eSEric Dumazet 7003d13008eSEric Dumazet slow_path_clean: 7013d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 7023d13008eSEric Dumazet if (frag2 == frag) 7033d13008eSEric Dumazet break; 7043d13008eSEric Dumazet frag2->sk = NULL; 7053d13008eSEric Dumazet frag2->destructor = NULL; 7063d13008eSEric Dumazet skb->truesize += frag2->truesize; 7073d13008eSEric Dumazet } 7081da177e4SLinus Torvalds } 7091da177e4SLinus Torvalds 7101da177e4SLinus Torvalds slow_path: 711c9af6db4SPravin B Shelar iph = ip_hdr(skb); 712fc70fb64SAlexander Duyck 7131da177e4SLinus Torvalds left = skb->len - hlen; /* Space per frame */ 71449085bd7SGeorge Kadianakis ptr = hlen; /* Where to start from */ 7151da177e4SLinus Torvalds 7161da177e4SLinus Torvalds /* 7171da177e4SLinus Torvalds * Fragment the datagram. 7181da177e4SLinus Torvalds */ 7191da177e4SLinus Torvalds 7201da177e4SLinus Torvalds offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3; 7211da177e4SLinus Torvalds not_last_frag = iph->frag_off & htons(IP_MF); 7221da177e4SLinus Torvalds 7231da177e4SLinus Torvalds /* 7241da177e4SLinus Torvalds * Keep copying data until we run out. 7251da177e4SLinus Torvalds */ 7261da177e4SLinus Torvalds 7271da177e4SLinus Torvalds while (left > 0) { 7281da177e4SLinus Torvalds len = left; 7291da177e4SLinus Torvalds /* IF: it doesn't fit, use 'mtu' - the data space left */ 7301da177e4SLinus Torvalds if (len > mtu) 7311da177e4SLinus Torvalds len = mtu; 7321da177e4SLinus Torvalds /* IF: we are not sending up to and including the packet end 7331da177e4SLinus Torvalds then align the next start on an eight byte boundary */ 7341da177e4SLinus Torvalds if (len < left) { 7351da177e4SLinus Torvalds len &= ~7; 7361da177e4SLinus Torvalds } 7371da177e4SLinus Torvalds 738cbffccc9SJoe Perches /* Allocate buffer */ 739cbffccc9SJoe Perches skb2 = alloc_skb(len + hlen + ll_rs, GFP_ATOMIC); 740cbffccc9SJoe Perches if (!skb2) { 7411da177e4SLinus Torvalds err = -ENOMEM; 7421da177e4SLinus Torvalds goto fail; 7431da177e4SLinus Torvalds } 7441da177e4SLinus Torvalds 7451da177e4SLinus Torvalds /* 7461da177e4SLinus Torvalds * Set up data on packet 7471da177e4SLinus Torvalds */ 7481da177e4SLinus Torvalds 7491da177e4SLinus Torvalds ip_copy_metadata(skb2, skb); 7501da177e4SLinus Torvalds skb_reserve(skb2, ll_rs); 7511da177e4SLinus Torvalds skb_put(skb2, len + hlen); 752c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb2); 753b0e380b1SArnaldo Carvalho de Melo skb2->transport_header = skb2->network_header + hlen; 7541da177e4SLinus Torvalds 7551da177e4SLinus Torvalds /* 7561da177e4SLinus Torvalds * Charge the memory for the fragment to any owner 7571da177e4SLinus Torvalds * it might possess 7581da177e4SLinus Torvalds */ 7591da177e4SLinus Torvalds 7601da177e4SLinus Torvalds if (skb->sk) 7611da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 7621da177e4SLinus Torvalds 7631da177e4SLinus Torvalds /* 7641da177e4SLinus Torvalds * Copy the packet header into the new buffer. 7651da177e4SLinus Torvalds */ 7661da177e4SLinus Torvalds 767d626f62bSArnaldo Carvalho de Melo skb_copy_from_linear_data(skb, skb_network_header(skb2), hlen); 7681da177e4SLinus Torvalds 7691da177e4SLinus Torvalds /* 7701da177e4SLinus Torvalds * Copy a block of the IP datagram. 7711da177e4SLinus Torvalds */ 772bff9b61cSArnaldo Carvalho de Melo if (skb_copy_bits(skb, ptr, skb_transport_header(skb2), len)) 7731da177e4SLinus Torvalds BUG(); 7741da177e4SLinus Torvalds left -= len; 7751da177e4SLinus Torvalds 7761da177e4SLinus Torvalds /* 7771da177e4SLinus Torvalds * Fill in the new header fields. 7781da177e4SLinus Torvalds */ 779eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb2); 7801da177e4SLinus Torvalds iph->frag_off = htons((offset >> 3)); 7811da177e4SLinus Torvalds 782d6b915e2SFlorian Westphal if (IPCB(skb)->flags & IPSKB_FRAG_PMTU) 783d6b915e2SFlorian Westphal iph->frag_off |= htons(IP_DF); 784d6b915e2SFlorian Westphal 7851da177e4SLinus Torvalds /* ANK: dirty, but effective trick. Upgrade options only if 7861da177e4SLinus Torvalds * the segment to be fragmented was THE FIRST (otherwise, 7871da177e4SLinus Torvalds * options are already fixed) and make it ONCE 7881da177e4SLinus Torvalds * on the initial skb, so that all the following fragments 7891da177e4SLinus Torvalds * will inherit fixed options. 7901da177e4SLinus Torvalds */ 7911da177e4SLinus Torvalds if (offset == 0) 7921da177e4SLinus Torvalds ip_options_fragment(skb); 7931da177e4SLinus Torvalds 7941da177e4SLinus Torvalds /* 7951da177e4SLinus Torvalds * Added AC : If we are fragmenting a fragment that's not the 7961da177e4SLinus Torvalds * last fragment then keep MF on each bit 7971da177e4SLinus Torvalds */ 7981da177e4SLinus Torvalds if (left > 0 || not_last_frag) 7991da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 8001da177e4SLinus Torvalds ptr += len; 8011da177e4SLinus Torvalds offset += len; 8021da177e4SLinus Torvalds 8031da177e4SLinus Torvalds /* 8041da177e4SLinus Torvalds * Put this fragment into the sending queue. 8051da177e4SLinus Torvalds */ 8061da177e4SLinus Torvalds iph->tot_len = htons(len + hlen); 8071da177e4SLinus Torvalds 8081da177e4SLinus Torvalds ip_send_check(iph); 8091da177e4SLinus Torvalds 810694869b3SEric W. Biederman err = output(net, sk, skb2); 8111da177e4SLinus Torvalds if (err) 8121da177e4SLinus Torvalds goto fail; 813dafee490SWei Dong 81426a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 8151da177e4SLinus Torvalds } 8165d0ba55bSEric Dumazet consume_skb(skb); 81726a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 8181da177e4SLinus Torvalds return err; 8191da177e4SLinus Torvalds 8201da177e4SLinus Torvalds fail: 8211da177e4SLinus Torvalds kfree_skb(skb); 82226a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 8231da177e4SLinus Torvalds return err; 8241da177e4SLinus Torvalds } 82549d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment); 8262e2f7aefSPatrick McHardy 8271da177e4SLinus Torvalds int 8281da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb) 8291da177e4SLinus Torvalds { 830f69e6d13SAl Viro struct msghdr *msg = from; 8311da177e4SLinus Torvalds 83284fa7933SPatrick McHardy if (skb->ip_summed == CHECKSUM_PARTIAL) { 8330b62fca2SAl Viro if (!copy_from_iter_full(to, len, &msg->msg_iter)) 8341da177e4SLinus Torvalds return -EFAULT; 8351da177e4SLinus Torvalds } else { 83644bb9363SAl Viro __wsum csum = 0; 8370b62fca2SAl Viro if (!csum_and_copy_from_iter_full(to, len, &csum, &msg->msg_iter)) 8381da177e4SLinus Torvalds return -EFAULT; 8391da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 8401da177e4SLinus Torvalds } 8411da177e4SLinus Torvalds return 0; 8421da177e4SLinus Torvalds } 8434bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag); 8441da177e4SLinus Torvalds 84544bb9363SAl Viro static inline __wsum 8461da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy) 8471da177e4SLinus Torvalds { 8481da177e4SLinus Torvalds char *kaddr; 84944bb9363SAl Viro __wsum csum; 8501da177e4SLinus Torvalds kaddr = kmap(page); 8511da177e4SLinus Torvalds csum = csum_partial(kaddr + offset, copy, 0); 8521da177e4SLinus Torvalds kunmap(page); 8531da177e4SLinus Torvalds return csum; 8541da177e4SLinus Torvalds } 8551da177e4SLinus Torvalds 856f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk, 857f5fca608SDavid S. Miller struct flowi4 *fl4, 858f5fca608SDavid S. Miller struct sk_buff_head *queue, 8591470ddf7SHerbert Xu struct inet_cork *cork, 8605640f768SEric Dumazet struct page_frag *pfrag, 8611470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, 8621470ddf7SHerbert Xu int len, int odd, struct sk_buff *skb), 8631da177e4SLinus Torvalds void *from, int length, int transhdrlen, 8641da177e4SLinus Torvalds unsigned int flags) 8651da177e4SLinus Torvalds { 8661da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 867b5947e5dSWillem de Bruijn struct ubuf_info *uarg = NULL; 8681da177e4SLinus Torvalds struct sk_buff *skb; 8691da177e4SLinus Torvalds 87007df5294SHerbert Xu struct ip_options *opt = cork->opt; 8711da177e4SLinus Torvalds int hh_len; 8721da177e4SLinus Torvalds int exthdrlen; 8731da177e4SLinus Torvalds int mtu; 8741da177e4SLinus Torvalds int copy; 8751da177e4SLinus Torvalds int err; 8761da177e4SLinus Torvalds int offset = 0; 877daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, maxnonfragsize; 8781da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 8791470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 880694aba69SEric Dumazet unsigned int wmem_alloc_delta = 0; 88152900d22SWillem de Bruijn bool paged, extra_uref; 88209c2d251SWillem de Bruijn u32 tskey = 0; 8831da177e4SLinus Torvalds 88496d7303eSSteffen Klassert skb = skb_peek_tail(queue); 88596d7303eSSteffen Klassert 88696d7303eSSteffen Klassert exthdrlen = !skb ? rt->dst.header_len : 0; 887bec1f6f6SWillem de Bruijn mtu = cork->gso_size ? IP_MAX_MTU : cork->fragsize; 88815e36f5bSWillem de Bruijn paged = !!cork->gso_size; 889bec1f6f6SWillem de Bruijn 89009c2d251SWillem de Bruijn if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP && 89109c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 89209c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 8931470ddf7SHerbert Xu 894d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 8951da177e4SLinus Torvalds 8961da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 8971da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 89860ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 8991da177e4SLinus Torvalds 900daba287bSHannes Frederic Sowa if (cork->length + length > maxnonfragsize - fragheaderlen) { 901f5fca608SDavid S. Miller ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 90261e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 9031da177e4SLinus Torvalds return -EMSGSIZE; 9041da177e4SLinus Torvalds } 9051da177e4SLinus Torvalds 9061da177e4SLinus Torvalds /* 9071da177e4SLinus Torvalds * transhdrlen > 0 means that this is the first fragment and we wish 9081da177e4SLinus Torvalds * it won't be fragmented in the future. 9091da177e4SLinus Torvalds */ 9101da177e4SLinus Torvalds if (transhdrlen && 9111da177e4SLinus Torvalds length + fragheaderlen <= mtu && 912c8cd0989STom Herbert rt->dst.dev->features & (NETIF_F_HW_CSUM | NETIF_F_IP_CSUM) && 913bec1f6f6SWillem de Bruijn (!(flags & MSG_MORE) || cork->gso_size) && 914cd027a54SJacek Kalwas (!exthdrlen || (rt->dst.dev->features & NETIF_F_HW_ESP_TX_CSUM))) 91584fa7933SPatrick McHardy csummode = CHECKSUM_PARTIAL; 9161da177e4SLinus Torvalds 917b5947e5dSWillem de Bruijn if (flags & MSG_ZEROCOPY && length && sock_flag(sk, SOCK_ZEROCOPY)) { 918b5947e5dSWillem de Bruijn uarg = sock_zerocopy_realloc(sk, length, skb_zcopy(skb)); 919b5947e5dSWillem de Bruijn if (!uarg) 920b5947e5dSWillem de Bruijn return -ENOBUFS; 92152900d22SWillem de Bruijn extra_uref = true; 922b5947e5dSWillem de Bruijn if (rt->dst.dev->features & NETIF_F_SG && 923b5947e5dSWillem de Bruijn csummode == CHECKSUM_PARTIAL) { 924b5947e5dSWillem de Bruijn paged = true; 925b5947e5dSWillem de Bruijn } else { 926b5947e5dSWillem de Bruijn uarg->zerocopy = 0; 92752900d22SWillem de Bruijn skb_zcopy_set(skb, uarg, &extra_uref); 928b5947e5dSWillem de Bruijn } 929b5947e5dSWillem de Bruijn } 930b5947e5dSWillem de Bruijn 9311470ddf7SHerbert Xu cork->length += length; 9321da177e4SLinus Torvalds 9331da177e4SLinus Torvalds /* So, what's going on in the loop below? 9341da177e4SLinus Torvalds * 9351da177e4SLinus Torvalds * We use calculated fragment length to generate chained skb, 9361da177e4SLinus Torvalds * each of segments is IP fragment ready for sending to network after 9371da177e4SLinus Torvalds * adding appropriate IP header. 9381da177e4SLinus Torvalds */ 9391da177e4SLinus Torvalds 94026cde9f7SHerbert Xu if (!skb) 9411da177e4SLinus Torvalds goto alloc_new_skb; 9421da177e4SLinus Torvalds 9431da177e4SLinus Torvalds while (length > 0) { 9441da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 9451da177e4SLinus Torvalds copy = mtu - skb->len; 9461da177e4SLinus Torvalds if (copy < length) 9471da177e4SLinus Torvalds copy = maxfraglen - skb->len; 9481da177e4SLinus Torvalds if (copy <= 0) { 9491da177e4SLinus Torvalds char *data; 9501da177e4SLinus Torvalds unsigned int datalen; 9511da177e4SLinus Torvalds unsigned int fraglen; 9521da177e4SLinus Torvalds unsigned int fraggap; 9531da177e4SLinus Torvalds unsigned int alloclen; 954aba36930SWillem de Bruijn unsigned int pagedlen; 9551da177e4SLinus Torvalds struct sk_buff *skb_prev; 9561da177e4SLinus Torvalds alloc_new_skb: 9571da177e4SLinus Torvalds skb_prev = skb; 9581da177e4SLinus Torvalds if (skb_prev) 9591da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 9601da177e4SLinus Torvalds else 9611da177e4SLinus Torvalds fraggap = 0; 9621da177e4SLinus Torvalds 9631da177e4SLinus Torvalds /* 9641da177e4SLinus Torvalds * If remaining data exceeds the mtu, 9651da177e4SLinus Torvalds * we know we need more fragment(s). 9661da177e4SLinus Torvalds */ 9671da177e4SLinus Torvalds datalen = length + fraggap; 9681da177e4SLinus Torvalds if (datalen > mtu - fragheaderlen) 9691da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 9701da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 971aba36930SWillem de Bruijn pagedlen = 0; 9721da177e4SLinus Torvalds 9731da177e4SLinus Torvalds if ((flags & MSG_MORE) && 974d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 9751da177e4SLinus Torvalds alloclen = mtu; 97615e36f5bSWillem de Bruijn else if (!paged) 97759104f06SEric Dumazet alloclen = fraglen; 97815e36f5bSWillem de Bruijn else { 97915e36f5bSWillem de Bruijn alloclen = min_t(int, fraglen, MAX_HEADER); 98015e36f5bSWillem de Bruijn pagedlen = fraglen - alloclen; 98115e36f5bSWillem de Bruijn } 9821da177e4SLinus Torvalds 983353e5c9aSSteffen Klassert alloclen += exthdrlen; 984353e5c9aSSteffen Klassert 9851da177e4SLinus Torvalds /* The last fragment gets additional space at tail. 9861da177e4SLinus Torvalds * Note, with MSG_MORE we overallocate on fragments, 9871da177e4SLinus Torvalds * because we have no idea what fragment will be 9881da177e4SLinus Torvalds * the last. 9891da177e4SLinus Torvalds */ 99033f99dc7SSteffen Klassert if (datalen == length + fraggap) 991d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 99233f99dc7SSteffen Klassert 9931da177e4SLinus Torvalds if (transhdrlen) { 9941da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 9951da177e4SLinus Torvalds alloclen + hh_len + 15, 9961da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 9971da177e4SLinus Torvalds } else { 9981da177e4SLinus Torvalds skb = NULL; 999694aba69SEric Dumazet if (refcount_read(&sk->sk_wmem_alloc) + wmem_alloc_delta <= 10001da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 1001694aba69SEric Dumazet skb = alloc_skb(alloclen + hh_len + 15, 10021da177e4SLinus Torvalds sk->sk_allocation); 100351456b29SIan Morris if (unlikely(!skb)) 10041da177e4SLinus Torvalds err = -ENOBUFS; 10051da177e4SLinus Torvalds } 100651456b29SIan Morris if (!skb) 10071da177e4SLinus Torvalds goto error; 10081da177e4SLinus Torvalds 10091da177e4SLinus Torvalds /* 10101da177e4SLinus Torvalds * Fill in the control structures 10111da177e4SLinus Torvalds */ 10121da177e4SLinus Torvalds skb->ip_summed = csummode; 10131da177e4SLinus Torvalds skb->csum = 0; 10141da177e4SLinus Torvalds skb_reserve(skb, hh_len); 101511878b40SWillem de Bruijn 10161da177e4SLinus Torvalds /* 10171da177e4SLinus Torvalds * Find where to start putting bytes. 10181da177e4SLinus Torvalds */ 101915e36f5bSWillem de Bruijn data = skb_put(skb, fraglen + exthdrlen - pagedlen); 1020c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 1021b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1022b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 1023353e5c9aSSteffen Klassert data += fragheaderlen + exthdrlen; 10241da177e4SLinus Torvalds 10251da177e4SLinus Torvalds if (fraggap) { 10261da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 10271da177e4SLinus Torvalds skb_prev, maxfraglen, 10281da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 10291da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 10301da177e4SLinus Torvalds skb->csum); 10311da177e4SLinus Torvalds data += fraggap; 1032e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 10331da177e4SLinus Torvalds } 10341da177e4SLinus Torvalds 103515e36f5bSWillem de Bruijn copy = datalen - transhdrlen - fraggap - pagedlen; 10361da177e4SLinus Torvalds if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 10371da177e4SLinus Torvalds err = -EFAULT; 10381da177e4SLinus Torvalds kfree_skb(skb); 10391da177e4SLinus Torvalds goto error; 10401da177e4SLinus Torvalds } 10411da177e4SLinus Torvalds 10421da177e4SLinus Torvalds offset += copy; 104315e36f5bSWillem de Bruijn length -= copy + transhdrlen; 10441da177e4SLinus Torvalds transhdrlen = 0; 10451da177e4SLinus Torvalds exthdrlen = 0; 10461da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 10471da177e4SLinus Torvalds 104852900d22SWillem de Bruijn /* only the initial fragment is time stamped */ 104952900d22SWillem de Bruijn skb_shinfo(skb)->tx_flags = cork->tx_flags; 105052900d22SWillem de Bruijn cork->tx_flags = 0; 105152900d22SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 105252900d22SWillem de Bruijn tskey = 0; 105352900d22SWillem de Bruijn skb_zcopy_set(skb, uarg, &extra_uref); 105452900d22SWillem de Bruijn 10550dec879fSJulian Anastasov if ((flags & MSG_CONFIRM) && !skb_prev) 10560dec879fSJulian Anastasov skb_set_dst_pending_confirm(skb, 1); 10570dec879fSJulian Anastasov 10581da177e4SLinus Torvalds /* 10591da177e4SLinus Torvalds * Put the packet on the pending queue. 10601da177e4SLinus Torvalds */ 1061694aba69SEric Dumazet if (!skb->destructor) { 1062694aba69SEric Dumazet skb->destructor = sock_wfree; 1063694aba69SEric Dumazet skb->sk = sk; 1064694aba69SEric Dumazet wmem_alloc_delta += skb->truesize; 1065694aba69SEric Dumazet } 10661470ddf7SHerbert Xu __skb_queue_tail(queue, skb); 10671da177e4SLinus Torvalds continue; 10681da177e4SLinus Torvalds } 10691da177e4SLinus Torvalds 10701da177e4SLinus Torvalds if (copy > length) 10711da177e4SLinus Torvalds copy = length; 10721da177e4SLinus Torvalds 1073113f99c3SWillem de Bruijn if (!(rt->dst.dev->features&NETIF_F_SG) && 1074113f99c3SWillem de Bruijn skb_tailroom(skb) >= copy) { 10751da177e4SLinus Torvalds unsigned int off; 10761da177e4SLinus Torvalds 10771da177e4SLinus Torvalds off = skb->len; 10781da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 10791da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 10801da177e4SLinus Torvalds __skb_trim(skb, off); 10811da177e4SLinus Torvalds err = -EFAULT; 10821da177e4SLinus Torvalds goto error; 10831da177e4SLinus Torvalds } 1084b5947e5dSWillem de Bruijn } else if (!uarg || !uarg->zerocopy) { 10851da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 10861da177e4SLinus Torvalds 10871da177e4SLinus Torvalds err = -ENOMEM; 10885640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 10891da177e4SLinus Torvalds goto error; 10901da177e4SLinus Torvalds 10915640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 10925640f768SEric Dumazet pfrag->offset)) { 10931da177e4SLinus Torvalds err = -EMSGSIZE; 10945640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 10951da177e4SLinus Torvalds goto error; 10965640f768SEric Dumazet 10975640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 10985640f768SEric Dumazet pfrag->offset, 0); 10995640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 11005640f768SEric Dumazet get_page(pfrag->page); 11011da177e4SLinus Torvalds } 11025640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 11035640f768SEric Dumazet if (getfrag(from, 11045640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 11055640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 11065640f768SEric Dumazet goto error_efault; 11075640f768SEric Dumazet 11085640f768SEric Dumazet pfrag->offset += copy; 11095640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 11101da177e4SLinus Torvalds skb->len += copy; 11111da177e4SLinus Torvalds skb->data_len += copy; 1112f945fa7aSHerbert Xu skb->truesize += copy; 1113694aba69SEric Dumazet wmem_alloc_delta += copy; 1114b5947e5dSWillem de Bruijn } else { 1115b5947e5dSWillem de Bruijn err = skb_zerocopy_iter_dgram(skb, from, copy); 1116b5947e5dSWillem de Bruijn if (err < 0) 1117b5947e5dSWillem de Bruijn goto error; 11181da177e4SLinus Torvalds } 11191da177e4SLinus Torvalds offset += copy; 11201da177e4SLinus Torvalds length -= copy; 11211da177e4SLinus Torvalds } 11221da177e4SLinus Torvalds 11239e8445a5SPaolo Abeni if (wmem_alloc_delta) 1124694aba69SEric Dumazet refcount_add(wmem_alloc_delta, &sk->sk_wmem_alloc); 11251da177e4SLinus Torvalds return 0; 11261da177e4SLinus Torvalds 11275640f768SEric Dumazet error_efault: 11285640f768SEric Dumazet err = -EFAULT; 11291da177e4SLinus Torvalds error: 113097ef7b4cSWillem de Bruijn if (uarg) 113152900d22SWillem de Bruijn sock_zerocopy_put_abort(uarg, extra_uref); 11321470ddf7SHerbert Xu cork->length -= length; 11335e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 1134694aba69SEric Dumazet refcount_add(wmem_alloc_delta, &sk->sk_wmem_alloc); 11351da177e4SLinus Torvalds return err; 11361da177e4SLinus Torvalds } 11371da177e4SLinus Torvalds 11381470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork, 11391470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp) 11401470ddf7SHerbert Xu { 1141f6d8bd05SEric Dumazet struct ip_options_rcu *opt; 11421470ddf7SHerbert Xu struct rtable *rt; 11431470ddf7SHerbert Xu 11449783ccd0SGao Feng rt = *rtp; 11459783ccd0SGao Feng if (unlikely(!rt)) 11469783ccd0SGao Feng return -EFAULT; 11479783ccd0SGao Feng 11481470ddf7SHerbert Xu /* 11491470ddf7SHerbert Xu * setup for corking. 11501470ddf7SHerbert Xu */ 11511470ddf7SHerbert Xu opt = ipc->opt; 11521470ddf7SHerbert Xu if (opt) { 115351456b29SIan Morris if (!cork->opt) { 11541470ddf7SHerbert Xu cork->opt = kmalloc(sizeof(struct ip_options) + 40, 11551470ddf7SHerbert Xu sk->sk_allocation); 115651456b29SIan Morris if (unlikely(!cork->opt)) 11571470ddf7SHerbert Xu return -ENOBUFS; 11581470ddf7SHerbert Xu } 1159f6d8bd05SEric Dumazet memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen); 11601470ddf7SHerbert Xu cork->flags |= IPCORK_OPT; 11611470ddf7SHerbert Xu cork->addr = ipc->addr; 11621470ddf7SHerbert Xu } 11639783ccd0SGao Feng 11641470ddf7SHerbert Xu /* 11651470ddf7SHerbert Xu * We steal reference to this route, caller should not release it 11661470ddf7SHerbert Xu */ 11671470ddf7SHerbert Xu *rtp = NULL; 1168482fc609SHannes Frederic Sowa cork->fragsize = ip_sk_use_pmtu(sk) ? 1169482fc609SHannes Frederic Sowa dst_mtu(&rt->dst) : rt->dst.dev->mtu; 1170bec1f6f6SWillem de Bruijn 1171fbf47813SWillem de Bruijn cork->gso_size = ipc->gso_size; 11721470ddf7SHerbert Xu cork->dst = &rt->dst; 11731470ddf7SHerbert Xu cork->length = 0; 1174aa661581SFrancesco Fusco cork->ttl = ipc->ttl; 1175aa661581SFrancesco Fusco cork->tos = ipc->tos; 1176aa661581SFrancesco Fusco cork->priority = ipc->priority; 1177bc969a97SJesus Sanchez-Palencia cork->transmit_time = ipc->sockc.transmit_time; 1178678ca42dSWillem de Bruijn cork->tx_flags = 0; 1179678ca42dSWillem de Bruijn sock_tx_timestamp(sk, ipc->sockc.tsflags, &cork->tx_flags); 11801470ddf7SHerbert Xu 11811470ddf7SHerbert Xu return 0; 11821470ddf7SHerbert Xu } 11831470ddf7SHerbert Xu 11841470ddf7SHerbert Xu /* 11851470ddf7SHerbert Xu * ip_append_data() and ip_append_page() can make one large IP datagram 11861470ddf7SHerbert Xu * from many pieces of data. Each pieces will be holded on the socket 11871470ddf7SHerbert Xu * until ip_push_pending_frames() is called. Each piece can be a page 11881470ddf7SHerbert Xu * or non-page data. 11891470ddf7SHerbert Xu * 11901470ddf7SHerbert Xu * Not only UDP, other transport protocols - e.g. raw sockets - can use 11911470ddf7SHerbert Xu * this interface potentially. 11921470ddf7SHerbert Xu * 11931470ddf7SHerbert Xu * LATER: length must be adjusted by pad at tail, when it is required. 11941470ddf7SHerbert Xu */ 1195f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4, 11961470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, int len, 11971470ddf7SHerbert Xu int odd, struct sk_buff *skb), 11981470ddf7SHerbert Xu void *from, int length, int transhdrlen, 11991470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 12001470ddf7SHerbert Xu unsigned int flags) 12011470ddf7SHerbert Xu { 12021470ddf7SHerbert Xu struct inet_sock *inet = inet_sk(sk); 12031470ddf7SHerbert Xu int err; 12041470ddf7SHerbert Xu 12051470ddf7SHerbert Xu if (flags&MSG_PROBE) 12061470ddf7SHerbert Xu return 0; 12071470ddf7SHerbert Xu 12081470ddf7SHerbert Xu if (skb_queue_empty(&sk->sk_write_queue)) { 1209bdc712b4SDavid S. Miller err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp); 12101470ddf7SHerbert Xu if (err) 12111470ddf7SHerbert Xu return err; 12121470ddf7SHerbert Xu } else { 12131470ddf7SHerbert Xu transhdrlen = 0; 12141470ddf7SHerbert Xu } 12151470ddf7SHerbert Xu 12165640f768SEric Dumazet return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base, 12175640f768SEric Dumazet sk_page_frag(sk), getfrag, 12181470ddf7SHerbert Xu from, length, transhdrlen, flags); 12191470ddf7SHerbert Xu } 12201470ddf7SHerbert Xu 1221f5fca608SDavid S. Miller ssize_t ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page, 12221da177e4SLinus Torvalds int offset, size_t size, int flags) 12231da177e4SLinus Torvalds { 12241da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 12251da177e4SLinus Torvalds struct sk_buff *skb; 12261da177e4SLinus Torvalds struct rtable *rt; 12271da177e4SLinus Torvalds struct ip_options *opt = NULL; 1228bdc712b4SDavid S. Miller struct inet_cork *cork; 12291da177e4SLinus Torvalds int hh_len; 12301da177e4SLinus Torvalds int mtu; 12311da177e4SLinus Torvalds int len; 12321da177e4SLinus Torvalds int err; 1233daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize; 12341da177e4SLinus Torvalds 12351da177e4SLinus Torvalds if (inet->hdrincl) 12361da177e4SLinus Torvalds return -EPERM; 12371da177e4SLinus Torvalds 12381da177e4SLinus Torvalds if (flags&MSG_PROBE) 12391da177e4SLinus Torvalds return 0; 12401da177e4SLinus Torvalds 12411da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) 12421da177e4SLinus Torvalds return -EINVAL; 12431da177e4SLinus Torvalds 1244bdc712b4SDavid S. Miller cork = &inet->cork.base; 1245bdc712b4SDavid S. Miller rt = (struct rtable *)cork->dst; 1246bdc712b4SDavid S. Miller if (cork->flags & IPCORK_OPT) 1247bdc712b4SDavid S. Miller opt = cork->opt; 12481da177e4SLinus Torvalds 1249d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) 12501da177e4SLinus Torvalds return -EOPNOTSUPP; 12511da177e4SLinus Torvalds 1252d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 1253bec1f6f6SWillem de Bruijn mtu = cork->gso_size ? IP_MAX_MTU : cork->fragsize; 12541da177e4SLinus Torvalds 12551da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 12561da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 125760ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 12581da177e4SLinus Torvalds 1259daba287bSHannes Frederic Sowa if (cork->length + size > maxnonfragsize - fragheaderlen) { 126061e7f09dSHannes Frederic Sowa ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 126161e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 12621da177e4SLinus Torvalds return -EMSGSIZE; 12631da177e4SLinus Torvalds } 12641da177e4SLinus Torvalds 126551456b29SIan Morris skb = skb_peek_tail(&sk->sk_write_queue); 126651456b29SIan Morris if (!skb) 12671da177e4SLinus Torvalds return -EINVAL; 12681da177e4SLinus Torvalds 1269a8c4a252SHannes Frederic Sowa cork->length += size; 1270e89e9cf5SAnanda Raju 12711da177e4SLinus Torvalds while (size > 0) { 12721da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 12731da177e4SLinus Torvalds len = mtu - skb->len; 12741da177e4SLinus Torvalds if (len < size) 12751da177e4SLinus Torvalds len = maxfraglen - skb->len; 1276ab2fb7e3SWillem de Bruijn 12771da177e4SLinus Torvalds if (len <= 0) { 12781da177e4SLinus Torvalds struct sk_buff *skb_prev; 12791da177e4SLinus Torvalds int alloclen; 12801da177e4SLinus Torvalds 12811da177e4SLinus Torvalds skb_prev = skb; 12821da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 12831da177e4SLinus Torvalds 12841da177e4SLinus Torvalds alloclen = fragheaderlen + hh_len + fraggap + 15; 12851da177e4SLinus Torvalds skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation); 12861da177e4SLinus Torvalds if (unlikely(!skb)) { 12871da177e4SLinus Torvalds err = -ENOBUFS; 12881da177e4SLinus Torvalds goto error; 12891da177e4SLinus Torvalds } 12901da177e4SLinus Torvalds 12911da177e4SLinus Torvalds /* 12921da177e4SLinus Torvalds * Fill in the control structures 12931da177e4SLinus Torvalds */ 12941da177e4SLinus Torvalds skb->ip_summed = CHECKSUM_NONE; 12951da177e4SLinus Torvalds skb->csum = 0; 12961da177e4SLinus Torvalds skb_reserve(skb, hh_len); 12971da177e4SLinus Torvalds 12981da177e4SLinus Torvalds /* 12991da177e4SLinus Torvalds * Find where to start putting bytes. 13001da177e4SLinus Torvalds */ 1301967b05f6SArnaldo Carvalho de Melo skb_put(skb, fragheaderlen + fraggap); 13022ca9e6f2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1303b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1304b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 13051da177e4SLinus Torvalds if (fraggap) { 1306967b05f6SArnaldo Carvalho de Melo skb->csum = skb_copy_and_csum_bits(skb_prev, 1307967b05f6SArnaldo Carvalho de Melo maxfraglen, 13089c70220bSArnaldo Carvalho de Melo skb_transport_header(skb), 1309967b05f6SArnaldo Carvalho de Melo fraggap, 0); 13101da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 13111da177e4SLinus Torvalds skb->csum); 1312e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 13131da177e4SLinus Torvalds } 13141da177e4SLinus Torvalds 13151da177e4SLinus Torvalds /* 13161da177e4SLinus Torvalds * Put the packet on the pending queue. 13171da177e4SLinus Torvalds */ 13181da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 13191da177e4SLinus Torvalds continue; 13201da177e4SLinus Torvalds } 13211da177e4SLinus Torvalds 13221da177e4SLinus Torvalds if (len > size) 13231da177e4SLinus Torvalds len = size; 1324be12a1feSHannes Frederic Sowa 1325be12a1feSHannes Frederic Sowa if (skb_append_pagefrags(skb, page, offset, len)) { 13261da177e4SLinus Torvalds err = -EMSGSIZE; 13271da177e4SLinus Torvalds goto error; 13281da177e4SLinus Torvalds } 13291da177e4SLinus Torvalds 13301da177e4SLinus Torvalds if (skb->ip_summed == CHECKSUM_NONE) { 133144bb9363SAl Viro __wsum csum; 13321da177e4SLinus Torvalds csum = csum_page(page, offset, len); 13331da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, skb->len); 13341da177e4SLinus Torvalds } 13351da177e4SLinus Torvalds 13361da177e4SLinus Torvalds skb->len += len; 13371da177e4SLinus Torvalds skb->data_len += len; 13381e34a11dSDavid S. Miller skb->truesize += len; 133914afee4bSReshetova, Elena refcount_add(len, &sk->sk_wmem_alloc); 13401da177e4SLinus Torvalds offset += len; 13411da177e4SLinus Torvalds size -= len; 13421da177e4SLinus Torvalds } 13431da177e4SLinus Torvalds return 0; 13441da177e4SLinus Torvalds 13451da177e4SLinus Torvalds error: 1346bdc712b4SDavid S. Miller cork->length -= size; 13475e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 13481da177e4SLinus Torvalds return err; 13491da177e4SLinus Torvalds } 13501da177e4SLinus Torvalds 13511470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork) 1352429f08e9SPavel Emelyanov { 13531470ddf7SHerbert Xu cork->flags &= ~IPCORK_OPT; 13541470ddf7SHerbert Xu kfree(cork->opt); 13551470ddf7SHerbert Xu cork->opt = NULL; 13561470ddf7SHerbert Xu dst_release(cork->dst); 13571470ddf7SHerbert Xu cork->dst = NULL; 1358429f08e9SPavel Emelyanov } 1359429f08e9SPavel Emelyanov 13601da177e4SLinus Torvalds /* 13611da177e4SLinus Torvalds * Combined all pending IP fragments on the socket as one IP datagram 13621da177e4SLinus Torvalds * and push them out. 13631da177e4SLinus Torvalds */ 13641c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk, 136577968b78SDavid S. Miller struct flowi4 *fl4, 13661470ddf7SHerbert Xu struct sk_buff_head *queue, 13671470ddf7SHerbert Xu struct inet_cork *cork) 13681da177e4SLinus Torvalds { 13691da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 13701da177e4SLinus Torvalds struct sk_buff **tail_skb; 13711da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 13720388b004SPavel Emelyanov struct net *net = sock_net(sk); 13731da177e4SLinus Torvalds struct ip_options *opt = NULL; 13741470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 13751da177e4SLinus Torvalds struct iphdr *iph; 137676ab608dSAlexey Dobriyan __be16 df = 0; 13771da177e4SLinus Torvalds __u8 ttl; 13781da177e4SLinus Torvalds 137951456b29SIan Morris skb = __skb_dequeue(queue); 138051456b29SIan Morris if (!skb) 13811da177e4SLinus Torvalds goto out; 13821da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 13831da177e4SLinus Torvalds 13841da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1385d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1386bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 13871470ddf7SHerbert Xu while ((tmp_skb = __skb_dequeue(queue)) != NULL) { 1388cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 13891da177e4SLinus Torvalds *tail_skb = tmp_skb; 13901da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 13911da177e4SLinus Torvalds skb->len += tmp_skb->len; 13921da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 13931da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 13941da177e4SLinus Torvalds tmp_skb->destructor = NULL; 13951da177e4SLinus Torvalds tmp_skb->sk = NULL; 13961da177e4SLinus Torvalds } 13971da177e4SLinus Torvalds 13981da177e4SLinus Torvalds /* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow 13991da177e4SLinus Torvalds * to fragment the frame generated here. No matter, what transforms 14001da177e4SLinus Torvalds * how transforms change size of the packet, it will come out. 14011da177e4SLinus Torvalds */ 140260ff7467SWANG Cong skb->ignore_df = ip_sk_ignore_df(sk); 14031da177e4SLinus Torvalds 14041da177e4SLinus Torvalds /* DF bit is set when we want to see DF on outgoing frames. 140560ff7467SWANG Cong * If ignore_df is set too, we still allow to fragment this frame 14061da177e4SLinus Torvalds * locally. */ 1407482fc609SHannes Frederic Sowa if (inet->pmtudisc == IP_PMTUDISC_DO || 1408482fc609SHannes Frederic Sowa inet->pmtudisc == IP_PMTUDISC_PROBE || 1409d8d1f30bSChangli Gao (skb->len <= dst_mtu(&rt->dst) && 1410d8d1f30bSChangli Gao ip_dont_fragment(sk, &rt->dst))) 14111da177e4SLinus Torvalds df = htons(IP_DF); 14121da177e4SLinus Torvalds 14131470ddf7SHerbert Xu if (cork->flags & IPCORK_OPT) 14141470ddf7SHerbert Xu opt = cork->opt; 14151da177e4SLinus Torvalds 1416aa661581SFrancesco Fusco if (cork->ttl != 0) 1417aa661581SFrancesco Fusco ttl = cork->ttl; 1418aa661581SFrancesco Fusco else if (rt->rt_type == RTN_MULTICAST) 14191da177e4SLinus Torvalds ttl = inet->mc_ttl; 14201da177e4SLinus Torvalds else 1421d8d1f30bSChangli Gao ttl = ip_select_ttl(inet, &rt->dst); 14221da177e4SLinus Torvalds 1423749154aaSAnsis Atteka iph = ip_hdr(skb); 14241da177e4SLinus Torvalds iph->version = 4; 14251da177e4SLinus Torvalds iph->ihl = 5; 1426aa661581SFrancesco Fusco iph->tos = (cork->tos != -1) ? cork->tos : inet->tos; 14271da177e4SLinus Torvalds iph->frag_off = df; 14281da177e4SLinus Torvalds iph->ttl = ttl; 14291da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 143084f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 1431b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, sk); 14321da177e4SLinus Torvalds 143322f728f8SDavid S. Miller if (opt) { 143422f728f8SDavid S. Miller iph->ihl += opt->optlen>>2; 143522f728f8SDavid S. Miller ip_options_build(skb, opt, cork->addr, rt, 0); 143622f728f8SDavid S. Miller } 143722f728f8SDavid S. Miller 1438aa661581SFrancesco Fusco skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority; 14394a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1440bc969a97SJesus Sanchez-Palencia skb->tstamp = cork->transmit_time; 1441a21bba94SEric Dumazet /* 1442a21bba94SEric Dumazet * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec 1443a21bba94SEric Dumazet * on dst refcount 1444a21bba94SEric Dumazet */ 14451470ddf7SHerbert Xu cork->dst = NULL; 1446d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 14471da177e4SLinus Torvalds 144896793b48SDavid L Stevens if (iph->protocol == IPPROTO_ICMP) 14490388b004SPavel Emelyanov icmp_out_count(net, ((struct icmphdr *) 145096793b48SDavid L Stevens skb_transport_header(skb))->type); 145196793b48SDavid L Stevens 14521c32c5adSHerbert Xu ip_cork_release(cork); 14531c32c5adSHerbert Xu out: 14541c32c5adSHerbert Xu return skb; 14551c32c5adSHerbert Xu } 14561c32c5adSHerbert Xu 1457b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb) 14581c32c5adSHerbert Xu { 14591c32c5adSHerbert Xu int err; 14601c32c5adSHerbert Xu 146133224b16SEric W. Biederman err = ip_local_out(net, skb->sk, skb); 14621da177e4SLinus Torvalds if (err) { 14631da177e4SLinus Torvalds if (err > 0) 14646ce9e7b5SEric Dumazet err = net_xmit_errno(err); 14651da177e4SLinus Torvalds if (err) 14661c32c5adSHerbert Xu IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS); 14671da177e4SLinus Torvalds } 14681da177e4SLinus Torvalds 14691da177e4SLinus Torvalds return err; 14701da177e4SLinus Torvalds } 14711da177e4SLinus Torvalds 147277968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4) 14731470ddf7SHerbert Xu { 14741c32c5adSHerbert Xu struct sk_buff *skb; 14751c32c5adSHerbert Xu 147677968b78SDavid S. Miller skb = ip_finish_skb(sk, fl4); 14771c32c5adSHerbert Xu if (!skb) 14781c32c5adSHerbert Xu return 0; 14791c32c5adSHerbert Xu 14801c32c5adSHerbert Xu /* Netfilter gets whole the not fragmented skb. */ 1481b5ec8eeaSEric Dumazet return ip_send_skb(sock_net(sk), skb); 14821470ddf7SHerbert Xu } 14831470ddf7SHerbert Xu 14841da177e4SLinus Torvalds /* 14851da177e4SLinus Torvalds * Throw away all pending data on the socket. 14861da177e4SLinus Torvalds */ 14871470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk, 14881470ddf7SHerbert Xu struct sk_buff_head *queue, 14891470ddf7SHerbert Xu struct inet_cork *cork) 14901da177e4SLinus Torvalds { 14911da177e4SLinus Torvalds struct sk_buff *skb; 14921da177e4SLinus Torvalds 14931470ddf7SHerbert Xu while ((skb = __skb_dequeue_tail(queue)) != NULL) 14941da177e4SLinus Torvalds kfree_skb(skb); 14951da177e4SLinus Torvalds 14961470ddf7SHerbert Xu ip_cork_release(cork); 14971470ddf7SHerbert Xu } 14981470ddf7SHerbert Xu 14991470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk) 15001470ddf7SHerbert Xu { 1501bdc712b4SDavid S. Miller __ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base); 15021da177e4SLinus Torvalds } 15031da177e4SLinus Torvalds 15041c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk, 150577968b78SDavid S. Miller struct flowi4 *fl4, 15061c32c5adSHerbert Xu int getfrag(void *from, char *to, int offset, 15071c32c5adSHerbert Xu int len, int odd, struct sk_buff *skb), 15081c32c5adSHerbert Xu void *from, int length, int transhdrlen, 15091c32c5adSHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 15101cd7884dSWillem de Bruijn struct inet_cork *cork, unsigned int flags) 15111c32c5adSHerbert Xu { 15121c32c5adSHerbert Xu struct sk_buff_head queue; 15131c32c5adSHerbert Xu int err; 15141c32c5adSHerbert Xu 15151c32c5adSHerbert Xu if (flags & MSG_PROBE) 15161c32c5adSHerbert Xu return NULL; 15171c32c5adSHerbert Xu 15181c32c5adSHerbert Xu __skb_queue_head_init(&queue); 15191c32c5adSHerbert Xu 15201cd7884dSWillem de Bruijn cork->flags = 0; 15211cd7884dSWillem de Bruijn cork->addr = 0; 15221cd7884dSWillem de Bruijn cork->opt = NULL; 15231cd7884dSWillem de Bruijn err = ip_setup_cork(sk, cork, ipc, rtp); 15241c32c5adSHerbert Xu if (err) 15251c32c5adSHerbert Xu return ERR_PTR(err); 15261c32c5adSHerbert Xu 15271cd7884dSWillem de Bruijn err = __ip_append_data(sk, fl4, &queue, cork, 15285640f768SEric Dumazet ¤t->task_frag, getfrag, 15291c32c5adSHerbert Xu from, length, transhdrlen, flags); 15301c32c5adSHerbert Xu if (err) { 15311cd7884dSWillem de Bruijn __ip_flush_pending_frames(sk, &queue, cork); 15321c32c5adSHerbert Xu return ERR_PTR(err); 15331c32c5adSHerbert Xu } 15341c32c5adSHerbert Xu 15351cd7884dSWillem de Bruijn return __ip_make_skb(sk, fl4, &queue, cork); 15361c32c5adSHerbert Xu } 15371da177e4SLinus Torvalds 15381da177e4SLinus Torvalds /* 15391da177e4SLinus Torvalds * Fetch data from kernel space and fill in checksum if needed. 15401da177e4SLinus Torvalds */ 15411da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset, 15421da177e4SLinus Torvalds int len, int odd, struct sk_buff *skb) 15431da177e4SLinus Torvalds { 15445084205fSAl Viro __wsum csum; 15451da177e4SLinus Torvalds 15461da177e4SLinus Torvalds csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0); 15471da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 15481da177e4SLinus Torvalds return 0; 15491da177e4SLinus Torvalds } 15501da177e4SLinus Torvalds 15511da177e4SLinus Torvalds /* 15521da177e4SLinus Torvalds * Generic function to send a packet as reply to another packet. 1553be9f4a44SEric Dumazet * Used to send some TCP resets/acks so far. 15541da177e4SLinus Torvalds */ 1555bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb, 155624a2d43dSEric Dumazet const struct ip_options *sopt, 155724a2d43dSEric Dumazet __be32 daddr, __be32 saddr, 155824a2d43dSEric Dumazet const struct ip_reply_arg *arg, 155970e73416SDavid S. Miller unsigned int len) 15601da177e4SLinus Torvalds { 1561f6d8bd05SEric Dumazet struct ip_options_data replyopts; 15621da177e4SLinus Torvalds struct ipcm_cookie ipc; 156377968b78SDavid S. Miller struct flowi4 fl4; 1564511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1565bdbbb852SEric Dumazet struct net *net = sock_net(sk); 1566be9f4a44SEric Dumazet struct sk_buff *nskb; 15674062090eSVasily Averin int err; 1568f7ba868bSDavid Ahern int oif; 15691da177e4SLinus Torvalds 157091ed1e66SPaolo Abeni if (__ip_options_echo(net, &replyopts.opt.opt, skb, sopt)) 15711da177e4SLinus Torvalds return; 15721da177e4SLinus Torvalds 157335178206SWillem de Bruijn ipcm_init(&ipc); 15740a5ebb80SDavid S. Miller ipc.addr = daddr; 15751da177e4SLinus Torvalds 1576f6d8bd05SEric Dumazet if (replyopts.opt.opt.optlen) { 15771da177e4SLinus Torvalds ipc.opt = &replyopts.opt; 15781da177e4SLinus Torvalds 1579f6d8bd05SEric Dumazet if (replyopts.opt.opt.srr) 1580f6d8bd05SEric Dumazet daddr = replyopts.opt.opt.faddr; 15811da177e4SLinus Torvalds } 15821da177e4SLinus Torvalds 1583f7ba868bSDavid Ahern oif = arg->bound_dev_if; 15849b6c14d5SDavid Ahern if (!oif && netif_index_is_l3_master(net, skb->skb_iif)) 15859b6c14d5SDavid Ahern oif = skb->skb_iif; 1586f7ba868bSDavid Ahern 1587f7ba868bSDavid Ahern flowi4_init_output(&fl4, oif, 158800483690SJon Maxwell IP4_REPLY_MARK(net, skb->mark) ?: sk->sk_mark, 158966b13d99SEric Dumazet RT_TOS(arg->tos), 1590be9f4a44SEric Dumazet RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol, 1591538de0e0SDavid S. Miller ip_reply_arg_flowi_flags(arg), 159270e73416SDavid S. Miller daddr, saddr, 1593e2d118a1SLorenzo Colitti tcp_hdr(skb)->source, tcp_hdr(skb)->dest, 1594e2d118a1SLorenzo Colitti arg->uid); 15959d6ec938SDavid S. Miller security_skb_classify_flow(skb, flowi4_to_flowi(&fl4)); 1596be9f4a44SEric Dumazet rt = ip_route_output_key(net, &fl4); 1597b23dd4feSDavid S. Miller if (IS_ERR(rt)) 15981da177e4SLinus Torvalds return; 15991da177e4SLinus Torvalds 1600bdbbb852SEric Dumazet inet_sk(sk)->tos = arg->tos; 16011da177e4SLinus Torvalds 16021da177e4SLinus Torvalds sk->sk_priority = skb->priority; 1603eddc9ec5SArnaldo Carvalho de Melo sk->sk_protocol = ip_hdr(skb)->protocol; 1604f0e48dbfSPatrick McHardy sk->sk_bound_dev_if = arg->bound_dev_if; 1605be9f4a44SEric Dumazet sk->sk_sndbuf = sysctl_wmem_default; 1606bf99b4deSPau Espin Pedrol sk->sk_mark = fl4.flowi4_mark; 16074062090eSVasily Averin err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base, 16084062090eSVasily Averin len, 0, &ipc, &rt, MSG_DONTWAIT); 16094062090eSVasily Averin if (unlikely(err)) { 16104062090eSVasily Averin ip_flush_pending_frames(sk); 16114062090eSVasily Averin goto out; 16124062090eSVasily Averin } 16134062090eSVasily Averin 1614be9f4a44SEric Dumazet nskb = skb_peek(&sk->sk_write_queue); 1615be9f4a44SEric Dumazet if (nskb) { 16161da177e4SLinus Torvalds if (arg->csumoffset >= 0) 1617be9f4a44SEric Dumazet *((__sum16 *)skb_transport_header(nskb) + 1618be9f4a44SEric Dumazet arg->csumoffset) = csum_fold(csum_add(nskb->csum, 16199c70220bSArnaldo Carvalho de Melo arg->csum)); 1620be9f4a44SEric Dumazet nskb->ip_summed = CHECKSUM_NONE; 162177968b78SDavid S. Miller ip_push_pending_frames(sk, &fl4); 16221da177e4SLinus Torvalds } 16234062090eSVasily Averin out: 16241da177e4SLinus Torvalds ip_rt_put(rt); 16251da177e4SLinus Torvalds } 16261da177e4SLinus Torvalds 16271da177e4SLinus Torvalds void __init ip_init(void) 16281da177e4SLinus Torvalds { 16291da177e4SLinus Torvalds ip_rt_init(); 16301da177e4SLinus Torvalds inet_initpeers(); 16311da177e4SLinus Torvalds 163272c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST) 163372c1d3bdSWANG Cong igmp_mc_init(); 16341da177e4SLinus Torvalds #endif 16351da177e4SLinus Torvalds } 1636