/*
    MODULE -- IP address management

    Copyright (C) Alberto Ornaghi

    $Id: inet.c 2653 2010-07-06 07:31:19Z alor $
*/

#include <main.h>
#include <inet.h>
#include <ui.h>

/* globals */


/* prototypes */
int ip_addr_init(struct ip_addr *sa, u_int16 type, u_char *addr);
int ip_addr_cmp(struct ip_addr *sa, struct ip_addr *sb);
int ip_addr_in_range(struct ip_addr *ip, struct ip_addr *sa, struct ip_addr *sb);
int ip_addr_is_zero(struct ip_addr *sa);

char *ip_addr_ntoa(struct ip_addr *sa, char *dst);
char *mac_addr_ntoa(u_char *mac, char *dst);
int mac_addr_aton(char *str, u_char *mac);

int inet_valid_ip(const char *string);

const char *inet_ntop4(const u_char *src, char *dst, size_t size);
const char *inet_ntop6(const u_char *src, char *dst, size_t size);

/***********************************************************************/


/*
 * creates a structure from a buffer
 */
int ip_addr_init(struct ip_addr *sa, u_int16 type, u_char *addr)
{
   /* the version of the IP packet */
   sa->addr_type = htons(type);
   /* wipe the buffer */
   memset(sa->addr, 0, MAX_IP_ADDR_LEN);

   switch (type) {
      case AF_INET:
         sa->addr_len = htons(IP4_ADDR_LEN);
         break;
      case AF_INET6:
         sa->addr_len = htons(IP6_ADDR_LEN);
         break;
      default:
         /* wipe the struct */
         memset(sa, 0, sizeof(struct ip_addr));
         BUG("Invalid ip_addr type");
         return -EINVALID;
   }

   memcpy(&sa->addr, addr, ntohs(sa->addr_len));

   return ESUCCESS;
};


/*
 * compare two ip_addr structure.
 */
int ip_addr_cmp(struct ip_addr *sa, struct ip_addr *sb)
{
   /* different type are incompatible */
   if (sa->addr_type != sb->addr_type)
      return -EINVALID;

   return memcmp(sa->addr, sb->addr, ntohs(sa->addr_len));

}

/*
 * return ESUCCESS if the ip is in the range sa -> sb
 */
int ip_addr_in_range(struct ip_addr *ip, struct ip_addr *sa, struct ip_addr *sb)
{
   /* different type are incompatible */
   if (ip->addr_type != sa->addr_type)
      return -EINVALID;

   if (sa->addr_type != sb->addr_type)
      return -EINVALID;

   if (memcmp(ip->addr, sa->addr, ntohs(sa->addr_len)) >= 0 &&
       memcmp(ip->addr, sb->addr, ntohs(sb->addr_len)) <= 0)
       return ESUCCESS;

   return -ENOTFOUND;
}

/*
 * return true if an ip address is 0.0.0.0 or invalid
 */
int ip_addr_is_zero(struct ip_addr *sa)
{
   switch (ntohs(sa->addr_type)) {
      case AF_INET:
         if (memcmp(sa->addr, "\x00\x00\x00\x00", IP4_ADDR_LEN))
            return 0;
         break;
      case AF_INET6:
         if (memcmp(sa->addr, "\x00\x00\x00\x00\x00\x00\x00\x00"
                              "\x00\x00\x00\x00\x00\x00\x00\x00", IP6_ADDR_LEN))
            return 0;
         break;
   };

   return 1;
}


/*
 * convert to ascii an ip address
 */
char * ip_addr_ntoa(struct ip_addr *sa, char *dst)
{

   switch (ntohs(sa->addr_type)) {
      case AF_INET:
         inet_ntop4(sa->addr, dst, IP4_ASCII_ADDR_LEN);
         return dst;
         break;
      case AF_INET6:
         inet_ntop6(sa->addr, dst, IP6_ASCII_ADDR_LEN);
         return dst;
         break;
   };

   return "invalid";
}

const char *
inet_ntop4(const u_char *src, char *dst, size_t size)
{
   char str[IP4_ASCII_ADDR_LEN];
   int n;

	n = sprintf(str, "%u.%u.%u.%u", src[0], src[1], src[2], src[3]);

   str[n] = '\0';

   strncpy(dst, str, size);

   return dst;
}

const char *
inet_ntop6(const u_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[IP6_ASCII_ADDR_LEN], *tp;
	struct { int base, len; } best, cur;
	u_int words[NS_IN6ADDRSZ / NS_INT16SZ];
	int i;

	best.len = 0;
	cur.len = 0;

	/*
	 * 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 < NS_IN6ADDRSZ; i += 2)
		words[i / 2] = (src[i] << 8) | src[i + 1];
	best.base = -1;
	cur.base = -1;
	for (i = 0; i < (NS_IN6ADDRSZ / NS_INT16SZ); 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 < (NS_IN6ADDRSZ / NS_INT16SZ); 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 == 5 && words[5] == 0xffff))) {
			if (inet_ntop4(src+12, tp, IP4_ASCII_ADDR_LEN) != 0)
				return (NULL);
			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) ==
	    (NS_IN6ADDRSZ / NS_INT16SZ))
		*tp++ = ':';
	*tp++ = '\0';

  	/*
	 * Check for overflow, copy, and we're done.
	 */
	if ((size_t)(tp - tmp) > size) {
		__set_errno (ENOSPC);
		return (NULL);
	}

   strncpy(dst, tmp, size);

   return dst;
}


/*
 * convert a MAC address to a human readable form
 */
char *mac_addr_ntoa(u_char *mac, char *dst)
{
   char str[ETH_ASCII_ADDR_LEN];
   int n;

	n = sprintf(str, "%02X:%02X:%02X:%02X:%02X:%02X",
         mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);

   str[n] = '\0';

   strncpy(dst, str, ETH_ASCII_ADDR_LEN);

   return dst;
}

/*
 * convert a string to a u_char mac[6]
 */
int mac_addr_aton(char *str, u_char *mac)
{
   int i;
   u_int tmp[MEDIA_ADDR_LEN];

   i = sscanf(str, "%02X:%02X:%02X:%02X:%02X:%02X",
         (u_int *)&tmp[0], (u_int *)&tmp[1], (u_int *)&tmp[2],
         (u_int *)&tmp[3], (u_int *)&tmp[4], (u_int *)&tmp[5]);

   /* incorrect parsing */
   if (i != MEDIA_ADDR_LEN) {
      memset(mac, 0, MEDIA_ADDR_LEN);
      return 0;
   }

   for (i = 0; i < MEDIA_ADDR_LEN; i++)
      mac[i] = (u_char)tmp[i];

   return i;
}

/*
 * return ESUCCESS if string contains a valid ip address
 */

int inet_valid_ip(const char *string)
{
   char *p;
   int i = 0;
   char valid[] = "1234567890.";

   p = (char *)string;

   /* check for invalid chars */
   if (strlen(p) != strspn(p, valid))
      return -EINVALID;

   /* count the dot in the address */
   while (p) {
      p = strchr(p, '.');
      if (p) {
         p++;
         i++;
      }
   }

   if (i != 3)
      return -EINVALID;


   return ESUCCESS;
}


/* EOF */

// vim:ts=3:expandtab