/* $KAME: mld6.c,v 1.11 2001/05/13 15:45:07 suz Exp $ */ /* * Copyright (C) 1998 WIDE Project. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. Neither the name of the project nor the names of its contributors * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * $FreeBSD: src/usr.sbin/mld6query/mld6.c,v 1.1.1.1.2.2 2001/07/03 11:02:06 ume Exp $ */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include static struct msghdr m; static struct sockaddr_in6 dst; static struct mld6_hdr mldh; static struct in6_addr maddr = IN6ADDR_ANY_INIT, any = IN6ADDR_ANY_INIT; static struct ipv6_mreq mreq; static u_short ifindex; static int s; #define QUERY_RESPONSE_INTERVAL 10000 static void make_msg(int, struct in6_addr *, u_int); static void usage(void) __dead2; static void dump(int); static void quit(int) __dead2; int main(int argc, char *argv[]) { int i; struct icmp6_filter filt; u_int hlim = 1; fd_set fdset; struct itimerval itimer; u_int type; int ch; type = MLD6_LISTENER_QUERY; while ((ch = getopt(argc, argv, "dr")) != -1) { switch (ch) { case 'd': type = MLD6_LISTENER_DONE; break; case 'r': type = MLD6_LISTENER_REPORT; break; default: usage(); /*NOTREACHED*/ } } argv += optind; argc -= optind; if (argc != 1 && argc != 2) usage(); ifindex = (u_short)if_nametoindex(argv[0]); if (ifindex == 0) usage(); if (argc == 2 && inet_pton(AF_INET6, argv[1], &maddr) != 1) usage(); if ((s = socket(AF_INET6, SOCK_RAW, IPPROTO_ICMPV6)) < 0) err(1, "socket"); if (setsockopt(s, IPPROTO_IPV6, IPV6_MULTICAST_HOPS, &hlim, sizeof(hlim)) == -1) err(1, "setsockopt(IPV6_MULTICAST_HOPS)"); mreq.ipv6mr_multiaddr = any; mreq.ipv6mr_interface = ifindex; if (setsockopt(s, IPPROTO_IPV6, IPV6_JOIN_GROUP, &mreq, sizeof(mreq)) == -1) err(1, "setsockopt(IPV6_JOIN_GROUP)"); ICMP6_FILTER_SETBLOCKALL(&filt); ICMP6_FILTER_SETPASS(ICMP6_MEMBERSHIP_QUERY, &filt); ICMP6_FILTER_SETPASS(ICMP6_MEMBERSHIP_REPORT, &filt); ICMP6_FILTER_SETPASS(ICMP6_MEMBERSHIP_REDUCTION, &filt); if (setsockopt(s, IPPROTO_ICMPV6, ICMP6_FILTER, &filt, sizeof(filt)) < 0) err(1, "setsockopt(ICMP6_FILTER)"); make_msg(ifindex, &maddr, type); if (sendmsg(s, &m, 0) < 0) err(1, "sendmsg"); itimer.it_value.tv_sec = QUERY_RESPONSE_INTERVAL / 1000; itimer.it_interval.tv_sec = 0; itimer.it_interval.tv_usec = 0; itimer.it_value.tv_usec = 0; signal(SIGALRM, quit); setitimer(ITIMER_REAL, &itimer, NULL); FD_ZERO(&fdset); for (;;) { FD_SET(s, &fdset); if ((i = select(s + 1, &fdset, NULL, NULL, NULL)) < 0) perror("select"); if (i == 0) continue; else dump(s); } } static void make_msg(int idx, struct in6_addr *addr, u_int type) { static struct iovec iov[2]; static u_char *cmsgbuf; int cmsglen, hbhlen = 0; u_int8_t raopt[IP6OPT_RTALERT_LEN]; struct in6_pktinfo *pi; struct cmsghdr *cmsgp; u_short rtalert_code = htons(IP6OPT_RTALERT_MLD); dst.sin6_len = sizeof(dst); dst.sin6_family = AF_INET6; if (IN6_IS_ADDR_UNSPECIFIED(addr)) { if (inet_pton(AF_INET6, "ff02::1", &dst.sin6_addr) != 1) errx(1, "inet_pton failed"); } else dst.sin6_addr = *addr; m.msg_name = (caddr_t)&dst; m.msg_namelen = dst.sin6_len; iov[0].iov_base = (caddr_t)&mldh; iov[0].iov_len = sizeof(mldh); m.msg_iov = iov; m.msg_iovlen = 1; bzero(&mldh, sizeof(mldh)); mldh.mld6_type = type & 0xff; mldh.mld6_maxdelay = htons(QUERY_RESPONSE_INTERVAL); mldh.mld6_addr = *addr; hbhlen = sizeof(raopt); cmsglen = CMSG_SPACE(sizeof(struct in6_pktinfo)) + inet6_option_space(hbhlen); if ((cmsgbuf = malloc(cmsglen)) == NULL) errx(1, "can't allocate enough memory for cmsg"); cmsgp = (struct cmsghdr *)cmsgbuf; m.msg_control = (caddr_t)cmsgbuf; m.msg_controllen = cmsglen; /* specify the outgoing interface */ cmsgp->cmsg_len = CMSG_LEN(sizeof(struct in6_pktinfo)); cmsgp->cmsg_level = IPPROTO_IPV6; cmsgp->cmsg_type = IPV6_PKTINFO; pi = (struct in6_pktinfo *)CMSG_DATA(cmsgp); pi->ipi6_ifindex = idx; memset(&pi->ipi6_addr, 0, sizeof(pi->ipi6_addr)); /* specifiy to insert router alert option in a hop-by-hop opt hdr. */ cmsgp = CMSG_NXTHDR(&m, cmsgp); if (inet6_option_init((void *)cmsgp, &cmsgp, IPV6_HOPOPTS)) errx(1, "inet6_option_init failed\n"); raopt[0] = IP6OPT_RTALERT; raopt[1] = IP6OPT_RTALERT_LEN - 2; memcpy(&raopt[2], (caddr_t)&rtalert_code, sizeof(u_short)); if (inet6_option_append(cmsgp, raopt, 4, 0)) errx(1, "inet6_option_append failed\n"); } static void dump(int sockdesc) { ssize_t i; struct mld6_hdr *mld; u_char buf[1024]; struct sockaddr_in6 from; int from_len = sizeof(from); char ntop_buf[256]; if ((i = recvfrom(sockdesc, buf, sizeof(buf), 0, (struct sockaddr *)&from, &from_len)) < 0) return; if ((size_t)i < sizeof(struct mld6_hdr)) { printf("too short!\n"); return; } mld = (struct mld6_hdr *)buf; printf("from %s, ", inet_ntop(AF_INET6, &from.sin6_addr, ntop_buf, sizeof(ntop_buf))); switch (mld->mld6_type) { case ICMP6_MEMBERSHIP_QUERY: printf("type=Multicast Listener Query, "); break; case ICMP6_MEMBERSHIP_REPORT: printf("type=Multicast Listener Report, "); break; case ICMP6_MEMBERSHIP_REDUCTION: printf("type=Multicast Listener Done, "); break; } printf("addr=%s\n", inet_ntop(AF_INET6, &mld->mld6_addr, ntop_buf, sizeof(ntop_buf))); fflush(stdout); } /* ARGSUSED */ static void quit(__unused int signum) { mreq.ipv6mr_multiaddr = any; mreq.ipv6mr_interface = ifindex; if (setsockopt(s, IPPROTO_IPV6, IPV6_LEAVE_GROUP, &mreq, sizeof(mreq)) == -1) err(1, "setsockopt(IPV6_LEAVE_GROUP)"); exit(0); } static void usage(void) { fprintf(stderr, "usage: mld6query ifname [addr]\n"); exit(1); }