[BACK]Return to net.c CVS log [TXT] [DIR] Up to [ELWIX - Embedded LightWeight unIX -] / libelwix / src

Diff for /libelwix/src/net.c between versions 1.2.2.1 and 1.12.4.3

version 1.2.2.1, 2013/06/03 11:41:45 version 1.12.4.3, 2016/05/14 13:26:04
Line 12  terms: Line 12  terms:
 All of the documentation and software included in the ELWIX and AITNET  All of the documentation and software included in the ELWIX and AITNET
 Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>  Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
   
Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013Copyright 2004 - 2016
         by Michael Pounov <misho@elwix.org>.  All rights reserved.          by Michael Pounov <misho@elwix.org>.  All rights reserved.
   
 Redistribution and use in source and binary forms, with or without  Redistribution and use in source and binary forms, with or without
Line 46  SUCH DAMAGE. Line 46  SUCH DAMAGE.
 #include "global.h"  #include "global.h"
   
   
   #ifndef __linux__
   static char hexlist[] = "0123456789abcdef";
   
 /*  /*
    * e_link_ntoa() - String ethernet address from link address
    *
    * @sdl = link address
    * return: =NULL error or !=NULL ethernet address, should be e_free()
    */
   char *
   e_link_ntoa(const struct sockaddr_dl *sdl)
   {
           static char obuf[64];
           char *out = obuf;
           int i;
           u_char *in = (u_char*) LLADDR(sdl);
           u_char *inlim = in + sdl->sdl_alen;
           int firsttime = 1;
   
           if (sdl->sdl_nlen) {
                   memcpy(obuf, sdl->sdl_data, sdl->sdl_nlen);
                   out += sdl->sdl_nlen;
                   if (sdl->sdl_alen)
                           *out++ = '!';
           }
   
           while (in < inlim) {
                   if (firsttime)
                           firsttime ^= firsttime;
                   else
                           *out++ = ':';
   
                   i = *in++;
                   if (i > 0xf) {
                           out[1] = hexlist[i & 0xf];
                           i >>= 4;
                   } else {
                           out[1] = hexlist[i];
                           i = 0;
                   }
   
                   out[0] = hexlist[i];
                   out += 2;
           }
   
           *out = 0;
           return obuf;
   }
   
   /*
    * e_link_addr() - String ethernet address to link address
    *
    * @mac = ethernet address
    * @sdl = link address
    * return: -1 error or 0 ok
    */
   int
   e_link_addr(const char *mac, struct sockaddr_dl * __restrict sdl)
   {
           if (!mac || !sdl)
                   return -1;
           if (!sdl->sdl_len)
                   sdl->sdl_len = sizeof(struct sockaddr_dl);
   
           link_addr(mac, sdl);
           return 0;
   }
   #endif
   
   /*
  * e_ether_ntoa() - Convert ethernet address to string   * e_ether_ntoa() - Convert ethernet address to string
  *   *
  * @n = ethernet address structure, like struct ether_addr   * @n = ethernet address structure, like struct ether_addr
Line 55  SUCH DAMAGE. Line 124  SUCH DAMAGE.
  * return: NULL error or !=NULL string a   * return: NULL error or !=NULL string a
  */   */
 char *  char *
e_ether_ntoa(const struct e_ether_addr *n, char * __restrict a, int len)e_ether_ntoa(const ether_addr_t * __restrict n, char * __restrict a, int len)
 {  {
         if (!n || !a)          if (!n || !a)
                 return NULL;                  return NULL;
   
         memset(a, 0, len);          memset(a, 0, len);
        if (snprintf(a, len, "%02x:%02x:%02x:%02x:%02x:%02x",         if (snprintf(a, len, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx", 
                        n->ether_addr_octet[0], n->ether_addr_octet[1],                         n->octet[0], n->octet[1], 
                        n->ether_addr_octet[2], n->ether_addr_octet[3],                         n->octet[2], n->octet[3], 
                        n->ether_addr_octet[4], n->ether_addr_octet[5]) < 17)                        n->octet[4], n->octet[5]) < 17)
                 return NULL;                  return NULL;
   
         return a;          return a;
Line 77  e_ether_ntoa(const struct e_ether_addr *n, char * __re Line 146  e_ether_ntoa(const struct e_ether_addr *n, char * __re
  * @e = ethernet address structure, like struct ether_addr   * @e = ethernet address structure, like struct ether_addr
  * return: NULL error or !=NULL ethernet address structure   * return: NULL error or !=NULL ethernet address structure
  */   */
struct e_ether_addr *ether_addr_t *
e_ether_aton(const char *a, struct e_ether_addr *e)e_ether_aton(const char *a, ether_addr_t * __restrict e)
 {                         {                       
         int i;          int i;
         u_int o0, o1, o2, o3, o4, o5;  
   
         if (!a || !e)          if (!a || !e)
                 return NULL;                  return NULL;
   
        i = sscanf(a, "%x:%x:%x:%x:%x:%x", &o0, &o1, &o2, &o3, &o4, &o5);        i = sscanf(a, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx", 
                         &e->octet[0], 
                         &e->octet[1], 
                         &e->octet[2], 
                         &e->octet[3], 
                         &e->octet[4], 
                         &e->octet[5]);
         if (i != 6)          if (i != 6)
                 return NULL;                  return NULL;
   
         e->ether_addr_octet[0] = o0;  
         e->ether_addr_octet[1] = o1;  
         e->ether_addr_octet[2] = o2;  
         e->ether_addr_octet[3] = o3;  
         e->ether_addr_octet[4] = o4;  
         e->ether_addr_octet[5] = o5;  
   
         return e;          return e;
 }  }
   
Line 136  e_n2port(sockaddr_t * __restrict addr) Line 203  e_n2port(sockaddr_t * __restrict addr)
 const char *  const char *
 e_n2addr(sockaddr_t * __restrict addr, ait_val_t * __restrict val)  e_n2addr(sockaddr_t * __restrict addr, ait_val_t * __restrict val)
 {  {
   #ifndef __linux__
           char *s;
   #endif
         char str[INET6_ADDRSTRLEN] = { 0 };          char str[INET6_ADDRSTRLEN] = { 0 };
         const char *ret = NULL;          const char *ret = NULL;
   
Line 161  e_n2addr(sockaddr_t * __restrict addr, ait_val_t * __r Line 231  e_n2addr(sockaddr_t * __restrict addr, ait_val_t * __r
                 case AF_LOCAL:                  case AF_LOCAL:
                         ret = addr->sun.sun_path;                          ret = addr->sun.sun_path;
                         break;                          break;
   #ifndef __linux__
                   case AF_LINK:
                           if (!(s = e_link_ntoa(&addr->sdl))) {
                                   LOGERR;
                                   return ret;
                           } else
                                   ret = s;
                           break;
   #endif
                 default:                  default:
                         elwix_SetErr(EPROTONOSUPPORT, "Unsuported address family %d",                           elwix_SetErr(EPROTONOSUPPORT, "Unsuported address family %d", 
                                         addr->sa.sa_family);                                          addr->sa.sa_family);
Line 189  e_gethostbyname(const char *psHost, u_short port, sock Line 268  e_gethostbyname(const char *psHost, u_short port, sock
   
         if (*psHost != '/') {          if (*psHost != '/') {
                 /* resolver */                  /* resolver */
                if (!addr->sa.sa_family)                host = gethostbyname2(psHost, !strchr(psHost, ':') ? AF_INET : AF_INET6);
                        host = gethostbyname(psHost); 
                else 
                        host = gethostbyname2(psHost, addr->sa.sa_family); 
                 if (!host) {                  if (!host) {
                         elwix_SetErr(EINVAL, "Resolver #%d - %s", h_errno, hstrerror(h_errno));                          elwix_SetErr(EINVAL, "Resolver #%d - %s", h_errno, hstrerror(h_errno));
                         return NULL;                          return NULL;
Line 208  e_gethostbyname(const char *psHost, u_short port, sock Line 284  e_gethostbyname(const char *psHost, u_short port, sock
   
         switch (addr->sa.sa_family) {          switch (addr->sa.sa_family) {
                 case AF_INET:                  case AF_INET:
   #ifndef __linux__
                         addr->sin.sin_len = sizeof(struct sockaddr_in);                          addr->sin.sin_len = sizeof(struct sockaddr_in);
   #endif
                         addr->sin.sin_family = AF_INET;                          addr->sin.sin_family = AF_INET;
                         addr->sin.sin_port = htons(port);                          addr->sin.sin_port = htons(port);
                         memcpy(&addr->sin.sin_addr, host->h_addr, sizeof addr->sin.sin_addr);                          memcpy(&addr->sin.sin_addr, host->h_addr, sizeof addr->sin.sin_addr);
                         return addr;                          return addr;
                 case AF_INET6:                  case AF_INET6:
   #ifndef __linux__
                         addr->sin6.sin6_len = sizeof(struct sockaddr_in6);                          addr->sin6.sin6_len = sizeof(struct sockaddr_in6);
   #endif
                         addr->sin6.sin6_family = AF_INET6;                          addr->sin6.sin6_family = AF_INET6;
                         addr->sin6.sin6_port = htons(port);                          addr->sin6.sin6_port = htons(port);
                         memcpy(&addr->sin6.sin6_addr, host->h_addr, sizeof addr->sin6.sin6_addr);                          memcpy(&addr->sin6.sin6_addr, host->h_addr, sizeof addr->sin6.sin6_addr);
                         return addr;                          return addr;
                 case AF_LOCAL:                  case AF_LOCAL:
   #ifndef __linux__
                         addr->sun.sun_len = sizeof(struct sockaddr_un);                          addr->sun.sun_len = sizeof(struct sockaddr_un);
   #endif
                         addr->sun.sun_family = AF_LOCAL;                          addr->sun.sun_family = AF_LOCAL;
                         memset(addr->sun.sun_path, 0, sizeof addr->sun.sun_path);                          memset(addr->sun.sun_path, 0, sizeof addr->sun.sun_path);
                         snprintf(addr->sun.sun_path, sizeof addr->sun.sun_path, "%s-%hu", psHost, port);                          snprintf(addr->sun.sun_path, sizeof addr->sun.sun_path, "%s-%hu", psHost, port);
Line 260  e_addrcmp(sockaddr_t * __restrict a, sockaddr_t * __re Line 342  e_addrcmp(sockaddr_t * __restrict a, sockaddr_t * __re
                                 else                                  else
                                         return memcmp(&a->sin6.sin6_addr, &b->sin6.sin6_addr,                                           return memcmp(&a->sin6.sin6_addr, &b->sin6.sin6_addr, 
                                                         sizeof a->sin6.sin6_addr);                                                          sizeof a->sin6.sin6_addr);
   #ifndef __linux__
                         case AF_LINK:                          case AF_LINK:
                                 return memcmp(&a->sdl.sdl_data, &b->sdl.sdl_data,                                   return memcmp(&a->sdl.sdl_data, &b->sdl.sdl_data, 
                                                 sizeof a->sdl.sdl_data);                                                  sizeof a->sdl.sdl_data);
   #endif
                           case AF_UNSPEC:
                                   return memcmp(a, b, sizeof(sockaddr_t));
                 }                  }
   
         return (int) !!(a - b);          return (int) !!(a - b);
Line 290  e_usleep(u_int usec) Line 376  e_usleep(u_int usec)
  * return: -1 error, 0 match or 1 not match   * return: -1 error, 0 match or 1 not match
  */   */
 int  int
e_innet(netaddr_t * __restrict net, netaddr_t * __restrict addr)e_innet(netaddr_t * __restrict net, inaddr_t * __restrict addr)
 {  {
         register int i;          register int i;
         int ret = 0;          int ret = 0;
Line 298  e_innet(netaddr_t * __restrict net, netaddr_t * __rest Line 384  e_innet(netaddr_t * __restrict net, netaddr_t * __rest
         if (!net || !addr)          if (!net || !addr)
                 return -1;                  return -1;
   
         if (net->addr.sa.sa_family != addr->addr.sa.sa_family)  
                 return -1;  
         switch (net->addr.sa.sa_family) {          switch (net->addr.sa.sa_family) {
                 case AF_INET:                  case AF_INET:
                        ret = net->addr.sin.sin_addr.s_addr & net->mask.in.s_addr;                        for (i = 0; i < sizeof(struct in_addr); i++) {
                        ret -= addr->addr.sin.sin_addr.s_addr & addr->mask.in.s_addr;                                ret = ((caddr_t) &net->addr.sin.sin_addr.s_addr)[i] & 
                                         net->mask.in.s4_addr[i];
                                 ret -= addr->in.s4_addr[i] & net->mask.in.s4_addr[i];
                                 if (ret)
                                         break;
                         }
                         break;                          break;
                 case AF_INET6:                  case AF_INET6:
                         for (i = 0; i < sizeof(struct in6_addr); i++) {                          for (i = 0; i < sizeof(struct in6_addr); i++) {
                                ret = net->addr.sin6.sin6_addr.s6_addr[i] & net->mask.in6.s6_addr[i];                                ret = net->addr.sin6.sin6_addr.s6_addr[i] & 
                                ret -= addr->addr.sin6.sin6_addr.s6_addr[i] & addr->mask.in6.s6_addr[i];                                        net->mask.in6.s6_addr[i];
                                 ret -= addr->in6.s6_addr[i] & net->mask.in6.s6_addr[i];
                                 if (ret)                                  if (ret)
                                         break;                                          break;
                         }                          }
Line 319  e_innet(netaddr_t * __restrict net, netaddr_t * __rest Line 409  e_innet(netaddr_t * __restrict net, netaddr_t * __rest
   
         return !!ret;          return !!ret;
 }  }
   
   /*
    * e_getnet() - Get network from string
    *
    * @net = Network string (format: <net[/cidr]>)
    * return: NULL error or !=NULL network should be e_free()
    */
   netaddr_t *
   e_getnet(const char *net)
   {
           netaddr_t *n;
           char *str, *wrk;
           struct hostent *host;
   
           n = e_malloc(sizeof(netaddr_t));
           if (!n) {
                   LOGERR;
                   return NULL;
           } else
                   memset(n, 0, sizeof(netaddr_t));
           str = e_strdup(net);
           if (!str) {
                   LOGERR;
                   e_free(n);
                   return NULL;
           }
           wrk = strchr(str, '/');
           if (wrk)
                   *wrk++ = 0;
   
           host = gethostbyname2(str, strchr(str, ':') ? AF_INET6 : AF_INET);
           if (!host) {
                   elwix_SetErr(EINVAL, "Resolver #%d - %s", h_errno, hstrerror(h_errno));
                   e_free(str);
                   e_free(n);
                   return NULL;
           }
           switch (host->h_addrtype) {
                   case AF_INET:
   #ifndef __linux__
                           n->addr.sin.sin_len = sizeof(struct sockaddr_in);
   #endif
                           n->addr.sin.sin_family = host->h_addrtype;
                           memcpy(&n->addr.sin.sin_addr, host->h_addr, sizeof n->addr.sin.sin_addr);
                           if (wrk)
                                   n->mask.in.s_addr = E_CIDRMASK(strtol(wrk, NULL, 10));
                           else
                                   n->mask.in.s_addr = 0xFFFFFFFF;
                           break;
                   case AF_INET6:
   #ifndef __linux__
                           n->addr.sin6.sin6_len = sizeof(struct sockaddr_in6);
   #endif
                           n->addr.sin6.sin6_family = host->h_addrtype;
                           memcpy(&n->addr.sin6.sin6_addr, host->h_addr, sizeof n->addr.sin6.sin6_addr);
                           /* TODO: should support ipv6 mask */
                           break;
                   default:
                           elwix_SetErr(EINVAL, "Unsupported family #%d", host->h_addrtype);
                           e_free(str);
                           e_free(n);
                           return NULL;
           }
   
           e_free(str);
           return n;
   }
   
   /*
    * e_ether_addr() - Get or set ethernet address from interface name
    *
    * @ifname = interface name
    * @addr = if addr is !=NULL then set this for new address
    * return: NULL error or !=NULL get ethernet address should be e_free()
    */
   ether_addr_t *
   e_ether_addr(const char *ifname, ether_addr_t * __restrict addr)
   {
           ether_addr_t *a = NULL;
           struct ifaddrs *p, *ifa = NULL;
   #ifdef __linux__
           int s;
           struct ifreq req;
   
           memset(&req, 0, sizeof req);
   #endif
   
           if (!ifname)
                   return NULL;
   
           getifaddrs(&ifa);
           for (p = ifa; p && p->ifa_name; p = p->ifa_next) {
   #ifndef __linux__
                   if (p->ifa_name && !strcmp(p->ifa_name, ifname) && p->ifa_addr && 
                                   p->ifa_addr->sa_family == AF_LINK) {
                           a = e_malloc(sizeof(ether_addr_t));
                           if (a)
                                   memcpy(a, LLADDR((struct sockaddr_dl*) p->ifa_addr), sizeof(ether_addr_t));
                           break;
                   }
   #else
                   if (p->ifa_name && !strcmp(p->ifa_name, ifname)) {
                           s = socket(AF_INET, SOCK_DGRAM, IPPROTO_IP);
                           if (s == -1)
                                   break;
                           strlcpy(req.ifr_name, ifname, sizeof req.ifr_name);
                           if (!ioctl(s, SIOCGIFHWADDR, &req)) {
                                   a = e_malloc(sizeof(ether_addr_t));
                                   if (a)
                                           memcpy(a, req.ifr_addr.sa_data, sizeof(ether_addr_t));
                           }
                           break;
                   }
   #endif
           }
           freeifaddrs(ifa);
   
           return a;
   }
   
   /*
    * e_get1stiface() - Get first interface of host
    *
    * @szIface = interface string buffer
    * @iflen = size of interface buffer
    * return: -1 error or 0 ok
    */
   int
   e_get1stiface(char *szIface, int iflen)
   {
           struct ifaddrs *ifa;
   
           if (!szIface || !iflen)
                   return -1;
   
           getifaddrs(&ifa);
           strlcpy(szIface, ifa->ifa_name, iflen);
           freeifaddrs(ifa);
           return 0;
   }
   
   #ifndef __linux__
   /*
    * e_getifacebyname() - Get interface and make network structure
    *
    * @psIface = Interface, if =NULL first interface
    * @addr = Network address structure
    * return: NULL error or !=NULL network structure
    */
   sockaddr_t *
   e_getifacebyname(const char *psIface, sockaddr_t * __restrict addr)
   {
           char szIface[64] = { [0 ... 63] = 0 };
           struct ifaddrs *p, *ifa = NULL;
   
           if (!addr)
                   return NULL;
   
           memset(addr, 0, sizeof(sockaddr_t));
           getifaddrs(&ifa);
           strlcpy(szIface, psIface ? psIface : ifa->ifa_name, sizeof szIface);
           for (p = ifa; p && p->ifa_name; p = p->ifa_next)
                   if (p->ifa_name && !strcmp(p->ifa_name, szIface) && p->ifa_addr && 
                                   p->ifa_addr->sa_family == AF_LINK) {
                           memcpy(&addr->sdl, p->ifa_addr, sizeof(struct sockaddr_dl));
                           break;
                   }
           freeifaddrs(ifa);
   
           return addr;
   }
   
   /*
    * e_getlinkbyname() - Get host ethernet address and make network structure
    *
    * @psHost = Host ethernet address
    * @addr = Network address structure
    * return: NULL error or !=NULL network structure
    */
   sockaddr_t *
   e_getlinkbyname(const char *psHost, sockaddr_t * __restrict addr)
   {
           ait_val_t v;
           sockaddr_t *a = addr;
   
           if (!psHost || !addr)
                   return NULL;
           else
                   memset(addr, 0, sizeof(sockaddr_t));
   
           AIT_INIT_VAL2(&v, string);
           if (!strchr(psHost, '.'))
                   AIT_SET_STR(&v, ":");
           AIT_SET_STRCAT(&v, psHost);
   
           addr->sdl.sdl_len = sizeof(struct sockaddr_dl);
           if (e_link_addr(AIT_GET_STR(&v), &addr->sdl))
                   a = NULL;
   
           AIT_FREE_VAL(&v);
           return a;
   }
   
   /*
    * e_getlinkbyether() - Get ethernet address and make network structure
    *
    * @mac = Ethernet address
    * @idx = Interface index
    * @type = Interface type
    * @iface = Interface name
    * @addr = Network address structure
    * return: NULL error or !=NULL network structure
    */
   sockaddr_t *
   e_getlinkbyether(const ether_addr_t * __restrict mac, u_short idx, u_char type, 
                   const char *iface, sockaddr_t * __restrict addr)
   {
           sockaddr_t *a = addr;
   
           if (!addr)
                   return NULL;
           else
                   memset(addr, 0, sizeof(sockaddr_t));
   
           addr->sdl.sdl_len = sizeof(struct sockaddr_dl);
           addr->sdl.sdl_family = AF_LINK;
           addr->sdl.sdl_index = idx;
           addr->sdl.sdl_type = type;
           if (iface && *iface) {
                   addr->sdl.sdl_nlen = strlen(iface);
                   memcpy(addr->sdl.sdl_data, iface, addr->sdl.sdl_nlen);
           }
           addr->sdl.sdl_alen = sizeof(ether_addr_t);
           memcpy(LLADDR(&addr->sdl), mac, addr->sdl.sdl_alen);
   
           return a;
   }
   #endif
Removed from v.1.2.2.1  
changed lines
  Added in v.1.12.4.3

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>