12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 26d0bfe22SLorenzo Colitti /* 36d0bfe22SLorenzo Colitti * INET An implementation of the TCP/IP protocol suite for the LINUX 46d0bfe22SLorenzo Colitti * operating system. INET is implemented using the BSD Socket 56d0bfe22SLorenzo Colitti * interface as the means of communication with the user level. 66d0bfe22SLorenzo Colitti * 76d0bfe22SLorenzo Colitti * "Ping" sockets 86d0bfe22SLorenzo Colitti * 96d0bfe22SLorenzo Colitti * Based on ipv4/ping.c code. 106d0bfe22SLorenzo Colitti * 116d0bfe22SLorenzo Colitti * Authors: Lorenzo Colitti (IPv6 support) 126d0bfe22SLorenzo Colitti * Vasiliy Kulikov / Openwall (IPv4 implementation, for Linux 2.6), 136d0bfe22SLorenzo Colitti * Pavel Kankovsky (IPv4 implementation, for Linux 2.4.32) 146d0bfe22SLorenzo Colitti */ 156d0bfe22SLorenzo Colitti 166d0bfe22SLorenzo Colitti #include <net/addrconf.h> 176d0bfe22SLorenzo Colitti #include <net/ipv6.h> 186d0bfe22SLorenzo Colitti #include <net/ip6_route.h> 196d0bfe22SLorenzo Colitti #include <net/protocol.h> 206d0bfe22SLorenzo Colitti #include <net/udp.h> 216d0bfe22SLorenzo Colitti #include <net/transp_v6.h> 22f4550221SChristoph Hellwig #include <linux/proc_fs.h> 236d0bfe22SLorenzo Colitti #include <net/ping.h> 246d0bfe22SLorenzo Colitti 256d0bfe22SLorenzo Colitti /* Compatibility glue so we can support IPv6 when it's compiled as a module */ 2685fbaa75SHannes Frederic Sowa static int dummy_ipv6_recv_error(struct sock *sk, struct msghdr *msg, int len, 2785fbaa75SHannes Frederic Sowa int *addr_len) 286d0bfe22SLorenzo Colitti { 296d0bfe22SLorenzo Colitti return -EAFNOSUPPORT; 306d0bfe22SLorenzo Colitti } 314b261c75SHannes Frederic Sowa static void dummy_ip6_datagram_recv_ctl(struct sock *sk, struct msghdr *msg, 326d0bfe22SLorenzo Colitti struct sk_buff *skb) 336d0bfe22SLorenzo Colitti { 346d0bfe22SLorenzo Colitti } 35a06a2d37SWu Fengguang static int dummy_icmpv6_err_convert(u8 type, u8 code, int *err) 366d0bfe22SLorenzo Colitti { 376d0bfe22SLorenzo Colitti return -EAFNOSUPPORT; 386d0bfe22SLorenzo Colitti } 39a06a2d37SWu Fengguang static void dummy_ipv6_icmp_error(struct sock *sk, struct sk_buff *skb, int err, 406d0bfe22SLorenzo Colitti __be16 port, u32 info, u8 *payload) {} 41a06a2d37SWu Fengguang static int dummy_ipv6_chk_addr(struct net *net, const struct in6_addr *addr, 426bc19fb8SDavid S. Miller const struct net_device *dev, int strict) 436d0bfe22SLorenzo Colitti { 446d0bfe22SLorenzo Colitti return 0; 456d0bfe22SLorenzo Colitti } 466d0bfe22SLorenzo Colitti 476579a023SHaishuang Yan static int ping_v6_sendmsg(struct sock *sk, struct msghdr *msg, size_t len) 486d0bfe22SLorenzo Colitti { 496d0bfe22SLorenzo Colitti struct inet_sock *inet = inet_sk(sk); 506d0bfe22SLorenzo Colitti struct ipv6_pinfo *np = inet6_sk(sk); 516d0bfe22SLorenzo Colitti struct icmp6hdr user_icmph; 526d0bfe22SLorenzo Colitti int addr_type; 536d0bfe22SLorenzo Colitti struct in6_addr *daddr; 545e457896SLorenzo Colitti int oif = 0; 556d0bfe22SLorenzo Colitti struct flowi6 fl6; 566d0bfe22SLorenzo Colitti int err; 576d0bfe22SLorenzo Colitti struct dst_entry *dst; 586d0bfe22SLorenzo Colitti struct rt6_info *rt; 596d0bfe22SLorenzo Colitti struct pingfakehdr pfh; 6026879da5SWei Wang struct ipcm6_cookie ipc6; 616d0bfe22SLorenzo Colitti 626d0bfe22SLorenzo Colitti pr_debug("ping_v6_sendmsg(sk=%p,sk->num=%u)\n", inet, inet->inet_num); 636d0bfe22SLorenzo Colitti 646d0bfe22SLorenzo Colitti err = ping_common_sendmsg(AF_INET6, msg, len, &user_icmph, 656d0bfe22SLorenzo Colitti sizeof(user_icmph)); 666d0bfe22SLorenzo Colitti if (err) 676d0bfe22SLorenzo Colitti return err; 686d0bfe22SLorenzo Colitti 696d0bfe22SLorenzo Colitti if (msg->msg_name) { 70342dfc30SSteffen Hurrle DECLARE_SOCKADDR(struct sockaddr_in6 *, u, msg->msg_name); 719145736dSLorenzo Colitti if (msg->msg_namelen < sizeof(*u)) 726d0bfe22SLorenzo Colitti return -EINVAL; 739145736dSLorenzo Colitti if (u->sin6_family != AF_INET6) { 749145736dSLorenzo Colitti return -EAFNOSUPPORT; 756d0bfe22SLorenzo Colitti } 766d0bfe22SLorenzo Colitti daddr = &(u->sin6_addr); 775e457896SLorenzo Colitti if (__ipv6_addr_needs_scope_id(ipv6_addr_type(daddr))) 785e457896SLorenzo Colitti oif = u->sin6_scope_id; 796d0bfe22SLorenzo Colitti } else { 806d0bfe22SLorenzo Colitti if (sk->sk_state != TCP_ESTABLISHED) 816d0bfe22SLorenzo Colitti return -EDESTADDRREQ; 82efe4208fSEric Dumazet daddr = &sk->sk_v6_daddr; 836d0bfe22SLorenzo Colitti } 846d0bfe22SLorenzo Colitti 855e457896SLorenzo Colitti if (!oif) 865e457896SLorenzo Colitti oif = sk->sk_bound_dev_if; 875e457896SLorenzo Colitti 885e457896SLorenzo Colitti if (!oif) 895e457896SLorenzo Colitti oif = np->sticky_pktinfo.ipi6_ifindex; 905e457896SLorenzo Colitti 915e457896SLorenzo Colitti if (!oif && ipv6_addr_is_multicast(daddr)) 925e457896SLorenzo Colitti oif = np->mcast_oif; 935e457896SLorenzo Colitti else if (!oif) 945e457896SLorenzo Colitti oif = np->ucast_oif; 956d0bfe22SLorenzo Colitti 966d0bfe22SLorenzo Colitti addr_type = ipv6_addr_type(daddr); 975e457896SLorenzo Colitti if ((__ipv6_addr_needs_scope_id(addr_type) && !oif) || 985e457896SLorenzo Colitti (addr_type & IPV6_ADDR_MAPPED) || 995e457896SLorenzo Colitti (oif && sk->sk_bound_dev_if && oif != sk->sk_bound_dev_if)) 1006d0bfe22SLorenzo Colitti return -EINVAL; 1016d0bfe22SLorenzo Colitti 1026d0bfe22SLorenzo Colitti /* TODO: use ip6_datagram_send_ctl to get options from cmsg */ 1036d0bfe22SLorenzo Colitti 1046d0bfe22SLorenzo Colitti memset(&fl6, 0, sizeof(fl6)); 1056d0bfe22SLorenzo Colitti 1066d0bfe22SLorenzo Colitti fl6.flowi6_proto = IPPROTO_ICMPV6; 1076d0bfe22SLorenzo Colitti fl6.saddr = np->saddr; 1086d0bfe22SLorenzo Colitti fl6.daddr = *daddr; 1095e457896SLorenzo Colitti fl6.flowi6_oif = oif; 110bf439b31SLorenzo Colitti fl6.flowi6_mark = sk->sk_mark; 111e2d118a1SLorenzo Colitti fl6.flowi6_uid = sk->sk_uid; 1126d0bfe22SLorenzo Colitti fl6.fl6_icmp_type = user_icmph.icmp6_type; 1136d0bfe22SLorenzo Colitti fl6.fl6_icmp_code = user_icmph.icmp6_code; 114*3df98d79SPaul Moore security_sk_classify_flow(sk, flowi6_to_flowi_common(&fl6)); 1156d0bfe22SLorenzo Colitti 116b515430aSWillem de Bruijn ipcm6_init_sk(&ipc6, np); 117cd8700e4SWillem de Bruijn ipc6.sockc.mark = sk->sk_mark; 11838b7097bSHannes Frederic Sowa fl6.flowlabel = ip6_make_flowinfo(ipc6.tclass, fl6.flowlabel); 11938b7097bSHannes Frederic Sowa 12096818159SAlexey Kodanev dst = ip6_sk_dst_lookup_flow(sk, &fl6, daddr, false); 1216d0bfe22SLorenzo Colitti if (IS_ERR(dst)) 1226d0bfe22SLorenzo Colitti return PTR_ERR(dst); 1236d0bfe22SLorenzo Colitti rt = (struct rt6_info *) dst; 1246d0bfe22SLorenzo Colitti 1256d0bfe22SLorenzo Colitti if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr)) 1266d0bfe22SLorenzo Colitti fl6.flowi6_oif = np->mcast_oif; 1276d0bfe22SLorenzo Colitti else if (!fl6.flowi6_oif) 1286d0bfe22SLorenzo Colitti fl6.flowi6_oif = np->ucast_oif; 1296d0bfe22SLorenzo Colitti 1306d0bfe22SLorenzo Colitti pfh.icmph.type = user_icmph.icmp6_type; 1316d0bfe22SLorenzo Colitti pfh.icmph.code = user_icmph.icmp6_code; 1326d0bfe22SLorenzo Colitti pfh.icmph.checksum = 0; 1336d0bfe22SLorenzo Colitti pfh.icmph.un.echo.id = inet->inet_sport; 1346d0bfe22SLorenzo Colitti pfh.icmph.un.echo.sequence = user_icmph.icmp6_sequence; 135cacdc7d2SAl Viro pfh.msg = msg; 1366d0bfe22SLorenzo Colitti pfh.wcheck = 0; 1376d0bfe22SLorenzo Colitti pfh.family = AF_INET6; 1386d0bfe22SLorenzo Colitti 13926879da5SWei Wang ipc6.hlimit = ip6_sk_dst_hoplimit(np, &fl6, dst); 1406d0bfe22SLorenzo Colitti 141a1bdc455SLorenzo Colitti lock_sock(sk); 1426d0bfe22SLorenzo Colitti err = ip6_append_data(sk, ping_getfrag, &pfh, len, 14326879da5SWei Wang 0, &ipc6, &fl6, rt, 1445fdaa88dSWillem de Bruijn MSG_DONTWAIT); 1456d0bfe22SLorenzo Colitti 1466d0bfe22SLorenzo Colitti if (err) { 14743a43b60SHannes Frederic Sowa ICMP6_INC_STATS(sock_net(sk), rt->rt6i_idev, 1486d0bfe22SLorenzo Colitti ICMP6_MIB_OUTERRORS); 1496d0bfe22SLorenzo Colitti ip6_flush_pending_frames(sk); 1506d0bfe22SLorenzo Colitti } else { 1514e64b1edSJoe Perches icmpv6_push_pending_frames(sk, &fl6, 1524e64b1edSJoe Perches (struct icmp6hdr *)&pfh.icmph, len); 1536d0bfe22SLorenzo Colitti } 154a1bdc455SLorenzo Colitti release_sock(sk); 1556d0bfe22SLorenzo Colitti 15603c2778aSDave Jones dst_release(dst); 15703c2778aSDave Jones 158fbfe80c8SLorenzo Colitti if (err) 1596d0bfe22SLorenzo Colitti return err; 160fbfe80c8SLorenzo Colitti 161fbfe80c8SLorenzo Colitti return len; 1626d0bfe22SLorenzo Colitti } 163d862e546SLorenzo Colitti 1646579a023SHaishuang Yan struct proto pingv6_prot = { 1656579a023SHaishuang Yan .name = "PINGv6", 1666579a023SHaishuang Yan .owner = THIS_MODULE, 1676579a023SHaishuang Yan .init = ping_init_sock, 1686579a023SHaishuang Yan .close = ping_close, 1696579a023SHaishuang Yan .connect = ip6_datagram_connect_v6_only, 170286c72deSEric Dumazet .disconnect = __udp_disconnect, 1716579a023SHaishuang Yan .setsockopt = ipv6_setsockopt, 1726579a023SHaishuang Yan .getsockopt = ipv6_getsockopt, 1736579a023SHaishuang Yan .sendmsg = ping_v6_sendmsg, 1746579a023SHaishuang Yan .recvmsg = ping_recvmsg, 1756579a023SHaishuang Yan .bind = ping_bind, 1766579a023SHaishuang Yan .backlog_rcv = ping_queue_rcv_skb, 1776579a023SHaishuang Yan .hash = ping_hash, 1786579a023SHaishuang Yan .unhash = ping_unhash, 1796579a023SHaishuang Yan .get_port = ping_get_port, 1806579a023SHaishuang Yan .obj_size = sizeof(struct raw6_sock), 1816579a023SHaishuang Yan }; 1826579a023SHaishuang Yan EXPORT_SYMBOL_GPL(pingv6_prot); 1836579a023SHaishuang Yan 1846579a023SHaishuang Yan static struct inet_protosw pingv6_protosw = { 1856579a023SHaishuang Yan .type = SOCK_DGRAM, 1866579a023SHaishuang Yan .protocol = IPPROTO_ICMPV6, 1876579a023SHaishuang Yan .prot = &pingv6_prot, 18877d4b1d3SEric Dumazet .ops = &inet6_sockraw_ops, 1896579a023SHaishuang Yan .flags = INET_PROTOSW_REUSE, 1906579a023SHaishuang Yan }; 1916579a023SHaishuang Yan 192d862e546SLorenzo Colitti #ifdef CONFIG_PROC_FS 193d862e546SLorenzo Colitti static void *ping_v6_seq_start(struct seq_file *seq, loff_t *pos) 194d862e546SLorenzo Colitti { 195d862e546SLorenzo Colitti return ping_seq_start(seq, pos, AF_INET6); 196d862e546SLorenzo Colitti } 197d862e546SLorenzo Colitti 198a06a2d37SWu Fengguang static int ping_v6_seq_show(struct seq_file *seq, void *v) 199d862e546SLorenzo Colitti { 200d862e546SLorenzo Colitti if (v == SEQ_START_TOKEN) { 201d862e546SLorenzo Colitti seq_puts(seq, IPV6_SEQ_DGRAM_HEADER); 202d862e546SLorenzo Colitti } else { 203d862e546SLorenzo Colitti int bucket = ((struct ping_iter_state *) seq->private)->bucket; 204d862e546SLorenzo Colitti struct inet_sock *inet = inet_sk(v); 205d862e546SLorenzo Colitti __u16 srcp = ntohs(inet->inet_sport); 206d862e546SLorenzo Colitti __u16 destp = ntohs(inet->inet_dport); 207d862e546SLorenzo Colitti ip6_dgram_sock_seq_show(seq, v, srcp, destp, bucket); 208d862e546SLorenzo Colitti } 209d862e546SLorenzo Colitti return 0; 210d862e546SLorenzo Colitti } 211d862e546SLorenzo Colitti 212f4550221SChristoph Hellwig static const struct seq_operations ping_v6_seq_ops = { 213d862e546SLorenzo Colitti .start = ping_v6_seq_start, 214d862e546SLorenzo Colitti .show = ping_v6_seq_show, 215d862e546SLorenzo Colitti .next = ping_seq_next, 216d862e546SLorenzo Colitti .stop = ping_seq_stop, 217f4550221SChristoph Hellwig }; 218f4550221SChristoph Hellwig 219d862e546SLorenzo Colitti static int __net_init ping_v6_proc_init_net(struct net *net) 220d862e546SLorenzo Colitti { 221c3506372SChristoph Hellwig if (!proc_create_net("icmp6", 0444, net->proc_net, &ping_v6_seq_ops, 222c3506372SChristoph Hellwig sizeof(struct ping_iter_state))) 223f4550221SChristoph Hellwig return -ENOMEM; 224f4550221SChristoph Hellwig return 0; 225d862e546SLorenzo Colitti } 226d862e546SLorenzo Colitti 227d23dbc47SChristophe JAILLET static void __net_exit ping_v6_proc_exit_net(struct net *net) 228d862e546SLorenzo Colitti { 229f4550221SChristoph Hellwig remove_proc_entry("icmp6", net->proc_net); 230d862e546SLorenzo Colitti } 231d862e546SLorenzo Colitti 232d862e546SLorenzo Colitti static struct pernet_operations ping_v6_net_ops = { 233d862e546SLorenzo Colitti .init = ping_v6_proc_init_net, 234d862e546SLorenzo Colitti .exit = ping_v6_proc_exit_net, 235d862e546SLorenzo Colitti }; 236d862e546SLorenzo Colitti #endif 237d862e546SLorenzo Colitti 238d862e546SLorenzo Colitti int __init pingv6_init(void) 239d862e546SLorenzo Colitti { 240d862e546SLorenzo Colitti #ifdef CONFIG_PROC_FS 241d862e546SLorenzo Colitti int ret = register_pernet_subsys(&ping_v6_net_ops); 242d862e546SLorenzo Colitti if (ret) 243d862e546SLorenzo Colitti return ret; 244d862e546SLorenzo Colitti #endif 245d862e546SLorenzo Colitti pingv6_ops.ipv6_recv_error = ipv6_recv_error; 2464b261c75SHannes Frederic Sowa pingv6_ops.ip6_datagram_recv_common_ctl = ip6_datagram_recv_common_ctl; 2474b261c75SHannes Frederic Sowa pingv6_ops.ip6_datagram_recv_specific_ctl = 2484b261c75SHannes Frederic Sowa ip6_datagram_recv_specific_ctl; 249d862e546SLorenzo Colitti pingv6_ops.icmpv6_err_convert = icmpv6_err_convert; 250d862e546SLorenzo Colitti pingv6_ops.ipv6_icmp_error = ipv6_icmp_error; 251d862e546SLorenzo Colitti pingv6_ops.ipv6_chk_addr = ipv6_chk_addr; 252d862e546SLorenzo Colitti return inet6_register_protosw(&pingv6_protosw); 253d862e546SLorenzo Colitti } 254d862e546SLorenzo Colitti 255d862e546SLorenzo Colitti /* This never gets called because it's not possible to unload the ipv6 module, 256d862e546SLorenzo Colitti * but just in case. 257d862e546SLorenzo Colitti */ 258d862e546SLorenzo Colitti void pingv6_exit(void) 259d862e546SLorenzo Colitti { 260d862e546SLorenzo Colitti pingv6_ops.ipv6_recv_error = dummy_ipv6_recv_error; 2614b261c75SHannes Frederic Sowa pingv6_ops.ip6_datagram_recv_common_ctl = dummy_ip6_datagram_recv_ctl; 2624b261c75SHannes Frederic Sowa pingv6_ops.ip6_datagram_recv_specific_ctl = dummy_ip6_datagram_recv_ctl; 263d862e546SLorenzo Colitti pingv6_ops.icmpv6_err_convert = dummy_icmpv6_err_convert; 264d862e546SLorenzo Colitti pingv6_ops.ipv6_icmp_error = dummy_ipv6_icmp_error; 265d862e546SLorenzo Colitti pingv6_ops.ipv6_chk_addr = dummy_ipv6_chk_addr; 266d862e546SLorenzo Colitti #ifdef CONFIG_PROC_FS 267d862e546SLorenzo Colitti unregister_pernet_subsys(&ping_v6_net_ops); 268d862e546SLorenzo Colitti #endif 269d862e546SLorenzo Colitti inet6_unregister_protosw(&pingv6_protosw); 270d862e546SLorenzo Colitti } 271