You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
253 lines
10 KiB
253 lines
10 KiB
/* |
|
* ZeroTier One - Network Virtualization Everywhere |
|
* Copyright (C) 2011-2015 ZeroTier, Inc. |
|
* |
|
* This program is free software: you can redistribute it and/or modify |
|
* it under the terms of the GNU General Public License as published by |
|
* the Free Software Foundation, either version 3 of the License, or |
|
* (at your option) any later version. |
|
* |
|
* This program is distributed in the hope that it will be useful, |
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
* GNU General Public License for more details. |
|
* |
|
* You should have received a copy of the GNU General Public License |
|
* along with this program. If not, see <http://www.gnu.org/licenses/>. |
|
* |
|
* -- |
|
* |
|
* ZeroTier may be used and distributed under the terms of the GPLv3, which |
|
* are available at: http://www.gnu.org/licenses/gpl-3.0.html |
|
* |
|
* If you would like to embed ZeroTier into a commercial application or |
|
* redistribute it in a modified binary form, please contact ZeroTier Networks |
|
* LLC. Start here: http://www.zerotier.com/ |
|
*/ |
|
|
|
#include <stdio.h> |
|
#include <string.h> |
|
#include <stdint.h> |
|
|
|
#include <string> |
|
|
|
#include "Constants.hpp" |
|
#include "InetAddress.hpp" |
|
#include "Utils.hpp" |
|
|
|
namespace ZeroTier { |
|
|
|
const InetAddress InetAddress::LO4("127.0.0.1",0); |
|
const InetAddress InetAddress::LO6("::1",0); |
|
const InetAddress InetAddress::DEFAULT4((uint32_t)0,0); |
|
const InetAddress InetAddress::DEFAULT6((const void *)0,16,0); |
|
|
|
void InetAddress::set(const std::string &ip,unsigned int port) |
|
throw() |
|
{ |
|
if (ip.find(':') != std::string::npos) { |
|
struct sockaddr_in6 sin6; |
|
memset(&sin6,0,sizeof(sin6)); |
|
sin6.sin6_family = AF_INET6; |
|
sin6.sin6_port = Utils::hton((uint16_t)port); |
|
if (inet_pton(AF_INET6,ip.c_str(),(void *)&(sin6.sin6_addr.s6_addr)) <= 0) |
|
memset(this,0,sizeof(InetAddress)); |
|
else *this = sin6; |
|
} else { |
|
struct sockaddr_in sin; |
|
memset(&sin,0,sizeof(sin)); |
|
sin.sin_family = AF_INET; |
|
sin.sin_port = Utils::hton((uint16_t)port); |
|
if (inet_pton(AF_INET,ip.c_str(),(void *)&(sin.sin_addr.s_addr)) <= 0) |
|
memset(this,0,sizeof(InetAddress)); |
|
else *this = sin; |
|
} |
|
} |
|
|
|
void InetAddress::set(const void *ipBytes,unsigned int ipLen,unsigned int port) |
|
throw() |
|
{ |
|
memset(this,0,sizeof(InetAddress)); |
|
if (ipLen == 4) { |
|
setV4(); |
|
if (ipBytes) |
|
memcpy(rawIpData(),ipBytes,4); |
|
setPort(port); |
|
} else if (ipLen == 16) { |
|
setV6(); |
|
if (ipBytes) |
|
memcpy(rawIpData(),ipBytes,16); |
|
setPort(port); |
|
} |
|
} |
|
|
|
bool InetAddress::isLinkLocal() const |
|
throw() |
|
{ |
|
static const unsigned char v6llPrefix[8] = { 0xfe,0x80,0x00,0x00,0x00,0x00,0x00,0x00 }; |
|
switch(ss_family) { |
|
case AF_INET: |
|
return ((Utils::ntoh((uint32_t)reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr) & 0xffff0000) == 0xa9fe0000); |
|
case AF_INET6: |
|
return (memcmp(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr,v6llPrefix,8) == 0); |
|
} |
|
return false; |
|
} |
|
|
|
std::string InetAddress::toString() const |
|
{ |
|
char buf[128]; |
|
switch(ss_family) { |
|
case AF_INET: |
|
Utils::snprintf(buf,sizeof(buf),"%d.%d.%d.%d/%d", |
|
(int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[0], |
|
(int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[1], |
|
(int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[2], |
|
(int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[3], |
|
(int)Utils::ntoh((uint16_t)(reinterpret_cast<const struct sockaddr_in *>(this)->sin_port)) |
|
); |
|
return std::string(buf); |
|
case AF_INET6: |
|
Utils::snprintf(buf,sizeof(buf),"%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x/%d", |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[0]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[1]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[2]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[3]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[4]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[5]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[6]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[7]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[8]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[9]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[10]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[11]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[12]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[13]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[14]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[15]), |
|
(int)Utils::ntoh((uint16_t)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port)) |
|
); |
|
return std::string(buf); |
|
} |
|
return std::string(); |
|
} |
|
|
|
std::string InetAddress::toIpString() const |
|
{ |
|
char buf[128]; |
|
switch(ss_family) { |
|
case AF_INET: |
|
Utils::snprintf(buf,sizeof(buf),"%d.%d.%d.%d", |
|
(int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[0], |
|
(int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[1], |
|
(int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[2], |
|
(int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[3] |
|
); |
|
return std::string(buf); |
|
case AF_INET6: |
|
Utils::snprintf(buf,sizeof(buf),"%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x", |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[0]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[1]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[2]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[3]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[4]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[5]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[6]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[7]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[8]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[9]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[10]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[11]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[12]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[13]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[14]), |
|
(int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[15]) |
|
); |
|
return std::string(buf); |
|
} |
|
return std::string(); |
|
} |
|
|
|
void InetAddress::fromString(const std::string &ipSlashPort) |
|
{ |
|
std::size_t slashAt = ipSlashPort.find('/'); |
|
if ((slashAt == std::string::npos)||(slashAt >= ipSlashPort.length())) |
|
set(ipSlashPort,0); |
|
else { |
|
long p = strtol(ipSlashPort.substr(slashAt+1).c_str(),(char **)0,10); |
|
if ((p > 0)&&(p <= 0xffff)) |
|
set(ipSlashPort.substr(0,slashAt),(unsigned int)p); |
|
else set(ipSlashPort.substr(0,slashAt),0); |
|
} |
|
} |
|
|
|
InetAddress InetAddress::netmask() const |
|
throw() |
|
{ |
|
InetAddress r(*this); |
|
switch(r.ss_family) { |
|
case AF_INET: |
|
reinterpret_cast<struct sockaddr_in *>(&r)->sin_addr.s_addr = Utils::hton((uint32_t)(0xffffffff << (32 - netmaskBits()))); |
|
break; |
|
case AF_INET6: { |
|
unsigned char *bf = reinterpret_cast<unsigned char *>(reinterpret_cast<struct sockaddr_in6 *>(&r)->sin6_addr.s6_addr); |
|
signed int bitsLeft = (signed int)netmaskBits(); |
|
for(unsigned int i=0;i<16;++i) { |
|
if (bitsLeft > 0) { |
|
bf[i] |= (unsigned char)((bitsLeft >= 8) ? 0x00 : (0xff >> bitsLeft)); |
|
bitsLeft -= 8; |
|
} |
|
} |
|
} break; |
|
} |
|
return r; |
|
} |
|
|
|
InetAddress InetAddress::broadcast() const |
|
throw() |
|
{ |
|
InetAddress r(*this); |
|
switch(r.ss_family) { |
|
case AF_INET: |
|
reinterpret_cast<struct sockaddr_in *>(&r)->sin_addr.s_addr |= Utils::hton((uint32_t)(0xffffffff >> netmaskBits())); |
|
break; |
|
case AF_INET6: { |
|
unsigned char *bf = reinterpret_cast<unsigned char *>(reinterpret_cast<struct sockaddr_in6 *>(&r)->sin6_addr.s6_addr); |
|
signed int bitsLeft = (signed int)netmaskBits(); |
|
for(unsigned int i=0;i<16;++i) { |
|
if (bitsLeft > 0) { |
|
bf[i] |= (unsigned char)((bitsLeft >= 8) ? 0x00 : (0xff >> bitsLeft)); |
|
bitsLeft -= 8; |
|
} |
|
} |
|
} break; |
|
} |
|
return r; |
|
} |
|
|
|
InetAddress InetAddress::makeIpv6LinkLocal(const MAC &mac) |
|
throw() |
|
{ |
|
struct sockaddr_in6 sin6; |
|
sin6.sin6_family = AF_INET6; |
|
sin6.sin6_addr.s6_addr[0] = 0xfe; |
|
sin6.sin6_addr.s6_addr[1] = 0x80; |
|
sin6.sin6_addr.s6_addr[2] = 0x00; |
|
sin6.sin6_addr.s6_addr[3] = 0x00; |
|
sin6.sin6_addr.s6_addr[4] = 0x00; |
|
sin6.sin6_addr.s6_addr[5] = 0x00; |
|
sin6.sin6_addr.s6_addr[6] = 0x00; |
|
sin6.sin6_addr.s6_addr[7] = 0x00; |
|
sin6.sin6_addr.s6_addr[8] = mac[0] & 0xfd; |
|
sin6.sin6_addr.s6_addr[9] = mac[1]; |
|
sin6.sin6_addr.s6_addr[10] = mac[2]; |
|
sin6.sin6_addr.s6_addr[11] = 0xff; |
|
sin6.sin6_addr.s6_addr[12] = 0xfe; |
|
sin6.sin6_addr.s6_addr[13] = mac[3]; |
|
sin6.sin6_addr.s6_addr[14] = mac[4]; |
|
sin6.sin6_addr.s6_addr[15] = mac[5]; |
|
sin6.sin6_port = Utils::hton((uint16_t)64); |
|
return InetAddress(sin6); |
|
} |
|
|
|
} // namespace ZeroTier
|
|
|