1457c8996SThomas 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 290956fe219Sbrakmo static int __ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 2911da177e4SLinus Torvalds { 292c5501eb3SFlorian Westphal unsigned int mtu; 293c5501eb3SFlorian Westphal 2945c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM) 2955c901daaSPatrick McHardy /* Policy lookup after SNAT yielded a new policy */ 29600db4124SIan Morris if (skb_dst(skb)->xfrm) { 29748d5cad8SPatrick McHardy IPCB(skb)->flags |= IPSKB_REROUTED; 29813206b6bSEric W. Biederman return dst_output(net, sk, skb); 29948d5cad8SPatrick McHardy } 3005c901daaSPatrick McHardy #endif 301fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 302c7ba65d7SFlorian Westphal if (skb_is_gso(skb)) 303694869b3SEric W. Biederman return ip_finish_output_gso(net, sk, skb, mtu); 304c7ba65d7SFlorian Westphal 305d6b915e2SFlorian Westphal if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU)) 306694869b3SEric W. Biederman return ip_fragment(net, sk, skb, mtu, ip_finish_output2); 307c7ba65d7SFlorian Westphal 308694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 3091da177e4SLinus Torvalds } 3101da177e4SLinus Torvalds 311956fe219Sbrakmo static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 312956fe219Sbrakmo { 313956fe219Sbrakmo int ret; 314956fe219Sbrakmo 315956fe219Sbrakmo ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 316956fe219Sbrakmo switch (ret) { 317956fe219Sbrakmo case NET_XMIT_SUCCESS: 318956fe219Sbrakmo return __ip_finish_output(net, sk, skb); 319956fe219Sbrakmo case NET_XMIT_CN: 320956fe219Sbrakmo return __ip_finish_output(net, sk, skb) ? : ret; 321956fe219Sbrakmo default: 322956fe219Sbrakmo kfree_skb(skb); 323956fe219Sbrakmo return ret; 324956fe219Sbrakmo } 325956fe219Sbrakmo } 326956fe219Sbrakmo 32733b48679SDaniel Mack static int ip_mc_finish_output(struct net *net, struct sock *sk, 32833b48679SDaniel Mack struct sk_buff *skb) 32933b48679SDaniel Mack { 33033b48679SDaniel Mack int ret; 33133b48679SDaniel Mack 33233b48679SDaniel Mack ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 333956fe219Sbrakmo switch (ret) { 334956fe219Sbrakmo case NET_XMIT_SUCCESS: 335956fe219Sbrakmo return dev_loopback_xmit(net, sk, skb); 336956fe219Sbrakmo case NET_XMIT_CN: 337956fe219Sbrakmo return dev_loopback_xmit(net, sk, skb) ? : ret; 338956fe219Sbrakmo default: 33933b48679SDaniel Mack kfree_skb(skb); 34033b48679SDaniel Mack return ret; 34133b48679SDaniel Mack } 34233b48679SDaniel Mack } 34333b48679SDaniel Mack 344ede2059dSEric W. Biederman int ip_mc_output(struct net *net, struct sock *sk, struct sk_buff *skb) 3451da177e4SLinus Torvalds { 346511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 347d8d1f30bSChangli Gao struct net_device *dev = rt->dst.dev; 3481da177e4SLinus Torvalds 3491da177e4SLinus Torvalds /* 3501da177e4SLinus Torvalds * If the indicated interface is up and running, send the packet. 3511da177e4SLinus Torvalds */ 35288f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3531da177e4SLinus Torvalds 3541da177e4SLinus Torvalds skb->dev = dev; 3551da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 3561da177e4SLinus Torvalds 3571da177e4SLinus Torvalds /* 3581da177e4SLinus Torvalds * Multicasts are looped back for other local users 3591da177e4SLinus Torvalds */ 3601da177e4SLinus Torvalds 3611da177e4SLinus Torvalds if (rt->rt_flags&RTCF_MULTICAST) { 3627ad6848cSOctavian Purdila if (sk_mc_loop(sk) 3631da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 3641da177e4SLinus Torvalds /* Small optimization: do not loopback not local frames, 3651da177e4SLinus Torvalds which returned after forwarding; they will be dropped 3661da177e4SLinus Torvalds by ip_mr_input in any case. 3671da177e4SLinus Torvalds Note, that local frames are looped back to be delivered 3681da177e4SLinus Torvalds to local recipients. 3691da177e4SLinus Torvalds 3701da177e4SLinus Torvalds This check is duplicated in ip_mr_input at the moment. 3711da177e4SLinus Torvalds */ 3729d4fb27dSJoe Perches && 3739d4fb27dSJoe Perches ((rt->rt_flags & RTCF_LOCAL) || 3749d4fb27dSJoe Perches !(IPCB(skb)->flags & IPSKB_FORWARDED)) 3751da177e4SLinus Torvalds #endif 3761da177e4SLinus Torvalds ) { 3771da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3781da177e4SLinus Torvalds if (newskb) 3799bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 38029a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 38133b48679SDaniel Mack ip_mc_finish_output); 3821da177e4SLinus Torvalds } 3831da177e4SLinus Torvalds 3841da177e4SLinus Torvalds /* Multicasts with ttl 0 must not go beyond the host */ 3851da177e4SLinus Torvalds 386eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl == 0) { 3871da177e4SLinus Torvalds kfree_skb(skb); 3881da177e4SLinus Torvalds return 0; 3891da177e4SLinus Torvalds } 3901da177e4SLinus Torvalds } 3911da177e4SLinus Torvalds 3921da177e4SLinus Torvalds if (rt->rt_flags&RTCF_BROADCAST) { 3931da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3941da177e4SLinus Torvalds if (newskb) 39529a26a56SEric W. Biederman NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 39629a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 39733b48679SDaniel Mack ip_mc_finish_output); 3981da177e4SLinus Torvalds } 3991da177e4SLinus Torvalds 40029a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 40129a26a56SEric W. Biederman net, sk, skb, NULL, skb->dev, 40229a26a56SEric W. Biederman ip_finish_output, 40348d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 4041da177e4SLinus Torvalds } 4051da177e4SLinus Torvalds 406ede2059dSEric W. Biederman int ip_output(struct net *net, struct sock *sk, struct sk_buff *skb) 4071da177e4SLinus Torvalds { 408adf30907SEric Dumazet struct net_device *dev = skb_dst(skb)->dev; 4091bd9bef6SPatrick McHardy 41088f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 4111da177e4SLinus Torvalds 4121bd9bef6SPatrick McHardy skb->dev = dev; 4131bd9bef6SPatrick McHardy skb->protocol = htons(ETH_P_IP); 4141bd9bef6SPatrick McHardy 41529a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 41629a26a56SEric W. Biederman net, sk, skb, NULL, dev, 41748d5cad8SPatrick McHardy ip_finish_output, 41848d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 4191da177e4SLinus Torvalds } 4201da177e4SLinus Torvalds 42184f9307cSEric Dumazet /* 42284f9307cSEric Dumazet * copy saddr and daddr, possibly using 64bit load/stores 42384f9307cSEric Dumazet * Equivalent to : 42484f9307cSEric Dumazet * iph->saddr = fl4->saddr; 42584f9307cSEric Dumazet * iph->daddr = fl4->daddr; 42684f9307cSEric Dumazet */ 42784f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4) 42884f9307cSEric Dumazet { 42984f9307cSEric Dumazet BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) != 43084f9307cSEric Dumazet offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr)); 43184f9307cSEric Dumazet memcpy(&iph->saddr, &fl4->saddr, 43284f9307cSEric Dumazet sizeof(fl4->saddr) + sizeof(fl4->daddr)); 43384f9307cSEric Dumazet } 43484f9307cSEric Dumazet 435b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */ 43669b9e1e0SXin Long int __ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl, 43769b9e1e0SXin Long __u8 tos) 4381da177e4SLinus Torvalds { 4391da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 44077589ce0SEric W. Biederman struct net *net = sock_net(sk); 441f6d8bd05SEric Dumazet struct ip_options_rcu *inet_opt; 442b57ae01aSDavid S. Miller struct flowi4 *fl4; 4431da177e4SLinus Torvalds struct rtable *rt; 4441da177e4SLinus Torvalds struct iphdr *iph; 445ab6e3febSEric Dumazet int res; 4461da177e4SLinus Torvalds 4471da177e4SLinus Torvalds /* Skip all of this if the packet is already routed, 4481da177e4SLinus Torvalds * f.e. by something like SCTP. 4491da177e4SLinus Torvalds */ 450ab6e3febSEric Dumazet rcu_read_lock(); 451f6d8bd05SEric Dumazet inet_opt = rcu_dereference(inet->inet_opt); 452ea4fc0d6SDavid S. Miller fl4 = &fl->u.ip4; 453511c3f92SEric Dumazet rt = skb_rtable(skb); 45400db4124SIan Morris if (rt) 4551da177e4SLinus Torvalds goto packet_routed; 4561da177e4SLinus Torvalds 4571da177e4SLinus Torvalds /* Make sure we can route this packet. */ 4581da177e4SLinus Torvalds rt = (struct rtable *)__sk_dst_check(sk, 0); 45951456b29SIan Morris if (!rt) { 4603ca3c68eSAl Viro __be32 daddr; 4611da177e4SLinus Torvalds 4621da177e4SLinus Torvalds /* Use correct destination address if we have options. */ 463c720c7e8SEric Dumazet daddr = inet->inet_daddr; 464f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.srr) 465f6d8bd05SEric Dumazet daddr = inet_opt->opt.faddr; 4661da177e4SLinus Torvalds 4671da177e4SLinus Torvalds /* If this fails, retransmit mechanism of transport layer will 4681da177e4SLinus Torvalds * keep trying until route appears or the connection times 4691da177e4SLinus Torvalds * itself out. 4701da177e4SLinus Torvalds */ 47177589ce0SEric W. Biederman rt = ip_route_output_ports(net, fl4, sk, 47278fbfd8aSDavid S. Miller daddr, inet->inet_saddr, 47378fbfd8aSDavid S. Miller inet->inet_dport, 47478fbfd8aSDavid S. Miller inet->inet_sport, 47578fbfd8aSDavid S. Miller sk->sk_protocol, 47669b9e1e0SXin Long RT_CONN_FLAGS_TOS(sk, tos), 47778fbfd8aSDavid S. Miller sk->sk_bound_dev_if); 478b23dd4feSDavid S. Miller if (IS_ERR(rt)) 4791da177e4SLinus Torvalds goto no_route; 480d8d1f30bSChangli Gao sk_setup_caps(sk, &rt->dst); 4811da177e4SLinus Torvalds } 482d8d1f30bSChangli Gao skb_dst_set_noref(skb, &rt->dst); 4831da177e4SLinus Torvalds 4841da177e4SLinus Torvalds packet_routed: 4851550c171SDavid Ahern if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_gw_family) 4861da177e4SLinus Torvalds goto no_route; 4871da177e4SLinus Torvalds 4881da177e4SLinus Torvalds /* OK, we know where to send it, allocate and build IP header. */ 489f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0)); 4908856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 491eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 49269b9e1e0SXin Long *((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (tos & 0xff)); 49360ff7467SWANG Cong if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df) 4941da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 4951da177e4SLinus Torvalds else 4961da177e4SLinus Torvalds iph->frag_off = 0; 497d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 4981da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 49984f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 50084f9307cSEric Dumazet 5011da177e4SLinus Torvalds /* Transport layer set skb->h.foo itself. */ 5021da177e4SLinus Torvalds 503f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.optlen) { 504f6d8bd05SEric Dumazet iph->ihl += inet_opt->opt.optlen >> 2; 505f6d8bd05SEric Dumazet ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0); 5061da177e4SLinus Torvalds } 5071da177e4SLinus Torvalds 50877589ce0SEric W. Biederman ip_select_ident_segs(net, skb, sk, 509b6a7719aSHannes Frederic Sowa skb_shinfo(skb)->gso_segs ?: 1); 5101da177e4SLinus Torvalds 511b0270e91SEric Dumazet /* TODO : should we use skb->sk here instead of sk ? */ 5121da177e4SLinus Torvalds skb->priority = sk->sk_priority; 5134a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 5141da177e4SLinus Torvalds 51533224b16SEric W. Biederman res = ip_local_out(net, sk, skb); 516ab6e3febSEric Dumazet rcu_read_unlock(); 517ab6e3febSEric Dumazet return res; 5181da177e4SLinus Torvalds 5191da177e4SLinus Torvalds no_route: 520ab6e3febSEric Dumazet rcu_read_unlock(); 52177589ce0SEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_OUTNOROUTES); 5221da177e4SLinus Torvalds kfree_skb(skb); 5231da177e4SLinus Torvalds return -EHOSTUNREACH; 5241da177e4SLinus Torvalds } 52569b9e1e0SXin Long EXPORT_SYMBOL(__ip_queue_xmit); 5261da177e4SLinus Torvalds 5271da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from) 5281da177e4SLinus Torvalds { 5291da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 5301da177e4SLinus Torvalds to->priority = from->priority; 5311da177e4SLinus Torvalds to->protocol = from->protocol; 532d2f0c961SShmulik Ladkani to->skb_iif = from->skb_iif; 533adf30907SEric Dumazet skb_dst_drop(to); 534fe76cda3SEric Dumazet skb_dst_copy(to, from); 5351da177e4SLinus Torvalds to->dev = from->dev; 53682e91ffeSThomas Graf to->mark = from->mark; 5371da177e4SLinus Torvalds 5383dd1c9a1SPaolo Abeni skb_copy_hash(to, from); 5393dd1c9a1SPaolo Abeni 5401da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 5411da177e4SLinus Torvalds to->tc_index = from->tc_index; 5421da177e4SLinus Torvalds #endif 543e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 544df5042f4SFlorian Westphal skb_ext_copy(to, from); 5456ca40d4eSJavier Martinez Canillas #if IS_ENABLED(CONFIG_IP_VS) 546c98d80edSJulian Anastasov to->ipvs_property = from->ipvs_property; 547c98d80edSJulian Anastasov #endif 548984bc16cSJames Morris skb_copy_secmark(to, from); 5491da177e4SLinus Torvalds } 5501da177e4SLinus Torvalds 551694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 552c5501eb3SFlorian Westphal unsigned int mtu, 553694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 55449d16b23SAndy Zhou { 55549d16b23SAndy Zhou struct iphdr *iph = ip_hdr(skb); 55649d16b23SAndy Zhou 557d6b915e2SFlorian Westphal if ((iph->frag_off & htons(IP_DF)) == 0) 558694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 559d6b915e2SFlorian Westphal 560d6b915e2SFlorian Westphal if (unlikely(!skb->ignore_df || 56149d16b23SAndy Zhou (IPCB(skb)->frag_max_size && 56249d16b23SAndy Zhou IPCB(skb)->frag_max_size > mtu))) { 5639479b0afSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 56449d16b23SAndy Zhou icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, 56549d16b23SAndy Zhou htonl(mtu)); 56649d16b23SAndy Zhou kfree_skb(skb); 56749d16b23SAndy Zhou return -EMSGSIZE; 56849d16b23SAndy Zhou } 56949d16b23SAndy Zhou 570694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 57149d16b23SAndy Zhou } 57249d16b23SAndy Zhou 573c8b17be0SPablo Neira Ayuso void ip_fraglist_init(struct sk_buff *skb, struct iphdr *iph, 574c8b17be0SPablo Neira Ayuso unsigned int hlen, struct ip_fraglist_iter *iter) 575c8b17be0SPablo Neira Ayuso { 576c8b17be0SPablo Neira Ayuso unsigned int first_len = skb_pagelen(skb); 577c8b17be0SPablo Neira Ayuso 578*b7034146SEric Dumazet iter->frag = skb_shinfo(skb)->frag_list; 579c8b17be0SPablo Neira Ayuso skb_frag_list_init(skb); 580c8b17be0SPablo Neira Ayuso 581c8b17be0SPablo Neira Ayuso iter->offset = 0; 582c8b17be0SPablo Neira Ayuso iter->iph = iph; 583c8b17be0SPablo Neira Ayuso iter->hlen = hlen; 584c8b17be0SPablo Neira Ayuso 585c8b17be0SPablo Neira Ayuso skb->data_len = first_len - skb_headlen(skb); 586c8b17be0SPablo Neira Ayuso skb->len = first_len; 587c8b17be0SPablo Neira Ayuso iph->tot_len = htons(first_len); 588c8b17be0SPablo Neira Ayuso iph->frag_off = htons(IP_MF); 589c8b17be0SPablo Neira Ayuso ip_send_check(iph); 590c8b17be0SPablo Neira Ayuso } 591c8b17be0SPablo Neira Ayuso EXPORT_SYMBOL(ip_fraglist_init); 592c8b17be0SPablo Neira Ayuso 59319c3401aSPablo Neira Ayuso static void ip_fraglist_ipcb_prepare(struct sk_buff *skb, 59419c3401aSPablo Neira Ayuso struct ip_fraglist_iter *iter) 59519c3401aSPablo Neira Ayuso { 59619c3401aSPablo Neira Ayuso struct sk_buff *to = iter->frag; 59719c3401aSPablo Neira Ayuso 59819c3401aSPablo Neira Ayuso /* Copy the flags to each fragment. */ 59919c3401aSPablo Neira Ayuso IPCB(to)->flags = IPCB(skb)->flags; 60019c3401aSPablo Neira Ayuso 60119c3401aSPablo Neira Ayuso if (iter->offset == 0) 60219c3401aSPablo Neira Ayuso ip_options_fragment(to); 60319c3401aSPablo Neira Ayuso } 60419c3401aSPablo Neira Ayuso 605c8b17be0SPablo Neira Ayuso void ip_fraglist_prepare(struct sk_buff *skb, struct ip_fraglist_iter *iter) 606c8b17be0SPablo Neira Ayuso { 607c8b17be0SPablo Neira Ayuso unsigned int hlen = iter->hlen; 608c8b17be0SPablo Neira Ayuso struct iphdr *iph = iter->iph; 609c8b17be0SPablo Neira Ayuso struct sk_buff *frag; 610c8b17be0SPablo Neira Ayuso 611c8b17be0SPablo Neira Ayuso frag = iter->frag; 612c8b17be0SPablo Neira Ayuso frag->ip_summed = CHECKSUM_NONE; 613c8b17be0SPablo Neira Ayuso skb_reset_transport_header(frag); 614c8b17be0SPablo Neira Ayuso __skb_push(frag, hlen); 615c8b17be0SPablo Neira Ayuso skb_reset_network_header(frag); 616c8b17be0SPablo Neira Ayuso memcpy(skb_network_header(frag), iph, hlen); 617c8b17be0SPablo Neira Ayuso iter->iph = ip_hdr(frag); 618c8b17be0SPablo Neira Ayuso iph = iter->iph; 619c8b17be0SPablo Neira Ayuso iph->tot_len = htons(frag->len); 620c8b17be0SPablo Neira Ayuso ip_copy_metadata(frag, skb); 621c8b17be0SPablo Neira Ayuso iter->offset += skb->len - hlen; 622c8b17be0SPablo Neira Ayuso iph->frag_off = htons(iter->offset >> 3); 623c8b17be0SPablo Neira Ayuso if (frag->next) 624c8b17be0SPablo Neira Ayuso iph->frag_off |= htons(IP_MF); 625c8b17be0SPablo Neira Ayuso /* Ready, complete checksum */ 626c8b17be0SPablo Neira Ayuso ip_send_check(iph); 627c8b17be0SPablo Neira Ayuso } 628c8b17be0SPablo Neira Ayuso EXPORT_SYMBOL(ip_fraglist_prepare); 629c8b17be0SPablo Neira Ayuso 630065ff79fSPablo Neira Ayuso void ip_frag_init(struct sk_buff *skb, unsigned int hlen, 631065ff79fSPablo Neira Ayuso unsigned int ll_rs, unsigned int mtu, 632065ff79fSPablo Neira Ayuso struct ip_frag_state *state) 633065ff79fSPablo Neira Ayuso { 634065ff79fSPablo Neira Ayuso struct iphdr *iph = ip_hdr(skb); 635065ff79fSPablo Neira Ayuso 636065ff79fSPablo Neira Ayuso state->hlen = hlen; 637065ff79fSPablo Neira Ayuso state->ll_rs = ll_rs; 638065ff79fSPablo Neira Ayuso state->mtu = mtu; 639065ff79fSPablo Neira Ayuso 640065ff79fSPablo Neira Ayuso state->left = skb->len - hlen; /* Space per frame */ 641065ff79fSPablo Neira Ayuso state->ptr = hlen; /* Where to start from */ 642065ff79fSPablo Neira Ayuso 643065ff79fSPablo Neira Ayuso state->offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3; 644065ff79fSPablo Neira Ayuso state->not_last_frag = iph->frag_off & htons(IP_MF); 645065ff79fSPablo Neira Ayuso } 646065ff79fSPablo Neira Ayuso EXPORT_SYMBOL(ip_frag_init); 647065ff79fSPablo Neira Ayuso 64819c3401aSPablo Neira Ayuso static void ip_frag_ipcb(struct sk_buff *from, struct sk_buff *to, 64919c3401aSPablo Neira Ayuso bool first_frag, struct ip_frag_state *state) 65019c3401aSPablo Neira Ayuso { 65119c3401aSPablo Neira Ayuso /* Copy the flags to each fragment. */ 65219c3401aSPablo Neira Ayuso IPCB(to)->flags = IPCB(from)->flags; 65319c3401aSPablo Neira Ayuso 65419c3401aSPablo Neira Ayuso if (IPCB(from)->flags & IPSKB_FRAG_PMTU) 65519c3401aSPablo Neira Ayuso state->iph->frag_off |= htons(IP_DF); 65619c3401aSPablo Neira Ayuso 65719c3401aSPablo Neira Ayuso /* ANK: dirty, but effective trick. Upgrade options only if 65819c3401aSPablo Neira Ayuso * the segment to be fragmented was THE FIRST (otherwise, 65919c3401aSPablo Neira Ayuso * options are already fixed) and make it ONCE 66019c3401aSPablo Neira Ayuso * on the initial skb, so that all the following fragments 66119c3401aSPablo Neira Ayuso * will inherit fixed options. 66219c3401aSPablo Neira Ayuso */ 66319c3401aSPablo Neira Ayuso if (first_frag) 66419c3401aSPablo Neira Ayuso ip_options_fragment(from); 66519c3401aSPablo Neira Ayuso } 66619c3401aSPablo Neira Ayuso 667065ff79fSPablo Neira Ayuso struct sk_buff *ip_frag_next(struct sk_buff *skb, struct ip_frag_state *state) 668065ff79fSPablo Neira Ayuso { 669065ff79fSPablo Neira Ayuso unsigned int len = state->left; 670065ff79fSPablo Neira Ayuso struct sk_buff *skb2; 671065ff79fSPablo Neira Ayuso struct iphdr *iph; 672065ff79fSPablo Neira Ayuso 673065ff79fSPablo Neira Ayuso len = state->left; 674065ff79fSPablo Neira Ayuso /* IF: it doesn't fit, use 'mtu' - the data space left */ 675065ff79fSPablo Neira Ayuso if (len > state->mtu) 676065ff79fSPablo Neira Ayuso len = state->mtu; 677065ff79fSPablo Neira Ayuso /* IF: we are not sending up to and including the packet end 678065ff79fSPablo Neira Ayuso then align the next start on an eight byte boundary */ 679065ff79fSPablo Neira Ayuso if (len < state->left) { 680065ff79fSPablo Neira Ayuso len &= ~7; 681065ff79fSPablo Neira Ayuso } 682065ff79fSPablo Neira Ayuso 683065ff79fSPablo Neira Ayuso /* Allocate buffer */ 684065ff79fSPablo Neira Ayuso skb2 = alloc_skb(len + state->hlen + state->ll_rs, GFP_ATOMIC); 685065ff79fSPablo Neira Ayuso if (!skb2) 686065ff79fSPablo Neira Ayuso return ERR_PTR(-ENOMEM); 687065ff79fSPablo Neira Ayuso 688065ff79fSPablo Neira Ayuso /* 689065ff79fSPablo Neira Ayuso * Set up data on packet 690065ff79fSPablo Neira Ayuso */ 691065ff79fSPablo Neira Ayuso 692065ff79fSPablo Neira Ayuso ip_copy_metadata(skb2, skb); 693065ff79fSPablo Neira Ayuso skb_reserve(skb2, state->ll_rs); 694065ff79fSPablo Neira Ayuso skb_put(skb2, len + state->hlen); 695065ff79fSPablo Neira Ayuso skb_reset_network_header(skb2); 696065ff79fSPablo Neira Ayuso skb2->transport_header = skb2->network_header + state->hlen; 697065ff79fSPablo Neira Ayuso 698065ff79fSPablo Neira Ayuso /* 699065ff79fSPablo Neira Ayuso * Charge the memory for the fragment to any owner 700065ff79fSPablo Neira Ayuso * it might possess 701065ff79fSPablo Neira Ayuso */ 702065ff79fSPablo Neira Ayuso 703065ff79fSPablo Neira Ayuso if (skb->sk) 704065ff79fSPablo Neira Ayuso skb_set_owner_w(skb2, skb->sk); 705065ff79fSPablo Neira Ayuso 706065ff79fSPablo Neira Ayuso /* 707065ff79fSPablo Neira Ayuso * Copy the packet header into the new buffer. 708065ff79fSPablo Neira Ayuso */ 709065ff79fSPablo Neira Ayuso 710065ff79fSPablo Neira Ayuso skb_copy_from_linear_data(skb, skb_network_header(skb2), state->hlen); 711065ff79fSPablo Neira Ayuso 712065ff79fSPablo Neira Ayuso /* 713065ff79fSPablo Neira Ayuso * Copy a block of the IP datagram. 714065ff79fSPablo Neira Ayuso */ 715065ff79fSPablo Neira Ayuso if (skb_copy_bits(skb, state->ptr, skb_transport_header(skb2), len)) 716065ff79fSPablo Neira Ayuso BUG(); 717065ff79fSPablo Neira Ayuso state->left -= len; 718065ff79fSPablo Neira Ayuso 719065ff79fSPablo Neira Ayuso /* 720065ff79fSPablo Neira Ayuso * Fill in the new header fields. 721065ff79fSPablo Neira Ayuso */ 722065ff79fSPablo Neira Ayuso iph = ip_hdr(skb2); 723065ff79fSPablo Neira Ayuso iph->frag_off = htons((state->offset >> 3)); 724065ff79fSPablo Neira Ayuso 725065ff79fSPablo Neira Ayuso /* 726065ff79fSPablo Neira Ayuso * Added AC : If we are fragmenting a fragment that's not the 727065ff79fSPablo Neira Ayuso * last fragment then keep MF on each bit 728065ff79fSPablo Neira Ayuso */ 729065ff79fSPablo Neira Ayuso if (state->left > 0 || state->not_last_frag) 730065ff79fSPablo Neira Ayuso iph->frag_off |= htons(IP_MF); 731065ff79fSPablo Neira Ayuso state->ptr += len; 732065ff79fSPablo Neira Ayuso state->offset += len; 733065ff79fSPablo Neira Ayuso 734065ff79fSPablo Neira Ayuso iph->tot_len = htons(len + state->hlen); 735065ff79fSPablo Neira Ayuso 736065ff79fSPablo Neira Ayuso ip_send_check(iph); 737065ff79fSPablo Neira Ayuso 738065ff79fSPablo Neira Ayuso return skb2; 739065ff79fSPablo Neira Ayuso } 740065ff79fSPablo Neira Ayuso EXPORT_SYMBOL(ip_frag_next); 741065ff79fSPablo Neira Ayuso 7421da177e4SLinus Torvalds /* 7431da177e4SLinus Torvalds * This IP datagram is too large to be sent in one piece. Break it up into 7441da177e4SLinus Torvalds * smaller pieces (each of size equal to IP header plus 7451da177e4SLinus Torvalds * a block of the data of the original IP data part) that will yet fit in a 7461da177e4SLinus Torvalds * single device frame, and queue such a frame for sending. 7471da177e4SLinus Torvalds */ 7481da177e4SLinus Torvalds 749694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 750694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 7511da177e4SLinus Torvalds { 7521da177e4SLinus Torvalds struct iphdr *iph; 7531da177e4SLinus Torvalds struct sk_buff *skb2; 754511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 755065ff79fSPablo Neira Ayuso unsigned int mtu, hlen, ll_rs; 756c8b17be0SPablo Neira Ayuso struct ip_fraglist_iter iter; 757065ff79fSPablo Neira Ayuso struct ip_frag_state state; 7581da177e4SLinus Torvalds int err = 0; 7591da177e4SLinus Torvalds 760dbd3393cSHannes Frederic Sowa /* for offloaded checksums cleanup checksum before fragmentation */ 761dbd3393cSHannes Frederic Sowa if (skb->ip_summed == CHECKSUM_PARTIAL && 762dbd3393cSHannes Frederic Sowa (err = skb_checksum_help(skb))) 763dbd3393cSHannes Frederic Sowa goto fail; 764dbd3393cSHannes Frederic Sowa 7651da177e4SLinus Torvalds /* 7661da177e4SLinus Torvalds * Point into the IP datagram header. 7671da177e4SLinus Torvalds */ 7681da177e4SLinus Torvalds 769eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 7701da177e4SLinus Torvalds 771fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 772d6b915e2SFlorian Westphal if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu) 773d6b915e2SFlorian Westphal mtu = IPCB(skb)->frag_max_size; 7741da177e4SLinus Torvalds 7751da177e4SLinus Torvalds /* 7761da177e4SLinus Torvalds * Setup starting values. 7771da177e4SLinus Torvalds */ 7781da177e4SLinus Torvalds 7791da177e4SLinus Torvalds hlen = iph->ihl * 4; 780f87c10a8SHannes Frederic Sowa mtu = mtu - hlen; /* Size of data space */ 78189cee8b1SHerbert Xu IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE; 782254d900bSVasily Averin ll_rs = LL_RESERVED_SPACE(rt->dst.dev); 7831da177e4SLinus Torvalds 7841da177e4SLinus Torvalds /* When frag_list is given, use it. First, check its validity: 7851da177e4SLinus Torvalds * some transformers could create wrong frag_list or break existing 7861da177e4SLinus Torvalds * one, it is not prohibited. In this case fall back to copying. 7871da177e4SLinus Torvalds * 7881da177e4SLinus Torvalds * LATER: this step can be merged to real generation of fragments, 7891da177e4SLinus Torvalds * we can switch to copy when see the first bad fragment. 7901da177e4SLinus Torvalds */ 79121dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 7923d13008eSEric Dumazet struct sk_buff *frag, *frag2; 793c72d8cdaSAlexey Dobriyan unsigned int first_len = skb_pagelen(skb); 7941da177e4SLinus Torvalds 7951da177e4SLinus Torvalds if (first_len - hlen > mtu || 7961da177e4SLinus Torvalds ((first_len - hlen) & 7) || 79756f8a75cSPaul Gortmaker ip_is_fragment(iph) || 798254d900bSVasily Averin skb_cloned(skb) || 799254d900bSVasily Averin skb_headroom(skb) < ll_rs) 8001da177e4SLinus Torvalds goto slow_path; 8011da177e4SLinus Torvalds 802d7fcf1a5SDavid S. Miller skb_walk_frags(skb, frag) { 8031da177e4SLinus Torvalds /* Correct geometry. */ 8041da177e4SLinus Torvalds if (frag->len > mtu || 8051da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 806254d900bSVasily Averin skb_headroom(frag) < hlen + ll_rs) 8073d13008eSEric Dumazet goto slow_path_clean; 8081da177e4SLinus Torvalds 8091da177e4SLinus Torvalds /* Partially cloned skb? */ 8101da177e4SLinus Torvalds if (skb_shared(frag)) 8113d13008eSEric Dumazet goto slow_path_clean; 8122fdba6b0SHerbert Xu 8132fdba6b0SHerbert Xu BUG_ON(frag->sk); 8142fdba6b0SHerbert Xu if (skb->sk) { 8152fdba6b0SHerbert Xu frag->sk = skb->sk; 8162fdba6b0SHerbert Xu frag->destructor = sock_wfree; 8172fdba6b0SHerbert Xu } 8183d13008eSEric Dumazet skb->truesize -= frag->truesize; 8191da177e4SLinus Torvalds } 8201da177e4SLinus Torvalds 8211da177e4SLinus Torvalds /* Everything is OK. Generate! */ 822c8b17be0SPablo Neira Ayuso ip_fraglist_init(skb, iph, hlen, &iter); 8231da177e4SLinus Torvalds 8241da177e4SLinus Torvalds for (;;) { 8251da177e4SLinus Torvalds /* Prepare header of the next frame, 8261da177e4SLinus Torvalds * before previous one went down. */ 82719c3401aSPablo Neira Ayuso if (iter.frag) { 82819c3401aSPablo Neira Ayuso ip_fraglist_ipcb_prepare(skb, &iter); 829c8b17be0SPablo Neira Ayuso ip_fraglist_prepare(skb, &iter); 83019c3401aSPablo Neira Ayuso } 8311da177e4SLinus Torvalds 832694869b3SEric W. Biederman err = output(net, sk, skb); 8331da177e4SLinus Torvalds 834dafee490SWei Dong if (!err) 83526a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 836c8b17be0SPablo Neira Ayuso if (err || !iter.frag) 8371da177e4SLinus Torvalds break; 8381da177e4SLinus Torvalds 839c8b17be0SPablo Neira Ayuso skb = ip_fraglist_next(&iter); 8401da177e4SLinus Torvalds } 8411da177e4SLinus Torvalds 8421da177e4SLinus Torvalds if (err == 0) { 84326a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 8441da177e4SLinus Torvalds return 0; 8451da177e4SLinus Torvalds } 8461da177e4SLinus Torvalds 847*b7034146SEric Dumazet kfree_skb_list(iter.frag); 848942f146aSPablo Neira Ayuso 84926a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 8501da177e4SLinus Torvalds return err; 8513d13008eSEric Dumazet 8523d13008eSEric Dumazet slow_path_clean: 8533d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 8543d13008eSEric Dumazet if (frag2 == frag) 8553d13008eSEric Dumazet break; 8563d13008eSEric Dumazet frag2->sk = NULL; 8573d13008eSEric Dumazet frag2->destructor = NULL; 8583d13008eSEric Dumazet skb->truesize += frag2->truesize; 8593d13008eSEric Dumazet } 8601da177e4SLinus Torvalds } 8611da177e4SLinus Torvalds 8621da177e4SLinus Torvalds slow_path: 8631da177e4SLinus Torvalds /* 8641da177e4SLinus Torvalds * Fragment the datagram. 8651da177e4SLinus Torvalds */ 8661da177e4SLinus Torvalds 867065ff79fSPablo Neira Ayuso ip_frag_init(skb, hlen, ll_rs, mtu, &state); 8681da177e4SLinus Torvalds 8691da177e4SLinus Torvalds /* 8701da177e4SLinus Torvalds * Keep copying data until we run out. 8711da177e4SLinus Torvalds */ 8721da177e4SLinus Torvalds 873065ff79fSPablo Neira Ayuso while (state.left > 0) { 87419c3401aSPablo Neira Ayuso bool first_frag = (state.offset == 0); 87519c3401aSPablo Neira Ayuso 876065ff79fSPablo Neira Ayuso skb2 = ip_frag_next(skb, &state); 877065ff79fSPablo Neira Ayuso if (IS_ERR(skb2)) { 878065ff79fSPablo Neira Ayuso err = PTR_ERR(skb2); 8791da177e4SLinus Torvalds goto fail; 8801da177e4SLinus Torvalds } 88119c3401aSPablo Neira Ayuso ip_frag_ipcb(skb, skb2, first_frag, &state); 8821da177e4SLinus Torvalds 8831da177e4SLinus Torvalds /* 8841da177e4SLinus Torvalds * Put this fragment into the sending queue. 8851da177e4SLinus Torvalds */ 886694869b3SEric W. Biederman err = output(net, sk, skb2); 8871da177e4SLinus Torvalds if (err) 8881da177e4SLinus Torvalds goto fail; 889dafee490SWei Dong 89026a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 8911da177e4SLinus Torvalds } 8925d0ba55bSEric Dumazet consume_skb(skb); 89326a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 8941da177e4SLinus Torvalds return err; 8951da177e4SLinus Torvalds 8961da177e4SLinus Torvalds fail: 8971da177e4SLinus Torvalds kfree_skb(skb); 89826a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 8991da177e4SLinus Torvalds return err; 9001da177e4SLinus Torvalds } 90149d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment); 9022e2f7aefSPatrick McHardy 9031da177e4SLinus Torvalds int 9041da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb) 9051da177e4SLinus Torvalds { 906f69e6d13SAl Viro struct msghdr *msg = from; 9071da177e4SLinus Torvalds 90884fa7933SPatrick McHardy if (skb->ip_summed == CHECKSUM_PARTIAL) { 9090b62fca2SAl Viro if (!copy_from_iter_full(to, len, &msg->msg_iter)) 9101da177e4SLinus Torvalds return -EFAULT; 9111da177e4SLinus Torvalds } else { 91244bb9363SAl Viro __wsum csum = 0; 9130b62fca2SAl Viro if (!csum_and_copy_from_iter_full(to, len, &csum, &msg->msg_iter)) 9141da177e4SLinus Torvalds return -EFAULT; 9151da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 9161da177e4SLinus Torvalds } 9171da177e4SLinus Torvalds return 0; 9181da177e4SLinus Torvalds } 9194bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag); 9201da177e4SLinus Torvalds 92144bb9363SAl Viro static inline __wsum 9221da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy) 9231da177e4SLinus Torvalds { 9241da177e4SLinus Torvalds char *kaddr; 92544bb9363SAl Viro __wsum csum; 9261da177e4SLinus Torvalds kaddr = kmap(page); 9271da177e4SLinus Torvalds csum = csum_partial(kaddr + offset, copy, 0); 9281da177e4SLinus Torvalds kunmap(page); 9291da177e4SLinus Torvalds return csum; 9301da177e4SLinus Torvalds } 9311da177e4SLinus Torvalds 932f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk, 933f5fca608SDavid S. Miller struct flowi4 *fl4, 934f5fca608SDavid S. Miller struct sk_buff_head *queue, 9351470ddf7SHerbert Xu struct inet_cork *cork, 9365640f768SEric Dumazet struct page_frag *pfrag, 9371470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, 9381470ddf7SHerbert Xu int len, int odd, struct sk_buff *skb), 9391da177e4SLinus Torvalds void *from, int length, int transhdrlen, 9401da177e4SLinus Torvalds unsigned int flags) 9411da177e4SLinus Torvalds { 9421da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 943b5947e5dSWillem de Bruijn struct ubuf_info *uarg = NULL; 9441da177e4SLinus Torvalds struct sk_buff *skb; 9451da177e4SLinus Torvalds 94607df5294SHerbert Xu struct ip_options *opt = cork->opt; 9471da177e4SLinus Torvalds int hh_len; 9481da177e4SLinus Torvalds int exthdrlen; 9491da177e4SLinus Torvalds int mtu; 9501da177e4SLinus Torvalds int copy; 9511da177e4SLinus Torvalds int err; 9521da177e4SLinus Torvalds int offset = 0; 953daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, maxnonfragsize; 9541da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 9551470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 956694aba69SEric Dumazet unsigned int wmem_alloc_delta = 0; 957100f6d8eSWillem de Bruijn bool paged, extra_uref = false; 95809c2d251SWillem de Bruijn u32 tskey = 0; 9591da177e4SLinus Torvalds 96096d7303eSSteffen Klassert skb = skb_peek_tail(queue); 96196d7303eSSteffen Klassert 96296d7303eSSteffen Klassert exthdrlen = !skb ? rt->dst.header_len : 0; 963bec1f6f6SWillem de Bruijn mtu = cork->gso_size ? IP_MAX_MTU : cork->fragsize; 96415e36f5bSWillem de Bruijn paged = !!cork->gso_size; 965bec1f6f6SWillem de Bruijn 96609c2d251SWillem de Bruijn if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP && 96709c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 96809c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 9691470ddf7SHerbert Xu 970d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 9711da177e4SLinus Torvalds 9721da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 9731da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 97460ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 9751da177e4SLinus Torvalds 976daba287bSHannes Frederic Sowa if (cork->length + length > maxnonfragsize - fragheaderlen) { 977f5fca608SDavid S. Miller ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 97861e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 9791da177e4SLinus Torvalds return -EMSGSIZE; 9801da177e4SLinus Torvalds } 9811da177e4SLinus Torvalds 9821da177e4SLinus Torvalds /* 9831da177e4SLinus Torvalds * transhdrlen > 0 means that this is the first fragment and we wish 9841da177e4SLinus Torvalds * it won't be fragmented in the future. 9851da177e4SLinus Torvalds */ 9861da177e4SLinus Torvalds if (transhdrlen && 9871da177e4SLinus Torvalds length + fragheaderlen <= mtu && 988c8cd0989STom Herbert rt->dst.dev->features & (NETIF_F_HW_CSUM | NETIF_F_IP_CSUM) && 989bec1f6f6SWillem de Bruijn (!(flags & MSG_MORE) || cork->gso_size) && 990cd027a54SJacek Kalwas (!exthdrlen || (rt->dst.dev->features & NETIF_F_HW_ESP_TX_CSUM))) 99184fa7933SPatrick McHardy csummode = CHECKSUM_PARTIAL; 9921da177e4SLinus Torvalds 993b5947e5dSWillem de Bruijn if (flags & MSG_ZEROCOPY && length && sock_flag(sk, SOCK_ZEROCOPY)) { 994b5947e5dSWillem de Bruijn uarg = sock_zerocopy_realloc(sk, length, skb_zcopy(skb)); 995b5947e5dSWillem de Bruijn if (!uarg) 996b5947e5dSWillem de Bruijn return -ENOBUFS; 997100f6d8eSWillem de Bruijn extra_uref = !skb; /* only extra ref if !MSG_MORE */ 998b5947e5dSWillem de Bruijn if (rt->dst.dev->features & NETIF_F_SG && 999b5947e5dSWillem de Bruijn csummode == CHECKSUM_PARTIAL) { 1000b5947e5dSWillem de Bruijn paged = true; 1001b5947e5dSWillem de Bruijn } else { 1002b5947e5dSWillem de Bruijn uarg->zerocopy = 0; 100352900d22SWillem de Bruijn skb_zcopy_set(skb, uarg, &extra_uref); 1004b5947e5dSWillem de Bruijn } 1005b5947e5dSWillem de Bruijn } 1006b5947e5dSWillem de Bruijn 10071470ddf7SHerbert Xu cork->length += length; 10081da177e4SLinus Torvalds 10091da177e4SLinus Torvalds /* So, what's going on in the loop below? 10101da177e4SLinus Torvalds * 10111da177e4SLinus Torvalds * We use calculated fragment length to generate chained skb, 10121da177e4SLinus Torvalds * each of segments is IP fragment ready for sending to network after 10131da177e4SLinus Torvalds * adding appropriate IP header. 10141da177e4SLinus Torvalds */ 10151da177e4SLinus Torvalds 101626cde9f7SHerbert Xu if (!skb) 10171da177e4SLinus Torvalds goto alloc_new_skb; 10181da177e4SLinus Torvalds 10191da177e4SLinus Torvalds while (length > 0) { 10201da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 10211da177e4SLinus Torvalds copy = mtu - skb->len; 10221da177e4SLinus Torvalds if (copy < length) 10231da177e4SLinus Torvalds copy = maxfraglen - skb->len; 10241da177e4SLinus Torvalds if (copy <= 0) { 10251da177e4SLinus Torvalds char *data; 10261da177e4SLinus Torvalds unsigned int datalen; 10271da177e4SLinus Torvalds unsigned int fraglen; 10281da177e4SLinus Torvalds unsigned int fraggap; 10291da177e4SLinus Torvalds unsigned int alloclen; 1030aba36930SWillem de Bruijn unsigned int pagedlen; 10311da177e4SLinus Torvalds struct sk_buff *skb_prev; 10321da177e4SLinus Torvalds alloc_new_skb: 10331da177e4SLinus Torvalds skb_prev = skb; 10341da177e4SLinus Torvalds if (skb_prev) 10351da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 10361da177e4SLinus Torvalds else 10371da177e4SLinus Torvalds fraggap = 0; 10381da177e4SLinus Torvalds 10391da177e4SLinus Torvalds /* 10401da177e4SLinus Torvalds * If remaining data exceeds the mtu, 10411da177e4SLinus Torvalds * we know we need more fragment(s). 10421da177e4SLinus Torvalds */ 10431da177e4SLinus Torvalds datalen = length + fraggap; 10441da177e4SLinus Torvalds if (datalen > mtu - fragheaderlen) 10451da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 10461da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 1047aba36930SWillem de Bruijn pagedlen = 0; 10481da177e4SLinus Torvalds 10491da177e4SLinus Torvalds if ((flags & MSG_MORE) && 1050d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 10511da177e4SLinus Torvalds alloclen = mtu; 105215e36f5bSWillem de Bruijn else if (!paged) 105359104f06SEric Dumazet alloclen = fraglen; 105415e36f5bSWillem de Bruijn else { 105515e36f5bSWillem de Bruijn alloclen = min_t(int, fraglen, MAX_HEADER); 105615e36f5bSWillem de Bruijn pagedlen = fraglen - alloclen; 105715e36f5bSWillem de Bruijn } 10581da177e4SLinus Torvalds 1059353e5c9aSSteffen Klassert alloclen += exthdrlen; 1060353e5c9aSSteffen Klassert 10611da177e4SLinus Torvalds /* The last fragment gets additional space at tail. 10621da177e4SLinus Torvalds * Note, with MSG_MORE we overallocate on fragments, 10631da177e4SLinus Torvalds * because we have no idea what fragment will be 10641da177e4SLinus Torvalds * the last. 10651da177e4SLinus Torvalds */ 106633f99dc7SSteffen Klassert if (datalen == length + fraggap) 1067d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 106833f99dc7SSteffen Klassert 10691da177e4SLinus Torvalds if (transhdrlen) { 10701da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 10711da177e4SLinus Torvalds alloclen + hh_len + 15, 10721da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 10731da177e4SLinus Torvalds } else { 10741da177e4SLinus Torvalds skb = NULL; 1075694aba69SEric Dumazet if (refcount_read(&sk->sk_wmem_alloc) + wmem_alloc_delta <= 10761da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 1077694aba69SEric Dumazet skb = alloc_skb(alloclen + hh_len + 15, 10781da177e4SLinus Torvalds sk->sk_allocation); 107951456b29SIan Morris if (unlikely(!skb)) 10801da177e4SLinus Torvalds err = -ENOBUFS; 10811da177e4SLinus Torvalds } 108251456b29SIan Morris if (!skb) 10831da177e4SLinus Torvalds goto error; 10841da177e4SLinus Torvalds 10851da177e4SLinus Torvalds /* 10861da177e4SLinus Torvalds * Fill in the control structures 10871da177e4SLinus Torvalds */ 10881da177e4SLinus Torvalds skb->ip_summed = csummode; 10891da177e4SLinus Torvalds skb->csum = 0; 10901da177e4SLinus Torvalds skb_reserve(skb, hh_len); 109111878b40SWillem de Bruijn 10921da177e4SLinus Torvalds /* 10931da177e4SLinus Torvalds * Find where to start putting bytes. 10941da177e4SLinus Torvalds */ 109515e36f5bSWillem de Bruijn data = skb_put(skb, fraglen + exthdrlen - pagedlen); 1096c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 1097b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1098b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 1099353e5c9aSSteffen Klassert data += fragheaderlen + exthdrlen; 11001da177e4SLinus Torvalds 11011da177e4SLinus Torvalds if (fraggap) { 11021da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 11031da177e4SLinus Torvalds skb_prev, maxfraglen, 11041da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 11051da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 11061da177e4SLinus Torvalds skb->csum); 11071da177e4SLinus Torvalds data += fraggap; 1108e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 11091da177e4SLinus Torvalds } 11101da177e4SLinus Torvalds 111115e36f5bSWillem de Bruijn copy = datalen - transhdrlen - fraggap - pagedlen; 11121da177e4SLinus Torvalds if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 11131da177e4SLinus Torvalds err = -EFAULT; 11141da177e4SLinus Torvalds kfree_skb(skb); 11151da177e4SLinus Torvalds goto error; 11161da177e4SLinus Torvalds } 11171da177e4SLinus Torvalds 11181da177e4SLinus Torvalds offset += copy; 111915e36f5bSWillem de Bruijn length -= copy + transhdrlen; 11201da177e4SLinus Torvalds transhdrlen = 0; 11211da177e4SLinus Torvalds exthdrlen = 0; 11221da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 11231da177e4SLinus Torvalds 112452900d22SWillem de Bruijn /* only the initial fragment is time stamped */ 112552900d22SWillem de Bruijn skb_shinfo(skb)->tx_flags = cork->tx_flags; 112652900d22SWillem de Bruijn cork->tx_flags = 0; 112752900d22SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 112852900d22SWillem de Bruijn tskey = 0; 112952900d22SWillem de Bruijn skb_zcopy_set(skb, uarg, &extra_uref); 113052900d22SWillem de Bruijn 11310dec879fSJulian Anastasov if ((flags & MSG_CONFIRM) && !skb_prev) 11320dec879fSJulian Anastasov skb_set_dst_pending_confirm(skb, 1); 11330dec879fSJulian Anastasov 11341da177e4SLinus Torvalds /* 11351da177e4SLinus Torvalds * Put the packet on the pending queue. 11361da177e4SLinus Torvalds */ 1137694aba69SEric Dumazet if (!skb->destructor) { 1138694aba69SEric Dumazet skb->destructor = sock_wfree; 1139694aba69SEric Dumazet skb->sk = sk; 1140694aba69SEric Dumazet wmem_alloc_delta += skb->truesize; 1141694aba69SEric Dumazet } 11421470ddf7SHerbert Xu __skb_queue_tail(queue, skb); 11431da177e4SLinus Torvalds continue; 11441da177e4SLinus Torvalds } 11451da177e4SLinus Torvalds 11461da177e4SLinus Torvalds if (copy > length) 11471da177e4SLinus Torvalds copy = length; 11481da177e4SLinus Torvalds 1149113f99c3SWillem de Bruijn if (!(rt->dst.dev->features&NETIF_F_SG) && 1150113f99c3SWillem de Bruijn skb_tailroom(skb) >= copy) { 11511da177e4SLinus Torvalds unsigned int off; 11521da177e4SLinus Torvalds 11531da177e4SLinus Torvalds off = skb->len; 11541da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 11551da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 11561da177e4SLinus Torvalds __skb_trim(skb, off); 11571da177e4SLinus Torvalds err = -EFAULT; 11581da177e4SLinus Torvalds goto error; 11591da177e4SLinus Torvalds } 1160b5947e5dSWillem de Bruijn } else if (!uarg || !uarg->zerocopy) { 11611da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 11621da177e4SLinus Torvalds 11631da177e4SLinus Torvalds err = -ENOMEM; 11645640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 11651da177e4SLinus Torvalds goto error; 11661da177e4SLinus Torvalds 11675640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 11685640f768SEric Dumazet pfrag->offset)) { 11691da177e4SLinus Torvalds err = -EMSGSIZE; 11705640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 11711da177e4SLinus Torvalds goto error; 11725640f768SEric Dumazet 11735640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 11745640f768SEric Dumazet pfrag->offset, 0); 11755640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 11765640f768SEric Dumazet get_page(pfrag->page); 11771da177e4SLinus Torvalds } 11785640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 11795640f768SEric Dumazet if (getfrag(from, 11805640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 11815640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 11825640f768SEric Dumazet goto error_efault; 11835640f768SEric Dumazet 11845640f768SEric Dumazet pfrag->offset += copy; 11855640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 11861da177e4SLinus Torvalds skb->len += copy; 11871da177e4SLinus Torvalds skb->data_len += copy; 1188f945fa7aSHerbert Xu skb->truesize += copy; 1189694aba69SEric Dumazet wmem_alloc_delta += copy; 1190b5947e5dSWillem de Bruijn } else { 1191b5947e5dSWillem de Bruijn err = skb_zerocopy_iter_dgram(skb, from, copy); 1192b5947e5dSWillem de Bruijn if (err < 0) 1193b5947e5dSWillem de Bruijn goto error; 11941da177e4SLinus Torvalds } 11951da177e4SLinus Torvalds offset += copy; 11961da177e4SLinus Torvalds length -= copy; 11971da177e4SLinus Torvalds } 11981da177e4SLinus Torvalds 11999e8445a5SPaolo Abeni if (wmem_alloc_delta) 1200694aba69SEric Dumazet refcount_add(wmem_alloc_delta, &sk->sk_wmem_alloc); 12011da177e4SLinus Torvalds return 0; 12021da177e4SLinus Torvalds 12035640f768SEric Dumazet error_efault: 12045640f768SEric Dumazet err = -EFAULT; 12051da177e4SLinus Torvalds error: 120697ef7b4cSWillem de Bruijn if (uarg) 120752900d22SWillem de Bruijn sock_zerocopy_put_abort(uarg, extra_uref); 12081470ddf7SHerbert Xu cork->length -= length; 12095e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 1210694aba69SEric Dumazet refcount_add(wmem_alloc_delta, &sk->sk_wmem_alloc); 12111da177e4SLinus Torvalds return err; 12121da177e4SLinus Torvalds } 12131da177e4SLinus Torvalds 12141470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork, 12151470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp) 12161470ddf7SHerbert Xu { 1217f6d8bd05SEric Dumazet struct ip_options_rcu *opt; 12181470ddf7SHerbert Xu struct rtable *rt; 12191470ddf7SHerbert Xu 12209783ccd0SGao Feng rt = *rtp; 12219783ccd0SGao Feng if (unlikely(!rt)) 12229783ccd0SGao Feng return -EFAULT; 12239783ccd0SGao Feng 12241470ddf7SHerbert Xu /* 12251470ddf7SHerbert Xu * setup for corking. 12261470ddf7SHerbert Xu */ 12271470ddf7SHerbert Xu opt = ipc->opt; 12281470ddf7SHerbert Xu if (opt) { 122951456b29SIan Morris if (!cork->opt) { 12301470ddf7SHerbert Xu cork->opt = kmalloc(sizeof(struct ip_options) + 40, 12311470ddf7SHerbert Xu sk->sk_allocation); 123251456b29SIan Morris if (unlikely(!cork->opt)) 12331470ddf7SHerbert Xu return -ENOBUFS; 12341470ddf7SHerbert Xu } 1235f6d8bd05SEric Dumazet memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen); 12361470ddf7SHerbert Xu cork->flags |= IPCORK_OPT; 12371470ddf7SHerbert Xu cork->addr = ipc->addr; 12381470ddf7SHerbert Xu } 12399783ccd0SGao Feng 12401470ddf7SHerbert Xu /* 12411470ddf7SHerbert Xu * We steal reference to this route, caller should not release it 12421470ddf7SHerbert Xu */ 12431470ddf7SHerbert Xu *rtp = NULL; 1244482fc609SHannes Frederic Sowa cork->fragsize = ip_sk_use_pmtu(sk) ? 1245482fc609SHannes Frederic Sowa dst_mtu(&rt->dst) : rt->dst.dev->mtu; 1246bec1f6f6SWillem de Bruijn 1247fbf47813SWillem de Bruijn cork->gso_size = ipc->gso_size; 12481470ddf7SHerbert Xu cork->dst = &rt->dst; 12491470ddf7SHerbert Xu cork->length = 0; 1250aa661581SFrancesco Fusco cork->ttl = ipc->ttl; 1251aa661581SFrancesco Fusco cork->tos = ipc->tos; 1252aa661581SFrancesco Fusco cork->priority = ipc->priority; 1253bc969a97SJesus Sanchez-Palencia cork->transmit_time = ipc->sockc.transmit_time; 1254678ca42dSWillem de Bruijn cork->tx_flags = 0; 1255678ca42dSWillem de Bruijn sock_tx_timestamp(sk, ipc->sockc.tsflags, &cork->tx_flags); 12561470ddf7SHerbert Xu 12571470ddf7SHerbert Xu return 0; 12581470ddf7SHerbert Xu } 12591470ddf7SHerbert Xu 12601470ddf7SHerbert Xu /* 12611470ddf7SHerbert Xu * ip_append_data() and ip_append_page() can make one large IP datagram 12621470ddf7SHerbert Xu * from many pieces of data. Each pieces will be holded on the socket 12631470ddf7SHerbert Xu * until ip_push_pending_frames() is called. Each piece can be a page 12641470ddf7SHerbert Xu * or non-page data. 12651470ddf7SHerbert Xu * 12661470ddf7SHerbert Xu * Not only UDP, other transport protocols - e.g. raw sockets - can use 12671470ddf7SHerbert Xu * this interface potentially. 12681470ddf7SHerbert Xu * 12691470ddf7SHerbert Xu * LATER: length must be adjusted by pad at tail, when it is required. 12701470ddf7SHerbert Xu */ 1271f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4, 12721470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, int len, 12731470ddf7SHerbert Xu int odd, struct sk_buff *skb), 12741470ddf7SHerbert Xu void *from, int length, int transhdrlen, 12751470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 12761470ddf7SHerbert Xu unsigned int flags) 12771470ddf7SHerbert Xu { 12781470ddf7SHerbert Xu struct inet_sock *inet = inet_sk(sk); 12791470ddf7SHerbert Xu int err; 12801470ddf7SHerbert Xu 12811470ddf7SHerbert Xu if (flags&MSG_PROBE) 12821470ddf7SHerbert Xu return 0; 12831470ddf7SHerbert Xu 12841470ddf7SHerbert Xu if (skb_queue_empty(&sk->sk_write_queue)) { 1285bdc712b4SDavid S. Miller err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp); 12861470ddf7SHerbert Xu if (err) 12871470ddf7SHerbert Xu return err; 12881470ddf7SHerbert Xu } else { 12891470ddf7SHerbert Xu transhdrlen = 0; 12901470ddf7SHerbert Xu } 12911470ddf7SHerbert Xu 12925640f768SEric Dumazet return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base, 12935640f768SEric Dumazet sk_page_frag(sk), getfrag, 12941470ddf7SHerbert Xu from, length, transhdrlen, flags); 12951470ddf7SHerbert Xu } 12961470ddf7SHerbert Xu 1297f5fca608SDavid S. Miller ssize_t ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page, 12981da177e4SLinus Torvalds int offset, size_t size, int flags) 12991da177e4SLinus Torvalds { 13001da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 13011da177e4SLinus Torvalds struct sk_buff *skb; 13021da177e4SLinus Torvalds struct rtable *rt; 13031da177e4SLinus Torvalds struct ip_options *opt = NULL; 1304bdc712b4SDavid S. Miller struct inet_cork *cork; 13051da177e4SLinus Torvalds int hh_len; 13061da177e4SLinus Torvalds int mtu; 13071da177e4SLinus Torvalds int len; 13081da177e4SLinus Torvalds int err; 1309daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize; 13101da177e4SLinus Torvalds 13111da177e4SLinus Torvalds if (inet->hdrincl) 13121da177e4SLinus Torvalds return -EPERM; 13131da177e4SLinus Torvalds 13141da177e4SLinus Torvalds if (flags&MSG_PROBE) 13151da177e4SLinus Torvalds return 0; 13161da177e4SLinus Torvalds 13171da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) 13181da177e4SLinus Torvalds return -EINVAL; 13191da177e4SLinus Torvalds 1320bdc712b4SDavid S. Miller cork = &inet->cork.base; 1321bdc712b4SDavid S. Miller rt = (struct rtable *)cork->dst; 1322bdc712b4SDavid S. Miller if (cork->flags & IPCORK_OPT) 1323bdc712b4SDavid S. Miller opt = cork->opt; 13241da177e4SLinus Torvalds 1325d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) 13261da177e4SLinus Torvalds return -EOPNOTSUPP; 13271da177e4SLinus Torvalds 1328d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 1329bec1f6f6SWillem de Bruijn mtu = cork->gso_size ? IP_MAX_MTU : cork->fragsize; 13301da177e4SLinus Torvalds 13311da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 13321da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 133360ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 13341da177e4SLinus Torvalds 1335daba287bSHannes Frederic Sowa if (cork->length + size > maxnonfragsize - fragheaderlen) { 133661e7f09dSHannes Frederic Sowa ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 133761e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 13381da177e4SLinus Torvalds return -EMSGSIZE; 13391da177e4SLinus Torvalds } 13401da177e4SLinus Torvalds 134151456b29SIan Morris skb = skb_peek_tail(&sk->sk_write_queue); 134251456b29SIan Morris if (!skb) 13431da177e4SLinus Torvalds return -EINVAL; 13441da177e4SLinus Torvalds 1345a8c4a252SHannes Frederic Sowa cork->length += size; 1346e89e9cf5SAnanda Raju 13471da177e4SLinus Torvalds while (size > 0) { 13481da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 13491da177e4SLinus Torvalds len = mtu - skb->len; 13501da177e4SLinus Torvalds if (len < size) 13511da177e4SLinus Torvalds len = maxfraglen - skb->len; 1352ab2fb7e3SWillem de Bruijn 13531da177e4SLinus Torvalds if (len <= 0) { 13541da177e4SLinus Torvalds struct sk_buff *skb_prev; 13551da177e4SLinus Torvalds int alloclen; 13561da177e4SLinus Torvalds 13571da177e4SLinus Torvalds skb_prev = skb; 13581da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 13591da177e4SLinus Torvalds 13601da177e4SLinus Torvalds alloclen = fragheaderlen + hh_len + fraggap + 15; 13611da177e4SLinus Torvalds skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation); 13621da177e4SLinus Torvalds if (unlikely(!skb)) { 13631da177e4SLinus Torvalds err = -ENOBUFS; 13641da177e4SLinus Torvalds goto error; 13651da177e4SLinus Torvalds } 13661da177e4SLinus Torvalds 13671da177e4SLinus Torvalds /* 13681da177e4SLinus Torvalds * Fill in the control structures 13691da177e4SLinus Torvalds */ 13701da177e4SLinus Torvalds skb->ip_summed = CHECKSUM_NONE; 13711da177e4SLinus Torvalds skb->csum = 0; 13721da177e4SLinus Torvalds skb_reserve(skb, hh_len); 13731da177e4SLinus Torvalds 13741da177e4SLinus Torvalds /* 13751da177e4SLinus Torvalds * Find where to start putting bytes. 13761da177e4SLinus Torvalds */ 1377967b05f6SArnaldo Carvalho de Melo skb_put(skb, fragheaderlen + fraggap); 13782ca9e6f2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1379b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1380b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 13811da177e4SLinus Torvalds if (fraggap) { 1382967b05f6SArnaldo Carvalho de Melo skb->csum = skb_copy_and_csum_bits(skb_prev, 1383967b05f6SArnaldo Carvalho de Melo maxfraglen, 13849c70220bSArnaldo Carvalho de Melo skb_transport_header(skb), 1385967b05f6SArnaldo Carvalho de Melo fraggap, 0); 13861da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 13871da177e4SLinus Torvalds skb->csum); 1388e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 13891da177e4SLinus Torvalds } 13901da177e4SLinus Torvalds 13911da177e4SLinus Torvalds /* 13921da177e4SLinus Torvalds * Put the packet on the pending queue. 13931da177e4SLinus Torvalds */ 13941da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 13951da177e4SLinus Torvalds continue; 13961da177e4SLinus Torvalds } 13971da177e4SLinus Torvalds 13981da177e4SLinus Torvalds if (len > size) 13991da177e4SLinus Torvalds len = size; 1400be12a1feSHannes Frederic Sowa 1401be12a1feSHannes Frederic Sowa if (skb_append_pagefrags(skb, page, offset, len)) { 14021da177e4SLinus Torvalds err = -EMSGSIZE; 14031da177e4SLinus Torvalds goto error; 14041da177e4SLinus Torvalds } 14051da177e4SLinus Torvalds 14061da177e4SLinus Torvalds if (skb->ip_summed == CHECKSUM_NONE) { 140744bb9363SAl Viro __wsum csum; 14081da177e4SLinus Torvalds csum = csum_page(page, offset, len); 14091da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, skb->len); 14101da177e4SLinus Torvalds } 14111da177e4SLinus Torvalds 14121da177e4SLinus Torvalds skb->len += len; 14131da177e4SLinus Torvalds skb->data_len += len; 14141e34a11dSDavid S. Miller skb->truesize += len; 141514afee4bSReshetova, Elena refcount_add(len, &sk->sk_wmem_alloc); 14161da177e4SLinus Torvalds offset += len; 14171da177e4SLinus Torvalds size -= len; 14181da177e4SLinus Torvalds } 14191da177e4SLinus Torvalds return 0; 14201da177e4SLinus Torvalds 14211da177e4SLinus Torvalds error: 1422bdc712b4SDavid S. Miller cork->length -= size; 14235e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 14241da177e4SLinus Torvalds return err; 14251da177e4SLinus Torvalds } 14261da177e4SLinus Torvalds 14271470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork) 1428429f08e9SPavel Emelyanov { 14291470ddf7SHerbert Xu cork->flags &= ~IPCORK_OPT; 14301470ddf7SHerbert Xu kfree(cork->opt); 14311470ddf7SHerbert Xu cork->opt = NULL; 14321470ddf7SHerbert Xu dst_release(cork->dst); 14331470ddf7SHerbert Xu cork->dst = NULL; 1434429f08e9SPavel Emelyanov } 1435429f08e9SPavel Emelyanov 14361da177e4SLinus Torvalds /* 14371da177e4SLinus Torvalds * Combined all pending IP fragments on the socket as one IP datagram 14381da177e4SLinus Torvalds * and push them out. 14391da177e4SLinus Torvalds */ 14401c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk, 144177968b78SDavid S. Miller struct flowi4 *fl4, 14421470ddf7SHerbert Xu struct sk_buff_head *queue, 14431470ddf7SHerbert Xu struct inet_cork *cork) 14441da177e4SLinus Torvalds { 14451da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 14461da177e4SLinus Torvalds struct sk_buff **tail_skb; 14471da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 14480388b004SPavel Emelyanov struct net *net = sock_net(sk); 14491da177e4SLinus Torvalds struct ip_options *opt = NULL; 14501470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 14511da177e4SLinus Torvalds struct iphdr *iph; 145276ab608dSAlexey Dobriyan __be16 df = 0; 14531da177e4SLinus Torvalds __u8 ttl; 14541da177e4SLinus Torvalds 145551456b29SIan Morris skb = __skb_dequeue(queue); 145651456b29SIan Morris if (!skb) 14571da177e4SLinus Torvalds goto out; 14581da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 14591da177e4SLinus Torvalds 14601da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1461d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1462bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 14631470ddf7SHerbert Xu while ((tmp_skb = __skb_dequeue(queue)) != NULL) { 1464cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 14651da177e4SLinus Torvalds *tail_skb = tmp_skb; 14661da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 14671da177e4SLinus Torvalds skb->len += tmp_skb->len; 14681da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 14691da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 14701da177e4SLinus Torvalds tmp_skb->destructor = NULL; 14711da177e4SLinus Torvalds tmp_skb->sk = NULL; 14721da177e4SLinus Torvalds } 14731da177e4SLinus Torvalds 14741da177e4SLinus Torvalds /* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow 14751da177e4SLinus Torvalds * to fragment the frame generated here. No matter, what transforms 14761da177e4SLinus Torvalds * how transforms change size of the packet, it will come out. 14771da177e4SLinus Torvalds */ 147860ff7467SWANG Cong skb->ignore_df = ip_sk_ignore_df(sk); 14791da177e4SLinus Torvalds 14801da177e4SLinus Torvalds /* DF bit is set when we want to see DF on outgoing frames. 148160ff7467SWANG Cong * If ignore_df is set too, we still allow to fragment this frame 14821da177e4SLinus Torvalds * locally. */ 1483482fc609SHannes Frederic Sowa if (inet->pmtudisc == IP_PMTUDISC_DO || 1484482fc609SHannes Frederic Sowa inet->pmtudisc == IP_PMTUDISC_PROBE || 1485d8d1f30bSChangli Gao (skb->len <= dst_mtu(&rt->dst) && 1486d8d1f30bSChangli Gao ip_dont_fragment(sk, &rt->dst))) 14871da177e4SLinus Torvalds df = htons(IP_DF); 14881da177e4SLinus Torvalds 14891470ddf7SHerbert Xu if (cork->flags & IPCORK_OPT) 14901470ddf7SHerbert Xu opt = cork->opt; 14911da177e4SLinus Torvalds 1492aa661581SFrancesco Fusco if (cork->ttl != 0) 1493aa661581SFrancesco Fusco ttl = cork->ttl; 1494aa661581SFrancesco Fusco else if (rt->rt_type == RTN_MULTICAST) 14951da177e4SLinus Torvalds ttl = inet->mc_ttl; 14961da177e4SLinus Torvalds else 1497d8d1f30bSChangli Gao ttl = ip_select_ttl(inet, &rt->dst); 14981da177e4SLinus Torvalds 1499749154aaSAnsis Atteka iph = ip_hdr(skb); 15001da177e4SLinus Torvalds iph->version = 4; 15011da177e4SLinus Torvalds iph->ihl = 5; 1502aa661581SFrancesco Fusco iph->tos = (cork->tos != -1) ? cork->tos : inet->tos; 15031da177e4SLinus Torvalds iph->frag_off = df; 15041da177e4SLinus Torvalds iph->ttl = ttl; 15051da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 150684f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 1507b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, sk); 15081da177e4SLinus Torvalds 150922f728f8SDavid S. Miller if (opt) { 151022f728f8SDavid S. Miller iph->ihl += opt->optlen>>2; 151122f728f8SDavid S. Miller ip_options_build(skb, opt, cork->addr, rt, 0); 151222f728f8SDavid S. Miller } 151322f728f8SDavid S. Miller 1514aa661581SFrancesco Fusco skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority; 15154a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1516bc969a97SJesus Sanchez-Palencia skb->tstamp = cork->transmit_time; 1517a21bba94SEric Dumazet /* 1518a21bba94SEric Dumazet * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec 1519a21bba94SEric Dumazet * on dst refcount 1520a21bba94SEric Dumazet */ 15211470ddf7SHerbert Xu cork->dst = NULL; 1522d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 15231da177e4SLinus Torvalds 152496793b48SDavid L Stevens if (iph->protocol == IPPROTO_ICMP) 15250388b004SPavel Emelyanov icmp_out_count(net, ((struct icmphdr *) 152696793b48SDavid L Stevens skb_transport_header(skb))->type); 152796793b48SDavid L Stevens 15281c32c5adSHerbert Xu ip_cork_release(cork); 15291c32c5adSHerbert Xu out: 15301c32c5adSHerbert Xu return skb; 15311c32c5adSHerbert Xu } 15321c32c5adSHerbert Xu 1533b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb) 15341c32c5adSHerbert Xu { 15351c32c5adSHerbert Xu int err; 15361c32c5adSHerbert Xu 153733224b16SEric W. Biederman err = ip_local_out(net, skb->sk, skb); 15381da177e4SLinus Torvalds if (err) { 15391da177e4SLinus Torvalds if (err > 0) 15406ce9e7b5SEric Dumazet err = net_xmit_errno(err); 15411da177e4SLinus Torvalds if (err) 15421c32c5adSHerbert Xu IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS); 15431da177e4SLinus Torvalds } 15441da177e4SLinus Torvalds 15451da177e4SLinus Torvalds return err; 15461da177e4SLinus Torvalds } 15471da177e4SLinus Torvalds 154877968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4) 15491470ddf7SHerbert Xu { 15501c32c5adSHerbert Xu struct sk_buff *skb; 15511c32c5adSHerbert Xu 155277968b78SDavid S. Miller skb = ip_finish_skb(sk, fl4); 15531c32c5adSHerbert Xu if (!skb) 15541c32c5adSHerbert Xu return 0; 15551c32c5adSHerbert Xu 15561c32c5adSHerbert Xu /* Netfilter gets whole the not fragmented skb. */ 1557b5ec8eeaSEric Dumazet return ip_send_skb(sock_net(sk), skb); 15581470ddf7SHerbert Xu } 15591470ddf7SHerbert Xu 15601da177e4SLinus Torvalds /* 15611da177e4SLinus Torvalds * Throw away all pending data on the socket. 15621da177e4SLinus Torvalds */ 15631470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk, 15641470ddf7SHerbert Xu struct sk_buff_head *queue, 15651470ddf7SHerbert Xu struct inet_cork *cork) 15661da177e4SLinus Torvalds { 15671da177e4SLinus Torvalds struct sk_buff *skb; 15681da177e4SLinus Torvalds 15691470ddf7SHerbert Xu while ((skb = __skb_dequeue_tail(queue)) != NULL) 15701da177e4SLinus Torvalds kfree_skb(skb); 15711da177e4SLinus Torvalds 15721470ddf7SHerbert Xu ip_cork_release(cork); 15731470ddf7SHerbert Xu } 15741470ddf7SHerbert Xu 15751470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk) 15761470ddf7SHerbert Xu { 1577bdc712b4SDavid S. Miller __ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base); 15781da177e4SLinus Torvalds } 15791da177e4SLinus Torvalds 15801c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk, 158177968b78SDavid S. Miller struct flowi4 *fl4, 15821c32c5adSHerbert Xu int getfrag(void *from, char *to, int offset, 15831c32c5adSHerbert Xu int len, int odd, struct sk_buff *skb), 15841c32c5adSHerbert Xu void *from, int length, int transhdrlen, 15851c32c5adSHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 15861cd7884dSWillem de Bruijn struct inet_cork *cork, unsigned int flags) 15871c32c5adSHerbert Xu { 15881c32c5adSHerbert Xu struct sk_buff_head queue; 15891c32c5adSHerbert Xu int err; 15901c32c5adSHerbert Xu 15911c32c5adSHerbert Xu if (flags & MSG_PROBE) 15921c32c5adSHerbert Xu return NULL; 15931c32c5adSHerbert Xu 15941c32c5adSHerbert Xu __skb_queue_head_init(&queue); 15951c32c5adSHerbert Xu 15961cd7884dSWillem de Bruijn cork->flags = 0; 15971cd7884dSWillem de Bruijn cork->addr = 0; 15981cd7884dSWillem de Bruijn cork->opt = NULL; 15991cd7884dSWillem de Bruijn err = ip_setup_cork(sk, cork, ipc, rtp); 16001c32c5adSHerbert Xu if (err) 16011c32c5adSHerbert Xu return ERR_PTR(err); 16021c32c5adSHerbert Xu 16031cd7884dSWillem de Bruijn err = __ip_append_data(sk, fl4, &queue, cork, 16045640f768SEric Dumazet ¤t->task_frag, getfrag, 16051c32c5adSHerbert Xu from, length, transhdrlen, flags); 16061c32c5adSHerbert Xu if (err) { 16071cd7884dSWillem de Bruijn __ip_flush_pending_frames(sk, &queue, cork); 16081c32c5adSHerbert Xu return ERR_PTR(err); 16091c32c5adSHerbert Xu } 16101c32c5adSHerbert Xu 16111cd7884dSWillem de Bruijn return __ip_make_skb(sk, fl4, &queue, cork); 16121c32c5adSHerbert Xu } 16131da177e4SLinus Torvalds 16141da177e4SLinus Torvalds /* 16151da177e4SLinus Torvalds * Fetch data from kernel space and fill in checksum if needed. 16161da177e4SLinus Torvalds */ 16171da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset, 16181da177e4SLinus Torvalds int len, int odd, struct sk_buff *skb) 16191da177e4SLinus Torvalds { 16205084205fSAl Viro __wsum csum; 16211da177e4SLinus Torvalds 16221da177e4SLinus Torvalds csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0); 16231da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 16241da177e4SLinus Torvalds return 0; 16251da177e4SLinus Torvalds } 16261da177e4SLinus Torvalds 16271da177e4SLinus Torvalds /* 16281da177e4SLinus Torvalds * Generic function to send a packet as reply to another packet. 1629be9f4a44SEric Dumazet * Used to send some TCP resets/acks so far. 16301da177e4SLinus Torvalds */ 1631bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb, 163224a2d43dSEric Dumazet const struct ip_options *sopt, 163324a2d43dSEric Dumazet __be32 daddr, __be32 saddr, 163424a2d43dSEric Dumazet const struct ip_reply_arg *arg, 163570e73416SDavid S. Miller unsigned int len) 16361da177e4SLinus Torvalds { 1637f6d8bd05SEric Dumazet struct ip_options_data replyopts; 16381da177e4SLinus Torvalds struct ipcm_cookie ipc; 163977968b78SDavid S. Miller struct flowi4 fl4; 1640511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1641bdbbb852SEric Dumazet struct net *net = sock_net(sk); 1642be9f4a44SEric Dumazet struct sk_buff *nskb; 16434062090eSVasily Averin int err; 1644f7ba868bSDavid Ahern int oif; 16451da177e4SLinus Torvalds 164691ed1e66SPaolo Abeni if (__ip_options_echo(net, &replyopts.opt.opt, skb, sopt)) 16471da177e4SLinus Torvalds return; 16481da177e4SLinus Torvalds 164935178206SWillem de Bruijn ipcm_init(&ipc); 16500a5ebb80SDavid S. Miller ipc.addr = daddr; 16511da177e4SLinus Torvalds 1652f6d8bd05SEric Dumazet if (replyopts.opt.opt.optlen) { 16531da177e4SLinus Torvalds ipc.opt = &replyopts.opt; 16541da177e4SLinus Torvalds 1655f6d8bd05SEric Dumazet if (replyopts.opt.opt.srr) 1656f6d8bd05SEric Dumazet daddr = replyopts.opt.opt.faddr; 16571da177e4SLinus Torvalds } 16581da177e4SLinus Torvalds 1659f7ba868bSDavid Ahern oif = arg->bound_dev_if; 16609b6c14d5SDavid Ahern if (!oif && netif_index_is_l3_master(net, skb->skb_iif)) 16619b6c14d5SDavid Ahern oif = skb->skb_iif; 1662f7ba868bSDavid Ahern 1663f7ba868bSDavid Ahern flowi4_init_output(&fl4, oif, 166400483690SJon Maxwell IP4_REPLY_MARK(net, skb->mark) ?: sk->sk_mark, 166566b13d99SEric Dumazet RT_TOS(arg->tos), 1666be9f4a44SEric Dumazet RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol, 1667538de0e0SDavid S. Miller ip_reply_arg_flowi_flags(arg), 166870e73416SDavid S. Miller daddr, saddr, 1669e2d118a1SLorenzo Colitti tcp_hdr(skb)->source, tcp_hdr(skb)->dest, 1670e2d118a1SLorenzo Colitti arg->uid); 16719d6ec938SDavid S. Miller security_skb_classify_flow(skb, flowi4_to_flowi(&fl4)); 1672be9f4a44SEric Dumazet rt = ip_route_output_key(net, &fl4); 1673b23dd4feSDavid S. Miller if (IS_ERR(rt)) 16741da177e4SLinus Torvalds return; 16751da177e4SLinus Torvalds 1676bdbbb852SEric Dumazet inet_sk(sk)->tos = arg->tos; 16771da177e4SLinus Torvalds 16781da177e4SLinus Torvalds sk->sk_priority = skb->priority; 1679eddc9ec5SArnaldo Carvalho de Melo sk->sk_protocol = ip_hdr(skb)->protocol; 1680f0e48dbfSPatrick McHardy sk->sk_bound_dev_if = arg->bound_dev_if; 1681be9f4a44SEric Dumazet sk->sk_sndbuf = sysctl_wmem_default; 1682bf99b4deSPau Espin Pedrol sk->sk_mark = fl4.flowi4_mark; 16834062090eSVasily Averin err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base, 16844062090eSVasily Averin len, 0, &ipc, &rt, MSG_DONTWAIT); 16854062090eSVasily Averin if (unlikely(err)) { 16864062090eSVasily Averin ip_flush_pending_frames(sk); 16874062090eSVasily Averin goto out; 16884062090eSVasily Averin } 16894062090eSVasily Averin 1690be9f4a44SEric Dumazet nskb = skb_peek(&sk->sk_write_queue); 1691be9f4a44SEric Dumazet if (nskb) { 16921da177e4SLinus Torvalds if (arg->csumoffset >= 0) 1693be9f4a44SEric Dumazet *((__sum16 *)skb_transport_header(nskb) + 1694be9f4a44SEric Dumazet arg->csumoffset) = csum_fold(csum_add(nskb->csum, 16959c70220bSArnaldo Carvalho de Melo arg->csum)); 1696be9f4a44SEric Dumazet nskb->ip_summed = CHECKSUM_NONE; 169777968b78SDavid S. Miller ip_push_pending_frames(sk, &fl4); 16981da177e4SLinus Torvalds } 16994062090eSVasily Averin out: 17001da177e4SLinus Torvalds ip_rt_put(rt); 17011da177e4SLinus Torvalds } 17021da177e4SLinus Torvalds 17031da177e4SLinus Torvalds void __init ip_init(void) 17041da177e4SLinus Torvalds { 17051da177e4SLinus Torvalds ip_rt_init(); 17061da177e4SLinus Torvalds inet_initpeers(); 17071da177e4SLinus Torvalds 170872c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST) 170972c1d3bdSWANG Cong igmp_mc_init(); 17101da177e4SLinus Torvalds #endif 17111da177e4SLinus Torvalds } 1712