projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge tag 'v3.10.90' into update
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / ipv6 / datagram.c
1 /*
2 * common UDP/RAW code
3 * Linux INET6 implementation
4 *
5 * Authors:
6 * Pedro Roque <roque@di.fc.ul.pt>
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * as published by the Free Software Foundation; either version
11 * 2 of the License, or (at your option) any later version.
12 */
13
14 #include <linux/capability.h>
15 #include <linux/errno.h>
16 #include <linux/types.h>
17 #include <linux/kernel.h>
18 #include <linux/interrupt.h>
19 #include <linux/socket.h>
20 #include <linux/sockios.h>
21 #include <linux/in6.h>
22 #include <linux/ipv6.h>
23 #include <linux/route.h>
24 #include <linux/slab.h>
25 #include <linux/export.h>
26
27 #include <net/ipv6.h>
28 #include <net/ndisc.h>
29 #include <net/addrconf.h>
30 #include <net/transp_v6.h>
31 #include <net/ip6_route.h>
32 #include <net/tcp_states.h>
33 #include <net/dsfield.h>
34
35 #include <linux/errqueue.h>
36 #include <asm/uaccess.h>
37
38 static bool ipv6_mapped_addr_any(const struct in6_addr *a)
39 {
40 return ipv6_addr_v4mapped(a) && (a->s6_addr32[3] == 0);
41 }
42
43 static int __ip6_datagram_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len)
44 {
45 struct sockaddr_in6 *usin = (struct sockaddr_in6 *) uaddr;
46 struct inet_sock *inet = inet_sk(sk);
47 struct ipv6_pinfo *np = inet6_sk(sk);
48 struct in6_addr *daddr, *final_p, final;
49 struct dst_entry *dst;
50 struct flowi6 fl6;
51 struct ip6_flowlabel *flowlabel = NULL;
52 struct ipv6_txoptions *opt;
53 int addr_type;
54 int err;
55
56 if (usin->sin6_family == AF_INET) {
57 if (__ipv6_only_sock(sk))
58 return -EAFNOSUPPORT;
59 err = __ip4_datagram_connect(sk, uaddr, addr_len);
60 goto ipv4_connected;
61 }
62
63 if (addr_len < SIN6_LEN_RFC2133)
64 return -EINVAL;
65
66 if (usin->sin6_family != AF_INET6)
67 return -EAFNOSUPPORT;
68
69 memset(&fl6, 0, sizeof(fl6));
70 if (np->sndflow) {
71 fl6.flowlabel = usin->sin6_flowinfo&IPV6_FLOWINFO_MASK;
72 if (fl6.flowlabel&IPV6_FLOWLABEL_MASK) {
73 flowlabel = fl6_sock_lookup(sk, fl6.flowlabel);
74 if (flowlabel == NULL)
75 return -EINVAL;
76 usin->sin6_addr = flowlabel->dst;
77 }
78 }
79
80 addr_type = ipv6_addr_type(&usin->sin6_addr);
81
82 if (addr_type == IPV6_ADDR_ANY) {
83 /*
84 * connect to self
85 */
86 usin->sin6_addr.s6_addr[15] = 0x01;
87 }
88
89 daddr = &usin->sin6_addr;
90
91 if (addr_type == IPV6_ADDR_MAPPED) {
92 struct sockaddr_in sin;
93
94 if (__ipv6_only_sock(sk)) {
95 err = -ENETUNREACH;
96 goto out;
97 }
98 sin.sin_family = AF_INET;
99 sin.sin_addr.s_addr = daddr->s6_addr32[3];
100 sin.sin_port = usin->sin6_port;
101
102 err = __ip4_datagram_connect(sk,
103 (struct sockaddr *) &sin,
104 sizeof(sin));
105
106 ipv4_connected:
107 if (err)
108 goto out;
109
110 ipv6_addr_set_v4mapped(inet->inet_daddr, &np->daddr);
111
112 if (ipv6_addr_any(&np->saddr) ||
113 ipv6_mapped_addr_any(&np->saddr))
114 ipv6_addr_set_v4mapped(inet->inet_saddr, &np->saddr);
115
116 if (ipv6_addr_any(&np->rcv_saddr) ||
117 ipv6_mapped_addr_any(&np->rcv_saddr)) {
118 ipv6_addr_set_v4mapped(inet->inet_rcv_saddr,
119 &np->rcv_saddr);
120 if (sk->sk_prot->rehash)
121 sk->sk_prot->rehash(sk);
122 }
123
124 goto out;
125 }
126
127 if (__ipv6_addr_needs_scope_id(addr_type)) {
128 if (addr_len >= sizeof(struct sockaddr_in6) &&
129 usin->sin6_scope_id) {
130 if (sk->sk_bound_dev_if &&
131 sk->sk_bound_dev_if != usin->sin6_scope_id) {
132 err = -EINVAL;
133 goto out;
134 }
135 sk->sk_bound_dev_if = usin->sin6_scope_id;
136 }
137
138 if (!sk->sk_bound_dev_if && (addr_type & IPV6_ADDR_MULTICAST))
139 sk->sk_bound_dev_if = np->mcast_oif;
140
141 /* Connect to link-local address requires an interface */
142 if (!sk->sk_bound_dev_if) {
143 err = -EINVAL;
144 goto out;
145 }
146 }
147
148 np->daddr = *daddr;
149 np->flow_label = fl6.flowlabel;
150
151 inet->inet_dport = usin->sin6_port;
152
153 /*
154 * Check for a route to destination an obtain the
155 * destination cache for it.
156 */
157
158 fl6.flowi6_proto = sk->sk_protocol;
159 fl6.daddr = np->daddr;
160 fl6.saddr = np->saddr;
161 fl6.flowi6_oif = sk->sk_bound_dev_if;
162 fl6.flowi6_mark = sk->sk_mark;
163 fl6.fl6_dport = inet->inet_dport;
164 fl6.fl6_sport = inet->inet_sport;
165 fl6.flowi6_uid = sock_i_uid(sk);
166
167 if (!fl6.flowi6_oif && (addr_type&IPV6_ADDR_MULTICAST))
168 fl6.flowi6_oif = np->mcast_oif;
169
170 security_sk_classify_flow(sk, flowi6_to_flowi(&fl6));
171
172 opt = flowlabel ? flowlabel->opt : np->opt;
173 final_p = fl6_update_dst(&fl6, opt, &final);
174
175 dst = ip6_dst_lookup_flow(sk, &fl6, final_p, true);
176 err = 0;
177 if (IS_ERR(dst)) {
178 err = PTR_ERR(dst);
179 goto out;
180 }
181
182 /* source address lookup done in ip6_dst_lookup */
183
184 if (ipv6_addr_any(&np->saddr))
185 np->saddr = fl6.saddr;
186
187 if (ipv6_addr_any(&np->rcv_saddr)) {
188 np->rcv_saddr = fl6.saddr;
189 inet->inet_rcv_saddr = LOOPBACK4_IPV6;
190 if (sk->sk_prot->rehash)
191 sk->sk_prot->rehash(sk);
192 }
193
194 ip6_dst_store(sk, dst,
195 ipv6_addr_equal(&fl6.daddr, &np->daddr) ?
196 &np->daddr : NULL,
197 #ifdef CONFIG_IPV6_SUBTREES
198 ipv6_addr_equal(&fl6.saddr, &np->saddr) ?
199 &np->saddr :
200 #endif
201 NULL);
202
203 sk->sk_state = TCP_ESTABLISHED;
204 out:
205 fl6_sock_release(flowlabel);
206 return err;
207 }
208
209 int ip6_datagram_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len)
210 {
211 int res;
212
213 lock_sock(sk);
214 res = __ip6_datagram_connect(sk, uaddr, addr_len);
215 release_sock(sk);
216 return res;
217 }
218 EXPORT_SYMBOL_GPL(ip6_datagram_connect);
219
220 void ipv6_icmp_error(struct sock *sk, struct sk_buff *skb, int err,
221 __be16 port, u32 info, u8 *payload)
222 {
223 struct ipv6_pinfo *np = inet6_sk(sk);
224 struct icmp6hdr *icmph = icmp6_hdr(skb);
225 struct sock_exterr_skb *serr;
226
227 if (!np->recverr)
228 return;
229
230 skb = skb_clone(skb, GFP_ATOMIC);
231 if (!skb)
232 return;
233
234 skb->protocol = htons(ETH_P_IPV6);
235
236 serr = SKB_EXT_ERR(skb);
237 serr->ee.ee_errno = err;
238 serr->ee.ee_origin = SO_EE_ORIGIN_ICMP6;
239 serr->ee.ee_type = icmph->icmp6_type;
240 serr->ee.ee_code = icmph->icmp6_code;
241 serr->ee.ee_pad = 0;
242 serr->ee.ee_info = info;
243 serr->ee.ee_data = 0;
244 serr->addr_offset = (u8 *)&(((struct ipv6hdr *)(icmph + 1))->daddr) -
245 skb_network_header(skb);
246 serr->port = port;
247
248 __skb_pull(skb, payload - skb->data);
249 skb_reset_transport_header(skb);
250
251 if (sock_queue_err_skb(sk, skb))
252 kfree_skb(skb);
253 }
254
255 void ipv6_local_error(struct sock *sk, int err, struct flowi6 *fl6, u32 info)
256 {
257 struct ipv6_pinfo *np = inet6_sk(sk);
258 struct sock_exterr_skb *serr;
259 struct ipv6hdr *iph;
260 struct sk_buff *skb;
261
262 if (!np->recverr)
263 return;
264
265 skb = alloc_skb(sizeof(struct ipv6hdr), GFP_ATOMIC);
266 if (!skb)
267 return;
268
269 skb->protocol = htons(ETH_P_IPV6);
270
271 skb_put(skb, sizeof(struct ipv6hdr));
272 skb_reset_network_header(skb);
273 iph = ipv6_hdr(skb);
274 iph->daddr = fl6->daddr;
275
276 serr = SKB_EXT_ERR(skb);
277 serr->ee.ee_errno = err;
278 serr->ee.ee_origin = SO_EE_ORIGIN_LOCAL;
279 serr->ee.ee_type = 0;
280 serr->ee.ee_code = 0;
281 serr->ee.ee_pad = 0;
282 serr->ee.ee_info = info;
283 serr->ee.ee_data = 0;
284 serr->addr_offset = (u8 *)&iph->daddr - skb_network_header(skb);
285 serr->port = fl6->fl6_dport;
286
287 __skb_pull(skb, skb_tail_pointer(skb) - skb->data);
288 skb_reset_transport_header(skb);
289
290 if (sock_queue_err_skb(sk, skb))
291 kfree_skb(skb);
292 }
293
294 void ipv6_local_rxpmtu(struct sock *sk, struct flowi6 *fl6, u32 mtu)
295 {
296 struct ipv6_pinfo *np = inet6_sk(sk);
297 struct ipv6hdr *iph;
298 struct sk_buff *skb;
299 struct ip6_mtuinfo *mtu_info;
300
301 if (!np->rxopt.bits.rxpmtu)
302 return;
303
304 skb = alloc_skb(sizeof(struct ipv6hdr), GFP_ATOMIC);
305 if (!skb)
306 return;
307
308 skb_put(skb, sizeof(struct ipv6hdr));
309 skb_reset_network_header(skb);
310 iph = ipv6_hdr(skb);
311 iph->daddr = fl6->daddr;
312
313 mtu_info = IP6CBMTU(skb);
314
315 mtu_info->ip6m_mtu = mtu;
316 mtu_info->ip6m_addr.sin6_family = AF_INET6;
317 mtu_info->ip6m_addr.sin6_port = 0;
318 mtu_info->ip6m_addr.sin6_flowinfo = 0;
319 mtu_info->ip6m_addr.sin6_scope_id = fl6->flowi6_oif;
320 mtu_info->ip6m_addr.sin6_addr = ipv6_hdr(skb)->daddr;
321
322 __skb_pull(skb, skb_tail_pointer(skb) - skb->data);
323 skb_reset_transport_header(skb);
324
325 skb = xchg(&np->rxpmtu, skb);
326 kfree_skb(skb);
327 }
328
329 /*
330 * Handle MSG_ERRQUEUE
331 */
332 int ipv6_recv_error(struct sock *sk, struct msghdr *msg, int len, int *addr_len)
333 {
334 struct ipv6_pinfo *np = inet6_sk(sk);
335 struct sock_exterr_skb *serr;
336 struct sk_buff *skb, *skb2;
337 struct sockaddr_in6 *sin;
338 struct {
339 struct sock_extended_err ee;
340 struct sockaddr_in6 offender;
341 } errhdr;
342 int err;
343 int copied;
344
345 err = -EAGAIN;
346 skb = skb_dequeue(&sk->sk_error_queue);
347 if (skb == NULL)
348 goto out;
349
350 copied = skb->len;
351 if (copied > len) {
352 msg->msg_flags |= MSG_TRUNC;
353 copied = len;
354 }
355 err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
356 if (err)
357 goto out_free_skb;
358
359 sock_recv_timestamp(msg, sk, skb);
360
361 serr = SKB_EXT_ERR(skb);
362
363 sin = (struct sockaddr_in6 *)msg->msg_name;
364 if (sin) {
365 const unsigned char *nh = skb_network_header(skb);
366 sin->sin6_family = AF_INET6;
367 sin->sin6_flowinfo = 0;
368 sin->sin6_port = serr->port;
369 if (skb->protocol == htons(ETH_P_IPV6)) {
370 const struct ipv6hdr *ip6h = container_of((struct in6_addr *)(nh + serr->addr_offset),
371 struct ipv6hdr, daddr);
372 sin->sin6_addr = ip6h->daddr;
373 if (np->sndflow)
374 sin->sin6_flowinfo = ip6_flowinfo(ip6h);
375 sin->sin6_scope_id =
376 ipv6_iface_scope_id(&sin->sin6_addr,
377 IP6CB(skb)->iif);
378 } else {
379 ipv6_addr_set_v4mapped(*(__be32 *)(nh + serr->addr_offset),
380 &sin->sin6_addr);
381 sin->sin6_scope_id = 0;
382 }
383 *addr_len = sizeof(*sin);
384 }
385
386 memcpy(&errhdr.ee, &serr->ee, sizeof(struct sock_extended_err));
387 sin = &errhdr.offender;
388 memset(sin, 0, sizeof(*sin));
389
390 if (serr->ee.ee_origin != SO_EE_ORIGIN_LOCAL) {
391 sin->sin6_family = AF_INET6;
392 if (skb->protocol == htons(ETH_P_IPV6)) {
393 sin->sin6_addr = ipv6_hdr(skb)->saddr;
394 if (np->rxopt.all)
395 ip6_datagram_recv_ctl(sk, msg, skb);
396 sin->sin6_scope_id =
397 ipv6_iface_scope_id(&sin->sin6_addr,
398 IP6CB(skb)->iif);
399 } else {
400 ipv6_addr_set_v4mapped(ip_hdr(skb)->saddr,
401 &sin->sin6_addr);
402 if (inet_sk(sk)->cmsg_flags)
403 ip_cmsg_recv(msg, skb);
404 }
405 }
406
407 put_cmsg(msg, SOL_IPV6, IPV6_RECVERR, sizeof(errhdr), &errhdr);
408
409 /* Now we could try to dump offended packet options */
410
411 msg->msg_flags |= MSG_ERRQUEUE;
412 err = copied;
413
414 /* Reset and regenerate socket error */
415 spin_lock_bh(&sk->sk_error_queue.lock);
416 sk->sk_err = 0;
417 if ((skb2 = skb_peek(&sk->sk_error_queue)) != NULL) {
418 sk->sk_err = SKB_EXT_ERR(skb2)->ee.ee_errno;
419 spin_unlock_bh(&sk->sk_error_queue.lock);
420 sk->sk_error_report(sk);
421 } else {
422 spin_unlock_bh(&sk->sk_error_queue.lock);
423 }
424
425 out_free_skb:
426 kfree_skb(skb);
427 out:
428 return err;
429 }
430 EXPORT_SYMBOL_GPL(ipv6_recv_error);
431
432 /*
433 * Handle IPV6_RECVPATHMTU
434 */
435 int ipv6_recv_rxpmtu(struct sock *sk, struct msghdr *msg, int len,
436 int *addr_len)
437 {
438 struct ipv6_pinfo *np = inet6_sk(sk);
439 struct sk_buff *skb;
440 struct sockaddr_in6 *sin;
441 struct ip6_mtuinfo mtu_info;
442 int err;
443 int copied;
444
445 err = -EAGAIN;
446 skb = xchg(&np->rxpmtu, NULL);
447 if (skb == NULL)
448 goto out;
449
450 copied = skb->len;
451 if (copied > len) {
452 msg->msg_flags |= MSG_TRUNC;
453 copied = len;
454 }
455 err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
456 if (err)
457 goto out_free_skb;
458
459 sock_recv_timestamp(msg, sk, skb);
460
461 memcpy(&mtu_info, IP6CBMTU(skb), sizeof(mtu_info));
462
463 sin = (struct sockaddr_in6 *)msg->msg_name;
464 if (sin) {
465 sin->sin6_family = AF_INET6;
466 sin->sin6_flowinfo = 0;
467 sin->sin6_port = 0;
468 sin->sin6_scope_id = mtu_info.ip6m_addr.sin6_scope_id;
469 sin->sin6_addr = mtu_info.ip6m_addr.sin6_addr;
470 *addr_len = sizeof(*sin);
471 }
472
473 put_cmsg(msg, SOL_IPV6, IPV6_PATHMTU, sizeof(mtu_info), &mtu_info);
474
475 err = copied;
476
477 out_free_skb:
478 kfree_skb(skb);
479 out:
480 return err;
481 }
482
483
484 int ip6_datagram_recv_ctl(struct sock *sk, struct msghdr *msg,
485 struct sk_buff *skb)
486 {
487 struct ipv6_pinfo *np = inet6_sk(sk);
488 struct inet6_skb_parm *opt = IP6CB(skb);
489 unsigned char *nh = skb_network_header(skb);
490
491 if (np->rxopt.bits.rxinfo) {
492 struct in6_pktinfo src_info;
493
494 src_info.ipi6_ifindex = opt->iif;
495 src_info.ipi6_addr = ipv6_hdr(skb)->daddr;
496 put_cmsg(msg, SOL_IPV6, IPV6_PKTINFO, sizeof(src_info), &src_info);
497 }
498
499 if (np->rxopt.bits.rxhlim) {
500 int hlim = ipv6_hdr(skb)->hop_limit;
501 put_cmsg(msg, SOL_IPV6, IPV6_HOPLIMIT, sizeof(hlim), &hlim);
502 }
503
504 if (np->rxopt.bits.rxtclass) {
505 int tclass = ipv6_get_dsfield(ipv6_hdr(skb));
506 put_cmsg(msg, SOL_IPV6, IPV6_TCLASS, sizeof(tclass), &tclass);
507 }
508
509 if (np->rxopt.bits.rxflow) {
510 __be32 flowinfo = ip6_flowinfo((struct ipv6hdr *)nh);
511 if (flowinfo)
512 put_cmsg(msg, SOL_IPV6, IPV6_FLOWINFO, sizeof(flowinfo), &flowinfo);
513 }
514
515 /* HbH is allowed only once */
516 if (np->rxopt.bits.hopopts && opt->hop) {
517 u8 *ptr = nh + opt->hop;
518 put_cmsg(msg, SOL_IPV6, IPV6_HOPOPTS, (ptr[1]+1)<<3, ptr);
519 }
520
521 if (opt->lastopt &&
522 (np->rxopt.bits.dstopts || np->rxopt.bits.srcrt)) {
523 /*
524 * Silly enough, but we need to reparse in order to
525 * report extension headers (except for HbH)
526 * in order.
527 *
528 * Also note that IPV6_RECVRTHDRDSTOPTS is NOT
529 * (and WILL NOT be) defined because
530 * IPV6_RECVDSTOPTS is more generic. --yoshfuji
531 */
532 unsigned int off = sizeof(struct ipv6hdr);
533 u8 nexthdr = ipv6_hdr(skb)->nexthdr;
534
535 while (off <= opt->lastopt) {
536 unsigned int len;
537 u8 *ptr = nh + off;
538
539 switch (nexthdr) {
540 case IPPROTO_DSTOPTS:
541 nexthdr = ptr[0];
542 len = (ptr[1] + 1) << 3;
543 if (np->rxopt.bits.dstopts)
544 put_cmsg(msg, SOL_IPV6, IPV6_DSTOPTS, len, ptr);
545 break;
546 case IPPROTO_ROUTING:
547 nexthdr = ptr[0];
548 len = (ptr[1] + 1) << 3;
549 if (np->rxopt.bits.srcrt)
550 put_cmsg(msg, SOL_IPV6, IPV6_RTHDR, len, ptr);
551 break;
552 case IPPROTO_AH:
553 nexthdr = ptr[0];
554 len = (ptr[1] + 2) << 2;
555 break;
556 default:
557 nexthdr = ptr[0];
558 len = (ptr[1] + 1) << 3;
559 break;
560 }
561
562 off += len;
563 }
564 }
565
566 /* socket options in old style */
567 if (np->rxopt.bits.rxoinfo) {
568 struct in6_pktinfo src_info;
569
570 src_info.ipi6_ifindex = opt->iif;
571 src_info.ipi6_addr = ipv6_hdr(skb)->daddr;
572 put_cmsg(msg, SOL_IPV6, IPV6_2292PKTINFO, sizeof(src_info), &src_info);
573 }
574 if (np->rxopt.bits.rxohlim) {
575 int hlim = ipv6_hdr(skb)->hop_limit;
576 put_cmsg(msg, SOL_IPV6, IPV6_2292HOPLIMIT, sizeof(hlim), &hlim);
577 }
578 if (np->rxopt.bits.ohopopts && opt->hop) {
579 u8 *ptr = nh + opt->hop;
580 put_cmsg(msg, SOL_IPV6, IPV6_2292HOPOPTS, (ptr[1]+1)<<3, ptr);
581 }
582 if (np->rxopt.bits.odstopts && opt->dst0) {
583 u8 *ptr = nh + opt->dst0;
584 put_cmsg(msg, SOL_IPV6, IPV6_2292DSTOPTS, (ptr[1]+1)<<3, ptr);
585 }
586 if (np->rxopt.bits.osrcrt && opt->srcrt) {
587 struct ipv6_rt_hdr *rthdr = (struct ipv6_rt_hdr *)(nh + opt->srcrt);
588 put_cmsg(msg, SOL_IPV6, IPV6_2292RTHDR, (rthdr->hdrlen+1) << 3, rthdr);
589 }
590 if (np->rxopt.bits.odstopts && opt->dst1) {
591 u8 *ptr = nh + opt->dst1;
592 put_cmsg(msg, SOL_IPV6, IPV6_2292DSTOPTS, (ptr[1]+1)<<3, ptr);
593 }
594 if (np->rxopt.bits.rxorigdstaddr) {
595 struct sockaddr_in6 sin6;
596 __be16 *ports = (__be16 *) skb_transport_header(skb);
597
598 if (skb_transport_offset(skb) + 4 <= skb->len) {
599 /* All current transport protocols have the port numbers in the
600 * first four bytes of the transport header and this function is
601 * written with this assumption in mind.
602 */
603
604 sin6.sin6_family = AF_INET6;
605 sin6.sin6_addr = ipv6_hdr(skb)->daddr;
606 sin6.sin6_port = ports[1];
607 sin6.sin6_flowinfo = 0;
608 sin6.sin6_scope_id =
609 ipv6_iface_scope_id(&ipv6_hdr(skb)->daddr,
610 opt->iif);
611
612 put_cmsg(msg, SOL_IPV6, IPV6_ORIGDSTADDR, sizeof(sin6), &sin6);
613 }
614 }
615 return 0;
616 }
617 EXPORT_SYMBOL_GPL(ip6_datagram_recv_ctl);
618
619 int ip6_datagram_send_ctl(struct net *net, struct sock *sk,
620 struct msghdr *msg, struct flowi6 *fl6,
621 struct ipv6_txoptions *opt,
622 int *hlimit, int *tclass, int *dontfrag)
623 {
624 struct in6_pktinfo *src_info;
625 struct cmsghdr *cmsg;
626 struct ipv6_rt_hdr *rthdr;
627 struct ipv6_opt_hdr *hdr;
628 int len;
629 int err = 0;
630
631 for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) {
632 int addr_type;
633
634 if (!CMSG_OK(msg, cmsg)) {
635 err = -EINVAL;
636 goto exit_f;
637 }
638
639 if (cmsg->cmsg_level != SOL_IPV6)
640 continue;
641
642 switch (cmsg->cmsg_type) {
643 case IPV6_PKTINFO:
644 case IPV6_2292PKTINFO:
645 {
646 struct net_device *dev = NULL;
647
648 if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct in6_pktinfo))) {
649 err = -EINVAL;
650 goto exit_f;
651 }
652
653 src_info = (struct in6_pktinfo *)CMSG_DATA(cmsg);
654
655 if (src_info->ipi6_ifindex) {
656 if (fl6->flowi6_oif &&
657 src_info->ipi6_ifindex != fl6->flowi6_oif)
658 return -EINVAL;
659 fl6->flowi6_oif = src_info->ipi6_ifindex;
660 }
661
662 addr_type = __ipv6_addr_type(&src_info->ipi6_addr);
663
664 rcu_read_lock();
665 if (fl6->flowi6_oif) {
666 dev = dev_get_by_index_rcu(net, fl6->flowi6_oif);
667 if (!dev) {
668 rcu_read_unlock();
669 return -ENODEV;
670 }
671 } else if (addr_type & IPV6_ADDR_LINKLOCAL) {
672 rcu_read_unlock();
673 return -EINVAL;
674 }
675
676 if (addr_type != IPV6_ADDR_ANY) {
677 int strict = __ipv6_addr_src_scope(addr_type) <= IPV6_ADDR_SCOPE_LINKLOCAL;
678 if (!(inet_sk(sk)->freebind || inet_sk(sk)->transparent) &&
679 !ipv6_chk_addr(net, &src_info->ipi6_addr,
680 strict ? dev : NULL, 0))
681 err = -EINVAL;
682 else
683 fl6->saddr = src_info->ipi6_addr;
684 }
685
686 rcu_read_unlock();
687
688 if (err)
689 goto exit_f;
690
691 break;
692 }
693
694 case IPV6_FLOWINFO:
695 if (cmsg->cmsg_len < CMSG_LEN(4)) {
696 err = -EINVAL;
697 goto exit_f;
698 }
699
700 if (fl6->flowlabel&IPV6_FLOWINFO_MASK) {
701 if ((fl6->flowlabel^*(__be32 *)CMSG_DATA(cmsg))&~IPV6_FLOWINFO_MASK) {
702 err = -EINVAL;
703 goto exit_f;
704 }
705 }
706 fl6->flowlabel = IPV6_FLOWINFO_MASK & *(__be32 *)CMSG_DATA(cmsg);
707 break;
708
709 case IPV6_2292HOPOPTS:
710 case IPV6_HOPOPTS:
711 if (opt->hopopt || cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) {
712 err = -EINVAL;
713 goto exit_f;
714 }
715
716 hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg);
717 len = ((hdr->hdrlen + 1) << 3);
718 if (cmsg->cmsg_len < CMSG_LEN(len)) {
719 err = -EINVAL;
720 goto exit_f;
721 }
722 if (!ns_capable(net->user_ns, CAP_NET_RAW)) {
723 err = -EPERM;
724 goto exit_f;
725 }
726 opt->opt_nflen += len;
727 opt->hopopt = hdr;
728 break;
729
730 case IPV6_2292DSTOPTS:
731 if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) {
732 err = -EINVAL;
733 goto exit_f;
734 }
735
736 hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg);
737 len = ((hdr->hdrlen + 1) << 3);
738 if (cmsg->cmsg_len < CMSG_LEN(len)) {
739 err = -EINVAL;
740 goto exit_f;
741 }
742 if (!ns_capable(net->user_ns, CAP_NET_RAW)) {
743 err = -EPERM;
744 goto exit_f;
745 }
746 if (opt->dst1opt) {
747 err = -EINVAL;
748 goto exit_f;
749 }
750 opt->opt_flen += len;
751 opt->dst1opt = hdr;
752 break;
753
754 case IPV6_DSTOPTS:
755 case IPV6_RTHDRDSTOPTS:
756 if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) {
757 err = -EINVAL;
758 goto exit_f;
759 }
760
761 hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg);
762 len = ((hdr->hdrlen + 1) << 3);
763 if (cmsg->cmsg_len < CMSG_LEN(len)) {
764 err = -EINVAL;
765 goto exit_f;
766 }
767 if (!ns_capable(net->user_ns, CAP_NET_RAW)) {
768 err = -EPERM;
769 goto exit_f;
770 }
771 if (cmsg->cmsg_type == IPV6_DSTOPTS) {
772 opt->opt_flen += len;
773 opt->dst1opt = hdr;
774 } else {
775 opt->opt_nflen += len;
776 opt->dst0opt = hdr;
777 }
778 break;
779
780 case IPV6_2292RTHDR:
781 case IPV6_RTHDR:
782 if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_rt_hdr))) {
783 err = -EINVAL;
784 goto exit_f;
785 }
786
787 rthdr = (struct ipv6_rt_hdr *)CMSG_DATA(cmsg);
788
789 switch (rthdr->type) {
790 #if IS_ENABLED(CONFIG_IPV6_MIP6)
791 case IPV6_SRCRT_TYPE_2:
792 if (rthdr->hdrlen != 2 ||
793 rthdr->segments_left != 1) {
794 err = -EINVAL;
795 goto exit_f;
796 }
797 break;
798 #endif
799 default:
800 err = -EINVAL;
801 goto exit_f;
802 }
803
804 len = ((rthdr->hdrlen + 1) << 3);
805
806 if (cmsg->cmsg_len < CMSG_LEN(len)) {
807 err = -EINVAL;
808 goto exit_f;
809 }
810
811 /* segments left must also match */
812 if ((rthdr->hdrlen >> 1) != rthdr->segments_left) {
813 err = -EINVAL;
814 goto exit_f;
815 }
816
817 opt->opt_nflen += len;
818 opt->srcrt = rthdr;
819
820 if (cmsg->cmsg_type == IPV6_2292RTHDR && opt->dst1opt) {
821 int dsthdrlen = ((opt->dst1opt->hdrlen+1)<<3);
822
823 opt->opt_nflen += dsthdrlen;
824 opt->dst0opt = opt->dst1opt;
825 opt->dst1opt = NULL;
826 opt->opt_flen -= dsthdrlen;
827 }
828
829 break;
830
831 case IPV6_2292HOPLIMIT:
832 case IPV6_HOPLIMIT:
833 if (cmsg->cmsg_len != CMSG_LEN(sizeof(int))) {
834 err = -EINVAL;
835 goto exit_f;
836 }
837
838 *hlimit = *(int *)CMSG_DATA(cmsg);
839 if (*hlimit < -1 || *hlimit > 0xff) {
840 err = -EINVAL;
841 goto exit_f;
842 }
843
844 break;
845
846 case IPV6_TCLASS:
847 {
848 int tc;
849
850 err = -EINVAL;
851 if (cmsg->cmsg_len != CMSG_LEN(sizeof(int)))
852 goto exit_f;
853
854 tc = *(int *)CMSG_DATA(cmsg);
855 if (tc < -1 || tc > 0xff)
856 goto exit_f;
857
858 err = 0;
859 *tclass = tc;
860
861 break;
862 }
863
864 case IPV6_DONTFRAG:
865 {
866 int df;
867
868 err = -EINVAL;
869 if (cmsg->cmsg_len != CMSG_LEN(sizeof(int)))
870 goto exit_f;
871
872 df = *(int *)CMSG_DATA(cmsg);
873 if (df < 0 || df > 1)
874 goto exit_f;
875
876 err = 0;
877 *dontfrag = df;
878
879 break;
880 }
881 default:
882 LIMIT_NETDEBUG(KERN_DEBUG "invalid cmsg type: %d\n",
883 cmsg->cmsg_type);
884 err = -EINVAL;
885 goto exit_f;
886 }
887 }
888
889 exit_f:
890 return err;
891 }
892 EXPORT_SYMBOL_GPL(ip6_datagram_send_ctl);
893
894 void ip6_dgram_sock_seq_show(struct seq_file *seq, struct sock *sp,
895 __u16 srcp, __u16 destp, int bucket)
896 {
897 struct ipv6_pinfo *np = inet6_sk(sp);
898 const struct in6_addr *dest, *src;
899
900 dest = &np->daddr;
901 src = &np->rcv_saddr;
902 seq_printf(seq,
903 "%5d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
904 "%02X %08X:%08X %02X:%08lX %08X %5d %8d %lu %d %pK %d\n",
905 bucket,
906 src->s6_addr32[0], src->s6_addr32[1],
907 src->s6_addr32[2], src->s6_addr32[3], srcp,
908 dest->s6_addr32[0], dest->s6_addr32[1],
909 dest->s6_addr32[2], dest->s6_addr32[3], destp,
910 sp->sk_state,
911 sk_wmem_alloc_get(sp),
912 sk_rmem_alloc_get(sp),
913 0, 0L, 0,
914 from_kuid_munged(seq_user_ns(seq), sock_i_uid(sp)),
915 0,
916 sock_i_ino(sp),
917 atomic_read(&sp->sk_refcnt), sp,
918 atomic_read(&sp->sk_drops));
919 }
kernel source for telekom puls (alcatel/mediatek)