#ifdef HAVE_CONFIG_H
# include <config.h>
#endif
#include <os/trace.h>
#include <stdio.h>
#include <signal.h>
#ifdef HAVE_SYS_PARAM_H
# include <sys/param.h>
#endif
#ifdef HAVE_SYS_IOCTL_H
# include <sys/ioctl.h>
#endif
#ifdef HAVE_SYS_SOCKIO_H
# include <sys/sockio.h>
#endif
#ifdef HAVE_SYS_UIO_H
# include <sys/uio.h>
#endif
#include "ntp_machine.h"
#include "ntpd.h"
#include "ntp_io.h"
#include "iosignal.h"
#include "ntp_lists.h"
#include "ntp_refclock.h"
#include "ntp_stdlib.h"
#include "ntp_request.h"
#include "ntp.h"
#include "ntp_unixtime.h"
#include "ntp_assert.h"
#include "ntpd-opts.h"
#define ISC_IPV6_H 1
#include <isc/mem.h>
#include <isc/interfaceiter.h>
#include <isc/netaddr.h>
#include <isc/result.h>
#include <isc/sockaddr.h>
#ifdef SIM
#include "ntpsim.h"
#endif
#ifdef HAS_ROUTING_SOCKET
# include <net/route.h>
# ifdef HAVE_RTNETLINK
# include <linux/rtnetlink.h>
# endif
#endif
#ifndef SETSOCKOPT_ARG_CAST
#define SETSOCKOPT_ARG_CAST
#endif
extern int listen_to_virtual_ips;
typedef struct nic_rule_tag nic_rule;
struct nic_rule_tag {
nic_rule * next;
nic_rule_action action;
nic_rule_match match_type;
char * if_name;
isc_netaddr_t netaddr;
int prefixlen;
};
nic_rule *nic_rule_list;
#if defined(SO_TIMESTAMP) && defined(SCM_TIMESTAMP)
#if defined(CMSG_FIRSTHDR)
#define HAVE_TIMESTAMP
#define USE_TIMESTAMP_CMSG
#ifndef TIMESTAMP_CTLMSGBUF_SIZE
#define TIMESTAMP_CTLMSGBUF_SIZE 1536
#endif
#else
#endif
#endif
#include <net/if.h>
#include <netinet/in_var.h>
#include <netinet6/in6_var.h>
#define IN6_AVOID_FLAGS (IN6_IFF_TEMPORARY|IN6_IFF_NOTREADY|IN6_IFF_DETACHED|IN6_IFF_DEPRECATED)
#if defined(SYS_WINNT)
#include <transmitbuff.h>
#include <isc/win32os.h>
#define ioctl(fd, opt, val) ioctlsocket((fd), (opt), (u_long *)(val))
#endif
volatile u_long packets_dropped;
volatile u_long packets_ignored;
volatile u_long packets_received;
u_long packets_sent;
u_long packets_notsent;
volatile u_long handler_calls;
volatile u_long handler_pkts;
u_long io_timereset;
struct interface *any_interface;
struct interface *any6_interface;
struct interface *loopback_interface;
isc_boolean_t broadcast_client_enabled;
int ninterfaces;
int disable_dynamic_updates;
#ifdef REFCLOCK
static struct refclockio *refio;
#endif
#if defined(HAVE_IPTOS_SUPPORT)
# if defined(IPTOS_PREC_INTERNETCONTROL)
unsigned int qos = IPTOS_PREC_INTERNETCONTROL;
# else
unsigned int qos = IPTOS_LOWDELAY;
# endif
#endif
fd_set activefds;
int maxactivefd;
static u_short sys_interphase = 0;
static struct interface *new_interface (struct interface *);
static void add_interface (struct interface *);
static int update_interfaces(u_short, interface_receiver_t, void *);
static void remove_interface(struct interface *);
static struct interface *create_interface(u_short, struct interface *, int *);
static int move_fd (SOCKET);
static int is_wildcard_addr (sockaddr_u *);
static int is_wildcard_netaddr (const isc_netaddr_t *);
static isc_boolean_t addr_ismulticast (sockaddr_u *);
#ifdef MCAST
static isc_boolean_t socket_multicast_enable (struct interface *, int, sockaddr_u *);
static isc_boolean_t socket_multicast_disable(struct interface *, sockaddr_u *);
#endif
#ifdef DEBUG
static void interface_dump (struct interface *);
static void sockaddr_dump (sockaddr_u *psau);
static void print_interface (struct interface *, char *, char *);
#define DPRINT_INTERFACE(level, args) do { if (debug >= (level)) { print_interface args; } } while (0)
#else
#define DPRINT_INTERFACE(level, args) do {} while (0)
#endif
typedef struct vsock vsock_t;
enum desc_type { FD_TYPE_SOCKET, FD_TYPE_FILE };
struct vsock {
vsock_t * link;
SOCKET fd;
enum desc_type type;
};
vsock_t *fd_list;
#if !defined(HAVE_IO_COMPLETION_PORT) && defined(HAS_ROUTING_SOCKET)
struct asyncio_reader {
struct asyncio_reader *link;
SOCKET fd;
void *data;
void (*receiver)(struct asyncio_reader *);
};
struct asyncio_reader *asyncio_reader_list;
static void delete_asyncio_reader (struct asyncio_reader *);
static struct asyncio_reader *new_asyncio_reader (void);
static void add_asyncio_reader (struct asyncio_reader *, enum desc_type);
static void remove_asyncio_reader (struct asyncio_reader *);
#endif
static void init_async_notifications (void);
static int create_sockets (u_short);
static SOCKET open_socket (sockaddr_u *, int, int, struct interface *);
static char * fdbits (int, fd_set *);
static void set_reuseaddr (int);
static isc_boolean_t socket_broadcast_enable (struct interface *, SOCKET, sockaddr_u *);
static isc_boolean_t socket_broadcast_disable (struct interface *, sockaddr_u *);
typedef struct remaddr remaddr_t;
struct remaddr {
remaddr_t * link;
sockaddr_u addr;
struct interface * interface;
};
remaddr_t * remoteaddr_list;
struct interface * inter_list;
static struct interface *wildipv4 = NULL;
static struct interface *wildipv6 = NULL;
static void add_fd_to_list (SOCKET,
enum desc_type);
static struct interface *find_addr_in_list (sockaddr_u *);
static struct interface *find_samenet_addr_in_list(sockaddr_u *);
static struct interface *find_flagged_addr_in_list(sockaddr_u *, int);
static void delete_addr_from_list (sockaddr_u *);
static void delete_interface_from_list(struct interface *);
static void close_and_delete_fd_from_list(SOCKET);
static void add_addr_to_list (sockaddr_u *,
struct interface *);
static void create_wildcards (u_short);
#ifdef DEBUG
static const char * action_text (nic_rule_action);
#endif
static nic_rule_action interface_action(char *, isc_netaddr_t *,
isc_uint32_t);
static void convert_isc_if (isc_interface_t *,
struct interface *, u_short);
static struct interface *getinterface (sockaddr_u *, int);
static struct interface *getsamenetinterface (sockaddr_u *, int);
static struct interface *findlocalinterface (sockaddr_u *, int, int);
static struct interface *findlocalcastinterface (sockaddr_u *);
#if !defined(HAVE_IO_COMPLETION_PORT)
static inline int read_network_packet (SOCKET, struct interface *, l_fp);
static inline int read_refclock_packet (SOCKET, struct refclockio *, l_fp);
#endif
#ifdef SYS_WINNT
void
connection_reset_fix(
SOCKET fd,
sockaddr_u * addr
)
{
DWORD dw;
BOOL bNewBehavior = FALSE;
DWORD status;
if (isc_win32os_majorversion() >= 5) {
status = WSAIoctl(fd, SIO_UDP_CONNRESET, &bNewBehavior,
sizeof(bNewBehavior), NULL, 0,
&dw, NULL, NULL);
if (SOCKET_ERROR == status)
msyslog(LOG_ERR,
"connection_reset_fix() failed for address %s: %m",
stoa(addr));
}
}
#endif
static int
move_fd(
SOCKET fd
)
{
#if !defined(SYS_WINNT) && defined(F_DUPFD)
#ifndef FD_CHUNK
#define FD_CHUNK 10
#endif
#ifndef FD_PREFERRED_SOCKBOUNDARY
#define FD_PREFERRED_SOCKBOUNDARY 48
#endif
#ifndef HAVE_GETDTABLESIZE
#define getdtablesize() (FOPEN_MAX+FD_CHUNK)
#endif
#ifndef FOPEN_MAX
#define FOPEN_MAX 20
#endif
static SOCKET socket_boundary = -1;
SOCKET newfd;
NTP_REQUIRE((int)fd >= 0);
if (socket_boundary == -1) {
socket_boundary = max(0, min(getdtablesize() - FD_CHUNK,
min(FOPEN_MAX, FD_PREFERRED_SOCKBOUNDARY)));
#ifdef DEBUG
msyslog(LOG_DEBUG,
"ntp_io: estimated max descriptors: %d, initial socket boundary: %d",
getdtablesize(), socket_boundary);
#endif
}
do {
if (fd >= 0 && fd < socket_boundary) {
newfd = fcntl(fd, F_DUPFD, socket_boundary);
if (newfd != -1) {
close(fd);
return newfd;
}
} else {
return fd;
}
socket_boundary = max(0, socket_boundary - FD_CHUNK);
#ifdef DEBUG
msyslog(LOG_DEBUG,
"ntp_io: selecting new socket boundary: %d",
socket_boundary);
#endif
} while (socket_boundary > 0);
#else
NTP_REQUIRE((int)fd >= 0);
#endif
return fd;
}
#ifdef DEBUG_TIMING
void
collect_timing(struct recvbuf *rb, const char *tag, int count, l_fp *dts)
{
char buf[256];
snprintf(buf, sizeof(buf), "%s %d %s %s",
(rb != NULL)
? ((rb->dstadr != NULL)
? stoa(&rb->recv_srcadr)
: "-REFCLOCK-")
: "-",
count, lfptoa(dts, 9), tag);
record_timing_stats(buf);
}
#endif
void
init_io(void)
{
init_recvbuff(RECV_INIT);
#ifdef SYS_WINNT
init_io_completion_port();
#endif
#if defined(HAVE_SIGNALED_IO)
(void) set_signal();
#endif
}
void
io_open_sockets(void)
{
static int already_opened;
if (already_opened || HAVE_OPT( SAVECONFIGQUIT ))
return;
already_opened = 1;
BLOCKIO();
create_sockets(NTP_PORT);
UNBLOCKIO();
init_async_notifications();
DPRINTF(3, ("io_open_sockets: maxactivefd %d\n", maxactivefd));
}
#ifdef DEBUG
void
interface_dump(struct interface *itf)
{
printf("Dumping interface: %p\n", itf);
printf("fd = %d\n", itf->fd);
printf("bfd = %d\n", itf->bfd);
printf("sin = %s,\n", stoa(&itf->sin));
sockaddr_dump(&itf->sin);
printf("bcast = %s,\n", stoa(&itf->bcast));
sockaddr_dump(&itf->bcast);
printf("mask = %s,\n", stoa(&itf->mask));
sockaddr_dump(&itf->mask);
printf("name = %s\n", itf->name);
printf("flags = 0x%08x\n", itf->flags);
printf("last_ttl = %d\n", itf->last_ttl);
printf("addr_refid = %08x\n", itf->addr_refid);
printf("num_mcast = %d\n", itf->num_mcast);
printf("received = %ld\n", itf->received);
printf("sent = %ld\n", itf->sent);
printf("notsent = %ld\n", itf->notsent);
printf("scopeid = %u\n", itf->scopeid);
printf("peercnt = %u\n", itf->peercnt);
printf("phase = %u\n", itf->phase);
}
static void
sockaddr_dump(sockaddr_u *psau)
{
const int maxsize = min(32, sizeof(psau->sas));
u_char * cp;
int i;
cp = (u_char *)&psau->sas;
for(i = 0; i < maxsize; i++)
{
printf("%02x", *cp++);
if (!((i + 1) % 4))
printf(" ");
}
printf("\n");
}
static void
print_interface(struct interface *iface, char *pfx, char *sfx)
{
printf("%sinterface #%d: fd=%d, bfd=%d, name=%s, flags=0x%x, scope=%d, sin=%s",
pfx,
iface->ifnum,
iface->fd,
iface->bfd,
iface->name,
iface->flags,
iface->scopeid,
stoa(&iface->sin));
if (AF_INET == iface->family) {
if (iface->flags & INT_BROADCAST)
printf(", bcast=%s", stoa(&iface->bcast));
printf(", mask=%s", stoa(&iface->mask));
}
printf(", %s:%s",
(iface->ignore_packets)
? "Disabled"
: "Enabled",
sfx);
if (debug > 4)
interface_dump(iface);
}
#endif
#if !defined(HAVE_IO_COMPLETION_PORT) && defined(HAS_ROUTING_SOCKET)
static struct asyncio_reader *
new_asyncio_reader(void)
{
struct asyncio_reader *reader;
reader = emalloc(sizeof(*reader));
memset(reader, 0, sizeof(*reader));
reader->fd = INVALID_SOCKET;
return reader;
}
static void
delete_asyncio_reader(
struct asyncio_reader *reader
)
{
free(reader);
}
static void
add_asyncio_reader(
struct asyncio_reader * reader,
enum desc_type type)
{
LINK_SLIST(asyncio_reader_list, reader, link);
add_fd_to_list(reader->fd, type);
}
static void
remove_asyncio_reader(
struct asyncio_reader *reader
)
{
struct asyncio_reader *unlinked;
UNLINK_SLIST(unlinked, asyncio_reader_list, reader, link,
struct asyncio_reader);
if (reader->fd != INVALID_SOCKET)
close_and_delete_fd_from_list(reader->fd);
reader->fd = INVALID_SOCKET;
}
#endif
isc_boolean_t
is_ip_address(
const char * host,
isc_netaddr_t * addr
)
{
struct in_addr in4;
struct in6_addr in6;
char tmpbuf[128];
char *pch;
NTP_REQUIRE(host != NULL);
NTP_REQUIRE(addr != NULL);
if (inet_pton(AF_INET, host, &in4) == 1) {
isc_netaddr_fromin(addr, &in4);
return (ISC_TRUE);
} else if (sizeof(tmpbuf) > strlen(host)) {
if ('[' == host[0]) {
strncpy(tmpbuf, &host[1], sizeof(tmpbuf));
pch = strchr(tmpbuf, ']');
if (pch != NULL)
*pch = '\0';
} else
strncpy(tmpbuf, host, sizeof(tmpbuf));
pch = strchr(tmpbuf, '%');
if (pch != NULL)
*pch = '\0';
if (inet_pton(AF_INET6, tmpbuf, &in6) == 1) {
isc_netaddr_fromin6(addr, &in6);
return (ISC_TRUE);
}
}
return (ISC_FALSE);
}
void
interface_enumerate(
interface_receiver_t receiver,
void * data
)
{
interface_info_t ifi;
ifi.action = IFS_EXISTS;
for (ifi.interface = inter_list;
ifi.interface != NULL;
ifi.interface = ifi.interface->link)
(*receiver)(data, &ifi);
}
static void
init_interface(
struct interface *iface
)
{
memset(iface, 0, sizeof(*iface));
iface->fd = INVALID_SOCKET;
iface->bfd = INVALID_SOCKET;
iface->phase = sys_interphase;
}
static struct interface *
new_interface(
struct interface *interface
)
{
static u_int sys_ifnum = 0;
struct interface * iface;
iface = emalloc(sizeof(*iface));
if (NULL == interface)
init_interface(iface);
else
memcpy(iface, interface, sizeof(*iface));
iface->ifnum = sys_ifnum++;
iface->starttime = current_time;
return iface;
}
static inline void
delete_interface(
struct interface *interface
)
{
free(interface);
}
static void
add_interface(
struct interface *interface
)
{
interface->addr_refid = addr2refid(&interface->sin);
LINK_SLIST(inter_list, interface, link);
ninterfaces++;
}
static void
remove_interface(
struct interface *iface
)
{
struct interface *unlinked;
sockaddr_u resmask;
UNLINK_SLIST(unlinked, inter_list, iface, link, struct
interface);
delete_interface_from_list(iface);
if (iface->fd != INVALID_SOCKET) {
msyslog(LOG_INFO,
"Deleting interface #%d %s, %s#%d, interface stats: received=%ld, sent=%ld, dropped=%ld, active_time=%ld secs",
iface->ifnum,
iface->name,
stoa(&iface->sin),
SRCPORT(&iface->sin),
iface->received,
iface->sent,
iface->notsent,
current_time - iface->starttime);
close_and_delete_fd_from_list(iface->fd);
}
if (iface->bfd != INVALID_SOCKET) {
msyslog(LOG_INFO,
"Deleting broadcast address %s#%d from interface #%d %s",
stoa(&iface->bcast),
SRCPORT(&iface->bcast),
iface->ifnum,
iface->name);
close_and_delete_fd_from_list(iface->bfd);
}
ninterfaces--;
ntp_monclearinterface(iface);
SET_HOSTMASK(&resmask, AF(&iface->sin));
hack_restrict(RESTRICT_REMOVEIF, &iface->sin, &resmask,
RESM_NTPONLY | RESM_INTERFACE, RES_IGNORE);
}
static void
list_if_listening(
struct interface * iface
)
{
msyslog(LOG_INFO, "%s on %d %s %s UDP %d",
(iface->ignore_packets)
? "Listen and drop"
: "Listen normally",
iface->ifnum,
iface->name,
stoa(&iface->sin),
SRCPORT(&iface->sin));
}
static void
create_wildcards(
u_short port
)
{
int v4wild, v6wild;
sockaddr_u wildaddr;
isc_netaddr_t wnaddr;
nic_rule_action action;
struct interface * wildif;
action = ACTION_LISTEN;
memset(&wildaddr, 0, sizeof(wildaddr));
v4wild = ipv4_works;
if (v4wild) {
AF(&wildaddr) = AF_INET;
SET_ADDR4(&wildaddr, INADDR_ANY);
SET_PORT(&wildaddr, port);
isc_netaddr_fromin(&wnaddr, &wildaddr.sa4.sin_addr);
action = interface_action(NULL, &wnaddr, 0);
v4wild = (ACTION_IGNORE != action);
}
if (v4wild) {
wildif = new_interface(NULL);
strncpy(wildif->name, "v4wildcard", sizeof(wildif->name));
memcpy(&wildif->sin, &wildaddr, sizeof(wildif->sin));
wildif->family = AF_INET;
AF(&wildif->mask) = AF_INET;
SET_ONESMASK(&wildif->mask);
wildif->flags = INT_BROADCAST | INT_UP | INT_WILDCARD;
wildif->ignore_packets = (ACTION_DROP == action);
#if defined(MCAST)
AF(&wildif->bcast) = AF_INET;
SET_ADDR4(&wildif->bcast, INADDR_ANY);
SET_PORT(&wildif->bcast, port);
#endif
wildif->fd = open_socket(&wildif->sin, 0, 1, wildif);
if (wildif->fd != INVALID_SOCKET) {
wildipv4 = wildif;
any_interface = wildif;
add_addr_to_list(&wildif->sin, wildif);
add_interface(wildif);
list_if_listening(wildif);
} else {
msyslog(LOG_ERR,
"unable to bind to wildcard address %s - another process may be running - EXITING",
stoa(&wildif->sin));
exit(1);
}
DPRINT_INTERFACE(2, (wildif, "created ", "\n"));
}
#ifdef INCLUDE_IPV6_SUPPORT
v6wild = ipv6_works;
if (v6wild) {
memset(&wildaddr, 0, sizeof(wildaddr));
AF(&wildaddr) = AF_INET6;
SET_ADDR6N(&wildaddr, in6addr_any);
SET_PORT(&wildaddr, port);
SET_SCOPE(&wildaddr, 0);
isc_netaddr_fromin(&wnaddr, &wildaddr.sa4.sin_addr);
action = interface_action(NULL, &wnaddr, 0);
v6wild = (ACTION_IGNORE != action);
}
if (v6wild) {
wildif = new_interface(NULL);
strncpy(wildif->name, "v6wildcard", sizeof(wildif->name));
memcpy(&wildif->sin, &wildaddr, sizeof(wildif->sin));
wildif->family = AF_INET6;
AF(&wildif->mask) = AF_INET6;
SET_ONESMASK(&wildif->mask);
wildif->flags = INT_UP | INT_WILDCARD;
wildif->ignore_packets = (ACTION_DROP == action);
wildif->fd = open_socket(&wildif->sin, 0, 1, wildif);
if (wildif->fd != INVALID_SOCKET) {
wildipv6 = wildif;
any6_interface = wildif;
add_addr_to_list(&wildif->sin, wildif);
add_interface(wildif);
list_if_listening(wildif);
} else {
msyslog(LOG_ERR,
"unable to bind to wildcard address %s - another process may be running - EXITING",
stoa(&wildif->sin));
exit(1);
}
DPRINT_INTERFACE(2, (wildif, "created ", "\n"));
}
#endif
}
void
add_nic_rule(
nic_rule_match match_type,
const char * if_name,
int prefixlen,
nic_rule_action action
)
{
nic_rule * rule;
isc_boolean_t is_ip;
rule = emalloc(sizeof(*rule));
memset(rule, 0, sizeof(*rule));
rule->match_type = match_type;
rule->prefixlen = prefixlen;
rule->action = action;
if (MATCH_IFNAME == match_type) {
NTP_REQUIRE(NULL != if_name);
rule->if_name = estrdup(if_name);
} else if (MATCH_IFADDR == match_type) {
NTP_REQUIRE(NULL != if_name);
is_ip = is_ip_address(if_name, &rule->netaddr);
NTP_REQUIRE(is_ip);
} else
NTP_REQUIRE(NULL == if_name);
LINK_SLIST(nic_rule_list, rule, next);
}
#ifdef DEBUG
static const char *
action_text(
nic_rule_action action
)
{
const char *t;
switch (action) {
default:
t = "ERROR";
DPRINTF(1, ("fatal: unknown nic_rule_action %d\n",
action));
NTP_ENSURE(0);
break;
case ACTION_LISTEN:
t = "listen";
break;
case ACTION_IGNORE:
t = "ignore";
break;
case ACTION_DROP:
t = "drop";
break;
}
return t;
}
#endif
static nic_rule_action
interface_action(
char * if_name,
isc_netaddr_t * if_netaddr,
isc_uint32_t if_flags
)
{
nic_rule *rule;
int isloopback;
int iswildcard;
DPRINTF(4, ("interface_action: interface %s ",
(if_name != NULL) ? if_name : "wildcard"));
iswildcard = is_wildcard_netaddr(if_netaddr);
if (if_flags & INTERFACE_F_LOOPBACK) {
isloopback = 1;
if (AF_INET == if_netaddr->family) {
DPRINTF(4, ("IPv4 loopback - listen\n"));
return ACTION_LISTEN;
}
} else
isloopback = 0;
for (rule = nic_rule_list; rule != NULL; rule = rule->next) {
switch (rule->match_type) {
case MATCH_ALL:
if (isloopback || iswildcard)
break;
DPRINTF(4, ("nic all %s\n",
action_text(rule->action)));
return rule->action;
case MATCH_IPV4:
if (AF_INET == if_netaddr->family) {
DPRINTF(4, ("nic ipv4 %s\n",
action_text(rule->action)));
return rule->action;
}
break;
case MATCH_IPV6:
if (AF_INET6 == if_netaddr->family) {
DPRINTF(4, ("nic ipv6 %s\n",
action_text(rule->action)));
return rule->action;
}
break;
case MATCH_WILDCARD:
if (iswildcard) {
DPRINTF(4, ("nic wildcard %s\n",
action_text(rule->action)));
return rule->action;
}
break;
case MATCH_IFADDR:
if (rule->prefixlen != -1) {
if (isc_netaddr_eqprefix(if_netaddr,
&rule->netaddr, rule->prefixlen)) {
DPRINTF(4, ("subnet address match - %s\n",
action_text(rule->action)));
return rule->action;
}
} else
if (isc_netaddr_equal(if_netaddr,
&rule->netaddr)) {
DPRINTF(4, ("address match - %s\n",
action_text(rule->action)));
return rule->action;
}
break;
case MATCH_IFNAME:
if (if_name != NULL
&& !strcasecmp(if_name, rule->if_name)) {
DPRINTF(4, ("interface name match - %s\n",
action_text(rule->action)));
return rule->action;
}
break;
}
}
if (isloopback) {
DPRINTF(4, ("default loopback listen\n"));
return ACTION_LISTEN;
}
if (iswildcard) {
DPRINTF(4, ("default wildcard drop\n"));
return ACTION_DROP;
}
if (!listen_to_virtual_ips && if_name != NULL
&& (strchr(if_name, ':') != NULL)) {
DPRINTF(4, ("virtual ip - ignore\n"));
return ACTION_IGNORE;
}
if (AF_INET6 == if_netaddr->family) {
struct in6_ifreq ifr6 = {
.ifr_addr.sin6_len = sizeof(struct sockaddr_in6),
.ifr_addr.sin6_family = AF_INET6,
.ifr_addr.sin6_addr = if_netaddr->type.in6,
};
struct sockaddr_in6 sa6 = ifr6.ifr_addr;
strlcpy(ifr6.ifr_name, if_name, sizeof(ifr6.ifr_name));
int s6 = socket(AF_INET6, SOCK_DGRAM, 0);
if (s6 >= 0) {
int on = 1;
setsockopt(s6, SOL_SOCKET, SO_REUSEADDR, (char *)&on, sizeof(on));
if (ioctl(s6, SIOCGIFAFLAG_IN6, &ifr6) == 0) {
if (ifr6.ifr_ifru.ifru_flags6 & IN6_AVOID_FLAGS) {
os_trace_debug("Ignoring IPv6 address because 0x%x",
ifr6.ifr_ifru.ifru_flags6 & IN6_AVOID_FLAGS);
goto bail;
}
} else { int save_errno = errno;
msyslog(LOG_DEBUG, "Ignoring address %s because ioctl failed errno:%d",
stoa((sockaddr_u *)&sa6), save_errno);
os_trace_debug("Ignoring IPv6 address because ioctl failed errno:%d", save_errno);
bail:
close(s6);
return ACTION_IGNORE;
}
close(s6);
} else {
os_trace("Failed to create IPv6 dgram socket errno:%d", errno);
}
}
if (NULL == nic_rule_list) {
DPRINTF(4, ("default listen\n"));
return ACTION_LISTEN;
}
DPRINTF(4, ("implicit ignore\n"));
return ACTION_IGNORE;
}
static void
convert_isc_if(
isc_interface_t *isc_if,
struct interface *itf,
u_short port
)
{
strncpy(itf->name, isc_if->name, sizeof(itf->name));
itf->name[sizeof(itf->name) - 1] = 0;
itf->family = (u_short)isc_if->af;
AF(&itf->sin) = itf->family;
AF(&itf->mask) = itf->family;
AF(&itf->bcast) = itf->family;
SET_PORT(&itf->sin, port);
SET_PORT(&itf->mask, port);
SET_PORT(&itf->bcast, port);
if (IS_IPV4(&itf->sin)) {
NSRCADR(&itf->sin) = isc_if->address.type.in.s_addr;
NSRCADR(&itf->mask) = isc_if->netmask.type.in.s_addr;
if (isc_if->flags & INTERFACE_F_BROADCAST) {
itf->flags |= INT_BROADCAST;
NSRCADR(&itf->bcast) =
isc_if->broadcast.type.in.s_addr;
}
}
#ifdef INCLUDE_IPV6_SUPPORT
else if (IS_IPV6(&itf->sin)) {
SET_ADDR6N(&itf->sin, isc_if->address.type.in6);
SET_ADDR6N(&itf->mask, isc_if->netmask.type.in6);
itf->scopeid = isc_netaddr_getzone(&isc_if->address);
SET_SCOPE(&itf->sin, itf->scopeid);
}
#endif
itf->flags |=
((INTERFACE_F_UP & isc_if->flags)
? INT_UP : 0)
| ((INTERFACE_F_LOOPBACK & isc_if->flags)
? INT_LOOPBACK : 0)
| ((INTERFACE_F_POINTTOPOINT & isc_if->flags)
? INT_PPP : 0)
| ((INTERFACE_F_MULTICAST & isc_if->flags)
? INT_MULTICAST : 0)
;
}
static int
refresh_interface(
struct interface * interface
)
{
#ifdef OS_MISSES_SPECIFIC_ROUTE_UPDATES
if (interface->fd != INVALID_SOCKET) {
close_and_delete_fd_from_list(interface->fd);
interface->fd = open_socket(&interface->sin,
0, 0, interface);
interface->last_ttl = 0;
return (interface->fd != INVALID_SOCKET);
} else
return 0;
#else
if (interface->fd != INVALID_SOCKET) {
if (IS_IPV6(&interface->sin)) {
struct in6_ifreq ifr6;
strlcpy(ifr6.ifr_name, interface->name, sizeof(ifr6.ifr_name));
ifr6.ifr_addr = *(struct sockaddr_in6 *)&interface->sin;
if (ioctl(interface->fd, SIOCGIFAFLAG_IN6, &ifr6) >= 0) {
interface->flags6 = ifr6.ifr_ifru.ifru_flags6;
if (interface->flags6 & IN6_AVOID_FLAGS) {
close_and_delete_fd_from_list(interface->fd);
interface->fd = INVALID_SOCKET;
}
}
}
}
return (interface->fd != INVALID_SOCKET);
#endif
}
void
interface_update(
interface_receiver_t receiver,
void * data)
{
int new_interface_found;
if (disable_dynamic_updates)
return;
BLOCKIO();
new_interface_found = update_interfaces(NTP_PORT, receiver, data);
UNBLOCKIO();
if (!new_interface_found)
return;
#ifdef DEBUG
msyslog(LOG_DEBUG, "new interface(s) found: waking up resolver");
#endif
#ifdef SYS_WINNT
if (ResolverEventHandle != NULL)
SetEvent(ResolverEventHandle);
#else
write( resolver_pipe_fd[1], &new_interface_found, 1 );
#endif
}
void
sau_from_netaddr(
sockaddr_u *psau,
const isc_netaddr_t *pna
)
{
memset(psau, 0, sizeof(*psau));
AF(psau) = (u_short)pna->family;
switch (pna->family) {
case AF_INET:
memcpy(&psau->sa4.sin_addr, &pna->type.in,
sizeof(psau->sa4.sin_addr));
break;
case AF_INET6:
memcpy(&psau->sa6.sin6_addr, &pna->type.in6,
sizeof(psau->sa6.sin6_addr));
break;
}
}
static int
is_wildcard_addr(
sockaddr_u *psau
)
{
if (IS_IPV4(psau) && !NSRCADR(psau))
return 1;
#ifdef INCLUDE_IPV6_SUPPORT
if (IS_IPV6(psau) && S_ADDR6_EQ(psau, &in6addr_any))
return 1;
#endif
return 0;
}
static int
is_wildcard_netaddr(
const isc_netaddr_t *pna
)
{
sockaddr_u sau;
sau_from_netaddr(&sau, pna);
return is_wildcard_addr(&sau);
}
#ifdef OS_NEEDS_REUSEADDR_FOR_IFADDRBIND
static void
set_wildcard_reuse(
u_short family,
int on
)
{
struct interface *any;
SOCKET fd = INVALID_SOCKET;
any = ANY_INTERFACE_BYFAM(family);
if (any != NULL)
fd = any->fd;
if (fd != INVALID_SOCKET) {
if (setsockopt(fd, SOL_SOCKET, SO_REUSEADDR,
(char *)&on, sizeof(on)))
msyslog(LOG_ERR,
"set_wildcard_reuse: setsockopt(SO_REUSEADDR, %s) failed: %m",
on ? "on" : "off");
DPRINTF(4, ("set SO_REUSEADDR to %s on %s\n",
on ? "on" : "off",
stoa(&any->sin)));
}
}
#endif
static int
update_interfaces(
u_short port,
interface_receiver_t receiver,
void * data
)
{
isc_mem_t * mctx = (void *)-1;
interface_info_t ifi;
isc_interfaceiter_t * iter;
isc_result_t result;
isc_interface_t isc_if;
int new_interface_found;
unsigned int family;
struct interface interface;
struct interface * iface;
struct interface * next;
DPRINTF(3, ("update_interfaces(%d)\n", port));
new_interface_found = 0;
iter = NULL;
result = isc_interfaceiter_create(mctx, &iter);
if (result != ISC_R_SUCCESS)
return 0;
sys_interphase ^= 0x1;
for (result = isc_interfaceiter_first(iter);
ISC_R_SUCCESS == result;
result = isc_interfaceiter_next(iter)) {
result = isc_interfaceiter_current(iter, &isc_if);
if (result != ISC_R_SUCCESS)
break;
family = isc_if.address.family;
if (AF_INET != family && AF_INET6 != family)
continue;
if (AF_INET == family && !ipv4_works)
continue;
if (AF_INET6 == family && !ipv6_works)
continue;
init_interface(&interface);
convert_isc_if(&isc_if, &interface, port);
switch (interface_action(isc_if.name, &isc_if.address,
isc_if.flags)) {
case ACTION_IGNORE:
continue;
case ACTION_LISTEN:
interface.ignore_packets = ISC_FALSE;
break;
case ACTION_DROP:
interface.ignore_packets = ISC_TRUE;
break;
}
DPRINT_INTERFACE(4, (&interface, "examining ", "\n"));
if (!(interface.flags & INT_UP)) {
DPRINTF(4, ("skipping interface %s (%s) - DOWN\n",
interface.name, stoa(&interface.sin)));
continue;
}
if (is_wildcard_addr(&interface.sin))
continue;
iface = getinterface(&interface.sin, INT_WILDCARD);
if (iface != NULL && refresh_interface(iface)) {
if (iface->phase != sys_interphase) {
strncpy(iface->name, interface.name,
sizeof(iface->name));
iface->ignore_packets =
interface.ignore_packets;
} else
strncpy(iface->name, "*multiple*",
sizeof(iface->name));
DPRINT_INTERFACE(4, (iface, "updating ",
" present\n"));
if (iface->ignore_packets !=
interface.ignore_packets) {
msyslog(LOG_ERR,
"WARNING: conflicting enable configuration for interfaces %s and %s for address %s - unsupported configuration - address DISABLED",
interface.name, iface->name,
stoa(&interface.sin));
iface->ignore_packets = ISC_TRUE;
}
iface->phase = sys_interphase;
ifi.action = IFS_EXISTS;
ifi.interface = iface;
if (receiver != NULL)
(*receiver)(data, &ifi);
} else {
int flags6 = 0;
iface = create_interface(port, &interface, &flags6);
if (iface != NULL) {
ifi.action = IFS_CREATED;
ifi.interface = iface;
if (receiver != NULL)
(*receiver)(data, &ifi);
new_interface_found = 1;
DPRINT_INTERFACE(3,
(iface, "updating ",
" new - created\n"));
} else if (0 == (flags6 & IN6_AVOID_FLAGS)) {
DPRINT_INTERFACE(3,
(&interface, "updating ",
" new - creation FAILED"));
msyslog(LOG_INFO,
"failed to init interface for address %s",
stoa(&interface.sin));
continue;
}
}
}
isc_interfaceiter_destroy(&iter);
iface = inter_list;
while (iface != NULL) {
next = iface->link;
if (!(iface->flags & (INT_WILDCARD | INT_MCASTIF))) {
if (iface->phase != sys_interphase) {
DPRINT_INTERFACE(3,
(iface, "updating ",
"GONE - deleting\n"));
remove_interface(iface);
ifi.action = IFS_DELETED;
ifi.interface = iface;
if (receiver != NULL)
(*receiver)(data, &ifi);
while (iface->peers != NULL)
set_peerdstadr(iface->peers, NULL);
if (iface == loopback_interface)
loopback_interface = NULL;
delete_interface(iface);
}
}
iface = next;
}
refresh_all_peerinterfaces();
return new_interface_found;
}
static int
create_sockets(
u_short port
)
{
#ifndef HAVE_IO_COMPLETION_PORT
maxactivefd = 0;
FD_ZERO(&activefds);
#endif
DPRINTF(2, ("create_sockets(%d)\n", port));
create_wildcards(port);
update_interfaces(port, NULL, NULL);
set_reuseaddr(0);
DPRINTF(2, ("create_sockets: Total interfaces = %d\n", ninterfaces));
return ninterfaces;
}
static struct interface *
create_interface(
u_short port,
struct interface * protot,
int *flags6
)
{
sockaddr_u resmask;
struct interface *iface;
DPRINTF(2, ("create_interface(%s#%d)\n", stoa(&protot->sin),
port));
iface = new_interface(protot);
iface->fd = open_socket(&iface->sin, 0, 0, iface);
if (iface->fd != INVALID_SOCKET)
list_if_listening(iface);
if ((INT_BROADCAST & iface->flags)
&& iface->bfd != INVALID_SOCKET)
msyslog(LOG_INFO, "Listening on broadcast address %s#%d",
stoa((&iface->bcast)), port);
if (INVALID_SOCKET == iface->fd
&& INVALID_SOCKET == iface->bfd) {
if ((iface->flags6 & IN6_AVOID_FLAGS) == 0) {
msyslog(LOG_ERR, "unable to create socket on %s (%d) for %s#%d",
iface->name,
iface->ifnum,
stoa((&iface->sin)),
port);
} else {
if (flags6) {
*flags6 = iface->flags6;
}
msyslog(LOG_DEBUG, "unable to create socket on %s (%d) for %s#%d flags6:0x%x",
iface->name,
iface->ifnum,
stoa((&iface->sin)),
port, iface->flags6);
}
delete_interface(iface);
return NULL;
}
SET_HOSTMASK(&resmask, AF(&iface->sin));
hack_restrict(RESTRICT_FLAGS, &iface->sin, &resmask,
RESM_NTPONLY | RESM_INTERFACE, RES_IGNORE);
if (NULL == loopback_interface && AF_INET == iface->family
&& (INT_LOOPBACK & iface->flags))
loopback_interface = iface;
add_addr_to_list(&iface->sin, iface);
add_interface(iface);
DPRINT_INTERFACE(2, (iface, "created ", "\n"));
return iface;
}
#ifdef SO_EXCLUSIVEADDRUSE
static void
set_excladdruse(
SOCKET fd
)
{
int one = 1;
int failed;
#ifdef SYS_WINNT
DWORD err;
#endif
failed = setsockopt(fd, SOL_SOCKET, SO_EXCLUSIVEADDRUSE,
(char *)&one, sizeof(one));
if (!failed)
return;
#ifdef SYS_WINNT
err = GetLastError();
if (isc_win32os_versioncheck(5, 1, 0, 0) < 0
&& WSAEINVAL == err)
return;
SetLastError(err);
#endif
msyslog(LOG_ERR,
"setsockopt(%d, SO_EXCLUSIVEADDRUSE, on): %m",
(int)fd);
}
#endif
static void
set_reuseaddr(
int flag
)
{
#ifndef SO_EXCLUSIVEADDRUSE
struct interface *interf;
for (interf = inter_list;
interf != NULL;
interf = interf->link) {
if (interf->flags & INT_WILDCARD)
continue;
DPRINTF(4, ("setting SO_REUSEADDR on %.16s@%s to %s\n",
interf->name, stoa(&interf->sin),
flag ? "on" : "off"));
if (interf->fd != INVALID_SOCKET) {
if (setsockopt(interf->fd, SOL_SOCKET,
SO_REUSEADDR, (char *)&flag,
sizeof(flag))) {
msyslog(LOG_ERR, "set_reuseaddr: setsockopt(SO_REUSEADDR, %s) failed: %m", flag ? "on" : "off");
}
}
}
#endif
}
void
enable_broadcast(
struct interface * iface,
sockaddr_u * baddr
)
{
#ifdef OPEN_BCAST_SOCKET
socket_broadcast_enable(iface, iface->fd, baddr);
#endif
}
#ifdef OPEN_BCAST_SOCKET
static isc_boolean_t
socket_broadcast_enable(
struct interface * iface,
SOCKET fd,
sockaddr_u * baddr
)
{
#ifdef SO_BROADCAST
int on = 1;
if (IS_IPV4(baddr)) {
if (setsockopt(fd, SOL_SOCKET, SO_BROADCAST,
(char *)&on, sizeof(on)))
msyslog(LOG_ERR,
"setsockopt(SO_BROADCAST) enable failure on address %s: %m",
stoa(baddr));
else
DPRINTF(2, ("Broadcast enabled on socket %d for address %s\n",
fd, stoa(baddr)));
}
iface->flags |= INT_BCASTOPEN;
broadcast_client_enabled = ISC_TRUE;
return ISC_TRUE;
#else
return ISC_FALSE;
#endif
}
static isc_boolean_t
socket_broadcast_disable(
struct interface * iface,
sockaddr_u * baddr
)
{
#ifdef SO_BROADCAST
int off = 0;
if (IS_IPV4(baddr) && setsockopt(iface->fd, SOL_SOCKET,
SO_BROADCAST, (char *)&off, sizeof(off)))
msyslog(LOG_ERR,
"setsockopt(SO_BROADCAST) disable failure on address %s: %m",
stoa(baddr));
iface->flags &= ~INT_BCASTOPEN;
broadcast_client_enabled = ISC_FALSE;
return ISC_TRUE;
#else
return ISC_FALSE;
#endif
}
#endif
isc_boolean_t
get_broadcastclient_flag(void)
{
return (broadcast_client_enabled);
}
static isc_boolean_t
addr_ismulticast(
sockaddr_u *maddr
)
{
isc_boolean_t result;
#ifndef INCLUDE_IPV6_MULTICAST_SUPPORT
if (IS_IPV6(maddr))
result = ISC_FALSE;
else
#endif
result = IS_MCAST(maddr);
if (!result)
DPRINTF(4, ("address %s is not multicast\n",
stoa(maddr)));
return result;
}
void
enable_multicast_if(
struct interface * iface,
sockaddr_u * maddr
)
{
#ifdef MCAST
TYPEOF_IP_MULTICAST_LOOP off = 0;
NTP_REQUIRE(AF(maddr) == AF(&iface->sin));
switch (AF(&iface->sin)) {
case AF_INET:
if (setsockopt(iface->fd, IPPROTO_IP, IP_MULTICAST_IF,
(void *)&NSRCADR(&iface->sin),
sizeof(NSRCADR(&iface->sin)))) {
msyslog(LOG_ERR,
"setsockopt IP_MULTICAST_IF failed: %m on socket %d, addr %s for multicast address %s",
iface->fd, stoa(&iface->sin),
stoa(maddr));
return;
}
#ifdef IP_MULTICAST_LOOP
if (setsockopt(iface->fd, IPPROTO_IP,
IP_MULTICAST_LOOP,
SETSOCKOPT_ARG_CAST &off,
sizeof(off))) {
msyslog(LOG_ERR,
"setsockopt IP_MULTICAST_LOOP failed: %m on socket %d, addr %s for multicast address %s",
iface->fd, stoa(&iface->sin),
stoa(maddr));
}
#endif
DPRINTF(4, ("Added IPv4 multicast interface on socket %d, addr %s for multicast address %s\n",
iface->fd, stoa(&iface->sin),
stoa(maddr)));
break;
case AF_INET6:
#ifdef INCLUDE_IPV6_MULTICAST_SUPPORT
if (setsockopt(iface->fd, IPPROTO_IPV6,
IPV6_MULTICAST_IF,
(char *)&iface->scopeid,
sizeof(iface->scopeid))) {
msyslog(LOG_ERR,
"setsockopt IPV6_MULTICAST_IF failed: %m on socket %d, addr %s, scope %d for multicast address %s",
iface->fd, stoa(&iface->sin),
iface->scopeid, stoa(maddr));
return;
}
#ifdef IPV6_MULTICAST_LOOP
if (setsockopt(iface->fd, IPPROTO_IPV6,
IPV6_MULTICAST_LOOP,
(char *) &off, sizeof(off))) {
msyslog(LOG_ERR,
"setsockopt IP_MULTICAST_LOOP failed: %m on socket %d, addr %s for multicast address %s",
iface->fd, stoa(&iface->sin),
stoa(maddr));
}
#endif
DPRINTF(4, ("Added IPv6 multicast interface on socket %d, addr %s, scope %d for multicast address %s\n",
iface->fd, stoa(&iface->sin),
iface->scopeid, stoa(maddr)));
break;
#else
return;
#endif
}
return;
#endif
}
#ifdef MCAST
static isc_boolean_t
socket_multicast_enable(
struct interface * iface,
int lscope,
sockaddr_u * maddr
)
{
struct ip_mreq mreq;
#ifdef INCLUDE_IPV6_MULTICAST_SUPPORT
struct ipv6_mreq mreq6;
#endif
if (find_addr_in_list(maddr) != NULL) {
DPRINTF(4, ("socket_multicast_enable(%s): already enabled\n",
stoa(maddr)));
return ISC_TRUE;
}
switch (AF(maddr)) {
case AF_INET:
memset(&mreq, 0, sizeof(mreq));
mreq.imr_multiaddr = SOCK_ADDR4(maddr);
mreq.imr_interface.s_addr = htonl(INADDR_ANY);
if (setsockopt(iface->fd,
IPPROTO_IP,
IP_ADD_MEMBERSHIP,
(char *)&mreq,
sizeof(mreq))) {
msyslog(LOG_ERR,
"setsockopt IP_ADD_MEMBERSHIP failed: %m on socket %d, addr %s for %x / %x (%s)",
iface->fd, stoa(&iface->sin),
mreq.imr_multiaddr.s_addr,
mreq.imr_interface.s_addr,
stoa(maddr));
return ISC_FALSE;
}
DPRINTF(4, ("Added IPv4 multicast membership on socket %d, addr %s for %x / %x (%s)\n",
iface->fd, stoa(&iface->sin),
mreq.imr_multiaddr.s_addr,
mreq.imr_interface.s_addr, stoa(maddr)));
break;
case AF_INET6:
#ifdef INCLUDE_IPV6_MULTICAST_SUPPORT
memset(&mreq6, 0, sizeof(mreq6));
mreq6.ipv6mr_multiaddr = SOCK_ADDR6(maddr);
mreq6.ipv6mr_interface = lscope;
if (setsockopt(iface->fd, IPPROTO_IPV6,
IPV6_JOIN_GROUP, (char *)&mreq6,
sizeof(mreq6))) {
msyslog(LOG_ERR,
"setsockopt IPV6_JOIN_GROUP failed: %m on socket %d, addr %s for interface %d (%s)",
iface->fd, stoa(&iface->sin),
mreq6.ipv6mr_interface, stoa(maddr));
return ISC_FALSE;
}
DPRINTF(4, ("Added IPv6 multicast group on socket %d, addr %s for interface %d(%s)\n",
iface->fd, stoa(&iface->sin),
mreq6.ipv6mr_interface, stoa(maddr)));
#else
return ISC_FALSE;
#endif
}
iface->flags |= INT_MCASTOPEN;
iface->num_mcast++;
add_addr_to_list(maddr, iface);
return ISC_TRUE;
}
static isc_boolean_t
socket_multicast_disable(
struct interface * iface,
sockaddr_u * maddr
)
{
#ifdef INCLUDE_IPV6_MULTICAST_SUPPORT
struct ipv6_mreq mreq6;
#endif
struct ip_mreq mreq;
memset(&mreq, 0, sizeof(mreq));
if (find_addr_in_list(maddr) == NULL) {
DPRINTF(4, ("socket_multicast_disable(%s): not found\n",
stoa(maddr)));
return ISC_TRUE;
}
switch (AF(maddr)) {
case AF_INET:
mreq.imr_multiaddr = SOCK_ADDR4(maddr);
mreq.imr_interface = SOCK_ADDR4(&iface->sin);
if (setsockopt(iface->fd, IPPROTO_IP,
IP_DROP_MEMBERSHIP, (char *)&mreq,
sizeof(mreq))) {
msyslog(LOG_ERR,
"setsockopt IP_DROP_MEMBERSHIP failed: %m on socket %d, addr %s for %x / %x (%s)",
iface->fd, stoa(&iface->sin),
SRCADR(maddr), SRCADR(&iface->sin),
stoa(maddr));
return ISC_FALSE;
}
break;
case AF_INET6:
#ifdef INCLUDE_IPV6_MULTICAST_SUPPORT
mreq6.ipv6mr_multiaddr = SOCK_ADDR6(maddr);
mreq6.ipv6mr_interface = iface->scopeid;
if (setsockopt(iface->fd, IPPROTO_IPV6,
IPV6_LEAVE_GROUP, (char *)&mreq6,
sizeof(mreq6))) {
msyslog(LOG_ERR,
"setsockopt IPV6_LEAVE_GROUP failure: %m on socket %d, addr %s for %d (%s)",
iface->fd, stoa(&iface->sin),
iface->scopeid, stoa(maddr));
return ISC_FALSE;
}
break;
#else
return ISC_FALSE;
#endif
}
iface->num_mcast--;
if (!iface->num_mcast)
iface->flags &= ~INT_MCASTOPEN;
return ISC_TRUE;
}
#endif
void
io_setbclient(void)
{
#ifdef OPEN_BCAST_SOCKET
struct interface * interf;
int nif;
isc_boolean_t jstatus;
SOCKET fd;
nif = 0;
set_reuseaddr(1);
for (interf = inter_list;
interf != NULL;
interf = interf->link) {
if (interf->flags & (INT_WILDCARD | INT_LOOPBACK))
continue;
if (interf->ignore_packets)
continue;
if (!(interf->flags & INT_BROADCAST))
continue;
NTP_REQUIRE(IS_IPV4(&interf->sin));
if (interf->flags & INT_BCASTOPEN) {
nif++;
continue;
}
interf->family = AF_INET;
interf->bfd = open_socket(&interf->bcast, 1, 0, interf);
if (interf->bfd != INVALID_SOCKET) {
fd = interf->bfd;
jstatus = ISC_TRUE;
} else {
fd = interf->fd;
jstatus = socket_broadcast_enable(interf, fd,
&interf->sin);
}
if (jstatus) {
nif++;
msyslog(LOG_INFO,
"io_setbclient: Opened broadcast client on interface #%d %s",
interf->ifnum, interf->name);
interf->addr_refid = addr2refid(&interf->sin);
}
}
set_reuseaddr(0);
if (nif > 0)
DPRINTF(1, ("io_setbclient: Opened broadcast clients\n"));
else if (!nif)
msyslog(LOG_ERR,
"Unable to listen for broadcasts, no broadcast interfaces available");
#else
msyslog(LOG_ERR,
"io_setbclient: Broadcast Client disabled by build");
#endif
}
void
io_unsetbclient(void)
{
struct interface *interf;
for (interf = inter_list;
NULL != interf;
interf = interf->link)
{
if (interf->flags & INT_WILDCARD)
continue;
if (!(interf->flags & INT_BCASTOPEN))
continue;
socket_broadcast_disable(interf, &interf->sin);
}
}
void
io_multicast_add(
sockaddr_u *addr
)
{
#ifdef MCAST
struct interface *interface;
#ifndef MULTICAST_NONEWSOCKET
struct interface *iface;
#endif
int lscope = 0;
if (!addr_ismulticast(addr))
return;
if (NULL != find_flagged_addr_in_list(addr, INT_MCASTOPEN)) {
msyslog(LOG_INFO,
"Duplicate request found for multicast address %s",
stoa(addr));
return;
}
#ifndef MULTICAST_NONEWSOCKET
interface = new_interface(NULL);
interface->family =
AF(&interface->sin) =
AF(&interface->mask) = AF(addr);
SET_PORT(&interface->sin, NTP_PORT);
SET_ONESMASK(&interface->mask);
switch(AF(addr)) {
case AF_INET:
NSRCADR(&interface->sin) = NSRCADR(addr);
break;
case AF_INET6:
#ifdef INCLUDE_IPV6_MULTICAST_SUPPORT
SET_ADDR6N(&interface->sin, SOCK_ADDR6(addr));
lscope = SCOPE(addr);
SET_SCOPE(&interface->sin, lscope);
#endif
iface = findlocalcastinterface(addr);
if (iface != NULL)
DPRINTF(4, ("Found interface #%d %s, scope %d for address %s\n",
iface->ifnum, iface->name, lscope,
stoa(addr)));
}
set_reuseaddr(1);
interface->bfd = INVALID_SOCKET;
interface->fd = open_socket(&interface->sin, INT_MULTICAST, 0,
interface);
if (interface->fd != INVALID_SOCKET) {
interface->bfd = INVALID_SOCKET;
interface->ignore_packets = ISC_FALSE;
interface->flags |= INT_MCASTIF;
strncpy(interface->name, "multicast",
sizeof(interface->name));
DPRINT_INTERFACE(2, (interface, "multicast add ", "\n"));
add_interface(interface);
list_if_listening(interface);
} else {
delete_interface(interface);
if (IS_IPV4(addr))
interface = wildipv4;
else if (IS_IPV6(addr))
interface = wildipv6;
else
interface = NULL;
if (interface != NULL) {
interface->bcast = *addr;
msyslog(LOG_ERR,
"multicast address %s using wildcard interface #%d %s",
stoa(addr), interface->ifnum,
interface->name);
} else {
msyslog(LOG_ERR,
"No multicast socket available to use for address %s",
stoa(addr));
return;
}
}
#else
interface = findlocalcastinterface(addr);
if (NULL == interface) {
msyslog(LOG_ERR,
"Can not add multicast address %s: no multicast interface found",
stoa(addr));
return;
}
#endif
if (socket_multicast_enable(interface, lscope, addr))
msyslog(LOG_INFO,
"Added Multicast Listener %s on interface #%d %s",
stoa(addr), interface->ifnum, interface->name);
else
msyslog(LOG_ERR, "Failed to add Multicast Listener %s",
stoa(addr));
#else
msyslog(LOG_ERR,
"Can not add multicast address %s: no multicast support",
stoa(addr));
#endif
return;
}
void
io_multicast_del(
sockaddr_u * addr
)
{
#ifdef MCAST
struct interface *iface;
if (!addr_ismulticast(addr)) {
msyslog(LOG_ERR, "invalid multicast address %s",
stoa(addr));
return;
}
while ((iface = find_flagged_addr_in_list(addr, INT_MCASTOPEN))
!= NULL)
socket_multicast_disable(iface, addr);
delete_addr_from_list(addr);
#else
msyslog(LOG_ERR,
"Can not delete multicast address %s: no multicast support",
stoa(addr));
#endif
}
static void init_nonblocking_io(
SOCKET fd
)
{
#ifdef USE_FIONBIO
#undef O_NONBLOCK
#undef FNDELAY
#undef O_NDELAY
#endif
#if defined(O_NONBLOCK)
if (fcntl(fd, F_SETFL, O_NONBLOCK) < 0) {
msyslog(LOG_ERR,
"fcntl(O_NONBLOCK) fails on fd #%d: %m", fd);
exit(1);
}
#elif defined(FNDELAY)
if (fcntl(fd, F_SETFL, FNDELAY) < 0) {
msyslog(LOG_ERR, "fcntl(FNDELAY) fails on fd #%d: %m",
fd);
exit(1);
}
#elif defined(O_NDELAY)
if (fcntl(fd, F_SETFL, O_NDELAY) < 0) {
msyslog(LOG_ERR, "fcntl(O_NDELAY) fails on fd #%d: %m",
fd);
exit(1);
}
#elif defined(FIONBIO)
{
int on = 1;
if (ioctl(fd, FIONBIO, &on) < 0) {
msyslog(LOG_ERR,
"ioctl(FIONBIO) fails on fd #%d: %m",
fd);
exit(1);
}
}
#elif defined(FIOSNBIO)
if (ioctl(fd, FIOSNBIO, &on) < 0) {
msyslog(LOG_ERR,
"ioctl(FIOSNBIO) fails on fd #%d: %m", fd);
exit(1);
}
#else
# include "Bletch: Need non-blocking I/O!"
#endif
}
static SOCKET
open_socket(
sockaddr_u * addr,
int bcast,
int turn_off_reuse,
struct interface * interf
)
{
SOCKET fd;
int errval;
char scopetext[16];
int on = 1;
int off = 0;
if (IS_IPV6(addr) && !ipv6_works)
return INVALID_SOCKET;
fd = socket(AF(addr), SOCK_DGRAM, 0);
if (INVALID_SOCKET == fd) {
#ifndef SYS_WINNT
errval = errno;
#else
errval = WSAGetLastError();
#endif
msyslog(LOG_ERR,
"socket(AF_INET%s, SOCK_DGRAM, 0) failed on address %s: %m",
IS_IPV6(addr) ? "6" : "", stoa(addr));
if (errval == EPROTONOSUPPORT ||
errval == EAFNOSUPPORT ||
errval == EPFNOSUPPORT)
return (INVALID_SOCKET);
errno = errval;
msyslog(LOG_ERR,
"unexpected socket() error %m code %d (not EPROTONOSUPPORT nor EAFNOSUPPORT nor EPFNOSUPPORT) - exiting",
errno);
exit(1);
}
#ifdef SYS_WINNT
connection_reset_fix(fd, addr);
#endif
fd = move_fd(fd);
#ifdef SYS_WINNT
if (isc_win32os_versioncheck(5, 1, 0, 0) < 0)
#endif
if (setsockopt(fd, SOL_SOCKET, SO_REUSEADDR,
(char *)((turn_off_reuse)
? &off
: &on),
sizeof(on))) {
msyslog(LOG_ERR,
"setsockopt SO_REUSEADDR %s fails for address %s: %m",
(turn_off_reuse)
? "off"
: "on",
stoa(addr));
closesocket(fd);
return INVALID_SOCKET;
}
#ifdef SO_EXCLUSIVEADDRUSE
if (!(interf->flags & INT_WILDCARD))
set_excladdruse(fd);
#endif
if (IS_IPV4(addr)) {
#if defined(HAVE_IPTOS_SUPPORT)
if (setsockopt(fd, IPPROTO_IP, IP_TOS, (char *)&qos,
sizeof(qos)))
msyslog(LOG_ERR,
"setsockopt IP_TOS (%02x) fails on address %s: %m",
qos, stoa(addr));
#endif
if (bcast)
socket_broadcast_enable(interf, fd, addr);
}
if (IS_IPV6(addr)) {
struct in6_ifreq ifr6;
strlcpy(ifr6.ifr_name, interf->name, sizeof(ifr6.ifr_name));
ifr6.ifr_addr = *(struct sockaddr_in6 *)addr;
if (ioctl(fd, SIOCGIFAFLAG_IN6, &ifr6) >= 0) {
interf->flags6 = ifr6.ifr_ifru.ifru_flags6;
if (interf->flags6 & IN6_AVOID_FLAGS) {
closesocket(fd);
return INVALID_SOCKET;
}
}
#if defined(IPV6_V6ONLY)
if (isc_net_probe_ipv6only() == ISC_R_SUCCESS
&& setsockopt(fd, IPPROTO_IPV6, IPV6_V6ONLY,
(char*)&on, sizeof(on)))
msyslog(LOG_ERR,
"setsockopt IPV6_V6ONLY on fails on address %s: %m",
stoa(addr));
#endif
#if defined(IPV6_BINDV6ONLY)
if (setsockopt(fd, IPPROTO_IPV6, IPV6_BINDV6ONLY,
(char*)&on, sizeof(on)))
msyslog(LOG_ERR,
"setsockopt IPV6_BINDV6ONLY on fails on address %s: %m",
stoa(addr));
#endif
}
#ifdef OS_NEEDS_REUSEADDR_FOR_IFADDRBIND
if (!is_wildcard_addr(addr))
set_wildcard_reuse(AF(addr), 1);
#endif
errval = bind(fd, &addr->sa, SOCKLEN(addr));
#ifdef OS_NEEDS_REUSEADDR_FOR_IFADDRBIND
if (!is_wildcard_addr(addr))
set_wildcard_reuse(AF(addr), 0);
#endif
if (errval < 0) {
if (turn_off_reuse == 0
#ifdef DEBUG
|| debug > 1
#endif
) {
if (SCOPE(addr))
snprintf(scopetext, sizeof(scopetext),
"%%%d", SCOPE(addr));
else
scopetext[0] = 0;
msyslog(LOG_ERR,
"bind(%d) AF_INET%s %s%s#%d%s flags 0x%x flags6 0x%x failed: %m",
fd, IS_IPV6(addr) ? "6" : "",
stoa(addr), scopetext, SRCPORT(addr),
IS_MCAST(addr) ? " (multicast)" : "",
interf->flags, interf->flags6);
}
closesocket(fd);
return INVALID_SOCKET;
}
#ifdef HAVE_TIMESTAMP
{
if (setsockopt(fd, SOL_SOCKET, SO_TIMESTAMP,
(char*)&on, sizeof(on)))
msyslog(LOG_DEBUG,
"setsockopt SO_TIMESTAMP on fails on address %s: %m",
stoa(addr));
else
DPRINTF(4, ("setsockopt SO_TIMESTAMP enabled on fd %d address %s\n",
fd, stoa(addr)));
}
#endif
DPRINTF(4, ("bind(%d) AF_INET%s, addr %s%%%d#%d, flags 0x%x\n",
fd, IS_IPV6(addr) ? "6" : "", stoa(addr),
SCOPE(addr), SRCPORT(addr), interf->flags));
init_nonblocking_io(fd);
#ifdef HAVE_SIGNALED_IO
init_socket_sig(fd);
#endif
add_fd_to_list(fd, FD_TYPE_SOCKET);
#if !defined(SYS_WINNT) && !defined(VMS)
DPRINTF(4, ("flags for fd %d: 0x%x\n", fd,
fcntl(fd, F_GETFL, 0)));
#endif
#if defined (HAVE_IO_COMPLETION_PORT)
if (io_completion_port_add_socket(fd, interf)) {
msyslog(LOG_ERR, "unable to set up io completion port - EXITING");
exit(1);
}
#endif
return fd;
}
void
sendpkt(
sockaddr_u *dest,
struct interface *inter,
int ttl,
struct pkt *pkt,
int len
)
{
int cc;
if (NULL == inter) {
DPRINTF(2, ("%ssendpkt(dst=%s, ttl=%d, len=%d): no interface - IGNORED\n",
(ttl > 0) ? "\tMCAST\t***** " : "",
stoa(dest), ttl, len));
return;
}
DPRINTF(2, ("%ssendpkt(%d, dst=%s, src=%s, ttl=%d, len=%d)\n",
(ttl > 0) ? "\tMCAST\t***** " : "",
inter->fd, stoa(dest), stoa(&inter->sin),
ttl, len));
#ifdef MCAST
if (ttl > 0 && ttl != inter->last_ttl) {
int rtc;
u_char cttl;
u_int uttl;
switch (AF(&inter->sin)) {
case AF_INET :
cttl = (u_char)ttl;
rtc = setsockopt(inter->fd, IPPROTO_IP,
IP_MULTICAST_TTL,
(void *)&cttl, sizeof(cttl));
break;
#ifdef INCLUDE_IPV6_SUPPORT
case AF_INET6 :
uttl = (u_int)ttl;
rtc = setsockopt(inter->fd, IPPROTO_IPV6,
IPV6_MULTICAST_HOPS,
(void *)&uttl, sizeof(uttl));
break;
#endif
default:
DPRINTF(1, ("sendpkt unknown AF %d",
AF(&inter->sin)));
rtc = 0;
}
if (!rtc)
inter->last_ttl = ttl;
else
msyslog(LOG_ERR,
"setsockopt IP_MULTICAST_TTL/IPV6_MULTICAST_HOPS fails on address %s: %m",
stoa(&inter->sin));
}
#endif
#if defined(HAVE_IO_COMPLETION_PORT)
cc = io_completion_port_sendto(inter, pkt, len, dest);
if (cc != ERROR_SUCCESS) {
#else
#ifdef SIM
cc = simulate_server(dest, inter, pkt);
#else
cc = sendto(inter->fd, (char *)pkt, (unsigned int)len, 0,
(struct sockaddr *)dest, SOCKLEN(dest));
#endif
if (cc == -1) {
#endif
inter->notsent++;
packets_notsent++;
} else {
inter->sent++;
packets_sent++;
}
}
#if !defined(HAVE_IO_COMPLETION_PORT)
static char *
fdbits(
int count,
fd_set *set
)
{
static char buffer[256];
char * buf = buffer;
count = min(count, 255);
while (count >= 0) {
*buf++ = FD_ISSET(count, set) ? '#' : '-';
count--;
}
*buf = '\0';
return buffer;
}
static inline int
read_refclock_packet(SOCKET fd, struct refclockio *rp, l_fp ts)
{
int i;
int buflen;
register struct recvbuf *rb;
rb = get_free_recv_buffer();
if (NULL == rb) {
char buf[RX_BUFF_SIZE];
buflen = read(fd, buf, sizeof buf);
packets_dropped++;
return (buflen);
}
i = (rp->datalen == 0
|| rp->datalen > sizeof(rb->recv_space))
? sizeof(rb->recv_space)
: rp->datalen;
buflen = read(fd, (char *)&rb->recv_space, (unsigned)i);
if (buflen < 0) {
if (errno != EINTR && errno != EAGAIN)
msyslog(LOG_ERR, "clock read fd %d: %m", fd);
freerecvbuf(rb);
return (buflen);
}
rb->recv_length = buflen;
rb->recv_srcclock = rp->srcclock;
rb->dstadr = 0;
rb->fd = fd;
rb->recv_time = ts;
rb->receiver = rp->clock_recv;
if (rp->io_input) {
if (rp->io_input(rb) == 0) {
freerecvbuf(rb);
return (buflen);
}
}
add_full_recv_buffer(rb);
rp->recvcount++;
packets_received++;
return (buflen);
}
#ifdef HAVE_TIMESTAMP
static l_fp
fetch_timestamp(
struct recvbuf * rb,
struct msghdr * msghdr,
l_fp ts
)
{
#ifdef USE_TIMESTAMP_CMSG
struct cmsghdr *cmsghdr;
cmsghdr = CMSG_FIRSTHDR(msghdr);
while (cmsghdr != NULL) {
switch (cmsghdr->cmsg_type)
{
case SCM_TIMESTAMP:
{
struct timeval *tvp;
double dtemp;
l_fp nts;
tvp = (struct timeval *)CMSG_DATA(cmsghdr);
DPRINTF(4, ("fetch_timestamp: system network time stamp: %ld.%06d\n",
tvp->tv_sec, tvp->tv_usec));
nts.l_i = tvp->tv_sec + JAN_1970;
dtemp = (tvp->tv_usec
+ (ntp_random() * 2. / FRAC)) / 1e6;
nts.l_uf = (u_int32)(dtemp * FRAC);
#ifdef DEBUG_TIMING
{
l_fp dts;
dts = ts;
L_SUB(&dts, &nts);
collect_timing(rb,
"input processing delay",
1, &dts);
DPRINTF(4, ("fetch_timestamp: timestamp delta: %s (incl. prec fuzz)\n",
lfptoa(&dts, 9)));
}
#endif
ts = nts;
break;
}
default:
DPRINTF(4, ("fetch_timestamp: skipping control message 0x%x\n",
cmsghdr->cmsg_type));
}
cmsghdr = CMSG_NXTHDR(msghdr, cmsghdr);
}
#endif
return ts;
}
#endif
static inline int
read_network_packet(
SOCKET fd,
struct interface * itf,
l_fp ts
)
{
GETSOCKNAME_SOCKLEN_TYPE fromlen;
int buflen;
register struct recvbuf *rb;
#ifdef HAVE_TIMESTAMP
struct msghdr msghdr;
struct iovec iovec;
char control[TIMESTAMP_CTLMSGBUF_SIZE];
#endif
rb = get_free_recv_buffer();
if (NULL == rb || itf->ignore_packets) {
char buf[RX_BUFF_SIZE];
sockaddr_u from;
if (rb != NULL)
freerecvbuf(rb);
fromlen = sizeof(from);
buflen = recvfrom(fd, buf, sizeof(buf), 0,
&from.sa, &fromlen);
DPRINTF(4, ("%s on (%lu) fd=%d from %s\n",
(itf->ignore_packets)
? "ignore"
: "drop",
free_recvbuffs(), fd, stoa(&from)));
if (itf->ignore_packets)
packets_ignored++;
else
packets_dropped++;
return (buflen);
}
fromlen = sizeof(rb->recv_srcadr);
#ifndef HAVE_TIMESTAMP
rb->recv_length = recvfrom(fd, (char *)&rb->recv_space,
sizeof(rb->recv_space), 0,
&rb->recv_srcadr.sa, &fromlen);
#else
iovec.iov_base = &rb->recv_space;
iovec.iov_len = sizeof(rb->recv_space);
msghdr.msg_name = &rb->recv_srcadr;
msghdr.msg_namelen = fromlen;
msghdr.msg_iov = &iovec;
msghdr.msg_iovlen = 1;
msghdr.msg_control = (void *)&control;
msghdr.msg_controllen = sizeof(control);
msghdr.msg_flags = 0;
rb->recv_length = recvmsg(fd, &msghdr, 0);
#endif
buflen = rb->recv_length;
if (buflen == 0 || (buflen == -1 &&
(EWOULDBLOCK == errno
#ifdef EAGAIN
|| EAGAIN == errno
#endif
))) {
freerecvbuf(rb);
return (buflen);
} else if (buflen < 0) {
msyslog(LOG_ERR, "recvfrom(%s) fd=%d: %m",
stoa(&rb->recv_srcadr), fd);
DPRINTF(5, ("read_network_packet: fd=%d dropped (bad recvfrom)\n",
fd));
freerecvbuf(rb);
return (buflen);
}
DPRINTF(3, ("read_network_packet: fd=%d length %d from %s\n",
fd, buflen, stoa(&rb->recv_srcadr)));
if (AF_INET6 == itf->family) {
DPRINTF(1, ("Got an IPv6 packet, from <%s> to <%s>\n",
stoa(&rb->recv_srcadr), stoa(&itf->sin)));
}
if ( AF_INET6 == itf->family
&& IN6_IS_ADDR_LOOPBACK(&rb->recv_srcadr.sa6.sin6_addr)
&& !IN6_IS_ADDR_LOOPBACK(&itf->sin.sa6.sin6_addr)
) {
packets_dropped++;
DPRINTF(1, ("DROPPING that packet\n"));
freerecvbuf(rb);
return buflen;
}
DPRINTF(1, ("processing that packet\n"));
rb->dstadr = itf;
rb->fd = fd;
#ifdef HAVE_TIMESTAMP
ts = fetch_timestamp(rb, &msghdr, ts);
#endif
rb->recv_time = ts;
rb->receiver = receive;
add_full_recv_buffer(rb);
itf->received++;
packets_received++;
return (buflen);
}
void
input_handler(
l_fp *cts
)
{
extern void trigger_timer();
int buflen;
int n;
int doing;
SOCKET fd;
struct timeval tvzero;
l_fp ts;
#ifdef DEBUG_TIMING
l_fp ts_e;
#endif
fd_set fds;
int select_count = 0;
struct interface *interface;
#if defined(HAS_ROUTING_SOCKET)
struct asyncio_reader *asyncio_reader;
#endif
handler_calls++;
ts = *cts;
fds = activefds;
tvzero.tv_sec = tvzero.tv_usec = 0;
n = select(maxactivefd + 1, &fds, (fd_set *)0, (fd_set *)0,
&tvzero);
if (n < 0) {
int err = errno;
if (err != EINTR)
msyslog(LOG_ERR,
"select(%d, %s, 0L, 0L, &0.0) error: %m",
maxactivefd + 1,
fdbits(maxactivefd, &activefds));
if (err == EBADF) {
int j, b;
fds = activefds;
for (j = 0; j <= maxactivefd; j++)
if ((FD_ISSET(j, &fds)
&& (read(j, &b, 0) == -1)))
msyslog(LOG_ERR,
"Bad file descriptor %d",
j);
}
return;
}
else if (n == 0)
return;
++handler_pkts;
#ifdef REFCLOCK
if (refio != NULL) {
register struct refclockio *rp;
for (rp = refio; rp != NULL; rp = rp->next) {
fd = rp->fd;
if (FD_ISSET(fd, &fds))
do {
++select_count;
buflen = read_refclock_packet(
fd, rp, ts);
} while (buflen > 0);
}
}
#endif
for (interface = inter_list;
interface != NULL;
interface = interface->link) {
for (doing = 0; (doing < 2); doing++) {
if (!doing)
fd = interface->fd;
else {
if (!(interface->flags & INT_BCASTOPEN))
break;
fd = interface->bfd;
}
if (fd < 0)
continue;
if (FD_ISSET(fd, &fds))
do {
++select_count;
buflen = read_network_packet(
fd, interface,
ts);
} while (buflen > 0);
}
}
#ifdef HAS_ROUTING_SOCKET
asyncio_reader = asyncio_reader_list;
while (asyncio_reader != NULL) {
if (FD_ISSET(asyncio_reader->fd, &fds)) {
++select_count;
(asyncio_reader->receiver)(asyncio_reader);
}
asyncio_reader = asyncio_reader->link;
}
#endif
trigger_timer();
if (select_count == 0) {
#ifdef DEBUG
if (debug)
msyslog(LOG_DEBUG, "input_handler: select() returned 0");
#endif
return;
}
#ifdef DEBUG_TIMING
get_systime(&ts_e);
L_SUB(&ts_e, &ts);
collect_timing(NULL, "input handler", 1, &ts_e);
if (debug > 3)
msyslog(LOG_DEBUG,
"input_handler: Processed a gob of fd's in %s msec",
lfptoms(&ts_e, 6));
#endif
return;
}
#endif
struct interface *
findinterface(
sockaddr_u *addr
)
{
struct interface *iface;
iface = findlocalinterface(addr, INT_WILDCARD, 0);
if (NULL == iface) {
DPRINTF(4, ("Found no interface for address %s - returning wildcard\n",
stoa(addr)));
iface = ANY_INTERFACE_CHOOSE(addr);
} else
DPRINTF(4, ("Found interface #%d %s for address %s\n",
iface->ifnum, iface->name, stoa(addr)));
return iface;
}
static struct interface *
findlocalinterface(
sockaddr_u * addr,
int flags,
int bcast
)
{
GETSOCKNAME_SOCKLEN_TYPE sockaddrlen;
struct interface * iface;
sockaddr_u saddr;
SOCKET s;
int rtn;
int on;
DPRINTF(4, ("Finding interface for addr %s in list of addresses\n",
stoa(addr)));
s = socket(AF(addr), SOCK_DGRAM, 0);
if (INVALID_SOCKET == s)
return NULL;
if (bcast) {
on = 1;
setsockopt(s, SOL_SOCKET, SO_BROADCAST,
(char *)&on, sizeof(on));
}
rtn = connect(s, &addr->sa, SOCKLEN(addr));
if (SOCKET_ERROR == rtn) {
closesocket(s);
return NULL;
}
sockaddrlen = sizeof(saddr);
rtn = getsockname(s, &saddr.sa, &sockaddrlen);
closesocket(s);
if (SOCKET_ERROR == rtn)
return NULL;
DPRINTF(4, ("findlocalinterface: kernel maps %s to %s\n",
stoa(addr), stoa(&saddr)));
iface = getinterface(&saddr, flags);
if (NULL == iface || iface->ignore_packets)
iface = getsamenetinterface(&saddr, flags);
if (iface != NULL && iface->ignore_packets)
iface = NULL;
return iface;
}
static struct interface *
getinterface(
sockaddr_u * addr,
int flags
)
{
struct interface *iface;
iface = find_addr_in_list(addr);
if (iface != NULL && (iface->flags & flags))
iface = NULL;
return iface;
}
static struct interface *
getsamenetinterface(
sockaddr_u * addr,
int flags
)
{
struct interface *iface;
iface = find_samenet_addr_in_list(addr);
if (iface != NULL && (iface->flags & flags))
iface = NULL;
return iface;
}
static struct interface *
findlocalcastinterface(
sockaddr_u * addr
)
{
struct interface * iface;
struct interface * nif;
#ifdef INCLUDE_IPV6_MULTICAST_SUPPORT
isc_boolean_t want_linklocal;
#endif
NTP_REQUIRE(addr_ismulticast(addr));
nif = findlocalinterface(addr, 0, 0);
if (nif != NULL && !nif->ignore_packets) {
DPRINTF(2, ("findlocalcastinterface: kernel recommends interface #%d %s for %s\n",
nif->ifnum, nif->name, stoa(addr)));
return nif;
}
#ifdef INCLUDE_IPV6_MULTICAST_SUPPORT
want_linklocal = (IN6_IS_ADDR_MC_LINKLOCAL(PSOCK_ADDR6(addr))
|| IN6_IS_ADDR_MC_SITELOCAL(PSOCK_ADDR6(addr)));
#endif
for (iface = inter_list;
iface != NULL;
iface = iface->link)
{
if (iface->ignore_packets)
continue;
if (iface->flags & (INT_LOOPBACK | INT_WILDCARD))
continue;
if (AF(&iface->sin) != AF(addr))
continue;
if (!(iface->flags & INT_MULTICAST))
continue;
#ifdef INCLUDE_IPV6_MULTICAST_SUPPORT
if (want_linklocal && IS_IPV6(&iface->sin) &&
IN6_IS_ADDR_LINKLOCAL(PSOCK_ADDR6(&iface->sin))) {
nif = iface;
break;
}
if (want_linklocal)
continue;
#endif
nif = iface;
break;
}
if (nif != NULL)
DPRINTF(3, ("findlocalcastinterface: found interface #%d %s for %s\n",
nif->ifnum, nif->name, stoa(addr)));
else
DPRINTF(3, ("findlocalcastinterface: no interface found for %s\n",
stoa(addr)));
return nif;
}
struct interface *
findbcastinter(
sockaddr_u *addr
)
{
#if !defined(MPE) && (defined(SIOCGIFCONF) || defined(SYS_WINNT))
struct interface *iface;
DPRINTF(4, ("Finding broadcast/multicast interface for addr %s in list of addresses\n",
stoa(addr)));
iface = findlocalinterface(addr, INT_LOOPBACK | INT_WILDCARD,
1);
if (iface != NULL) {
DPRINTF(4, ("Easily found bcast-/mcast- interface index #%d %s\n",
iface->ifnum, iface->name));
return iface;
}
for (iface = inter_list;
iface != NULL;
iface = iface->link)
{
if (iface->flags & INT_WILDCARD)
continue;
if (iface->ignore_packets)
continue;
if(AF(&iface->sin) != AF(addr))
continue;
if (iface->flags & INT_LOOPBACK)
continue;
if (addr_ismulticast(addr)
&& (iface->flags & INT_MULTICAST)) {
#ifdef INCLUDE_IPV6_SUPPORT
if (IS_IPV6(addr)
&& IN6_IS_ADDR_MC_LINKLOCAL(PSOCK_ADDR6(addr))
&& !IN6_IS_ADDR_LINKLOCAL(PSOCK_ADDR6(&iface->sin)))
continue;
#endif
break;
}
if (IS_IPV4(addr)) {
if (SOCK_EQ(&iface->bcast, addr))
break;
if ((NSRCADR(&iface->sin) & NSRCADR(&iface->mask))
== (NSRCADR(addr) & NSRCADR(&iface->mask)))
break;
}
#ifdef INCLUDE_IPV6_SUPPORT
else if(IS_IPV6(addr)) {
if (SOCK_EQ(&iface->bcast, addr))
break;
if (SOCK_EQ(netof(&iface->sin), netof(addr)))
break;
}
#endif
}
#endif
if (NULL == iface) {
DPRINTF(4, ("No bcast interface found for %s\n",
stoa(addr)));
iface = ANY_INTERFACE_CHOOSE(addr);
} else
DPRINTF(4, ("Found bcast-/mcast- interface index #%d %s\n",
iface->ifnum, iface->name));
return iface;
}
void
io_clr_stats(void)
{
packets_dropped = 0;
packets_ignored = 0;
packets_received = 0;
packets_sent = 0;
packets_notsent = 0;
handler_calls = 0;
handler_pkts = 0;
io_timereset = current_time;
}
#ifdef REFCLOCK
int
io_addclock(
struct refclockio *rio
)
{
BLOCKIO();
rio->next = refio;
# ifdef HAVE_SIGNALED_IO
if (init_clock_sig(rio)) {
UNBLOCKIO();
return 0;
}
# elif defined(HAVE_IO_COMPLETION_PORT)
if (io_completion_port_add_clock_io(rio)) {
UNBLOCKIO();
return 0;
}
# endif
refio = rio;
add_fd_to_list(rio->fd, FD_TYPE_FILE);
UNBLOCKIO();
return 1;
}
void
io_closeclock(
struct refclockio *rio
)
{
register struct refclockio *rp;
BLOCKIO();
if (refio == rio)
refio = rio->next;
else {
for (rp = refio; rp != NULL; rp = rp->next)
if (rp->next == rio) {
rp->next = rio->next;
break;
}
if (NULL == rp) {
UNBLOCKIO();
return;
}
}
close_and_delete_fd_from_list(rio->fd);
UNBLOCKIO();
}
#endif
#ifndef SYS_WINNT
void
kill_asyncio(int startfd)
{
BLOCKIO();
maxactivefd = 0;
while (fd_list != NULL)
close_and_delete_fd_from_list(fd_list->fd);
UNBLOCKIO();
}
#endif
static void
add_fd_to_list(
SOCKET fd,
enum desc_type type
)
{
vsock_t *lsock = emalloc(sizeof(*lsock));
lsock->fd = fd;
lsock->type = type;
LINK_SLIST(fd_list, lsock, link);
#ifndef HAVE_IO_COMPLETION_PORT
if (fd < 0 || fd >= FD_SETSIZE) {
msyslog(LOG_ERR,
"Too many sockets in use, FD_SETSIZE %d exceeded",
FD_SETSIZE);
exit(1);
}
maxactivefd = max(fd, maxactivefd);
FD_SET(fd, &activefds);
#endif
}
static void
close_and_delete_fd_from_list(
SOCKET fd
)
{
vsock_t *lsock;
UNLINK_EXPR_SLIST(lsock, fd_list, fd ==
UNLINK_EXPR_SLIST_CURRENT()->fd, link, vsock_t);
if (lsock != NULL) {
switch (lsock->type) {
case FD_TYPE_SOCKET:
closesocket(lsock->fd);
break;
case FD_TYPE_FILE:
close(lsock->fd);
break;
default:
msyslog(LOG_ERR,
"internal error - illegal descriptor type %d - EXITING",
(int)lsock->type);
exit(1);
}
free(lsock);
#ifndef HAVE_IO_COMPLETION_PORT
FD_CLR(fd, &activefds);
if (fd == maxactivefd && maxactivefd) {
int i;
NTP_INSIST(maxactivefd - 1 < FD_SETSIZE);
for (i = maxactivefd - 1; i >= 0; i--)
if (FD_ISSET(i, &activefds)) {
maxactivefd = i;
break;
}
NTP_INSIST(fd != maxactivefd);
}
#endif
}
}
static void
add_addr_to_list(
sockaddr_u *addr,
struct interface *interface
)
{
remaddr_t *laddr;
#ifdef DEBUG
if (find_addr_in_list(addr) == NULL) {
#endif
laddr = emalloc(sizeof(*laddr));
memcpy(&laddr->addr, addr, sizeof(laddr->addr));
laddr->interface = interface;
LINK_SLIST(remoteaddr_list, laddr, link);
DPRINTF(4, ("Added addr %s to list of addresses\n",
stoa(addr)));
#ifdef DEBUG
} else
DPRINTF(4, ("WARNING: Attempt to add duplicate addr %s to address list\n",
stoa(addr)));
#endif
}
static void
delete_addr_from_list(
sockaddr_u *addr
)
{
remaddr_t *unlinked;
UNLINK_EXPR_SLIST(unlinked, remoteaddr_list, SOCK_EQ(addr,
&(UNLINK_EXPR_SLIST_CURRENT()->addr)), link, remaddr_t);
if (unlinked != NULL) {
DPRINTF(4, ("Deleted addr %s from list of addresses\n",
stoa(addr)));
free(unlinked);
}
}
static void
delete_interface_from_list(
struct interface *iface
)
{
remaddr_t *unlinked;
do {
UNLINK_EXPR_SLIST(unlinked, remoteaddr_list, iface ==
UNLINK_EXPR_SLIST_CURRENT()->interface, link,
remaddr_t);
if (unlinked != NULL) {
DPRINTF(4, ("Deleted addr %s for interface #%d %s from list of addresses\n",
stoa(&unlinked->addr), iface->ifnum,
iface->name));
if (addr_ismulticast(&unlinked->addr))
io_multicast_add(&unlinked->addr);
free(unlinked);
}
} while (unlinked != NULL);
}
static struct interface *
find_addr_in_list(
sockaddr_u *addr
)
{
remaddr_t *entry;
DPRINTF(4, ("Searching for addr %s in list of addresses - ",
stoa(addr)));
for (entry = remoteaddr_list;
entry != NULL;
entry = entry->link)
if (SOCK_EQ(&entry->addr, addr)) {
DPRINTF(4, ("FOUND\n"));
return entry->interface;
}
DPRINTF(4, ("NOT FOUND\n"));
return NULL;
}
static inline isc_boolean_t
same_network_v4(
struct sockaddr_in *addr1,
struct sockaddr_in *mask,
struct sockaddr_in *addr2
)
{
return (addr1->sin_addr.s_addr & mask->sin_addr.s_addr)
== (addr2->sin_addr.s_addr & mask->sin_addr.s_addr);
}
#ifdef INCLUDE_IPV6_SUPPORT
static inline isc_boolean_t
same_network_v6(
struct sockaddr_in6 *addr1,
struct sockaddr_in6 *mask,
struct sockaddr_in6 *addr2
)
{
int i;
for (i = 0;
i < sizeof(addr1->sin6_addr.s6_addr) /
sizeof(addr1->sin6_addr.s6_addr[0]);
i++)
if ((addr1->sin6_addr.s6_addr[i] &
mask->sin6_addr.s6_addr[i])
!=
(addr2->sin6_addr.s6_addr[i] &
mask->sin6_addr.s6_addr[i]))
return ISC_FALSE;
return ISC_TRUE;
}
#endif
static isc_boolean_t
same_network(
sockaddr_u *a1,
sockaddr_u *mask,
sockaddr_u *a2
)
{
isc_boolean_t sn;
if (AF(a1) != AF(a2))
sn = ISC_FALSE;
else if (IS_IPV4(a1))
sn = same_network_v4(&a1->sa4, &mask->sa4, &a2->sa4);
#ifdef INCLUDE_IPV6_SUPPORT
else if (IS_IPV6(a1))
sn = same_network_v6(&a1->sa6, &mask->sa6, &a2->sa6);
#endif
else
sn = ISC_FALSE;
return sn;
}
static struct interface *
find_samenet_addr_in_list(
sockaddr_u *addr
)
{
remaddr_t *entry;
DPRINTF(4, ("Searching for addr with same subnet as %s in list of addresses - ",
stoa(addr)));
for (entry = remoteaddr_list;
entry != NULL;
entry = entry->link)
if (!SOCK_EQ(addr, &entry->addr)
&& same_network(&entry->addr,
&entry->interface->mask,
addr)) {
DPRINTF(4, ("FOUND\n"));
return entry->interface;
}
DPRINTF(4, ("NOT FOUND\n"));
return NULL;
}
static struct interface *
find_flagged_addr_in_list(
sockaddr_u * addr,
int flags
)
{
remaddr_t *entry;
DPRINTF(4, ("Finding addr %s with flags %d in list: ",
stoa(addr), flags));
for (entry = remoteaddr_list;
entry != NULL;
entry = entry->link)
if (SOCK_EQ(&entry->addr, addr)
&& (entry->interface->flags & flags) == flags) {
DPRINTF(4, ("FOUND\n"));
return entry->interface;
}
DPRINTF(4, ("NOT FOUND\n"));
return NULL;
}
#ifdef HAS_ROUTING_SOCKET
# ifndef UPDATE_GRACE
# define UPDATE_GRACE 2
# endif
static void
process_routing_msgs(struct asyncio_reader *reader)
{
char buffer[5120];
int cnt, msg_type;
#ifdef HAVE_RTNETLINK
struct nlmsghdr *nh;
#else
struct rt_msghdr *rtm;
char *p;
#endif
if (disable_dynamic_updates) {
remove_asyncio_reader(reader);
delete_asyncio_reader(reader);
return;
}
cnt = read(reader->fd, buffer, sizeof(buffer));
if (cnt < 0) {
msyslog(LOG_ERR,
"i/o error on routing socket %m - disabling");
remove_asyncio_reader(reader);
delete_asyncio_reader(reader);
return;
}
#ifdef HAVE_RTNETLINK
for (nh = (struct nlmsghdr *)buffer;
NLMSG_OK(nh, cnt);
nh = NLMSG_NEXT(nh, cnt)) {
msg_type = nh->nlmsg_type;
#else
for (p = buffer;
(p + sizeof(struct rt_msghdr)) <= (buffer + cnt);
p += rtm->rtm_msglen) {
rtm = (struct rt_msghdr *)p;
if (rtm->rtm_version != RTM_VERSION) {
msyslog(LOG_ERR,
"version mismatch (got %d - expected %d) on routing socket - disabling",
rtm->rtm_version, RTM_VERSION);
remove_asyncio_reader(reader);
delete_asyncio_reader(reader);
return;
}
msg_type = rtm->rtm_type;
#endif
switch (msg_type) {
#ifdef RTM_NEWADDR
case RTM_NEWADDR:
#endif
#ifdef RTM_DELADDR
case RTM_DELADDR:
#endif
#ifdef RTM_ADD
case RTM_ADD:
#endif
#ifdef RTM_DELETE
case RTM_DELETE:
#endif
#ifdef RTM_REDIRECT
case RTM_REDIRECT:
#endif
#ifdef RTM_CHANGE
case RTM_CHANGE:
#endif
#ifdef RTM_LOSING
case RTM_LOSING:
#endif
#ifdef RTM_IFINFO
case RTM_IFINFO:
#endif
#ifdef RTM_IFANNOUNCE
case RTM_IFANNOUNCE:
#endif
#ifdef RTM_NEWLINK
case RTM_NEWLINK:
#endif
#ifdef RTM_DELLINK
case RTM_DELLINK:
#endif
#ifdef RTM_NEWROUTE
case RTM_NEWROUTE:
#endif
#ifdef RTM_DELROUTE
case RTM_DELROUTE:
#endif
DPRINTF(3, ("routing message op = %d: scheduling interface update\n",
msg_type));
timer_interfacetimeout(current_time + UPDATE_GRACE);
break;
#ifdef HAVE_RTNETLINK
case NLMSG_DONE:
return;
#endif
default:
DPRINTF(4, ("routing message op = %d: ignored\n",
msg_type));
break;
}
}
}
static void
init_async_notifications()
{
struct asyncio_reader *reader;
#ifdef HAVE_RTNETLINK
int fd = socket(PF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
struct sockaddr_nl sa;
#else
int fd = socket(PF_ROUTE, SOCK_RAW, 0);
#endif
if (fd < 0) {
msyslog(LOG_ERR,
"unable to open routing socket (%m) - using polled interface update");
return;
}
fd = move_fd(fd);
#ifdef HAVE_RTNETLINK
memset(&sa, 0, sizeof(sa));
sa.nl_family = PF_NETLINK;
sa.nl_groups = RTMGRP_LINK | RTMGRP_IPV4_IFADDR
| RTMGRP_IPV6_IFADDR | RTMGRP_IPV4_ROUTE
| RTMGRP_IPV4_MROUTE | RTMGRP_IPV6_ROUTE
| RTMGRP_IPV6_MROUTE;
if (bind(fd, (struct sockaddr *)&sa, sizeof(sa)) < 0) {
msyslog(LOG_ERR,
"bind failed on routing socket (%m) - using polled interface update");
return;
}
#endif
init_nonblocking_io(fd);
#if defined(HAVE_SIGNALED_IO)
init_socket_sig(fd);
#endif
reader = new_asyncio_reader();
reader->fd = fd;
reader->receiver = process_routing_msgs;
add_asyncio_reader(reader, FD_TYPE_SOCKET);
msyslog(LOG_INFO,
"Listening on routing socket on fd #%d for interface updates",
fd);
}
#else
static void
init_async_notifications(void)
{
}
#endif