16d0bfe22SLorenzo Colitti /* 26d0bfe22SLorenzo Colitti * INET An implementation of the TCP/IP protocol suite for the LINUX 36d0bfe22SLorenzo Colitti * operating system. INET is implemented using the BSD Socket 46d0bfe22SLorenzo Colitti * interface as the means of communication with the user level. 56d0bfe22SLorenzo Colitti * 66d0bfe22SLorenzo Colitti * "Ping" sockets 76d0bfe22SLorenzo Colitti * 86d0bfe22SLorenzo Colitti * This program is free software; you can redistribute it and/or 96d0bfe22SLorenzo Colitti * modify it under the terms of the GNU General Public License 106d0bfe22SLorenzo Colitti * as published by the Free Software Foundation; either version 116d0bfe22SLorenzo Colitti * 2 of the License, or (at your option) any later version. 126d0bfe22SLorenzo Colitti * 136d0bfe22SLorenzo Colitti * Based on ipv4/ping.c code. 146d0bfe22SLorenzo Colitti * 156d0bfe22SLorenzo Colitti * Authors: Lorenzo Colitti (IPv6 support) 166d0bfe22SLorenzo Colitti * Vasiliy Kulikov / Openwall (IPv4 implementation, for Linux 2.6), 176d0bfe22SLorenzo Colitti * Pavel Kankovsky (IPv4 implementation, for Linux 2.4.32) 186d0bfe22SLorenzo Colitti * 196d0bfe22SLorenzo Colitti */ 206d0bfe22SLorenzo Colitti 216d0bfe22SLorenzo Colitti #include <net/addrconf.h> 226d0bfe22SLorenzo Colitti #include <net/ipv6.h> 236d0bfe22SLorenzo Colitti #include <net/ip6_route.h> 246d0bfe22SLorenzo Colitti #include <net/protocol.h> 256d0bfe22SLorenzo Colitti #include <net/udp.h> 266d0bfe22SLorenzo Colitti #include <net/transp_v6.h> 276d0bfe22SLorenzo Colitti #include <net/ping.h> 286d0bfe22SLorenzo Colitti 296d0bfe22SLorenzo Colitti struct proto pingv6_prot = { 306d0bfe22SLorenzo Colitti .name = "PINGv6", 316d0bfe22SLorenzo Colitti .owner = THIS_MODULE, 326d0bfe22SLorenzo Colitti .init = ping_init_sock, 336d0bfe22SLorenzo Colitti .close = ping_close, 346d0bfe22SLorenzo Colitti .connect = ip6_datagram_connect, 356d0bfe22SLorenzo Colitti .disconnect = udp_disconnect, 366d0bfe22SLorenzo Colitti .setsockopt = ipv6_setsockopt, 376d0bfe22SLorenzo Colitti .getsockopt = ipv6_getsockopt, 386d0bfe22SLorenzo Colitti .sendmsg = ping_v6_sendmsg, 396d0bfe22SLorenzo Colitti .recvmsg = ping_recvmsg, 406d0bfe22SLorenzo Colitti .bind = ping_bind, 416d0bfe22SLorenzo Colitti .backlog_rcv = ping_queue_rcv_skb, 426d0bfe22SLorenzo Colitti .hash = ping_hash, 436d0bfe22SLorenzo Colitti .unhash = ping_unhash, 446d0bfe22SLorenzo Colitti .get_port = ping_get_port, 456d0bfe22SLorenzo Colitti .obj_size = sizeof(struct raw6_sock), 466d0bfe22SLorenzo Colitti }; 476d0bfe22SLorenzo Colitti EXPORT_SYMBOL_GPL(pingv6_prot); 486d0bfe22SLorenzo Colitti 496d0bfe22SLorenzo Colitti static struct inet_protosw pingv6_protosw = { 506d0bfe22SLorenzo Colitti .type = SOCK_DGRAM, 516d0bfe22SLorenzo Colitti .protocol = IPPROTO_ICMPV6, 526d0bfe22SLorenzo Colitti .prot = &pingv6_prot, 536d0bfe22SLorenzo Colitti .ops = &inet6_dgram_ops, 546d0bfe22SLorenzo Colitti .no_check = UDP_CSUM_DEFAULT, 556d0bfe22SLorenzo Colitti .flags = INET_PROTOSW_REUSE, 566d0bfe22SLorenzo Colitti }; 576d0bfe22SLorenzo Colitti 586d0bfe22SLorenzo Colitti 596d0bfe22SLorenzo Colitti /* Compatibility glue so we can support IPv6 when it's compiled as a module */ 6085fbaa75SHannes Frederic Sowa static int dummy_ipv6_recv_error(struct sock *sk, struct msghdr *msg, int len, 6185fbaa75SHannes Frederic Sowa int *addr_len) 626d0bfe22SLorenzo Colitti { 636d0bfe22SLorenzo Colitti return -EAFNOSUPPORT; 646d0bfe22SLorenzo Colitti } 65a06a2d37SWu Fengguang static int dummy_ip6_datagram_recv_ctl(struct sock *sk, struct msghdr *msg, 666d0bfe22SLorenzo Colitti struct sk_buff *skb) 676d0bfe22SLorenzo Colitti { 686d0bfe22SLorenzo Colitti return -EAFNOSUPPORT; 696d0bfe22SLorenzo Colitti } 70a06a2d37SWu Fengguang static int dummy_icmpv6_err_convert(u8 type, u8 code, int *err) 716d0bfe22SLorenzo Colitti { 726d0bfe22SLorenzo Colitti return -EAFNOSUPPORT; 736d0bfe22SLorenzo Colitti } 74a06a2d37SWu Fengguang static void dummy_ipv6_icmp_error(struct sock *sk, struct sk_buff *skb, int err, 756d0bfe22SLorenzo Colitti __be16 port, u32 info, u8 *payload) {} 76a06a2d37SWu Fengguang static int dummy_ipv6_chk_addr(struct net *net, const struct in6_addr *addr, 776bc19fb8SDavid S. Miller const struct net_device *dev, int strict) 786d0bfe22SLorenzo Colitti { 796d0bfe22SLorenzo Colitti return 0; 806d0bfe22SLorenzo Colitti } 816d0bfe22SLorenzo Colitti 826d0bfe22SLorenzo Colitti int ping_v6_sendmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg, 836d0bfe22SLorenzo Colitti size_t len) 846d0bfe22SLorenzo Colitti { 856d0bfe22SLorenzo Colitti struct inet_sock *inet = inet_sk(sk); 866d0bfe22SLorenzo Colitti struct ipv6_pinfo *np = inet6_sk(sk); 876d0bfe22SLorenzo Colitti struct icmp6hdr user_icmph; 886d0bfe22SLorenzo Colitti int addr_type; 896d0bfe22SLorenzo Colitti struct in6_addr *daddr; 906d0bfe22SLorenzo Colitti int iif = 0; 916d0bfe22SLorenzo Colitti struct flowi6 fl6; 926d0bfe22SLorenzo Colitti int err; 936d0bfe22SLorenzo Colitti int hlimit; 946d0bfe22SLorenzo Colitti struct dst_entry *dst; 956d0bfe22SLorenzo Colitti struct rt6_info *rt; 966d0bfe22SLorenzo Colitti struct pingfakehdr pfh; 976d0bfe22SLorenzo Colitti 986d0bfe22SLorenzo Colitti pr_debug("ping_v6_sendmsg(sk=%p,sk->num=%u)\n", inet, inet->inet_num); 996d0bfe22SLorenzo Colitti 1006d0bfe22SLorenzo Colitti err = ping_common_sendmsg(AF_INET6, msg, len, &user_icmph, 1016d0bfe22SLorenzo Colitti sizeof(user_icmph)); 1026d0bfe22SLorenzo Colitti if (err) 1036d0bfe22SLorenzo Colitti return err; 1046d0bfe22SLorenzo Colitti 1056d0bfe22SLorenzo Colitti if (msg->msg_name) { 106342dfc30SSteffen Hurrle DECLARE_SOCKADDR(struct sockaddr_in6 *, u, msg->msg_name); 1076d0bfe22SLorenzo Colitti if (msg->msg_namelen < sizeof(struct sockaddr_in6) || 1086d0bfe22SLorenzo Colitti u->sin6_family != AF_INET6) { 1096d0bfe22SLorenzo Colitti return -EINVAL; 1106d0bfe22SLorenzo Colitti } 1116d0bfe22SLorenzo Colitti if (sk->sk_bound_dev_if && 1126d0bfe22SLorenzo Colitti sk->sk_bound_dev_if != u->sin6_scope_id) { 1136d0bfe22SLorenzo Colitti return -EINVAL; 1146d0bfe22SLorenzo Colitti } 1156d0bfe22SLorenzo Colitti daddr = &(u->sin6_addr); 1166d0bfe22SLorenzo Colitti iif = u->sin6_scope_id; 1176d0bfe22SLorenzo Colitti } else { 1186d0bfe22SLorenzo Colitti if (sk->sk_state != TCP_ESTABLISHED) 1196d0bfe22SLorenzo Colitti return -EDESTADDRREQ; 120efe4208fSEric Dumazet daddr = &sk->sk_v6_daddr; 1216d0bfe22SLorenzo Colitti } 1226d0bfe22SLorenzo Colitti 1236d0bfe22SLorenzo Colitti if (!iif) 1246d0bfe22SLorenzo Colitti iif = sk->sk_bound_dev_if; 1256d0bfe22SLorenzo Colitti 1266d0bfe22SLorenzo Colitti addr_type = ipv6_addr_type(daddr); 1276d0bfe22SLorenzo Colitti if (__ipv6_addr_needs_scope_id(addr_type) && !iif) 1286d0bfe22SLorenzo Colitti return -EINVAL; 1296d0bfe22SLorenzo Colitti if (addr_type & IPV6_ADDR_MAPPED) 1306d0bfe22SLorenzo Colitti return -EINVAL; 1316d0bfe22SLorenzo Colitti 1326d0bfe22SLorenzo Colitti /* TODO: use ip6_datagram_send_ctl to get options from cmsg */ 1336d0bfe22SLorenzo Colitti 1346d0bfe22SLorenzo Colitti memset(&fl6, 0, sizeof(fl6)); 1356d0bfe22SLorenzo Colitti 1366d0bfe22SLorenzo Colitti fl6.flowi6_proto = IPPROTO_ICMPV6; 1376d0bfe22SLorenzo Colitti fl6.saddr = np->saddr; 1386d0bfe22SLorenzo Colitti fl6.daddr = *daddr; 1396d0bfe22SLorenzo Colitti fl6.fl6_icmp_type = user_icmph.icmp6_type; 1406d0bfe22SLorenzo Colitti fl6.fl6_icmp_code = user_icmph.icmp6_code; 1416d0bfe22SLorenzo Colitti security_sk_classify_flow(sk, flowi6_to_flowi(&fl6)); 1426d0bfe22SLorenzo Colitti 1436d0bfe22SLorenzo Colitti if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr)) 1446d0bfe22SLorenzo Colitti fl6.flowi6_oif = np->mcast_oif; 1456d0bfe22SLorenzo Colitti else if (!fl6.flowi6_oif) 1466d0bfe22SLorenzo Colitti fl6.flowi6_oif = np->ucast_oif; 1476d0bfe22SLorenzo Colitti 1480e0d44abSSteffen Klassert dst = ip6_sk_dst_lookup_flow(sk, &fl6, daddr); 1496d0bfe22SLorenzo Colitti if (IS_ERR(dst)) 1506d0bfe22SLorenzo Colitti return PTR_ERR(dst); 1516d0bfe22SLorenzo Colitti rt = (struct rt6_info *) dst; 1526d0bfe22SLorenzo Colitti 1536d0bfe22SLorenzo Colitti np = inet6_sk(sk); 1546d0bfe22SLorenzo Colitti if (!np) 1556d0bfe22SLorenzo Colitti return -EBADF; 1566d0bfe22SLorenzo Colitti 1576d0bfe22SLorenzo Colitti if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr)) 1586d0bfe22SLorenzo Colitti fl6.flowi6_oif = np->mcast_oif; 1596d0bfe22SLorenzo Colitti else if (!fl6.flowi6_oif) 1606d0bfe22SLorenzo Colitti fl6.flowi6_oif = np->ucast_oif; 1616d0bfe22SLorenzo Colitti 1626d0bfe22SLorenzo Colitti pfh.icmph.type = user_icmph.icmp6_type; 1636d0bfe22SLorenzo Colitti pfh.icmph.code = user_icmph.icmp6_code; 1646d0bfe22SLorenzo Colitti pfh.icmph.checksum = 0; 1656d0bfe22SLorenzo Colitti pfh.icmph.un.echo.id = inet->inet_sport; 1666d0bfe22SLorenzo Colitti pfh.icmph.un.echo.sequence = user_icmph.icmp6_sequence; 1676d0bfe22SLorenzo Colitti pfh.iov = msg->msg_iov; 1686d0bfe22SLorenzo Colitti pfh.wcheck = 0; 1696d0bfe22SLorenzo Colitti pfh.family = AF_INET6; 1706d0bfe22SLorenzo Colitti 1716d0bfe22SLorenzo Colitti if (ipv6_addr_is_multicast(&fl6.daddr)) 1726d0bfe22SLorenzo Colitti hlimit = np->mcast_hops; 1736d0bfe22SLorenzo Colitti else 1746d0bfe22SLorenzo Colitti hlimit = np->hop_limit; 1756d0bfe22SLorenzo Colitti if (hlimit < 0) 1766d0bfe22SLorenzo Colitti hlimit = ip6_dst_hoplimit(dst); 1776d0bfe22SLorenzo Colitti 178a1bdc455SLorenzo Colitti lock_sock(sk); 1796d0bfe22SLorenzo Colitti err = ip6_append_data(sk, ping_getfrag, &pfh, len, 1806d0bfe22SLorenzo Colitti 0, hlimit, 1816d0bfe22SLorenzo Colitti np->tclass, NULL, &fl6, rt, 1826d0bfe22SLorenzo Colitti MSG_DONTWAIT, np->dontfrag); 1836d0bfe22SLorenzo Colitti 1846d0bfe22SLorenzo Colitti if (err) { 1856d0bfe22SLorenzo Colitti ICMP6_INC_STATS_BH(sock_net(sk), rt->rt6i_idev, 1866d0bfe22SLorenzo Colitti ICMP6_MIB_OUTERRORS); 1876d0bfe22SLorenzo Colitti ip6_flush_pending_frames(sk); 1886d0bfe22SLorenzo Colitti } else { 1896d0bfe22SLorenzo Colitti err = icmpv6_push_pending_frames(sk, &fl6, 1906d0bfe22SLorenzo Colitti (struct icmp6hdr *) &pfh.icmph, 1916d0bfe22SLorenzo Colitti len); 1926d0bfe22SLorenzo Colitti } 193a1bdc455SLorenzo Colitti release_sock(sk); 1946d0bfe22SLorenzo Colitti 195fbfe80c8SLorenzo Colitti if (err) 1966d0bfe22SLorenzo Colitti return err; 197fbfe80c8SLorenzo Colitti 198fbfe80c8SLorenzo Colitti return len; 1996d0bfe22SLorenzo Colitti } 200d862e546SLorenzo Colitti 201d862e546SLorenzo Colitti #ifdef CONFIG_PROC_FS 202d862e546SLorenzo Colitti static void *ping_v6_seq_start(struct seq_file *seq, loff_t *pos) 203d862e546SLorenzo Colitti { 204d862e546SLorenzo Colitti return ping_seq_start(seq, pos, AF_INET6); 205d862e546SLorenzo Colitti } 206d862e546SLorenzo Colitti 207a06a2d37SWu Fengguang static int ping_v6_seq_show(struct seq_file *seq, void *v) 208d862e546SLorenzo Colitti { 209d862e546SLorenzo Colitti if (v == SEQ_START_TOKEN) { 210d862e546SLorenzo Colitti seq_puts(seq, IPV6_SEQ_DGRAM_HEADER); 211d862e546SLorenzo Colitti } else { 212d862e546SLorenzo Colitti int bucket = ((struct ping_iter_state *) seq->private)->bucket; 213d862e546SLorenzo Colitti struct inet_sock *inet = inet_sk(v); 214d862e546SLorenzo Colitti __u16 srcp = ntohs(inet->inet_sport); 215d862e546SLorenzo Colitti __u16 destp = ntohs(inet->inet_dport); 216d862e546SLorenzo Colitti ip6_dgram_sock_seq_show(seq, v, srcp, destp, bucket); 217d862e546SLorenzo Colitti } 218d862e546SLorenzo Colitti return 0; 219d862e546SLorenzo Colitti } 220d862e546SLorenzo Colitti 221d862e546SLorenzo Colitti static struct ping_seq_afinfo ping_v6_seq_afinfo = { 222d862e546SLorenzo Colitti .name = "icmp6", 223d862e546SLorenzo Colitti .family = AF_INET6, 224d862e546SLorenzo Colitti .seq_fops = &ping_seq_fops, 225d862e546SLorenzo Colitti .seq_ops = { 226d862e546SLorenzo Colitti .start = ping_v6_seq_start, 227d862e546SLorenzo Colitti .show = ping_v6_seq_show, 228d862e546SLorenzo Colitti .next = ping_seq_next, 229d862e546SLorenzo Colitti .stop = ping_seq_stop, 230d862e546SLorenzo Colitti }, 231d862e546SLorenzo Colitti }; 232d862e546SLorenzo Colitti 233d862e546SLorenzo Colitti static int __net_init ping_v6_proc_init_net(struct net *net) 234d862e546SLorenzo Colitti { 235d862e546SLorenzo Colitti return ping_proc_register(net, &ping_v6_seq_afinfo); 236d862e546SLorenzo Colitti } 237d862e546SLorenzo Colitti 238d862e546SLorenzo Colitti static void __net_init ping_v6_proc_exit_net(struct net *net) 239d862e546SLorenzo Colitti { 240d862e546SLorenzo Colitti return ping_proc_unregister(net, &ping_v6_seq_afinfo); 241d862e546SLorenzo Colitti } 242d862e546SLorenzo Colitti 243d862e546SLorenzo Colitti static struct pernet_operations ping_v6_net_ops = { 244d862e546SLorenzo Colitti .init = ping_v6_proc_init_net, 245d862e546SLorenzo Colitti .exit = ping_v6_proc_exit_net, 246d862e546SLorenzo Colitti }; 247d862e546SLorenzo Colitti #endif 248d862e546SLorenzo Colitti 249d862e546SLorenzo Colitti int __init pingv6_init(void) 250d862e546SLorenzo Colitti { 251d862e546SLorenzo Colitti #ifdef CONFIG_PROC_FS 252d862e546SLorenzo Colitti int ret = register_pernet_subsys(&ping_v6_net_ops); 253d862e546SLorenzo Colitti if (ret) 254d862e546SLorenzo Colitti return ret; 255d862e546SLorenzo Colitti #endif 256d862e546SLorenzo Colitti pingv6_ops.ipv6_recv_error = ipv6_recv_error; 257d862e546SLorenzo Colitti pingv6_ops.ip6_datagram_recv_ctl = ip6_datagram_recv_ctl; 258d862e546SLorenzo Colitti pingv6_ops.icmpv6_err_convert = icmpv6_err_convert; 259d862e546SLorenzo Colitti pingv6_ops.ipv6_icmp_error = ipv6_icmp_error; 260d862e546SLorenzo Colitti pingv6_ops.ipv6_chk_addr = ipv6_chk_addr; 261d862e546SLorenzo Colitti return inet6_register_protosw(&pingv6_protosw); 262d862e546SLorenzo Colitti } 263d862e546SLorenzo Colitti 264d862e546SLorenzo Colitti /* This never gets called because it's not possible to unload the ipv6 module, 265d862e546SLorenzo Colitti * but just in case. 266d862e546SLorenzo Colitti */ 267d862e546SLorenzo Colitti void pingv6_exit(void) 268d862e546SLorenzo Colitti { 269d862e546SLorenzo Colitti pingv6_ops.ipv6_recv_error = dummy_ipv6_recv_error; 270d862e546SLorenzo Colitti pingv6_ops.ip6_datagram_recv_ctl = dummy_ip6_datagram_recv_ctl; 271d862e546SLorenzo Colitti pingv6_ops.icmpv6_err_convert = dummy_icmpv6_err_convert; 272d862e546SLorenzo Colitti pingv6_ops.ipv6_icmp_error = dummy_ipv6_icmp_error; 273d862e546SLorenzo Colitti pingv6_ops.ipv6_chk_addr = dummy_ipv6_chk_addr; 274d862e546SLorenzo Colitti #ifdef CONFIG_PROC_FS 275d862e546SLorenzo Colitti unregister_pernet_subsys(&ping_v6_net_ops); 276d862e546SLorenzo Colitti #endif 277d862e546SLorenzo Colitti inet6_unregister_protosw(&pingv6_protosw); 278d862e546SLorenzo Colitti } 279