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 { 243*88bebdf5SJason A. Donenfeld struct sk_buff *segs, *nskb; 244c7ba65d7SFlorian Westphal netdev_features_t features; 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 275*88bebdf5SJason A. Donenfeld skb_list_walk_safe(segs, segs, nskb) { 276c7ba65d7SFlorian Westphal int err; 277c7ba65d7SFlorian Westphal 278a8305bffSDavid S. Miller skb_mark_not_on_list(segs); 279694869b3SEric W. Biederman err = ip_fragment(net, sk, segs, mtu, ip_finish_output2); 280c7ba65d7SFlorian Westphal 281c7ba65d7SFlorian Westphal if (err && ret == 0) 282c7ba65d7SFlorian Westphal ret = err; 283*88bebdf5SJason A. Donenfeld } 284c7ba65d7SFlorian Westphal 285c7ba65d7SFlorian Westphal return ret; 286c7ba65d7SFlorian Westphal } 287c7ba65d7SFlorian Westphal 288956fe219Sbrakmo static int __ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 2891da177e4SLinus Torvalds { 290c5501eb3SFlorian Westphal unsigned int mtu; 291c5501eb3SFlorian Westphal 2925c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM) 2935c901daaSPatrick McHardy /* Policy lookup after SNAT yielded a new policy */ 29400db4124SIan Morris if (skb_dst(skb)->xfrm) { 29548d5cad8SPatrick McHardy IPCB(skb)->flags |= IPSKB_REROUTED; 29613206b6bSEric W. Biederman return dst_output(net, sk, skb); 29748d5cad8SPatrick McHardy } 2985c901daaSPatrick McHardy #endif 299fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 300c7ba65d7SFlorian Westphal if (skb_is_gso(skb)) 301694869b3SEric W. Biederman return ip_finish_output_gso(net, sk, skb, mtu); 302c7ba65d7SFlorian Westphal 303d6b915e2SFlorian Westphal if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU)) 304694869b3SEric W. Biederman return ip_fragment(net, sk, skb, mtu, ip_finish_output2); 305c7ba65d7SFlorian Westphal 306694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 3071da177e4SLinus Torvalds } 3081da177e4SLinus Torvalds 309956fe219Sbrakmo static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 310956fe219Sbrakmo { 311956fe219Sbrakmo int ret; 312956fe219Sbrakmo 313956fe219Sbrakmo ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 314956fe219Sbrakmo switch (ret) { 315956fe219Sbrakmo case NET_XMIT_SUCCESS: 316956fe219Sbrakmo return __ip_finish_output(net, sk, skb); 317956fe219Sbrakmo case NET_XMIT_CN: 318956fe219Sbrakmo return __ip_finish_output(net, sk, skb) ? : ret; 319956fe219Sbrakmo default: 320956fe219Sbrakmo kfree_skb(skb); 321956fe219Sbrakmo return ret; 322956fe219Sbrakmo } 323956fe219Sbrakmo } 324956fe219Sbrakmo 32533b48679SDaniel Mack static int ip_mc_finish_output(struct net *net, struct sock *sk, 32633b48679SDaniel Mack struct sk_buff *skb) 32733b48679SDaniel Mack { 3285b18f128SStephen Suryaputra struct rtable *new_rt; 329d96ff269SDavid S. Miller bool do_cn = false; 330d96ff269SDavid S. Miller int ret, err; 33133b48679SDaniel Mack 33233b48679SDaniel Mack ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 333956fe219Sbrakmo switch (ret) { 334956fe219Sbrakmo case NET_XMIT_CN: 335d96ff269SDavid S. Miller do_cn = true; 336d96ff269SDavid S. Miller /* fall through */ 337d96ff269SDavid S. Miller case NET_XMIT_SUCCESS: 338d96ff269SDavid S. Miller break; 339956fe219Sbrakmo default: 34033b48679SDaniel Mack kfree_skb(skb); 34133b48679SDaniel Mack return ret; 34233b48679SDaniel Mack } 34333b48679SDaniel Mack 3445b18f128SStephen Suryaputra /* Reset rt_iif so that inet_iif() will return skb->skb_iif. Setting 3455b18f128SStephen Suryaputra * this to non-zero causes ipi_ifindex in in_pktinfo to be overwritten, 3465b18f128SStephen Suryaputra * see ipv4_pktinfo_prepare(). 3475b18f128SStephen Suryaputra */ 3485b18f128SStephen Suryaputra new_rt = rt_dst_clone(net->loopback_dev, skb_rtable(skb)); 3495b18f128SStephen Suryaputra if (new_rt) { 3505b18f128SStephen Suryaputra new_rt->rt_iif = 0; 3515b18f128SStephen Suryaputra skb_dst_drop(skb); 3525b18f128SStephen Suryaputra skb_dst_set(skb, &new_rt->dst); 3535b18f128SStephen Suryaputra } 3545b18f128SStephen Suryaputra 355d96ff269SDavid S. Miller err = dev_loopback_xmit(net, sk, skb); 356d96ff269SDavid S. Miller return (do_cn && err) ? ret : err; 35733b48679SDaniel Mack } 35833b48679SDaniel Mack 359ede2059dSEric W. Biederman int ip_mc_output(struct net *net, struct sock *sk, struct sk_buff *skb) 3601da177e4SLinus Torvalds { 361511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 362d8d1f30bSChangli Gao struct net_device *dev = rt->dst.dev; 3631da177e4SLinus Torvalds 3641da177e4SLinus Torvalds /* 3651da177e4SLinus Torvalds * If the indicated interface is up and running, send the packet. 3661da177e4SLinus Torvalds */ 36788f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3681da177e4SLinus Torvalds 3691da177e4SLinus Torvalds skb->dev = dev; 3701da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 3711da177e4SLinus Torvalds 3721da177e4SLinus Torvalds /* 3731da177e4SLinus Torvalds * Multicasts are looped back for other local users 3741da177e4SLinus Torvalds */ 3751da177e4SLinus Torvalds 3761da177e4SLinus Torvalds if (rt->rt_flags&RTCF_MULTICAST) { 3777ad6848cSOctavian Purdila if (sk_mc_loop(sk) 3781da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 3791da177e4SLinus Torvalds /* Small optimization: do not loopback not local frames, 3801da177e4SLinus Torvalds which returned after forwarding; they will be dropped 3811da177e4SLinus Torvalds by ip_mr_input in any case. 3821da177e4SLinus Torvalds Note, that local frames are looped back to be delivered 3831da177e4SLinus Torvalds to local recipients. 3841da177e4SLinus Torvalds 3851da177e4SLinus Torvalds This check is duplicated in ip_mr_input at the moment. 3861da177e4SLinus Torvalds */ 3879d4fb27dSJoe Perches && 3889d4fb27dSJoe Perches ((rt->rt_flags & RTCF_LOCAL) || 3899d4fb27dSJoe Perches !(IPCB(skb)->flags & IPSKB_FORWARDED)) 3901da177e4SLinus Torvalds #endif 3911da177e4SLinus Torvalds ) { 3921da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3931da177e4SLinus Torvalds if (newskb) 3949bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 39529a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 39633b48679SDaniel Mack ip_mc_finish_output); 3971da177e4SLinus Torvalds } 3981da177e4SLinus Torvalds 3991da177e4SLinus Torvalds /* Multicasts with ttl 0 must not go beyond the host */ 4001da177e4SLinus Torvalds 401eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl == 0) { 4021da177e4SLinus Torvalds kfree_skb(skb); 4031da177e4SLinus Torvalds return 0; 4041da177e4SLinus Torvalds } 4051da177e4SLinus Torvalds } 4061da177e4SLinus Torvalds 4071da177e4SLinus Torvalds if (rt->rt_flags&RTCF_BROADCAST) { 4081da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 4091da177e4SLinus Torvalds if (newskb) 41029a26a56SEric W. Biederman NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 41129a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 41233b48679SDaniel Mack ip_mc_finish_output); 4131da177e4SLinus Torvalds } 4141da177e4SLinus Torvalds 41529a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 41629a26a56SEric W. Biederman net, sk, skb, NULL, skb->dev, 41729a26a56SEric W. Biederman ip_finish_output, 41848d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 4191da177e4SLinus Torvalds } 4201da177e4SLinus Torvalds 421ede2059dSEric W. Biederman int ip_output(struct net *net, struct sock *sk, struct sk_buff *skb) 4221da177e4SLinus Torvalds { 42328f8bfd1SPhil Sutter struct net_device *dev = skb_dst(skb)->dev, *indev = skb->dev; 4241bd9bef6SPatrick McHardy 42588f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 4261da177e4SLinus Torvalds 4271bd9bef6SPatrick McHardy skb->dev = dev; 4281bd9bef6SPatrick McHardy skb->protocol = htons(ETH_P_IP); 4291bd9bef6SPatrick McHardy 43029a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 43128f8bfd1SPhil Sutter net, sk, skb, indev, dev, 43248d5cad8SPatrick McHardy ip_finish_output, 43348d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 4341da177e4SLinus Torvalds } 4351da177e4SLinus Torvalds 43684f9307cSEric Dumazet /* 43784f9307cSEric Dumazet * copy saddr and daddr, possibly using 64bit load/stores 43884f9307cSEric Dumazet * Equivalent to : 43984f9307cSEric Dumazet * iph->saddr = fl4->saddr; 44084f9307cSEric Dumazet * iph->daddr = fl4->daddr; 44184f9307cSEric Dumazet */ 44284f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4) 44384f9307cSEric Dumazet { 44484f9307cSEric Dumazet BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) != 44584f9307cSEric Dumazet offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr)); 44684f9307cSEric Dumazet memcpy(&iph->saddr, &fl4->saddr, 44784f9307cSEric Dumazet sizeof(fl4->saddr) + sizeof(fl4->daddr)); 44884f9307cSEric Dumazet } 44984f9307cSEric Dumazet 450b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */ 45169b9e1e0SXin Long int __ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl, 45269b9e1e0SXin Long __u8 tos) 4531da177e4SLinus Torvalds { 4541da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 45577589ce0SEric W. Biederman struct net *net = sock_net(sk); 456f6d8bd05SEric Dumazet struct ip_options_rcu *inet_opt; 457b57ae01aSDavid S. Miller struct flowi4 *fl4; 4581da177e4SLinus Torvalds struct rtable *rt; 4591da177e4SLinus Torvalds struct iphdr *iph; 460ab6e3febSEric Dumazet int res; 4611da177e4SLinus Torvalds 4621da177e4SLinus Torvalds /* Skip all of this if the packet is already routed, 4631da177e4SLinus Torvalds * f.e. by something like SCTP. 4641da177e4SLinus Torvalds */ 465ab6e3febSEric Dumazet rcu_read_lock(); 466f6d8bd05SEric Dumazet inet_opt = rcu_dereference(inet->inet_opt); 467ea4fc0d6SDavid S. Miller fl4 = &fl->u.ip4; 468511c3f92SEric Dumazet rt = skb_rtable(skb); 46900db4124SIan Morris if (rt) 4701da177e4SLinus Torvalds goto packet_routed; 4711da177e4SLinus Torvalds 4721da177e4SLinus Torvalds /* Make sure we can route this packet. */ 4731da177e4SLinus Torvalds rt = (struct rtable *)__sk_dst_check(sk, 0); 47451456b29SIan Morris if (!rt) { 4753ca3c68eSAl Viro __be32 daddr; 4761da177e4SLinus Torvalds 4771da177e4SLinus Torvalds /* Use correct destination address if we have options. */ 478c720c7e8SEric Dumazet daddr = inet->inet_daddr; 479f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.srr) 480f6d8bd05SEric Dumazet daddr = inet_opt->opt.faddr; 4811da177e4SLinus Torvalds 4821da177e4SLinus Torvalds /* If this fails, retransmit mechanism of transport layer will 4831da177e4SLinus Torvalds * keep trying until route appears or the connection times 4841da177e4SLinus Torvalds * itself out. 4851da177e4SLinus Torvalds */ 48677589ce0SEric W. Biederman rt = ip_route_output_ports(net, fl4, sk, 48778fbfd8aSDavid S. Miller daddr, inet->inet_saddr, 48878fbfd8aSDavid S. Miller inet->inet_dport, 48978fbfd8aSDavid S. Miller inet->inet_sport, 49078fbfd8aSDavid S. Miller sk->sk_protocol, 49169b9e1e0SXin Long RT_CONN_FLAGS_TOS(sk, tos), 49278fbfd8aSDavid S. Miller sk->sk_bound_dev_if); 493b23dd4feSDavid S. Miller if (IS_ERR(rt)) 4941da177e4SLinus Torvalds goto no_route; 495d8d1f30bSChangli Gao sk_setup_caps(sk, &rt->dst); 4961da177e4SLinus Torvalds } 497d8d1f30bSChangli Gao skb_dst_set_noref(skb, &rt->dst); 4981da177e4SLinus Torvalds 4991da177e4SLinus Torvalds packet_routed: 50077d5bc7eSDavid Ahern if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway) 5011da177e4SLinus Torvalds goto no_route; 5021da177e4SLinus Torvalds 5031da177e4SLinus Torvalds /* OK, we know where to send it, allocate and build IP header. */ 504f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0)); 5058856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 506eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 50769b9e1e0SXin Long *((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (tos & 0xff)); 50860ff7467SWANG Cong if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df) 5091da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 5101da177e4SLinus Torvalds else 5111da177e4SLinus Torvalds iph->frag_off = 0; 512d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 5131da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 51484f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 51584f9307cSEric Dumazet 5161da177e4SLinus Torvalds /* Transport layer set skb->h.foo itself. */ 5171da177e4SLinus Torvalds 518f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.optlen) { 519f6d8bd05SEric Dumazet iph->ihl += inet_opt->opt.optlen >> 2; 520f6d8bd05SEric Dumazet ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0); 5211da177e4SLinus Torvalds } 5221da177e4SLinus Torvalds 52377589ce0SEric W. Biederman ip_select_ident_segs(net, skb, sk, 524b6a7719aSHannes Frederic Sowa skb_shinfo(skb)->gso_segs ?: 1); 5251da177e4SLinus Torvalds 526b0270e91SEric Dumazet /* TODO : should we use skb->sk here instead of sk ? */ 5271da177e4SLinus Torvalds skb->priority = sk->sk_priority; 5284a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 5291da177e4SLinus Torvalds 53033224b16SEric W. Biederman res = ip_local_out(net, sk, skb); 531ab6e3febSEric Dumazet rcu_read_unlock(); 532ab6e3febSEric Dumazet return res; 5331da177e4SLinus Torvalds 5341da177e4SLinus Torvalds no_route: 535ab6e3febSEric Dumazet rcu_read_unlock(); 53677589ce0SEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_OUTNOROUTES); 5371da177e4SLinus Torvalds kfree_skb(skb); 5381da177e4SLinus Torvalds return -EHOSTUNREACH; 5391da177e4SLinus Torvalds } 54069b9e1e0SXin Long EXPORT_SYMBOL(__ip_queue_xmit); 5411da177e4SLinus Torvalds 5421da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from) 5431da177e4SLinus Torvalds { 5441da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 5451da177e4SLinus Torvalds to->priority = from->priority; 5461da177e4SLinus Torvalds to->protocol = from->protocol; 547d2f0c961SShmulik Ladkani to->skb_iif = from->skb_iif; 548adf30907SEric Dumazet skb_dst_drop(to); 549fe76cda3SEric Dumazet skb_dst_copy(to, from); 5501da177e4SLinus Torvalds to->dev = from->dev; 55182e91ffeSThomas Graf to->mark = from->mark; 5521da177e4SLinus Torvalds 5533dd1c9a1SPaolo Abeni skb_copy_hash(to, from); 5543dd1c9a1SPaolo Abeni 5551da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 5561da177e4SLinus Torvalds to->tc_index = from->tc_index; 5571da177e4SLinus Torvalds #endif 558e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 559df5042f4SFlorian Westphal skb_ext_copy(to, from); 5606ca40d4eSJavier Martinez Canillas #if IS_ENABLED(CONFIG_IP_VS) 561c98d80edSJulian Anastasov to->ipvs_property = from->ipvs_property; 562c98d80edSJulian Anastasov #endif 563984bc16cSJames Morris skb_copy_secmark(to, from); 5641da177e4SLinus Torvalds } 5651da177e4SLinus Torvalds 566694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 567c5501eb3SFlorian Westphal unsigned int mtu, 568694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 56949d16b23SAndy Zhou { 57049d16b23SAndy Zhou struct iphdr *iph = ip_hdr(skb); 57149d16b23SAndy Zhou 572d6b915e2SFlorian Westphal if ((iph->frag_off & htons(IP_DF)) == 0) 573694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 574d6b915e2SFlorian Westphal 575d6b915e2SFlorian Westphal if (unlikely(!skb->ignore_df || 57649d16b23SAndy Zhou (IPCB(skb)->frag_max_size && 57749d16b23SAndy Zhou IPCB(skb)->frag_max_size > mtu))) { 5789479b0afSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 57949d16b23SAndy Zhou icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, 58049d16b23SAndy Zhou htonl(mtu)); 58149d16b23SAndy Zhou kfree_skb(skb); 58249d16b23SAndy Zhou return -EMSGSIZE; 58349d16b23SAndy Zhou } 58449d16b23SAndy Zhou 585694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 58649d16b23SAndy Zhou } 58749d16b23SAndy Zhou 588c8b17be0SPablo Neira Ayuso void ip_fraglist_init(struct sk_buff *skb, struct iphdr *iph, 589c8b17be0SPablo Neira Ayuso unsigned int hlen, struct ip_fraglist_iter *iter) 590c8b17be0SPablo Neira Ayuso { 591c8b17be0SPablo Neira Ayuso unsigned int first_len = skb_pagelen(skb); 592c8b17be0SPablo Neira Ayuso 593b7034146SEric Dumazet iter->frag = skb_shinfo(skb)->frag_list; 594c8b17be0SPablo Neira Ayuso skb_frag_list_init(skb); 595c8b17be0SPablo Neira Ayuso 596c8b17be0SPablo Neira Ayuso iter->offset = 0; 597c8b17be0SPablo Neira Ayuso iter->iph = iph; 598c8b17be0SPablo Neira Ayuso iter->hlen = hlen; 599c8b17be0SPablo Neira Ayuso 600c8b17be0SPablo Neira Ayuso skb->data_len = first_len - skb_headlen(skb); 601c8b17be0SPablo Neira Ayuso skb->len = first_len; 602c8b17be0SPablo Neira Ayuso iph->tot_len = htons(first_len); 603c8b17be0SPablo Neira Ayuso iph->frag_off = htons(IP_MF); 604c8b17be0SPablo Neira Ayuso ip_send_check(iph); 605c8b17be0SPablo Neira Ayuso } 606c8b17be0SPablo Neira Ayuso EXPORT_SYMBOL(ip_fraglist_init); 607c8b17be0SPablo Neira Ayuso 60819c3401aSPablo Neira Ayuso static void ip_fraglist_ipcb_prepare(struct sk_buff *skb, 60919c3401aSPablo Neira Ayuso struct ip_fraglist_iter *iter) 61019c3401aSPablo Neira Ayuso { 61119c3401aSPablo Neira Ayuso struct sk_buff *to = iter->frag; 61219c3401aSPablo Neira Ayuso 61319c3401aSPablo Neira Ayuso /* Copy the flags to each fragment. */ 61419c3401aSPablo Neira Ayuso IPCB(to)->flags = IPCB(skb)->flags; 61519c3401aSPablo Neira Ayuso 61619c3401aSPablo Neira Ayuso if (iter->offset == 0) 61719c3401aSPablo Neira Ayuso ip_options_fragment(to); 61819c3401aSPablo Neira Ayuso } 61919c3401aSPablo Neira Ayuso 620c8b17be0SPablo Neira Ayuso void ip_fraglist_prepare(struct sk_buff *skb, struct ip_fraglist_iter *iter) 621c8b17be0SPablo Neira Ayuso { 622c8b17be0SPablo Neira Ayuso unsigned int hlen = iter->hlen; 623c8b17be0SPablo Neira Ayuso struct iphdr *iph = iter->iph; 624c8b17be0SPablo Neira Ayuso struct sk_buff *frag; 625c8b17be0SPablo Neira Ayuso 626c8b17be0SPablo Neira Ayuso frag = iter->frag; 627c8b17be0SPablo Neira Ayuso frag->ip_summed = CHECKSUM_NONE; 628c8b17be0SPablo Neira Ayuso skb_reset_transport_header(frag); 629c8b17be0SPablo Neira Ayuso __skb_push(frag, hlen); 630c8b17be0SPablo Neira Ayuso skb_reset_network_header(frag); 631c8b17be0SPablo Neira Ayuso memcpy(skb_network_header(frag), iph, hlen); 632c8b17be0SPablo Neira Ayuso iter->iph = ip_hdr(frag); 633c8b17be0SPablo Neira Ayuso iph = iter->iph; 634c8b17be0SPablo Neira Ayuso iph->tot_len = htons(frag->len); 635c8b17be0SPablo Neira Ayuso ip_copy_metadata(frag, skb); 636c8b17be0SPablo Neira Ayuso iter->offset += skb->len - hlen; 637c8b17be0SPablo Neira Ayuso iph->frag_off = htons(iter->offset >> 3); 638c8b17be0SPablo Neira Ayuso if (frag->next) 639c8b17be0SPablo Neira Ayuso iph->frag_off |= htons(IP_MF); 640c8b17be0SPablo Neira Ayuso /* Ready, complete checksum */ 641c8b17be0SPablo Neira Ayuso ip_send_check(iph); 642c8b17be0SPablo Neira Ayuso } 643c8b17be0SPablo Neira Ayuso EXPORT_SYMBOL(ip_fraglist_prepare); 644c8b17be0SPablo Neira Ayuso 645065ff79fSPablo Neira Ayuso void ip_frag_init(struct sk_buff *skb, unsigned int hlen, 646e7a409c3SEric Dumazet unsigned int ll_rs, unsigned int mtu, bool DF, 647065ff79fSPablo Neira Ayuso struct ip_frag_state *state) 648065ff79fSPablo Neira Ayuso { 649065ff79fSPablo Neira Ayuso struct iphdr *iph = ip_hdr(skb); 650065ff79fSPablo Neira Ayuso 651e7a409c3SEric Dumazet state->DF = DF; 652065ff79fSPablo Neira Ayuso state->hlen = hlen; 653065ff79fSPablo Neira Ayuso state->ll_rs = ll_rs; 654065ff79fSPablo Neira Ayuso state->mtu = mtu; 655065ff79fSPablo Neira Ayuso 656065ff79fSPablo Neira Ayuso state->left = skb->len - hlen; /* Space per frame */ 657065ff79fSPablo Neira Ayuso state->ptr = hlen; /* Where to start from */ 658065ff79fSPablo Neira Ayuso 659065ff79fSPablo Neira Ayuso state->offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3; 660065ff79fSPablo Neira Ayuso state->not_last_frag = iph->frag_off & htons(IP_MF); 661065ff79fSPablo Neira Ayuso } 662065ff79fSPablo Neira Ayuso EXPORT_SYMBOL(ip_frag_init); 663065ff79fSPablo Neira Ayuso 66419c3401aSPablo Neira Ayuso static void ip_frag_ipcb(struct sk_buff *from, struct sk_buff *to, 66519c3401aSPablo Neira Ayuso bool first_frag, struct ip_frag_state *state) 66619c3401aSPablo Neira Ayuso { 66719c3401aSPablo Neira Ayuso /* Copy the flags to each fragment. */ 66819c3401aSPablo Neira Ayuso IPCB(to)->flags = IPCB(from)->flags; 66919c3401aSPablo Neira Ayuso 67019c3401aSPablo Neira Ayuso /* ANK: dirty, but effective trick. Upgrade options only if 67119c3401aSPablo Neira Ayuso * the segment to be fragmented was THE FIRST (otherwise, 67219c3401aSPablo Neira Ayuso * options are already fixed) and make it ONCE 67319c3401aSPablo Neira Ayuso * on the initial skb, so that all the following fragments 67419c3401aSPablo Neira Ayuso * will inherit fixed options. 67519c3401aSPablo Neira Ayuso */ 67619c3401aSPablo Neira Ayuso if (first_frag) 67719c3401aSPablo Neira Ayuso ip_options_fragment(from); 67819c3401aSPablo Neira Ayuso } 67919c3401aSPablo Neira Ayuso 680065ff79fSPablo Neira Ayuso struct sk_buff *ip_frag_next(struct sk_buff *skb, struct ip_frag_state *state) 681065ff79fSPablo Neira Ayuso { 682065ff79fSPablo Neira Ayuso unsigned int len = state->left; 683065ff79fSPablo Neira Ayuso struct sk_buff *skb2; 684065ff79fSPablo Neira Ayuso struct iphdr *iph; 685065ff79fSPablo Neira Ayuso 686065ff79fSPablo Neira Ayuso len = state->left; 687065ff79fSPablo Neira Ayuso /* IF: it doesn't fit, use 'mtu' - the data space left */ 688065ff79fSPablo Neira Ayuso if (len > state->mtu) 689065ff79fSPablo Neira Ayuso len = state->mtu; 690065ff79fSPablo Neira Ayuso /* IF: we are not sending up to and including the packet end 691065ff79fSPablo Neira Ayuso then align the next start on an eight byte boundary */ 692065ff79fSPablo Neira Ayuso if (len < state->left) { 693065ff79fSPablo Neira Ayuso len &= ~7; 694065ff79fSPablo Neira Ayuso } 695065ff79fSPablo Neira Ayuso 696065ff79fSPablo Neira Ayuso /* Allocate buffer */ 697065ff79fSPablo Neira Ayuso skb2 = alloc_skb(len + state->hlen + state->ll_rs, GFP_ATOMIC); 698065ff79fSPablo Neira Ayuso if (!skb2) 699065ff79fSPablo Neira Ayuso return ERR_PTR(-ENOMEM); 700065ff79fSPablo Neira Ayuso 701065ff79fSPablo Neira Ayuso /* 702065ff79fSPablo Neira Ayuso * Set up data on packet 703065ff79fSPablo Neira Ayuso */ 704065ff79fSPablo Neira Ayuso 705065ff79fSPablo Neira Ayuso ip_copy_metadata(skb2, skb); 706065ff79fSPablo Neira Ayuso skb_reserve(skb2, state->ll_rs); 707065ff79fSPablo Neira Ayuso skb_put(skb2, len + state->hlen); 708065ff79fSPablo Neira Ayuso skb_reset_network_header(skb2); 709065ff79fSPablo Neira Ayuso skb2->transport_header = skb2->network_header + state->hlen; 710065ff79fSPablo Neira Ayuso 711065ff79fSPablo Neira Ayuso /* 712065ff79fSPablo Neira Ayuso * Charge the memory for the fragment to any owner 713065ff79fSPablo Neira Ayuso * it might possess 714065ff79fSPablo Neira Ayuso */ 715065ff79fSPablo Neira Ayuso 716065ff79fSPablo Neira Ayuso if (skb->sk) 717065ff79fSPablo Neira Ayuso skb_set_owner_w(skb2, skb->sk); 718065ff79fSPablo Neira Ayuso 719065ff79fSPablo Neira Ayuso /* 720065ff79fSPablo Neira Ayuso * Copy the packet header into the new buffer. 721065ff79fSPablo Neira Ayuso */ 722065ff79fSPablo Neira Ayuso 723065ff79fSPablo Neira Ayuso skb_copy_from_linear_data(skb, skb_network_header(skb2), state->hlen); 724065ff79fSPablo Neira Ayuso 725065ff79fSPablo Neira Ayuso /* 726065ff79fSPablo Neira Ayuso * Copy a block of the IP datagram. 727065ff79fSPablo Neira Ayuso */ 728065ff79fSPablo Neira Ayuso if (skb_copy_bits(skb, state->ptr, skb_transport_header(skb2), len)) 729065ff79fSPablo Neira Ayuso BUG(); 730065ff79fSPablo Neira Ayuso state->left -= len; 731065ff79fSPablo Neira Ayuso 732065ff79fSPablo Neira Ayuso /* 733065ff79fSPablo Neira Ayuso * Fill in the new header fields. 734065ff79fSPablo Neira Ayuso */ 735065ff79fSPablo Neira Ayuso iph = ip_hdr(skb2); 736065ff79fSPablo Neira Ayuso iph->frag_off = htons((state->offset >> 3)); 737e7a409c3SEric Dumazet if (state->DF) 738e7a409c3SEric Dumazet iph->frag_off |= htons(IP_DF); 739065ff79fSPablo Neira Ayuso 740065ff79fSPablo Neira Ayuso /* 741065ff79fSPablo Neira Ayuso * Added AC : If we are fragmenting a fragment that's not the 742065ff79fSPablo Neira Ayuso * last fragment then keep MF on each bit 743065ff79fSPablo Neira Ayuso */ 744065ff79fSPablo Neira Ayuso if (state->left > 0 || state->not_last_frag) 745065ff79fSPablo Neira Ayuso iph->frag_off |= htons(IP_MF); 746065ff79fSPablo Neira Ayuso state->ptr += len; 747065ff79fSPablo Neira Ayuso state->offset += len; 748065ff79fSPablo Neira Ayuso 749065ff79fSPablo Neira Ayuso iph->tot_len = htons(len + state->hlen); 750065ff79fSPablo Neira Ayuso 751065ff79fSPablo Neira Ayuso ip_send_check(iph); 752065ff79fSPablo Neira Ayuso 753065ff79fSPablo Neira Ayuso return skb2; 754065ff79fSPablo Neira Ayuso } 755065ff79fSPablo Neira Ayuso EXPORT_SYMBOL(ip_frag_next); 756065ff79fSPablo Neira Ayuso 7571da177e4SLinus Torvalds /* 7581da177e4SLinus Torvalds * This IP datagram is too large to be sent in one piece. Break it up into 7591da177e4SLinus Torvalds * smaller pieces (each of size equal to IP header plus 7601da177e4SLinus Torvalds * a block of the data of the original IP data part) that will yet fit in a 7611da177e4SLinus Torvalds * single device frame, and queue such a frame for sending. 7621da177e4SLinus Torvalds */ 7631da177e4SLinus Torvalds 764694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 765694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 7661da177e4SLinus Torvalds { 7671da177e4SLinus Torvalds struct iphdr *iph; 7681da177e4SLinus Torvalds struct sk_buff *skb2; 769511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 770065ff79fSPablo Neira Ayuso unsigned int mtu, hlen, ll_rs; 771c8b17be0SPablo Neira Ayuso struct ip_fraglist_iter iter; 7729669fffcSEric Dumazet ktime_t tstamp = skb->tstamp; 773065ff79fSPablo Neira Ayuso struct ip_frag_state state; 7741da177e4SLinus Torvalds int err = 0; 7751da177e4SLinus Torvalds 776dbd3393cSHannes Frederic Sowa /* for offloaded checksums cleanup checksum before fragmentation */ 777dbd3393cSHannes Frederic Sowa if (skb->ip_summed == CHECKSUM_PARTIAL && 778dbd3393cSHannes Frederic Sowa (err = skb_checksum_help(skb))) 779dbd3393cSHannes Frederic Sowa goto fail; 780dbd3393cSHannes Frederic Sowa 7811da177e4SLinus Torvalds /* 7821da177e4SLinus Torvalds * Point into the IP datagram header. 7831da177e4SLinus Torvalds */ 7841da177e4SLinus Torvalds 785eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 7861da177e4SLinus Torvalds 787fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 788d6b915e2SFlorian Westphal if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu) 789d6b915e2SFlorian Westphal mtu = IPCB(skb)->frag_max_size; 7901da177e4SLinus Torvalds 7911da177e4SLinus Torvalds /* 7921da177e4SLinus Torvalds * Setup starting values. 7931da177e4SLinus Torvalds */ 7941da177e4SLinus Torvalds 7951da177e4SLinus Torvalds hlen = iph->ihl * 4; 796f87c10a8SHannes Frederic Sowa mtu = mtu - hlen; /* Size of data space */ 79789cee8b1SHerbert Xu IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE; 798254d900bSVasily Averin ll_rs = LL_RESERVED_SPACE(rt->dst.dev); 7991da177e4SLinus Torvalds 8001da177e4SLinus Torvalds /* When frag_list is given, use it. First, check its validity: 8011da177e4SLinus Torvalds * some transformers could create wrong frag_list or break existing 8021da177e4SLinus Torvalds * one, it is not prohibited. In this case fall back to copying. 8031da177e4SLinus Torvalds * 8041da177e4SLinus Torvalds * LATER: this step can be merged to real generation of fragments, 8051da177e4SLinus Torvalds * we can switch to copy when see the first bad fragment. 8061da177e4SLinus Torvalds */ 80721dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 8083d13008eSEric Dumazet struct sk_buff *frag, *frag2; 809c72d8cdaSAlexey Dobriyan unsigned int first_len = skb_pagelen(skb); 8101da177e4SLinus Torvalds 8111da177e4SLinus Torvalds if (first_len - hlen > mtu || 8121da177e4SLinus Torvalds ((first_len - hlen) & 7) || 81356f8a75cSPaul Gortmaker ip_is_fragment(iph) || 814254d900bSVasily Averin skb_cloned(skb) || 815254d900bSVasily Averin skb_headroom(skb) < ll_rs) 8161da177e4SLinus Torvalds goto slow_path; 8171da177e4SLinus Torvalds 818d7fcf1a5SDavid S. Miller skb_walk_frags(skb, frag) { 8191da177e4SLinus Torvalds /* Correct geometry. */ 8201da177e4SLinus Torvalds if (frag->len > mtu || 8211da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 822254d900bSVasily Averin skb_headroom(frag) < hlen + ll_rs) 8233d13008eSEric Dumazet goto slow_path_clean; 8241da177e4SLinus Torvalds 8251da177e4SLinus Torvalds /* Partially cloned skb? */ 8261da177e4SLinus Torvalds if (skb_shared(frag)) 8273d13008eSEric Dumazet goto slow_path_clean; 8282fdba6b0SHerbert Xu 8292fdba6b0SHerbert Xu BUG_ON(frag->sk); 8302fdba6b0SHerbert Xu if (skb->sk) { 8312fdba6b0SHerbert Xu frag->sk = skb->sk; 8322fdba6b0SHerbert Xu frag->destructor = sock_wfree; 8332fdba6b0SHerbert Xu } 8343d13008eSEric Dumazet skb->truesize -= frag->truesize; 8351da177e4SLinus Torvalds } 8361da177e4SLinus Torvalds 8371da177e4SLinus Torvalds /* Everything is OK. Generate! */ 838c8b17be0SPablo Neira Ayuso ip_fraglist_init(skb, iph, hlen, &iter); 8391da177e4SLinus Torvalds 8401da177e4SLinus Torvalds for (;;) { 8411da177e4SLinus Torvalds /* Prepare header of the next frame, 8421da177e4SLinus Torvalds * before previous one went down. */ 84319c3401aSPablo Neira Ayuso if (iter.frag) { 84419c3401aSPablo Neira Ayuso ip_fraglist_ipcb_prepare(skb, &iter); 845c8b17be0SPablo Neira Ayuso ip_fraglist_prepare(skb, &iter); 84619c3401aSPablo Neira Ayuso } 8471da177e4SLinus Torvalds 8489669fffcSEric Dumazet skb->tstamp = tstamp; 849694869b3SEric W. Biederman err = output(net, sk, skb); 8501da177e4SLinus Torvalds 851dafee490SWei Dong if (!err) 85226a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 853c8b17be0SPablo Neira Ayuso if (err || !iter.frag) 8541da177e4SLinus Torvalds break; 8551da177e4SLinus Torvalds 856c8b17be0SPablo Neira Ayuso skb = ip_fraglist_next(&iter); 8571da177e4SLinus Torvalds } 8581da177e4SLinus Torvalds 8591da177e4SLinus Torvalds if (err == 0) { 86026a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 8611da177e4SLinus Torvalds return 0; 8621da177e4SLinus Torvalds } 8631da177e4SLinus Torvalds 864b7034146SEric Dumazet kfree_skb_list(iter.frag); 865942f146aSPablo Neira Ayuso 86626a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 8671da177e4SLinus Torvalds return err; 8683d13008eSEric Dumazet 8693d13008eSEric Dumazet slow_path_clean: 8703d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 8713d13008eSEric Dumazet if (frag2 == frag) 8723d13008eSEric Dumazet break; 8733d13008eSEric Dumazet frag2->sk = NULL; 8743d13008eSEric Dumazet frag2->destructor = NULL; 8753d13008eSEric Dumazet skb->truesize += frag2->truesize; 8763d13008eSEric Dumazet } 8771da177e4SLinus Torvalds } 8781da177e4SLinus Torvalds 8791da177e4SLinus Torvalds slow_path: 8801da177e4SLinus Torvalds /* 8811da177e4SLinus Torvalds * Fragment the datagram. 8821da177e4SLinus Torvalds */ 8831da177e4SLinus Torvalds 884e7a409c3SEric Dumazet ip_frag_init(skb, hlen, ll_rs, mtu, IPCB(skb)->flags & IPSKB_FRAG_PMTU, 885e7a409c3SEric Dumazet &state); 8861da177e4SLinus Torvalds 8871da177e4SLinus Torvalds /* 8881da177e4SLinus Torvalds * Keep copying data until we run out. 8891da177e4SLinus Torvalds */ 8901da177e4SLinus Torvalds 891065ff79fSPablo Neira Ayuso while (state.left > 0) { 89219c3401aSPablo Neira Ayuso bool first_frag = (state.offset == 0); 89319c3401aSPablo Neira Ayuso 894065ff79fSPablo Neira Ayuso skb2 = ip_frag_next(skb, &state); 895065ff79fSPablo Neira Ayuso if (IS_ERR(skb2)) { 896065ff79fSPablo Neira Ayuso err = PTR_ERR(skb2); 8971da177e4SLinus Torvalds goto fail; 8981da177e4SLinus Torvalds } 89919c3401aSPablo Neira Ayuso ip_frag_ipcb(skb, skb2, first_frag, &state); 9001da177e4SLinus Torvalds 9011da177e4SLinus Torvalds /* 9021da177e4SLinus Torvalds * Put this fragment into the sending queue. 9031da177e4SLinus Torvalds */ 9049669fffcSEric Dumazet skb2->tstamp = tstamp; 905694869b3SEric W. Biederman err = output(net, sk, skb2); 9061da177e4SLinus Torvalds if (err) 9071da177e4SLinus Torvalds goto fail; 908dafee490SWei Dong 90926a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 9101da177e4SLinus Torvalds } 9115d0ba55bSEric Dumazet consume_skb(skb); 91226a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 9131da177e4SLinus Torvalds return err; 9141da177e4SLinus Torvalds 9151da177e4SLinus Torvalds fail: 9161da177e4SLinus Torvalds kfree_skb(skb); 91726a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 9181da177e4SLinus Torvalds return err; 9191da177e4SLinus Torvalds } 92049d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment); 9212e2f7aefSPatrick McHardy 9221da177e4SLinus Torvalds int 9231da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb) 9241da177e4SLinus Torvalds { 925f69e6d13SAl Viro struct msghdr *msg = from; 9261da177e4SLinus Torvalds 92784fa7933SPatrick McHardy if (skb->ip_summed == CHECKSUM_PARTIAL) { 9280b62fca2SAl Viro if (!copy_from_iter_full(to, len, &msg->msg_iter)) 9291da177e4SLinus Torvalds return -EFAULT; 9301da177e4SLinus Torvalds } else { 93144bb9363SAl Viro __wsum csum = 0; 9320b62fca2SAl Viro if (!csum_and_copy_from_iter_full(to, len, &csum, &msg->msg_iter)) 9331da177e4SLinus Torvalds return -EFAULT; 9341da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 9351da177e4SLinus Torvalds } 9361da177e4SLinus Torvalds return 0; 9371da177e4SLinus Torvalds } 9384bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag); 9391da177e4SLinus Torvalds 94044bb9363SAl Viro static inline __wsum 9411da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy) 9421da177e4SLinus Torvalds { 9431da177e4SLinus Torvalds char *kaddr; 94444bb9363SAl Viro __wsum csum; 9451da177e4SLinus Torvalds kaddr = kmap(page); 9461da177e4SLinus Torvalds csum = csum_partial(kaddr + offset, copy, 0); 9471da177e4SLinus Torvalds kunmap(page); 9481da177e4SLinus Torvalds return csum; 9491da177e4SLinus Torvalds } 9501da177e4SLinus Torvalds 951f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk, 952f5fca608SDavid S. Miller struct flowi4 *fl4, 953f5fca608SDavid S. Miller struct sk_buff_head *queue, 9541470ddf7SHerbert Xu struct inet_cork *cork, 9555640f768SEric Dumazet struct page_frag *pfrag, 9561470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, 9571470ddf7SHerbert Xu int len, int odd, struct sk_buff *skb), 9581da177e4SLinus Torvalds void *from, int length, int transhdrlen, 9591da177e4SLinus Torvalds unsigned int flags) 9601da177e4SLinus Torvalds { 9611da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 962b5947e5dSWillem de Bruijn struct ubuf_info *uarg = NULL; 9631da177e4SLinus Torvalds struct sk_buff *skb; 9641da177e4SLinus Torvalds 96507df5294SHerbert Xu struct ip_options *opt = cork->opt; 9661da177e4SLinus Torvalds int hh_len; 9671da177e4SLinus Torvalds int exthdrlen; 9681da177e4SLinus Torvalds int mtu; 9691da177e4SLinus Torvalds int copy; 9701da177e4SLinus Torvalds int err; 9711da177e4SLinus Torvalds int offset = 0; 972daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, maxnonfragsize; 9731da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 9741470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 975694aba69SEric Dumazet unsigned int wmem_alloc_delta = 0; 976100f6d8eSWillem de Bruijn bool paged, extra_uref = false; 97709c2d251SWillem de Bruijn u32 tskey = 0; 9781da177e4SLinus Torvalds 97996d7303eSSteffen Klassert skb = skb_peek_tail(queue); 98096d7303eSSteffen Klassert 98196d7303eSSteffen Klassert exthdrlen = !skb ? rt->dst.header_len : 0; 982bec1f6f6SWillem de Bruijn mtu = cork->gso_size ? IP_MAX_MTU : cork->fragsize; 98315e36f5bSWillem de Bruijn paged = !!cork->gso_size; 984bec1f6f6SWillem de Bruijn 98509c2d251SWillem de Bruijn if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP && 98609c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 98709c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 9881470ddf7SHerbert Xu 989d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 9901da177e4SLinus Torvalds 9911da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 9921da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 99360ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 9941da177e4SLinus Torvalds 995daba287bSHannes Frederic Sowa if (cork->length + length > maxnonfragsize - fragheaderlen) { 996f5fca608SDavid S. Miller ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 99761e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 9981da177e4SLinus Torvalds return -EMSGSIZE; 9991da177e4SLinus Torvalds } 10001da177e4SLinus Torvalds 10011da177e4SLinus Torvalds /* 10021da177e4SLinus Torvalds * transhdrlen > 0 means that this is the first fragment and we wish 10031da177e4SLinus Torvalds * it won't be fragmented in the future. 10041da177e4SLinus Torvalds */ 10051da177e4SLinus Torvalds if (transhdrlen && 10061da177e4SLinus Torvalds length + fragheaderlen <= mtu && 1007c8cd0989STom Herbert rt->dst.dev->features & (NETIF_F_HW_CSUM | NETIF_F_IP_CSUM) && 1008bec1f6f6SWillem de Bruijn (!(flags & MSG_MORE) || cork->gso_size) && 1009cd027a54SJacek Kalwas (!exthdrlen || (rt->dst.dev->features & NETIF_F_HW_ESP_TX_CSUM))) 101084fa7933SPatrick McHardy csummode = CHECKSUM_PARTIAL; 10111da177e4SLinus Torvalds 1012b5947e5dSWillem de Bruijn if (flags & MSG_ZEROCOPY && length && sock_flag(sk, SOCK_ZEROCOPY)) { 1013b5947e5dSWillem de Bruijn uarg = sock_zerocopy_realloc(sk, length, skb_zcopy(skb)); 1014b5947e5dSWillem de Bruijn if (!uarg) 1015b5947e5dSWillem de Bruijn return -ENOBUFS; 1016522924b5SWillem de Bruijn extra_uref = !skb_zcopy(skb); /* only ref on new uarg */ 1017b5947e5dSWillem de Bruijn if (rt->dst.dev->features & NETIF_F_SG && 1018b5947e5dSWillem de Bruijn csummode == CHECKSUM_PARTIAL) { 1019b5947e5dSWillem de Bruijn paged = true; 1020b5947e5dSWillem de Bruijn } else { 1021b5947e5dSWillem de Bruijn uarg->zerocopy = 0; 102252900d22SWillem de Bruijn skb_zcopy_set(skb, uarg, &extra_uref); 1023b5947e5dSWillem de Bruijn } 1024b5947e5dSWillem de Bruijn } 1025b5947e5dSWillem de Bruijn 10261470ddf7SHerbert Xu cork->length += length; 10271da177e4SLinus Torvalds 10281da177e4SLinus Torvalds /* So, what's going on in the loop below? 10291da177e4SLinus Torvalds * 10301da177e4SLinus Torvalds * We use calculated fragment length to generate chained skb, 10311da177e4SLinus Torvalds * each of segments is IP fragment ready for sending to network after 10321da177e4SLinus Torvalds * adding appropriate IP header. 10331da177e4SLinus Torvalds */ 10341da177e4SLinus Torvalds 103526cde9f7SHerbert Xu if (!skb) 10361da177e4SLinus Torvalds goto alloc_new_skb; 10371da177e4SLinus Torvalds 10381da177e4SLinus Torvalds while (length > 0) { 10391da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 10401da177e4SLinus Torvalds copy = mtu - skb->len; 10411da177e4SLinus Torvalds if (copy < length) 10421da177e4SLinus Torvalds copy = maxfraglen - skb->len; 10431da177e4SLinus Torvalds if (copy <= 0) { 10441da177e4SLinus Torvalds char *data; 10451da177e4SLinus Torvalds unsigned int datalen; 10461da177e4SLinus Torvalds unsigned int fraglen; 10471da177e4SLinus Torvalds unsigned int fraggap; 10481da177e4SLinus Torvalds unsigned int alloclen; 1049aba36930SWillem de Bruijn unsigned int pagedlen; 10501da177e4SLinus Torvalds struct sk_buff *skb_prev; 10511da177e4SLinus Torvalds alloc_new_skb: 10521da177e4SLinus Torvalds skb_prev = skb; 10531da177e4SLinus Torvalds if (skb_prev) 10541da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 10551da177e4SLinus Torvalds else 10561da177e4SLinus Torvalds fraggap = 0; 10571da177e4SLinus Torvalds 10581da177e4SLinus Torvalds /* 10591da177e4SLinus Torvalds * If remaining data exceeds the mtu, 10601da177e4SLinus Torvalds * we know we need more fragment(s). 10611da177e4SLinus Torvalds */ 10621da177e4SLinus Torvalds datalen = length + fraggap; 10631da177e4SLinus Torvalds if (datalen > mtu - fragheaderlen) 10641da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 10651da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 1066aba36930SWillem de Bruijn pagedlen = 0; 10671da177e4SLinus Torvalds 10681da177e4SLinus Torvalds if ((flags & MSG_MORE) && 1069d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 10701da177e4SLinus Torvalds alloclen = mtu; 107115e36f5bSWillem de Bruijn else if (!paged) 107259104f06SEric Dumazet alloclen = fraglen; 107315e36f5bSWillem de Bruijn else { 107415e36f5bSWillem de Bruijn alloclen = min_t(int, fraglen, MAX_HEADER); 107515e36f5bSWillem de Bruijn pagedlen = fraglen - alloclen; 107615e36f5bSWillem de Bruijn } 10771da177e4SLinus Torvalds 1078353e5c9aSSteffen Klassert alloclen += exthdrlen; 1079353e5c9aSSteffen Klassert 10801da177e4SLinus Torvalds /* The last fragment gets additional space at tail. 10811da177e4SLinus Torvalds * Note, with MSG_MORE we overallocate on fragments, 10821da177e4SLinus Torvalds * because we have no idea what fragment will be 10831da177e4SLinus Torvalds * the last. 10841da177e4SLinus Torvalds */ 108533f99dc7SSteffen Klassert if (datalen == length + fraggap) 1086d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 108733f99dc7SSteffen Klassert 10881da177e4SLinus Torvalds if (transhdrlen) { 10891da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 10901da177e4SLinus Torvalds alloclen + hh_len + 15, 10911da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 10921da177e4SLinus Torvalds } else { 10931da177e4SLinus Torvalds skb = NULL; 1094694aba69SEric Dumazet if (refcount_read(&sk->sk_wmem_alloc) + wmem_alloc_delta <= 10951da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 1096694aba69SEric Dumazet skb = alloc_skb(alloclen + hh_len + 15, 10971da177e4SLinus Torvalds sk->sk_allocation); 109851456b29SIan Morris if (unlikely(!skb)) 10991da177e4SLinus Torvalds err = -ENOBUFS; 11001da177e4SLinus Torvalds } 110151456b29SIan Morris if (!skb) 11021da177e4SLinus Torvalds goto error; 11031da177e4SLinus Torvalds 11041da177e4SLinus Torvalds /* 11051da177e4SLinus Torvalds * Fill in the control structures 11061da177e4SLinus Torvalds */ 11071da177e4SLinus Torvalds skb->ip_summed = csummode; 11081da177e4SLinus Torvalds skb->csum = 0; 11091da177e4SLinus Torvalds skb_reserve(skb, hh_len); 111011878b40SWillem de Bruijn 11111da177e4SLinus Torvalds /* 11121da177e4SLinus Torvalds * Find where to start putting bytes. 11131da177e4SLinus Torvalds */ 111415e36f5bSWillem de Bruijn data = skb_put(skb, fraglen + exthdrlen - pagedlen); 1115c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 1116b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1117b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 1118353e5c9aSSteffen Klassert data += fragheaderlen + exthdrlen; 11191da177e4SLinus Torvalds 11201da177e4SLinus Torvalds if (fraggap) { 11211da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 11221da177e4SLinus Torvalds skb_prev, maxfraglen, 11231da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 11241da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 11251da177e4SLinus Torvalds skb->csum); 11261da177e4SLinus Torvalds data += fraggap; 1127e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 11281da177e4SLinus Torvalds } 11291da177e4SLinus Torvalds 113015e36f5bSWillem de Bruijn copy = datalen - transhdrlen - fraggap - pagedlen; 11311da177e4SLinus Torvalds if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 11321da177e4SLinus Torvalds err = -EFAULT; 11331da177e4SLinus Torvalds kfree_skb(skb); 11341da177e4SLinus Torvalds goto error; 11351da177e4SLinus Torvalds } 11361da177e4SLinus Torvalds 11371da177e4SLinus Torvalds offset += copy; 113815e36f5bSWillem de Bruijn length -= copy + transhdrlen; 11391da177e4SLinus Torvalds transhdrlen = 0; 11401da177e4SLinus Torvalds exthdrlen = 0; 11411da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 11421da177e4SLinus Torvalds 114352900d22SWillem de Bruijn /* only the initial fragment is time stamped */ 114452900d22SWillem de Bruijn skb_shinfo(skb)->tx_flags = cork->tx_flags; 114552900d22SWillem de Bruijn cork->tx_flags = 0; 114652900d22SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 114752900d22SWillem de Bruijn tskey = 0; 114852900d22SWillem de Bruijn skb_zcopy_set(skb, uarg, &extra_uref); 114952900d22SWillem de Bruijn 11500dec879fSJulian Anastasov if ((flags & MSG_CONFIRM) && !skb_prev) 11510dec879fSJulian Anastasov skb_set_dst_pending_confirm(skb, 1); 11520dec879fSJulian Anastasov 11531da177e4SLinus Torvalds /* 11541da177e4SLinus Torvalds * Put the packet on the pending queue. 11551da177e4SLinus Torvalds */ 1156694aba69SEric Dumazet if (!skb->destructor) { 1157694aba69SEric Dumazet skb->destructor = sock_wfree; 1158694aba69SEric Dumazet skb->sk = sk; 1159694aba69SEric Dumazet wmem_alloc_delta += skb->truesize; 1160694aba69SEric Dumazet } 11611470ddf7SHerbert Xu __skb_queue_tail(queue, skb); 11621da177e4SLinus Torvalds continue; 11631da177e4SLinus Torvalds } 11641da177e4SLinus Torvalds 11651da177e4SLinus Torvalds if (copy > length) 11661da177e4SLinus Torvalds copy = length; 11671da177e4SLinus Torvalds 1168113f99c3SWillem de Bruijn if (!(rt->dst.dev->features&NETIF_F_SG) && 1169113f99c3SWillem de Bruijn skb_tailroom(skb) >= copy) { 11701da177e4SLinus Torvalds unsigned int off; 11711da177e4SLinus Torvalds 11721da177e4SLinus Torvalds off = skb->len; 11731da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 11741da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 11751da177e4SLinus Torvalds __skb_trim(skb, off); 11761da177e4SLinus Torvalds err = -EFAULT; 11771da177e4SLinus Torvalds goto error; 11781da177e4SLinus Torvalds } 1179b5947e5dSWillem de Bruijn } else if (!uarg || !uarg->zerocopy) { 11801da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 11811da177e4SLinus Torvalds 11821da177e4SLinus Torvalds err = -ENOMEM; 11835640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 11841da177e4SLinus Torvalds goto error; 11851da177e4SLinus Torvalds 11865640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 11875640f768SEric Dumazet pfrag->offset)) { 11881da177e4SLinus Torvalds err = -EMSGSIZE; 11895640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 11901da177e4SLinus Torvalds goto error; 11915640f768SEric Dumazet 11925640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 11935640f768SEric Dumazet pfrag->offset, 0); 11945640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 11955640f768SEric Dumazet get_page(pfrag->page); 11961da177e4SLinus Torvalds } 11975640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 11985640f768SEric Dumazet if (getfrag(from, 11995640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 12005640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 12015640f768SEric Dumazet goto error_efault; 12025640f768SEric Dumazet 12035640f768SEric Dumazet pfrag->offset += copy; 12045640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 12051da177e4SLinus Torvalds skb->len += copy; 12061da177e4SLinus Torvalds skb->data_len += copy; 1207f945fa7aSHerbert Xu skb->truesize += copy; 1208694aba69SEric Dumazet wmem_alloc_delta += copy; 1209b5947e5dSWillem de Bruijn } else { 1210b5947e5dSWillem de Bruijn err = skb_zerocopy_iter_dgram(skb, from, copy); 1211b5947e5dSWillem de Bruijn if (err < 0) 1212b5947e5dSWillem de Bruijn goto error; 12131da177e4SLinus Torvalds } 12141da177e4SLinus Torvalds offset += copy; 12151da177e4SLinus Torvalds length -= copy; 12161da177e4SLinus Torvalds } 12171da177e4SLinus Torvalds 12189e8445a5SPaolo Abeni if (wmem_alloc_delta) 1219694aba69SEric Dumazet refcount_add(wmem_alloc_delta, &sk->sk_wmem_alloc); 12201da177e4SLinus Torvalds return 0; 12211da177e4SLinus Torvalds 12225640f768SEric Dumazet error_efault: 12235640f768SEric Dumazet err = -EFAULT; 12241da177e4SLinus Torvalds error: 122597ef7b4cSWillem de Bruijn if (uarg) 122652900d22SWillem de Bruijn sock_zerocopy_put_abort(uarg, extra_uref); 12271470ddf7SHerbert Xu cork->length -= length; 12285e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 1229694aba69SEric Dumazet refcount_add(wmem_alloc_delta, &sk->sk_wmem_alloc); 12301da177e4SLinus Torvalds return err; 12311da177e4SLinus Torvalds } 12321da177e4SLinus Torvalds 12331470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork, 12341470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp) 12351470ddf7SHerbert Xu { 1236f6d8bd05SEric Dumazet struct ip_options_rcu *opt; 12371470ddf7SHerbert Xu struct rtable *rt; 12381470ddf7SHerbert Xu 12399783ccd0SGao Feng rt = *rtp; 12409783ccd0SGao Feng if (unlikely(!rt)) 12419783ccd0SGao Feng return -EFAULT; 12429783ccd0SGao Feng 12431470ddf7SHerbert Xu /* 12441470ddf7SHerbert Xu * setup for corking. 12451470ddf7SHerbert Xu */ 12461470ddf7SHerbert Xu opt = ipc->opt; 12471470ddf7SHerbert Xu if (opt) { 124851456b29SIan Morris if (!cork->opt) { 12491470ddf7SHerbert Xu cork->opt = kmalloc(sizeof(struct ip_options) + 40, 12501470ddf7SHerbert Xu sk->sk_allocation); 125151456b29SIan Morris if (unlikely(!cork->opt)) 12521470ddf7SHerbert Xu return -ENOBUFS; 12531470ddf7SHerbert Xu } 1254f6d8bd05SEric Dumazet memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen); 12551470ddf7SHerbert Xu cork->flags |= IPCORK_OPT; 12561470ddf7SHerbert Xu cork->addr = ipc->addr; 12571470ddf7SHerbert Xu } 12589783ccd0SGao Feng 1259482fc609SHannes Frederic Sowa cork->fragsize = ip_sk_use_pmtu(sk) ? 1260501a90c9SEric Dumazet dst_mtu(&rt->dst) : READ_ONCE(rt->dst.dev->mtu); 1261501a90c9SEric Dumazet 1262501a90c9SEric Dumazet if (!inetdev_valid_mtu(cork->fragsize)) 1263501a90c9SEric Dumazet return -ENETUNREACH; 1264bec1f6f6SWillem de Bruijn 1265fbf47813SWillem de Bruijn cork->gso_size = ipc->gso_size; 1266501a90c9SEric Dumazet 12671470ddf7SHerbert Xu cork->dst = &rt->dst; 1268501a90c9SEric Dumazet /* We stole this route, caller should not release it. */ 1269501a90c9SEric Dumazet *rtp = NULL; 1270501a90c9SEric Dumazet 12711470ddf7SHerbert Xu cork->length = 0; 1272aa661581SFrancesco Fusco cork->ttl = ipc->ttl; 1273aa661581SFrancesco Fusco cork->tos = ipc->tos; 1274c6af0c22SWillem de Bruijn cork->mark = ipc->sockc.mark; 1275aa661581SFrancesco Fusco cork->priority = ipc->priority; 1276bc969a97SJesus Sanchez-Palencia cork->transmit_time = ipc->sockc.transmit_time; 1277678ca42dSWillem de Bruijn cork->tx_flags = 0; 1278678ca42dSWillem de Bruijn sock_tx_timestamp(sk, ipc->sockc.tsflags, &cork->tx_flags); 12791470ddf7SHerbert Xu 12801470ddf7SHerbert Xu return 0; 12811470ddf7SHerbert Xu } 12821470ddf7SHerbert Xu 12831470ddf7SHerbert Xu /* 12841470ddf7SHerbert Xu * ip_append_data() and ip_append_page() can make one large IP datagram 12851470ddf7SHerbert Xu * from many pieces of data. Each pieces will be holded on the socket 12861470ddf7SHerbert Xu * until ip_push_pending_frames() is called. Each piece can be a page 12871470ddf7SHerbert Xu * or non-page data. 12881470ddf7SHerbert Xu * 12891470ddf7SHerbert Xu * Not only UDP, other transport protocols - e.g. raw sockets - can use 12901470ddf7SHerbert Xu * this interface potentially. 12911470ddf7SHerbert Xu * 12921470ddf7SHerbert Xu * LATER: length must be adjusted by pad at tail, when it is required. 12931470ddf7SHerbert Xu */ 1294f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4, 12951470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, int len, 12961470ddf7SHerbert Xu int odd, struct sk_buff *skb), 12971470ddf7SHerbert Xu void *from, int length, int transhdrlen, 12981470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 12991470ddf7SHerbert Xu unsigned int flags) 13001470ddf7SHerbert Xu { 13011470ddf7SHerbert Xu struct inet_sock *inet = inet_sk(sk); 13021470ddf7SHerbert Xu int err; 13031470ddf7SHerbert Xu 13041470ddf7SHerbert Xu if (flags&MSG_PROBE) 13051470ddf7SHerbert Xu return 0; 13061470ddf7SHerbert Xu 13071470ddf7SHerbert Xu if (skb_queue_empty(&sk->sk_write_queue)) { 1308bdc712b4SDavid S. Miller err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp); 13091470ddf7SHerbert Xu if (err) 13101470ddf7SHerbert Xu return err; 13111470ddf7SHerbert Xu } else { 13121470ddf7SHerbert Xu transhdrlen = 0; 13131470ddf7SHerbert Xu } 13141470ddf7SHerbert Xu 13155640f768SEric Dumazet return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base, 13165640f768SEric Dumazet sk_page_frag(sk), getfrag, 13171470ddf7SHerbert Xu from, length, transhdrlen, flags); 13181470ddf7SHerbert Xu } 13191470ddf7SHerbert Xu 1320f5fca608SDavid S. Miller ssize_t ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page, 13211da177e4SLinus Torvalds int offset, size_t size, int flags) 13221da177e4SLinus Torvalds { 13231da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 13241da177e4SLinus Torvalds struct sk_buff *skb; 13251da177e4SLinus Torvalds struct rtable *rt; 13261da177e4SLinus Torvalds struct ip_options *opt = NULL; 1327bdc712b4SDavid S. Miller struct inet_cork *cork; 13281da177e4SLinus Torvalds int hh_len; 13291da177e4SLinus Torvalds int mtu; 13301da177e4SLinus Torvalds int len; 13311da177e4SLinus Torvalds int err; 1332daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize; 13331da177e4SLinus Torvalds 13341da177e4SLinus Torvalds if (inet->hdrincl) 13351da177e4SLinus Torvalds return -EPERM; 13361da177e4SLinus Torvalds 13371da177e4SLinus Torvalds if (flags&MSG_PROBE) 13381da177e4SLinus Torvalds return 0; 13391da177e4SLinus Torvalds 13401da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) 13411da177e4SLinus Torvalds return -EINVAL; 13421da177e4SLinus Torvalds 1343bdc712b4SDavid S. Miller cork = &inet->cork.base; 1344bdc712b4SDavid S. Miller rt = (struct rtable *)cork->dst; 1345bdc712b4SDavid S. Miller if (cork->flags & IPCORK_OPT) 1346bdc712b4SDavid S. Miller opt = cork->opt; 13471da177e4SLinus Torvalds 1348d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) 13491da177e4SLinus Torvalds return -EOPNOTSUPP; 13501da177e4SLinus Torvalds 1351d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 1352bec1f6f6SWillem de Bruijn mtu = cork->gso_size ? IP_MAX_MTU : cork->fragsize; 13531da177e4SLinus Torvalds 13541da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 13551da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 135660ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 13571da177e4SLinus Torvalds 1358daba287bSHannes Frederic Sowa if (cork->length + size > maxnonfragsize - fragheaderlen) { 135961e7f09dSHannes Frederic Sowa ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 136061e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 13611da177e4SLinus Torvalds return -EMSGSIZE; 13621da177e4SLinus Torvalds } 13631da177e4SLinus Torvalds 136451456b29SIan Morris skb = skb_peek_tail(&sk->sk_write_queue); 136551456b29SIan Morris if (!skb) 13661da177e4SLinus Torvalds return -EINVAL; 13671da177e4SLinus Torvalds 1368a8c4a252SHannes Frederic Sowa cork->length += size; 1369e89e9cf5SAnanda Raju 13701da177e4SLinus Torvalds while (size > 0) { 13711da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 13721da177e4SLinus Torvalds len = mtu - skb->len; 13731da177e4SLinus Torvalds if (len < size) 13741da177e4SLinus Torvalds len = maxfraglen - skb->len; 1375ab2fb7e3SWillem de Bruijn 13761da177e4SLinus Torvalds if (len <= 0) { 13771da177e4SLinus Torvalds struct sk_buff *skb_prev; 13781da177e4SLinus Torvalds int alloclen; 13791da177e4SLinus Torvalds 13801da177e4SLinus Torvalds skb_prev = skb; 13811da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 13821da177e4SLinus Torvalds 13831da177e4SLinus Torvalds alloclen = fragheaderlen + hh_len + fraggap + 15; 13841da177e4SLinus Torvalds skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation); 13851da177e4SLinus Torvalds if (unlikely(!skb)) { 13861da177e4SLinus Torvalds err = -ENOBUFS; 13871da177e4SLinus Torvalds goto error; 13881da177e4SLinus Torvalds } 13891da177e4SLinus Torvalds 13901da177e4SLinus Torvalds /* 13911da177e4SLinus Torvalds * Fill in the control structures 13921da177e4SLinus Torvalds */ 13931da177e4SLinus Torvalds skb->ip_summed = CHECKSUM_NONE; 13941da177e4SLinus Torvalds skb->csum = 0; 13951da177e4SLinus Torvalds skb_reserve(skb, hh_len); 13961da177e4SLinus Torvalds 13971da177e4SLinus Torvalds /* 13981da177e4SLinus Torvalds * Find where to start putting bytes. 13991da177e4SLinus Torvalds */ 1400967b05f6SArnaldo Carvalho de Melo skb_put(skb, fragheaderlen + fraggap); 14012ca9e6f2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1402b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1403b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 14041da177e4SLinus Torvalds if (fraggap) { 1405967b05f6SArnaldo Carvalho de Melo skb->csum = skb_copy_and_csum_bits(skb_prev, 1406967b05f6SArnaldo Carvalho de Melo maxfraglen, 14079c70220bSArnaldo Carvalho de Melo skb_transport_header(skb), 1408967b05f6SArnaldo Carvalho de Melo fraggap, 0); 14091da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 14101da177e4SLinus Torvalds skb->csum); 1411e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 14121da177e4SLinus Torvalds } 14131da177e4SLinus Torvalds 14141da177e4SLinus Torvalds /* 14151da177e4SLinus Torvalds * Put the packet on the pending queue. 14161da177e4SLinus Torvalds */ 14171da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 14181da177e4SLinus Torvalds continue; 14191da177e4SLinus Torvalds } 14201da177e4SLinus Torvalds 14211da177e4SLinus Torvalds if (len > size) 14221da177e4SLinus Torvalds len = size; 1423be12a1feSHannes Frederic Sowa 1424be12a1feSHannes Frederic Sowa if (skb_append_pagefrags(skb, page, offset, len)) { 14251da177e4SLinus Torvalds err = -EMSGSIZE; 14261da177e4SLinus Torvalds goto error; 14271da177e4SLinus Torvalds } 14281da177e4SLinus Torvalds 14291da177e4SLinus Torvalds if (skb->ip_summed == CHECKSUM_NONE) { 143044bb9363SAl Viro __wsum csum; 14311da177e4SLinus Torvalds csum = csum_page(page, offset, len); 14321da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, skb->len); 14331da177e4SLinus Torvalds } 14341da177e4SLinus Torvalds 14351da177e4SLinus Torvalds skb->len += len; 14361da177e4SLinus Torvalds skb->data_len += len; 14371e34a11dSDavid S. Miller skb->truesize += len; 143814afee4bSReshetova, Elena refcount_add(len, &sk->sk_wmem_alloc); 14391da177e4SLinus Torvalds offset += len; 14401da177e4SLinus Torvalds size -= len; 14411da177e4SLinus Torvalds } 14421da177e4SLinus Torvalds return 0; 14431da177e4SLinus Torvalds 14441da177e4SLinus Torvalds error: 1445bdc712b4SDavid S. Miller cork->length -= size; 14465e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 14471da177e4SLinus Torvalds return err; 14481da177e4SLinus Torvalds } 14491da177e4SLinus Torvalds 14501470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork) 1451429f08e9SPavel Emelyanov { 14521470ddf7SHerbert Xu cork->flags &= ~IPCORK_OPT; 14531470ddf7SHerbert Xu kfree(cork->opt); 14541470ddf7SHerbert Xu cork->opt = NULL; 14551470ddf7SHerbert Xu dst_release(cork->dst); 14561470ddf7SHerbert Xu cork->dst = NULL; 1457429f08e9SPavel Emelyanov } 1458429f08e9SPavel Emelyanov 14591da177e4SLinus Torvalds /* 14601da177e4SLinus Torvalds * Combined all pending IP fragments on the socket as one IP datagram 14611da177e4SLinus Torvalds * and push them out. 14621da177e4SLinus Torvalds */ 14631c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk, 146477968b78SDavid S. Miller struct flowi4 *fl4, 14651470ddf7SHerbert Xu struct sk_buff_head *queue, 14661470ddf7SHerbert Xu struct inet_cork *cork) 14671da177e4SLinus Torvalds { 14681da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 14691da177e4SLinus Torvalds struct sk_buff **tail_skb; 14701da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 14710388b004SPavel Emelyanov struct net *net = sock_net(sk); 14721da177e4SLinus Torvalds struct ip_options *opt = NULL; 14731470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 14741da177e4SLinus Torvalds struct iphdr *iph; 147576ab608dSAlexey Dobriyan __be16 df = 0; 14761da177e4SLinus Torvalds __u8 ttl; 14771da177e4SLinus Torvalds 147851456b29SIan Morris skb = __skb_dequeue(queue); 147951456b29SIan Morris if (!skb) 14801da177e4SLinus Torvalds goto out; 14811da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 14821da177e4SLinus Torvalds 14831da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1484d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1485bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 14861470ddf7SHerbert Xu while ((tmp_skb = __skb_dequeue(queue)) != NULL) { 1487cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 14881da177e4SLinus Torvalds *tail_skb = tmp_skb; 14891da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 14901da177e4SLinus Torvalds skb->len += tmp_skb->len; 14911da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 14921da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 14931da177e4SLinus Torvalds tmp_skb->destructor = NULL; 14941da177e4SLinus Torvalds tmp_skb->sk = NULL; 14951da177e4SLinus Torvalds } 14961da177e4SLinus Torvalds 14971da177e4SLinus Torvalds /* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow 14981da177e4SLinus Torvalds * to fragment the frame generated here. No matter, what transforms 14991da177e4SLinus Torvalds * how transforms change size of the packet, it will come out. 15001da177e4SLinus Torvalds */ 150160ff7467SWANG Cong skb->ignore_df = ip_sk_ignore_df(sk); 15021da177e4SLinus Torvalds 15031da177e4SLinus Torvalds /* DF bit is set when we want to see DF on outgoing frames. 150460ff7467SWANG Cong * If ignore_df is set too, we still allow to fragment this frame 15051da177e4SLinus Torvalds * locally. */ 1506482fc609SHannes Frederic Sowa if (inet->pmtudisc == IP_PMTUDISC_DO || 1507482fc609SHannes Frederic Sowa inet->pmtudisc == IP_PMTUDISC_PROBE || 1508d8d1f30bSChangli Gao (skb->len <= dst_mtu(&rt->dst) && 1509d8d1f30bSChangli Gao ip_dont_fragment(sk, &rt->dst))) 15101da177e4SLinus Torvalds df = htons(IP_DF); 15111da177e4SLinus Torvalds 15121470ddf7SHerbert Xu if (cork->flags & IPCORK_OPT) 15131470ddf7SHerbert Xu opt = cork->opt; 15141da177e4SLinus Torvalds 1515aa661581SFrancesco Fusco if (cork->ttl != 0) 1516aa661581SFrancesco Fusco ttl = cork->ttl; 1517aa661581SFrancesco Fusco else if (rt->rt_type == RTN_MULTICAST) 15181da177e4SLinus Torvalds ttl = inet->mc_ttl; 15191da177e4SLinus Torvalds else 1520d8d1f30bSChangli Gao ttl = ip_select_ttl(inet, &rt->dst); 15211da177e4SLinus Torvalds 1522749154aaSAnsis Atteka iph = ip_hdr(skb); 15231da177e4SLinus Torvalds iph->version = 4; 15241da177e4SLinus Torvalds iph->ihl = 5; 1525aa661581SFrancesco Fusco iph->tos = (cork->tos != -1) ? cork->tos : inet->tos; 15261da177e4SLinus Torvalds iph->frag_off = df; 15271da177e4SLinus Torvalds iph->ttl = ttl; 15281da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 152984f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 1530b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, sk); 15311da177e4SLinus Torvalds 153222f728f8SDavid S. Miller if (opt) { 153322f728f8SDavid S. Miller iph->ihl += opt->optlen>>2; 153422f728f8SDavid S. Miller ip_options_build(skb, opt, cork->addr, rt, 0); 153522f728f8SDavid S. Miller } 153622f728f8SDavid S. Miller 1537aa661581SFrancesco Fusco skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority; 1538c6af0c22SWillem de Bruijn skb->mark = cork->mark; 1539bc969a97SJesus Sanchez-Palencia skb->tstamp = cork->transmit_time; 1540a21bba94SEric Dumazet /* 1541a21bba94SEric Dumazet * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec 1542a21bba94SEric Dumazet * on dst refcount 1543a21bba94SEric Dumazet */ 15441470ddf7SHerbert Xu cork->dst = NULL; 1545d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 15461da177e4SLinus Torvalds 154796793b48SDavid L Stevens if (iph->protocol == IPPROTO_ICMP) 15480388b004SPavel Emelyanov icmp_out_count(net, ((struct icmphdr *) 154996793b48SDavid L Stevens skb_transport_header(skb))->type); 155096793b48SDavid L Stevens 15511c32c5adSHerbert Xu ip_cork_release(cork); 15521c32c5adSHerbert Xu out: 15531c32c5adSHerbert Xu return skb; 15541c32c5adSHerbert Xu } 15551c32c5adSHerbert Xu 1556b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb) 15571c32c5adSHerbert Xu { 15581c32c5adSHerbert Xu int err; 15591c32c5adSHerbert Xu 156033224b16SEric W. Biederman err = ip_local_out(net, skb->sk, skb); 15611da177e4SLinus Torvalds if (err) { 15621da177e4SLinus Torvalds if (err > 0) 15636ce9e7b5SEric Dumazet err = net_xmit_errno(err); 15641da177e4SLinus Torvalds if (err) 15651c32c5adSHerbert Xu IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS); 15661da177e4SLinus Torvalds } 15671da177e4SLinus Torvalds 15681da177e4SLinus Torvalds return err; 15691da177e4SLinus Torvalds } 15701da177e4SLinus Torvalds 157177968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4) 15721470ddf7SHerbert Xu { 15731c32c5adSHerbert Xu struct sk_buff *skb; 15741c32c5adSHerbert Xu 157577968b78SDavid S. Miller skb = ip_finish_skb(sk, fl4); 15761c32c5adSHerbert Xu if (!skb) 15771c32c5adSHerbert Xu return 0; 15781c32c5adSHerbert Xu 15791c32c5adSHerbert Xu /* Netfilter gets whole the not fragmented skb. */ 1580b5ec8eeaSEric Dumazet return ip_send_skb(sock_net(sk), skb); 15811470ddf7SHerbert Xu } 15821470ddf7SHerbert Xu 15831da177e4SLinus Torvalds /* 15841da177e4SLinus Torvalds * Throw away all pending data on the socket. 15851da177e4SLinus Torvalds */ 15861470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk, 15871470ddf7SHerbert Xu struct sk_buff_head *queue, 15881470ddf7SHerbert Xu struct inet_cork *cork) 15891da177e4SLinus Torvalds { 15901da177e4SLinus Torvalds struct sk_buff *skb; 15911da177e4SLinus Torvalds 15921470ddf7SHerbert Xu while ((skb = __skb_dequeue_tail(queue)) != NULL) 15931da177e4SLinus Torvalds kfree_skb(skb); 15941da177e4SLinus Torvalds 15951470ddf7SHerbert Xu ip_cork_release(cork); 15961470ddf7SHerbert Xu } 15971470ddf7SHerbert Xu 15981470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk) 15991470ddf7SHerbert Xu { 1600bdc712b4SDavid S. Miller __ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base); 16011da177e4SLinus Torvalds } 16021da177e4SLinus Torvalds 16031c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk, 160477968b78SDavid S. Miller struct flowi4 *fl4, 16051c32c5adSHerbert Xu int getfrag(void *from, char *to, int offset, 16061c32c5adSHerbert Xu int len, int odd, struct sk_buff *skb), 16071c32c5adSHerbert Xu void *from, int length, int transhdrlen, 16081c32c5adSHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 16091cd7884dSWillem de Bruijn struct inet_cork *cork, unsigned int flags) 16101c32c5adSHerbert Xu { 16111c32c5adSHerbert Xu struct sk_buff_head queue; 16121c32c5adSHerbert Xu int err; 16131c32c5adSHerbert Xu 16141c32c5adSHerbert Xu if (flags & MSG_PROBE) 16151c32c5adSHerbert Xu return NULL; 16161c32c5adSHerbert Xu 16171c32c5adSHerbert Xu __skb_queue_head_init(&queue); 16181c32c5adSHerbert Xu 16191cd7884dSWillem de Bruijn cork->flags = 0; 16201cd7884dSWillem de Bruijn cork->addr = 0; 16211cd7884dSWillem de Bruijn cork->opt = NULL; 16221cd7884dSWillem de Bruijn err = ip_setup_cork(sk, cork, ipc, rtp); 16231c32c5adSHerbert Xu if (err) 16241c32c5adSHerbert Xu return ERR_PTR(err); 16251c32c5adSHerbert Xu 16261cd7884dSWillem de Bruijn err = __ip_append_data(sk, fl4, &queue, cork, 16275640f768SEric Dumazet ¤t->task_frag, getfrag, 16281c32c5adSHerbert Xu from, length, transhdrlen, flags); 16291c32c5adSHerbert Xu if (err) { 16301cd7884dSWillem de Bruijn __ip_flush_pending_frames(sk, &queue, cork); 16311c32c5adSHerbert Xu return ERR_PTR(err); 16321c32c5adSHerbert Xu } 16331c32c5adSHerbert Xu 16341cd7884dSWillem de Bruijn return __ip_make_skb(sk, fl4, &queue, cork); 16351c32c5adSHerbert Xu } 16361da177e4SLinus Torvalds 16371da177e4SLinus Torvalds /* 16381da177e4SLinus Torvalds * Fetch data from kernel space and fill in checksum if needed. 16391da177e4SLinus Torvalds */ 16401da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset, 16411da177e4SLinus Torvalds int len, int odd, struct sk_buff *skb) 16421da177e4SLinus Torvalds { 16435084205fSAl Viro __wsum csum; 16441da177e4SLinus Torvalds 16451da177e4SLinus Torvalds csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0); 16461da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 16471da177e4SLinus Torvalds return 0; 16481da177e4SLinus Torvalds } 16491da177e4SLinus Torvalds 16501da177e4SLinus Torvalds /* 16511da177e4SLinus Torvalds * Generic function to send a packet as reply to another packet. 1652be9f4a44SEric Dumazet * Used to send some TCP resets/acks so far. 16531da177e4SLinus Torvalds */ 1654bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb, 165524a2d43dSEric Dumazet const struct ip_options *sopt, 165624a2d43dSEric Dumazet __be32 daddr, __be32 saddr, 165724a2d43dSEric Dumazet const struct ip_reply_arg *arg, 1658d6fb396cSEric Dumazet unsigned int len, u64 transmit_time) 16591da177e4SLinus Torvalds { 1660f6d8bd05SEric Dumazet struct ip_options_data replyopts; 16611da177e4SLinus Torvalds struct ipcm_cookie ipc; 166277968b78SDavid S. Miller struct flowi4 fl4; 1663511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1664bdbbb852SEric Dumazet struct net *net = sock_net(sk); 1665be9f4a44SEric Dumazet struct sk_buff *nskb; 16664062090eSVasily Averin int err; 1667f7ba868bSDavid Ahern int oif; 16681da177e4SLinus Torvalds 166991ed1e66SPaolo Abeni if (__ip_options_echo(net, &replyopts.opt.opt, skb, sopt)) 16701da177e4SLinus Torvalds return; 16711da177e4SLinus Torvalds 167235178206SWillem de Bruijn ipcm_init(&ipc); 16730a5ebb80SDavid S. Miller ipc.addr = daddr; 1674d6fb396cSEric Dumazet ipc.sockc.transmit_time = transmit_time; 16751da177e4SLinus Torvalds 1676f6d8bd05SEric Dumazet if (replyopts.opt.opt.optlen) { 16771da177e4SLinus Torvalds ipc.opt = &replyopts.opt; 16781da177e4SLinus Torvalds 1679f6d8bd05SEric Dumazet if (replyopts.opt.opt.srr) 1680f6d8bd05SEric Dumazet daddr = replyopts.opt.opt.faddr; 16811da177e4SLinus Torvalds } 16821da177e4SLinus Torvalds 1683f7ba868bSDavid Ahern oif = arg->bound_dev_if; 16849b6c14d5SDavid Ahern if (!oif && netif_index_is_l3_master(net, skb->skb_iif)) 16859b6c14d5SDavid Ahern oif = skb->skb_iif; 1686f7ba868bSDavid Ahern 1687f7ba868bSDavid Ahern flowi4_init_output(&fl4, oif, 168800483690SJon Maxwell IP4_REPLY_MARK(net, skb->mark) ?: sk->sk_mark, 168966b13d99SEric Dumazet RT_TOS(arg->tos), 1690be9f4a44SEric Dumazet RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol, 1691538de0e0SDavid S. Miller ip_reply_arg_flowi_flags(arg), 169270e73416SDavid S. Miller daddr, saddr, 1693e2d118a1SLorenzo Colitti tcp_hdr(skb)->source, tcp_hdr(skb)->dest, 1694e2d118a1SLorenzo Colitti arg->uid); 16959d6ec938SDavid S. Miller security_skb_classify_flow(skb, flowi4_to_flowi(&fl4)); 1696be9f4a44SEric Dumazet rt = ip_route_output_key(net, &fl4); 1697b23dd4feSDavid S. Miller if (IS_ERR(rt)) 16981da177e4SLinus Torvalds return; 16991da177e4SLinus Torvalds 1700bdbbb852SEric Dumazet inet_sk(sk)->tos = arg->tos; 17011da177e4SLinus Torvalds 1702eddc9ec5SArnaldo Carvalho de Melo sk->sk_protocol = ip_hdr(skb)->protocol; 1703f0e48dbfSPatrick McHardy sk->sk_bound_dev_if = arg->bound_dev_if; 1704be9f4a44SEric Dumazet sk->sk_sndbuf = sysctl_wmem_default; 1705bf99b4deSPau Espin Pedrol sk->sk_mark = fl4.flowi4_mark; 17064062090eSVasily Averin err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base, 17074062090eSVasily Averin len, 0, &ipc, &rt, MSG_DONTWAIT); 17084062090eSVasily Averin if (unlikely(err)) { 17094062090eSVasily Averin ip_flush_pending_frames(sk); 17104062090eSVasily Averin goto out; 17114062090eSVasily Averin } 17124062090eSVasily Averin 1713be9f4a44SEric Dumazet nskb = skb_peek(&sk->sk_write_queue); 1714be9f4a44SEric Dumazet if (nskb) { 17151da177e4SLinus Torvalds if (arg->csumoffset >= 0) 1716be9f4a44SEric Dumazet *((__sum16 *)skb_transport_header(nskb) + 1717be9f4a44SEric Dumazet arg->csumoffset) = csum_fold(csum_add(nskb->csum, 17189c70220bSArnaldo Carvalho de Melo arg->csum)); 1719be9f4a44SEric Dumazet nskb->ip_summed = CHECKSUM_NONE; 172077968b78SDavid S. Miller ip_push_pending_frames(sk, &fl4); 17211da177e4SLinus Torvalds } 17224062090eSVasily Averin out: 17231da177e4SLinus Torvalds ip_rt_put(rt); 17241da177e4SLinus Torvalds } 17251da177e4SLinus Torvalds 17261da177e4SLinus Torvalds void __init ip_init(void) 17271da177e4SLinus Torvalds { 17281da177e4SLinus Torvalds ip_rt_init(); 17291da177e4SLinus Torvalds inet_initpeers(); 17301da177e4SLinus Torvalds 173172c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST) 173272c1d3bdSWANG Cong igmp_mc_init(); 17331da177e4SLinus Torvalds #endif 17341da177e4SLinus Torvalds } 1735