?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 4.1.16
[linux/fpc-iii.git] / net / ipv6 / ip6_output.c
blobbc09cb97b8401011c112afe469fd231382387622
1 /*
2 * IPv6 output functions
3 * Linux INET6 implementation
4 *
5 * Authors:
6 * Pedro Roque <roque@di.fc.ul.pt>
7 *
8 * Based on linux/net/ipv4/ip_output.c
9 *
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * as published by the Free Software Foundation; either version
13 * 2 of the License, or (at your option) any later version.
14 *
15 * Changes:
16 * A.N.Kuznetsov : airthmetics in fragmentation.
17 * extension headers are implemented.
18 * route changes now work.
19 * ip6_forward does not confuse sniffers.
20 * etc.
21 *
22 * H. von Brand : Added missing #include <linux/string.h>
23 * Imran Patel : frag id should be in NBO
24 * Kazunori MIYAZAWA @USAGI
25 * : add ip6_append_data and related functions
26 * for datagram xmit
27 */
28
29 #include <linux/errno.h>
30 #include <linux/kernel.h>
31 #include <linux/string.h>
32 #include <linux/socket.h>
33 #include <linux/net.h>
34 #include <linux/netdevice.h>
35 #include <linux/if_arp.h>
36 #include <linux/in6.h>
37 #include <linux/tcp.h>
38 #include <linux/route.h>
39 #include <linux/module.h>
40 #include <linux/slab.h>
41
42 #include <linux/netfilter.h>
43 #include <linux/netfilter_ipv6.h>
44
45 #include <net/sock.h>
46 #include <net/snmp.h>
47
48 #include <net/ipv6.h>
49 #include <net/ndisc.h>
50 #include <net/protocol.h>
51 #include <net/ip6_route.h>
52 #include <net/addrconf.h>
53 #include <net/rawv6.h>
54 #include <net/icmp.h>
55 #include <net/xfrm.h>
56 #include <net/checksum.h>
57 #include <linux/mroute6.h>
58
59 static int ip6_finish_output2(struct sock *sk, struct sk_buff *skb)
60 {
61 struct dst_entry *dst = skb_dst(skb);
62 struct net_device *dev = dst->dev;
63 struct neighbour *neigh;
64 struct in6_addr *nexthop;
65 int ret;
66
67 skb->protocol = htons(ETH_P_IPV6);
68 skb->dev = dev;
69
70 if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr)) {
71 struct inet6_dev *idev = ip6_dst_idev(skb_dst(skb));
72
73 if (!(dev->flags & IFF_LOOPBACK) && sk_mc_loop(sk) &&
74 ((mroute6_socket(dev_net(dev), skb) &&
75 !(IP6CB(skb)->flags & IP6SKB_FORWARDED)) ||
76 ipv6_chk_mcast_addr(dev, &ipv6_hdr(skb)->daddr,
77 &ipv6_hdr(skb)->saddr))) {
78 struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
79
80 /* Do not check for IFF_ALLMULTI; multicast routing
81 is not supported in any case.
82 */
83 if (newskb)
84 NF_HOOK(NFPROTO_IPV6, NF_INET_POST_ROUTING,
85 sk, newskb, NULL, newskb->dev,
86 dev_loopback_xmit);
87
88 if (ipv6_hdr(skb)->hop_limit == 0) {
89 IP6_INC_STATS(dev_net(dev), idev,
90 IPSTATS_MIB_OUTDISCARDS);
91 kfree_skb(skb);
92 return 0;
93 }
94 }
95
96 IP6_UPD_PO_STATS(dev_net(dev), idev, IPSTATS_MIB_OUTMCAST,
97 skb->len);
98
99 if (IPV6_ADDR_MC_SCOPE(&ipv6_hdr(skb)->daddr) <=
100 IPV6_ADDR_SCOPE_NODELOCAL &&
101 !(dev->flags & IFF_LOOPBACK)) {
102 kfree_skb(skb);
103 return 0;
104 }
105 }
106
107 rcu_read_lock_bh();
108 nexthop = rt6_nexthop((struct rt6_info *)dst);
109 neigh = __ipv6_neigh_lookup_noref(dst->dev, nexthop);
110 if (unlikely(!neigh))
111 neigh = __neigh_create(&nd_tbl, nexthop, dst->dev, false);
112 if (!IS_ERR(neigh)) {
113 ret = dst_neigh_output(dst, neigh, skb);
114 rcu_read_unlock_bh();
115 return ret;
116 }
117 rcu_read_unlock_bh();
118
119 IP6_INC_STATS(dev_net(dst->dev),
120 ip6_dst_idev(dst), IPSTATS_MIB_OUTNOROUTES);
121 kfree_skb(skb);
122 return -EINVAL;
123 }
124
125 static int ip6_finish_output(struct sock *sk, struct sk_buff *skb)
126 {
127 if ((skb->len > ip6_skb_dst_mtu(skb) && !skb_is_gso(skb)) ||
128 dst_allfrag(skb_dst(skb)) ||
129 (IP6CB(skb)->frag_max_size && skb->len > IP6CB(skb)->frag_max_size))
130 return ip6_fragment(sk, skb, ip6_finish_output2);
131 else
132 return ip6_finish_output2(sk, skb);
133 }
134
135 int ip6_output(struct sock *sk, struct sk_buff *skb)
136 {
137 struct net_device *dev = skb_dst(skb)->dev;
138 struct inet6_dev *idev = ip6_dst_idev(skb_dst(skb));
139 if (unlikely(idev->cnf.disable_ipv6)) {
140 IP6_INC_STATS(dev_net(dev), idev,
141 IPSTATS_MIB_OUTDISCARDS);
142 kfree_skb(skb);
143 return 0;
144 }
145
146 return NF_HOOK_COND(NFPROTO_IPV6, NF_INET_POST_ROUTING, sk, skb,
147 NULL, dev,
148 ip6_finish_output,
149 !(IP6CB(skb)->flags & IP6SKB_REROUTED));
150 }
151
152 /*
153 * xmit an sk_buff (used by TCP, SCTP and DCCP)
154 */
155
156 int ip6_xmit(struct sock *sk, struct sk_buff *skb, struct flowi6 *fl6,
157 struct ipv6_txoptions *opt, int tclass)
158 {
159 struct net *net = sock_net(sk);
160 struct ipv6_pinfo *np = inet6_sk(sk);
161 struct in6_addr *first_hop = &fl6->daddr;
162 struct dst_entry *dst = skb_dst(skb);
163 struct ipv6hdr *hdr;
164 u8 proto = fl6->flowi6_proto;
165 int seg_len = skb->len;
166 int hlimit = -1;
167 u32 mtu;
168
169 if (opt) {
170 unsigned int head_room;
171
172 /* First: exthdrs may take lots of space (~8K for now)
173 MAX_HEADER is not enough.
174 */
175 head_room = opt->opt_nflen + opt->opt_flen;
176 seg_len += head_room;
177 head_room += sizeof(struct ipv6hdr) + LL_RESERVED_SPACE(dst->dev);
178
179 if (skb_headroom(skb) < head_room) {
180 struct sk_buff *skb2 = skb_realloc_headroom(skb, head_room);
181 if (!skb2) {
182 IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
183 IPSTATS_MIB_OUTDISCARDS);
184 kfree_skb(skb);
185 return -ENOBUFS;
186 }
187 consume_skb(skb);
188 skb = skb2;
189 skb_set_owner_w(skb, sk);
190 }
191 if (opt->opt_flen)
192 ipv6_push_frag_opts(skb, opt, &proto);
193 if (opt->opt_nflen)
194 ipv6_push_nfrag_opts(skb, opt, &proto, &first_hop);
195 }
196
197 skb_push(skb, sizeof(struct ipv6hdr));
198 skb_reset_network_header(skb);
199 hdr = ipv6_hdr(skb);
200
201 /*
202 * Fill in the IPv6 header
203 */
204 if (np)
205 hlimit = np->hop_limit;
206 if (hlimit < 0)
207 hlimit = ip6_dst_hoplimit(dst);
208
209 ip6_flow_hdr(hdr, tclass, ip6_make_flowlabel(net, skb, fl6->flowlabel,
210 np->autoflowlabel));
211
212 hdr->payload_len = htons(seg_len);
213 hdr->nexthdr = proto;
214 hdr->hop_limit = hlimit;
215
216 hdr->saddr = fl6->saddr;
217 hdr->daddr = *first_hop;
218
219 skb->protocol = htons(ETH_P_IPV6);
220 skb->priority = sk->sk_priority;
221 skb->mark = sk->sk_mark;
222
223 mtu = dst_mtu(dst);
224 if ((skb->len <= mtu) || skb->ignore_df || skb_is_gso(skb)) {
225 IP6_UPD_PO_STATS(net, ip6_dst_idev(skb_dst(skb)),
226 IPSTATS_MIB_OUT, skb->len);
227 return NF_HOOK(NFPROTO_IPV6, NF_INET_LOCAL_OUT, sk, skb,
228 NULL, dst->dev, dst_output_sk);
229 }
230
231 skb->dev = dst->dev;
232 ipv6_local_error(sk, EMSGSIZE, fl6, mtu);
233 IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_FRAGFAILS);
234 kfree_skb(skb);
235 return -EMSGSIZE;
236 }
237 EXPORT_SYMBOL(ip6_xmit);
238
239 static int ip6_call_ra_chain(struct sk_buff *skb, int sel)
240 {
241 struct ip6_ra_chain *ra;
242 struct sock *last = NULL;
243
244 read_lock(&ip6_ra_lock);
245 for (ra = ip6_ra_chain; ra; ra = ra->next) {
246 struct sock *sk = ra->sk;
247 if (sk && ra->sel == sel &&
248 (!sk->sk_bound_dev_if ||
249 sk->sk_bound_dev_if == skb->dev->ifindex)) {
250 if (last) {
251 struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
252 if (skb2)
253 rawv6_rcv(last, skb2);
254 }
255 last = sk;
256 }
257 }
258
259 if (last) {
260 rawv6_rcv(last, skb);
261 read_unlock(&ip6_ra_lock);
262 return 1;
263 }
264 read_unlock(&ip6_ra_lock);
265 return 0;
266 }
267
268 static int ip6_forward_proxy_check(struct sk_buff *skb)
269 {
270 struct ipv6hdr *hdr = ipv6_hdr(skb);
271 u8 nexthdr = hdr->nexthdr;
272 __be16 frag_off;
273 int offset;
274
275 if (ipv6_ext_hdr(nexthdr)) {
276 offset = ipv6_skip_exthdr(skb, sizeof(*hdr), &nexthdr, &frag_off);
277 if (offset < 0)
278 return 0;
279 } else
280 offset = sizeof(struct ipv6hdr);
281
282 if (nexthdr == IPPROTO_ICMPV6) {
283 struct icmp6hdr *icmp6;
284
285 if (!pskb_may_pull(skb, (skb_network_header(skb) +
286 offset + 1 - skb->data)))
287 return 0;
288
289 icmp6 = (struct icmp6hdr *)(skb_network_header(skb) + offset);
290
291 switch (icmp6->icmp6_type) {
292 case NDISC_ROUTER_SOLICITATION:
293 case NDISC_ROUTER_ADVERTISEMENT:
294 case NDISC_NEIGHBOUR_SOLICITATION:
295 case NDISC_NEIGHBOUR_ADVERTISEMENT:
296 case NDISC_REDIRECT:
297 /* For reaction involving unicast neighbor discovery
298 * message destined to the proxied address, pass it to
299 * input function.
300 */
301 return 1;
302 default:
303 break;
304 }
305 }
306
307 /*
308 * The proxying router can't forward traffic sent to a link-local
309 * address, so signal the sender and discard the packet. This
310 * behavior is clarified by the MIPv6 specification.
311 */
312 if (ipv6_addr_type(&hdr->daddr) & IPV6_ADDR_LINKLOCAL) {
313 dst_link_failure(skb);
314 return -1;
315 }
316
317 return 0;
318 }
319
320 static inline int ip6_forward_finish(struct sock *sk, struct sk_buff *skb)
321 {
322 skb_sender_cpu_clear(skb);
323 return dst_output_sk(sk, skb);
324 }
325
326 static unsigned int ip6_dst_mtu_forward(const struct dst_entry *dst)
327 {
328 unsigned int mtu;
329 struct inet6_dev *idev;
330
331 if (dst_metric_locked(dst, RTAX_MTU)) {
332 mtu = dst_metric_raw(dst, RTAX_MTU);
333 if (mtu)
334 return mtu;
335 }
336
337 mtu = IPV6_MIN_MTU;
338 rcu_read_lock();
339 idev = __in6_dev_get(dst->dev);
340 if (idev)
341 mtu = idev->cnf.mtu6;
342 rcu_read_unlock();
343
344 return mtu;
345 }
346
347 static bool ip6_pkt_too_big(const struct sk_buff *skb, unsigned int mtu)
348 {
349 if (skb->len <= mtu)
350 return false;
351
352 /* ipv6 conntrack defrag sets max_frag_size + ignore_df */
353 if (IP6CB(skb)->frag_max_size && IP6CB(skb)->frag_max_size > mtu)
354 return true;
355
356 if (skb->ignore_df)
357 return false;
358
359 if (skb_is_gso(skb) && skb_gso_network_seglen(skb) <= mtu)
360 return false;
361
362 return true;
363 }
364
365 int ip6_forward(struct sk_buff *skb)
366 {
367 struct dst_entry *dst = skb_dst(skb);
368 struct ipv6hdr *hdr = ipv6_hdr(skb);
369 struct inet6_skb_parm *opt = IP6CB(skb);
370 struct net *net = dev_net(dst->dev);
371 u32 mtu;
372
373 if (net->ipv6.devconf_all->forwarding == 0)
374 goto error;
375
376 if (skb->pkt_type != PACKET_HOST)
377 goto drop;
378
379 if (skb_warn_if_lro(skb))
380 goto drop;
381
382 if (!xfrm6_policy_check(NULL, XFRM_POLICY_FWD, skb)) {
383 IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
384 IPSTATS_MIB_INDISCARDS);
385 goto drop;
386 }
387
388 skb_forward_csum(skb);
389
390 /*
391 * We DO NOT make any processing on
392 * RA packets, pushing them to user level AS IS
393 * without ane WARRANTY that application will be able
394 * to interpret them. The reason is that we
395 * cannot make anything clever here.
396 *
397 * We are not end-node, so that if packet contains
398 * AH/ESP, we cannot make anything.
399 * Defragmentation also would be mistake, RA packets
400 * cannot be fragmented, because there is no warranty
401 * that different fragments will go along one path. --ANK
402 */
403 if (unlikely(opt->flags & IP6SKB_ROUTERALERT)) {
404 if (ip6_call_ra_chain(skb, ntohs(opt->ra)))
405 return 0;
406 }
407
408 /*
409 * check and decrement ttl
410 */
411 if (hdr->hop_limit <= 1) {
412 /* Force OUTPUT device used as source address */
413 skb->dev = dst->dev;
414 icmpv6_send(skb, ICMPV6_TIME_EXCEED, ICMPV6_EXC_HOPLIMIT, 0);
415 IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
416 IPSTATS_MIB_INHDRERRORS);
417
418 kfree_skb(skb);
419 return -ETIMEDOUT;
420 }
421
422 /* XXX: idev->cnf.proxy_ndp? */
423 if (net->ipv6.devconf_all->proxy_ndp &&
424 pneigh_lookup(&nd_tbl, net, &hdr->daddr, skb->dev, 0)) {
425 int proxied = ip6_forward_proxy_check(skb);
426 if (proxied > 0)
427 return ip6_input(skb);
428 else if (proxied < 0) {
429 IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
430 IPSTATS_MIB_INDISCARDS);
431 goto drop;
432 }
433 }
434
435 if (!xfrm6_route_forward(skb)) {
436 IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
437 IPSTATS_MIB_INDISCARDS);
438 goto drop;
439 }
440 dst = skb_dst(skb);
441
442 /* IPv6 specs say nothing about it, but it is clear that we cannot
443 send redirects to source routed frames.
444 We don't send redirects to frames decapsulated from IPsec.
445 */
446 if (skb->dev == dst->dev && opt->srcrt == 0 && !skb_sec_path(skb)) {
447 struct in6_addr *target = NULL;
448 struct inet_peer *peer;
449 struct rt6_info *rt;
450
451 /*
452 * incoming and outgoing devices are the same
453 * send a redirect.
454 */
455
456 rt = (struct rt6_info *) dst;
457 if (rt->rt6i_flags & RTF_GATEWAY)
458 target = &rt->rt6i_gateway;
459 else
460 target = &hdr->daddr;
461
462 peer = inet_getpeer_v6(net->ipv6.peers, &rt->rt6i_dst.addr, 1);
463
464 /* Limit redirects both by destination (here)
465 and by source (inside ndisc_send_redirect)
466 */
467 if (inet_peer_xrlim_allow(peer, 1*HZ))
468 ndisc_send_redirect(skb, target);
469 if (peer)
470 inet_putpeer(peer);
471 } else {
472 int addrtype = ipv6_addr_type(&hdr->saddr);
473
474 /* This check is security critical. */
475 if (addrtype == IPV6_ADDR_ANY ||
476 addrtype & (IPV6_ADDR_MULTICAST | IPV6_ADDR_LOOPBACK))
477 goto error;
478 if (addrtype & IPV6_ADDR_LINKLOCAL) {
479 icmpv6_send(skb, ICMPV6_DEST_UNREACH,
480 ICMPV6_NOT_NEIGHBOUR, 0);
481 goto error;
482 }
483 }
484
485 mtu = ip6_dst_mtu_forward(dst);
486 if (mtu < IPV6_MIN_MTU)
487 mtu = IPV6_MIN_MTU;
488
489 if (ip6_pkt_too_big(skb, mtu)) {
490 /* Again, force OUTPUT device used as source address */
491 skb->dev = dst->dev;
492 icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
493 IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
494 IPSTATS_MIB_INTOOBIGERRORS);
495 IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
496 IPSTATS_MIB_FRAGFAILS);
497 kfree_skb(skb);
498 return -EMSGSIZE;
499 }
500
501 if (skb_cow(skb, dst->dev->hard_header_len)) {
502 IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
503 IPSTATS_MIB_OUTDISCARDS);
504 goto drop;
505 }
506
507 hdr = ipv6_hdr(skb);
508
509 /* Mangling hops number delayed to point after skb COW */
510
511 hdr->hop_limit--;
512
513 IP6_INC_STATS_BH(net, ip6_dst_idev(dst), IPSTATS_MIB_OUTFORWDATAGRAMS);
514 IP6_ADD_STATS_BH(net, ip6_dst_idev(dst), IPSTATS_MIB_OUTOCTETS, skb->len);
515 return NF_HOOK(NFPROTO_IPV6, NF_INET_FORWARD, NULL, skb,
516 skb->dev, dst->dev,
517 ip6_forward_finish);
518
519 error:
520 IP6_INC_STATS_BH(net, ip6_dst_idev(dst), IPSTATS_MIB_INADDRERRORS);
521 drop:
522 kfree_skb(skb);
523 return -EINVAL;
524 }
525
526 static void ip6_copy_metadata(struct sk_buff *to, struct sk_buff *from)
527 {
528 to->pkt_type = from->pkt_type;
529 to->priority = from->priority;
530 to->protocol = from->protocol;
531 skb_dst_drop(to);
532 skb_dst_set(to, dst_clone(skb_dst(from)));
533 to->dev = from->dev;
534 to->mark = from->mark;
535
536 #ifdef CONFIG_NET_SCHED
537 to->tc_index = from->tc_index;
538 #endif
539 nf_copy(to, from);
540 skb_copy_secmark(to, from);
541 }
542
543 int ip6_fragment(struct sock *sk, struct sk_buff *skb,
544 int (*output)(struct sock *, struct sk_buff *))
545 {
546 struct sk_buff *frag;
547 struct rt6_info *rt = (struct rt6_info *)skb_dst(skb);
548 struct ipv6_pinfo *np = skb->sk && !dev_recursion_level() ?
549 inet6_sk(skb->sk) : NULL;
550 struct ipv6hdr *tmp_hdr;
551 struct frag_hdr *fh;
552 unsigned int mtu, hlen, left, len;
553 int hroom, troom;
554 __be32 frag_id = 0;
555 int ptr, offset = 0, err = 0;
556 u8 *prevhdr, nexthdr = 0;
557 struct net *net = dev_net(skb_dst(skb)->dev);
558
559 hlen = ip6_find_1stfragopt(skb, &prevhdr);
560 nexthdr = *prevhdr;
561
562 mtu = ip6_skb_dst_mtu(skb);
563
564 /* We must not fragment if the socket is set to force MTU discovery
565 * or if the skb it not generated by a local socket.
566 */
567 if (unlikely(!skb->ignore_df && skb->len > mtu) ||
568 (IP6CB(skb)->frag_max_size &&
569 IP6CB(skb)->frag_max_size > mtu)) {
570 if (skb->sk && dst_allfrag(skb_dst(skb)))
571 sk_nocaps_add(skb->sk, NETIF_F_GSO_MASK);
572
573 skb->dev = skb_dst(skb)->dev;
574 icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
575 IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
576 IPSTATS_MIB_FRAGFAILS);
577 kfree_skb(skb);
578 return -EMSGSIZE;
579 }
580
581 if (np && np->frag_size < mtu) {
582 if (np->frag_size)
583 mtu = np->frag_size;
584 }
585 mtu -= hlen + sizeof(struct frag_hdr);
586
587 if (skb_has_frag_list(skb)) {
588 int first_len = skb_pagelen(skb);
589 struct sk_buff *frag2;
590
591 if (first_len - hlen > mtu ||
592 ((first_len - hlen) & 7) ||
593 skb_cloned(skb))
594 goto slow_path;
595
596 skb_walk_frags(skb, frag) {
597 /* Correct geometry. */
598 if (frag->len > mtu ||
599 ((frag->len & 7) && frag->next) ||
600 skb_headroom(frag) < hlen)
601 goto slow_path_clean;
602
603 /* Partially cloned skb? */
604 if (skb_shared(frag))
605 goto slow_path_clean;
606
607 BUG_ON(frag->sk);
608 if (skb->sk) {
609 frag->sk = skb->sk;
610 frag->destructor = sock_wfree;
611 }
612 skb->truesize -= frag->truesize;
613 }
614
615 err = 0;
616 offset = 0;
617 frag = skb_shinfo(skb)->frag_list;
618 skb_frag_list_init(skb);
619 /* BUILD HEADER */
620
621 *prevhdr = NEXTHDR_FRAGMENT;
622 tmp_hdr = kmemdup(skb_network_header(skb), hlen, GFP_ATOMIC);
623 if (!tmp_hdr) {
624 IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
625 IPSTATS_MIB_FRAGFAILS);
626 return -ENOMEM;
627 }
628
629 __skb_pull(skb, hlen);
630 fh = (struct frag_hdr *)__skb_push(skb, sizeof(struct frag_hdr));
631 __skb_push(skb, hlen);
632 skb_reset_network_header(skb);
633 memcpy(skb_network_header(skb), tmp_hdr, hlen);
634
635 ipv6_select_ident(net, fh, rt);
636 fh->nexthdr = nexthdr;
637 fh->reserved = 0;
638 fh->frag_off = htons(IP6_MF);
639 frag_id = fh->identification;
640
641 first_len = skb_pagelen(skb);
642 skb->data_len = first_len - skb_headlen(skb);
643 skb->len = first_len;
644 ipv6_hdr(skb)->payload_len = htons(first_len -
645 sizeof(struct ipv6hdr));
646
647 dst_hold(&rt->dst);
648
649 for (;;) {
650 /* Prepare header of the next frame,
651 * before previous one went down. */
652 if (frag) {
653 frag->ip_summed = CHECKSUM_NONE;
654 skb_reset_transport_header(frag);
655 fh = (struct frag_hdr *)__skb_push(frag, sizeof(struct frag_hdr));
656 __skb_push(frag, hlen);
657 skb_reset_network_header(frag);
658 memcpy(skb_network_header(frag), tmp_hdr,
659 hlen);
660 offset += skb->len - hlen - sizeof(struct frag_hdr);
661 fh->nexthdr = nexthdr;
662 fh->reserved = 0;
663 fh->frag_off = htons(offset);
664 if (frag->next)
665 fh->frag_off |= htons(IP6_MF);
666 fh->identification = frag_id;
667 ipv6_hdr(frag)->payload_len =
668 htons(frag->len -
669 sizeof(struct ipv6hdr));
670 ip6_copy_metadata(frag, skb);
671 }
672
673 err = output(sk, skb);
674 if (!err)
675 IP6_INC_STATS(net, ip6_dst_idev(&rt->dst),
676 IPSTATS_MIB_FRAGCREATES);
677
678 if (err || !frag)
679 break;
680
681 skb = frag;
682 frag = skb->next;
683 skb->next = NULL;
684 }
685
686 kfree(tmp_hdr);
687
688 if (err == 0) {
689 IP6_INC_STATS(net, ip6_dst_idev(&rt->dst),
690 IPSTATS_MIB_FRAGOKS);
691 ip6_rt_put(rt);
692 return 0;
693 }
694
695 kfree_skb_list(frag);
696
697 IP6_INC_STATS(net, ip6_dst_idev(&rt->dst),
698 IPSTATS_MIB_FRAGFAILS);
699 ip6_rt_put(rt);
700 return err;
701
702 slow_path_clean:
703 skb_walk_frags(skb, frag2) {
704 if (frag2 == frag)
705 break;
706 frag2->sk = NULL;
707 frag2->destructor = NULL;
708 skb->truesize += frag2->truesize;
709 }
710 }
711
712 slow_path:
713 if ((skb->ip_summed == CHECKSUM_PARTIAL) &&
714 skb_checksum_help(skb))
715 goto fail;
716
717 left = skb->len - hlen; /* Space per frame */
718 ptr = hlen; /* Where to start from */
719
720 /*
721 * Fragment the datagram.
722 */
723
724 *prevhdr = NEXTHDR_FRAGMENT;
725 hroom = LL_RESERVED_SPACE(rt->dst.dev);
726 troom = rt->dst.dev->needed_tailroom;
727
728 /*
729 * Keep copying data until we run out.
730 */
731 while (left > 0) {
732 len = left;
733 /* IF: it doesn't fit, use 'mtu' - the data space left */
734 if (len > mtu)
735 len = mtu;
736 /* IF: we are not sending up to and including the packet end
737 then align the next start on an eight byte boundary */
738 if (len < left) {
739 len &= ~7;
740 }
741
742 /* Allocate buffer */
743 frag = alloc_skb(len + hlen + sizeof(struct frag_hdr) +
744 hroom + troom, GFP_ATOMIC);
745 if (!frag) {
746 IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
747 IPSTATS_MIB_FRAGFAILS);
748 err = -ENOMEM;
749 goto fail;
750 }
751
752 /*
753 * Set up data on packet
754 */
755
756 ip6_copy_metadata(frag, skb);
757 skb_reserve(frag, hroom);
758 skb_put(frag, len + hlen + sizeof(struct frag_hdr));
759 skb_reset_network_header(frag);
760 fh = (struct frag_hdr *)(skb_network_header(frag) + hlen);
761 frag->transport_header = (frag->network_header + hlen +
762 sizeof(struct frag_hdr));
763
764 /*
765 * Charge the memory for the fragment to any owner
766 * it might possess
767 */
768 if (skb->sk)
769 skb_set_owner_w(frag, skb->sk);
770
771 /*
772 * Copy the packet header into the new buffer.
773 */
774 skb_copy_from_linear_data(skb, skb_network_header(frag), hlen);
775
776 /*
777 * Build fragment header.
778 */
779 fh->nexthdr = nexthdr;
780 fh->reserved = 0;
781 if (!frag_id) {
782 ipv6_select_ident(net, fh, rt);
783 frag_id = fh->identification;
784 } else
785 fh->identification = frag_id;
786
787 /*
788 * Copy a block of the IP datagram.
789 */
790 BUG_ON(skb_copy_bits(skb, ptr, skb_transport_header(frag),
791 len));
792 left -= len;
793
794 fh->frag_off = htons(offset);
795 if (left > 0)
796 fh->frag_off |= htons(IP6_MF);
797 ipv6_hdr(frag)->payload_len = htons(frag->len -
798 sizeof(struct ipv6hdr));
799
800 ptr += len;
801 offset += len;
802
803 /*
804 * Put this fragment into the sending queue.
805 */
806 err = output(sk, frag);
807 if (err)
808 goto fail;
809
810 IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
811 IPSTATS_MIB_FRAGCREATES);
812 }
813 IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
814 IPSTATS_MIB_FRAGOKS);
815 consume_skb(skb);
816 return err;
817
818 fail:
819 IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
820 IPSTATS_MIB_FRAGFAILS);
821 kfree_skb(skb);
822 return err;
823 }
824
825 static inline int ip6_rt_check(const struct rt6key *rt_key,
826 const struct in6_addr *fl_addr,
827 const struct in6_addr *addr_cache)
828 {
829 return (rt_key->plen != 128 || !ipv6_addr_equal(fl_addr, &rt_key->addr)) &&
830 (!addr_cache || !ipv6_addr_equal(fl_addr, addr_cache));
831 }
832
833 static struct dst_entry *ip6_sk_dst_check(struct sock *sk,
834 struct dst_entry *dst,
835 const struct flowi6 *fl6)
836 {
837 struct ipv6_pinfo *np = inet6_sk(sk);
838 struct rt6_info *rt;
839
840 if (!dst)
841 goto out;
842
843 if (dst->ops->family != AF_INET6) {
844 dst_release(dst);
845 return NULL;
846 }
847
848 rt = (struct rt6_info *)dst;
849 /* Yes, checking route validity in not connected
850 * case is not very simple. Take into account,
851 * that we do not support routing by source, TOS,
852 * and MSG_DONTROUTE --ANK (980726)
853 *
854 * 1. ip6_rt_check(): If route was host route,
855 * check that cached destination is current.
856 * If it is network route, we still may
857 * check its validity using saved pointer
858 * to the last used address: daddr_cache.
859 * We do not want to save whole address now,
860 * (because main consumer of this service
861 * is tcp, which has not this problem),
862 * so that the last trick works only on connected
863 * sockets.
864 * 2. oif also should be the same.
865 */
866 if (ip6_rt_check(&rt->rt6i_dst, &fl6->daddr, np->daddr_cache) ||
867 #ifdef CONFIG_IPV6_SUBTREES
868 ip6_rt_check(&rt->rt6i_src, &fl6->saddr, np->saddr_cache) ||
869 #endif
870 (fl6->flowi6_oif && fl6->flowi6_oif != dst->dev->ifindex)) {
871 dst_release(dst);
872 dst = NULL;
873 }
874
875 out:
876 return dst;
877 }
878
879 static int ip6_dst_lookup_tail(struct sock *sk,
880 struct dst_entry **dst, struct flowi6 *fl6)
881 {
882 struct net *net = sock_net(sk);
883 #ifdef CONFIG_IPV6_OPTIMISTIC_DAD
884 struct neighbour *n;
885 struct rt6_info *rt;
886 #endif
887 int err;
888
889 /* The correct way to handle this would be to do
890 * ip6_route_get_saddr, and then ip6_route_output; however,
891 * the route-specific preferred source forces the
892 * ip6_route_output call _before_ ip6_route_get_saddr.
893 *
894 * In source specific routing (no src=any default route),
895 * ip6_route_output will fail given src=any saddr, though, so
896 * that's why we try it again later.
897 */
898 if (ipv6_addr_any(&fl6->saddr) && (!*dst || !(*dst)->error)) {
899 struct rt6_info *rt;
900 bool had_dst = *dst != NULL;
901
902 if (!had_dst)
903 *dst = ip6_route_output(net, sk, fl6);
904 rt = (*dst)->error ? NULL : (struct rt6_info *)*dst;
905 err = ip6_route_get_saddr(net, rt, &fl6->daddr,
906 sk ? inet6_sk(sk)->srcprefs : 0,
907 &fl6->saddr);
908 if (err)
909 goto out_err_release;
910
911 /* If we had an erroneous initial result, pretend it
912 * never existed and let the SA-enabled version take
913 * over.
914 */
915 if (!had_dst && (*dst)->error) {
916 dst_release(*dst);
917 *dst = NULL;
918 }
919 }
920
921 if (!*dst)
922 *dst = ip6_route_output(net, sk, fl6);
923
924 err = (*dst)->error;
925 if (err)
926 goto out_err_release;
927
928 #ifdef CONFIG_IPV6_OPTIMISTIC_DAD
929 /*
930 * Here if the dst entry we've looked up
931 * has a neighbour entry that is in the INCOMPLETE
932 * state and the src address from the flow is
933 * marked as OPTIMISTIC, we release the found
934 * dst entry and replace it instead with the
935 * dst entry of the nexthop router
936 */
937 rt = (struct rt6_info *) *dst;
938 rcu_read_lock_bh();
939 n = __ipv6_neigh_lookup_noref(rt->dst.dev, rt6_nexthop(rt));
940 err = n && !(n->nud_state & NUD_VALID) ? -EINVAL : 0;
941 rcu_read_unlock_bh();
942
943 if (err) {
944 struct inet6_ifaddr *ifp;
945 struct flowi6 fl_gw6;
946 int redirect;
947
948 ifp = ipv6_get_ifaddr(net, &fl6->saddr,
949 (*dst)->dev, 1);
950
951 redirect = (ifp && ifp->flags & IFA_F_OPTIMISTIC);
952 if (ifp)
953 in6_ifa_put(ifp);
954
955 if (redirect) {
956 /*
957 * We need to get the dst entry for the
958 * default router instead
959 */
960 dst_release(*dst);
961 memcpy(&fl_gw6, fl6, sizeof(struct flowi6));
962 memset(&fl_gw6.daddr, 0, sizeof(struct in6_addr));
963 *dst = ip6_route_output(net, sk, &fl_gw6);
964 err = (*dst)->error;
965 if (err)
966 goto out_err_release;
967 }
968 }
969 #endif
970
971 return 0;
972
973 out_err_release:
974 if (err == -ENETUNREACH)
975 IP6_INC_STATS(net, NULL, IPSTATS_MIB_OUTNOROUTES);
976 dst_release(*dst);
977 *dst = NULL;
978 return err;
979 }
980
981 /**
982 * ip6_dst_lookup - perform route lookup on flow
983 * @sk: socket which provides route info
984 * @dst: pointer to dst_entry * for result
985 * @fl6: flow to lookup
986 *
987 * This function performs a route lookup on the given flow.
988 *
989 * It returns zero on success, or a standard errno code on error.
990 */
991 int ip6_dst_lookup(struct sock *sk, struct dst_entry **dst, struct flowi6 *fl6)
992 {
993 *dst = NULL;
994 return ip6_dst_lookup_tail(sk, dst, fl6);
995 }
996 EXPORT_SYMBOL_GPL(ip6_dst_lookup);
997
998 /**
999 * ip6_dst_lookup_flow - perform route lookup on flow with ipsec
1000 * @sk: socket which provides route info
1001 * @fl6: flow to lookup
1002 * @final_dst: final destination address for ipsec lookup
1003 *
1004 * This function performs a route lookup on the given flow.
1005 *
1006 * It returns a valid dst pointer on success, or a pointer encoded
1007 * error code.
1008 */
1009 struct dst_entry *ip6_dst_lookup_flow(struct sock *sk, struct flowi6 *fl6,
1010 const struct in6_addr *final_dst)
1011 {
1012 struct dst_entry *dst = NULL;
1013 int err;
1014
1015 err = ip6_dst_lookup_tail(sk, &dst, fl6);
1016 if (err)
1017 return ERR_PTR(err);
1018 if (final_dst)
1019 fl6->daddr = *final_dst;
1020
1021 return xfrm_lookup_route(sock_net(sk), dst, flowi6_to_flowi(fl6), sk, 0);
1022 }
1023 EXPORT_SYMBOL_GPL(ip6_dst_lookup_flow);
1024
1025 /**
1026 * ip6_sk_dst_lookup_flow - perform socket cached route lookup on flow
1027 * @sk: socket which provides the dst cache and route info
1028 * @fl6: flow to lookup
1029 * @final_dst: final destination address for ipsec lookup
1030 *
1031 * This function performs a route lookup on the given flow with the
1032 * possibility of using the cached route in the socket if it is valid.
1033 * It will take the socket dst lock when operating on the dst cache.
1034 * As a result, this function can only be used in process context.
1035 *
1036 * It returns a valid dst pointer on success, or a pointer encoded
1037 * error code.
1038 */
1039 struct dst_entry *ip6_sk_dst_lookup_flow(struct sock *sk, struct flowi6 *fl6,
1040 const struct in6_addr *final_dst)
1041 {
1042 struct dst_entry *dst = sk_dst_check(sk, inet6_sk(sk)->dst_cookie);
1043 int err;
1044
1045 dst = ip6_sk_dst_check(sk, dst, fl6);
1046
1047 err = ip6_dst_lookup_tail(sk, &dst, fl6);
1048 if (err)
1049 return ERR_PTR(err);
1050 if (final_dst)
1051 fl6->daddr = *final_dst;
1052
1053 return xfrm_lookup_route(sock_net(sk), dst, flowi6_to_flowi(fl6), sk, 0);
1054 }
1055 EXPORT_SYMBOL_GPL(ip6_sk_dst_lookup_flow);
1056
1057 static inline int ip6_ufo_append_data(struct sock *sk,
1058 struct sk_buff_head *queue,
1059 int getfrag(void *from, char *to, int offset, int len,
1060 int odd, struct sk_buff *skb),
1061 void *from, int length, int hh_len, int fragheaderlen,
1062 int transhdrlen, int mtu, unsigned int flags,
1063 struct rt6_info *rt)
1064
1065 {
1066 struct sk_buff *skb;
1067 struct frag_hdr fhdr;
1068 int err;
1069
1070 /* There is support for UDP large send offload by network
1071 * device, so create one single skb packet containing complete
1072 * udp datagram
1073 */
1074 skb = skb_peek_tail(queue);
1075 if (!skb) {
1076 skb = sock_alloc_send_skb(sk,
1077 hh_len + fragheaderlen + transhdrlen + 20,
1078 (flags & MSG_DONTWAIT), &err);
1079 if (!skb)
1080 return err;
1081
1082 /* reserve space for Hardware header */
1083 skb_reserve(skb, hh_len);
1084
1085 /* create space for UDP/IP header */
1086 skb_put(skb, fragheaderlen + transhdrlen);
1087
1088 /* initialize network header pointer */
1089 skb_reset_network_header(skb);
1090
1091 /* initialize protocol header pointer */
1092 skb->transport_header = skb->network_header + fragheaderlen;
1093
1094 skb->protocol = htons(ETH_P_IPV6);
1095 skb->csum = 0;
1096
1097 __skb_queue_tail(queue, skb);
1098 } else if (skb_is_gso(skb)) {
1099 goto append;
1100 }
1101
1102 skb->ip_summed = CHECKSUM_PARTIAL;
1103 /* Specify the length of each IPv6 datagram fragment.
1104 * It has to be a multiple of 8.
1105 */
1106 skb_shinfo(skb)->gso_size = (mtu - fragheaderlen -
1107 sizeof(struct frag_hdr)) & ~7;
1108 skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
1109 ipv6_select_ident(sock_net(sk), &fhdr, rt);
1110 skb_shinfo(skb)->ip6_frag_id = fhdr.identification;
1111
1112 append:
1113 return skb_append_datato_frags(sk, skb, getfrag, from,
1114 (length - transhdrlen));
1115 }
1116
1117 static inline struct ipv6_opt_hdr *ip6_opt_dup(struct ipv6_opt_hdr *src,
1118 gfp_t gfp)
1119 {
1120 return src ? kmemdup(src, (src->hdrlen + 1) * 8, gfp) : NULL;
1121 }
1122
1123 static inline struct ipv6_rt_hdr *ip6_rthdr_dup(struct ipv6_rt_hdr *src,
1124 gfp_t gfp)
1125 {
1126 return src ? kmemdup(src, (src->hdrlen + 1) * 8, gfp) : NULL;
1127 }
1128
1129 static void ip6_append_data_mtu(unsigned int *mtu,
1130 int *maxfraglen,
1131 unsigned int fragheaderlen,
1132 struct sk_buff *skb,
1133 struct rt6_info *rt,
1134 unsigned int orig_mtu)
1135 {
1136 if (!(rt->dst.flags & DST_XFRM_TUNNEL)) {
1137 if (!skb) {
1138 /* first fragment, reserve header_len */
1139 *mtu = orig_mtu - rt->dst.header_len;
1140
1141 } else {
1142 /*
1143 * this fragment is not first, the headers
1144 * space is regarded as data space.
1145 */
1146 *mtu = orig_mtu;
1147 }
1148 *maxfraglen = ((*mtu - fragheaderlen) & ~7)
1149 + fragheaderlen - sizeof(struct frag_hdr);
1150 }
1151 }
1152
1153 static int ip6_setup_cork(struct sock *sk, struct inet_cork_full *cork,
1154 struct inet6_cork *v6_cork,
1155 int hlimit, int tclass, struct ipv6_txoptions *opt,
1156 struct rt6_info *rt, struct flowi6 *fl6)
1157 {
1158 struct ipv6_pinfo *np = inet6_sk(sk);
1159 unsigned int mtu;
1160
1161 /*
1162 * setup for corking
1163 */
1164 if (opt) {
1165 if (WARN_ON(v6_cork->opt))
1166 return -EINVAL;
1167
1168 v6_cork->opt = kzalloc(opt->tot_len, sk->sk_allocation);
1169 if (unlikely(!v6_cork->opt))
1170 return -ENOBUFS;
1171
1172 v6_cork->opt->tot_len = opt->tot_len;
1173 v6_cork->opt->opt_flen = opt->opt_flen;
1174 v6_cork->opt->opt_nflen = opt->opt_nflen;
1175
1176 v6_cork->opt->dst0opt = ip6_opt_dup(opt->dst0opt,
1177 sk->sk_allocation);
1178 if (opt->dst0opt && !v6_cork->opt->dst0opt)
1179 return -ENOBUFS;
1180
1181 v6_cork->opt->dst1opt = ip6_opt_dup(opt->dst1opt,
1182 sk->sk_allocation);
1183 if (opt->dst1opt && !v6_cork->opt->dst1opt)
1184 return -ENOBUFS;
1185
1186 v6_cork->opt->hopopt = ip6_opt_dup(opt->hopopt,
1187 sk->sk_allocation);
1188 if (opt->hopopt && !v6_cork->opt->hopopt)
1189 return -ENOBUFS;
1190
1191 v6_cork->opt->srcrt = ip6_rthdr_dup(opt->srcrt,
1192 sk->sk_allocation);
1193 if (opt->srcrt && !v6_cork->opt->srcrt)
1194 return -ENOBUFS;
1195
1196 /* need source address above miyazawa*/
1197 }
1198 dst_hold(&rt->dst);
1199 cork->base.dst = &rt->dst;
1200 cork->fl.u.ip6 = *fl6;
1201 v6_cork->hop_limit = hlimit;
1202 v6_cork->tclass = tclass;
1203 if (rt->dst.flags & DST_XFRM_TUNNEL)
1204 mtu = np->pmtudisc >= IPV6_PMTUDISC_PROBE ?
1205 rt->dst.dev->mtu : dst_mtu(&rt->dst);
1206 else
1207 mtu = np->pmtudisc >= IPV6_PMTUDISC_PROBE ?
1208 rt->dst.dev->mtu : dst_mtu(rt->dst.path);
1209 if (np->frag_size < mtu) {
1210 if (np->frag_size)
1211 mtu = np->frag_size;
1212 }
1213 cork->base.fragsize = mtu;
1214 if (dst_allfrag(rt->dst.path))
1215 cork->base.flags |= IPCORK_ALLFRAG;
1216 cork->base.length = 0;
1217
1218 return 0;
1219 }
1220
1221 static int __ip6_append_data(struct sock *sk,
1222 struct flowi6 *fl6,
1223 struct sk_buff_head *queue,
1224 struct inet_cork *cork,
1225 struct inet6_cork *v6_cork,
1226 struct page_frag *pfrag,
1227 int getfrag(void *from, char *to, int offset,
1228 int len, int odd, struct sk_buff *skb),
1229 void *from, int length, int transhdrlen,
1230 unsigned int flags, int dontfrag)
1231 {
1232 struct sk_buff *skb, *skb_prev = NULL;
1233 unsigned int maxfraglen, fragheaderlen, mtu, orig_mtu;
1234 int exthdrlen = 0;
1235 int dst_exthdrlen = 0;
1236 int hh_len;
1237 int copy;
1238 int err;
1239 int offset = 0;
1240 __u8 tx_flags = 0;
1241 u32 tskey = 0;
1242 struct rt6_info *rt = (struct rt6_info *)cork->dst;
1243 struct ipv6_txoptions *opt = v6_cork->opt;
1244 int csummode = CHECKSUM_NONE;
1245
1246 skb = skb_peek_tail(queue);
1247 if (!skb) {
1248 exthdrlen = opt ? opt->opt_flen : 0;
1249 dst_exthdrlen = rt->dst.header_len - rt->rt6i_nfheader_len;
1250 }
1251
1252 mtu = cork->fragsize;
1253 orig_mtu = mtu;
1254
1255 hh_len = LL_RESERVED_SPACE(rt->dst.dev);
1256
1257 fragheaderlen = sizeof(struct ipv6hdr) + rt->rt6i_nfheader_len +
1258 (opt ? opt->opt_nflen : 0);
1259 maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen -
1260 sizeof(struct frag_hdr);
1261
1262 if (mtu <= sizeof(struct ipv6hdr) + IPV6_MAXPLEN) {
1263 unsigned int maxnonfragsize, headersize;
1264
1265 headersize = sizeof(struct ipv6hdr) +
1266 (opt ? opt->opt_flen + opt->opt_nflen : 0) +
1267 (dst_allfrag(&rt->dst) ?
1268 sizeof(struct frag_hdr) : 0) +
1269 rt->rt6i_nfheader_len;
1270
1271 if (ip6_sk_ignore_df(sk))
1272 maxnonfragsize = sizeof(struct ipv6hdr) + IPV6_MAXPLEN;
1273 else
1274 maxnonfragsize = mtu;
1275
1276 /* dontfrag active */
1277 if ((cork->length + length > mtu - headersize) && dontfrag &&
1278 (sk->sk_protocol == IPPROTO_UDP ||
1279 sk->sk_protocol == IPPROTO_RAW)) {
1280 ipv6_local_rxpmtu(sk, fl6, mtu - headersize +
1281 sizeof(struct ipv6hdr));
1282 goto emsgsize;
1283 }
1284
1285 if (cork->length + length > maxnonfragsize - headersize) {
1286 emsgsize:
1287 ipv6_local_error(sk, EMSGSIZE, fl6,
1288 mtu - headersize +
1289 sizeof(struct ipv6hdr));
1290 return -EMSGSIZE;
1291 }
1292 }
1293
1294 if (sk->sk_type == SOCK_DGRAM || sk->sk_type == SOCK_RAW) {
1295 sock_tx_timestamp(sk, &tx_flags);
1296 if (tx_flags & SKBTX_ANY_SW_TSTAMP &&
1297 sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID)
1298 tskey = sk->sk_tskey++;
1299 }
1300
1301 /* If this is the first and only packet and device
1302 * supports checksum offloading, let's use it.
1303 * Use transhdrlen, same as IPv4, because partial
1304 * sums only work when transhdrlen is set.
1305 */
1306 if (transhdrlen && sk->sk_protocol == IPPROTO_UDP &&
1307 length + fragheaderlen < mtu &&
1308 rt->dst.dev->features & NETIF_F_V6_CSUM &&
1309 !exthdrlen)
1310 csummode = CHECKSUM_PARTIAL;
1311 /*
1312 * Let's try using as much space as possible.
1313 * Use MTU if total length of the message fits into the MTU.
1314 * Otherwise, we need to reserve fragment header and
1315 * fragment alignment (= 8-15 octects, in total).
1316 *
1317 * Note that we may need to "move" the data from the tail of
1318 * of the buffer to the new fragment when we split
1319 * the message.
1320 *
1321 * FIXME: It may be fragmented into multiple chunks
1322 * at once if non-fragmentable extension headers
1323 * are too large.
1324 * --yoshfuji
1325 */
1326
1327 cork->length += length;
1328 if (((length > mtu) ||
1329 (skb && skb_is_gso(skb))) &&
1330 (sk->sk_protocol == IPPROTO_UDP) &&
1331 (rt->dst.dev->features & NETIF_F_UFO) &&
1332 (sk->sk_type == SOCK_DGRAM)) {
1333 err = ip6_ufo_append_data(sk, queue, getfrag, from, length,
1334 hh_len, fragheaderlen,
1335 transhdrlen, mtu, flags, rt);
1336 if (err)
1337 goto error;
1338 return 0;
1339 }
1340
1341 if (!skb)
1342 goto alloc_new_skb;
1343
1344 while (length > 0) {
1345 /* Check if the remaining data fits into current packet. */
1346 copy = (cork->length <= mtu && !(cork->flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - skb->len;
1347 if (copy < length)
1348 copy = maxfraglen - skb->len;
1349
1350 if (copy <= 0) {
1351 char *data;
1352 unsigned int datalen;
1353 unsigned int fraglen;
1354 unsigned int fraggap;
1355 unsigned int alloclen;
1356 alloc_new_skb:
1357 /* There's no room in the current skb */
1358 if (skb)
1359 fraggap = skb->len - maxfraglen;
1360 else
1361 fraggap = 0;
1362 /* update mtu and maxfraglen if necessary */
1363 if (!skb || !skb_prev)
1364 ip6_append_data_mtu(&mtu, &maxfraglen,
1365 fragheaderlen, skb, rt,
1366 orig_mtu);
1367
1368 skb_prev = skb;
1369
1370 /*
1371 * If remaining data exceeds the mtu,
1372 * we know we need more fragment(s).
1373 */
1374 datalen = length + fraggap;
1375
1376 if (datalen > (cork->length <= mtu && !(cork->flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - fragheaderlen)
1377 datalen = maxfraglen - fragheaderlen - rt->dst.trailer_len;
1378 if ((flags & MSG_MORE) &&
1379 !(rt->dst.dev->features&NETIF_F_SG))
1380 alloclen = mtu;
1381 else
1382 alloclen = datalen + fragheaderlen;
1383
1384 alloclen += dst_exthdrlen;
1385
1386 if (datalen != length + fraggap) {
1387 /*
1388 * this is not the last fragment, the trailer
1389 * space is regarded as data space.
1390 */
1391 datalen += rt->dst.trailer_len;
1392 }
1393
1394 alloclen += rt->dst.trailer_len;
1395 fraglen = datalen + fragheaderlen;
1396
1397 /*
1398 * We just reserve space for fragment header.
1399 * Note: this may be overallocation if the message
1400 * (without MSG_MORE) fits into the MTU.
1401 */
1402 alloclen += sizeof(struct frag_hdr);
1403
1404 if (transhdrlen) {
1405 skb = sock_alloc_send_skb(sk,
1406 alloclen + hh_len,
1407 (flags & MSG_DONTWAIT), &err);
1408 } else {
1409 skb = NULL;
1410 if (atomic_read(&sk->sk_wmem_alloc) <=
1411 2 * sk->sk_sndbuf)
1412 skb = sock_wmalloc(sk,
1413 alloclen + hh_len, 1,
1414 sk->sk_allocation);
1415 if (unlikely(!skb))
1416 err = -ENOBUFS;
1417 }
1418 if (!skb)
1419 goto error;
1420 /*
1421 * Fill in the control structures
1422 */
1423 skb->protocol = htons(ETH_P_IPV6);
1424 skb->ip_summed = csummode;
1425 skb->csum = 0;
1426 /* reserve for fragmentation and ipsec header */
1427 skb_reserve(skb, hh_len + sizeof(struct frag_hdr) +
1428 dst_exthdrlen);
1429
1430 /* Only the initial fragment is time stamped */
1431 skb_shinfo(skb)->tx_flags = tx_flags;
1432 tx_flags = 0;
1433 skb_shinfo(skb)->tskey = tskey;
1434 tskey = 0;
1435
1436 /*
1437 * Find where to start putting bytes
1438 */
1439 data = skb_put(skb, fraglen);
1440 skb_set_network_header(skb, exthdrlen);
1441 data += fragheaderlen;
1442 skb->transport_header = (skb->network_header +
1443 fragheaderlen);
1444 if (fraggap) {
1445 skb->csum = skb_copy_and_csum_bits(
1446 skb_prev, maxfraglen,
1447 data + transhdrlen, fraggap, 0);
1448 skb_prev->csum = csum_sub(skb_prev->csum,
1449 skb->csum);
1450 data += fraggap;
1451 pskb_trim_unique(skb_prev, maxfraglen);
1452 }
1453 copy = datalen - transhdrlen - fraggap;
1454
1455 if (copy < 0) {
1456 err = -EINVAL;
1457 kfree_skb(skb);
1458 goto error;
1459 } else if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) {
1460 err = -EFAULT;
1461 kfree_skb(skb);
1462 goto error;
1463 }
1464
1465 offset += copy;
1466 length -= datalen - fraggap;
1467 transhdrlen = 0;
1468 exthdrlen = 0;
1469 dst_exthdrlen = 0;
1470
1471 /*
1472 * Put the packet on the pending queue
1473 */
1474 __skb_queue_tail(queue, skb);
1475 continue;
1476 }
1477
1478 if (copy > length)
1479 copy = length;
1480
1481 if (!(rt->dst.dev->features&NETIF_F_SG)) {
1482 unsigned int off;
1483
1484 off = skb->len;
1485 if (getfrag(from, skb_put(skb, copy),
1486 offset, copy, off, skb) < 0) {
1487 __skb_trim(skb, off);
1488 err = -EFAULT;
1489 goto error;
1490 }
1491 } else {
1492 int i = skb_shinfo(skb)->nr_frags;
1493
1494 err = -ENOMEM;
1495 if (!sk_page_frag_refill(sk, pfrag))
1496 goto error;
1497
1498 if (!skb_can_coalesce(skb, i, pfrag->page,
1499 pfrag->offset)) {
1500 err = -EMSGSIZE;
1501 if (i == MAX_SKB_FRAGS)
1502 goto error;
1503
1504 __skb_fill_page_desc(skb, i, pfrag->page,
1505 pfrag->offset, 0);
1506 skb_shinfo(skb)->nr_frags = ++i;
1507 get_page(pfrag->page);
1508 }
1509 copy = min_t(int, copy, pfrag->size - pfrag->offset);
1510 if (getfrag(from,
1511 page_address(pfrag->page) + pfrag->offset,
1512 offset, copy, skb->len, skb) < 0)
1513 goto error_efault;
1514
1515 pfrag->offset += copy;
1516 skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy);
1517 skb->len += copy;
1518 skb->data_len += copy;
1519 skb->truesize += copy;
1520 atomic_add(copy, &sk->sk_wmem_alloc);
1521 }
1522 offset += copy;
1523 length -= copy;
1524 }
1525
1526 return 0;
1527
1528 error_efault:
1529 err = -EFAULT;
1530 error:
1531 cork->length -= length;
1532 IP6_INC_STATS(sock_net(sk), rt->rt6i_idev, IPSTATS_MIB_OUTDISCARDS);
1533 return err;
1534 }
1535
1536 int ip6_append_data(struct sock *sk,
1537 int getfrag(void *from, char *to, int offset, int len,
1538 int odd, struct sk_buff *skb),
1539 void *from, int length, int transhdrlen, int hlimit,
1540 int tclass, struct ipv6_txoptions *opt, struct flowi6 *fl6,
1541 struct rt6_info *rt, unsigned int flags, int dontfrag)
1542 {
1543 struct inet_sock *inet = inet_sk(sk);
1544 struct ipv6_pinfo *np = inet6_sk(sk);
1545 int exthdrlen;
1546 int err;
1547
1548 if (flags&MSG_PROBE)
1549 return 0;
1550 if (skb_queue_empty(&sk->sk_write_queue)) {
1551 /*
1552 * setup for corking
1553 */
1554 err = ip6_setup_cork(sk, &inet->cork, &np->cork, hlimit,
1555 tclass, opt, rt, fl6);
1556 if (err)
1557 return err;
1558
1559 exthdrlen = (opt ? opt->opt_flen : 0);
1560 length += exthdrlen;
1561 transhdrlen += exthdrlen;
1562 } else {
1563 fl6 = &inet->cork.fl.u.ip6;
1564 transhdrlen = 0;
1565 }
1566
1567 return __ip6_append_data(sk, fl6, &sk->sk_write_queue, &inet->cork.base,
1568 &np->cork, sk_page_frag(sk), getfrag,
1569 from, length, transhdrlen, flags, dontfrag);
1570 }
1571 EXPORT_SYMBOL_GPL(ip6_append_data);
1572
1573 static void ip6_cork_release(struct inet_cork_full *cork,
1574 struct inet6_cork *v6_cork)
1575 {
1576 if (v6_cork->opt) {
1577 kfree(v6_cork->opt->dst0opt);
1578 kfree(v6_cork->opt->dst1opt);
1579 kfree(v6_cork->opt->hopopt);
1580 kfree(v6_cork->opt->srcrt);
1581 kfree(v6_cork->opt);
1582 v6_cork->opt = NULL;
1583 }
1584
1585 if (cork->base.dst) {
1586 dst_release(cork->base.dst);
1587 cork->base.dst = NULL;
1588 cork->base.flags &= ~IPCORK_ALLFRAG;
1589 }
1590 memset(&cork->fl, 0, sizeof(cork->fl));
1591 }
1592
1593 struct sk_buff *__ip6_make_skb(struct sock *sk,
1594 struct sk_buff_head *queue,
1595 struct inet_cork_full *cork,
1596 struct inet6_cork *v6_cork)
1597 {
1598 struct sk_buff *skb, *tmp_skb;
1599 struct sk_buff **tail_skb;
1600 struct in6_addr final_dst_buf, *final_dst = &final_dst_buf;
1601 struct ipv6_pinfo *np = inet6_sk(sk);
1602 struct net *net = sock_net(sk);
1603 struct ipv6hdr *hdr;
1604 struct ipv6_txoptions *opt = v6_cork->opt;
1605 struct rt6_info *rt = (struct rt6_info *)cork->base.dst;
1606 struct flowi6 *fl6 = &cork->fl.u.ip6;
1607 unsigned char proto = fl6->flowi6_proto;
1608
1609 skb = __skb_dequeue(queue);
1610 if (!skb)
1611 goto out;
1612 tail_skb = &(skb_shinfo(skb)->frag_list);
1613
1614 /* move skb->data to ip header from ext header */
1615 if (skb->data < skb_network_header(skb))
1616 __skb_pull(skb, skb_network_offset(skb));
1617 while ((tmp_skb = __skb_dequeue(queue)) != NULL) {
1618 __skb_pull(tmp_skb, skb_network_header_len(skb));
1619 *tail_skb = tmp_skb;
1620 tail_skb = &(tmp_skb->next);
1621 skb->len += tmp_skb->len;
1622 skb->data_len += tmp_skb->len;
1623 skb->truesize += tmp_skb->truesize;
1624 tmp_skb->destructor = NULL;
1625 tmp_skb->sk = NULL;
1626 }
1627
1628 /* Allow local fragmentation. */
1629 skb->ignore_df = ip6_sk_ignore_df(sk);
1630
1631 *final_dst = fl6->daddr;
1632 __skb_pull(skb, skb_network_header_len(skb));
1633 if (opt && opt->opt_flen)
1634 ipv6_push_frag_opts(skb, opt, &proto);
1635 if (opt && opt->opt_nflen)
1636 ipv6_push_nfrag_opts(skb, opt, &proto, &final_dst);
1637
1638 skb_push(skb, sizeof(struct ipv6hdr));
1639 skb_reset_network_header(skb);
1640 hdr = ipv6_hdr(skb);
1641
1642 ip6_flow_hdr(hdr, v6_cork->tclass,
1643 ip6_make_flowlabel(net, skb, fl6->flowlabel,
1644 np->autoflowlabel));
1645 hdr->hop_limit = v6_cork->hop_limit;
1646 hdr->nexthdr = proto;
1647 hdr->saddr = fl6->saddr;
1648 hdr->daddr = *final_dst;
1649
1650 skb->priority = sk->sk_priority;
1651 skb->mark = sk->sk_mark;
1652
1653 skb_dst_set(skb, dst_clone(&rt->dst));
1654 IP6_UPD_PO_STATS(net, rt->rt6i_idev, IPSTATS_MIB_OUT, skb->len);
1655 if (proto == IPPROTO_ICMPV6) {
1656 struct inet6_dev *idev = ip6_dst_idev(skb_dst(skb));
1657
1658 ICMP6MSGOUT_INC_STATS(net, idev, icmp6_hdr(skb)->icmp6_type);
1659 ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTMSGS);
1660 }
1661
1662 ip6_cork_release(cork, v6_cork);
1663 out:
1664 return skb;
1665 }
1666
1667 int ip6_send_skb(struct sk_buff *skb)
1668 {
1669 struct net *net = sock_net(skb->sk);
1670 struct rt6_info *rt = (struct rt6_info *)skb_dst(skb);
1671 int err;
1672
1673 err = ip6_local_out(skb);
1674 if (err) {
1675 if (err > 0)
1676 err = net_xmit_errno(err);
1677 if (err)
1678 IP6_INC_STATS(net, rt->rt6i_idev,
1679 IPSTATS_MIB_OUTDISCARDS);
1680 }
1681
1682 return err;
1683 }
1684
1685 int ip6_push_pending_frames(struct sock *sk)
1686 {
1687 struct sk_buff *skb;
1688
1689 skb = ip6_finish_skb(sk);
1690 if (!skb)
1691 return 0;
1692
1693 return ip6_send_skb(skb);
1694 }
1695 EXPORT_SYMBOL_GPL(ip6_push_pending_frames);
1696
1697 static void __ip6_flush_pending_frames(struct sock *sk,
1698 struct sk_buff_head *queue,
1699 struct inet_cork_full *cork,
1700 struct inet6_cork *v6_cork)
1701 {
1702 struct sk_buff *skb;
1703
1704 while ((skb = __skb_dequeue_tail(queue)) != NULL) {
1705 if (skb_dst(skb))
1706 IP6_INC_STATS(sock_net(sk), ip6_dst_idev(skb_dst(skb)),
1707 IPSTATS_MIB_OUTDISCARDS);
1708 kfree_skb(skb);
1709 }
1710
1711 ip6_cork_release(cork, v6_cork);
1712 }
1713
1714 void ip6_flush_pending_frames(struct sock *sk)
1715 {
1716 __ip6_flush_pending_frames(sk, &sk->sk_write_queue,
1717 &inet_sk(sk)->cork, &inet6_sk(sk)->cork);
1718 }
1719 EXPORT_SYMBOL_GPL(ip6_flush_pending_frames);
1720
1721 struct sk_buff *ip6_make_skb(struct sock *sk,
1722 int getfrag(void *from, char *to, int offset,
1723 int len, int odd, struct sk_buff *skb),
1724 void *from, int length, int transhdrlen,
1725 int hlimit, int tclass,
1726 struct ipv6_txoptions *opt, struct flowi6 *fl6,
1727 struct rt6_info *rt, unsigned int flags,
1728 int dontfrag)
1729 {
1730 struct inet_cork_full cork;
1731 struct inet6_cork v6_cork;
1732 struct sk_buff_head queue;
1733 int exthdrlen = (opt ? opt->opt_flen : 0);
1734 int err;
1735
1736 if (flags & MSG_PROBE)
1737 return NULL;
1738
1739 __skb_queue_head_init(&queue);
1740
1741 cork.base.flags = 0;
1742 cork.base.addr = 0;
1743 cork.base.opt = NULL;
1744 v6_cork.opt = NULL;
1745 err = ip6_setup_cork(sk, &cork, &v6_cork, hlimit, tclass, opt, rt, fl6);
1746 if (err)
1747 return ERR_PTR(err);
1748
1749 if (dontfrag < 0)
1750 dontfrag = inet6_sk(sk)->dontfrag;
1751
1752 err = __ip6_append_data(sk, fl6, &queue, &cork.base, &v6_cork,
1753 &current->task_frag, getfrag, from,
1754 length + exthdrlen, transhdrlen + exthdrlen,
1755 flags, dontfrag);
1756 if (err) {
1757 __ip6_flush_pending_frames(sk, &queue, &cork, &v6_cork);
1758 return ERR_PTR(err);
1759 }
1760
1761 return __ip6_make_skb(sk, &queue, &cork, &v6_cork);
1762 }
Linux with added FPC-III support