Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 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 | |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 29 | /* Compatibility glue so we can support IPv6 when it's compiled as a module */ |
Hannes Frederic Sowa | 85fbaa7 | 2013-11-23 00:46:12 +0100 | [diff] [blame] | 30 | static int dummy_ipv6_recv_error(struct sock *sk, struct msghdr *msg, int len, |
| 31 | int *addr_len) |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 32 | { |
| 33 | return -EAFNOSUPPORT; |
| 34 | } |
Hannes Frederic Sowa | 4b261c7 | 2014-01-20 03:43:08 +0100 | [diff] [blame] | 35 | static void dummy_ip6_datagram_recv_ctl(struct sock *sk, struct msghdr *msg, |
Wu Fengguang | a06a2d3 | 2013-06-12 21:04:16 +0800 | [diff] [blame] | 36 | struct sk_buff *skb) |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 37 | { |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 38 | } |
Wu Fengguang | a06a2d3 | 2013-06-12 21:04:16 +0800 | [diff] [blame] | 39 | static int dummy_icmpv6_err_convert(u8 type, u8 code, int *err) |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 40 | { |
| 41 | return -EAFNOSUPPORT; |
| 42 | } |
Wu Fengguang | a06a2d3 | 2013-06-12 21:04:16 +0800 | [diff] [blame] | 43 | static void dummy_ipv6_icmp_error(struct sock *sk, struct sk_buff *skb, int err, |
| 44 | __be16 port, u32 info, u8 *payload) {} |
| 45 | static int dummy_ipv6_chk_addr(struct net *net, const struct in6_addr *addr, |
| 46 | const struct net_device *dev, int strict) |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 47 | { |
| 48 | return 0; |
| 49 | } |
| 50 | |
Haishuang Yan | 6579a02 | 2016-03-23 17:59:51 +0800 | [diff] [blame] | 51 | static int ping_v6_sendmsg(struct sock *sk, struct msghdr *msg, size_t len) |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 52 | { |
| 53 | struct inet_sock *inet = inet_sk(sk); |
| 54 | struct ipv6_pinfo *np = inet6_sk(sk); |
| 55 | struct icmp6hdr user_icmph; |
| 56 | int addr_type; |
| 57 | struct in6_addr *daddr; |
Lorenzo Colitti | 5e45789 | 2016-08-13 01:13:38 +0900 | [diff] [blame] | 58 | int oif = 0; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 59 | struct flowi6 fl6; |
| 60 | int err; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 61 | struct dst_entry *dst; |
| 62 | struct rt6_info *rt; |
| 63 | struct pingfakehdr pfh; |
Soheil Hassas Yeganeh | c14ac94 | 2016-04-02 23:08:12 -0400 | [diff] [blame] | 64 | struct sockcm_cookie junk = {0}; |
Wei Wang | 26879da | 2016-05-02 21:40:07 -0700 | [diff] [blame] | 65 | struct ipcm6_cookie ipc6; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 66 | |
| 67 | pr_debug("ping_v6_sendmsg(sk=%p,sk->num=%u)\n", inet, inet->inet_num); |
| 68 | |
| 69 | err = ping_common_sendmsg(AF_INET6, msg, len, &user_icmph, |
| 70 | sizeof(user_icmph)); |
| 71 | if (err) |
| 72 | return err; |
| 73 | |
| 74 | if (msg->msg_name) { |
Steffen Hurrle | 342dfc3 | 2014-01-17 22:53:15 +0100 | [diff] [blame] | 75 | DECLARE_SOCKADDR(struct sockaddr_in6 *, u, msg->msg_name); |
Lorenzo Colitti | 9145736 | 2015-03-03 23:16:16 +0900 | [diff] [blame] | 76 | if (msg->msg_namelen < sizeof(*u)) |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 77 | return -EINVAL; |
Lorenzo Colitti | 9145736 | 2015-03-03 23:16:16 +0900 | [diff] [blame] | 78 | if (u->sin6_family != AF_INET6) { |
| 79 | return -EAFNOSUPPORT; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 80 | } |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 81 | daddr = &(u->sin6_addr); |
Lorenzo Colitti | 5e45789 | 2016-08-13 01:13:38 +0900 | [diff] [blame] | 82 | if (__ipv6_addr_needs_scope_id(ipv6_addr_type(daddr))) |
| 83 | oif = u->sin6_scope_id; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 84 | } else { |
| 85 | if (sk->sk_state != TCP_ESTABLISHED) |
| 86 | return -EDESTADDRREQ; |
Eric Dumazet | efe4208 | 2013-10-03 15:42:29 -0700 | [diff] [blame] | 87 | daddr = &sk->sk_v6_daddr; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 88 | } |
| 89 | |
Lorenzo Colitti | 5e45789 | 2016-08-13 01:13:38 +0900 | [diff] [blame] | 90 | if (!oif) |
| 91 | oif = sk->sk_bound_dev_if; |
| 92 | |
| 93 | if (!oif) |
| 94 | oif = np->sticky_pktinfo.ipi6_ifindex; |
| 95 | |
| 96 | if (!oif && ipv6_addr_is_multicast(daddr)) |
| 97 | oif = np->mcast_oif; |
| 98 | else if (!oif) |
| 99 | oif = np->ucast_oif; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 100 | |
| 101 | addr_type = ipv6_addr_type(daddr); |
Lorenzo Colitti | 5e45789 | 2016-08-13 01:13:38 +0900 | [diff] [blame] | 102 | if ((__ipv6_addr_needs_scope_id(addr_type) && !oif) || |
| 103 | (addr_type & IPV6_ADDR_MAPPED) || |
| 104 | (oif && sk->sk_bound_dev_if && oif != sk->sk_bound_dev_if)) |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 105 | return -EINVAL; |
| 106 | |
| 107 | /* TODO: use ip6_datagram_send_ctl to get options from cmsg */ |
| 108 | |
| 109 | memset(&fl6, 0, sizeof(fl6)); |
| 110 | |
| 111 | fl6.flowi6_proto = IPPROTO_ICMPV6; |
| 112 | fl6.saddr = np->saddr; |
| 113 | fl6.daddr = *daddr; |
Lorenzo Colitti | 5e45789 | 2016-08-13 01:13:38 +0900 | [diff] [blame] | 114 | fl6.flowi6_oif = oif; |
Lorenzo Colitti | bf439b3 | 2014-02-27 13:38:26 +0900 | [diff] [blame] | 115 | fl6.flowi6_mark = sk->sk_mark; |
Lorenzo Colitti | e2d118a | 2016-11-04 02:23:43 +0900 | [diff] [blame] | 116 | fl6.flowi6_uid = sk->sk_uid; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 117 | fl6.fl6_icmp_type = user_icmph.icmp6_type; |
| 118 | fl6.fl6_icmp_code = user_icmph.icmp6_code; |
| 119 | security_sk_classify_flow(sk, flowi6_to_flowi(&fl6)); |
| 120 | |
Hannes Frederic Sowa | 38b7097 | 2016-06-11 20:08:19 +0200 | [diff] [blame] | 121 | ipc6.tclass = np->tclass; |
| 122 | fl6.flowlabel = ip6_make_flowinfo(ipc6.tclass, fl6.flowlabel); |
| 123 | |
Steffen Klassert | 0e0d44a | 2013-08-28 08:04:14 +0200 | [diff] [blame] | 124 | dst = ip6_sk_dst_lookup_flow(sk, &fl6, daddr); |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 125 | if (IS_ERR(dst)) |
| 126 | return PTR_ERR(dst); |
| 127 | rt = (struct rt6_info *) dst; |
| 128 | |
| 129 | np = inet6_sk(sk); |
Dave Jones | 03c2778 | 2016-09-02 14:39:50 -0400 | [diff] [blame] | 130 | if (!np) { |
| 131 | err = -EBADF; |
| 132 | goto dst_err_out; |
| 133 | } |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 134 | |
| 135 | if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr)) |
| 136 | fl6.flowi6_oif = np->mcast_oif; |
| 137 | else if (!fl6.flowi6_oif) |
| 138 | fl6.flowi6_oif = np->ucast_oif; |
| 139 | |
| 140 | pfh.icmph.type = user_icmph.icmp6_type; |
| 141 | pfh.icmph.code = user_icmph.icmp6_code; |
| 142 | pfh.icmph.checksum = 0; |
| 143 | pfh.icmph.un.echo.id = inet->inet_sport; |
| 144 | pfh.icmph.un.echo.sequence = user_icmph.icmp6_sequence; |
Al Viro | cacdc7d | 2014-11-27 20:34:16 -0500 | [diff] [blame] | 145 | pfh.msg = msg; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 146 | pfh.wcheck = 0; |
| 147 | pfh.family = AF_INET6; |
| 148 | |
Wei Wang | 26879da | 2016-05-02 21:40:07 -0700 | [diff] [blame] | 149 | ipc6.hlimit = ip6_sk_dst_hoplimit(np, &fl6, dst); |
Wei Wang | 26879da | 2016-05-02 21:40:07 -0700 | [diff] [blame] | 150 | ipc6.dontfrag = np->dontfrag; |
| 151 | ipc6.opt = NULL; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 152 | |
Lorenzo Colitti | a1bdc45 | 2013-07-04 00:52:49 +0900 | [diff] [blame] | 153 | lock_sock(sk); |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 154 | err = ip6_append_data(sk, ping_getfrag, &pfh, len, |
Wei Wang | 26879da | 2016-05-02 21:40:07 -0700 | [diff] [blame] | 155 | 0, &ipc6, &fl6, rt, |
| 156 | MSG_DONTWAIT, &junk); |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 157 | |
| 158 | if (err) { |
Hannes Frederic Sowa | 43a43b6 | 2014-03-31 20:14:10 +0200 | [diff] [blame] | 159 | ICMP6_INC_STATS(sock_net(sk), rt->rt6i_idev, |
| 160 | ICMP6_MIB_OUTERRORS); |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 161 | ip6_flush_pending_frames(sk); |
| 162 | } else { |
| 163 | err = icmpv6_push_pending_frames(sk, &fl6, |
| 164 | (struct icmp6hdr *) &pfh.icmph, |
| 165 | len); |
| 166 | } |
Lorenzo Colitti | a1bdc45 | 2013-07-04 00:52:49 +0900 | [diff] [blame] | 167 | release_sock(sk); |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 168 | |
Dave Jones | 03c2778 | 2016-09-02 14:39:50 -0400 | [diff] [blame] | 169 | dst_err_out: |
| 170 | dst_release(dst); |
| 171 | |
Lorenzo Colitti | fbfe80c | 2013-07-04 00:12:40 +0900 | [diff] [blame] | 172 | if (err) |
| 173 | return err; |
| 174 | |
| 175 | return len; |
Lorenzo Colitti | 6d0bfe2 | 2013-05-22 20:17:31 +0000 | [diff] [blame] | 176 | } |
Lorenzo Colitti | d862e54 | 2013-05-31 15:05:50 +0000 | [diff] [blame] | 177 | |
Haishuang Yan | 6579a02 | 2016-03-23 17:59:51 +0800 | [diff] [blame] | 178 | struct proto pingv6_prot = { |
| 179 | .name = "PINGv6", |
| 180 | .owner = THIS_MODULE, |
| 181 | .init = ping_init_sock, |
| 182 | .close = ping_close, |
| 183 | .connect = ip6_datagram_connect_v6_only, |
Eric Dumazet | 286c72d | 2016-10-20 09:39:40 -0700 | [diff] [blame] | 184 | .disconnect = __udp_disconnect, |
Haishuang Yan | 6579a02 | 2016-03-23 17:59:51 +0800 | [diff] [blame] | 185 | .setsockopt = ipv6_setsockopt, |
| 186 | .getsockopt = ipv6_getsockopt, |
| 187 | .sendmsg = ping_v6_sendmsg, |
| 188 | .recvmsg = ping_recvmsg, |
| 189 | .bind = ping_bind, |
| 190 | .backlog_rcv = ping_queue_rcv_skb, |
| 191 | .hash = ping_hash, |
| 192 | .unhash = ping_unhash, |
| 193 | .get_port = ping_get_port, |
| 194 | .obj_size = sizeof(struct raw6_sock), |
| 195 | }; |
| 196 | EXPORT_SYMBOL_GPL(pingv6_prot); |
| 197 | |
| 198 | static struct inet_protosw pingv6_protosw = { |
| 199 | .type = SOCK_DGRAM, |
| 200 | .protocol = IPPROTO_ICMPV6, |
| 201 | .prot = &pingv6_prot, |
| 202 | .ops = &inet6_dgram_ops, |
| 203 | .flags = INET_PROTOSW_REUSE, |
| 204 | }; |
| 205 | |
Lorenzo Colitti | d862e54 | 2013-05-31 15:05:50 +0000 | [diff] [blame] | 206 | #ifdef CONFIG_PROC_FS |
| 207 | static void *ping_v6_seq_start(struct seq_file *seq, loff_t *pos) |
| 208 | { |
| 209 | return ping_seq_start(seq, pos, AF_INET6); |
| 210 | } |
| 211 | |
Wu Fengguang | a06a2d3 | 2013-06-12 21:04:16 +0800 | [diff] [blame] | 212 | static int ping_v6_seq_show(struct seq_file *seq, void *v) |
Lorenzo Colitti | d862e54 | 2013-05-31 15:05:50 +0000 | [diff] [blame] | 213 | { |
| 214 | if (v == SEQ_START_TOKEN) { |
| 215 | seq_puts(seq, IPV6_SEQ_DGRAM_HEADER); |
| 216 | } else { |
| 217 | int bucket = ((struct ping_iter_state *) seq->private)->bucket; |
| 218 | struct inet_sock *inet = inet_sk(v); |
| 219 | __u16 srcp = ntohs(inet->inet_sport); |
| 220 | __u16 destp = ntohs(inet->inet_dport); |
| 221 | ip6_dgram_sock_seq_show(seq, v, srcp, destp, bucket); |
| 222 | } |
| 223 | return 0; |
| 224 | } |
| 225 | |
| 226 | static struct ping_seq_afinfo ping_v6_seq_afinfo = { |
| 227 | .name = "icmp6", |
| 228 | .family = AF_INET6, |
| 229 | .seq_fops = &ping_seq_fops, |
| 230 | .seq_ops = { |
| 231 | .start = ping_v6_seq_start, |
| 232 | .show = ping_v6_seq_show, |
| 233 | .next = ping_seq_next, |
| 234 | .stop = ping_seq_stop, |
| 235 | }, |
| 236 | }; |
| 237 | |
| 238 | static int __net_init ping_v6_proc_init_net(struct net *net) |
| 239 | { |
| 240 | return ping_proc_register(net, &ping_v6_seq_afinfo); |
| 241 | } |
| 242 | |
| 243 | static void __net_init ping_v6_proc_exit_net(struct net *net) |
| 244 | { |
| 245 | return ping_proc_unregister(net, &ping_v6_seq_afinfo); |
| 246 | } |
| 247 | |
| 248 | static struct pernet_operations ping_v6_net_ops = { |
| 249 | .init = ping_v6_proc_init_net, |
| 250 | .exit = ping_v6_proc_exit_net, |
| 251 | }; |
| 252 | #endif |
| 253 | |
| 254 | int __init pingv6_init(void) |
| 255 | { |
| 256 | #ifdef CONFIG_PROC_FS |
| 257 | int ret = register_pernet_subsys(&ping_v6_net_ops); |
| 258 | if (ret) |
| 259 | return ret; |
| 260 | #endif |
| 261 | pingv6_ops.ipv6_recv_error = ipv6_recv_error; |
Hannes Frederic Sowa | 4b261c7 | 2014-01-20 03:43:08 +0100 | [diff] [blame] | 262 | pingv6_ops.ip6_datagram_recv_common_ctl = ip6_datagram_recv_common_ctl; |
| 263 | pingv6_ops.ip6_datagram_recv_specific_ctl = |
| 264 | ip6_datagram_recv_specific_ctl; |
Lorenzo Colitti | d862e54 | 2013-05-31 15:05:50 +0000 | [diff] [blame] | 265 | pingv6_ops.icmpv6_err_convert = icmpv6_err_convert; |
| 266 | pingv6_ops.ipv6_icmp_error = ipv6_icmp_error; |
| 267 | pingv6_ops.ipv6_chk_addr = ipv6_chk_addr; |
| 268 | return inet6_register_protosw(&pingv6_protosw); |
| 269 | } |
| 270 | |
| 271 | /* This never gets called because it's not possible to unload the ipv6 module, |
| 272 | * but just in case. |
| 273 | */ |
| 274 | void pingv6_exit(void) |
| 275 | { |
| 276 | pingv6_ops.ipv6_recv_error = dummy_ipv6_recv_error; |
Hannes Frederic Sowa | 4b261c7 | 2014-01-20 03:43:08 +0100 | [diff] [blame] | 277 | pingv6_ops.ip6_datagram_recv_common_ctl = dummy_ip6_datagram_recv_ctl; |
| 278 | pingv6_ops.ip6_datagram_recv_specific_ctl = dummy_ip6_datagram_recv_ctl; |
Lorenzo Colitti | d862e54 | 2013-05-31 15:05:50 +0000 | [diff] [blame] | 279 | pingv6_ops.icmpv6_err_convert = dummy_icmpv6_err_convert; |
| 280 | pingv6_ops.ipv6_icmp_error = dummy_ipv6_icmp_error; |
| 281 | pingv6_ops.ipv6_chk_addr = dummy_ipv6_chk_addr; |
| 282 | #ifdef CONFIG_PROC_FS |
| 283 | unregister_pernet_subsys(&ping_v6_net_ops); |
| 284 | #endif |
| 285 | inet6_unregister_protosw(&pingv6_protosw); |
| 286 | } |