1 /*
2 * INET An implementation of the TCP/IP protocol suite for the LINUX
3 * operating system. INET is implemented using the BSD Socket
4 * interface as the means of communication with the user level.
5 *
6 * "Ping" sockets
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 * Based on ipv4/ping.c code.
14 *
15 * Authors: Lorenzo Colitti (IPv6 support)
16 * Vasiliy Kulikov / Openwall (IPv4 implementation, for Linux 2.6),
17 * Pavel Kankovsky (IPv4 implementation, for Linux 2.4.32)
18 *
19 */
20
21 #include <net/addrconf.h>
22 #include <net/ipv6.h>
23 #include <net/ip6_route.h>
24 #include <net/protocol.h>
25 #include <net/udp.h>
26 #include <net/transp_v6.h>
27 #include <net/ping.h>
28
29 struct proto pingv6_prot = {
30 .name = "PINGv6",
31 .owner = THIS_MODULE,
32 .init = ping_init_sock,
33 .close = ping_close,
34 .connect = ip6_datagram_connect_v6_only,
35 .disconnect = udp_disconnect,
36 .setsockopt = ipv6_setsockopt,
37 .getsockopt = ipv6_getsockopt,
38 .sendmsg = ping_v6_sendmsg,
39 .recvmsg = ping_recvmsg,
40 .bind = ping_bind,
41 .backlog_rcv = ping_queue_rcv_skb,
42 .hash = ping_hash,
43 .unhash = ping_unhash,
44 .get_port = ping_get_port,
45 .obj_size = sizeof(struct raw6_sock),
46 };
47 EXPORT_SYMBOL_GPL(pingv6_prot);
48
49 static struct inet_protosw pingv6_protosw = {
50 .type = SOCK_DGRAM,
51 .protocol = IPPROTO_ICMPV6,
52 .prot = &pingv6_prot,
53 .ops = &inet6_sockraw_ops,
54 .flags = INET_PROTOSW_REUSE,
55 };
56
57
58 /* Compatibility glue so we can support IPv6 when it's compiled as a module */
dummy_ipv6_recv_error(struct sock * sk,struct msghdr * msg,int len,int * addr_len)59 static int dummy_ipv6_recv_error(struct sock *sk, struct msghdr *msg, int len,
60 int *addr_len)
61 {
62 return -EAFNOSUPPORT;
63 }
dummy_ip6_datagram_recv_ctl(struct sock * sk,struct msghdr * msg,struct sk_buff * skb)64 static void dummy_ip6_datagram_recv_ctl(struct sock *sk, struct msghdr *msg,
65 struct sk_buff *skb)
66 {
67 }
dummy_icmpv6_err_convert(u8 type,u8 code,int * err)68 static int dummy_icmpv6_err_convert(u8 type, u8 code, int *err)
69 {
70 return -EAFNOSUPPORT;
71 }
dummy_ipv6_icmp_error(struct sock * sk,struct sk_buff * skb,int err,__be16 port,u32 info,u8 * payload)72 static void dummy_ipv6_icmp_error(struct sock *sk, struct sk_buff *skb, int err,
73 __be16 port, u32 info, u8 *payload) {}
dummy_ipv6_chk_addr(struct net * net,const struct in6_addr * addr,const struct net_device * dev,int strict)74 static int dummy_ipv6_chk_addr(struct net *net, const struct in6_addr *addr,
75 const struct net_device *dev, int strict)
76 {
77 return 0;
78 }
79
ping_v6_sendmsg(struct kiocb * iocb,struct sock * sk,struct msghdr * msg,size_t len)80 int ping_v6_sendmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg,
81 size_t len)
82 {
83 struct inet_sock *inet = inet_sk(sk);
84 struct ipv6_pinfo *np = inet6_sk(sk);
85 struct icmp6hdr user_icmph;
86 int addr_type;
87 struct in6_addr *daddr;
88 int oif = 0;
89 struct flowi6 fl6;
90 int err;
91 int hlimit;
92 struct dst_entry *dst;
93 struct rt6_info *rt;
94 struct pingfakehdr pfh;
95
96 pr_debug("ping_v6_sendmsg(sk=%p,sk->num=%u)\n", inet, inet->inet_num);
97
98 err = ping_common_sendmsg(AF_INET6, msg, len, &user_icmph,
99 sizeof(user_icmph));
100 if (err)
101 return err;
102
103 if (msg->msg_name) {
104 DECLARE_SOCKADDR(struct sockaddr_in6 *, u, msg->msg_name);
105 if (msg->msg_namelen < sizeof(*u))
106 return -EINVAL;
107 if (u->sin6_family != AF_INET6) {
108 return -EAFNOSUPPORT;
109 }
110 daddr = &(u->sin6_addr);
111 if (__ipv6_addr_needs_scope_id(ipv6_addr_type(daddr)))
112 oif = u->sin6_scope_id;
113 } else {
114 if (sk->sk_state != TCP_ESTABLISHED)
115 return -EDESTADDRREQ;
116 daddr = &sk->sk_v6_daddr;
117 }
118
119 if (!oif)
120 oif = sk->sk_bound_dev_if;
121
122 if (!oif)
123 oif = np->sticky_pktinfo.ipi6_ifindex;
124
125 if (!oif && ipv6_addr_is_multicast(daddr))
126 oif = np->mcast_oif;
127 else if (!oif)
128 oif = np->ucast_oif;
129
130 addr_type = ipv6_addr_type(daddr);
131 if ((__ipv6_addr_needs_scope_id(addr_type) && !oif) ||
132 (addr_type & IPV6_ADDR_MAPPED) ||
133 (oif && sk->sk_bound_dev_if && oif != sk->sk_bound_dev_if))
134 return -EINVAL;
135
136 /* TODO: use ip6_datagram_send_ctl to get options from cmsg */
137
138 memset(&fl6, 0, sizeof(fl6));
139
140 fl6.flowi6_proto = IPPROTO_ICMPV6;
141 fl6.saddr = np->saddr;
142 fl6.daddr = *daddr;
143 fl6.flowi6_oif = oif;
144 fl6.flowi6_mark = sk->sk_mark;
145 fl6.flowi6_uid = sk->sk_uid;
146 fl6.fl6_icmp_type = user_icmph.icmp6_type;
147 fl6.fl6_icmp_code = user_icmph.icmp6_code;
148 security_sk_classify_flow(sk, flowi6_to_flowi(&fl6));
149
150 dst = ip6_sk_dst_lookup_flow(sk, &fl6, daddr);
151 if (IS_ERR(dst))
152 return PTR_ERR(dst);
153 rt = (struct rt6_info *) dst;
154
155 np = inet6_sk(sk);
156 if (!np)
157 return -EBADF;
158
159 pfh.icmph.type = user_icmph.icmp6_type;
160 pfh.icmph.code = user_icmph.icmp6_code;
161 pfh.icmph.checksum = 0;
162 pfh.icmph.un.echo.id = inet->inet_sport;
163 pfh.icmph.un.echo.sequence = user_icmph.icmp6_sequence;
164 pfh.iov = msg->msg_iov;
165 pfh.wcheck = 0;
166 pfh.family = AF_INET6;
167
168 hlimit = ip6_sk_dst_hoplimit(np, &fl6, dst);
169
170 lock_sock(sk);
171 err = ip6_append_data(sk, ping_getfrag, &pfh, len,
172 0, hlimit,
173 np->tclass, NULL, &fl6, rt,
174 MSG_DONTWAIT, np->dontfrag);
175
176 if (err) {
177 ICMP6_INC_STATS(sock_net(sk), rt->rt6i_idev,
178 ICMP6_MIB_OUTERRORS);
179 ip6_flush_pending_frames(sk);
180 } else {
181 err = icmpv6_push_pending_frames(sk, &fl6,
182 (struct icmp6hdr *) &pfh.icmph,
183 len);
184 }
185 release_sock(sk);
186
187 if (err)
188 return err;
189
190 return len;
191 }
192
193 #ifdef CONFIG_PROC_FS
ping_v6_seq_start(struct seq_file * seq,loff_t * pos)194 static void *ping_v6_seq_start(struct seq_file *seq, loff_t *pos)
195 {
196 return ping_seq_start(seq, pos, AF_INET6);
197 }
198
ping_v6_seq_show(struct seq_file * seq,void * v)199 static int ping_v6_seq_show(struct seq_file *seq, void *v)
200 {
201 if (v == SEQ_START_TOKEN) {
202 seq_puts(seq, IPV6_SEQ_DGRAM_HEADER);
203 } else {
204 int bucket = ((struct ping_iter_state *) seq->private)->bucket;
205 struct inet_sock *inet = inet_sk(v);
206 __u16 srcp = ntohs(inet->inet_sport);
207 __u16 destp = ntohs(inet->inet_dport);
208 ip6_dgram_sock_seq_show(seq, v, srcp, destp, bucket);
209 }
210 return 0;
211 }
212
213 static struct ping_seq_afinfo ping_v6_seq_afinfo = {
214 .name = "icmp6",
215 .family = AF_INET6,
216 .seq_fops = &ping_seq_fops,
217 .seq_ops = {
218 .start = ping_v6_seq_start,
219 .show = ping_v6_seq_show,
220 .next = ping_seq_next,
221 .stop = ping_seq_stop,
222 },
223 };
224
ping_v6_proc_init_net(struct net * net)225 static int __net_init ping_v6_proc_init_net(struct net *net)
226 {
227 return ping_proc_register(net, &ping_v6_seq_afinfo);
228 }
229
ping_v6_proc_exit_net(struct net * net)230 static void __net_init ping_v6_proc_exit_net(struct net *net)
231 {
232 return ping_proc_unregister(net, &ping_v6_seq_afinfo);
233 }
234
235 static struct pernet_operations ping_v6_net_ops = {
236 .init = ping_v6_proc_init_net,
237 .exit = ping_v6_proc_exit_net,
238 };
239 #endif
240
pingv6_init(void)241 int __init pingv6_init(void)
242 {
243 #ifdef CONFIG_PROC_FS
244 int ret = register_pernet_subsys(&ping_v6_net_ops);
245 if (ret)
246 return ret;
247 #endif
248 pingv6_ops.ipv6_recv_error = ipv6_recv_error;
249 pingv6_ops.ip6_datagram_recv_common_ctl = ip6_datagram_recv_common_ctl;
250 pingv6_ops.ip6_datagram_recv_specific_ctl =
251 ip6_datagram_recv_specific_ctl;
252 pingv6_ops.icmpv6_err_convert = icmpv6_err_convert;
253 pingv6_ops.ipv6_icmp_error = ipv6_icmp_error;
254 pingv6_ops.ipv6_chk_addr = ipv6_chk_addr;
255 return inet6_register_protosw(&pingv6_protosw);
256 }
257
258 /* This never gets called because it's not possible to unload the ipv6 module,
259 * but just in case.
260 */
pingv6_exit(void)261 void pingv6_exit(void)
262 {
263 pingv6_ops.ipv6_recv_error = dummy_ipv6_recv_error;
264 pingv6_ops.ip6_datagram_recv_common_ctl = dummy_ip6_datagram_recv_ctl;
265 pingv6_ops.ip6_datagram_recv_specific_ctl = dummy_ip6_datagram_recv_ctl;
266 pingv6_ops.icmpv6_err_convert = dummy_icmpv6_err_convert;
267 pingv6_ops.ipv6_icmp_error = dummy_ipv6_icmp_error;
268 pingv6_ops.ipv6_chk_addr = dummy_ipv6_chk_addr;
269 #ifdef CONFIG_PROC_FS
270 unregister_pernet_subsys(&ping_v6_net_ops);
271 #endif
272 inet6_unregister_protosw(&pingv6_protosw);
273 }
274