#include "mDNSEmbeddedAPI.h" // Defines the interface provided to the client layer above
#include "mDNSPosix.h" // Defines the specific types needed to run mDNS on this platform
#include "dns_sd.h"
#include <assert.h>
#include <stdio.h>
#include <stdlib.h>
#include <errno.h>
#include <string.h>
#include <unistd.h>
#include <syslog.h>
#include <stdarg.h>
#include <fcntl.h>
#include <sys/types.h>
#include <sys/time.h>
#include <sys/socket.h>
#include <sys/uio.h>
#include <sys/select.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <time.h> // platform support for UTC time
#if USES_NETLINK
#include <asm/types.h>
#include <linux/netlink.h>
#include <linux/rtnetlink.h>
#else // USES_NETLINK
#include <net/route.h>
#include <net/if.h>
#endif // USES_NETLINK
#include "mDNSUNP.h"
#include "GenLinkedList.h"
struct PosixEventSource
{
mDNSPosixEventCallback Callback;
void *Context;
int fd;
struct PosixEventSource *Next;
};
typedef struct PosixEventSource PosixEventSource;
struct IfChangeRec
{
int NotifySD;
mDNS* mDNS;
};
typedef struct IfChangeRec IfChangeRec;
static fd_set gEventFDs;
static int gMaxFD; static GenLinkedList gEventSources; static sigset_t gEventSignalSet; static sigset_t gEventSignals;
static int num_registered_interfaces = 0;
static int num_pkts_accepted = 0;
static int num_pkts_rejected = 0;
int gMDNSPlatformPosixVerboseLevel = 0;
#define PosixErrorToStatus(errNum) ((errNum) == 0 ? mStatus_NoError : mStatus_UnknownErr)
mDNSlocal void SockAddrTomDNSAddr(const struct sockaddr *const sa, mDNSAddr *ipAddr, mDNSIPPort *ipPort)
{
switch (sa->sa_family)
{
case AF_INET:
{
struct sockaddr_in* sin = (struct sockaddr_in*)sa;
ipAddr->type = mDNSAddrType_IPv4;
ipAddr->ip.v4.NotAnInteger = sin->sin_addr.s_addr;
if (ipPort) ipPort->NotAnInteger = sin->sin_port;
break;
}
#if HAVE_IPV6
case AF_INET6:
{
struct sockaddr_in6* sin6 = (struct sockaddr_in6*)sa;
#ifndef NOT_HAVE_SA_LEN
assert(sin6->sin6_len == sizeof(*sin6));
#endif
ipAddr->type = mDNSAddrType_IPv6;
ipAddr->ip.v6 = *(mDNSv6Addr*)&sin6->sin6_addr;
if (ipPort) ipPort->NotAnInteger = sin6->sin6_port;
break;
}
#endif
default:
verbosedebugf("SockAddrTomDNSAddr: Uknown address family %d\n", sa->sa_family);
ipAddr->type = mDNSAddrType_None;
if (ipPort) ipPort->NotAnInteger = 0;
break;
}
}
#if COMPILER_LIKES_PRAGMA_MARK
#pragma mark ***** Send and Receive
#endif
mDNSexport mStatus mDNSPlatformSendUDP(const mDNS *const m, const void *const msg, const mDNSu8 *const end,
mDNSInterfaceID InterfaceID, const mDNSAddr *dst, mDNSIPPort dstPort)
{
int err = 0;
struct sockaddr_storage to;
PosixNetworkInterface * thisIntf = (PosixNetworkInterface *)(InterfaceID);
int sendingsocket = -1;
assert(m != NULL);
assert(msg != NULL);
assert(end != NULL);
assert( (((char *) end) - ((char *) msg)) > 0 );
assert(dstPort.NotAnInteger != 0);
if (dst->type == mDNSAddrType_IPv4)
{
struct sockaddr_in *sin = (struct sockaddr_in*)&to;
#ifndef NOT_HAVE_SA_LEN
sin->sin_len = sizeof(*sin);
#endif
sin->sin_family = AF_INET;
sin->sin_port = dstPort.NotAnInteger;
sin->sin_addr.s_addr = dst->ip.v4.NotAnInteger;
sendingsocket = thisIntf ? thisIntf->multicastSocket4 : m->p->unicastSocket4;
}
#if HAVE_IPV6
else if (dst->type == mDNSAddrType_IPv6)
{
struct sockaddr_in6 *sin6 = (struct sockaddr_in6*)&to;
mDNSPlatformMemZero(sin6, sizeof(*sin6));
#ifndef NOT_HAVE_SA_LEN
sin6->sin6_len = sizeof(*sin6);
#endif
sin6->sin6_family = AF_INET6;
sin6->sin6_port = dstPort.NotAnInteger;
sin6->sin6_addr = *(struct in6_addr*)&dst->ip.v6;
sendingsocket = thisIntf ? thisIntf->multicastSocket6 : m->p->unicastSocket6;
}
#endif
if (sendingsocket >= 0)
err = sendto(sendingsocket, msg, (char*)end - (char*)msg, 0, (struct sockaddr *)&to, GET_SA_LEN(to));
if (err > 0) err = 0;
else if (err < 0)
{
if (thisIntf)
verbosedebugf("mDNSPlatformSendUDP got error %d (%s) sending packet to %#a on interface %#a/%s/%d",
errno, strerror(errno), dst, &thisIntf->coreIntf.ip, thisIntf->intfName, thisIntf->index);
else
verbosedebugf("mDNSPlatformSendUDP got error %d (%s) sending packet to %#a", errno, strerror(errno), dst);
}
return PosixErrorToStatus(err);
}
mDNSlocal void SocketDataReady(mDNS *const m, PosixNetworkInterface *intf, int skt)
{
mDNSAddr senderAddr, destAddr;
mDNSIPPort senderPort;
ssize_t packetLen;
DNSMessage packet;
struct my_in_pktinfo packetInfo;
struct sockaddr_storage from;
socklen_t fromLen;
int flags;
mDNSu8 ttl;
mDNSBool reject;
const mDNSInterfaceID InterfaceID = intf ? intf->coreIntf.InterfaceID : NULL;
assert(m != NULL);
assert(skt >= 0);
fromLen = sizeof(from);
flags = 0;
packetLen = recvfrom_flags(skt, &packet, sizeof(packet), &flags, (struct sockaddr *) &from, &fromLen, &packetInfo, &ttl);
if (packetLen >= 0)
{
SockAddrTomDNSAddr((struct sockaddr*)&from, &senderAddr, &senderPort);
SockAddrTomDNSAddr((struct sockaddr*)&packetInfo.ipi_addr, &destAddr, NULL);
#if HAVE_BROKEN_RECVDSTADDR || (!defined(IP_PKTINFO) && !defined(IP_RECVDSTADDR))
if ( (destAddr.NotAnInteger == 0) && (flags & MSG_MCAST) )
{
destAddr.type = senderAddr.type;
if (senderAddr.type == mDNSAddrType_IPv4) destAddr.ip.v4 = AllDNSLinkGroupv4;
else if (senderAddr.type == mDNSAddrType_IPv6) destAddr.ip.v6 = AllDNSLinkGroupv6;
}
#endif
reject = mDNSfalse;
if (!intf)
{
if (mDNSAddrIsDNSMulticast(&destAddr)) packetLen = -1;
}
else
{
if ( packetInfo.ipi_ifname[0] != 0 ) reject = (strcmp(packetInfo.ipi_ifname, intf->intfName) != 0);
else if ( packetInfo.ipi_ifindex != -1 ) reject = (packetInfo.ipi_ifindex != intf->index);
if (reject)
{
verbosedebugf("SocketDataReady ignored a packet from %#a to %#a on interface %s/%d expecting %#a/%s/%d/%d",
&senderAddr, &destAddr, packetInfo.ipi_ifname, packetInfo.ipi_ifindex,
&intf->coreIntf.ip, intf->intfName, intf->index, skt);
packetLen = -1;
num_pkts_rejected++;
if (num_pkts_rejected > (num_pkts_accepted + 1) * (num_registered_interfaces + 1) * 2)
{
fprintf(stderr,
"*** WARNING: Received %d packets; Accepted %d packets; Rejected %d packets because of interface mismatch\n",
num_pkts_accepted + num_pkts_rejected, num_pkts_accepted, num_pkts_rejected);
num_pkts_accepted = 0;
num_pkts_rejected = 0;
}
}
else
{
verbosedebugf("SocketDataReady got a packet from %#a to %#a on interface %#a/%s/%d/%d",
&senderAddr, &destAddr, &intf->coreIntf.ip, intf->intfName, intf->index, skt);
num_pkts_accepted++;
}
}
}
if (packetLen >= 0)
mDNSCoreReceive(m, &packet, (mDNSu8 *)&packet + packetLen,
&senderAddr, senderPort, &destAddr, MulticastDNSPort, InterfaceID);
}
mDNSexport mStatus mDNSPlatformTCPConnect(const mDNSAddr *dst, mDNSOpaque16 dstport, mDNSInterfaceID InterfaceID,
TCPConnectionCallback callback, void *context, int *descriptor)
{
(void)dst; (void)dstport; (void)InterfaceID; (void)callback; (void)context; (void)descriptor; return(mStatus_UnsupportedErr);
}
mDNSexport void mDNSPlatformTCPCloseConnection(int sd)
{
(void)sd; }
mDNSexport int mDNSPlatformReadTCP(int sd, void *buf, int buflen)
{
(void)sd; (void)buf; (void)buflen; return(0);
}
mDNSexport int mDNSPlatformWriteTCP(int sd, const char *msg, int len)
{
(void)sd; (void)msg; (void)len; return(0);
}
#if COMPILER_LIKES_PRAGMA_MARK
#pragma mark ***** Get/Free Search Domain List
#endif
mDNSexport DNameListElem *mDNSPlatformGetSearchDomainList(void)
{
static DNameListElem tmp;
static mDNSBool init = mDNSfalse;
if (!init)
{
MakeDomainNameFromDNSNameString(&tmp.name, "local.");
tmp.next = NULL;
init = mDNStrue;
}
return mDNS_CopyDNameList(&tmp);
}
mDNSexport DNameListElem *mDNSPlatformGetRegDomainList(void)
{
return NULL;
}
#if COMPILER_LIKES_PRAGMA_MARK
#pragma mark ***** Init and Term
#endif
mDNSlocal void GetUserSpecifiedRFC1034ComputerName(domainlabel *const namelabel)
{
int len = 0;
gethostname((char *)(&namelabel->c[1]), MAX_DOMAIN_LABEL);
while (len < MAX_DOMAIN_LABEL && namelabel->c[len+1] && namelabel->c[len+1] != '.') len++;
namelabel->c[0] = len;
}
mDNSlocal void GetUserSpecifiedFriendlyComputerName(domainlabel *const namelabel)
{
GetUserSpecifiedRFC1034ComputerName( namelabel);
}
mDNSexport int ParseDNSServers(mDNS *m, const char *filePath)
{
char line[256];
char nameserver[16];
char keyword[10];
int numOfServers = 0;
FILE *fp = fopen(filePath, "r");
if (fp == NULL) return -1;
while (fgets(line,sizeof(line),fp))
{
struct in_addr ina;
line[255]='\0'; if (sscanf(line,"%10s %15s", keyword, nameserver) != 2) continue; if (strncmp(keyword,"nameserver",10)) continue;
if (inet_aton(nameserver, (struct in_addr *)&ina) != 0)
{
mDNSAddr DNSAddr;
DNSAddr.type = mDNSAddrType_IPv4;
DNSAddr.ip.v4.NotAnInteger = ina.s_addr;
mDNS_AddDNSServer(m, &DNSAddr, NULL);
numOfServers++;
}
}
return (numOfServers > 0) ? 0 : -1;
}
mDNSlocal PosixNetworkInterface *SearchForInterfaceByName(mDNS *const m, const char *intfName)
{
PosixNetworkInterface *intf;
assert(m != NULL);
assert(intfName != NULL);
intf = (PosixNetworkInterface*)(m->HostInterfaces);
while ( (intf != NULL) && (strcmp(intf->intfName, intfName) != 0) )
intf = (PosixNetworkInterface *)(intf->coreIntf.next);
return intf;
}
mDNSexport mDNSInterfaceID mDNSPlatformInterfaceIDfromInterfaceIndex(const mDNS *const m, mDNSu32 index)
{
PosixNetworkInterface *intf;
assert(m != NULL);
if (index == kDNSServiceInterfaceIndexLocalOnly) return(mDNSInterface_LocalOnly);
intf = (PosixNetworkInterface*)(m->HostInterfaces);
while ( (intf != NULL) && (mDNSu32) intf->index != index)
intf = (PosixNetworkInterface *)(intf->coreIntf.next);
return (mDNSInterfaceID) intf;
}
mDNSexport mDNSu32 mDNSPlatformInterfaceIndexfromInterfaceID(const mDNS *const m, mDNSInterfaceID id)
{
PosixNetworkInterface *intf;
assert(m != NULL);
if (id == mDNSInterface_LocalOnly) return(kDNSServiceInterfaceIndexLocalOnly);
intf = (PosixNetworkInterface*)(m->HostInterfaces);
while ( (intf != NULL) && (mDNSInterfaceID) intf != id)
intf = (PosixNetworkInterface *)(intf->coreIntf.next);
return intf ? intf->index : 0;
}
mDNSlocal void FreePosixNetworkInterface(PosixNetworkInterface *intf)
{
assert(intf != NULL);
if (intf->intfName != NULL) free((void *)intf->intfName);
if (intf->multicastSocket4 != -1) assert(close(intf->multicastSocket4) == 0);
#if HAVE_IPV6
if (intf->multicastSocket6 != -1) assert(close(intf->multicastSocket6) == 0);
#endif
free(intf);
}
mDNSlocal void ClearInterfaceList(mDNS *const m)
{
assert(m != NULL);
while (m->HostInterfaces)
{
PosixNetworkInterface *intf = (PosixNetworkInterface*)(m->HostInterfaces);
mDNS_DeregisterInterface(m, &intf->coreIntf);
if (gMDNSPlatformPosixVerboseLevel > 0) fprintf(stderr, "Deregistered interface %s\n", intf->intfName);
FreePosixNetworkInterface(intf);
}
num_registered_interfaces = 0;
num_pkts_accepted = 0;
num_pkts_rejected = 0;
}
mDNSlocal int SetupSocket(struct sockaddr *intfAddr, mDNSIPPort port, int interfaceIndex, int *sktPtr)
{
int err = 0;
static const int kOn = 1;
static const int kIntTwoFiveFive = 255;
static const unsigned char kByteTwoFiveFive = 255;
(void) interfaceIndex; assert(intfAddr != NULL);
assert(sktPtr != NULL);
assert(*sktPtr == -1);
if (intfAddr->sa_family == AF_INET ) *sktPtr = socket(PF_INET, SOCK_DGRAM, IPPROTO_UDP);
#if HAVE_IPV6
else if (intfAddr->sa_family == AF_INET6) *sktPtr = socket(PF_INET6, SOCK_DGRAM, IPPROTO_UDP);
#endif
else return EINVAL;
if (*sktPtr < 0) { err = errno; perror("socket"); }
if (err == 0 && port.NotAnInteger)
{
#if defined(SO_REUSEPORT)
err = setsockopt(*sktPtr, SOL_SOCKET, SO_REUSEPORT, &kOn, sizeof(kOn));
#elif defined(SO_REUSEADDR)
err = setsockopt(*sktPtr, SOL_SOCKET, SO_REUSEADDR, &kOn, sizeof(kOn));
#else
#error This platform has no way to avoid address busy errors on multicast.
#endif
if (err < 0) { err = errno; perror("setsockopt - SO_REUSExxxx"); }
}
if (intfAddr->sa_family == AF_INET)
{
struct ip_mreq imr;
struct sockaddr_in bindAddr;
if (err == 0)
{
#if defined(IP_PKTINFO) err = setsockopt(*sktPtr, IPPROTO_IP, IP_PKTINFO, &kOn, sizeof(kOn));
if (err < 0) { err = errno; perror("setsockopt - IP_PKTINFO"); }
#elif defined(IP_RECVDSTADDR) || defined(IP_RECVIF) #if defined(IP_RECVDSTADDR)
err = setsockopt(*sktPtr, IPPROTO_IP, IP_RECVDSTADDR, &kOn, sizeof(kOn));
if (err < 0) { err = errno; perror("setsockopt - IP_RECVDSTADDR"); }
#endif
#if defined(IP_RECVIF)
if (err == 0)
{
err = setsockopt(*sktPtr, IPPROTO_IP, IP_RECVIF, &kOn, sizeof(kOn));
if (err < 0) { err = errno; perror("setsockopt - IP_RECVIF"); }
}
#endif
#else
#warning This platform has no way to get the destination interface information -- will only work for single-homed hosts
#endif
}
#if defined(IP_RECVTTL) if (err == 0)
{
err = setsockopt(*sktPtr, IPPROTO_IP, IP_RECVTTL, &kOn, sizeof(kOn));
if (err < 0) { err = errno; perror("setsockopt - IP_RECVTTL"); }
}
#endif
if (err == 0 && port.NotAnInteger)
{
imr.imr_multiaddr.s_addr = AllDNSLinkGroupv4.NotAnInteger;
imr.imr_interface = ((struct sockaddr_in*)intfAddr)->sin_addr;
err = setsockopt(*sktPtr, IPPROTO_IP, IP_ADD_MEMBERSHIP, &imr, sizeof(imr));
if (err < 0) { err = errno; perror("setsockopt - IP_ADD_MEMBERSHIP"); }
}
if (err == 0 && port.NotAnInteger)
{
err = setsockopt(*sktPtr, IPPROTO_IP, IP_MULTICAST_IF, &((struct sockaddr_in*)intfAddr)->sin_addr, sizeof(struct in_addr));
if (err < 0) { err = errno; perror("setsockopt - IP_MULTICAST_IF"); }
}
if (err == 0)
{
err = setsockopt(*sktPtr, IPPROTO_IP, IP_TTL, &kIntTwoFiveFive, sizeof(kIntTwoFiveFive));
if (err < 0) { err = errno; perror("setsockopt - IP_TTL"); }
}
if (err == 0)
{
err = setsockopt(*sktPtr, IPPROTO_IP, IP_MULTICAST_TTL, &kByteTwoFiveFive, sizeof(kByteTwoFiveFive));
if (err < 0 && errno == EINVAL)
err = setsockopt(*sktPtr, IPPROTO_IP, IP_MULTICAST_TTL, &kIntTwoFiveFive, sizeof(kIntTwoFiveFive));
if (err < 0) { err = errno; perror("setsockopt - IP_MULTICAST_TTL"); }
}
if (err == 0)
{
bindAddr.sin_family = AF_INET;
bindAddr.sin_port = port.NotAnInteger;
bindAddr.sin_addr.s_addr = INADDR_ANY; err = bind(*sktPtr, (struct sockaddr *) &bindAddr, sizeof(bindAddr));
if (err < 0) { err = errno; perror("bind"); fflush(stderr); }
}
}
#if HAVE_IPV6
else if (intfAddr->sa_family == AF_INET6)
{
struct ipv6_mreq imr6;
struct sockaddr_in6 bindAddr6;
#if defined(IPV6_PKTINFO)
if (err == 0)
{
err = setsockopt(*sktPtr, IPPROTO_IPV6, IPV6_PKTINFO, &kOn, sizeof(kOn));
if (err < 0) { err = errno; perror("setsockopt - IPV6_PKTINFO"); }
}
#else
#warning This platform has no way to get the destination interface information for IPv6 -- will only work for single-homed hosts
#endif
#if defined(IPV6_HOPLIMIT)
if (err == 0)
{
err = setsockopt(*sktPtr, IPPROTO_IPV6, IPV6_HOPLIMIT, &kOn, sizeof(kOn));
if (err < 0) { err = errno; perror("setsockopt - IPV6_HOPLIMIT"); }
}
#endif
if (err == 0 && port.NotAnInteger)
{
imr6.ipv6mr_multiaddr = *(const struct in6_addr*)&AllDNSLinkGroupv6;
imr6.ipv6mr_interface = interfaceIndex;
err = setsockopt(*sktPtr, IPPROTO_IPV6, IPV6_JOIN_GROUP, &imr6, sizeof(imr6));
if (err < 0)
{
err = errno;
verbosedebugf("IPV6_JOIN_GROUP %.16a on %d failed.\n", &imr6.ipv6mr_multiaddr, imr6.ipv6mr_interface);
perror("setsockopt - IPV6_JOIN_GROUP");
}
}
if (err == 0 && port.NotAnInteger)
{
u_int multicast_if = interfaceIndex;
err = setsockopt(*sktPtr, IPPROTO_IPV6, IPV6_MULTICAST_IF, &multicast_if, sizeof(multicast_if));
if (err < 0) { err = errno; perror("setsockopt - IPV6_MULTICAST_IF"); }
}
if (err == 0)
{
err = setsockopt(*sktPtr, IPPROTO_IPV6, IPV6_V6ONLY, &kOn, sizeof(kOn));
if (err < 0) { err = errno; perror("setsockopt - IPV6_V6ONLY"); }
}
if (err == 0)
{
err = setsockopt(*sktPtr, IPPROTO_IPV6, IPV6_UNICAST_HOPS, &kIntTwoFiveFive, sizeof(kIntTwoFiveFive));
if (err < 0) { err = errno; perror("setsockopt - IPV6_UNICAST_HOPS"); }
}
if (err == 0)
{
err = setsockopt(*sktPtr, IPPROTO_IPV6, IPV6_MULTICAST_HOPS, &kByteTwoFiveFive, sizeof(kByteTwoFiveFive));
if (err < 0 && errno == EINVAL)
err = setsockopt(*sktPtr, IPPROTO_IPV6, IPV6_MULTICAST_HOPS, &kIntTwoFiveFive, sizeof(kIntTwoFiveFive));
if (err < 0) { err = errno; perror("setsockopt - IPV6_MULTICAST_HOPS"); }
}
if (err == 0)
{
mDNSPlatformMemZero(&bindAddr6, sizeof(bindAddr6));
#ifndef NOT_HAVE_SA_LEN
bindAddr6.sin6_len = sizeof(bindAddr6);
#endif
bindAddr6.sin6_family = AF_INET6;
bindAddr6.sin6_port = port.NotAnInteger;
bindAddr6.sin6_flowinfo = 0;
bindAddr6.sin6_scope_id = 0;
err = bind(*sktPtr, (struct sockaddr *) &bindAddr6, sizeof(bindAddr6));
if (err < 0) { err = errno; perror("bind"); fflush(stderr); }
}
} #endif
if (err == 0)
{
err = fcntl(*sktPtr, F_GETFL, 0);
if (err < 0) err = errno;
else
{
err = fcntl(*sktPtr, F_SETFL, err | O_NONBLOCK);
if (err < 0) err = errno;
}
}
if (err != 0 && *sktPtr != -1) { assert(close(*sktPtr) == 0); *sktPtr = -1; }
assert( (err == 0) == (*sktPtr != -1) );
return err;
}
mDNSlocal int SetupOneInterface(mDNS *const m, struct sockaddr *intfAddr, struct sockaddr *intfMask, const char *intfName, int intfIndex)
{
int err = 0;
PosixNetworkInterface *intf;
PosixNetworkInterface *alias = NULL;
assert(m != NULL);
assert(intfAddr != NULL);
assert(intfName != NULL);
assert(intfMask != NULL);
intf = (PosixNetworkInterface*)malloc(sizeof(*intf));
if (intf == NULL) { assert(0); err = ENOMEM; }
if (err == 0)
{
intf->intfName = strdup(intfName);
if (intf->intfName == NULL) { assert(0); err = ENOMEM; }
}
if (err == 0)
{
SockAddrTomDNSAddr(intfAddr, &intf->coreIntf.ip, NULL);
SockAddrTomDNSAddr(intfMask, &intf->coreIntf.mask, NULL);
strncpy(intf->coreIntf.ifname, intfName, sizeof(intf->coreIntf.ifname));
intf->coreIntf.ifname[sizeof(intf->coreIntf.ifname)-1] = 0;
intf->coreIntf.Advertise = m->AdvertiseLocalAddresses;
intf->coreIntf.McastTxRx = mDNStrue;
assert(intf->intfName != NULL); intf->index = intfIndex;
intf->multicastSocket4 = -1;
#if HAVE_IPV6
intf->multicastSocket6 = -1;
#endif
alias = SearchForInterfaceByName(m, intf->intfName);
if (alias == NULL) alias = intf;
intf->coreIntf.InterfaceID = (mDNSInterfaceID)alias;
if (alias != intf)
debugf("SetupOneInterface: %s %#a is an alias of %#a", intfName, &intf->coreIntf.ip, &alias->coreIntf.ip);
}
if (err == 0)
{
if (alias->multicastSocket4 == -1 && intfAddr->sa_family == AF_INET)
err = SetupSocket(intfAddr, MulticastDNSPort, intf->index, &alias->multicastSocket4);
#if HAVE_IPV6
else if (alias->multicastSocket6 == -1 && intfAddr->sa_family == AF_INET6)
err = SetupSocket(intfAddr, MulticastDNSPort, intf->index, &alias->multicastSocket6);
#endif
}
if (err == 0)
err = mDNS_RegisterInterface(m, &intf->coreIntf, 0);
if (err == 0)
{
num_registered_interfaces++;
debugf("SetupOneInterface: %s %#a Registered", intf->intfName, &intf->coreIntf.ip);
if (gMDNSPlatformPosixVerboseLevel > 0)
fprintf(stderr, "Registered interface %s\n", intf->intfName);
}
else
{
debugf("SetupOneInterface: %s %#a failed to register %d", intfName, &intf->coreIntf.ip, err);
if (intf) { FreePosixNetworkInterface(intf); intf = NULL; }
}
assert( (err == 0) == (intf != NULL) );
return err;
}
mDNSlocal int SetupInterfaceList(mDNS *const m)
{
mDNSBool foundav4 = mDNSfalse;
int err = 0;
struct ifi_info *intfList = get_ifi_info(AF_INET, mDNStrue);
struct ifi_info *firstLoopback = NULL;
assert(m != NULL);
debugf("SetupInterfaceList");
if (intfList == NULL) err = ENOENT;
#if HAVE_IPV6
if (err == 0)
{
struct ifi_info **p = &intfList;
while (*p) p = &(*p)->ifi_next;
*p = get_ifi_info(AF_INET6, mDNStrue);
}
#endif
if (err == 0)
{
struct ifi_info *i = intfList;
while (i)
{
if ( ((i->ifi_addr->sa_family == AF_INET)
#if HAVE_IPV6
|| (i->ifi_addr->sa_family == AF_INET6)
#endif
) && (i->ifi_flags & IFF_UP) && !(i->ifi_flags & IFF_POINTOPOINT) )
{
if (i->ifi_flags & IFF_LOOPBACK)
{
if (firstLoopback == NULL)
firstLoopback = i;
}
else
{
if (SetupOneInterface(m, i->ifi_addr, i->ifi_netmask, i->ifi_name, i->ifi_index) == 0)
if (i->ifi_addr->sa_family == AF_INET)
foundav4 = mDNStrue;
}
}
i = i->ifi_next;
}
if ( !foundav4 && firstLoopback )
(void) SetupOneInterface(m, firstLoopback->ifi_addr, firstLoopback->ifi_netmask, firstLoopback->ifi_name, firstLoopback->ifi_index);
}
if (intfList != NULL) free_ifi_info(intfList);
return err;
}
#if USES_NETLINK
mDNSlocal mStatus OpenIfNotifySocket( int *pFD)
{
mStatus err = mStatus_NoError;
struct sockaddr_nl snl;
int sock;
int ret;
sock = socket( AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
if (sock < 0)
return errno;
(void) fcntl( sock, F_SETFL, O_NONBLOCK);
bzero( &snl, sizeof snl);
snl.nl_family = AF_NETLINK;
snl.nl_groups = RTMGRP_LINK | RTMGRP_IPV4_IFADDR;
ret = bind( sock, (struct sockaddr *) &snl, sizeof snl);
if ( 0 == ret)
*pFD = sock;
else
err = errno;
return err;
}
#if MDNS_DEBUGMSGS
mDNSlocal void PrintNetLinkMsg( const struct nlmsghdr *pNLMsg)
{
const char *kNLMsgTypes[] = { "", "NLMSG_NOOP", "NLMSG_ERROR", "NLMSG_DONE", "NLMSG_OVERRUN" };
const char *kNLRtMsgTypes[] = { "RTM_NEWLINK", "RTM_DELLINK", "RTM_GETLINK", "RTM_NEWADDR", "RTM_DELADDR", "RTM_GETADDR" };
printf( "nlmsghdr len=%d, type=%s, flags=0x%x\n", pNLMsg->nlmsg_len,
pNLMsg->nlmsg_type < RTM_BASE ? kNLMsgTypes[ pNLMsg->nlmsg_type] : kNLRtMsgTypes[ pNLMsg->nlmsg_type - RTM_BASE],
pNLMsg->nlmsg_flags);
if ( RTM_NEWLINK <= pNLMsg->nlmsg_type && pNLMsg->nlmsg_type <= RTM_GETLINK)
{
struct ifinfomsg *pIfInfo = (struct ifinfomsg*) NLMSG_DATA( pNLMsg);
printf( "ifinfomsg family=%d, type=%d, index=%d, flags=0x%x, change=0x%x\n", pIfInfo->ifi_family,
pIfInfo->ifi_type, pIfInfo->ifi_index, pIfInfo->ifi_flags, pIfInfo->ifi_change);
}
else if ( RTM_NEWADDR <= pNLMsg->nlmsg_type && pNLMsg->nlmsg_type <= RTM_GETADDR)
{
struct ifaddrmsg *pIfAddr = (struct ifaddrmsg*) NLMSG_DATA( pNLMsg);
printf( "ifaddrmsg family=%d, index=%d, flags=0x%x\n", pIfAddr->ifa_family,
pIfAddr->ifa_index, pIfAddr->ifa_flags);
}
printf( "\n");
}
#endif
mDNSlocal mDNSu32 ProcessRoutingNotification( int sd)
{
ssize_t readCount;
char buff[ 4096];
struct nlmsghdr *pNLMsg = (struct nlmsghdr*) buff;
mDNSu32 result = 0;
readCount = read( sd, buff, sizeof buff);
while ( 1)
{
if ( ( (char*) &pNLMsg[1] > ( buff + readCount)) || ( (char*) pNLMsg + pNLMsg->nlmsg_len > ( buff + readCount)))
{
if ( buff < (char*) pNLMsg) {
readCount -= ( (char*) pNLMsg - buff);
memmove( buff, pNLMsg, readCount);
pNLMsg = (struct nlmsghdr*) buff;
readCount += read( sd, buff + readCount, sizeof buff - readCount);
continue; }
else
break; }
#if MDNS_DEBUGMSGS
PrintNetLinkMsg( pNLMsg);
#endif
if ( pNLMsg->nlmsg_type == RTM_GETLINK || pNLMsg->nlmsg_type == RTM_NEWLINK)
result |= 1 << ((struct ifinfomsg*) NLMSG_DATA( pNLMsg))->ifi_index;
else if ( pNLMsg->nlmsg_type == RTM_DELADDR || pNLMsg->nlmsg_type == RTM_NEWADDR)
result |= 1 << ((struct ifaddrmsg*) NLMSG_DATA( pNLMsg))->ifa_index;
if ( ( pNLMsg->nlmsg_flags & NLM_F_MULTI) != 0 && pNLMsg->nlmsg_type != NLMSG_DONE)
{
ssize_t len = readCount - ( (char*)pNLMsg - buff);
pNLMsg = NLMSG_NEXT( pNLMsg, len);
}
else
break; }
return result;
}
#else // USES_NETLINK
mDNSlocal mStatus OpenIfNotifySocket( int *pFD)
{
*pFD = socket( AF_ROUTE, SOCK_RAW, 0);
if ( *pFD < 0)
return mStatus_UnknownErr;
(void) fcntl( *pFD, F_SETFL, O_NONBLOCK);
return mStatus_NoError;
}
#if MDNS_DEBUGMSGS
mDNSlocal void PrintRoutingSocketMsg( const struct ifa_msghdr *pRSMsg)
{
const char *kRSMsgTypes[] = { "", "RTM_ADD", "RTM_DELETE", "RTM_CHANGE", "RTM_GET", "RTM_LOSING",
"RTM_REDIRECT", "RTM_MISS", "RTM_LOCK", "RTM_OLDADD", "RTM_OLDDEL", "RTM_RESOLVE",
"RTM_NEWADDR", "RTM_DELADDR", "RTM_IFINFO", "RTM_NEWMADDR", "RTM_DELMADDR" };
int index = pRSMsg->ifam_type == RTM_IFINFO ? ((struct if_msghdr*) pRSMsg)->ifm_index : pRSMsg->ifam_index;
printf( "ifa_msghdr len=%d, type=%s, index=%d\n", pRSMsg->ifam_msglen, kRSMsgTypes[ pRSMsg->ifam_type], index);
}
#endif
mDNSlocal mDNSu32 ProcessRoutingNotification( int sd)
{
ssize_t readCount;
char buff[ 4096];
struct ifa_msghdr *pRSMsg = (struct ifa_msghdr*) buff;
mDNSu32 result = 0;
readCount = read( sd, buff, sizeof buff);
if ( readCount < (ssize_t) sizeof( struct ifa_msghdr))
return mStatus_UnsupportedErr;
#if MDNS_DEBUGMSGS
PrintRoutingSocketMsg( pRSMsg);
#endif
if ( pRSMsg->ifam_type == RTM_NEWADDR || pRSMsg->ifam_type == RTM_DELADDR ||
pRSMsg->ifam_type == RTM_IFINFO)
{
if ( pRSMsg->ifam_type == RTM_IFINFO)
result |= 1 << ((struct if_msghdr*) pRSMsg)->ifm_index;
else
result |= 1 << pRSMsg->ifam_index;
}
return result;
}
#endif // USES_NETLINK
mDNSlocal void InterfaceChangeCallback( void *context)
{
IfChangeRec *pChgRec = (IfChangeRec*) context;
fd_set readFDs;
mDNSu32 changedInterfaces = 0;
struct timeval zeroTimeout = { 0, 0 };
FD_ZERO( &readFDs);
FD_SET( pChgRec->NotifySD, &readFDs);
do
{
changedInterfaces |= ProcessRoutingNotification( pChgRec->NotifySD);
}
while ( 0 < select( pChgRec->NotifySD + 1, &readFDs, (fd_set*) NULL, (fd_set*) NULL, &zeroTimeout));
if ( changedInterfaces)
mDNSPlatformPosixRefreshInterfaceList( pChgRec->mDNS);
}
mDNSlocal mStatus WatchForInterfaceChange(mDNS *const m)
{
mStatus err;
IfChangeRec *pChgRec;
pChgRec = (IfChangeRec*) mDNSPlatformMemAllocate( sizeof *pChgRec);
if ( pChgRec == NULL)
return mStatus_NoMemoryErr;
pChgRec->mDNS = m;
err = OpenIfNotifySocket( &pChgRec->NotifySD);
if ( err == 0)
err = mDNSPosixAddFDToEventLoop( pChgRec->NotifySD, InterfaceChangeCallback, pChgRec);
return err;
}
mDNSlocal mDNSBool mDNSPlatformInit_CanReceiveUnicast(void)
{
int err;
int s = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
struct sockaddr_in s5353;
s5353.sin_family = AF_INET;
s5353.sin_port = MulticastDNSPort.NotAnInteger;
s5353.sin_addr.s_addr = 0;
err = bind(s, (struct sockaddr *)&s5353, sizeof(s5353));
close(s);
if (err) debugf("No unicast UDP responses");
else debugf("Unicast UDP responses okay");
return(err == 0);
}
mDNSexport mStatus mDNSPlatformInit(mDNS *const m)
{
int err = 0;
struct sockaddr sa;
assert(m != NULL);
if (mDNSPlatformInit_CanReceiveUnicast()) m->CanReceiveUnicastOn5353 = mDNStrue;
m->nicelabel.c[0] = 0;
GetUserSpecifiedFriendlyComputerName(&m->nicelabel);
if (m->nicelabel.c[0] == 0) MakeDomainLabelFromLiteralString(&m->nicelabel, "Macintosh");
m->hostlabel.c[0] = 0;
GetUserSpecifiedRFC1034ComputerName(&m->hostlabel);
if (m->hostlabel.c[0] == 0) MakeDomainLabelFromLiteralString(&m->hostlabel, "Macintosh");
mDNS_SetFQDN(m);
sa.sa_family = AF_INET;
m->p->unicastSocket4 = -1;
if (err == mStatus_NoError) err = SetupSocket(&sa, zeroIPPort, 0, &m->p->unicastSocket4);
#if HAVE_IPV6
sa.sa_family = AF_INET6;
m->p->unicastSocket6 = -1;
if (err == mStatus_NoError) err = SetupSocket(&sa, zeroIPPort, 0, &m->p->unicastSocket6);
#endif
if (err == mStatus_NoError) err = SetupInterfaceList(m);
if (err == mStatus_NoError) ParseDNSServers(m, uDNS_SERVERS_FILE);
if (err == mStatus_NoError)
{
err = WatchForInterfaceChange(m);
if ( err != mStatus_NoError)
{
fprintf(stderr, "mDNS(%d) WARNING: Unable to detect interface changes (%d).\n", getpid(), err);
err = mStatus_NoError;
}
}
if (err == mStatus_NoError)
mDNSCoreInitComplete(m, mStatus_NoError);
return PosixErrorToStatus(err);
}
mDNSexport void mDNSPlatformClose(mDNS *const m)
{
assert(m != NULL);
ClearInterfaceList(m);
if (m->p->unicastSocket4 != -1) assert(close(m->p->unicastSocket4) == 0);
#if HAVE_IPV6
if (m->p->unicastSocket6 != -1) assert(close(m->p->unicastSocket6) == 0);
#endif
}
mDNSexport mStatus mDNSPlatformPosixRefreshInterfaceList(mDNS *const m)
{
int err;
ClearInterfaceList(m);
err = SetupInterfaceList(m);
return PosixErrorToStatus(err);
}
#if COMPILER_LIKES_PRAGMA_MARK
#pragma mark ***** Locking
#endif
mDNSexport void mDNSPlatformLock (const mDNS *const m)
{
(void) m; }
mDNSexport void mDNSPlatformUnlock (const mDNS *const m)
{
(void) m; }
#if COMPILER_LIKES_PRAGMA_MARK
#pragma mark ***** Strings
#endif
mDNSexport void mDNSPlatformStrCopy(const void *src, void *dst)
{
strcpy((char *)dst, (char *)src);
}
mDNSexport mDNSu32 mDNSPlatformStrLen (const void *src)
{
return strlen((char*)src);
}
mDNSexport void mDNSPlatformMemCopy(const void *src, void *dst, mDNSu32 len)
{
memcpy(dst, src, len);
}
mDNSexport mDNSBool mDNSPlatformMemSame(const void *src, const void *dst, mDNSu32 len)
{
return memcmp(dst, src, len) == 0;
}
mDNSexport void mDNSPlatformMemZero( void *dst, mDNSu32 len)
{
memset(dst, 0, len);
}
mDNSexport void * mDNSPlatformMemAllocate(mDNSu32 len) { return(malloc(len)); }
mDNSexport void mDNSPlatformMemFree (void *mem) { free(mem); }
mDNSexport mDNSu32 mDNSPlatformRandomSeed(void)
{
struct timeval tv;
gettimeofday(&tv, NULL);
return(tv.tv_usec);
}
mDNSexport mDNSs32 mDNSPlatformOneSecond = 1024;
mDNSexport mStatus mDNSPlatformTimeInit(void)
{
return(mStatus_NoError);
}
mDNSexport mDNSs32 mDNSPlatformRawTime()
{
struct timeval tv;
gettimeofday(&tv, NULL);
return( (tv.tv_sec << 10) | (tv.tv_usec * 16 / 15625) );
}
mDNSexport mDNSs32 mDNSPlatformUTC(void)
{
return time(NULL);
}
mDNSlocal void mDNSPosixAddToFDSet(int *nfds, fd_set *readfds, int s)
{
if (*nfds < s + 1) *nfds = s + 1;
FD_SET(s, readfds);
}
mDNSexport void mDNSPosixGetFDSet(mDNS *m, int *nfds, fd_set *readfds, struct timeval *timeout)
{
mDNSs32 ticks;
struct timeval interval;
mDNSs32 nextevent = mDNS_Execute(m);
PosixNetworkInterface *info = (PosixNetworkInterface *)(m->HostInterfaces);
if (m->p->unicastSocket4 != -1) mDNSPosixAddToFDSet(nfds, readfds, m->p->unicastSocket4);
#if HAVE_IPV6
if (m->p->unicastSocket6 != -1) mDNSPosixAddToFDSet(nfds, readfds, m->p->unicastSocket6);
#endif
while (info)
{
if (info->multicastSocket4 != -1) mDNSPosixAddToFDSet(nfds, readfds, info->multicastSocket4);
#if HAVE_IPV6
if (info->multicastSocket6 != -1) mDNSPosixAddToFDSet(nfds, readfds, info->multicastSocket6);
#endif
info = (PosixNetworkInterface *)(info->coreIntf.next);
}
ticks = nextevent - mDNS_TimeNow(m);
if (ticks < 1) ticks = 1;
interval.tv_sec = ticks >> 10; interval.tv_usec = ((ticks & 0x3FF) * 15625) / 16;
if (timeout->tv_sec > interval.tv_sec ||
(timeout->tv_sec == interval.tv_sec && timeout->tv_usec > interval.tv_usec))
*timeout = interval;
}
mDNSexport void mDNSPosixProcessFDSet(mDNS *const m, fd_set *readfds)
{
PosixNetworkInterface *info;
assert(m != NULL);
assert(readfds != NULL);
info = (PosixNetworkInterface *)(m->HostInterfaces);
if (m->p->unicastSocket4 != -1 && FD_ISSET(m->p->unicastSocket4, readfds))
{
FD_CLR(m->p->unicastSocket4, readfds);
SocketDataReady(m, NULL, m->p->unicastSocket4);
}
#if HAVE_IPV6
if (m->p->unicastSocket6 != -1 && FD_ISSET(m->p->unicastSocket6, readfds))
{
FD_CLR(m->p->unicastSocket6, readfds);
SocketDataReady(m, NULL, m->p->unicastSocket6);
}
#endif
while (info)
{
if (info->multicastSocket4 != -1 && FD_ISSET(info->multicastSocket4, readfds))
{
FD_CLR(info->multicastSocket4, readfds);
SocketDataReady(m, info, info->multicastSocket4);
}
#if HAVE_IPV6
if (info->multicastSocket6 != -1 && FD_ISSET(info->multicastSocket6, readfds))
{
FD_CLR(info->multicastSocket6, readfds);
SocketDataReady(m, info, info->multicastSocket6);
}
#endif
info = (PosixNetworkInterface *)(info->coreIntf.next);
}
}
mDNSlocal void DetermineMaxEventFD( void )
{
PosixEventSource *iSource;
gMaxFD = 0;
for ( iSource=(PosixEventSource*)gEventSources.Head; iSource; iSource = iSource->Next)
if ( gMaxFD < iSource->fd)
gMaxFD = iSource->fd;
}
mStatus mDNSPosixAddFDToEventLoop( int fd, mDNSPosixEventCallback callback, void *context)
{
PosixEventSource *newSource;
if ( gEventSources.LinkOffset == 0)
InitLinkedList( &gEventSources, offsetof( PosixEventSource, Next));
if ( fd >= (int) FD_SETSIZE || fd < 0)
return mStatus_UnsupportedErr;
if ( callback == NULL)
return mStatus_BadParamErr;
newSource = (PosixEventSource*) malloc( sizeof *newSource);
if ( NULL == newSource)
return mStatus_NoMemoryErr;
newSource->Callback = callback;
newSource->Context = context;
newSource->fd = fd;
AddToTail( &gEventSources, newSource);
FD_SET( fd, &gEventFDs);
DetermineMaxEventFD();
return mStatus_NoError;
}
mStatus mDNSPosixRemoveFDFromEventLoop( int fd)
{
PosixEventSource *iSource;
for ( iSource=(PosixEventSource*)gEventSources.Head; iSource; iSource = iSource->Next)
{
if ( fd == iSource->fd)
{
FD_CLR( fd, &gEventFDs);
RemoveFromList( &gEventSources, iSource);
free( iSource);
DetermineMaxEventFD();
return mStatus_NoError;
}
}
return mStatus_NoSuchNameErr;
}
mDNSlocal void NoteSignal( int signum)
{
sigaddset( &gEventSignals, signum);
}
mStatus mDNSPosixListenForSignalInEventLoop( int signum)
{
struct sigaction action;
mStatus err;
bzero( &action, sizeof action); action.sa_handler = NoteSignal;
err = sigaction( signum, &action, (struct sigaction*) NULL);
sigaddset( &gEventSignalSet, signum);
return err;
}
mStatus mDNSPosixIgnoreSignalInEventLoop( int signum)
{
struct sigaction action;
mStatus err;
bzero( &action, sizeof action); action.sa_handler = SIG_DFL;
err = sigaction( signum, &action, (struct sigaction*) NULL);
sigdelset( &gEventSignalSet, signum);
return err;
}
mStatus mDNSPosixRunEventLoopOnce( mDNS *m, const struct timeval *pTimeout,
sigset_t *pSignalsReceived, mDNSBool *pDataDispatched)
{
fd_set listenFDs = gEventFDs;
int fdMax = 0, numReady;
struct timeval timeout = *pTimeout;
mDNSPosixGetFDSet( m, &fdMax, &listenFDs, &timeout); if ( fdMax < gMaxFD)
fdMax = gMaxFD;
numReady = select( fdMax + 1, &listenFDs, (fd_set*) NULL, (fd_set*) NULL, &timeout);
if ( numReady > 0)
{
PosixEventSource *iSource;
(void) mDNSPosixProcessFDSet( m, &listenFDs);
for ( iSource=(PosixEventSource*)gEventSources.Head; iSource; iSource = iSource->Next)
{
if ( FD_ISSET( iSource->fd, &listenFDs))
{
iSource->Callback( iSource->Context);
break; }
}
*pDataDispatched = mDNStrue;
}
else
*pDataDispatched = mDNSfalse;
(void) sigprocmask( SIG_BLOCK, &gEventSignalSet, (sigset_t*) NULL);
*pSignalsReceived = gEventSignals;
sigemptyset( &gEventSignals);
(void) sigprocmask( SIG_UNBLOCK, &gEventSignalSet, (sigset_t*) NULL);
return mStatus_NoError;
}