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> 77*ba9e04a7SWei Wang #include <net/inet_ecn.h> 7814972cbdSRoopa Prabhu #include <net/lwtunnel.h> 7933b48679SDaniel Mack #include <linux/bpf-cgroup.h> 801da177e4SLinus Torvalds #include <linux/igmp.h> 811da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h> 821da177e4SLinus Torvalds #include <linux/netfilter_bridge.h> 831da177e4SLinus Torvalds #include <linux/netlink.h> 846cbb0df7SArnaldo Carvalho de Melo #include <linux/tcp.h> 851da177e4SLinus Torvalds 86694869b3SEric W. Biederman static int 87694869b3SEric W. Biederman ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 88c5501eb3SFlorian Westphal unsigned int mtu, 89694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)); 9049d16b23SAndy Zhou 911da177e4SLinus Torvalds /* Generate a checksum for an outgoing IP datagram. */ 922fbd9679SDenis Efremov void ip_send_check(struct iphdr *iph) 931da177e4SLinus Torvalds { 941da177e4SLinus Torvalds iph->check = 0; 951da177e4SLinus Torvalds iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl); 961da177e4SLinus Torvalds } 974bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_send_check); 981da177e4SLinus Torvalds 99cf91a99dSEric W. Biederman int __ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb) 100c439cb2eSHerbert Xu { 101c439cb2eSHerbert Xu struct iphdr *iph = ip_hdr(skb); 102c439cb2eSHerbert Xu 103c439cb2eSHerbert Xu iph->tot_len = htons(skb->len); 104c439cb2eSHerbert Xu ip_send_check(iph); 105a8e3e1a9SDavid Ahern 106a8e3e1a9SDavid Ahern /* if egress device is enslaved to an L3 master device pass the 107a8e3e1a9SDavid Ahern * skb to its handler for processing 108a8e3e1a9SDavid Ahern */ 109a8e3e1a9SDavid Ahern skb = l3mdev_ip_out(sk, skb); 110a8e3e1a9SDavid Ahern if (unlikely(!skb)) 111a8e3e1a9SDavid Ahern return 0; 112a8e3e1a9SDavid Ahern 113f4180439SEli Cooper skb->protocol = htons(ETH_P_IP); 114f4180439SEli Cooper 11529a26a56SEric W. Biederman return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT, 11629a26a56SEric W. Biederman net, sk, skb, NULL, skb_dst(skb)->dev, 11713206b6bSEric W. Biederman dst_output); 1187026b1ddSDavid Miller } 1197026b1ddSDavid Miller 12033224b16SEric W. Biederman int ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb) 121c439cb2eSHerbert Xu { 122c439cb2eSHerbert Xu int err; 123c439cb2eSHerbert Xu 124cf91a99dSEric W. Biederman err = __ip_local_out(net, sk, skb); 125c439cb2eSHerbert Xu if (likely(err == 1)) 12613206b6bSEric W. Biederman err = dst_output(net, sk, skb); 127c439cb2eSHerbert Xu 128c439cb2eSHerbert Xu return err; 129c439cb2eSHerbert Xu } 130e2cb77dbSEric W. Biederman EXPORT_SYMBOL_GPL(ip_local_out); 131c439cb2eSHerbert Xu 1321da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst) 1331da177e4SLinus Torvalds { 1341da177e4SLinus Torvalds int ttl = inet->uc_ttl; 1351da177e4SLinus Torvalds 1361da177e4SLinus Torvalds if (ttl < 0) 137323e126fSDavid S. Miller ttl = ip4_dst_hoplimit(dst); 1381da177e4SLinus Torvalds return ttl; 1391da177e4SLinus Torvalds } 1401da177e4SLinus Torvalds 1411da177e4SLinus Torvalds /* 1421da177e4SLinus Torvalds * Add an ip header to a skbuff and send it out. 1431da177e4SLinus Torvalds * 1441da177e4SLinus Torvalds */ 145cfe673b0SEric Dumazet int ip_build_and_send_pkt(struct sk_buff *skb, const struct sock *sk, 146f6d8bd05SEric Dumazet __be32 saddr, __be32 daddr, struct ip_options_rcu *opt) 1471da177e4SLinus Torvalds { 1481da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 149511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 15077589ce0SEric W. Biederman struct net *net = sock_net(sk); 1511da177e4SLinus Torvalds struct iphdr *iph; 1521da177e4SLinus Torvalds 1531da177e4SLinus Torvalds /* Build the IP header. */ 154f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (opt ? opt->opt.optlen : 0)); 1558856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 156eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 1571da177e4SLinus Torvalds iph->version = 4; 1581da177e4SLinus Torvalds iph->ihl = 5; 1591da177e4SLinus Torvalds iph->tos = inet->tos; 160d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 161dd927a26SDavid S. Miller iph->daddr = (opt && opt->opt.srr ? opt->opt.faddr : daddr); 162dd927a26SDavid S. Miller iph->saddr = saddr; 1631da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 164cfe673b0SEric Dumazet if (ip_dont_fragment(sk, &rt->dst)) { 165cfe673b0SEric Dumazet iph->frag_off = htons(IP_DF); 166cfe673b0SEric Dumazet iph->id = 0; 167cfe673b0SEric Dumazet } else { 168cfe673b0SEric Dumazet iph->frag_off = 0; 16977589ce0SEric W. Biederman __ip_select_ident(net, iph, 1); 170cfe673b0SEric Dumazet } 1711da177e4SLinus Torvalds 172f6d8bd05SEric Dumazet if (opt && opt->opt.optlen) { 173f6d8bd05SEric Dumazet iph->ihl += opt->opt.optlen>>2; 174f6d8bd05SEric Dumazet ip_options_build(skb, &opt->opt, daddr, rt, 0); 1751da177e4SLinus Torvalds } 1761da177e4SLinus Torvalds 1771da177e4SLinus Torvalds skb->priority = sk->sk_priority; 178e05a90ecSJamal Hadi Salim if (!skb->mark) 1794a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1801da177e4SLinus Torvalds 1811da177e4SLinus Torvalds /* Send it out. */ 18233224b16SEric W. Biederman return ip_local_out(net, skb->sk, skb); 1831da177e4SLinus Torvalds } 184d8c97a94SArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip_build_and_send_pkt); 185d8c97a94SArnaldo Carvalho de Melo 186694869b3SEric W. Biederman static int ip_finish_output2(struct net *net, struct sock *sk, struct sk_buff *skb) 1871da177e4SLinus Torvalds { 188adf30907SEric Dumazet struct dst_entry *dst = skb_dst(skb); 18980787ebcSMitsuru Chinen struct rtable *rt = (struct rtable *)dst; 1901da177e4SLinus Torvalds struct net_device *dev = dst->dev; 191c2636b4dSChuck Lever unsigned int hh_len = LL_RESERVED_SPACE(dev); 192f6b72b62SDavid S. Miller struct neighbour *neigh; 1935c9f7c1dSDavid Ahern bool is_v6gw = false; 1941da177e4SLinus Torvalds 195edf391ffSNeil Horman if (rt->rt_type == RTN_MULTICAST) { 1964ba1bf42SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTMCAST, skb->len); 197edf391ffSNeil Horman } else if (rt->rt_type == RTN_BROADCAST) 1984ba1bf42SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTBCAST, skb->len); 19980787ebcSMitsuru Chinen 2001da177e4SLinus Torvalds /* Be paranoid, rather than too clever. */ 2013b04dddeSStephen Hemminger if (unlikely(skb_headroom(skb) < hh_len && dev->header_ops)) { 2021da177e4SLinus Torvalds struct sk_buff *skb2; 2031da177e4SLinus Torvalds 2041da177e4SLinus Torvalds skb2 = skb_realloc_headroom(skb, LL_RESERVED_SPACE(dev)); 20551456b29SIan Morris if (!skb2) { 2061da177e4SLinus Torvalds kfree_skb(skb); 2071da177e4SLinus Torvalds return -ENOMEM; 2081da177e4SLinus Torvalds } 2091da177e4SLinus Torvalds if (skb->sk) 2101da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 2115d0ba55bSEric Dumazet consume_skb(skb); 2121da177e4SLinus Torvalds skb = skb2; 2131da177e4SLinus Torvalds } 2141da177e4SLinus Torvalds 21514972cbdSRoopa Prabhu if (lwtunnel_xmit_redirect(dst->lwtstate)) { 21614972cbdSRoopa Prabhu int res = lwtunnel_xmit(skb); 21714972cbdSRoopa Prabhu 21814972cbdSRoopa Prabhu if (res < 0 || res == LWTUNNEL_XMIT_DONE) 21914972cbdSRoopa Prabhu return res; 22014972cbdSRoopa Prabhu } 22114972cbdSRoopa Prabhu 222a263b309SDavid S. Miller rcu_read_lock_bh(); 2235c9f7c1dSDavid Ahern neigh = ip_neigh_for_gw(rt, skb, &is_v6gw); 2249871f1adSVasiliy Kulikov if (!IS_ERR(neigh)) { 2254ff06203SJulian Anastasov int res; 2264ff06203SJulian Anastasov 2274ff06203SJulian Anastasov sock_confirm_neigh(skb, neigh); 2285c9f7c1dSDavid Ahern /* if crossing protocols, can not use the cached header */ 2295c9f7c1dSDavid Ahern res = neigh_output(neigh, skb, is_v6gw); 230a263b309SDavid S. Miller rcu_read_unlock_bh(); 231f2c31e32SEric Dumazet return res; 232f2c31e32SEric Dumazet } 233a263b309SDavid S. Miller rcu_read_unlock_bh(); 23405e3aa09SDavid S. Miller 235e87cc472SJoe Perches net_dbg_ratelimited("%s: No header cache and no neighbour!\n", 236e87cc472SJoe Perches __func__); 2371da177e4SLinus Torvalds kfree_skb(skb); 2381da177e4SLinus Torvalds return -EINVAL; 2391da177e4SLinus Torvalds } 2401da177e4SLinus Torvalds 241694869b3SEric W. Biederman static int ip_finish_output_gso(struct net *net, struct sock *sk, 242694869b3SEric W. Biederman struct sk_buff *skb, unsigned int mtu) 243c7ba65d7SFlorian Westphal { 24488bebdf5SJason A. Donenfeld struct sk_buff *segs, *nskb; 245c7ba65d7SFlorian Westphal netdev_features_t features; 246c7ba65d7SFlorian Westphal int ret = 0; 247c7ba65d7SFlorian Westphal 2489ee6c5dcSLance Richardson /* common case: seglen is <= mtu 249359ebda2SShmulik Ladkani */ 250779b7931SDaniel Axtens if (skb_gso_validate_network_len(skb, mtu)) 251694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 252c7ba65d7SFlorian Westphal 2530ace81ecSLance Richardson /* Slowpath - GSO segment length exceeds the egress MTU. 254c7ba65d7SFlorian Westphal * 2550ace81ecSLance Richardson * This can happen in several cases: 2560ace81ecSLance Richardson * - Forwarding of a TCP GRO skb, when DF flag is not set. 2570ace81ecSLance Richardson * - Forwarding of an skb that arrived on a virtualization interface 2580ace81ecSLance Richardson * (virtio-net/vhost/tap) with TSO/GSO size set by other network 2590ace81ecSLance Richardson * stack. 2600ace81ecSLance Richardson * - Local GSO skb transmitted on an NETIF_F_TSO tunnel stacked over an 2610ace81ecSLance Richardson * interface with a smaller MTU. 2620ace81ecSLance Richardson * - Arriving GRO skb (or GSO skb in a virtualized environment) that is 2630ace81ecSLance Richardson * bridged to a NETIF_F_TSO tunnel stacked over an interface with an 2640ace81ecSLance Richardson * insufficent MTU. 265c7ba65d7SFlorian Westphal */ 266c7ba65d7SFlorian Westphal features = netif_skb_features(skb); 267a08e7fd9SCambda Zhu BUILD_BUG_ON(sizeof(*IPCB(skb)) > SKB_GSO_CB_OFFSET); 268c7ba65d7SFlorian Westphal segs = skb_gso_segment(skb, features & ~NETIF_F_GSO_MASK); 269330966e5SFlorian Westphal if (IS_ERR_OR_NULL(segs)) { 270c7ba65d7SFlorian Westphal kfree_skb(skb); 271c7ba65d7SFlorian Westphal return -ENOMEM; 272c7ba65d7SFlorian Westphal } 273c7ba65d7SFlorian Westphal 274c7ba65d7SFlorian Westphal consume_skb(skb); 275c7ba65d7SFlorian Westphal 27688bebdf5SJason A. Donenfeld skb_list_walk_safe(segs, segs, nskb) { 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; 28488bebdf5SJason A. Donenfeld } 285c7ba65d7SFlorian Westphal 286c7ba65d7SFlorian Westphal return ret; 287c7ba65d7SFlorian Westphal } 288c7ba65d7SFlorian Westphal 289956fe219Sbrakmo static int __ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 2901da177e4SLinus Torvalds { 291c5501eb3SFlorian Westphal unsigned int mtu; 292c5501eb3SFlorian Westphal 2935c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM) 2945c901daaSPatrick McHardy /* Policy lookup after SNAT yielded a new policy */ 29500db4124SIan Morris if (skb_dst(skb)->xfrm) { 29648d5cad8SPatrick McHardy IPCB(skb)->flags |= IPSKB_REROUTED; 29713206b6bSEric W. Biederman return dst_output(net, sk, skb); 29848d5cad8SPatrick McHardy } 2995c901daaSPatrick McHardy #endif 300fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 301c7ba65d7SFlorian Westphal if (skb_is_gso(skb)) 302694869b3SEric W. Biederman return ip_finish_output_gso(net, sk, skb, mtu); 303c7ba65d7SFlorian Westphal 304d6b915e2SFlorian Westphal if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU)) 305694869b3SEric W. Biederman return ip_fragment(net, sk, skb, mtu, ip_finish_output2); 306c7ba65d7SFlorian Westphal 307694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 3081da177e4SLinus Torvalds } 3091da177e4SLinus Torvalds 310956fe219Sbrakmo static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 311956fe219Sbrakmo { 312956fe219Sbrakmo int ret; 313956fe219Sbrakmo 314956fe219Sbrakmo ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 315956fe219Sbrakmo switch (ret) { 316956fe219Sbrakmo case NET_XMIT_SUCCESS: 317956fe219Sbrakmo return __ip_finish_output(net, sk, skb); 318956fe219Sbrakmo case NET_XMIT_CN: 319956fe219Sbrakmo return __ip_finish_output(net, sk, skb) ? : ret; 320956fe219Sbrakmo default: 321956fe219Sbrakmo kfree_skb(skb); 322956fe219Sbrakmo return ret; 323956fe219Sbrakmo } 324956fe219Sbrakmo } 325956fe219Sbrakmo 32633b48679SDaniel Mack static int ip_mc_finish_output(struct net *net, struct sock *sk, 32733b48679SDaniel Mack struct sk_buff *skb) 32833b48679SDaniel Mack { 3295b18f128SStephen Suryaputra struct rtable *new_rt; 330d96ff269SDavid S. Miller bool do_cn = false; 331d96ff269SDavid S. Miller int ret, err; 33233b48679SDaniel Mack 33333b48679SDaniel Mack ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 334956fe219Sbrakmo switch (ret) { 335956fe219Sbrakmo case NET_XMIT_CN: 336d96ff269SDavid S. Miller do_cn = true; 337a8eceea8SJoe Perches fallthrough; 338d96ff269SDavid S. Miller case NET_XMIT_SUCCESS: 339d96ff269SDavid S. Miller break; 340956fe219Sbrakmo default: 34133b48679SDaniel Mack kfree_skb(skb); 34233b48679SDaniel Mack return ret; 34333b48679SDaniel Mack } 34433b48679SDaniel Mack 3455b18f128SStephen Suryaputra /* Reset rt_iif so that inet_iif() will return skb->skb_iif. Setting 3465b18f128SStephen Suryaputra * this to non-zero causes ipi_ifindex in in_pktinfo to be overwritten, 3475b18f128SStephen Suryaputra * see ipv4_pktinfo_prepare(). 3485b18f128SStephen Suryaputra */ 3495b18f128SStephen Suryaputra new_rt = rt_dst_clone(net->loopback_dev, skb_rtable(skb)); 3505b18f128SStephen Suryaputra if (new_rt) { 3515b18f128SStephen Suryaputra new_rt->rt_iif = 0; 3525b18f128SStephen Suryaputra skb_dst_drop(skb); 3535b18f128SStephen Suryaputra skb_dst_set(skb, &new_rt->dst); 3545b18f128SStephen Suryaputra } 3555b18f128SStephen Suryaputra 356d96ff269SDavid S. Miller err = dev_loopback_xmit(net, sk, skb); 357d96ff269SDavid S. Miller return (do_cn && err) ? ret : err; 35833b48679SDaniel Mack } 35933b48679SDaniel Mack 360ede2059dSEric W. Biederman int ip_mc_output(struct net *net, struct sock *sk, struct sk_buff *skb) 3611da177e4SLinus Torvalds { 362511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 363d8d1f30bSChangli Gao struct net_device *dev = rt->dst.dev; 3641da177e4SLinus Torvalds 3651da177e4SLinus Torvalds /* 3661da177e4SLinus Torvalds * If the indicated interface is up and running, send the packet. 3671da177e4SLinus Torvalds */ 36888f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3691da177e4SLinus Torvalds 3701da177e4SLinus Torvalds skb->dev = dev; 3711da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 3721da177e4SLinus Torvalds 3731da177e4SLinus Torvalds /* 3741da177e4SLinus Torvalds * Multicasts are looped back for other local users 3751da177e4SLinus Torvalds */ 3761da177e4SLinus Torvalds 3771da177e4SLinus Torvalds if (rt->rt_flags&RTCF_MULTICAST) { 3787ad6848cSOctavian Purdila if (sk_mc_loop(sk) 3791da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 3801da177e4SLinus Torvalds /* Small optimization: do not loopback not local frames, 3811da177e4SLinus Torvalds which returned after forwarding; they will be dropped 3821da177e4SLinus Torvalds by ip_mr_input in any case. 3831da177e4SLinus Torvalds Note, that local frames are looped back to be delivered 3841da177e4SLinus Torvalds to local recipients. 3851da177e4SLinus Torvalds 3861da177e4SLinus Torvalds This check is duplicated in ip_mr_input at the moment. 3871da177e4SLinus Torvalds */ 3889d4fb27dSJoe Perches && 3899d4fb27dSJoe Perches ((rt->rt_flags & RTCF_LOCAL) || 3909d4fb27dSJoe Perches !(IPCB(skb)->flags & IPSKB_FORWARDED)) 3911da177e4SLinus Torvalds #endif 3921da177e4SLinus Torvalds ) { 3931da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3941da177e4SLinus Torvalds if (newskb) 3959bbc768aSJan Engelhardt 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 4001da177e4SLinus Torvalds /* Multicasts with ttl 0 must not go beyond the host */ 4011da177e4SLinus Torvalds 402eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl == 0) { 4031da177e4SLinus Torvalds kfree_skb(skb); 4041da177e4SLinus Torvalds return 0; 4051da177e4SLinus Torvalds } 4061da177e4SLinus Torvalds } 4071da177e4SLinus Torvalds 4081da177e4SLinus Torvalds if (rt->rt_flags&RTCF_BROADCAST) { 4091da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 4101da177e4SLinus Torvalds if (newskb) 41129a26a56SEric W. Biederman NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 41229a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 41333b48679SDaniel Mack ip_mc_finish_output); 4141da177e4SLinus Torvalds } 4151da177e4SLinus Torvalds 41629a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 41729a26a56SEric W. Biederman net, sk, skb, NULL, skb->dev, 41829a26a56SEric W. Biederman ip_finish_output, 41948d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 4201da177e4SLinus Torvalds } 4211da177e4SLinus Torvalds 422ede2059dSEric W. Biederman int ip_output(struct net *net, struct sock *sk, struct sk_buff *skb) 4231da177e4SLinus Torvalds { 42428f8bfd1SPhil Sutter struct net_device *dev = skb_dst(skb)->dev, *indev = skb->dev; 4251bd9bef6SPatrick McHardy 42688f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 4271da177e4SLinus Torvalds 4281bd9bef6SPatrick McHardy skb->dev = dev; 4291bd9bef6SPatrick McHardy skb->protocol = htons(ETH_P_IP); 4301bd9bef6SPatrick McHardy 43129a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 43228f8bfd1SPhil Sutter net, sk, skb, indev, dev, 43348d5cad8SPatrick McHardy ip_finish_output, 43448d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 4351da177e4SLinus Torvalds } 4361da177e4SLinus Torvalds 43784f9307cSEric Dumazet /* 43884f9307cSEric Dumazet * copy saddr and daddr, possibly using 64bit load/stores 43984f9307cSEric Dumazet * Equivalent to : 44084f9307cSEric Dumazet * iph->saddr = fl4->saddr; 44184f9307cSEric Dumazet * iph->daddr = fl4->daddr; 44284f9307cSEric Dumazet */ 44384f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4) 44484f9307cSEric Dumazet { 44584f9307cSEric Dumazet BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) != 44684f9307cSEric Dumazet offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr)); 44784f9307cSEric Dumazet memcpy(&iph->saddr, &fl4->saddr, 44884f9307cSEric Dumazet sizeof(fl4->saddr) + sizeof(fl4->daddr)); 44984f9307cSEric Dumazet } 45084f9307cSEric Dumazet 451b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */ 45269b9e1e0SXin Long int __ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl, 45369b9e1e0SXin Long __u8 tos) 4541da177e4SLinus Torvalds { 4551da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 45677589ce0SEric W. Biederman struct net *net = sock_net(sk); 457f6d8bd05SEric Dumazet struct ip_options_rcu *inet_opt; 458b57ae01aSDavid S. Miller struct flowi4 *fl4; 4591da177e4SLinus Torvalds struct rtable *rt; 4601da177e4SLinus Torvalds struct iphdr *iph; 461ab6e3febSEric Dumazet int res; 4621da177e4SLinus Torvalds 4631da177e4SLinus Torvalds /* Skip all of this if the packet is already routed, 4641da177e4SLinus Torvalds * f.e. by something like SCTP. 4651da177e4SLinus Torvalds */ 466ab6e3febSEric Dumazet rcu_read_lock(); 467f6d8bd05SEric Dumazet inet_opt = rcu_dereference(inet->inet_opt); 468ea4fc0d6SDavid S. Miller fl4 = &fl->u.ip4; 469511c3f92SEric Dumazet rt = skb_rtable(skb); 47000db4124SIan Morris if (rt) 4711da177e4SLinus Torvalds goto packet_routed; 4721da177e4SLinus Torvalds 4731da177e4SLinus Torvalds /* Make sure we can route this packet. */ 4741da177e4SLinus Torvalds rt = (struct rtable *)__sk_dst_check(sk, 0); 47551456b29SIan Morris if (!rt) { 4763ca3c68eSAl Viro __be32 daddr; 4771da177e4SLinus Torvalds 4781da177e4SLinus Torvalds /* Use correct destination address if we have options. */ 479c720c7e8SEric Dumazet daddr = inet->inet_daddr; 480f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.srr) 481f6d8bd05SEric Dumazet daddr = inet_opt->opt.faddr; 4821da177e4SLinus Torvalds 4831da177e4SLinus Torvalds /* If this fails, retransmit mechanism of transport layer will 4841da177e4SLinus Torvalds * keep trying until route appears or the connection times 4851da177e4SLinus Torvalds * itself out. 4861da177e4SLinus Torvalds */ 48777589ce0SEric W. Biederman rt = ip_route_output_ports(net, fl4, sk, 48878fbfd8aSDavid S. Miller daddr, inet->inet_saddr, 48978fbfd8aSDavid S. Miller inet->inet_dport, 49078fbfd8aSDavid S. Miller inet->inet_sport, 49178fbfd8aSDavid S. Miller sk->sk_protocol, 49269b9e1e0SXin Long RT_CONN_FLAGS_TOS(sk, tos), 49378fbfd8aSDavid S. Miller sk->sk_bound_dev_if); 494b23dd4feSDavid S. Miller if (IS_ERR(rt)) 4951da177e4SLinus Torvalds goto no_route; 496d8d1f30bSChangli Gao sk_setup_caps(sk, &rt->dst); 4971da177e4SLinus Torvalds } 498d8d1f30bSChangli Gao skb_dst_set_noref(skb, &rt->dst); 4991da177e4SLinus Torvalds 5001da177e4SLinus Torvalds packet_routed: 50177d5bc7eSDavid Ahern if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway) 5021da177e4SLinus Torvalds goto no_route; 5031da177e4SLinus Torvalds 5041da177e4SLinus Torvalds /* OK, we know where to send it, allocate and build IP header. */ 505f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0)); 5068856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 507eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 50869b9e1e0SXin Long *((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (tos & 0xff)); 50960ff7467SWANG Cong if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df) 5101da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 5111da177e4SLinus Torvalds else 5121da177e4SLinus Torvalds iph->frag_off = 0; 513d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 5141da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 51584f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 51684f9307cSEric Dumazet 5171da177e4SLinus Torvalds /* Transport layer set skb->h.foo itself. */ 5181da177e4SLinus Torvalds 519f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.optlen) { 520f6d8bd05SEric Dumazet iph->ihl += inet_opt->opt.optlen >> 2; 521f6d8bd05SEric Dumazet ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0); 5221da177e4SLinus Torvalds } 5231da177e4SLinus Torvalds 52477589ce0SEric W. Biederman ip_select_ident_segs(net, skb, sk, 525b6a7719aSHannes Frederic Sowa skb_shinfo(skb)->gso_segs ?: 1); 5261da177e4SLinus Torvalds 527b0270e91SEric Dumazet /* TODO : should we use skb->sk here instead of sk ? */ 5281da177e4SLinus Torvalds skb->priority = sk->sk_priority; 5294a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 5301da177e4SLinus Torvalds 53133224b16SEric W. Biederman res = ip_local_out(net, sk, skb); 532ab6e3febSEric Dumazet rcu_read_unlock(); 533ab6e3febSEric Dumazet return res; 5341da177e4SLinus Torvalds 5351da177e4SLinus Torvalds no_route: 536ab6e3febSEric Dumazet rcu_read_unlock(); 53777589ce0SEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_OUTNOROUTES); 5381da177e4SLinus Torvalds kfree_skb(skb); 5391da177e4SLinus Torvalds return -EHOSTUNREACH; 5401da177e4SLinus Torvalds } 54169b9e1e0SXin Long EXPORT_SYMBOL(__ip_queue_xmit); 5421da177e4SLinus Torvalds 54305e22e83SEric Dumazet int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl) 54405e22e83SEric Dumazet { 54505e22e83SEric Dumazet return __ip_queue_xmit(sk, skb, fl, inet_sk(sk)->tos); 54605e22e83SEric Dumazet } 54705e22e83SEric Dumazet EXPORT_SYMBOL(ip_queue_xmit); 54805e22e83SEric Dumazet 5491da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from) 5501da177e4SLinus Torvalds { 5511da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 5521da177e4SLinus Torvalds to->priority = from->priority; 5531da177e4SLinus Torvalds to->protocol = from->protocol; 554d2f0c961SShmulik Ladkani to->skb_iif = from->skb_iif; 555adf30907SEric Dumazet skb_dst_drop(to); 556fe76cda3SEric Dumazet skb_dst_copy(to, from); 5571da177e4SLinus Torvalds to->dev = from->dev; 55882e91ffeSThomas Graf to->mark = from->mark; 5591da177e4SLinus Torvalds 5603dd1c9a1SPaolo Abeni skb_copy_hash(to, from); 5613dd1c9a1SPaolo Abeni 5621da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 5631da177e4SLinus Torvalds to->tc_index = from->tc_index; 5641da177e4SLinus Torvalds #endif 565e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 566df5042f4SFlorian Westphal skb_ext_copy(to, from); 5676ca40d4eSJavier Martinez Canillas #if IS_ENABLED(CONFIG_IP_VS) 568c98d80edSJulian Anastasov to->ipvs_property = from->ipvs_property; 569c98d80edSJulian Anastasov #endif 570984bc16cSJames Morris skb_copy_secmark(to, from); 5711da177e4SLinus Torvalds } 5721da177e4SLinus Torvalds 573694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 574c5501eb3SFlorian Westphal unsigned int mtu, 575694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 57649d16b23SAndy Zhou { 57749d16b23SAndy Zhou struct iphdr *iph = ip_hdr(skb); 57849d16b23SAndy Zhou 579d6b915e2SFlorian Westphal if ((iph->frag_off & htons(IP_DF)) == 0) 580694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 581d6b915e2SFlorian Westphal 582d6b915e2SFlorian Westphal if (unlikely(!skb->ignore_df || 58349d16b23SAndy Zhou (IPCB(skb)->frag_max_size && 58449d16b23SAndy Zhou IPCB(skb)->frag_max_size > mtu))) { 5859479b0afSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 58649d16b23SAndy Zhou icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, 58749d16b23SAndy Zhou htonl(mtu)); 58849d16b23SAndy Zhou kfree_skb(skb); 58949d16b23SAndy Zhou return -EMSGSIZE; 59049d16b23SAndy Zhou } 59149d16b23SAndy Zhou 592694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 59349d16b23SAndy Zhou } 59449d16b23SAndy Zhou 595c8b17be0SPablo Neira Ayuso void ip_fraglist_init(struct sk_buff *skb, struct iphdr *iph, 596c8b17be0SPablo Neira Ayuso unsigned int hlen, struct ip_fraglist_iter *iter) 597c8b17be0SPablo Neira Ayuso { 598c8b17be0SPablo Neira Ayuso unsigned int first_len = skb_pagelen(skb); 599c8b17be0SPablo Neira Ayuso 600b7034146SEric Dumazet iter->frag = skb_shinfo(skb)->frag_list; 601c8b17be0SPablo Neira Ayuso skb_frag_list_init(skb); 602c8b17be0SPablo Neira Ayuso 603c8b17be0SPablo Neira Ayuso iter->offset = 0; 604c8b17be0SPablo Neira Ayuso iter->iph = iph; 605c8b17be0SPablo Neira Ayuso iter->hlen = hlen; 606c8b17be0SPablo Neira Ayuso 607c8b17be0SPablo Neira Ayuso skb->data_len = first_len - skb_headlen(skb); 608c8b17be0SPablo Neira Ayuso skb->len = first_len; 609c8b17be0SPablo Neira Ayuso iph->tot_len = htons(first_len); 610c8b17be0SPablo Neira Ayuso iph->frag_off = htons(IP_MF); 611c8b17be0SPablo Neira Ayuso ip_send_check(iph); 612c8b17be0SPablo Neira Ayuso } 613c8b17be0SPablo Neira Ayuso EXPORT_SYMBOL(ip_fraglist_init); 614c8b17be0SPablo Neira Ayuso 61519c3401aSPablo Neira Ayuso static void ip_fraglist_ipcb_prepare(struct sk_buff *skb, 61619c3401aSPablo Neira Ayuso struct ip_fraglist_iter *iter) 61719c3401aSPablo Neira Ayuso { 61819c3401aSPablo Neira Ayuso struct sk_buff *to = iter->frag; 61919c3401aSPablo Neira Ayuso 62019c3401aSPablo Neira Ayuso /* Copy the flags to each fragment. */ 62119c3401aSPablo Neira Ayuso IPCB(to)->flags = IPCB(skb)->flags; 62219c3401aSPablo Neira Ayuso 62319c3401aSPablo Neira Ayuso if (iter->offset == 0) 62419c3401aSPablo Neira Ayuso ip_options_fragment(to); 62519c3401aSPablo Neira Ayuso } 62619c3401aSPablo Neira Ayuso 627c8b17be0SPablo Neira Ayuso void ip_fraglist_prepare(struct sk_buff *skb, struct ip_fraglist_iter *iter) 628c8b17be0SPablo Neira Ayuso { 629c8b17be0SPablo Neira Ayuso unsigned int hlen = iter->hlen; 630c8b17be0SPablo Neira Ayuso struct iphdr *iph = iter->iph; 631c8b17be0SPablo Neira Ayuso struct sk_buff *frag; 632c8b17be0SPablo Neira Ayuso 633c8b17be0SPablo Neira Ayuso frag = iter->frag; 634c8b17be0SPablo Neira Ayuso frag->ip_summed = CHECKSUM_NONE; 635c8b17be0SPablo Neira Ayuso skb_reset_transport_header(frag); 636c8b17be0SPablo Neira Ayuso __skb_push(frag, hlen); 637c8b17be0SPablo Neira Ayuso skb_reset_network_header(frag); 638c8b17be0SPablo Neira Ayuso memcpy(skb_network_header(frag), iph, hlen); 639c8b17be0SPablo Neira Ayuso iter->iph = ip_hdr(frag); 640c8b17be0SPablo Neira Ayuso iph = iter->iph; 641c8b17be0SPablo Neira Ayuso iph->tot_len = htons(frag->len); 642c8b17be0SPablo Neira Ayuso ip_copy_metadata(frag, skb); 643c8b17be0SPablo Neira Ayuso iter->offset += skb->len - hlen; 644c8b17be0SPablo Neira Ayuso iph->frag_off = htons(iter->offset >> 3); 645c8b17be0SPablo Neira Ayuso if (frag->next) 646c8b17be0SPablo Neira Ayuso iph->frag_off |= htons(IP_MF); 647c8b17be0SPablo Neira Ayuso /* Ready, complete checksum */ 648c8b17be0SPablo Neira Ayuso ip_send_check(iph); 649c8b17be0SPablo Neira Ayuso } 650c8b17be0SPablo Neira Ayuso EXPORT_SYMBOL(ip_fraglist_prepare); 651c8b17be0SPablo Neira Ayuso 652065ff79fSPablo Neira Ayuso void ip_frag_init(struct sk_buff *skb, unsigned int hlen, 653e7a409c3SEric Dumazet unsigned int ll_rs, unsigned int mtu, bool DF, 654065ff79fSPablo Neira Ayuso struct ip_frag_state *state) 655065ff79fSPablo Neira Ayuso { 656065ff79fSPablo Neira Ayuso struct iphdr *iph = ip_hdr(skb); 657065ff79fSPablo Neira Ayuso 658e7a409c3SEric Dumazet state->DF = DF; 659065ff79fSPablo Neira Ayuso state->hlen = hlen; 660065ff79fSPablo Neira Ayuso state->ll_rs = ll_rs; 661065ff79fSPablo Neira Ayuso state->mtu = mtu; 662065ff79fSPablo Neira Ayuso 663065ff79fSPablo Neira Ayuso state->left = skb->len - hlen; /* Space per frame */ 664065ff79fSPablo Neira Ayuso state->ptr = hlen; /* Where to start from */ 665065ff79fSPablo Neira Ayuso 666065ff79fSPablo Neira Ayuso state->offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3; 667065ff79fSPablo Neira Ayuso state->not_last_frag = iph->frag_off & htons(IP_MF); 668065ff79fSPablo Neira Ayuso } 669065ff79fSPablo Neira Ayuso EXPORT_SYMBOL(ip_frag_init); 670065ff79fSPablo Neira Ayuso 67119c3401aSPablo Neira Ayuso static void ip_frag_ipcb(struct sk_buff *from, struct sk_buff *to, 67219c3401aSPablo Neira Ayuso bool first_frag, struct ip_frag_state *state) 67319c3401aSPablo Neira Ayuso { 67419c3401aSPablo Neira Ayuso /* Copy the flags to each fragment. */ 67519c3401aSPablo Neira Ayuso IPCB(to)->flags = IPCB(from)->flags; 67619c3401aSPablo Neira Ayuso 67719c3401aSPablo Neira Ayuso /* ANK: dirty, but effective trick. Upgrade options only if 67819c3401aSPablo Neira Ayuso * the segment to be fragmented was THE FIRST (otherwise, 67919c3401aSPablo Neira Ayuso * options are already fixed) and make it ONCE 68019c3401aSPablo Neira Ayuso * on the initial skb, so that all the following fragments 68119c3401aSPablo Neira Ayuso * will inherit fixed options. 68219c3401aSPablo Neira Ayuso */ 68319c3401aSPablo Neira Ayuso if (first_frag) 68419c3401aSPablo Neira Ayuso ip_options_fragment(from); 68519c3401aSPablo Neira Ayuso } 68619c3401aSPablo Neira Ayuso 687065ff79fSPablo Neira Ayuso struct sk_buff *ip_frag_next(struct sk_buff *skb, struct ip_frag_state *state) 688065ff79fSPablo Neira Ayuso { 689065ff79fSPablo Neira Ayuso unsigned int len = state->left; 690065ff79fSPablo Neira Ayuso struct sk_buff *skb2; 691065ff79fSPablo Neira Ayuso struct iphdr *iph; 692065ff79fSPablo Neira Ayuso 693065ff79fSPablo Neira Ayuso len = state->left; 694065ff79fSPablo Neira Ayuso /* IF: it doesn't fit, use 'mtu' - the data space left */ 695065ff79fSPablo Neira Ayuso if (len > state->mtu) 696065ff79fSPablo Neira Ayuso len = state->mtu; 697065ff79fSPablo Neira Ayuso /* IF: we are not sending up to and including the packet end 698065ff79fSPablo Neira Ayuso then align the next start on an eight byte boundary */ 699065ff79fSPablo Neira Ayuso if (len < state->left) { 700065ff79fSPablo Neira Ayuso len &= ~7; 701065ff79fSPablo Neira Ayuso } 702065ff79fSPablo Neira Ayuso 703065ff79fSPablo Neira Ayuso /* Allocate buffer */ 704065ff79fSPablo Neira Ayuso skb2 = alloc_skb(len + state->hlen + state->ll_rs, GFP_ATOMIC); 705065ff79fSPablo Neira Ayuso if (!skb2) 706065ff79fSPablo Neira Ayuso return ERR_PTR(-ENOMEM); 707065ff79fSPablo Neira Ayuso 708065ff79fSPablo Neira Ayuso /* 709065ff79fSPablo Neira Ayuso * Set up data on packet 710065ff79fSPablo Neira Ayuso */ 711065ff79fSPablo Neira Ayuso 712065ff79fSPablo Neira Ayuso ip_copy_metadata(skb2, skb); 713065ff79fSPablo Neira Ayuso skb_reserve(skb2, state->ll_rs); 714065ff79fSPablo Neira Ayuso skb_put(skb2, len + state->hlen); 715065ff79fSPablo Neira Ayuso skb_reset_network_header(skb2); 716065ff79fSPablo Neira Ayuso skb2->transport_header = skb2->network_header + state->hlen; 717065ff79fSPablo Neira Ayuso 718065ff79fSPablo Neira Ayuso /* 719065ff79fSPablo Neira Ayuso * Charge the memory for the fragment to any owner 720065ff79fSPablo Neira Ayuso * it might possess 721065ff79fSPablo Neira Ayuso */ 722065ff79fSPablo Neira Ayuso 723065ff79fSPablo Neira Ayuso if (skb->sk) 724065ff79fSPablo Neira Ayuso skb_set_owner_w(skb2, skb->sk); 725065ff79fSPablo Neira Ayuso 726065ff79fSPablo Neira Ayuso /* 727065ff79fSPablo Neira Ayuso * Copy the packet header into the new buffer. 728065ff79fSPablo Neira Ayuso */ 729065ff79fSPablo Neira Ayuso 730065ff79fSPablo Neira Ayuso skb_copy_from_linear_data(skb, skb_network_header(skb2), state->hlen); 731065ff79fSPablo Neira Ayuso 732065ff79fSPablo Neira Ayuso /* 733065ff79fSPablo Neira Ayuso * Copy a block of the IP datagram. 734065ff79fSPablo Neira Ayuso */ 735065ff79fSPablo Neira Ayuso if (skb_copy_bits(skb, state->ptr, skb_transport_header(skb2), len)) 736065ff79fSPablo Neira Ayuso BUG(); 737065ff79fSPablo Neira Ayuso state->left -= len; 738065ff79fSPablo Neira Ayuso 739065ff79fSPablo Neira Ayuso /* 740065ff79fSPablo Neira Ayuso * Fill in the new header fields. 741065ff79fSPablo Neira Ayuso */ 742065ff79fSPablo Neira Ayuso iph = ip_hdr(skb2); 743065ff79fSPablo Neira Ayuso iph->frag_off = htons((state->offset >> 3)); 744e7a409c3SEric Dumazet if (state->DF) 745e7a409c3SEric Dumazet iph->frag_off |= htons(IP_DF); 746065ff79fSPablo Neira Ayuso 747065ff79fSPablo Neira Ayuso /* 748065ff79fSPablo Neira Ayuso * Added AC : If we are fragmenting a fragment that's not the 749065ff79fSPablo Neira Ayuso * last fragment then keep MF on each bit 750065ff79fSPablo Neira Ayuso */ 751065ff79fSPablo Neira Ayuso if (state->left > 0 || state->not_last_frag) 752065ff79fSPablo Neira Ayuso iph->frag_off |= htons(IP_MF); 753065ff79fSPablo Neira Ayuso state->ptr += len; 754065ff79fSPablo Neira Ayuso state->offset += len; 755065ff79fSPablo Neira Ayuso 756065ff79fSPablo Neira Ayuso iph->tot_len = htons(len + state->hlen); 757065ff79fSPablo Neira Ayuso 758065ff79fSPablo Neira Ayuso ip_send_check(iph); 759065ff79fSPablo Neira Ayuso 760065ff79fSPablo Neira Ayuso return skb2; 761065ff79fSPablo Neira Ayuso } 762065ff79fSPablo Neira Ayuso EXPORT_SYMBOL(ip_frag_next); 763065ff79fSPablo Neira Ayuso 7641da177e4SLinus Torvalds /* 7651da177e4SLinus Torvalds * This IP datagram is too large to be sent in one piece. Break it up into 7661da177e4SLinus Torvalds * smaller pieces (each of size equal to IP header plus 7671da177e4SLinus Torvalds * a block of the data of the original IP data part) that will yet fit in a 7681da177e4SLinus Torvalds * single device frame, and queue such a frame for sending. 7691da177e4SLinus Torvalds */ 7701da177e4SLinus Torvalds 771694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 772694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 7731da177e4SLinus Torvalds { 7741da177e4SLinus Torvalds struct iphdr *iph; 7751da177e4SLinus Torvalds struct sk_buff *skb2; 776511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 777065ff79fSPablo Neira Ayuso unsigned int mtu, hlen, ll_rs; 778c8b17be0SPablo Neira Ayuso struct ip_fraglist_iter iter; 7799669fffcSEric Dumazet ktime_t tstamp = skb->tstamp; 780065ff79fSPablo Neira Ayuso struct ip_frag_state state; 7811da177e4SLinus Torvalds int err = 0; 7821da177e4SLinus Torvalds 783dbd3393cSHannes Frederic Sowa /* for offloaded checksums cleanup checksum before fragmentation */ 784dbd3393cSHannes Frederic Sowa if (skb->ip_summed == CHECKSUM_PARTIAL && 785dbd3393cSHannes Frederic Sowa (err = skb_checksum_help(skb))) 786dbd3393cSHannes Frederic Sowa goto fail; 787dbd3393cSHannes Frederic Sowa 7881da177e4SLinus Torvalds /* 7891da177e4SLinus Torvalds * Point into the IP datagram header. 7901da177e4SLinus Torvalds */ 7911da177e4SLinus Torvalds 792eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 7931da177e4SLinus Torvalds 794fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 795d6b915e2SFlorian Westphal if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu) 796d6b915e2SFlorian Westphal mtu = IPCB(skb)->frag_max_size; 7971da177e4SLinus Torvalds 7981da177e4SLinus Torvalds /* 7991da177e4SLinus Torvalds * Setup starting values. 8001da177e4SLinus Torvalds */ 8011da177e4SLinus Torvalds 8021da177e4SLinus Torvalds hlen = iph->ihl * 4; 803f87c10a8SHannes Frederic Sowa mtu = mtu - hlen; /* Size of data space */ 80489cee8b1SHerbert Xu IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE; 805254d900bSVasily Averin ll_rs = LL_RESERVED_SPACE(rt->dst.dev); 8061da177e4SLinus Torvalds 8071da177e4SLinus Torvalds /* When frag_list is given, use it. First, check its validity: 8081da177e4SLinus Torvalds * some transformers could create wrong frag_list or break existing 8091da177e4SLinus Torvalds * one, it is not prohibited. In this case fall back to copying. 8101da177e4SLinus Torvalds * 8111da177e4SLinus Torvalds * LATER: this step can be merged to real generation of fragments, 8121da177e4SLinus Torvalds * we can switch to copy when see the first bad fragment. 8131da177e4SLinus Torvalds */ 81421dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 8153d13008eSEric Dumazet struct sk_buff *frag, *frag2; 816c72d8cdaSAlexey Dobriyan unsigned int first_len = skb_pagelen(skb); 8171da177e4SLinus Torvalds 8181da177e4SLinus Torvalds if (first_len - hlen > mtu || 8191da177e4SLinus Torvalds ((first_len - hlen) & 7) || 82056f8a75cSPaul Gortmaker ip_is_fragment(iph) || 821254d900bSVasily Averin skb_cloned(skb) || 822254d900bSVasily Averin skb_headroom(skb) < ll_rs) 8231da177e4SLinus Torvalds goto slow_path; 8241da177e4SLinus Torvalds 825d7fcf1a5SDavid S. Miller skb_walk_frags(skb, frag) { 8261da177e4SLinus Torvalds /* Correct geometry. */ 8271da177e4SLinus Torvalds if (frag->len > mtu || 8281da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 829254d900bSVasily Averin skb_headroom(frag) < hlen + ll_rs) 8303d13008eSEric Dumazet goto slow_path_clean; 8311da177e4SLinus Torvalds 8321da177e4SLinus Torvalds /* Partially cloned skb? */ 8331da177e4SLinus Torvalds if (skb_shared(frag)) 8343d13008eSEric Dumazet goto slow_path_clean; 8352fdba6b0SHerbert Xu 8362fdba6b0SHerbert Xu BUG_ON(frag->sk); 8372fdba6b0SHerbert Xu if (skb->sk) { 8382fdba6b0SHerbert Xu frag->sk = skb->sk; 8392fdba6b0SHerbert Xu frag->destructor = sock_wfree; 8402fdba6b0SHerbert Xu } 8413d13008eSEric Dumazet skb->truesize -= frag->truesize; 8421da177e4SLinus Torvalds } 8431da177e4SLinus Torvalds 8441da177e4SLinus Torvalds /* Everything is OK. Generate! */ 845c8b17be0SPablo Neira Ayuso ip_fraglist_init(skb, iph, hlen, &iter); 8461da177e4SLinus Torvalds 8471da177e4SLinus Torvalds for (;;) { 8481da177e4SLinus Torvalds /* Prepare header of the next frame, 8491da177e4SLinus Torvalds * before previous one went down. */ 85019c3401aSPablo Neira Ayuso if (iter.frag) { 85119c3401aSPablo Neira Ayuso ip_fraglist_ipcb_prepare(skb, &iter); 852c8b17be0SPablo Neira Ayuso ip_fraglist_prepare(skb, &iter); 85319c3401aSPablo Neira Ayuso } 8541da177e4SLinus Torvalds 8559669fffcSEric Dumazet skb->tstamp = tstamp; 856694869b3SEric W. Biederman err = output(net, sk, skb); 8571da177e4SLinus Torvalds 858dafee490SWei Dong if (!err) 85926a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 860c8b17be0SPablo Neira Ayuso if (err || !iter.frag) 8611da177e4SLinus Torvalds break; 8621da177e4SLinus Torvalds 863c8b17be0SPablo Neira Ayuso skb = ip_fraglist_next(&iter); 8641da177e4SLinus Torvalds } 8651da177e4SLinus Torvalds 8661da177e4SLinus Torvalds if (err == 0) { 86726a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 8681da177e4SLinus Torvalds return 0; 8691da177e4SLinus Torvalds } 8701da177e4SLinus Torvalds 871b7034146SEric Dumazet kfree_skb_list(iter.frag); 872942f146aSPablo Neira Ayuso 87326a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 8741da177e4SLinus Torvalds return err; 8753d13008eSEric Dumazet 8763d13008eSEric Dumazet slow_path_clean: 8773d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 8783d13008eSEric Dumazet if (frag2 == frag) 8793d13008eSEric Dumazet break; 8803d13008eSEric Dumazet frag2->sk = NULL; 8813d13008eSEric Dumazet frag2->destructor = NULL; 8823d13008eSEric Dumazet skb->truesize += frag2->truesize; 8833d13008eSEric Dumazet } 8841da177e4SLinus Torvalds } 8851da177e4SLinus Torvalds 8861da177e4SLinus Torvalds slow_path: 8871da177e4SLinus Torvalds /* 8881da177e4SLinus Torvalds * Fragment the datagram. 8891da177e4SLinus Torvalds */ 8901da177e4SLinus Torvalds 891e7a409c3SEric Dumazet ip_frag_init(skb, hlen, ll_rs, mtu, IPCB(skb)->flags & IPSKB_FRAG_PMTU, 892e7a409c3SEric Dumazet &state); 8931da177e4SLinus Torvalds 8941da177e4SLinus Torvalds /* 8951da177e4SLinus Torvalds * Keep copying data until we run out. 8961da177e4SLinus Torvalds */ 8971da177e4SLinus Torvalds 898065ff79fSPablo Neira Ayuso while (state.left > 0) { 89919c3401aSPablo Neira Ayuso bool first_frag = (state.offset == 0); 90019c3401aSPablo Neira Ayuso 901065ff79fSPablo Neira Ayuso skb2 = ip_frag_next(skb, &state); 902065ff79fSPablo Neira Ayuso if (IS_ERR(skb2)) { 903065ff79fSPablo Neira Ayuso err = PTR_ERR(skb2); 9041da177e4SLinus Torvalds goto fail; 9051da177e4SLinus Torvalds } 90619c3401aSPablo Neira Ayuso ip_frag_ipcb(skb, skb2, first_frag, &state); 9071da177e4SLinus Torvalds 9081da177e4SLinus Torvalds /* 9091da177e4SLinus Torvalds * Put this fragment into the sending queue. 9101da177e4SLinus Torvalds */ 9119669fffcSEric Dumazet skb2->tstamp = tstamp; 912694869b3SEric W. Biederman err = output(net, sk, skb2); 9131da177e4SLinus Torvalds if (err) 9141da177e4SLinus Torvalds goto fail; 915dafee490SWei Dong 91626a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 9171da177e4SLinus Torvalds } 9185d0ba55bSEric Dumazet consume_skb(skb); 91926a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 9201da177e4SLinus Torvalds return err; 9211da177e4SLinus Torvalds 9221da177e4SLinus Torvalds fail: 9231da177e4SLinus Torvalds kfree_skb(skb); 92426a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 9251da177e4SLinus Torvalds return err; 9261da177e4SLinus Torvalds } 92749d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment); 9282e2f7aefSPatrick McHardy 9291da177e4SLinus Torvalds int 9301da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb) 9311da177e4SLinus Torvalds { 932f69e6d13SAl Viro struct msghdr *msg = from; 9331da177e4SLinus Torvalds 93484fa7933SPatrick McHardy if (skb->ip_summed == CHECKSUM_PARTIAL) { 9350b62fca2SAl Viro if (!copy_from_iter_full(to, len, &msg->msg_iter)) 9361da177e4SLinus Torvalds return -EFAULT; 9371da177e4SLinus Torvalds } else { 93844bb9363SAl Viro __wsum csum = 0; 9390b62fca2SAl Viro if (!csum_and_copy_from_iter_full(to, len, &csum, &msg->msg_iter)) 9401da177e4SLinus Torvalds return -EFAULT; 9411da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 9421da177e4SLinus Torvalds } 9431da177e4SLinus Torvalds return 0; 9441da177e4SLinus Torvalds } 9454bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag); 9461da177e4SLinus Torvalds 94744bb9363SAl Viro static inline __wsum 9481da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy) 9491da177e4SLinus Torvalds { 9501da177e4SLinus Torvalds char *kaddr; 95144bb9363SAl Viro __wsum csum; 9521da177e4SLinus Torvalds kaddr = kmap(page); 9531da177e4SLinus Torvalds csum = csum_partial(kaddr + offset, copy, 0); 9541da177e4SLinus Torvalds kunmap(page); 9551da177e4SLinus Torvalds return csum; 9561da177e4SLinus Torvalds } 9571da177e4SLinus Torvalds 958f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk, 959f5fca608SDavid S. Miller struct flowi4 *fl4, 960f5fca608SDavid S. Miller struct sk_buff_head *queue, 9611470ddf7SHerbert Xu struct inet_cork *cork, 9625640f768SEric Dumazet struct page_frag *pfrag, 9631470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, 9641470ddf7SHerbert Xu int len, int odd, struct sk_buff *skb), 9651da177e4SLinus Torvalds void *from, int length, int transhdrlen, 9661da177e4SLinus Torvalds unsigned int flags) 9671da177e4SLinus Torvalds { 9681da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 969b5947e5dSWillem de Bruijn struct ubuf_info *uarg = NULL; 9701da177e4SLinus Torvalds struct sk_buff *skb; 9711da177e4SLinus Torvalds 97207df5294SHerbert Xu struct ip_options *opt = cork->opt; 9731da177e4SLinus Torvalds int hh_len; 9741da177e4SLinus Torvalds int exthdrlen; 9751da177e4SLinus Torvalds int mtu; 9761da177e4SLinus Torvalds int copy; 9771da177e4SLinus Torvalds int err; 9781da177e4SLinus Torvalds int offset = 0; 979daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, maxnonfragsize; 9801da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 9811470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 982694aba69SEric Dumazet unsigned int wmem_alloc_delta = 0; 983100f6d8eSWillem de Bruijn bool paged, extra_uref = false; 98409c2d251SWillem de Bruijn u32 tskey = 0; 9851da177e4SLinus Torvalds 98696d7303eSSteffen Klassert skb = skb_peek_tail(queue); 98796d7303eSSteffen Klassert 98896d7303eSSteffen Klassert exthdrlen = !skb ? rt->dst.header_len : 0; 989bec1f6f6SWillem de Bruijn mtu = cork->gso_size ? IP_MAX_MTU : cork->fragsize; 99015e36f5bSWillem de Bruijn paged = !!cork->gso_size; 991bec1f6f6SWillem de Bruijn 99209c2d251SWillem de Bruijn if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP && 99309c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 99409c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 9951470ddf7SHerbert Xu 996d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 9971da177e4SLinus Torvalds 9981da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 9991da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 100060ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 10011da177e4SLinus Torvalds 1002daba287bSHannes Frederic Sowa if (cork->length + length > maxnonfragsize - fragheaderlen) { 1003f5fca608SDavid S. Miller ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 100461e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 10051da177e4SLinus Torvalds return -EMSGSIZE; 10061da177e4SLinus Torvalds } 10071da177e4SLinus Torvalds 10081da177e4SLinus Torvalds /* 10091da177e4SLinus Torvalds * transhdrlen > 0 means that this is the first fragment and we wish 10101da177e4SLinus Torvalds * it won't be fragmented in the future. 10111da177e4SLinus Torvalds */ 10121da177e4SLinus Torvalds if (transhdrlen && 10131da177e4SLinus Torvalds length + fragheaderlen <= mtu && 1014c8cd0989STom Herbert rt->dst.dev->features & (NETIF_F_HW_CSUM | NETIF_F_IP_CSUM) && 1015bec1f6f6SWillem de Bruijn (!(flags & MSG_MORE) || cork->gso_size) && 1016cd027a54SJacek Kalwas (!exthdrlen || (rt->dst.dev->features & NETIF_F_HW_ESP_TX_CSUM))) 101784fa7933SPatrick McHardy csummode = CHECKSUM_PARTIAL; 10181da177e4SLinus Torvalds 1019b5947e5dSWillem de Bruijn if (flags & MSG_ZEROCOPY && length && sock_flag(sk, SOCK_ZEROCOPY)) { 1020b5947e5dSWillem de Bruijn uarg = sock_zerocopy_realloc(sk, length, skb_zcopy(skb)); 1021b5947e5dSWillem de Bruijn if (!uarg) 1022b5947e5dSWillem de Bruijn return -ENOBUFS; 1023522924b5SWillem de Bruijn extra_uref = !skb_zcopy(skb); /* only ref on new uarg */ 1024b5947e5dSWillem de Bruijn if (rt->dst.dev->features & NETIF_F_SG && 1025b5947e5dSWillem de Bruijn csummode == CHECKSUM_PARTIAL) { 1026b5947e5dSWillem de Bruijn paged = true; 1027b5947e5dSWillem de Bruijn } else { 1028b5947e5dSWillem de Bruijn uarg->zerocopy = 0; 102952900d22SWillem de Bruijn skb_zcopy_set(skb, uarg, &extra_uref); 1030b5947e5dSWillem de Bruijn } 1031b5947e5dSWillem de Bruijn } 1032b5947e5dSWillem de Bruijn 10331470ddf7SHerbert Xu cork->length += length; 10341da177e4SLinus Torvalds 10351da177e4SLinus Torvalds /* So, what's going on in the loop below? 10361da177e4SLinus Torvalds * 10371da177e4SLinus Torvalds * We use calculated fragment length to generate chained skb, 10381da177e4SLinus Torvalds * each of segments is IP fragment ready for sending to network after 10391da177e4SLinus Torvalds * adding appropriate IP header. 10401da177e4SLinus Torvalds */ 10411da177e4SLinus Torvalds 104226cde9f7SHerbert Xu if (!skb) 10431da177e4SLinus Torvalds goto alloc_new_skb; 10441da177e4SLinus Torvalds 10451da177e4SLinus Torvalds while (length > 0) { 10461da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 10471da177e4SLinus Torvalds copy = mtu - skb->len; 10481da177e4SLinus Torvalds if (copy < length) 10491da177e4SLinus Torvalds copy = maxfraglen - skb->len; 10501da177e4SLinus Torvalds if (copy <= 0) { 10511da177e4SLinus Torvalds char *data; 10521da177e4SLinus Torvalds unsigned int datalen; 10531da177e4SLinus Torvalds unsigned int fraglen; 10541da177e4SLinus Torvalds unsigned int fraggap; 10551da177e4SLinus Torvalds unsigned int alloclen; 1056aba36930SWillem de Bruijn unsigned int pagedlen; 10571da177e4SLinus Torvalds struct sk_buff *skb_prev; 10581da177e4SLinus Torvalds alloc_new_skb: 10591da177e4SLinus Torvalds skb_prev = skb; 10601da177e4SLinus Torvalds if (skb_prev) 10611da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 10621da177e4SLinus Torvalds else 10631da177e4SLinus Torvalds fraggap = 0; 10641da177e4SLinus Torvalds 10651da177e4SLinus Torvalds /* 10661da177e4SLinus Torvalds * If remaining data exceeds the mtu, 10671da177e4SLinus Torvalds * we know we need more fragment(s). 10681da177e4SLinus Torvalds */ 10691da177e4SLinus Torvalds datalen = length + fraggap; 10701da177e4SLinus Torvalds if (datalen > mtu - fragheaderlen) 10711da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 10721da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 1073aba36930SWillem de Bruijn pagedlen = 0; 10741da177e4SLinus Torvalds 10751da177e4SLinus Torvalds if ((flags & MSG_MORE) && 1076d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 10771da177e4SLinus Torvalds alloclen = mtu; 107815e36f5bSWillem de Bruijn else if (!paged) 107959104f06SEric Dumazet alloclen = fraglen; 108015e36f5bSWillem de Bruijn else { 108115e36f5bSWillem de Bruijn alloclen = min_t(int, fraglen, MAX_HEADER); 108215e36f5bSWillem de Bruijn pagedlen = fraglen - alloclen; 108315e36f5bSWillem de Bruijn } 10841da177e4SLinus Torvalds 1085353e5c9aSSteffen Klassert alloclen += exthdrlen; 1086353e5c9aSSteffen Klassert 10871da177e4SLinus Torvalds /* The last fragment gets additional space at tail. 10881da177e4SLinus Torvalds * Note, with MSG_MORE we overallocate on fragments, 10891da177e4SLinus Torvalds * because we have no idea what fragment will be 10901da177e4SLinus Torvalds * the last. 10911da177e4SLinus Torvalds */ 109233f99dc7SSteffen Klassert if (datalen == length + fraggap) 1093d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 109433f99dc7SSteffen Klassert 10951da177e4SLinus Torvalds if (transhdrlen) { 10961da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 10971da177e4SLinus Torvalds alloclen + hh_len + 15, 10981da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 10991da177e4SLinus Torvalds } else { 11001da177e4SLinus Torvalds skb = NULL; 1101694aba69SEric Dumazet if (refcount_read(&sk->sk_wmem_alloc) + wmem_alloc_delta <= 11021da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 1103694aba69SEric Dumazet skb = alloc_skb(alloclen + hh_len + 15, 11041da177e4SLinus Torvalds sk->sk_allocation); 110551456b29SIan Morris if (unlikely(!skb)) 11061da177e4SLinus Torvalds err = -ENOBUFS; 11071da177e4SLinus Torvalds } 110851456b29SIan Morris if (!skb) 11091da177e4SLinus Torvalds goto error; 11101da177e4SLinus Torvalds 11111da177e4SLinus Torvalds /* 11121da177e4SLinus Torvalds * Fill in the control structures 11131da177e4SLinus Torvalds */ 11141da177e4SLinus Torvalds skb->ip_summed = csummode; 11151da177e4SLinus Torvalds skb->csum = 0; 11161da177e4SLinus Torvalds skb_reserve(skb, hh_len); 111711878b40SWillem de Bruijn 11181da177e4SLinus Torvalds /* 11191da177e4SLinus Torvalds * Find where to start putting bytes. 11201da177e4SLinus Torvalds */ 112115e36f5bSWillem de Bruijn data = skb_put(skb, fraglen + exthdrlen - pagedlen); 1122c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 1123b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1124b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 1125353e5c9aSSteffen Klassert data += fragheaderlen + exthdrlen; 11261da177e4SLinus Torvalds 11271da177e4SLinus Torvalds if (fraggap) { 11281da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 11291da177e4SLinus Torvalds skb_prev, maxfraglen, 11301da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 11311da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 11321da177e4SLinus Torvalds skb->csum); 11331da177e4SLinus Torvalds data += fraggap; 1134e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 11351da177e4SLinus Torvalds } 11361da177e4SLinus Torvalds 113715e36f5bSWillem de Bruijn copy = datalen - transhdrlen - fraggap - pagedlen; 11381da177e4SLinus Torvalds if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 11391da177e4SLinus Torvalds err = -EFAULT; 11401da177e4SLinus Torvalds kfree_skb(skb); 11411da177e4SLinus Torvalds goto error; 11421da177e4SLinus Torvalds } 11431da177e4SLinus Torvalds 11441da177e4SLinus Torvalds offset += copy; 114515e36f5bSWillem de Bruijn length -= copy + transhdrlen; 11461da177e4SLinus Torvalds transhdrlen = 0; 11471da177e4SLinus Torvalds exthdrlen = 0; 11481da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 11491da177e4SLinus Torvalds 115052900d22SWillem de Bruijn /* only the initial fragment is time stamped */ 115152900d22SWillem de Bruijn skb_shinfo(skb)->tx_flags = cork->tx_flags; 115252900d22SWillem de Bruijn cork->tx_flags = 0; 115352900d22SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 115452900d22SWillem de Bruijn tskey = 0; 115552900d22SWillem de Bruijn skb_zcopy_set(skb, uarg, &extra_uref); 115652900d22SWillem de Bruijn 11570dec879fSJulian Anastasov if ((flags & MSG_CONFIRM) && !skb_prev) 11580dec879fSJulian Anastasov skb_set_dst_pending_confirm(skb, 1); 11590dec879fSJulian Anastasov 11601da177e4SLinus Torvalds /* 11611da177e4SLinus Torvalds * Put the packet on the pending queue. 11621da177e4SLinus Torvalds */ 1163694aba69SEric Dumazet if (!skb->destructor) { 1164694aba69SEric Dumazet skb->destructor = sock_wfree; 1165694aba69SEric Dumazet skb->sk = sk; 1166694aba69SEric Dumazet wmem_alloc_delta += skb->truesize; 1167694aba69SEric Dumazet } 11681470ddf7SHerbert Xu __skb_queue_tail(queue, skb); 11691da177e4SLinus Torvalds continue; 11701da177e4SLinus Torvalds } 11711da177e4SLinus Torvalds 11721da177e4SLinus Torvalds if (copy > length) 11731da177e4SLinus Torvalds copy = length; 11741da177e4SLinus Torvalds 1175113f99c3SWillem de Bruijn if (!(rt->dst.dev->features&NETIF_F_SG) && 1176113f99c3SWillem de Bruijn skb_tailroom(skb) >= copy) { 11771da177e4SLinus Torvalds unsigned int off; 11781da177e4SLinus Torvalds 11791da177e4SLinus Torvalds off = skb->len; 11801da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 11811da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 11821da177e4SLinus Torvalds __skb_trim(skb, off); 11831da177e4SLinus Torvalds err = -EFAULT; 11841da177e4SLinus Torvalds goto error; 11851da177e4SLinus Torvalds } 1186b5947e5dSWillem de Bruijn } else if (!uarg || !uarg->zerocopy) { 11871da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 11881da177e4SLinus Torvalds 11891da177e4SLinus Torvalds err = -ENOMEM; 11905640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 11911da177e4SLinus Torvalds goto error; 11921da177e4SLinus Torvalds 11935640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 11945640f768SEric Dumazet pfrag->offset)) { 11951da177e4SLinus Torvalds err = -EMSGSIZE; 11965640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 11971da177e4SLinus Torvalds goto error; 11985640f768SEric Dumazet 11995640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 12005640f768SEric Dumazet pfrag->offset, 0); 12015640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 12025640f768SEric Dumazet get_page(pfrag->page); 12031da177e4SLinus Torvalds } 12045640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 12055640f768SEric Dumazet if (getfrag(from, 12065640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 12075640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 12085640f768SEric Dumazet goto error_efault; 12095640f768SEric Dumazet 12105640f768SEric Dumazet pfrag->offset += copy; 12115640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 12121da177e4SLinus Torvalds skb->len += copy; 12131da177e4SLinus Torvalds skb->data_len += copy; 1214f945fa7aSHerbert Xu skb->truesize += copy; 1215694aba69SEric Dumazet wmem_alloc_delta += copy; 1216b5947e5dSWillem de Bruijn } else { 1217b5947e5dSWillem de Bruijn err = skb_zerocopy_iter_dgram(skb, from, copy); 1218b5947e5dSWillem de Bruijn if (err < 0) 1219b5947e5dSWillem de Bruijn goto error; 12201da177e4SLinus Torvalds } 12211da177e4SLinus Torvalds offset += copy; 12221da177e4SLinus Torvalds length -= copy; 12231da177e4SLinus Torvalds } 12241da177e4SLinus Torvalds 12259e8445a5SPaolo Abeni if (wmem_alloc_delta) 1226694aba69SEric Dumazet refcount_add(wmem_alloc_delta, &sk->sk_wmem_alloc); 12271da177e4SLinus Torvalds return 0; 12281da177e4SLinus Torvalds 12295640f768SEric Dumazet error_efault: 12305640f768SEric Dumazet err = -EFAULT; 12311da177e4SLinus Torvalds error: 123297ef7b4cSWillem de Bruijn if (uarg) 123352900d22SWillem de Bruijn sock_zerocopy_put_abort(uarg, extra_uref); 12341470ddf7SHerbert Xu cork->length -= length; 12355e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 1236694aba69SEric Dumazet refcount_add(wmem_alloc_delta, &sk->sk_wmem_alloc); 12371da177e4SLinus Torvalds return err; 12381da177e4SLinus Torvalds } 12391da177e4SLinus Torvalds 12401470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork, 12411470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp) 12421470ddf7SHerbert Xu { 1243f6d8bd05SEric Dumazet struct ip_options_rcu *opt; 12441470ddf7SHerbert Xu struct rtable *rt; 12451470ddf7SHerbert Xu 12469783ccd0SGao Feng rt = *rtp; 12479783ccd0SGao Feng if (unlikely(!rt)) 12489783ccd0SGao Feng return -EFAULT; 12499783ccd0SGao Feng 12501470ddf7SHerbert Xu /* 12511470ddf7SHerbert Xu * setup for corking. 12521470ddf7SHerbert Xu */ 12531470ddf7SHerbert Xu opt = ipc->opt; 12541470ddf7SHerbert Xu if (opt) { 125551456b29SIan Morris if (!cork->opt) { 12561470ddf7SHerbert Xu cork->opt = kmalloc(sizeof(struct ip_options) + 40, 12571470ddf7SHerbert Xu sk->sk_allocation); 125851456b29SIan Morris if (unlikely(!cork->opt)) 12591470ddf7SHerbert Xu return -ENOBUFS; 12601470ddf7SHerbert Xu } 1261f6d8bd05SEric Dumazet memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen); 12621470ddf7SHerbert Xu cork->flags |= IPCORK_OPT; 12631470ddf7SHerbert Xu cork->addr = ipc->addr; 12641470ddf7SHerbert Xu } 12659783ccd0SGao Feng 1266482fc609SHannes Frederic Sowa cork->fragsize = ip_sk_use_pmtu(sk) ? 1267501a90c9SEric Dumazet dst_mtu(&rt->dst) : READ_ONCE(rt->dst.dev->mtu); 1268501a90c9SEric Dumazet 1269501a90c9SEric Dumazet if (!inetdev_valid_mtu(cork->fragsize)) 1270501a90c9SEric Dumazet return -ENETUNREACH; 1271bec1f6f6SWillem de Bruijn 1272fbf47813SWillem de Bruijn cork->gso_size = ipc->gso_size; 1273501a90c9SEric Dumazet 12741470ddf7SHerbert Xu cork->dst = &rt->dst; 1275501a90c9SEric Dumazet /* We stole this route, caller should not release it. */ 1276501a90c9SEric Dumazet *rtp = NULL; 1277501a90c9SEric Dumazet 12781470ddf7SHerbert Xu cork->length = 0; 1279aa661581SFrancesco Fusco cork->ttl = ipc->ttl; 1280aa661581SFrancesco Fusco cork->tos = ipc->tos; 1281c6af0c22SWillem de Bruijn cork->mark = ipc->sockc.mark; 1282aa661581SFrancesco Fusco cork->priority = ipc->priority; 1283bc969a97SJesus Sanchez-Palencia cork->transmit_time = ipc->sockc.transmit_time; 1284678ca42dSWillem de Bruijn cork->tx_flags = 0; 1285678ca42dSWillem de Bruijn sock_tx_timestamp(sk, ipc->sockc.tsflags, &cork->tx_flags); 12861470ddf7SHerbert Xu 12871470ddf7SHerbert Xu return 0; 12881470ddf7SHerbert Xu } 12891470ddf7SHerbert Xu 12901470ddf7SHerbert Xu /* 12911470ddf7SHerbert Xu * ip_append_data() and ip_append_page() can make one large IP datagram 12921470ddf7SHerbert Xu * from many pieces of data. Each pieces will be holded on the socket 12931470ddf7SHerbert Xu * until ip_push_pending_frames() is called. Each piece can be a page 12941470ddf7SHerbert Xu * or non-page data. 12951470ddf7SHerbert Xu * 12961470ddf7SHerbert Xu * Not only UDP, other transport protocols - e.g. raw sockets - can use 12971470ddf7SHerbert Xu * this interface potentially. 12981470ddf7SHerbert Xu * 12991470ddf7SHerbert Xu * LATER: length must be adjusted by pad at tail, when it is required. 13001470ddf7SHerbert Xu */ 1301f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4, 13021470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, int len, 13031470ddf7SHerbert Xu int odd, struct sk_buff *skb), 13041470ddf7SHerbert Xu void *from, int length, int transhdrlen, 13051470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 13061470ddf7SHerbert Xu unsigned int flags) 13071470ddf7SHerbert Xu { 13081470ddf7SHerbert Xu struct inet_sock *inet = inet_sk(sk); 13091470ddf7SHerbert Xu int err; 13101470ddf7SHerbert Xu 13111470ddf7SHerbert Xu if (flags&MSG_PROBE) 13121470ddf7SHerbert Xu return 0; 13131470ddf7SHerbert Xu 13141470ddf7SHerbert Xu if (skb_queue_empty(&sk->sk_write_queue)) { 1315bdc712b4SDavid S. Miller err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp); 13161470ddf7SHerbert Xu if (err) 13171470ddf7SHerbert Xu return err; 13181470ddf7SHerbert Xu } else { 13191470ddf7SHerbert Xu transhdrlen = 0; 13201470ddf7SHerbert Xu } 13211470ddf7SHerbert Xu 13225640f768SEric Dumazet return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base, 13235640f768SEric Dumazet sk_page_frag(sk), getfrag, 13241470ddf7SHerbert Xu from, length, transhdrlen, flags); 13251470ddf7SHerbert Xu } 13261470ddf7SHerbert Xu 1327f5fca608SDavid S. Miller ssize_t ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page, 13281da177e4SLinus Torvalds int offset, size_t size, int flags) 13291da177e4SLinus Torvalds { 13301da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 13311da177e4SLinus Torvalds struct sk_buff *skb; 13321da177e4SLinus Torvalds struct rtable *rt; 13331da177e4SLinus Torvalds struct ip_options *opt = NULL; 1334bdc712b4SDavid S. Miller struct inet_cork *cork; 13351da177e4SLinus Torvalds int hh_len; 13361da177e4SLinus Torvalds int mtu; 13371da177e4SLinus Torvalds int len; 13381da177e4SLinus Torvalds int err; 1339daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize; 13401da177e4SLinus Torvalds 13411da177e4SLinus Torvalds if (inet->hdrincl) 13421da177e4SLinus Torvalds return -EPERM; 13431da177e4SLinus Torvalds 13441da177e4SLinus Torvalds if (flags&MSG_PROBE) 13451da177e4SLinus Torvalds return 0; 13461da177e4SLinus Torvalds 13471da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) 13481da177e4SLinus Torvalds return -EINVAL; 13491da177e4SLinus Torvalds 1350bdc712b4SDavid S. Miller cork = &inet->cork.base; 1351bdc712b4SDavid S. Miller rt = (struct rtable *)cork->dst; 1352bdc712b4SDavid S. Miller if (cork->flags & IPCORK_OPT) 1353bdc712b4SDavid S. Miller opt = cork->opt; 13541da177e4SLinus Torvalds 1355d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) 13561da177e4SLinus Torvalds return -EOPNOTSUPP; 13571da177e4SLinus Torvalds 1358d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 1359bec1f6f6SWillem de Bruijn mtu = cork->gso_size ? IP_MAX_MTU : cork->fragsize; 13601da177e4SLinus Torvalds 13611da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 13621da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 136360ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 13641da177e4SLinus Torvalds 1365daba287bSHannes Frederic Sowa if (cork->length + size > maxnonfragsize - fragheaderlen) { 136661e7f09dSHannes Frederic Sowa ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 136761e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 13681da177e4SLinus Torvalds return -EMSGSIZE; 13691da177e4SLinus Torvalds } 13701da177e4SLinus Torvalds 137151456b29SIan Morris skb = skb_peek_tail(&sk->sk_write_queue); 137251456b29SIan Morris if (!skb) 13731da177e4SLinus Torvalds return -EINVAL; 13741da177e4SLinus Torvalds 1375a8c4a252SHannes Frederic Sowa cork->length += size; 1376e89e9cf5SAnanda Raju 13771da177e4SLinus Torvalds while (size > 0) { 13781da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 13791da177e4SLinus Torvalds len = mtu - skb->len; 13801da177e4SLinus Torvalds if (len < size) 13811da177e4SLinus Torvalds len = maxfraglen - skb->len; 1382ab2fb7e3SWillem de Bruijn 13831da177e4SLinus Torvalds if (len <= 0) { 13841da177e4SLinus Torvalds struct sk_buff *skb_prev; 13851da177e4SLinus Torvalds int alloclen; 13861da177e4SLinus Torvalds 13871da177e4SLinus Torvalds skb_prev = skb; 13881da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 13891da177e4SLinus Torvalds 13901da177e4SLinus Torvalds alloclen = fragheaderlen + hh_len + fraggap + 15; 13911da177e4SLinus Torvalds skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation); 13921da177e4SLinus Torvalds if (unlikely(!skb)) { 13931da177e4SLinus Torvalds err = -ENOBUFS; 13941da177e4SLinus Torvalds goto error; 13951da177e4SLinus Torvalds } 13961da177e4SLinus Torvalds 13971da177e4SLinus Torvalds /* 13981da177e4SLinus Torvalds * Fill in the control structures 13991da177e4SLinus Torvalds */ 14001da177e4SLinus Torvalds skb->ip_summed = CHECKSUM_NONE; 14011da177e4SLinus Torvalds skb->csum = 0; 14021da177e4SLinus Torvalds skb_reserve(skb, hh_len); 14031da177e4SLinus Torvalds 14041da177e4SLinus Torvalds /* 14051da177e4SLinus Torvalds * Find where to start putting bytes. 14061da177e4SLinus Torvalds */ 1407967b05f6SArnaldo Carvalho de Melo skb_put(skb, fragheaderlen + fraggap); 14082ca9e6f2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1409b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1410b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 14111da177e4SLinus Torvalds if (fraggap) { 1412967b05f6SArnaldo Carvalho de Melo skb->csum = skb_copy_and_csum_bits(skb_prev, 1413967b05f6SArnaldo Carvalho de Melo maxfraglen, 14149c70220bSArnaldo Carvalho de Melo skb_transport_header(skb), 1415967b05f6SArnaldo Carvalho de Melo fraggap, 0); 14161da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 14171da177e4SLinus Torvalds skb->csum); 1418e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 14191da177e4SLinus Torvalds } 14201da177e4SLinus Torvalds 14211da177e4SLinus Torvalds /* 14221da177e4SLinus Torvalds * Put the packet on the pending queue. 14231da177e4SLinus Torvalds */ 14241da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 14251da177e4SLinus Torvalds continue; 14261da177e4SLinus Torvalds } 14271da177e4SLinus Torvalds 14281da177e4SLinus Torvalds if (len > size) 14291da177e4SLinus Torvalds len = size; 1430be12a1feSHannes Frederic Sowa 1431be12a1feSHannes Frederic Sowa if (skb_append_pagefrags(skb, page, offset, len)) { 14321da177e4SLinus Torvalds err = -EMSGSIZE; 14331da177e4SLinus Torvalds goto error; 14341da177e4SLinus Torvalds } 14351da177e4SLinus Torvalds 14361da177e4SLinus Torvalds if (skb->ip_summed == CHECKSUM_NONE) { 143744bb9363SAl Viro __wsum csum; 14381da177e4SLinus Torvalds csum = csum_page(page, offset, len); 14391da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, skb->len); 14401da177e4SLinus Torvalds } 14411da177e4SLinus Torvalds 14421da177e4SLinus Torvalds skb->len += len; 14431da177e4SLinus Torvalds skb->data_len += len; 14441e34a11dSDavid S. Miller skb->truesize += len; 144514afee4bSReshetova, Elena refcount_add(len, &sk->sk_wmem_alloc); 14461da177e4SLinus Torvalds offset += len; 14471da177e4SLinus Torvalds size -= len; 14481da177e4SLinus Torvalds } 14491da177e4SLinus Torvalds return 0; 14501da177e4SLinus Torvalds 14511da177e4SLinus Torvalds error: 1452bdc712b4SDavid S. Miller cork->length -= size; 14535e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 14541da177e4SLinus Torvalds return err; 14551da177e4SLinus Torvalds } 14561da177e4SLinus Torvalds 14571470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork) 1458429f08e9SPavel Emelyanov { 14591470ddf7SHerbert Xu cork->flags &= ~IPCORK_OPT; 14601470ddf7SHerbert Xu kfree(cork->opt); 14611470ddf7SHerbert Xu cork->opt = NULL; 14621470ddf7SHerbert Xu dst_release(cork->dst); 14631470ddf7SHerbert Xu cork->dst = NULL; 1464429f08e9SPavel Emelyanov } 1465429f08e9SPavel Emelyanov 14661da177e4SLinus Torvalds /* 14671da177e4SLinus Torvalds * Combined all pending IP fragments on the socket as one IP datagram 14681da177e4SLinus Torvalds * and push them out. 14691da177e4SLinus Torvalds */ 14701c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk, 147177968b78SDavid S. Miller struct flowi4 *fl4, 14721470ddf7SHerbert Xu struct sk_buff_head *queue, 14731470ddf7SHerbert Xu struct inet_cork *cork) 14741da177e4SLinus Torvalds { 14751da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 14761da177e4SLinus Torvalds struct sk_buff **tail_skb; 14771da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 14780388b004SPavel Emelyanov struct net *net = sock_net(sk); 14791da177e4SLinus Torvalds struct ip_options *opt = NULL; 14801470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 14811da177e4SLinus Torvalds struct iphdr *iph; 148276ab608dSAlexey Dobriyan __be16 df = 0; 14831da177e4SLinus Torvalds __u8 ttl; 14841da177e4SLinus Torvalds 148551456b29SIan Morris skb = __skb_dequeue(queue); 148651456b29SIan Morris if (!skb) 14871da177e4SLinus Torvalds goto out; 14881da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 14891da177e4SLinus Torvalds 14901da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1491d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1492bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 14931470ddf7SHerbert Xu while ((tmp_skb = __skb_dequeue(queue)) != NULL) { 1494cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 14951da177e4SLinus Torvalds *tail_skb = tmp_skb; 14961da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 14971da177e4SLinus Torvalds skb->len += tmp_skb->len; 14981da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 14991da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 15001da177e4SLinus Torvalds tmp_skb->destructor = NULL; 15011da177e4SLinus Torvalds tmp_skb->sk = NULL; 15021da177e4SLinus Torvalds } 15031da177e4SLinus Torvalds 15041da177e4SLinus Torvalds /* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow 15051da177e4SLinus Torvalds * to fragment the frame generated here. No matter, what transforms 15061da177e4SLinus Torvalds * how transforms change size of the packet, it will come out. 15071da177e4SLinus Torvalds */ 150860ff7467SWANG Cong skb->ignore_df = ip_sk_ignore_df(sk); 15091da177e4SLinus Torvalds 15101da177e4SLinus Torvalds /* DF bit is set when we want to see DF on outgoing frames. 151160ff7467SWANG Cong * If ignore_df is set too, we still allow to fragment this frame 15121da177e4SLinus Torvalds * locally. */ 1513482fc609SHannes Frederic Sowa if (inet->pmtudisc == IP_PMTUDISC_DO || 1514482fc609SHannes Frederic Sowa inet->pmtudisc == IP_PMTUDISC_PROBE || 1515d8d1f30bSChangli Gao (skb->len <= dst_mtu(&rt->dst) && 1516d8d1f30bSChangli Gao ip_dont_fragment(sk, &rt->dst))) 15171da177e4SLinus Torvalds df = htons(IP_DF); 15181da177e4SLinus Torvalds 15191470ddf7SHerbert Xu if (cork->flags & IPCORK_OPT) 15201470ddf7SHerbert Xu opt = cork->opt; 15211da177e4SLinus Torvalds 1522aa661581SFrancesco Fusco if (cork->ttl != 0) 1523aa661581SFrancesco Fusco ttl = cork->ttl; 1524aa661581SFrancesco Fusco else if (rt->rt_type == RTN_MULTICAST) 15251da177e4SLinus Torvalds ttl = inet->mc_ttl; 15261da177e4SLinus Torvalds else 1527d8d1f30bSChangli Gao ttl = ip_select_ttl(inet, &rt->dst); 15281da177e4SLinus Torvalds 1529749154aaSAnsis Atteka iph = ip_hdr(skb); 15301da177e4SLinus Torvalds iph->version = 4; 15311da177e4SLinus Torvalds iph->ihl = 5; 1532aa661581SFrancesco Fusco iph->tos = (cork->tos != -1) ? cork->tos : inet->tos; 15331da177e4SLinus Torvalds iph->frag_off = df; 15341da177e4SLinus Torvalds iph->ttl = ttl; 15351da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 153684f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 1537b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, sk); 15381da177e4SLinus Torvalds 153922f728f8SDavid S. Miller if (opt) { 154022f728f8SDavid S. Miller iph->ihl += opt->optlen>>2; 154122f728f8SDavid S. Miller ip_options_build(skb, opt, cork->addr, rt, 0); 154222f728f8SDavid S. Miller } 154322f728f8SDavid S. Miller 1544aa661581SFrancesco Fusco skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority; 1545c6af0c22SWillem de Bruijn skb->mark = cork->mark; 1546bc969a97SJesus Sanchez-Palencia skb->tstamp = cork->transmit_time; 1547a21bba94SEric Dumazet /* 1548a21bba94SEric Dumazet * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec 1549a21bba94SEric Dumazet * on dst refcount 1550a21bba94SEric Dumazet */ 15511470ddf7SHerbert Xu cork->dst = NULL; 1552d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 15531da177e4SLinus Torvalds 155496793b48SDavid L Stevens if (iph->protocol == IPPROTO_ICMP) 15550388b004SPavel Emelyanov icmp_out_count(net, ((struct icmphdr *) 155696793b48SDavid L Stevens skb_transport_header(skb))->type); 155796793b48SDavid L Stevens 15581c32c5adSHerbert Xu ip_cork_release(cork); 15591c32c5adSHerbert Xu out: 15601c32c5adSHerbert Xu return skb; 15611c32c5adSHerbert Xu } 15621c32c5adSHerbert Xu 1563b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb) 15641c32c5adSHerbert Xu { 15651c32c5adSHerbert Xu int err; 15661c32c5adSHerbert Xu 156733224b16SEric W. Biederman err = ip_local_out(net, skb->sk, skb); 15681da177e4SLinus Torvalds if (err) { 15691da177e4SLinus Torvalds if (err > 0) 15706ce9e7b5SEric Dumazet err = net_xmit_errno(err); 15711da177e4SLinus Torvalds if (err) 15721c32c5adSHerbert Xu IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS); 15731da177e4SLinus Torvalds } 15741da177e4SLinus Torvalds 15751da177e4SLinus Torvalds return err; 15761da177e4SLinus Torvalds } 15771da177e4SLinus Torvalds 157877968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4) 15791470ddf7SHerbert Xu { 15801c32c5adSHerbert Xu struct sk_buff *skb; 15811c32c5adSHerbert Xu 158277968b78SDavid S. Miller skb = ip_finish_skb(sk, fl4); 15831c32c5adSHerbert Xu if (!skb) 15841c32c5adSHerbert Xu return 0; 15851c32c5adSHerbert Xu 15861c32c5adSHerbert Xu /* Netfilter gets whole the not fragmented skb. */ 1587b5ec8eeaSEric Dumazet return ip_send_skb(sock_net(sk), skb); 15881470ddf7SHerbert Xu } 15891470ddf7SHerbert Xu 15901da177e4SLinus Torvalds /* 15911da177e4SLinus Torvalds * Throw away all pending data on the socket. 15921da177e4SLinus Torvalds */ 15931470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk, 15941470ddf7SHerbert Xu struct sk_buff_head *queue, 15951470ddf7SHerbert Xu struct inet_cork *cork) 15961da177e4SLinus Torvalds { 15971da177e4SLinus Torvalds struct sk_buff *skb; 15981da177e4SLinus Torvalds 15991470ddf7SHerbert Xu while ((skb = __skb_dequeue_tail(queue)) != NULL) 16001da177e4SLinus Torvalds kfree_skb(skb); 16011da177e4SLinus Torvalds 16021470ddf7SHerbert Xu ip_cork_release(cork); 16031470ddf7SHerbert Xu } 16041470ddf7SHerbert Xu 16051470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk) 16061470ddf7SHerbert Xu { 1607bdc712b4SDavid S. Miller __ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base); 16081da177e4SLinus Torvalds } 16091da177e4SLinus Torvalds 16101c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk, 161177968b78SDavid S. Miller struct flowi4 *fl4, 16121c32c5adSHerbert Xu int getfrag(void *from, char *to, int offset, 16131c32c5adSHerbert Xu int len, int odd, struct sk_buff *skb), 16141c32c5adSHerbert Xu void *from, int length, int transhdrlen, 16151c32c5adSHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 16161cd7884dSWillem de Bruijn struct inet_cork *cork, unsigned int flags) 16171c32c5adSHerbert Xu { 16181c32c5adSHerbert Xu struct sk_buff_head queue; 16191c32c5adSHerbert Xu int err; 16201c32c5adSHerbert Xu 16211c32c5adSHerbert Xu if (flags & MSG_PROBE) 16221c32c5adSHerbert Xu return NULL; 16231c32c5adSHerbert Xu 16241c32c5adSHerbert Xu __skb_queue_head_init(&queue); 16251c32c5adSHerbert Xu 16261cd7884dSWillem de Bruijn cork->flags = 0; 16271cd7884dSWillem de Bruijn cork->addr = 0; 16281cd7884dSWillem de Bruijn cork->opt = NULL; 16291cd7884dSWillem de Bruijn err = ip_setup_cork(sk, cork, ipc, rtp); 16301c32c5adSHerbert Xu if (err) 16311c32c5adSHerbert Xu return ERR_PTR(err); 16321c32c5adSHerbert Xu 16331cd7884dSWillem de Bruijn err = __ip_append_data(sk, fl4, &queue, cork, 16345640f768SEric Dumazet ¤t->task_frag, getfrag, 16351c32c5adSHerbert Xu from, length, transhdrlen, flags); 16361c32c5adSHerbert Xu if (err) { 16371cd7884dSWillem de Bruijn __ip_flush_pending_frames(sk, &queue, cork); 16381c32c5adSHerbert Xu return ERR_PTR(err); 16391c32c5adSHerbert Xu } 16401c32c5adSHerbert Xu 16411cd7884dSWillem de Bruijn return __ip_make_skb(sk, fl4, &queue, cork); 16421c32c5adSHerbert Xu } 16431da177e4SLinus Torvalds 16441da177e4SLinus Torvalds /* 16451da177e4SLinus Torvalds * Fetch data from kernel space and fill in checksum if needed. 16461da177e4SLinus Torvalds */ 16471da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset, 16481da177e4SLinus Torvalds int len, int odd, struct sk_buff *skb) 16491da177e4SLinus Torvalds { 16505084205fSAl Viro __wsum csum; 16511da177e4SLinus Torvalds 16521da177e4SLinus Torvalds csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0); 16531da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 16541da177e4SLinus Torvalds return 0; 16551da177e4SLinus Torvalds } 16561da177e4SLinus Torvalds 16571da177e4SLinus Torvalds /* 16581da177e4SLinus Torvalds * Generic function to send a packet as reply to another packet. 1659be9f4a44SEric Dumazet * Used to send some TCP resets/acks so far. 16601da177e4SLinus Torvalds */ 1661bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb, 166224a2d43dSEric Dumazet const struct ip_options *sopt, 166324a2d43dSEric Dumazet __be32 daddr, __be32 saddr, 166424a2d43dSEric Dumazet const struct ip_reply_arg *arg, 1665d6fb396cSEric Dumazet unsigned int len, u64 transmit_time) 16661da177e4SLinus Torvalds { 1667f6d8bd05SEric Dumazet struct ip_options_data replyopts; 16681da177e4SLinus Torvalds struct ipcm_cookie ipc; 166977968b78SDavid S. Miller struct flowi4 fl4; 1670511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1671bdbbb852SEric Dumazet struct net *net = sock_net(sk); 1672be9f4a44SEric Dumazet struct sk_buff *nskb; 16734062090eSVasily Averin int err; 1674f7ba868bSDavid Ahern int oif; 16751da177e4SLinus Torvalds 167691ed1e66SPaolo Abeni if (__ip_options_echo(net, &replyopts.opt.opt, skb, sopt)) 16771da177e4SLinus Torvalds return; 16781da177e4SLinus Torvalds 167935178206SWillem de Bruijn ipcm_init(&ipc); 16800a5ebb80SDavid S. Miller ipc.addr = daddr; 1681d6fb396cSEric Dumazet ipc.sockc.transmit_time = transmit_time; 16821da177e4SLinus Torvalds 1683f6d8bd05SEric Dumazet if (replyopts.opt.opt.optlen) { 16841da177e4SLinus Torvalds ipc.opt = &replyopts.opt; 16851da177e4SLinus Torvalds 1686f6d8bd05SEric Dumazet if (replyopts.opt.opt.srr) 1687f6d8bd05SEric Dumazet daddr = replyopts.opt.opt.faddr; 16881da177e4SLinus Torvalds } 16891da177e4SLinus Torvalds 1690f7ba868bSDavid Ahern oif = arg->bound_dev_if; 16919b6c14d5SDavid Ahern if (!oif && netif_index_is_l3_master(net, skb->skb_iif)) 16929b6c14d5SDavid Ahern oif = skb->skb_iif; 1693f7ba868bSDavid Ahern 1694f7ba868bSDavid Ahern flowi4_init_output(&fl4, oif, 169500483690SJon Maxwell IP4_REPLY_MARK(net, skb->mark) ?: sk->sk_mark, 169666b13d99SEric Dumazet RT_TOS(arg->tos), 1697be9f4a44SEric Dumazet RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol, 1698538de0e0SDavid S. Miller ip_reply_arg_flowi_flags(arg), 169970e73416SDavid S. Miller daddr, saddr, 1700e2d118a1SLorenzo Colitti tcp_hdr(skb)->source, tcp_hdr(skb)->dest, 1701e2d118a1SLorenzo Colitti arg->uid); 17029d6ec938SDavid S. Miller security_skb_classify_flow(skb, flowi4_to_flowi(&fl4)); 1703be9f4a44SEric Dumazet rt = ip_route_output_key(net, &fl4); 1704b23dd4feSDavid S. Miller if (IS_ERR(rt)) 17051da177e4SLinus Torvalds return; 17061da177e4SLinus Torvalds 1707*ba9e04a7SWei Wang inet_sk(sk)->tos = arg->tos & ~INET_ECN_MASK; 17081da177e4SLinus Torvalds 1709eddc9ec5SArnaldo Carvalho de Melo sk->sk_protocol = ip_hdr(skb)->protocol; 1710f0e48dbfSPatrick McHardy sk->sk_bound_dev_if = arg->bound_dev_if; 1711be9f4a44SEric Dumazet sk->sk_sndbuf = sysctl_wmem_default; 17120da7536fSWillem de Bruijn ipc.sockc.mark = fl4.flowi4_mark; 17134062090eSVasily Averin err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base, 17144062090eSVasily Averin len, 0, &ipc, &rt, MSG_DONTWAIT); 17154062090eSVasily Averin if (unlikely(err)) { 17164062090eSVasily Averin ip_flush_pending_frames(sk); 17174062090eSVasily Averin goto out; 17184062090eSVasily Averin } 17194062090eSVasily Averin 1720be9f4a44SEric Dumazet nskb = skb_peek(&sk->sk_write_queue); 1721be9f4a44SEric Dumazet if (nskb) { 17221da177e4SLinus Torvalds if (arg->csumoffset >= 0) 1723be9f4a44SEric Dumazet *((__sum16 *)skb_transport_header(nskb) + 1724be9f4a44SEric Dumazet arg->csumoffset) = csum_fold(csum_add(nskb->csum, 17259c70220bSArnaldo Carvalho de Melo arg->csum)); 1726be9f4a44SEric Dumazet nskb->ip_summed = CHECKSUM_NONE; 172777968b78SDavid S. Miller ip_push_pending_frames(sk, &fl4); 17281da177e4SLinus Torvalds } 17294062090eSVasily Averin out: 17301da177e4SLinus Torvalds ip_rt_put(rt); 17311da177e4SLinus Torvalds } 17321da177e4SLinus Torvalds 17331da177e4SLinus Torvalds void __init ip_init(void) 17341da177e4SLinus Torvalds { 17351da177e4SLinus Torvalds ip_rt_init(); 17361da177e4SLinus Torvalds inet_initpeers(); 17371da177e4SLinus Torvalds 173872c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST) 173972c1d3bdSWANG Cong igmp_mc_init(); 17401da177e4SLinus Torvalds #endif 17411da177e4SLinus Torvalds } 1742