11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * INET An implementation of the TCP/IP protocol suite for the LINUX 31da177e4SLinus Torvalds * operating system. INET is implemented using the BSD Socket 41da177e4SLinus Torvalds * interface as the means of communication with the user level. 51da177e4SLinus Torvalds * 61da177e4SLinus Torvalds * The Internet Protocol (IP) output module. 71da177e4SLinus Torvalds * 802c30a84SJesper Juhl * Authors: Ross Biro 91da177e4SLinus Torvalds * Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG> 101da177e4SLinus Torvalds * Donald Becker, <becker@super.org> 111da177e4SLinus Torvalds * Alan Cox, <Alan.Cox@linux.org> 121da177e4SLinus Torvalds * Richard Underwood 131da177e4SLinus Torvalds * Stefan Becker, <stefanb@yello.ping.de> 141da177e4SLinus Torvalds * Jorge Cwik, <jorge@laser.satlink.net> 151da177e4SLinus Torvalds * Arnt Gulbrandsen, <agulbra@nvg.unit.no> 161da177e4SLinus Torvalds * Hirokazu Takahashi, <taka@valinux.co.jp> 171da177e4SLinus Torvalds * 181da177e4SLinus Torvalds * See ip_input.c for original log 191da177e4SLinus Torvalds * 201da177e4SLinus Torvalds * Fixes: 211da177e4SLinus Torvalds * Alan Cox : Missing nonblock feature in ip_build_xmit. 221da177e4SLinus Torvalds * Mike Kilburn : htons() missing in ip_build_xmit. 231da177e4SLinus Torvalds * Bradford Johnson: Fix faulty handling of some frames when 241da177e4SLinus Torvalds * no route is found. 251da177e4SLinus Torvalds * Alexander Demenshin: Missing sk/skb free in ip_queue_xmit 261da177e4SLinus Torvalds * (in case if packet not accepted by 271da177e4SLinus Torvalds * output firewall rules) 281da177e4SLinus Torvalds * Mike McLagan : Routing by source 291da177e4SLinus Torvalds * Alexey Kuznetsov: use new route cache 301da177e4SLinus Torvalds * Andi Kleen: Fix broken PMTU recovery and remove 311da177e4SLinus Torvalds * some redundant tests. 321da177e4SLinus Torvalds * Vitaly E. Lavrov : Transparent proxy revived after year coma. 331da177e4SLinus Torvalds * Andi Kleen : Replace ip_reply with ip_send_reply. 341da177e4SLinus Torvalds * Andi Kleen : Split fast and slow ip_build_xmit path 351da177e4SLinus Torvalds * for decreased register pressure on x86 361da177e4SLinus Torvalds * and more readibility. 371da177e4SLinus Torvalds * Marc Boucher : When call_out_firewall returns FW_QUEUE, 381da177e4SLinus Torvalds * silently drop skb instead of failing with -EPERM. 391da177e4SLinus Torvalds * Detlev Wengorz : Copy protocol for fragments. 401da177e4SLinus Torvalds * Hirokazu Takahashi: HW checksumming for outgoing UDP 411da177e4SLinus Torvalds * datagrams. 421da177e4SLinus Torvalds * Hirokazu Takahashi: sendfile() on UDP works now. 431da177e4SLinus Torvalds */ 441da177e4SLinus Torvalds 457c0f6ba6SLinus Torvalds #include <linux/uaccess.h> 461da177e4SLinus Torvalds #include <linux/module.h> 471da177e4SLinus Torvalds #include <linux/types.h> 481da177e4SLinus Torvalds #include <linux/kernel.h> 491da177e4SLinus Torvalds #include <linux/mm.h> 501da177e4SLinus Torvalds #include <linux/string.h> 511da177e4SLinus Torvalds #include <linux/errno.h> 52a1f8e7f7SAl Viro #include <linux/highmem.h> 535a0e3ad6STejun Heo #include <linux/slab.h> 541da177e4SLinus Torvalds 551da177e4SLinus Torvalds #include <linux/socket.h> 561da177e4SLinus Torvalds #include <linux/sockios.h> 571da177e4SLinus Torvalds #include <linux/in.h> 581da177e4SLinus Torvalds #include <linux/inet.h> 591da177e4SLinus Torvalds #include <linux/netdevice.h> 601da177e4SLinus Torvalds #include <linux/etherdevice.h> 611da177e4SLinus Torvalds #include <linux/proc_fs.h> 621da177e4SLinus Torvalds #include <linux/stat.h> 631da177e4SLinus Torvalds #include <linux/init.h> 641da177e4SLinus Torvalds 651da177e4SLinus Torvalds #include <net/snmp.h> 661da177e4SLinus Torvalds #include <net/ip.h> 671da177e4SLinus Torvalds #include <net/protocol.h> 681da177e4SLinus Torvalds #include <net/route.h> 69cfacb057SPatrick McHardy #include <net/xfrm.h> 701da177e4SLinus Torvalds #include <linux/skbuff.h> 711da177e4SLinus Torvalds #include <net/sock.h> 721da177e4SLinus Torvalds #include <net/arp.h> 731da177e4SLinus Torvalds #include <net/icmp.h> 741da177e4SLinus Torvalds #include <net/checksum.h> 751da177e4SLinus Torvalds #include <net/inetpeer.h> 7614972cbdSRoopa Prabhu #include <net/lwtunnel.h> 7733b48679SDaniel Mack #include <linux/bpf-cgroup.h> 781da177e4SLinus Torvalds #include <linux/igmp.h> 791da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h> 801da177e4SLinus Torvalds #include <linux/netfilter_bridge.h> 811da177e4SLinus Torvalds #include <linux/netlink.h> 826cbb0df7SArnaldo Carvalho de Melo #include <linux/tcp.h> 831da177e4SLinus Torvalds 84694869b3SEric W. Biederman static int 85694869b3SEric W. Biederman ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 86c5501eb3SFlorian Westphal unsigned int mtu, 87694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)); 8849d16b23SAndy Zhou 891da177e4SLinus Torvalds /* Generate a checksum for an outgoing IP datagram. */ 902fbd9679SDenis Efremov void ip_send_check(struct iphdr *iph) 911da177e4SLinus Torvalds { 921da177e4SLinus Torvalds iph->check = 0; 931da177e4SLinus Torvalds iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl); 941da177e4SLinus Torvalds } 954bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_send_check); 961da177e4SLinus Torvalds 97cf91a99dSEric W. Biederman int __ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb) 98c439cb2eSHerbert Xu { 99c439cb2eSHerbert Xu struct iphdr *iph = ip_hdr(skb); 100c439cb2eSHerbert Xu 101c439cb2eSHerbert Xu iph->tot_len = htons(skb->len); 102c439cb2eSHerbert Xu ip_send_check(iph); 103a8e3e1a9SDavid Ahern 104a8e3e1a9SDavid Ahern /* if egress device is enslaved to an L3 master device pass the 105a8e3e1a9SDavid Ahern * skb to its handler for processing 106a8e3e1a9SDavid Ahern */ 107a8e3e1a9SDavid Ahern skb = l3mdev_ip_out(sk, skb); 108a8e3e1a9SDavid Ahern if (unlikely(!skb)) 109a8e3e1a9SDavid Ahern return 0; 110a8e3e1a9SDavid Ahern 111f4180439SEli Cooper skb->protocol = htons(ETH_P_IP); 112f4180439SEli Cooper 11329a26a56SEric W. Biederman return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT, 11429a26a56SEric W. Biederman net, sk, skb, NULL, skb_dst(skb)->dev, 11513206b6bSEric W. Biederman dst_output); 1167026b1ddSDavid Miller } 1177026b1ddSDavid Miller 11833224b16SEric W. Biederman int ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb) 119c439cb2eSHerbert Xu { 120c439cb2eSHerbert Xu int err; 121c439cb2eSHerbert Xu 122cf91a99dSEric W. Biederman err = __ip_local_out(net, sk, skb); 123c439cb2eSHerbert Xu if (likely(err == 1)) 12413206b6bSEric W. Biederman err = dst_output(net, sk, skb); 125c439cb2eSHerbert Xu 126c439cb2eSHerbert Xu return err; 127c439cb2eSHerbert Xu } 128e2cb77dbSEric W. Biederman EXPORT_SYMBOL_GPL(ip_local_out); 129c439cb2eSHerbert Xu 1301da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst) 1311da177e4SLinus Torvalds { 1321da177e4SLinus Torvalds int ttl = inet->uc_ttl; 1331da177e4SLinus Torvalds 1341da177e4SLinus Torvalds if (ttl < 0) 135323e126fSDavid S. Miller ttl = ip4_dst_hoplimit(dst); 1361da177e4SLinus Torvalds return ttl; 1371da177e4SLinus Torvalds } 1381da177e4SLinus Torvalds 1391da177e4SLinus Torvalds /* 1401da177e4SLinus Torvalds * Add an ip header to a skbuff and send it out. 1411da177e4SLinus Torvalds * 1421da177e4SLinus Torvalds */ 143cfe673b0SEric Dumazet int ip_build_and_send_pkt(struct sk_buff *skb, const struct sock *sk, 144f6d8bd05SEric Dumazet __be32 saddr, __be32 daddr, struct ip_options_rcu *opt) 1451da177e4SLinus Torvalds { 1461da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 147511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 14877589ce0SEric W. Biederman struct net *net = sock_net(sk); 1491da177e4SLinus Torvalds struct iphdr *iph; 1501da177e4SLinus Torvalds 1511da177e4SLinus Torvalds /* Build the IP header. */ 152f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (opt ? opt->opt.optlen : 0)); 1538856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 154eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 1551da177e4SLinus Torvalds iph->version = 4; 1561da177e4SLinus Torvalds iph->ihl = 5; 1571da177e4SLinus Torvalds iph->tos = inet->tos; 158d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 159dd927a26SDavid S. Miller iph->daddr = (opt && opt->opt.srr ? opt->opt.faddr : daddr); 160dd927a26SDavid S. Miller iph->saddr = saddr; 1611da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 162cfe673b0SEric Dumazet if (ip_dont_fragment(sk, &rt->dst)) { 163cfe673b0SEric Dumazet iph->frag_off = htons(IP_DF); 164cfe673b0SEric Dumazet iph->id = 0; 165cfe673b0SEric Dumazet } else { 166cfe673b0SEric Dumazet iph->frag_off = 0; 16777589ce0SEric W. Biederman __ip_select_ident(net, iph, 1); 168cfe673b0SEric Dumazet } 1691da177e4SLinus Torvalds 170f6d8bd05SEric Dumazet if (opt && opt->opt.optlen) { 171f6d8bd05SEric Dumazet iph->ihl += opt->opt.optlen>>2; 172f6d8bd05SEric Dumazet ip_options_build(skb, &opt->opt, daddr, rt, 0); 1731da177e4SLinus Torvalds } 1741da177e4SLinus Torvalds 1751da177e4SLinus Torvalds skb->priority = sk->sk_priority; 1764a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1771da177e4SLinus Torvalds 1781da177e4SLinus Torvalds /* Send it out. */ 17933224b16SEric W. Biederman return ip_local_out(net, skb->sk, skb); 1801da177e4SLinus Torvalds } 181d8c97a94SArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip_build_and_send_pkt); 182d8c97a94SArnaldo Carvalho de Melo 183694869b3SEric W. Biederman static int ip_finish_output2(struct net *net, struct sock *sk, struct sk_buff *skb) 1841da177e4SLinus Torvalds { 185adf30907SEric Dumazet struct dst_entry *dst = skb_dst(skb); 18680787ebcSMitsuru Chinen struct rtable *rt = (struct rtable *)dst; 1871da177e4SLinus Torvalds struct net_device *dev = dst->dev; 188c2636b4dSChuck Lever unsigned int hh_len = LL_RESERVED_SPACE(dev); 189f6b72b62SDavid S. Miller struct neighbour *neigh; 190a263b309SDavid S. Miller u32 nexthop; 1911da177e4SLinus Torvalds 192edf391ffSNeil Horman if (rt->rt_type == RTN_MULTICAST) { 1934ba1bf42SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTMCAST, skb->len); 194edf391ffSNeil Horman } else if (rt->rt_type == RTN_BROADCAST) 1954ba1bf42SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTBCAST, skb->len); 19680787ebcSMitsuru Chinen 1971da177e4SLinus Torvalds /* Be paranoid, rather than too clever. */ 1983b04dddeSStephen Hemminger if (unlikely(skb_headroom(skb) < hh_len && dev->header_ops)) { 1991da177e4SLinus Torvalds struct sk_buff *skb2; 2001da177e4SLinus Torvalds 2011da177e4SLinus Torvalds skb2 = skb_realloc_headroom(skb, LL_RESERVED_SPACE(dev)); 20251456b29SIan Morris if (!skb2) { 2031da177e4SLinus Torvalds kfree_skb(skb); 2041da177e4SLinus Torvalds return -ENOMEM; 2051da177e4SLinus Torvalds } 2061da177e4SLinus Torvalds if (skb->sk) 2071da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 2085d0ba55bSEric Dumazet consume_skb(skb); 2091da177e4SLinus Torvalds skb = skb2; 2101da177e4SLinus Torvalds } 2111da177e4SLinus Torvalds 21214972cbdSRoopa Prabhu if (lwtunnel_xmit_redirect(dst->lwtstate)) { 21314972cbdSRoopa Prabhu int res = lwtunnel_xmit(skb); 21414972cbdSRoopa Prabhu 21514972cbdSRoopa Prabhu if (res < 0 || res == LWTUNNEL_XMIT_DONE) 21614972cbdSRoopa Prabhu return res; 21714972cbdSRoopa Prabhu } 21814972cbdSRoopa Prabhu 219a263b309SDavid S. Miller rcu_read_lock_bh(); 220155e8336SJulian Anastasov nexthop = (__force u32) rt_nexthop(rt, ip_hdr(skb)->daddr); 221a263b309SDavid S. Miller neigh = __ipv4_neigh_lookup_noref(dev, nexthop); 222a263b309SDavid S. Miller if (unlikely(!neigh)) 223a263b309SDavid S. Miller neigh = __neigh_create(&arp_tbl, &nexthop, dev, false); 2249871f1adSVasiliy Kulikov if (!IS_ERR(neigh)) { 2254ff06203SJulian Anastasov int res; 2264ff06203SJulian Anastasov 2274ff06203SJulian Anastasov sock_confirm_neigh(skb, neigh); 2284ff06203SJulian Anastasov res = dst_neigh_output(dst, neigh, skb); 229f2c31e32SEric Dumazet 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 { 244c7ba65d7SFlorian Westphal netdev_features_t features; 245c7ba65d7SFlorian Westphal struct sk_buff *segs; 246c7ba65d7SFlorian Westphal int ret = 0; 247c7ba65d7SFlorian Westphal 2489ee6c5dcSLance Richardson /* common case: seglen is <= mtu 249359ebda2SShmulik Ladkani */ 2509ee6c5dcSLance Richardson if (skb_gso_validate_mtu(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); 2679207f9d4SKonstantin Khlebnikov BUILD_BUG_ON(sizeof(*IPCB(skb)) > SKB_SGO_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 276c7ba65d7SFlorian Westphal do { 277c7ba65d7SFlorian Westphal struct sk_buff *nskb = segs->next; 278c7ba65d7SFlorian Westphal int err; 279c7ba65d7SFlorian Westphal 280c7ba65d7SFlorian Westphal segs->next = NULL; 281694869b3SEric W. Biederman err = ip_fragment(net, sk, segs, mtu, ip_finish_output2); 282c7ba65d7SFlorian Westphal 283c7ba65d7SFlorian Westphal if (err && ret == 0) 284c7ba65d7SFlorian Westphal ret = err; 285c7ba65d7SFlorian Westphal segs = nskb; 286c7ba65d7SFlorian Westphal } while (segs); 287c7ba65d7SFlorian Westphal 288c7ba65d7SFlorian Westphal return ret; 289c7ba65d7SFlorian Westphal } 290c7ba65d7SFlorian Westphal 2910c4b51f0SEric W. Biederman static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb) 2921da177e4SLinus Torvalds { 293c5501eb3SFlorian Westphal unsigned int mtu; 29433b48679SDaniel Mack int ret; 29533b48679SDaniel Mack 29633b48679SDaniel Mack ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 29733b48679SDaniel Mack if (ret) { 29833b48679SDaniel Mack kfree_skb(skb); 29933b48679SDaniel Mack return ret; 30033b48679SDaniel Mack } 301c5501eb3SFlorian Westphal 3025c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM) 3035c901daaSPatrick McHardy /* Policy lookup after SNAT yielded a new policy */ 30400db4124SIan Morris if (skb_dst(skb)->xfrm) { 30548d5cad8SPatrick McHardy IPCB(skb)->flags |= IPSKB_REROUTED; 30613206b6bSEric W. Biederman return dst_output(net, sk, skb); 30748d5cad8SPatrick McHardy } 3085c901daaSPatrick McHardy #endif 309fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 310c7ba65d7SFlorian Westphal if (skb_is_gso(skb)) 311694869b3SEric W. Biederman return ip_finish_output_gso(net, sk, skb, mtu); 312c7ba65d7SFlorian Westphal 313d6b915e2SFlorian Westphal if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU)) 314694869b3SEric W. Biederman return ip_fragment(net, sk, skb, mtu, ip_finish_output2); 315c7ba65d7SFlorian Westphal 316694869b3SEric W. Biederman return ip_finish_output2(net, sk, skb); 3171da177e4SLinus Torvalds } 3181da177e4SLinus Torvalds 31933b48679SDaniel Mack static int ip_mc_finish_output(struct net *net, struct sock *sk, 32033b48679SDaniel Mack struct sk_buff *skb) 32133b48679SDaniel Mack { 32233b48679SDaniel Mack int ret; 32333b48679SDaniel Mack 32433b48679SDaniel Mack ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb); 32533b48679SDaniel Mack if (ret) { 32633b48679SDaniel Mack kfree_skb(skb); 32733b48679SDaniel Mack return ret; 32833b48679SDaniel Mack } 32933b48679SDaniel Mack 33033b48679SDaniel Mack return dev_loopback_xmit(net, sk, skb); 33133b48679SDaniel Mack } 33233b48679SDaniel Mack 333ede2059dSEric W. Biederman int ip_mc_output(struct net *net, struct sock *sk, struct sk_buff *skb) 3341da177e4SLinus Torvalds { 335511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 336d8d1f30bSChangli Gao struct net_device *dev = rt->dst.dev; 3371da177e4SLinus Torvalds 3381da177e4SLinus Torvalds /* 3391da177e4SLinus Torvalds * If the indicated interface is up and running, send the packet. 3401da177e4SLinus Torvalds */ 34188f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 3421da177e4SLinus Torvalds 3431da177e4SLinus Torvalds skb->dev = dev; 3441da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 3451da177e4SLinus Torvalds 3461da177e4SLinus Torvalds /* 3471da177e4SLinus Torvalds * Multicasts are looped back for other local users 3481da177e4SLinus Torvalds */ 3491da177e4SLinus Torvalds 3501da177e4SLinus Torvalds if (rt->rt_flags&RTCF_MULTICAST) { 3517ad6848cSOctavian Purdila if (sk_mc_loop(sk) 3521da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 3531da177e4SLinus Torvalds /* Small optimization: do not loopback not local frames, 3541da177e4SLinus Torvalds which returned after forwarding; they will be dropped 3551da177e4SLinus Torvalds by ip_mr_input in any case. 3561da177e4SLinus Torvalds Note, that local frames are looped back to be delivered 3571da177e4SLinus Torvalds to local recipients. 3581da177e4SLinus Torvalds 3591da177e4SLinus Torvalds This check is duplicated in ip_mr_input at the moment. 3601da177e4SLinus Torvalds */ 3619d4fb27dSJoe Perches && 3629d4fb27dSJoe Perches ((rt->rt_flags & RTCF_LOCAL) || 3639d4fb27dSJoe Perches !(IPCB(skb)->flags & IPSKB_FORWARDED)) 3641da177e4SLinus Torvalds #endif 3651da177e4SLinus Torvalds ) { 3661da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3671da177e4SLinus Torvalds if (newskb) 3689bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 36929a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 37033b48679SDaniel Mack ip_mc_finish_output); 3711da177e4SLinus Torvalds } 3721da177e4SLinus Torvalds 3731da177e4SLinus Torvalds /* Multicasts with ttl 0 must not go beyond the host */ 3741da177e4SLinus Torvalds 375eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl == 0) { 3761da177e4SLinus Torvalds kfree_skb(skb); 3771da177e4SLinus Torvalds return 0; 3781da177e4SLinus Torvalds } 3791da177e4SLinus Torvalds } 3801da177e4SLinus Torvalds 3811da177e4SLinus Torvalds if (rt->rt_flags&RTCF_BROADCAST) { 3821da177e4SLinus Torvalds struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC); 3831da177e4SLinus Torvalds if (newskb) 38429a26a56SEric W. Biederman NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING, 38529a26a56SEric W. Biederman net, sk, newskb, NULL, newskb->dev, 38633b48679SDaniel Mack ip_mc_finish_output); 3871da177e4SLinus Torvalds } 3881da177e4SLinus Torvalds 38929a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 39029a26a56SEric W. Biederman net, sk, skb, NULL, skb->dev, 39129a26a56SEric W. Biederman ip_finish_output, 39248d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 3931da177e4SLinus Torvalds } 3941da177e4SLinus Torvalds 395ede2059dSEric W. Biederman int ip_output(struct net *net, struct sock *sk, struct sk_buff *skb) 3961da177e4SLinus Torvalds { 397adf30907SEric Dumazet struct net_device *dev = skb_dst(skb)->dev; 3981bd9bef6SPatrick McHardy 39988f5cc24SEric W. Biederman IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len); 4001da177e4SLinus Torvalds 4011bd9bef6SPatrick McHardy skb->dev = dev; 4021bd9bef6SPatrick McHardy skb->protocol = htons(ETH_P_IP); 4031bd9bef6SPatrick McHardy 40429a26a56SEric W. Biederman return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING, 40529a26a56SEric W. Biederman net, sk, skb, NULL, dev, 40648d5cad8SPatrick McHardy ip_finish_output, 40748d5cad8SPatrick McHardy !(IPCB(skb)->flags & IPSKB_REROUTED)); 4081da177e4SLinus Torvalds } 4091da177e4SLinus Torvalds 41084f9307cSEric Dumazet /* 41184f9307cSEric Dumazet * copy saddr and daddr, possibly using 64bit load/stores 41284f9307cSEric Dumazet * Equivalent to : 41384f9307cSEric Dumazet * iph->saddr = fl4->saddr; 41484f9307cSEric Dumazet * iph->daddr = fl4->daddr; 41584f9307cSEric Dumazet */ 41684f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4) 41784f9307cSEric Dumazet { 41884f9307cSEric Dumazet BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) != 41984f9307cSEric Dumazet offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr)); 42084f9307cSEric Dumazet memcpy(&iph->saddr, &fl4->saddr, 42184f9307cSEric Dumazet sizeof(fl4->saddr) + sizeof(fl4->daddr)); 42284f9307cSEric Dumazet } 42384f9307cSEric Dumazet 424b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */ 425b0270e91SEric Dumazet int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl) 4261da177e4SLinus Torvalds { 4271da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 42877589ce0SEric W. Biederman struct net *net = sock_net(sk); 429f6d8bd05SEric Dumazet struct ip_options_rcu *inet_opt; 430b57ae01aSDavid S. Miller struct flowi4 *fl4; 4311da177e4SLinus Torvalds struct rtable *rt; 4321da177e4SLinus Torvalds struct iphdr *iph; 433ab6e3febSEric Dumazet int res; 4341da177e4SLinus Torvalds 4351da177e4SLinus Torvalds /* Skip all of this if the packet is already routed, 4361da177e4SLinus Torvalds * f.e. by something like SCTP. 4371da177e4SLinus Torvalds */ 438ab6e3febSEric Dumazet rcu_read_lock(); 439f6d8bd05SEric Dumazet inet_opt = rcu_dereference(inet->inet_opt); 440ea4fc0d6SDavid S. Miller fl4 = &fl->u.ip4; 441511c3f92SEric Dumazet rt = skb_rtable(skb); 44200db4124SIan Morris if (rt) 4431da177e4SLinus Torvalds goto packet_routed; 4441da177e4SLinus Torvalds 4451da177e4SLinus Torvalds /* Make sure we can route this packet. */ 4461da177e4SLinus Torvalds rt = (struct rtable *)__sk_dst_check(sk, 0); 44751456b29SIan Morris if (!rt) { 4483ca3c68eSAl Viro __be32 daddr; 4491da177e4SLinus Torvalds 4501da177e4SLinus Torvalds /* Use correct destination address if we have options. */ 451c720c7e8SEric Dumazet daddr = inet->inet_daddr; 452f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.srr) 453f6d8bd05SEric Dumazet daddr = inet_opt->opt.faddr; 4541da177e4SLinus Torvalds 4551da177e4SLinus Torvalds /* If this fails, retransmit mechanism of transport layer will 4561da177e4SLinus Torvalds * keep trying until route appears or the connection times 4571da177e4SLinus Torvalds * itself out. 4581da177e4SLinus Torvalds */ 45977589ce0SEric W. Biederman rt = ip_route_output_ports(net, fl4, sk, 46078fbfd8aSDavid S. Miller daddr, inet->inet_saddr, 46178fbfd8aSDavid S. Miller inet->inet_dport, 46278fbfd8aSDavid S. Miller inet->inet_sport, 46378fbfd8aSDavid S. Miller sk->sk_protocol, 46478fbfd8aSDavid S. Miller RT_CONN_FLAGS(sk), 46578fbfd8aSDavid S. Miller sk->sk_bound_dev_if); 466b23dd4feSDavid S. Miller if (IS_ERR(rt)) 4671da177e4SLinus Torvalds goto no_route; 468d8d1f30bSChangli Gao sk_setup_caps(sk, &rt->dst); 4691da177e4SLinus Torvalds } 470d8d1f30bSChangli Gao skb_dst_set_noref(skb, &rt->dst); 4711da177e4SLinus Torvalds 4721da177e4SLinus Torvalds packet_routed: 473155e8336SJulian Anastasov if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway) 4741da177e4SLinus Torvalds goto no_route; 4751da177e4SLinus Torvalds 4761da177e4SLinus Torvalds /* OK, we know where to send it, allocate and build IP header. */ 477f6d8bd05SEric Dumazet skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0)); 4788856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 479eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 480714e85beSAl Viro *((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (inet->tos & 0xff)); 48160ff7467SWANG Cong if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df) 4821da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 4831da177e4SLinus Torvalds else 4841da177e4SLinus Torvalds iph->frag_off = 0; 485d8d1f30bSChangli Gao iph->ttl = ip_select_ttl(inet, &rt->dst); 4861da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 48784f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 48884f9307cSEric Dumazet 4891da177e4SLinus Torvalds /* Transport layer set skb->h.foo itself. */ 4901da177e4SLinus Torvalds 491f6d8bd05SEric Dumazet if (inet_opt && inet_opt->opt.optlen) { 492f6d8bd05SEric Dumazet iph->ihl += inet_opt->opt.optlen >> 2; 493f6d8bd05SEric Dumazet ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0); 4941da177e4SLinus Torvalds } 4951da177e4SLinus Torvalds 49677589ce0SEric W. Biederman ip_select_ident_segs(net, skb, sk, 497b6a7719aSHannes Frederic Sowa skb_shinfo(skb)->gso_segs ?: 1); 4981da177e4SLinus Torvalds 499b0270e91SEric Dumazet /* TODO : should we use skb->sk here instead of sk ? */ 5001da177e4SLinus Torvalds skb->priority = sk->sk_priority; 5014a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 5021da177e4SLinus Torvalds 50333224b16SEric W. Biederman res = ip_local_out(net, sk, skb); 504ab6e3febSEric Dumazet rcu_read_unlock(); 505ab6e3febSEric Dumazet return res; 5061da177e4SLinus Torvalds 5071da177e4SLinus Torvalds no_route: 508ab6e3febSEric Dumazet rcu_read_unlock(); 50977589ce0SEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_OUTNOROUTES); 5101da177e4SLinus Torvalds kfree_skb(skb); 5111da177e4SLinus Torvalds return -EHOSTUNREACH; 5121da177e4SLinus Torvalds } 5134bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_queue_xmit); 5141da177e4SLinus Torvalds 5151da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from) 5161da177e4SLinus Torvalds { 5171da177e4SLinus Torvalds to->pkt_type = from->pkt_type; 5181da177e4SLinus Torvalds to->priority = from->priority; 5191da177e4SLinus Torvalds to->protocol = from->protocol; 520adf30907SEric Dumazet skb_dst_drop(to); 521fe76cda3SEric Dumazet skb_dst_copy(to, from); 5221da177e4SLinus Torvalds to->dev = from->dev; 52382e91ffeSThomas Graf to->mark = from->mark; 5241da177e4SLinus Torvalds 5251da177e4SLinus Torvalds /* Copy the flags to each fragment. */ 5261da177e4SLinus Torvalds IPCB(to)->flags = IPCB(from)->flags; 5271da177e4SLinus Torvalds 5281da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED 5291da177e4SLinus Torvalds to->tc_index = from->tc_index; 5301da177e4SLinus Torvalds #endif 531e7ac05f3SYasuyuki Kozakai nf_copy(to, from); 5326ca40d4eSJavier Martinez Canillas #if IS_ENABLED(CONFIG_IP_VS) 533c98d80edSJulian Anastasov to->ipvs_property = from->ipvs_property; 534c98d80edSJulian Anastasov #endif 535984bc16cSJames Morris skb_copy_secmark(to, from); 5361da177e4SLinus Torvalds } 5371da177e4SLinus Torvalds 538694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 539c5501eb3SFlorian Westphal unsigned int mtu, 540694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 54149d16b23SAndy Zhou { 54249d16b23SAndy Zhou struct iphdr *iph = ip_hdr(skb); 54349d16b23SAndy Zhou 544d6b915e2SFlorian Westphal if ((iph->frag_off & htons(IP_DF)) == 0) 545694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 546d6b915e2SFlorian Westphal 547d6b915e2SFlorian Westphal if (unlikely(!skb->ignore_df || 54849d16b23SAndy Zhou (IPCB(skb)->frag_max_size && 54949d16b23SAndy Zhou IPCB(skb)->frag_max_size > mtu))) { 5509479b0afSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 55149d16b23SAndy Zhou icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED, 55249d16b23SAndy Zhou htonl(mtu)); 55349d16b23SAndy Zhou kfree_skb(skb); 55449d16b23SAndy Zhou return -EMSGSIZE; 55549d16b23SAndy Zhou } 55649d16b23SAndy Zhou 557694869b3SEric W. Biederman return ip_do_fragment(net, sk, skb, output); 55849d16b23SAndy Zhou } 55949d16b23SAndy Zhou 5601da177e4SLinus Torvalds /* 5611da177e4SLinus Torvalds * This IP datagram is too large to be sent in one piece. Break it up into 5621da177e4SLinus Torvalds * smaller pieces (each of size equal to IP header plus 5631da177e4SLinus Torvalds * a block of the data of the original IP data part) that will yet fit in a 5641da177e4SLinus Torvalds * single device frame, and queue such a frame for sending. 5651da177e4SLinus Torvalds */ 5661da177e4SLinus Torvalds 567694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb, 568694869b3SEric W. Biederman int (*output)(struct net *, struct sock *, struct sk_buff *)) 5691da177e4SLinus Torvalds { 5701da177e4SLinus Torvalds struct iphdr *iph; 5711da177e4SLinus Torvalds int ptr; 5721da177e4SLinus Torvalds struct sk_buff *skb2; 573c893b806SChangli Gao unsigned int mtu, hlen, left, len, ll_rs; 5741da177e4SLinus Torvalds int offset; 57576ab608dSAlexey Dobriyan __be16 not_last_frag; 576511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 5771da177e4SLinus Torvalds int err = 0; 5781da177e4SLinus Torvalds 579dbd3393cSHannes Frederic Sowa /* for offloaded checksums cleanup checksum before fragmentation */ 580dbd3393cSHannes Frederic Sowa if (skb->ip_summed == CHECKSUM_PARTIAL && 581dbd3393cSHannes Frederic Sowa (err = skb_checksum_help(skb))) 582dbd3393cSHannes Frederic Sowa goto fail; 583dbd3393cSHannes Frederic Sowa 5841da177e4SLinus Torvalds /* 5851da177e4SLinus Torvalds * Point into the IP datagram header. 5861da177e4SLinus Torvalds */ 5871da177e4SLinus Torvalds 588eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 5891da177e4SLinus Torvalds 590fedbb6b4SShmulik Ladkani mtu = ip_skb_dst_mtu(sk, skb); 591d6b915e2SFlorian Westphal if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu) 592d6b915e2SFlorian Westphal mtu = IPCB(skb)->frag_max_size; 5931da177e4SLinus Torvalds 5941da177e4SLinus Torvalds /* 5951da177e4SLinus Torvalds * Setup starting values. 5961da177e4SLinus Torvalds */ 5971da177e4SLinus Torvalds 5981da177e4SLinus Torvalds hlen = iph->ihl * 4; 599f87c10a8SHannes Frederic Sowa mtu = mtu - hlen; /* Size of data space */ 60089cee8b1SHerbert Xu IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE; 6011da177e4SLinus Torvalds 6021da177e4SLinus Torvalds /* When frag_list is given, use it. First, check its validity: 6031da177e4SLinus Torvalds * some transformers could create wrong frag_list or break existing 6041da177e4SLinus Torvalds * one, it is not prohibited. In this case fall back to copying. 6051da177e4SLinus Torvalds * 6061da177e4SLinus Torvalds * LATER: this step can be merged to real generation of fragments, 6071da177e4SLinus Torvalds * we can switch to copy when see the first bad fragment. 6081da177e4SLinus Torvalds */ 60921dc3301SDavid S. Miller if (skb_has_frag_list(skb)) { 6103d13008eSEric Dumazet struct sk_buff *frag, *frag2; 611c72d8cdaSAlexey Dobriyan unsigned int first_len = skb_pagelen(skb); 6121da177e4SLinus Torvalds 6131da177e4SLinus Torvalds if (first_len - hlen > mtu || 6141da177e4SLinus Torvalds ((first_len - hlen) & 7) || 61556f8a75cSPaul Gortmaker ip_is_fragment(iph) || 6161da177e4SLinus Torvalds skb_cloned(skb)) 6171da177e4SLinus Torvalds goto slow_path; 6181da177e4SLinus Torvalds 619d7fcf1a5SDavid S. Miller skb_walk_frags(skb, frag) { 6201da177e4SLinus Torvalds /* Correct geometry. */ 6211da177e4SLinus Torvalds if (frag->len > mtu || 6221da177e4SLinus Torvalds ((frag->len & 7) && frag->next) || 6231da177e4SLinus Torvalds skb_headroom(frag) < hlen) 6243d13008eSEric Dumazet goto slow_path_clean; 6251da177e4SLinus Torvalds 6261da177e4SLinus Torvalds /* Partially cloned skb? */ 6271da177e4SLinus Torvalds if (skb_shared(frag)) 6283d13008eSEric Dumazet goto slow_path_clean; 6292fdba6b0SHerbert Xu 6302fdba6b0SHerbert Xu BUG_ON(frag->sk); 6312fdba6b0SHerbert Xu if (skb->sk) { 6322fdba6b0SHerbert Xu frag->sk = skb->sk; 6332fdba6b0SHerbert Xu frag->destructor = sock_wfree; 6342fdba6b0SHerbert Xu } 6353d13008eSEric Dumazet skb->truesize -= frag->truesize; 6361da177e4SLinus Torvalds } 6371da177e4SLinus Torvalds 6381da177e4SLinus Torvalds /* Everything is OK. Generate! */ 6391da177e4SLinus Torvalds 6401da177e4SLinus Torvalds err = 0; 6411da177e4SLinus Torvalds offset = 0; 6421da177e4SLinus Torvalds frag = skb_shinfo(skb)->frag_list; 643d7fcf1a5SDavid S. Miller skb_frag_list_init(skb); 6441da177e4SLinus Torvalds skb->data_len = first_len - skb_headlen(skb); 6451da177e4SLinus Torvalds skb->len = first_len; 6461da177e4SLinus Torvalds iph->tot_len = htons(first_len); 6471da177e4SLinus Torvalds iph->frag_off = htons(IP_MF); 6481da177e4SLinus Torvalds ip_send_check(iph); 6491da177e4SLinus Torvalds 6501da177e4SLinus Torvalds for (;;) { 6511da177e4SLinus Torvalds /* Prepare header of the next frame, 6521da177e4SLinus Torvalds * before previous one went down. */ 6531da177e4SLinus Torvalds if (frag) { 6541da177e4SLinus Torvalds frag->ip_summed = CHECKSUM_NONE; 655badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(frag); 656e2d1bca7SArnaldo Carvalho de Melo __skb_push(frag, hlen); 657e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(frag); 658d56f90a7SArnaldo Carvalho de Melo memcpy(skb_network_header(frag), iph, hlen); 659eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(frag); 6601da177e4SLinus Torvalds iph->tot_len = htons(frag->len); 6611da177e4SLinus Torvalds ip_copy_metadata(frag, skb); 6621da177e4SLinus Torvalds if (offset == 0) 6631da177e4SLinus Torvalds ip_options_fragment(frag); 6641da177e4SLinus Torvalds offset += skb->len - hlen; 6651da177e4SLinus Torvalds iph->frag_off = htons(offset>>3); 66600db4124SIan Morris if (frag->next) 6671da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 6681da177e4SLinus Torvalds /* Ready, complete checksum */ 6691da177e4SLinus Torvalds ip_send_check(iph); 6701da177e4SLinus Torvalds } 6711da177e4SLinus Torvalds 672694869b3SEric W. Biederman err = output(net, sk, skb); 6731da177e4SLinus Torvalds 674dafee490SWei Dong if (!err) 67526a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 6761da177e4SLinus Torvalds if (err || !frag) 6771da177e4SLinus Torvalds break; 6781da177e4SLinus Torvalds 6791da177e4SLinus Torvalds skb = frag; 6801da177e4SLinus Torvalds frag = skb->next; 6811da177e4SLinus Torvalds skb->next = NULL; 6821da177e4SLinus Torvalds } 6831da177e4SLinus Torvalds 6841da177e4SLinus Torvalds if (err == 0) { 68526a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 6861da177e4SLinus Torvalds return 0; 6871da177e4SLinus Torvalds } 6881da177e4SLinus Torvalds 6891da177e4SLinus Torvalds while (frag) { 6901da177e4SLinus Torvalds skb = frag->next; 6911da177e4SLinus Torvalds kfree_skb(frag); 6921da177e4SLinus Torvalds frag = skb; 6931da177e4SLinus Torvalds } 69426a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 6951da177e4SLinus Torvalds return err; 6963d13008eSEric Dumazet 6973d13008eSEric Dumazet slow_path_clean: 6983d13008eSEric Dumazet skb_walk_frags(skb, frag2) { 6993d13008eSEric Dumazet if (frag2 == frag) 7003d13008eSEric Dumazet break; 7013d13008eSEric Dumazet frag2->sk = NULL; 7023d13008eSEric Dumazet frag2->destructor = NULL; 7033d13008eSEric Dumazet skb->truesize += frag2->truesize; 7043d13008eSEric Dumazet } 7051da177e4SLinus Torvalds } 7061da177e4SLinus Torvalds 7071da177e4SLinus Torvalds slow_path: 708c9af6db4SPravin B Shelar iph = ip_hdr(skb); 709fc70fb64SAlexander Duyck 7101da177e4SLinus Torvalds left = skb->len - hlen; /* Space per frame */ 71149085bd7SGeorge Kadianakis ptr = hlen; /* Where to start from */ 7121da177e4SLinus Torvalds 7138d045163SFlorian Westphal ll_rs = LL_RESERVED_SPACE(rt->dst.dev); 7149bcfcaf5SStephen Hemminger 7151da177e4SLinus Torvalds /* 7161da177e4SLinus Torvalds * Fragment the datagram. 7171da177e4SLinus Torvalds */ 7181da177e4SLinus Torvalds 7191da177e4SLinus Torvalds offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3; 7201da177e4SLinus Torvalds not_last_frag = iph->frag_off & htons(IP_MF); 7211da177e4SLinus Torvalds 7221da177e4SLinus Torvalds /* 7231da177e4SLinus Torvalds * Keep copying data until we run out. 7241da177e4SLinus Torvalds */ 7251da177e4SLinus Torvalds 7261da177e4SLinus Torvalds while (left > 0) { 7271da177e4SLinus Torvalds len = left; 7281da177e4SLinus Torvalds /* IF: it doesn't fit, use 'mtu' - the data space left */ 7291da177e4SLinus Torvalds if (len > mtu) 7301da177e4SLinus Torvalds len = mtu; 7311da177e4SLinus Torvalds /* IF: we are not sending up to and including the packet end 7321da177e4SLinus Torvalds then align the next start on an eight byte boundary */ 7331da177e4SLinus Torvalds if (len < left) { 7341da177e4SLinus Torvalds len &= ~7; 7351da177e4SLinus Torvalds } 7361da177e4SLinus Torvalds 737cbffccc9SJoe Perches /* Allocate buffer */ 738cbffccc9SJoe Perches skb2 = alloc_skb(len + hlen + ll_rs, GFP_ATOMIC); 739cbffccc9SJoe Perches if (!skb2) { 7401da177e4SLinus Torvalds err = -ENOMEM; 7411da177e4SLinus Torvalds goto fail; 7421da177e4SLinus Torvalds } 7431da177e4SLinus Torvalds 7441da177e4SLinus Torvalds /* 7451da177e4SLinus Torvalds * Set up data on packet 7461da177e4SLinus Torvalds */ 7471da177e4SLinus Torvalds 7481da177e4SLinus Torvalds ip_copy_metadata(skb2, skb); 7491da177e4SLinus Torvalds skb_reserve(skb2, ll_rs); 7501da177e4SLinus Torvalds skb_put(skb2, len + hlen); 751c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb2); 752b0e380b1SArnaldo Carvalho de Melo skb2->transport_header = skb2->network_header + hlen; 7531da177e4SLinus Torvalds 7541da177e4SLinus Torvalds /* 7551da177e4SLinus Torvalds * Charge the memory for the fragment to any owner 7561da177e4SLinus Torvalds * it might possess 7571da177e4SLinus Torvalds */ 7581da177e4SLinus Torvalds 7591da177e4SLinus Torvalds if (skb->sk) 7601da177e4SLinus Torvalds skb_set_owner_w(skb2, skb->sk); 7611da177e4SLinus Torvalds 7621da177e4SLinus Torvalds /* 7631da177e4SLinus Torvalds * Copy the packet header into the new buffer. 7641da177e4SLinus Torvalds */ 7651da177e4SLinus Torvalds 766d626f62bSArnaldo Carvalho de Melo skb_copy_from_linear_data(skb, skb_network_header(skb2), hlen); 7671da177e4SLinus Torvalds 7681da177e4SLinus Torvalds /* 7691da177e4SLinus Torvalds * Copy a block of the IP datagram. 7701da177e4SLinus Torvalds */ 771bff9b61cSArnaldo Carvalho de Melo if (skb_copy_bits(skb, ptr, skb_transport_header(skb2), len)) 7721da177e4SLinus Torvalds BUG(); 7731da177e4SLinus Torvalds left -= len; 7741da177e4SLinus Torvalds 7751da177e4SLinus Torvalds /* 7761da177e4SLinus Torvalds * Fill in the new header fields. 7771da177e4SLinus Torvalds */ 778eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb2); 7791da177e4SLinus Torvalds iph->frag_off = htons((offset >> 3)); 7801da177e4SLinus Torvalds 781d6b915e2SFlorian Westphal if (IPCB(skb)->flags & IPSKB_FRAG_PMTU) 782d6b915e2SFlorian Westphal iph->frag_off |= htons(IP_DF); 783d6b915e2SFlorian Westphal 7841da177e4SLinus Torvalds /* ANK: dirty, but effective trick. Upgrade options only if 7851da177e4SLinus Torvalds * the segment to be fragmented was THE FIRST (otherwise, 7861da177e4SLinus Torvalds * options are already fixed) and make it ONCE 7871da177e4SLinus Torvalds * on the initial skb, so that all the following fragments 7881da177e4SLinus Torvalds * will inherit fixed options. 7891da177e4SLinus Torvalds */ 7901da177e4SLinus Torvalds if (offset == 0) 7911da177e4SLinus Torvalds ip_options_fragment(skb); 7921da177e4SLinus Torvalds 7931da177e4SLinus Torvalds /* 7941da177e4SLinus Torvalds * Added AC : If we are fragmenting a fragment that's not the 7951da177e4SLinus Torvalds * last fragment then keep MF on each bit 7961da177e4SLinus Torvalds */ 7971da177e4SLinus Torvalds if (left > 0 || not_last_frag) 7981da177e4SLinus Torvalds iph->frag_off |= htons(IP_MF); 7991da177e4SLinus Torvalds ptr += len; 8001da177e4SLinus Torvalds offset += len; 8011da177e4SLinus Torvalds 8021da177e4SLinus Torvalds /* 8031da177e4SLinus Torvalds * Put this fragment into the sending queue. 8041da177e4SLinus Torvalds */ 8051da177e4SLinus Torvalds iph->tot_len = htons(len + hlen); 8061da177e4SLinus Torvalds 8071da177e4SLinus Torvalds ip_send_check(iph); 8081da177e4SLinus Torvalds 809694869b3SEric W. Biederman err = output(net, sk, skb2); 8101da177e4SLinus Torvalds if (err) 8111da177e4SLinus Torvalds goto fail; 812dafee490SWei Dong 81326a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES); 8141da177e4SLinus Torvalds } 8155d0ba55bSEric Dumazet consume_skb(skb); 81626a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS); 8171da177e4SLinus Torvalds return err; 8181da177e4SLinus Torvalds 8191da177e4SLinus Torvalds fail: 8201da177e4SLinus Torvalds kfree_skb(skb); 82126a949dbSEric W. Biederman IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS); 8221da177e4SLinus Torvalds return err; 8231da177e4SLinus Torvalds } 82449d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment); 8252e2f7aefSPatrick McHardy 8261da177e4SLinus Torvalds int 8271da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb) 8281da177e4SLinus Torvalds { 829f69e6d13SAl Viro struct msghdr *msg = from; 8301da177e4SLinus Torvalds 83184fa7933SPatrick McHardy if (skb->ip_summed == CHECKSUM_PARTIAL) { 8320b62fca2SAl Viro if (!copy_from_iter_full(to, len, &msg->msg_iter)) 8331da177e4SLinus Torvalds return -EFAULT; 8341da177e4SLinus Torvalds } else { 83544bb9363SAl Viro __wsum csum = 0; 8360b62fca2SAl Viro if (!csum_and_copy_from_iter_full(to, len, &csum, &msg->msg_iter)) 8371da177e4SLinus Torvalds return -EFAULT; 8381da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 8391da177e4SLinus Torvalds } 8401da177e4SLinus Torvalds return 0; 8411da177e4SLinus Torvalds } 8424bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag); 8431da177e4SLinus Torvalds 84444bb9363SAl Viro static inline __wsum 8451da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy) 8461da177e4SLinus Torvalds { 8471da177e4SLinus Torvalds char *kaddr; 84844bb9363SAl Viro __wsum csum; 8491da177e4SLinus Torvalds kaddr = kmap(page); 8501da177e4SLinus Torvalds csum = csum_partial(kaddr + offset, copy, 0); 8511da177e4SLinus Torvalds kunmap(page); 8521da177e4SLinus Torvalds return csum; 8531da177e4SLinus Torvalds } 8541da177e4SLinus Torvalds 8554b30b1c6SAdrian Bunk static inline int ip_ufo_append_data(struct sock *sk, 8561470ddf7SHerbert Xu struct sk_buff_head *queue, 857e89e9cf5SAnanda Raju int getfrag(void *from, char *to, int offset, int len, 858e89e9cf5SAnanda Raju int odd, struct sk_buff *skb), 859e89e9cf5SAnanda Raju void *from, int length, int hh_len, int fragheaderlen, 860d9be4f7aSBill Sommerfeld int transhdrlen, int maxfraglen, unsigned int flags) 861e89e9cf5SAnanda Raju { 862e89e9cf5SAnanda Raju struct sk_buff *skb; 863e89e9cf5SAnanda Raju int err; 864e89e9cf5SAnanda Raju 865e89e9cf5SAnanda Raju /* There is support for UDP fragmentation offload by network 866e89e9cf5SAnanda Raju * device, so create one single skb packet containing complete 867e89e9cf5SAnanda Raju * udp datagram 868e89e9cf5SAnanda Raju */ 86951456b29SIan Morris skb = skb_peek_tail(queue); 87051456b29SIan Morris if (!skb) { 871e89e9cf5SAnanda Raju skb = sock_alloc_send_skb(sk, 872e89e9cf5SAnanda Raju hh_len + fragheaderlen + transhdrlen + 20, 873e89e9cf5SAnanda Raju (flags & MSG_DONTWAIT), &err); 874e89e9cf5SAnanda Raju 87551456b29SIan Morris if (!skb) 876e89e9cf5SAnanda Raju return err; 877e89e9cf5SAnanda Raju 878e89e9cf5SAnanda Raju /* reserve space for Hardware header */ 879e89e9cf5SAnanda Raju skb_reserve(skb, hh_len); 880e89e9cf5SAnanda Raju 881e89e9cf5SAnanda Raju /* create space for UDP/IP header */ 882e89e9cf5SAnanda Raju skb_put(skb, fragheaderlen + transhdrlen); 883e89e9cf5SAnanda Raju 884e89e9cf5SAnanda Raju /* initialize network header pointer */ 885c1d2bbe1SArnaldo Carvalho de Melo skb_reset_network_header(skb); 886e89e9cf5SAnanda Raju 887e89e9cf5SAnanda Raju /* initialize protocol header pointer */ 888b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header + fragheaderlen; 889e89e9cf5SAnanda Raju 890e89e9cf5SAnanda Raju skb->csum = 0; 891e89e9cf5SAnanda Raju 892*0dec879fSJulian Anastasov if (flags & MSG_CONFIRM) 893*0dec879fSJulian Anastasov skb_set_dst_pending_confirm(skb, 1); 894*0dec879fSJulian Anastasov 895e93b7d74SJiri Pirko __skb_queue_tail(queue, skb); 896e93b7d74SJiri Pirko } else if (skb_is_gso(skb)) { 897e93b7d74SJiri Pirko goto append; 898e93b7d74SJiri Pirko } 899e93b7d74SJiri Pirko 900e93b7d74SJiri Pirko skb->ip_summed = CHECKSUM_PARTIAL; 901e89e9cf5SAnanda Raju /* specify the length of each IP datagram fragment */ 902d9be4f7aSBill Sommerfeld skb_shinfo(skb)->gso_size = maxfraglen - fragheaderlen; 903f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 904be9164e7SKostya B 905e93b7d74SJiri Pirko append: 906be9164e7SKostya B return skb_append_datato_frags(sk, skb, getfrag, from, 907be9164e7SKostya B (length - transhdrlen)); 908e89e9cf5SAnanda Raju } 909e89e9cf5SAnanda Raju 910f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk, 911f5fca608SDavid S. Miller struct flowi4 *fl4, 912f5fca608SDavid S. Miller struct sk_buff_head *queue, 9131470ddf7SHerbert Xu struct inet_cork *cork, 9145640f768SEric Dumazet struct page_frag *pfrag, 9151470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, 9161470ddf7SHerbert Xu int len, int odd, struct sk_buff *skb), 9171da177e4SLinus Torvalds void *from, int length, int transhdrlen, 9181da177e4SLinus Torvalds unsigned int flags) 9191da177e4SLinus Torvalds { 9201da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 9211da177e4SLinus Torvalds struct sk_buff *skb; 9221da177e4SLinus Torvalds 92307df5294SHerbert Xu struct ip_options *opt = cork->opt; 9241da177e4SLinus Torvalds int hh_len; 9251da177e4SLinus Torvalds int exthdrlen; 9261da177e4SLinus Torvalds int mtu; 9271da177e4SLinus Torvalds int copy; 9281da177e4SLinus Torvalds int err; 9291da177e4SLinus Torvalds int offset = 0; 930daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, maxnonfragsize; 9311da177e4SLinus Torvalds int csummode = CHECKSUM_NONE; 9321470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 93309c2d251SWillem de Bruijn u32 tskey = 0; 9341da177e4SLinus Torvalds 93596d7303eSSteffen Klassert skb = skb_peek_tail(queue); 93696d7303eSSteffen Klassert 93796d7303eSSteffen Klassert exthdrlen = !skb ? rt->dst.header_len : 0; 93807df5294SHerbert Xu mtu = cork->fragsize; 93909c2d251SWillem de Bruijn if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP && 94009c2d251SWillem de Bruijn sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID) 94109c2d251SWillem de Bruijn tskey = sk->sk_tskey++; 9421470ddf7SHerbert Xu 943d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 9441da177e4SLinus Torvalds 9451da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 9461da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 94760ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 9481da177e4SLinus Torvalds 949daba287bSHannes Frederic Sowa if (cork->length + length > maxnonfragsize - fragheaderlen) { 950f5fca608SDavid S. Miller ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 95161e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 9521da177e4SLinus Torvalds return -EMSGSIZE; 9531da177e4SLinus Torvalds } 9541da177e4SLinus Torvalds 9551da177e4SLinus Torvalds /* 9561da177e4SLinus Torvalds * transhdrlen > 0 means that this is the first fragment and we wish 9571da177e4SLinus Torvalds * it won't be fragmented in the future. 9581da177e4SLinus Torvalds */ 9591da177e4SLinus Torvalds if (transhdrlen && 9601da177e4SLinus Torvalds length + fragheaderlen <= mtu && 961c8cd0989STom Herbert rt->dst.dev->features & (NETIF_F_HW_CSUM | NETIF_F_IP_CSUM) && 962d749c9cbSHannes Frederic Sowa !(flags & MSG_MORE) && 9631da177e4SLinus Torvalds !exthdrlen) 96484fa7933SPatrick McHardy csummode = CHECKSUM_PARTIAL; 9651da177e4SLinus Torvalds 9661470ddf7SHerbert Xu cork->length += length; 9670a28cfd5Szheng li if ((((length + fragheaderlen) > mtu) || (skb && skb_is_gso(skb))) && 968be9164e7SKostya B (sk->sk_protocol == IPPROTO_UDP) && 969acf8dd0aSMichal Kubeček (rt->dst.dev->features & NETIF_F_UFO) && !rt->dst.header_len && 97040ba3302SMichal Kubeček (sk->sk_type == SOCK_DGRAM) && !sk->sk_no_check_tx) { 9711470ddf7SHerbert Xu err = ip_ufo_append_data(sk, queue, getfrag, from, length, 9721470ddf7SHerbert Xu hh_len, fragheaderlen, transhdrlen, 973d9be4f7aSBill Sommerfeld maxfraglen, flags); 974baa829d8SPatrick McHardy if (err) 975e89e9cf5SAnanda Raju goto error; 976e89e9cf5SAnanda Raju return 0; 977e89e9cf5SAnanda Raju } 9781da177e4SLinus Torvalds 9791da177e4SLinus Torvalds /* So, what's going on in the loop below? 9801da177e4SLinus Torvalds * 9811da177e4SLinus Torvalds * We use calculated fragment length to generate chained skb, 9821da177e4SLinus Torvalds * each of segments is IP fragment ready for sending to network after 9831da177e4SLinus Torvalds * adding appropriate IP header. 9841da177e4SLinus Torvalds */ 9851da177e4SLinus Torvalds 98626cde9f7SHerbert Xu if (!skb) 9871da177e4SLinus Torvalds goto alloc_new_skb; 9881da177e4SLinus Torvalds 9891da177e4SLinus Torvalds while (length > 0) { 9901da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 9911da177e4SLinus Torvalds copy = mtu - skb->len; 9921da177e4SLinus Torvalds if (copy < length) 9931da177e4SLinus Torvalds copy = maxfraglen - skb->len; 9941da177e4SLinus Torvalds if (copy <= 0) { 9951da177e4SLinus Torvalds char *data; 9961da177e4SLinus Torvalds unsigned int datalen; 9971da177e4SLinus Torvalds unsigned int fraglen; 9981da177e4SLinus Torvalds unsigned int fraggap; 9991da177e4SLinus Torvalds unsigned int alloclen; 10001da177e4SLinus Torvalds struct sk_buff *skb_prev; 10011da177e4SLinus Torvalds alloc_new_skb: 10021da177e4SLinus Torvalds skb_prev = skb; 10031da177e4SLinus Torvalds if (skb_prev) 10041da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 10051da177e4SLinus Torvalds else 10061da177e4SLinus Torvalds fraggap = 0; 10071da177e4SLinus Torvalds 10081da177e4SLinus Torvalds /* 10091da177e4SLinus Torvalds * If remaining data exceeds the mtu, 10101da177e4SLinus Torvalds * we know we need more fragment(s). 10111da177e4SLinus Torvalds */ 10121da177e4SLinus Torvalds datalen = length + fraggap; 10131da177e4SLinus Torvalds if (datalen > mtu - fragheaderlen) 10141da177e4SLinus Torvalds datalen = maxfraglen - fragheaderlen; 10151da177e4SLinus Torvalds fraglen = datalen + fragheaderlen; 10161da177e4SLinus Torvalds 10171da177e4SLinus Torvalds if ((flags & MSG_MORE) && 1018d8d1f30bSChangli Gao !(rt->dst.dev->features&NETIF_F_SG)) 10191da177e4SLinus Torvalds alloclen = mtu; 10201da177e4SLinus Torvalds else 102159104f06SEric Dumazet alloclen = fraglen; 10221da177e4SLinus Torvalds 1023353e5c9aSSteffen Klassert alloclen += exthdrlen; 1024353e5c9aSSteffen Klassert 10251da177e4SLinus Torvalds /* The last fragment gets additional space at tail. 10261da177e4SLinus Torvalds * Note, with MSG_MORE we overallocate on fragments, 10271da177e4SLinus Torvalds * because we have no idea what fragment will be 10281da177e4SLinus Torvalds * the last. 10291da177e4SLinus Torvalds */ 103033f99dc7SSteffen Klassert if (datalen == length + fraggap) 1031d8d1f30bSChangli Gao alloclen += rt->dst.trailer_len; 103233f99dc7SSteffen Klassert 10331da177e4SLinus Torvalds if (transhdrlen) { 10341da177e4SLinus Torvalds skb = sock_alloc_send_skb(sk, 10351da177e4SLinus Torvalds alloclen + hh_len + 15, 10361da177e4SLinus Torvalds (flags & MSG_DONTWAIT), &err); 10371da177e4SLinus Torvalds } else { 10381da177e4SLinus Torvalds skb = NULL; 10391da177e4SLinus Torvalds if (atomic_read(&sk->sk_wmem_alloc) <= 10401da177e4SLinus Torvalds 2 * sk->sk_sndbuf) 10411da177e4SLinus Torvalds skb = sock_wmalloc(sk, 10421da177e4SLinus Torvalds alloclen + hh_len + 15, 1, 10431da177e4SLinus Torvalds sk->sk_allocation); 104451456b29SIan Morris if (unlikely(!skb)) 10451da177e4SLinus Torvalds err = -ENOBUFS; 10461da177e4SLinus Torvalds } 104751456b29SIan Morris if (!skb) 10481da177e4SLinus Torvalds goto error; 10491da177e4SLinus Torvalds 10501da177e4SLinus Torvalds /* 10511da177e4SLinus Torvalds * Fill in the control structures 10521da177e4SLinus Torvalds */ 10531da177e4SLinus Torvalds skb->ip_summed = csummode; 10541da177e4SLinus Torvalds skb->csum = 0; 10551da177e4SLinus Torvalds skb_reserve(skb, hh_len); 105611878b40SWillem de Bruijn 105711878b40SWillem de Bruijn /* only the initial fragment is time stamped */ 10581470ddf7SHerbert Xu skb_shinfo(skb)->tx_flags = cork->tx_flags; 105911878b40SWillem de Bruijn cork->tx_flags = 0; 106009c2d251SWillem de Bruijn skb_shinfo(skb)->tskey = tskey; 106109c2d251SWillem de Bruijn tskey = 0; 10621da177e4SLinus Torvalds 10631da177e4SLinus Torvalds /* 10641da177e4SLinus Torvalds * Find where to start putting bytes. 10651da177e4SLinus Torvalds */ 1066353e5c9aSSteffen Klassert data = skb_put(skb, fraglen + exthdrlen); 1067c14d2450SArnaldo Carvalho de Melo skb_set_network_header(skb, exthdrlen); 1068b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1069b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 1070353e5c9aSSteffen Klassert data += fragheaderlen + exthdrlen; 10711da177e4SLinus Torvalds 10721da177e4SLinus Torvalds if (fraggap) { 10731da177e4SLinus Torvalds skb->csum = skb_copy_and_csum_bits( 10741da177e4SLinus Torvalds skb_prev, maxfraglen, 10751da177e4SLinus Torvalds data + transhdrlen, fraggap, 0); 10761da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 10771da177e4SLinus Torvalds skb->csum); 10781da177e4SLinus Torvalds data += fraggap; 1079e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 10801da177e4SLinus Torvalds } 10811da177e4SLinus Torvalds 10821da177e4SLinus Torvalds copy = datalen - transhdrlen - fraggap; 10831da177e4SLinus Torvalds if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) { 10841da177e4SLinus Torvalds err = -EFAULT; 10851da177e4SLinus Torvalds kfree_skb(skb); 10861da177e4SLinus Torvalds goto error; 10871da177e4SLinus Torvalds } 10881da177e4SLinus Torvalds 10891da177e4SLinus Torvalds offset += copy; 10901da177e4SLinus Torvalds length -= datalen - fraggap; 10911da177e4SLinus Torvalds transhdrlen = 0; 10921da177e4SLinus Torvalds exthdrlen = 0; 10931da177e4SLinus Torvalds csummode = CHECKSUM_NONE; 10941da177e4SLinus Torvalds 1095*0dec879fSJulian Anastasov if ((flags & MSG_CONFIRM) && !skb_prev) 1096*0dec879fSJulian Anastasov skb_set_dst_pending_confirm(skb, 1); 1097*0dec879fSJulian Anastasov 10981da177e4SLinus Torvalds /* 10991da177e4SLinus Torvalds * Put the packet on the pending queue. 11001da177e4SLinus Torvalds */ 11011470ddf7SHerbert Xu __skb_queue_tail(queue, skb); 11021da177e4SLinus Torvalds continue; 11031da177e4SLinus Torvalds } 11041da177e4SLinus Torvalds 11051da177e4SLinus Torvalds if (copy > length) 11061da177e4SLinus Torvalds copy = length; 11071da177e4SLinus Torvalds 1108d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) { 11091da177e4SLinus Torvalds unsigned int off; 11101da177e4SLinus Torvalds 11111da177e4SLinus Torvalds off = skb->len; 11121da177e4SLinus Torvalds if (getfrag(from, skb_put(skb, copy), 11131da177e4SLinus Torvalds offset, copy, off, skb) < 0) { 11141da177e4SLinus Torvalds __skb_trim(skb, off); 11151da177e4SLinus Torvalds err = -EFAULT; 11161da177e4SLinus Torvalds goto error; 11171da177e4SLinus Torvalds } 11181da177e4SLinus Torvalds } else { 11191da177e4SLinus Torvalds int i = skb_shinfo(skb)->nr_frags; 11201da177e4SLinus Torvalds 11211da177e4SLinus Torvalds err = -ENOMEM; 11225640f768SEric Dumazet if (!sk_page_frag_refill(sk, pfrag)) 11231da177e4SLinus Torvalds goto error; 11241da177e4SLinus Torvalds 11255640f768SEric Dumazet if (!skb_can_coalesce(skb, i, pfrag->page, 11265640f768SEric Dumazet pfrag->offset)) { 11271da177e4SLinus Torvalds err = -EMSGSIZE; 11285640f768SEric Dumazet if (i == MAX_SKB_FRAGS) 11291da177e4SLinus Torvalds goto error; 11305640f768SEric Dumazet 11315640f768SEric Dumazet __skb_fill_page_desc(skb, i, pfrag->page, 11325640f768SEric Dumazet pfrag->offset, 0); 11335640f768SEric Dumazet skb_shinfo(skb)->nr_frags = ++i; 11345640f768SEric Dumazet get_page(pfrag->page); 11351da177e4SLinus Torvalds } 11365640f768SEric Dumazet copy = min_t(int, copy, pfrag->size - pfrag->offset); 11375640f768SEric Dumazet if (getfrag(from, 11385640f768SEric Dumazet page_address(pfrag->page) + pfrag->offset, 11395640f768SEric Dumazet offset, copy, skb->len, skb) < 0) 11405640f768SEric Dumazet goto error_efault; 11415640f768SEric Dumazet 11425640f768SEric Dumazet pfrag->offset += copy; 11435640f768SEric Dumazet skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy); 11441da177e4SLinus Torvalds skb->len += copy; 11451da177e4SLinus Torvalds skb->data_len += copy; 1146f945fa7aSHerbert Xu skb->truesize += copy; 1147f945fa7aSHerbert Xu atomic_add(copy, &sk->sk_wmem_alloc); 11481da177e4SLinus Torvalds } 11491da177e4SLinus Torvalds offset += copy; 11501da177e4SLinus Torvalds length -= copy; 11511da177e4SLinus Torvalds } 11521da177e4SLinus Torvalds 11531da177e4SLinus Torvalds return 0; 11541da177e4SLinus Torvalds 11555640f768SEric Dumazet error_efault: 11565640f768SEric Dumazet err = -EFAULT; 11571da177e4SLinus Torvalds error: 11581470ddf7SHerbert Xu cork->length -= length; 11595e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 11601da177e4SLinus Torvalds return err; 11611da177e4SLinus Torvalds } 11621da177e4SLinus Torvalds 11631470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork, 11641470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp) 11651470ddf7SHerbert Xu { 1166f6d8bd05SEric Dumazet struct ip_options_rcu *opt; 11671470ddf7SHerbert Xu struct rtable *rt; 11681470ddf7SHerbert Xu 11691470ddf7SHerbert Xu /* 11701470ddf7SHerbert Xu * setup for corking. 11711470ddf7SHerbert Xu */ 11721470ddf7SHerbert Xu opt = ipc->opt; 11731470ddf7SHerbert Xu if (opt) { 117451456b29SIan Morris if (!cork->opt) { 11751470ddf7SHerbert Xu cork->opt = kmalloc(sizeof(struct ip_options) + 40, 11761470ddf7SHerbert Xu sk->sk_allocation); 117751456b29SIan Morris if (unlikely(!cork->opt)) 11781470ddf7SHerbert Xu return -ENOBUFS; 11791470ddf7SHerbert Xu } 1180f6d8bd05SEric Dumazet memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen); 11811470ddf7SHerbert Xu cork->flags |= IPCORK_OPT; 11821470ddf7SHerbert Xu cork->addr = ipc->addr; 11831470ddf7SHerbert Xu } 11841470ddf7SHerbert Xu rt = *rtp; 11851470ddf7SHerbert Xu if (unlikely(!rt)) 11861470ddf7SHerbert Xu return -EFAULT; 11871470ddf7SHerbert Xu /* 11881470ddf7SHerbert Xu * We steal reference to this route, caller should not release it 11891470ddf7SHerbert Xu */ 11901470ddf7SHerbert Xu *rtp = NULL; 1191482fc609SHannes Frederic Sowa cork->fragsize = ip_sk_use_pmtu(sk) ? 1192482fc609SHannes Frederic Sowa dst_mtu(&rt->dst) : rt->dst.dev->mtu; 11931470ddf7SHerbert Xu cork->dst = &rt->dst; 11941470ddf7SHerbert Xu cork->length = 0; 1195aa661581SFrancesco Fusco cork->ttl = ipc->ttl; 1196aa661581SFrancesco Fusco cork->tos = ipc->tos; 1197aa661581SFrancesco Fusco cork->priority = ipc->priority; 11981470ddf7SHerbert Xu cork->tx_flags = ipc->tx_flags; 11991470ddf7SHerbert Xu 12001470ddf7SHerbert Xu return 0; 12011470ddf7SHerbert Xu } 12021470ddf7SHerbert Xu 12031470ddf7SHerbert Xu /* 12041470ddf7SHerbert Xu * ip_append_data() and ip_append_page() can make one large IP datagram 12051470ddf7SHerbert Xu * from many pieces of data. Each pieces will be holded on the socket 12061470ddf7SHerbert Xu * until ip_push_pending_frames() is called. Each piece can be a page 12071470ddf7SHerbert Xu * or non-page data. 12081470ddf7SHerbert Xu * 12091470ddf7SHerbert Xu * Not only UDP, other transport protocols - e.g. raw sockets - can use 12101470ddf7SHerbert Xu * this interface potentially. 12111470ddf7SHerbert Xu * 12121470ddf7SHerbert Xu * LATER: length must be adjusted by pad at tail, when it is required. 12131470ddf7SHerbert Xu */ 1214f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4, 12151470ddf7SHerbert Xu int getfrag(void *from, char *to, int offset, int len, 12161470ddf7SHerbert Xu int odd, struct sk_buff *skb), 12171470ddf7SHerbert Xu void *from, int length, int transhdrlen, 12181470ddf7SHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 12191470ddf7SHerbert Xu unsigned int flags) 12201470ddf7SHerbert Xu { 12211470ddf7SHerbert Xu struct inet_sock *inet = inet_sk(sk); 12221470ddf7SHerbert Xu int err; 12231470ddf7SHerbert Xu 12241470ddf7SHerbert Xu if (flags&MSG_PROBE) 12251470ddf7SHerbert Xu return 0; 12261470ddf7SHerbert Xu 12271470ddf7SHerbert Xu if (skb_queue_empty(&sk->sk_write_queue)) { 1228bdc712b4SDavid S. Miller err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp); 12291470ddf7SHerbert Xu if (err) 12301470ddf7SHerbert Xu return err; 12311470ddf7SHerbert Xu } else { 12321470ddf7SHerbert Xu transhdrlen = 0; 12331470ddf7SHerbert Xu } 12341470ddf7SHerbert Xu 12355640f768SEric Dumazet return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base, 12365640f768SEric Dumazet sk_page_frag(sk), getfrag, 12371470ddf7SHerbert Xu from, length, transhdrlen, flags); 12381470ddf7SHerbert Xu } 12391470ddf7SHerbert Xu 1240f5fca608SDavid S. Miller ssize_t ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page, 12411da177e4SLinus Torvalds int offset, size_t size, int flags) 12421da177e4SLinus Torvalds { 12431da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 12441da177e4SLinus Torvalds struct sk_buff *skb; 12451da177e4SLinus Torvalds struct rtable *rt; 12461da177e4SLinus Torvalds struct ip_options *opt = NULL; 1247bdc712b4SDavid S. Miller struct inet_cork *cork; 12481da177e4SLinus Torvalds int hh_len; 12491da177e4SLinus Torvalds int mtu; 12501da177e4SLinus Torvalds int len; 12511da177e4SLinus Torvalds int err; 1252daba287bSHannes Frederic Sowa unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize; 12531da177e4SLinus Torvalds 12541da177e4SLinus Torvalds if (inet->hdrincl) 12551da177e4SLinus Torvalds return -EPERM; 12561da177e4SLinus Torvalds 12571da177e4SLinus Torvalds if (flags&MSG_PROBE) 12581da177e4SLinus Torvalds return 0; 12591da177e4SLinus Torvalds 12601da177e4SLinus Torvalds if (skb_queue_empty(&sk->sk_write_queue)) 12611da177e4SLinus Torvalds return -EINVAL; 12621da177e4SLinus Torvalds 1263bdc712b4SDavid S. Miller cork = &inet->cork.base; 1264bdc712b4SDavid S. Miller rt = (struct rtable *)cork->dst; 1265bdc712b4SDavid S. Miller if (cork->flags & IPCORK_OPT) 1266bdc712b4SDavid S. Miller opt = cork->opt; 12671da177e4SLinus Torvalds 1268d8d1f30bSChangli Gao if (!(rt->dst.dev->features&NETIF_F_SG)) 12691da177e4SLinus Torvalds return -EOPNOTSUPP; 12701da177e4SLinus Torvalds 1271d8d1f30bSChangli Gao hh_len = LL_RESERVED_SPACE(rt->dst.dev); 1272bdc712b4SDavid S. Miller mtu = cork->fragsize; 12731da177e4SLinus Torvalds 12741da177e4SLinus Torvalds fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0); 12751da177e4SLinus Torvalds maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen; 127660ff7467SWANG Cong maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu; 12771da177e4SLinus Torvalds 1278daba287bSHannes Frederic Sowa if (cork->length + size > maxnonfragsize - fragheaderlen) { 127961e7f09dSHannes Frederic Sowa ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport, 128061e7f09dSHannes Frederic Sowa mtu - (opt ? opt->optlen : 0)); 12811da177e4SLinus Torvalds return -EMSGSIZE; 12821da177e4SLinus Torvalds } 12831da177e4SLinus Torvalds 128451456b29SIan Morris skb = skb_peek_tail(&sk->sk_write_queue); 128551456b29SIan Morris if (!skb) 12861da177e4SLinus Torvalds return -EINVAL; 12871da177e4SLinus Torvalds 128826cde9f7SHerbert Xu if ((size + skb->len > mtu) && 128926cde9f7SHerbert Xu (sk->sk_protocol == IPPROTO_UDP) && 1290d8d1f30bSChangli Gao (rt->dst.dev->features & NETIF_F_UFO)) { 1291a8c4a252SHannes Frederic Sowa if (skb->ip_summed != CHECKSUM_PARTIAL) 1292a8c4a252SHannes Frederic Sowa return -EOPNOTSUPP; 1293a8c4a252SHannes Frederic Sowa 12947967168cSHerbert Xu skb_shinfo(skb)->gso_size = mtu - fragheaderlen; 1295f83ef8c0SHerbert Xu skb_shinfo(skb)->gso_type = SKB_GSO_UDP; 12967967168cSHerbert Xu } 1297a8c4a252SHannes Frederic Sowa cork->length += size; 1298e89e9cf5SAnanda Raju 12991da177e4SLinus Torvalds while (size > 0) { 1300be12a1feSHannes Frederic Sowa if (skb_is_gso(skb)) { 1301e89e9cf5SAnanda Raju len = size; 1302be12a1feSHannes Frederic Sowa } else { 1303e89e9cf5SAnanda Raju 13041da177e4SLinus Torvalds /* Check if the remaining data fits into current packet. */ 13051da177e4SLinus Torvalds len = mtu - skb->len; 13061da177e4SLinus Torvalds if (len < size) 13071da177e4SLinus Torvalds len = maxfraglen - skb->len; 1308e89e9cf5SAnanda Raju } 13091da177e4SLinus Torvalds if (len <= 0) { 13101da177e4SLinus Torvalds struct sk_buff *skb_prev; 13111da177e4SLinus Torvalds int alloclen; 13121da177e4SLinus Torvalds 13131da177e4SLinus Torvalds skb_prev = skb; 13141da177e4SLinus Torvalds fraggap = skb_prev->len - maxfraglen; 13151da177e4SLinus Torvalds 13161da177e4SLinus Torvalds alloclen = fragheaderlen + hh_len + fraggap + 15; 13171da177e4SLinus Torvalds skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation); 13181da177e4SLinus Torvalds if (unlikely(!skb)) { 13191da177e4SLinus Torvalds err = -ENOBUFS; 13201da177e4SLinus Torvalds goto error; 13211da177e4SLinus Torvalds } 13221da177e4SLinus Torvalds 13231da177e4SLinus Torvalds /* 13241da177e4SLinus Torvalds * Fill in the control structures 13251da177e4SLinus Torvalds */ 13261da177e4SLinus Torvalds skb->ip_summed = CHECKSUM_NONE; 13271da177e4SLinus Torvalds skb->csum = 0; 13281da177e4SLinus Torvalds skb_reserve(skb, hh_len); 13291da177e4SLinus Torvalds 13301da177e4SLinus Torvalds /* 13311da177e4SLinus Torvalds * Find where to start putting bytes. 13321da177e4SLinus Torvalds */ 1333967b05f6SArnaldo Carvalho de Melo skb_put(skb, fragheaderlen + fraggap); 13342ca9e6f2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1335b0e380b1SArnaldo Carvalho de Melo skb->transport_header = (skb->network_header + 1336b0e380b1SArnaldo Carvalho de Melo fragheaderlen); 13371da177e4SLinus Torvalds if (fraggap) { 1338967b05f6SArnaldo Carvalho de Melo skb->csum = skb_copy_and_csum_bits(skb_prev, 1339967b05f6SArnaldo Carvalho de Melo maxfraglen, 13409c70220bSArnaldo Carvalho de Melo skb_transport_header(skb), 1341967b05f6SArnaldo Carvalho de Melo fraggap, 0); 13421da177e4SLinus Torvalds skb_prev->csum = csum_sub(skb_prev->csum, 13431da177e4SLinus Torvalds skb->csum); 1344e9fa4f7bSHerbert Xu pskb_trim_unique(skb_prev, maxfraglen); 13451da177e4SLinus Torvalds } 13461da177e4SLinus Torvalds 13471da177e4SLinus Torvalds /* 13481da177e4SLinus Torvalds * Put the packet on the pending queue. 13491da177e4SLinus Torvalds */ 13501da177e4SLinus Torvalds __skb_queue_tail(&sk->sk_write_queue, skb); 13511da177e4SLinus Torvalds continue; 13521da177e4SLinus Torvalds } 13531da177e4SLinus Torvalds 13541da177e4SLinus Torvalds if (len > size) 13551da177e4SLinus Torvalds len = size; 1356be12a1feSHannes Frederic Sowa 1357be12a1feSHannes Frederic Sowa if (skb_append_pagefrags(skb, page, offset, len)) { 13581da177e4SLinus Torvalds err = -EMSGSIZE; 13591da177e4SLinus Torvalds goto error; 13601da177e4SLinus Torvalds } 13611da177e4SLinus Torvalds 13621da177e4SLinus Torvalds if (skb->ip_summed == CHECKSUM_NONE) { 136344bb9363SAl Viro __wsum csum; 13641da177e4SLinus Torvalds csum = csum_page(page, offset, len); 13651da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, skb->len); 13661da177e4SLinus Torvalds } 13671da177e4SLinus Torvalds 13681da177e4SLinus Torvalds skb->len += len; 13691da177e4SLinus Torvalds skb->data_len += len; 13701e34a11dSDavid S. Miller skb->truesize += len; 13711e34a11dSDavid S. Miller atomic_add(len, &sk->sk_wmem_alloc); 13721da177e4SLinus Torvalds offset += len; 13731da177e4SLinus Torvalds size -= len; 13741da177e4SLinus Torvalds } 13751da177e4SLinus Torvalds return 0; 13761da177e4SLinus Torvalds 13771da177e4SLinus Torvalds error: 1378bdc712b4SDavid S. Miller cork->length -= size; 13795e38e270SPavel Emelyanov IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS); 13801da177e4SLinus Torvalds return err; 13811da177e4SLinus Torvalds } 13821da177e4SLinus Torvalds 13831470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork) 1384429f08e9SPavel Emelyanov { 13851470ddf7SHerbert Xu cork->flags &= ~IPCORK_OPT; 13861470ddf7SHerbert Xu kfree(cork->opt); 13871470ddf7SHerbert Xu cork->opt = NULL; 13881470ddf7SHerbert Xu dst_release(cork->dst); 13891470ddf7SHerbert Xu cork->dst = NULL; 1390429f08e9SPavel Emelyanov } 1391429f08e9SPavel Emelyanov 13921da177e4SLinus Torvalds /* 13931da177e4SLinus Torvalds * Combined all pending IP fragments on the socket as one IP datagram 13941da177e4SLinus Torvalds * and push them out. 13951da177e4SLinus Torvalds */ 13961c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk, 139777968b78SDavid S. Miller struct flowi4 *fl4, 13981470ddf7SHerbert Xu struct sk_buff_head *queue, 13991470ddf7SHerbert Xu struct inet_cork *cork) 14001da177e4SLinus Torvalds { 14011da177e4SLinus Torvalds struct sk_buff *skb, *tmp_skb; 14021da177e4SLinus Torvalds struct sk_buff **tail_skb; 14031da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 14040388b004SPavel Emelyanov struct net *net = sock_net(sk); 14051da177e4SLinus Torvalds struct ip_options *opt = NULL; 14061470ddf7SHerbert Xu struct rtable *rt = (struct rtable *)cork->dst; 14071da177e4SLinus Torvalds struct iphdr *iph; 140876ab608dSAlexey Dobriyan __be16 df = 0; 14091da177e4SLinus Torvalds __u8 ttl; 14101da177e4SLinus Torvalds 141151456b29SIan Morris skb = __skb_dequeue(queue); 141251456b29SIan Morris if (!skb) 14131da177e4SLinus Torvalds goto out; 14141da177e4SLinus Torvalds tail_skb = &(skb_shinfo(skb)->frag_list); 14151da177e4SLinus Torvalds 14161da177e4SLinus Torvalds /* move skb->data to ip header from ext header */ 1417d56f90a7SArnaldo Carvalho de Melo if (skb->data < skb_network_header(skb)) 1418bbe735e4SArnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 14191470ddf7SHerbert Xu while ((tmp_skb = __skb_dequeue(queue)) != NULL) { 1420cfe1fc77SArnaldo Carvalho de Melo __skb_pull(tmp_skb, skb_network_header_len(skb)); 14211da177e4SLinus Torvalds *tail_skb = tmp_skb; 14221da177e4SLinus Torvalds tail_skb = &(tmp_skb->next); 14231da177e4SLinus Torvalds skb->len += tmp_skb->len; 14241da177e4SLinus Torvalds skb->data_len += tmp_skb->len; 14251da177e4SLinus Torvalds skb->truesize += tmp_skb->truesize; 14261da177e4SLinus Torvalds tmp_skb->destructor = NULL; 14271da177e4SLinus Torvalds tmp_skb->sk = NULL; 14281da177e4SLinus Torvalds } 14291da177e4SLinus Torvalds 14301da177e4SLinus Torvalds /* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow 14311da177e4SLinus Torvalds * to fragment the frame generated here. No matter, what transforms 14321da177e4SLinus Torvalds * how transforms change size of the packet, it will come out. 14331da177e4SLinus Torvalds */ 143460ff7467SWANG Cong skb->ignore_df = ip_sk_ignore_df(sk); 14351da177e4SLinus Torvalds 14361da177e4SLinus Torvalds /* DF bit is set when we want to see DF on outgoing frames. 143760ff7467SWANG Cong * If ignore_df is set too, we still allow to fragment this frame 14381da177e4SLinus Torvalds * locally. */ 1439482fc609SHannes Frederic Sowa if (inet->pmtudisc == IP_PMTUDISC_DO || 1440482fc609SHannes Frederic Sowa inet->pmtudisc == IP_PMTUDISC_PROBE || 1441d8d1f30bSChangli Gao (skb->len <= dst_mtu(&rt->dst) && 1442d8d1f30bSChangli Gao ip_dont_fragment(sk, &rt->dst))) 14431da177e4SLinus Torvalds df = htons(IP_DF); 14441da177e4SLinus Torvalds 14451470ddf7SHerbert Xu if (cork->flags & IPCORK_OPT) 14461470ddf7SHerbert Xu opt = cork->opt; 14471da177e4SLinus Torvalds 1448aa661581SFrancesco Fusco if (cork->ttl != 0) 1449aa661581SFrancesco Fusco ttl = cork->ttl; 1450aa661581SFrancesco Fusco else if (rt->rt_type == RTN_MULTICAST) 14511da177e4SLinus Torvalds ttl = inet->mc_ttl; 14521da177e4SLinus Torvalds else 1453d8d1f30bSChangli Gao ttl = ip_select_ttl(inet, &rt->dst); 14541da177e4SLinus Torvalds 1455749154aaSAnsis Atteka iph = ip_hdr(skb); 14561da177e4SLinus Torvalds iph->version = 4; 14571da177e4SLinus Torvalds iph->ihl = 5; 1458aa661581SFrancesco Fusco iph->tos = (cork->tos != -1) ? cork->tos : inet->tos; 14591da177e4SLinus Torvalds iph->frag_off = df; 14601da177e4SLinus Torvalds iph->ttl = ttl; 14611da177e4SLinus Torvalds iph->protocol = sk->sk_protocol; 146284f9307cSEric Dumazet ip_copy_addrs(iph, fl4); 1463b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, sk); 14641da177e4SLinus Torvalds 146522f728f8SDavid S. Miller if (opt) { 146622f728f8SDavid S. Miller iph->ihl += opt->optlen>>2; 146722f728f8SDavid S. Miller ip_options_build(skb, opt, cork->addr, rt, 0); 146822f728f8SDavid S. Miller } 146922f728f8SDavid S. Miller 1470aa661581SFrancesco Fusco skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority; 14714a19ec58SLaszlo Attila Toth skb->mark = sk->sk_mark; 1472a21bba94SEric Dumazet /* 1473a21bba94SEric Dumazet * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec 1474a21bba94SEric Dumazet * on dst refcount 1475a21bba94SEric Dumazet */ 14761470ddf7SHerbert Xu cork->dst = NULL; 1477d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 14781da177e4SLinus Torvalds 147996793b48SDavid L Stevens if (iph->protocol == IPPROTO_ICMP) 14800388b004SPavel Emelyanov icmp_out_count(net, ((struct icmphdr *) 148196793b48SDavid L Stevens skb_transport_header(skb))->type); 148296793b48SDavid L Stevens 14831c32c5adSHerbert Xu ip_cork_release(cork); 14841c32c5adSHerbert Xu out: 14851c32c5adSHerbert Xu return skb; 14861c32c5adSHerbert Xu } 14871c32c5adSHerbert Xu 1488b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb) 14891c32c5adSHerbert Xu { 14901c32c5adSHerbert Xu int err; 14911c32c5adSHerbert Xu 149233224b16SEric W. Biederman err = ip_local_out(net, skb->sk, skb); 14931da177e4SLinus Torvalds if (err) { 14941da177e4SLinus Torvalds if (err > 0) 14956ce9e7b5SEric Dumazet err = net_xmit_errno(err); 14961da177e4SLinus Torvalds if (err) 14971c32c5adSHerbert Xu IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS); 14981da177e4SLinus Torvalds } 14991da177e4SLinus Torvalds 15001da177e4SLinus Torvalds return err; 15011da177e4SLinus Torvalds } 15021da177e4SLinus Torvalds 150377968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4) 15041470ddf7SHerbert Xu { 15051c32c5adSHerbert Xu struct sk_buff *skb; 15061c32c5adSHerbert Xu 150777968b78SDavid S. Miller skb = ip_finish_skb(sk, fl4); 15081c32c5adSHerbert Xu if (!skb) 15091c32c5adSHerbert Xu return 0; 15101c32c5adSHerbert Xu 15111c32c5adSHerbert Xu /* Netfilter gets whole the not fragmented skb. */ 1512b5ec8eeaSEric Dumazet return ip_send_skb(sock_net(sk), skb); 15131470ddf7SHerbert Xu } 15141470ddf7SHerbert Xu 15151da177e4SLinus Torvalds /* 15161da177e4SLinus Torvalds * Throw away all pending data on the socket. 15171da177e4SLinus Torvalds */ 15181470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk, 15191470ddf7SHerbert Xu struct sk_buff_head *queue, 15201470ddf7SHerbert Xu struct inet_cork *cork) 15211da177e4SLinus Torvalds { 15221da177e4SLinus Torvalds struct sk_buff *skb; 15231da177e4SLinus Torvalds 15241470ddf7SHerbert Xu while ((skb = __skb_dequeue_tail(queue)) != NULL) 15251da177e4SLinus Torvalds kfree_skb(skb); 15261da177e4SLinus Torvalds 15271470ddf7SHerbert Xu ip_cork_release(cork); 15281470ddf7SHerbert Xu } 15291470ddf7SHerbert Xu 15301470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk) 15311470ddf7SHerbert Xu { 1532bdc712b4SDavid S. Miller __ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base); 15331da177e4SLinus Torvalds } 15341da177e4SLinus Torvalds 15351c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk, 153677968b78SDavid S. Miller struct flowi4 *fl4, 15371c32c5adSHerbert Xu int getfrag(void *from, char *to, int offset, 15381c32c5adSHerbert Xu int len, int odd, struct sk_buff *skb), 15391c32c5adSHerbert Xu void *from, int length, int transhdrlen, 15401c32c5adSHerbert Xu struct ipcm_cookie *ipc, struct rtable **rtp, 15411c32c5adSHerbert Xu unsigned int flags) 15421c32c5adSHerbert Xu { 1543b80d7226SDavid S. Miller struct inet_cork cork; 15441c32c5adSHerbert Xu struct sk_buff_head queue; 15451c32c5adSHerbert Xu int err; 15461c32c5adSHerbert Xu 15471c32c5adSHerbert Xu if (flags & MSG_PROBE) 15481c32c5adSHerbert Xu return NULL; 15491c32c5adSHerbert Xu 15501c32c5adSHerbert Xu __skb_queue_head_init(&queue); 15511c32c5adSHerbert Xu 1552b80d7226SDavid S. Miller cork.flags = 0; 1553b80d7226SDavid S. Miller cork.addr = 0; 155470652728SDavid S. Miller cork.opt = NULL; 15551c32c5adSHerbert Xu err = ip_setup_cork(sk, &cork, ipc, rtp); 15561c32c5adSHerbert Xu if (err) 15571c32c5adSHerbert Xu return ERR_PTR(err); 15581c32c5adSHerbert Xu 15595640f768SEric Dumazet err = __ip_append_data(sk, fl4, &queue, &cork, 15605640f768SEric Dumazet ¤t->task_frag, getfrag, 15611c32c5adSHerbert Xu from, length, transhdrlen, flags); 15621c32c5adSHerbert Xu if (err) { 15631c32c5adSHerbert Xu __ip_flush_pending_frames(sk, &queue, &cork); 15641c32c5adSHerbert Xu return ERR_PTR(err); 15651c32c5adSHerbert Xu } 15661c32c5adSHerbert Xu 156777968b78SDavid S. Miller return __ip_make_skb(sk, fl4, &queue, &cork); 15681c32c5adSHerbert Xu } 15691da177e4SLinus Torvalds 15701da177e4SLinus Torvalds /* 15711da177e4SLinus Torvalds * Fetch data from kernel space and fill in checksum if needed. 15721da177e4SLinus Torvalds */ 15731da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset, 15741da177e4SLinus Torvalds int len, int odd, struct sk_buff *skb) 15751da177e4SLinus Torvalds { 15765084205fSAl Viro __wsum csum; 15771da177e4SLinus Torvalds 15781da177e4SLinus Torvalds csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0); 15791da177e4SLinus Torvalds skb->csum = csum_block_add(skb->csum, csum, odd); 15801da177e4SLinus Torvalds return 0; 15811da177e4SLinus Torvalds } 15821da177e4SLinus Torvalds 15831da177e4SLinus Torvalds /* 15841da177e4SLinus Torvalds * Generic function to send a packet as reply to another packet. 1585be9f4a44SEric Dumazet * Used to send some TCP resets/acks so far. 15861da177e4SLinus Torvalds */ 1587bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb, 158824a2d43dSEric Dumazet const struct ip_options *sopt, 158924a2d43dSEric Dumazet __be32 daddr, __be32 saddr, 159024a2d43dSEric Dumazet const struct ip_reply_arg *arg, 159170e73416SDavid S. Miller unsigned int len) 15921da177e4SLinus Torvalds { 1593f6d8bd05SEric Dumazet struct ip_options_data replyopts; 15941da177e4SLinus Torvalds struct ipcm_cookie ipc; 159577968b78SDavid S. Miller struct flowi4 fl4; 1596511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 1597bdbbb852SEric Dumazet struct net *net = sock_net(sk); 1598be9f4a44SEric Dumazet struct sk_buff *nskb; 15994062090eSVasily Averin int err; 1600f7ba868bSDavid Ahern int oif; 16011da177e4SLinus Torvalds 160224a2d43dSEric Dumazet if (__ip_options_echo(&replyopts.opt.opt, skb, sopt)) 16031da177e4SLinus Torvalds return; 16041da177e4SLinus Torvalds 16050a5ebb80SDavid S. Miller ipc.addr = daddr; 16061da177e4SLinus Torvalds ipc.opt = NULL; 16072244d07bSOliver Hartkopp ipc.tx_flags = 0; 1608aa661581SFrancesco Fusco ipc.ttl = 0; 1609aa661581SFrancesco Fusco ipc.tos = -1; 16101da177e4SLinus Torvalds 1611f6d8bd05SEric Dumazet if (replyopts.opt.opt.optlen) { 16121da177e4SLinus Torvalds ipc.opt = &replyopts.opt; 16131da177e4SLinus Torvalds 1614f6d8bd05SEric Dumazet if (replyopts.opt.opt.srr) 1615f6d8bd05SEric Dumazet daddr = replyopts.opt.opt.faddr; 16161da177e4SLinus Torvalds } 16171da177e4SLinus Torvalds 1618f7ba868bSDavid Ahern oif = arg->bound_dev_if; 16199b6c14d5SDavid Ahern if (!oif && netif_index_is_l3_master(net, skb->skb_iif)) 16209b6c14d5SDavid Ahern oif = skb->skb_iif; 1621f7ba868bSDavid Ahern 1622f7ba868bSDavid Ahern flowi4_init_output(&fl4, oif, 1623e110861fSLorenzo Colitti IP4_REPLY_MARK(net, skb->mark), 162466b13d99SEric Dumazet RT_TOS(arg->tos), 1625be9f4a44SEric Dumazet RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol, 1626538de0e0SDavid S. Miller ip_reply_arg_flowi_flags(arg), 162770e73416SDavid S. Miller daddr, saddr, 1628e2d118a1SLorenzo Colitti tcp_hdr(skb)->source, tcp_hdr(skb)->dest, 1629e2d118a1SLorenzo Colitti arg->uid); 16309d6ec938SDavid S. Miller security_skb_classify_flow(skb, flowi4_to_flowi(&fl4)); 1631be9f4a44SEric Dumazet rt = ip_route_output_key(net, &fl4); 1632b23dd4feSDavid S. Miller if (IS_ERR(rt)) 16331da177e4SLinus Torvalds return; 16341da177e4SLinus Torvalds 1635bdbbb852SEric Dumazet inet_sk(sk)->tos = arg->tos; 16361da177e4SLinus Torvalds 16371da177e4SLinus Torvalds sk->sk_priority = skb->priority; 1638eddc9ec5SArnaldo Carvalho de Melo sk->sk_protocol = ip_hdr(skb)->protocol; 1639f0e48dbfSPatrick McHardy sk->sk_bound_dev_if = arg->bound_dev_if; 1640be9f4a44SEric Dumazet sk->sk_sndbuf = sysctl_wmem_default; 1641bf99b4deSPau Espin Pedrol sk->sk_mark = fl4.flowi4_mark; 16424062090eSVasily Averin err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base, 16434062090eSVasily Averin len, 0, &ipc, &rt, MSG_DONTWAIT); 16444062090eSVasily Averin if (unlikely(err)) { 16454062090eSVasily Averin ip_flush_pending_frames(sk); 16464062090eSVasily Averin goto out; 16474062090eSVasily Averin } 16484062090eSVasily Averin 1649be9f4a44SEric Dumazet nskb = skb_peek(&sk->sk_write_queue); 1650be9f4a44SEric Dumazet if (nskb) { 16511da177e4SLinus Torvalds if (arg->csumoffset >= 0) 1652be9f4a44SEric Dumazet *((__sum16 *)skb_transport_header(nskb) + 1653be9f4a44SEric Dumazet arg->csumoffset) = csum_fold(csum_add(nskb->csum, 16549c70220bSArnaldo Carvalho de Melo arg->csum)); 1655be9f4a44SEric Dumazet nskb->ip_summed = CHECKSUM_NONE; 165677968b78SDavid S. Miller ip_push_pending_frames(sk, &fl4); 16571da177e4SLinus Torvalds } 16584062090eSVasily Averin out: 16591da177e4SLinus Torvalds ip_rt_put(rt); 16601da177e4SLinus Torvalds } 16611da177e4SLinus Torvalds 16621da177e4SLinus Torvalds void __init ip_init(void) 16631da177e4SLinus Torvalds { 16641da177e4SLinus Torvalds ip_rt_init(); 16651da177e4SLinus Torvalds inet_initpeers(); 16661da177e4SLinus Torvalds 166772c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST) 166872c1d3bdSWANG Cong igmp_mc_init(); 16691da177e4SLinus Torvalds #endif 16701da177e4SLinus Torvalds } 1671