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.
 
 
 
 
 
 

601 lines
19 KiB

/*
* Copyright (c) 2004 by Internet Systems Consortium, Inc. ("ISC")
* Copyright (c) 1996-1999 by Internet Software Consortium.
*
* Permission to use, copy, modify, and distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND ISC DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL ISC BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT
* OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
#ifndef crypto777_inet_h
#define crypto777_inet_h
#include "OS_portable.h"
#include <netinet/in.h>
#ifdef _WIN32
#include <windows.h>
#include <io.h>
#include <winsock2.h>
#define in6_addr sockaddr
#define in_addr_t struct sockaddr_storage
#define EAFNOSUPPORT WSAEAFNOSUPPORT
struct sockaddr_in6 {
short sin6_family;
u_short sin6_port;
u_long sin6_flowinfo;
struct in6_addr sin6_addr;
u_long sin6_scope_id;
};
#endif
static int inet_ntop4(unsigned char *src, char *dst, size_t size);
static int inet_ntop6(unsigned char *src, char *dst, size_t size);
static int inet_pton4(char *src, unsigned char *dst);
static int inet_pton6(char *src, unsigned char *dst);
int32_t portable_ntop(int af, void* src, char* dst, size_t size)
{
switch (af) {
case AF_INET:
return (inet_ntop4(src, dst, size));
case AF_INET6:
return (inet_ntop6(src, dst, size));
default:
return -1;
}
/* NOTREACHED */
}
static int inet_ntop4(unsigned char *src, char *dst, size_t size) {
static const char fmt[] = "%u.%u.%u.%u";
char tmp[sizeof "255.255.255.255"];
int l;
#ifndef _WIN32
l = snprintf(tmp, sizeof(tmp), fmt, src[0], src[1], src[2], src[3]);
#else
l = _snprintf(tmp, sizeof(tmp), fmt, src[0], src[1], src[2], src[3]);
#endif
if (l <= 0 || (size_t) l >= size) {
return -1;
}
strncpy(dst, tmp, size);
dst[size - 1] = '\0';
return 0;
}
static int inet_ntop6(unsigned char *src, char *dst, size_t size) {
/*
* Note that int32_t and int16_t need only be "at least" large enough
* to contain a value of the specified size. On some systems, like
* Crays, there is no such thing as an integer variable with 16 bits.
* Keep this in mind if you think this function should have been coded
* to use pointer overlays. All the world's not a VAX.
*/
char tmp[sizeof "ffff:ffff:ffff:ffff:ffff:ffff:255.255.255.255"], *tp;
struct { int base, len; } best, cur;
unsigned int words[sizeof(struct in6_addr) / sizeof(uint16_t)];
int i;
/*
* Preprocess:
* Copy the input (bytewise) array into a wordwise array.
* Find the longest run of 0x00's in src[] for :: shorthanding.
*/
memset(words, '\0', sizeof words);
for (i = 0; i < (int) sizeof(struct in6_addr); i++)
words[i / 2] |= (src[i] << ((1 - (i % 2)) << 3));
best.base = -1;
best.len = 0;
cur.base = -1;
cur.len = 0;
for (i = 0; i < (int)(sizeof(struct in6_addr) / sizeof(uint16_t)); i++) {
if (words[i] == 0) {
if (cur.base == -1)
cur.base = i, cur.len = 1;
else
cur.len++;
} else {
if (cur.base != -1) {
if (best.base == -1 || cur.len > best.len)
best = cur;
cur.base = -1;
}
}
}
if (cur.base != -1) {
if (best.base == -1 || cur.len > best.len)
best = cur;
}
if (best.base != -1 && best.len < 2)
best.base = -1;
/*
* Format the result.
*/
tp = tmp;
for (i = 0; i < (int)(sizeof(struct in6_addr) / sizeof(uint16_t)); i++) {
/* Are we inside the best run of 0x00's? */
if (best.base != -1 && i >= best.base &&
i < (best.base + best.len)) {
if (i == best.base)
*tp++ = ':';
continue;
}
/* Are we following an initial run of 0x00s or any real hex? */
if (i != 0)
*tp++ = ':';
/* Is this address an encapsulated IPv4? */
if (i == 6 && best.base == 0 && (best.len == 6 ||
(best.len == 7 && words[7] != 0x0001) ||
(best.len == 5 && words[5] == 0xffff))) {
int err = inet_ntop4(src+12, tp, sizeof tmp - (tp - tmp));
if (err)
return err;
tp += strlen(tp);
break;
}
tp += sprintf(tp, "%x", words[i]);
}
/* Was it a trailing run of 0x00's? */
if (best.base != -1 && (best.base + best.len) == (sizeof(struct in6_addr) / sizeof(uint16_t)))
*tp++ = ':';
*tp++ = '\0';
/*
* Check for overflow, copy, and we're done.
*/
if ((size_t)(tp - tmp) > size) {
return ENOSPC;
}
strcpy(dst, tmp);
return 0;
}
int portable_pton(int af, char* src, void* dst)
{
switch (af) {
case AF_INET:
return (inet_pton4(src, dst));
case AF_INET6:
return (inet_pton6(src, dst));
default:
return EAFNOSUPPORT;
}
/* NOTREACHED */
}
static int inet_pton4(char *src, unsigned char *dst) {
static const char digits[] = "0123456789";
int saw_digit, octets, ch;
unsigned char tmp[sizeof(struct in_addr)], *tp;
char savestr[64];
strcpy(savestr,src);
//printf("inet_pton4(%s)\n",src);
saw_digit = 0;
octets = 0;
*(tp = tmp) = 0;
while ((ch = (uint8_t)*src++) != '\0')
{
char *pch;
if ( (pch = strchr(digits, ch)) != NULL )
{
unsigned int nw = (unsigned int)(*tp * 10 + (pch - digits));
if (saw_digit && *tp == 0)
{
printf("inet_pton4 0\n");
return EINVAL;
}
if ( nw > 255 )
{
printf("inet_pton4 1\n");
return EINVAL;
}
*tp = nw;
if (!saw_digit) {
if (++octets > 4)
{
printf("inet_pton4 2\n");
return EINVAL;
}
saw_digit = 1;
}
} else if (ch == '.' && saw_digit) {
if (octets == 4)
{
printf("inet_pton4 3\n");
return EINVAL;
}
*++tp = 0;
saw_digit = 0;
} else
{
printf("inet_pton4 4 error.(%s)\n",savestr); getchar();
return EINVAL;
}
}
if (octets < 4)
{
printf("inet_pton4 5 error.(%s)\n",savestr); getchar();
return EINVAL;
}
memcpy(dst, tmp, sizeof(struct in_addr));
//printf("not errors %08x\n",*(int32_t *)dst);
return 0;
}
static int inet_pton6(char *src, unsigned char *dst) {
static char xdigits_l[] = "0123456789abcdef",
xdigits_u[] = "0123456789ABCDEF";
unsigned char tmp[sizeof(struct in6_addr)], *tp, *endp, *colonp;
char *xdigits, *curtok;
int ch, seen_xdigits;
unsigned int val;
memset((tp = tmp), '\0', sizeof tmp);
endp = tp + sizeof tmp;
colonp = NULL;
/* Leading :: requires some special handling. */
if (*src == ':')
if (*++src != ':')
return EINVAL;
curtok = src;
seen_xdigits = 0;
val = 0;
while ((ch = *src++) != '\0' && ch != '%') {
char *pch;
if ((pch = strchr((xdigits = xdigits_l), ch)) == NULL)
pch = strchr((xdigits = xdigits_u), ch);
if (pch != NULL) {
val <<= 4;
val |= (pch - xdigits);
if (++seen_xdigits > 4)
return EINVAL;
continue;
}
if (ch == ':') {
curtok = src;
if (!seen_xdigits) {
if (colonp)
return EINVAL;
colonp = tp;
continue;
} else if (*src == '\0') {
return EINVAL;
}
if (tp + sizeof(uint16_t) > endp)
return EINVAL;
*tp++ = (unsigned char) (val >> 8) & 0xff;
*tp++ = (unsigned char) val & 0xff;
seen_xdigits = 0;
val = 0;
continue;
}
if (ch == '.' && ((tp + sizeof(struct in_addr)) <= endp)) {
int err;
/* Scope id present, parse ipv4 addr without it */
pch = strchr(curtok, '%');
if (pch != NULL) {
char tmp2[sizeof "255.255.255.255"];
memcpy(tmp2, curtok, pch - curtok);
curtok = tmp2;
src = pch;
}
err = inet_pton4(curtok, tp);
if (err == 0) {
tp += sizeof(struct in_addr);
seen_xdigits = 0;
break; /*%< '\\0' was seen by inet_pton4(). */
}
}
return EINVAL;
}
if (seen_xdigits) {
if (tp + sizeof(uint16_t) > endp)
return EINVAL;
*tp++ = (unsigned char) (val >> 8) & 0xff;
*tp++ = (unsigned char) val & 0xff;
}
if (colonp != NULL) {
/*
* Since some memmove()'s erroneously fail to handle
* overlapping regions, we'll do the shift by hand.
*/
int n = (int)(tp - colonp);
int i;
if (tp == endp)
return EINVAL;
for (i = 1; i <= n; i++) {
endp[- i] = colonp[n - i];
colonp[n - i] = 0;
}
tp = endp;
}
if (tp != endp)
return EINVAL;
memcpy(dst, tmp, sizeof tmp);
return 0;
}
uint16_t parse_ipaddr(char *ipaddr,char *ip_port)
{
int32_t j; uint16_t port = 0;
if ( ip_port != 0 && ip_port[0] != 0 )
{
strcpy(ipaddr,ip_port);
for (j=0; ipaddr[j]!=0&&j<60; j++)
if ( ipaddr[j] == ':' )
{
port = atoi(ipaddr+j+1);
break;
}
ipaddr[j] = 0;
//printf("%p.(%s) -> (%s:%d)\n",ip_port,ip_port,ipaddr,port);
} else strcpy(ipaddr,"127.0.0.1");
return(port);
}
uint64_t _calc_ipbits(char *ip_port)
{
int32_t port;
char ipaddr[64];
struct sockaddr_in addr;
port = parse_ipaddr(ipaddr,ip_port);
memset(&addr,0,sizeof(addr));
portable_pton(ip_port[0] == '[' ? AF_INET6 : AF_INET,ipaddr,&addr);
if ( 0 )
{
int i;
for (i=0; i<16; i++)
printf("%02x ",((uint8_t *)&addr)[i]);
printf("<- %s %x\n",ip_port,*(uint32_t *)&addr);
}
return(*(uint32_t *)&addr | ((uint64_t)port << 32));
}
void expand_ipbits(char *ipaddr,uint64_t ipbits)
{
uint16_t port;
struct sockaddr_in addr;
memset(&addr,0,sizeof(addr));
*(uint32_t *)&addr = (uint32_t)ipbits;
portable_ntop(AF_INET,&addr,ipaddr,64);
if ( (port= (uint16_t)(ipbits>>32)) != 0 )
sprintf(ipaddr + strlen(ipaddr),":%d",port);
//sprintf(ipaddr,"%d.%d.%d.%d",(ipbits>>24)&0xff,(ipbits>>16)&0xff,(ipbits>>8)&0xff,(ipbits&0xff));
}
uint64_t calc_ipbits(char *ip_port)
{
uint64_t ipbits; char ipaddr[64];
ipbits = _calc_ipbits(ip_port);
expand_ipbits(ipaddr,ipbits);
if ( ipbits != 0 && strcmp(ipaddr,ip_port) != 0 )
printf("calc_ipbits error: (%s) -> %llx -> (%s)\n",ip_port,(long long)ipbits,ipaddr);
return(ipbits);
}
char *ipbits_str(char ipaddr[64],uint64_t ipbits)
{
expand_ipbits(ipaddr,ipbits);
return(ipaddr);
}
uint32_t is_ipaddr(char *str)
{
uint64_t ipbits; char ipaddr[64];
if ( str != 0 && str[0] != 0 && (ipbits= calc_ipbits(str)) != 0 )
{
expand_ipbits(ipaddr,(uint32_t)ipbits);
if ( strncmp(ipaddr,str,strlen(ipaddr)) == 0 )
return((uint32_t)ipbits);
}
// printf("(%s) is not ipaddr\n",str);
return(0);
}
/*int32_t conv_domain(struct sockaddr_storage *ss,const char *addr,int32_t ipv4only)
{
//struct nn_dns dns; struct nn_dns_result dns_result;
size_t addrlen,sslen;
const char *semicolon,*hostname,*colon,*end;
addrlen = strlen(addr);
semicolon = strchr(addr,';');
hostname = semicolon ? semicolon + 1 : addr;
colon = strrchr(addr,':');
end = addr + addrlen;
if ( nn_slow(!colon) ) // Parse the port
return -EINVAL;
if ( nn_slow(nn_port_resolve (colon + 1, end - colon - 1) < 0) )
return -EINVAL;
// Check whether the host portion of the address is either a literal or a valid hostname.
if ( nn_dns_check_hostname(hostname,colon - hostname) < 0 && nn_literal_resolve(hostname,colon - hostname,ipv4only,ss,&sslen) < 0 )
return -EINVAL;
if ( semicolon != 0 && nn_iface_resolve(addr,semicolon - addr,ipv4only,ss,&sslen) < 0 ) // If local address is specified, check whether it is valid
return -ENODEV;
//memset(&dns_result,0,sizeof(dns_result));
// nn_dns_start(&dns,addr,addrlen,ipv4only,&dns_result);
// while ( *(uint32_t *)&dns_result.addr == 0 )
// usleep(10000);
return(0);
}*/
uint32_t conv_domainname(char *ipaddr,char *domain)
{
int32_t conv_domain(struct sockaddr_storage *ss,const char *addr,int32_t ipv4only);
int32_t ipv4only = 1;
uint32_t ipbits;
struct sockaddr_in ss;
if ( 0 && conv_domain((struct sockaddr_storage *)&ss,(const char *)domain,ipv4only) == 0 )
{
ipbits = *(uint32_t *)&ss.sin_addr;
expand_ipbits(ipaddr,ipbits);
if ( (uint32_t)calc_ipbits(ipaddr) == ipbits )
return(ipbits);
//printf("conv_domainname (%s) -> (%s)\n",domain,ipaddr);
} //else printf("error conv_domain.(%s)\n",domain);
return(0);
}
int32_t notlocalip(char *ipaddr)
{
if ( ipaddr == 0 || ipaddr[0] == 0 || strcmp("127.0.0.1",ipaddr) == 0 || strncmp("192.168",ipaddr,7) == 0 )
return(0);
else return(1);
}
int32_t is_remote_access(char *previpaddr)
{
if ( notlocalip(previpaddr) != 0 )
return(1);
else return(0);
}
/*struct sockaddr_in conv_ipbits(uint64_t ipbits)
{
char ipaddr[64];
uint16_t port;
struct hostent *host;
struct sockaddr_in server_addr;
port = (uint16_t)(ipbits>>32);
ipbits = (uint32_t)ipbits;
expand_ipbits(ipaddr,ipbits);
host = (struct hostent *)gethostbyname(ipaddr);
server_addr.sin_family = AF_INET;
server_addr.sin_port = htons(port);
server_addr.sin_addr = *((struct in_addr *)host->h_addr);
memset(&(server_addr.sin_zero),0,8);
return(server_addr);
}*/
/*char *conv_ipv6(char *ipv6addr)
{
unsigned char IPV4CHECK[10]; // 80 ZERO BITS for testing
char ipv4str[4096];
struct sockaddr_in6 ipv6sa;
in_addr_t *ipv4bin;
unsigned char *bytes = 0;
int32_t isok;
memset(IPV4CHECK,0,sizeof(IPV4CHECK));
strcpy(ipv4str,ipv6addr);
//isok = !uv_inet_pton(AF_INET,(const char*)ipv6addr,&ipv6sa.sin6_addr);
//printf("isok.%d\n",isok);
isok = portable_pton(AF_INET6,ipv6addr,&ipv6sa.sin6_addr);
if ( isok == 0 )
{
#ifdef _WIN32
printf("need to figure this out for win32\n");
//bytes = ((struct sockaddr_in6 *)&ipv6sa)->sin6_addr.s6_addr;
#else
bytes = ((struct sockaddr_in6 *)&ipv6sa)->sin6_addr.s6_addr;
#endif
if ( memcmp(bytes,IPV4CHECK,sizeof(IPV4CHECK)) != 0 ) // check its IPV4 really
{
bytes += 12;
ipv4bin = (in_addr_t *)bytes;
#ifndef _WIN32
if ( portable_ntop(AF_INET,ipv4bin,ipv4str,sizeof(ipv4str)) == 0 )
#endif
isok = 0;
} else isok = 0;
}
if ( isok != 0 )
strcpy(ipv6addr,ipv4str);
return(ipv6addr); // it is ipv4 now
}*/
uint16_t parse_endpoint(int32_t *ip6flagp,char *transport,char *ipbuf,char *retbuf,char *endpoint,uint16_t default_port)
{
//int32_t myatoi(char *str,int32_t range);
char *valids[] = { "tcp", "ws", "ipc", "inproc", "tcpmux" };
char tmp[128],*inet = 0,*ipaddr = 0; uint64_t ipbits; int32_t i,j,n,port = 0;
ipbuf[0] = retbuf[0] = 0;
*ip6flagp = 0;
if ( endpoint != 0 && strlen(endpoint) > 6 )
{
for (i=0; i<sizeof(valids)/sizeof(*valids); i++)
if ( strncmp(endpoint,valids[i],strlen(valids[i])) == 0 )
{
n = (int32_t)strlen(valids[i]);
ipaddr = &endpoint[n];
if ( ipaddr[0] == '[' )
{
*ip6flagp = 1;
inet = "ip6";
for (j=n-1; j>0; j--)
{
if ( ipaddr[j] == ':' )
{
if ( (port= atoi(ipaddr + j + 1)) < 0 || port >= (1 << 16) )
{
if ( ipaddr[j-1] == ']' )
ipaddr[j] = 0;
else ipaddr = 0;
break;
}
}
else if ( ipaddr[j] == ']' )
{
if ( j == n-1 )
port = default_port;
break;
}
}
}
else
{
inet = "ip4";
for (j=n-1; j>0; j--)
{
if ( ipaddr[j] == ':' )
{
if ( (port= atoi(ipaddr + j + 1)) < 0 || port >= (1 << 16) )
ipaddr = 0;
break;
}
}
}
if ( ipaddr != 0 )
{
ipbits = calc_ipbits(ipaddr);
expand_ipbits(tmp,ipbits);
if ( strcmp(tmp,ipaddr) != 0 )
ipaddr = 0, sprintf(retbuf,"{\"result\":\"illegal ipaddr\",\"endpoint\":\"%s\",\"ipaddr\":\"%s\",\"checkaddr\":\"%s\"}",endpoint,ipaddr,tmp);
}
if ( inet != 0 && ipaddr != 0 && port != 0 )
{
sprintf(retbuf,"{\"result\":\"ip6 endpoint\",\"endpoint\":\"%s\",\"transport\":\"%s\",\"ipaddr\":\"%s\",\"port\":%d}",endpoint,valids[i],ipaddr,port);
if ( transport[0] == 0 )
strcpy(transport,valids[i]);
strcpy(ipbuf,ipaddr);
return(port);
}
}
sprintf(retbuf,"{\"result\":\"illegal endpoint\",\"endpoint\":\"%s\"}",endpoint);
} else sprintf(retbuf,"{\"error\":\"no mode specified\"}");
*ip6flagp = 0;
return(0);
}
#endif