#include <sys/param.h>
#include <sys/ioctl.h>
#include <sys/linker.h>
#include <sys/socket.h>
#include <net/if.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <err.h>
#include <errno.h>
#include <fcntl.h>
#include <stdio.h>
#include <string.h>
#include <unistd.h>
#define MULTICAST_IP "224.100.100.100"
#define DISC_IP "192.0.2.100"
#define DISC_MASK "255.255.255.0"
#define DISC_IFNAME "disc"
#define DISC_IFUNIT 100
static int
disc_setup(void)
{
struct ifreq ifr;
int s;
if (kldload("if_disc") < 0) {
switch (errno) {
case EEXIST:
break;
default:
warn("disc_setup: kldload(if_disc)");
return (-1);
}
}
s = socket(PF_INET, SOCK_RAW, 0);
if (s < 0) {
warn("disc_setup: socket(PF_INET, SOCK_RAW, 0)");
return (-1);
}
bzero(&ifr, sizeof(ifr));
snprintf(ifr.ifr_name, sizeof(ifr.ifr_name), "%s%d", DISC_IFNAME,
DISC_IFUNIT);
if (ioctl(s, SIOCIFCREATE, &ifr) < 0) {
warn("disc_setup: ioctl(%s, SIOCIFCREATE)", ifr.ifr_name);
close(s);
return (-1);
}
close(s);
return (0);
}
static void
disc_done(void)
{
struct ifreq ifr;
int s;
s = socket(PF_INET, SOCK_RAW, 0);
if (s < 0) {
warn("disc_done: socket(PF_INET, SOCK_RAW, 0)");
return;
}
bzero(&ifr, sizeof(ifr));
snprintf(ifr.ifr_name, sizeof(ifr.ifr_name), "%s%d", DISC_IFNAME,
DISC_IFUNIT);
if (ioctl(s, SIOCIFDESTROY, &ifr) < 0)
warn("disc_done: ioctl(%s, SIOCIFDESTROY)", ifr.ifr_name);
close(s);
}
static int
ifconfig_inet(char *ifname, int ifunit, char *ip, char *netmask)
{
struct sockaddr_in *sinp;
struct ifaliasreq ifra;
int s;
s = socket(PF_INET, SOCK_RAW, 0);
if (s < 0) {
warn("ifconfig_inet: socket(PF_INET, SOCK_RAW, 0)");
return (-1);
}
bzero(&ifra, sizeof(ifra));
snprintf(ifra.ifra_name, sizeof(ifra.ifra_name), "%s%d", ifname,
ifunit);
sinp = (struct sockaddr_in *)&ifra.ifra_addr;
sinp->sin_family = AF_INET;
sinp->sin_len = sizeof(ifra.ifra_addr);
sinp->sin_addr.s_addr = inet_addr(ip);
sinp = (struct sockaddr_in *)&ifra.ifra_mask;
sinp->sin_family = AF_INET;
sinp->sin_len = sizeof(ifra.ifra_addr);
sinp->sin_addr.s_addr = inet_addr(netmask);
if (ioctl(s, SIOCAIFADDR, &ifra) < 0) {
warn("ifconfig_inet: ioctl(%s%d, SIOCAIFADDR, %s)", ifname,
ifunit, ip);
close(s);
return (-1);
}
close(s);
return (0);
}
static int
multicast_open(int *sockp, int type, const char *type_string)
{
struct ip_mreq imr;
int sock;
sock = socket(PF_INET, type, 0);
if (sock < 0) {
warn("multicast_test: socket(PF_INET, %s, 0)", type_string);
return (-1);
}
bzero(&imr, sizeof(imr));
imr.imr_multiaddr.s_addr = inet_addr(MULTICAST_IP);
imr.imr_interface.s_addr = inet_addr(DISC_IP);
if (setsockopt(sock, IPPROTO_IP, IP_ADD_MEMBERSHIP, &imr,
sizeof(imr)) < 0) {
warn("multicast_test: setsockopt(IPPROTO_IP, "
"IP_ADD_MEMBERSHIP, {%s, %s})", MULTICAST_IP, DISC_IP);
close(sock);
return (-1);
}
*sockp = sock;
return (0);
}
static void
multicast_close(int udp_socket)
{
close(udp_socket);
}
static int
test_sock_type(int type, const char *type_string)
{
int sock;
if (disc_setup() < 0)
return (-1);
if (ifconfig_inet(DISC_IFNAME, DISC_IFUNIT, DISC_IP, DISC_MASK) < 0) {
disc_done();
return (-1);
}
if (multicast_open(&sock, type, type_string) < 0) {
disc_done();
return (-1);
}
disc_done();
multicast_close(sock);
printf("test_sock_type(%s) passed\n", type_string);
return (0);
}
int
main(int argc, char *argv[])
{
if (test_sock_type(SOCK_RAW, "SOCK_RAW") < 0)
return (-1);
if (test_sock_type(SOCK_DGRAM, "SOCK_DGRAM") < 0)
return (-1);
return (0);
}