--- libaitio/src/Attic/tools.c 2011/06/07 11:49:39 1.5 +++ libaitio/src/Attic/tools.c 2012/07/03 08:51:05 1.15 @@ -3,7 +3,7 @@ * by Michael Pounov * * $Author: misho $ -* $Id: tools.c,v 1.5 2011/06/07 11:49:39 misho Exp $ +* $Id: tools.c,v 1.15 2012/07/03 08:51:05 misho Exp $ * ************************************************************************** The ELWIX and AITNET software is distributed under the following @@ -12,7 +12,7 @@ terms: All of the documentation and software included in the ELWIX and AITNET Releases is copyrighted by ELWIX - Sofia/Bulgaria -Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011 +Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012 by Michael Pounov . All rights reserved. Redistribution and use in source and binary forms, with or without @@ -48,53 +48,56 @@ SUCH DAMAGE. /* - * io_LTrimStr() Remove left whitespaces from text string + * io_LTrimStr() - Remove left whitespaces from text string + * * @psLine = Text string * return: 0 nothing to do; !=0 Removed bytes */ inline int -io_LTrimStr(u_char * __restrict psLine) +io_LTrimStr(char * __restrict psLine) { int pos = 0; - u_char *s; + char *s; if (!psLine || !*psLine) return 0; - for (s = psLine; isspace(*s); s++); + for (s = psLine; isspace((u_char) *s); s++); pos = s - psLine; - memmove(psLine, s, (strlen((char*) psLine) - pos) + 1); + memmove(psLine, s, (strlen(psLine) - pos) + 1); return pos; } /* - * io_RTrimStr() Remove right whitespaces from text string + * io_RTrimStr() - Remove right whitespaces from text string + * * @psLine = Text string * return: 0 nothing to do; !=0 Removed bytes */ inline int -io_RTrimStr(u_char * __restrict psLine) +io_RTrimStr(char * __restrict psLine) { - u_char *t, *pos; + char *t, *pos; if (!psLine || !*psLine) return 0; - pos = psLine + strlen((char*) psLine); - for (t = pos - 1; t > psLine && isspace(*t); t--); + pos = psLine + strlen(psLine); + for (t = pos - 1; t > psLine && isspace((u_char) *t); t--); *++t = 0; return pos - t; } /* - * io_TrimStr() Remove left and right whitespaces from text string + * io_TrimStr() - Remove left and right whitespaces from text string + * * @psLine = Text string * return: 0 nothing to do; !=0 Removed bytes */ inline int -io_TrimStr(u_char * __restrict psLine) +io_TrimStr(char * __restrict psLine) { int ret = 0; @@ -105,12 +108,13 @@ io_TrimStr(u_char * __restrict psLine) } /* - * io_UnquotStr() Remove quots from input text string + * io_UnquotStr() - Remove quots from input text string + * * @psLine = Text string * return: 0 nothing to do; 1 successful unquoted string */ inline int -io_UnquotStr(u_char * __restrict psLine) +io_UnquotStr(char * __restrict psLine) { char *pos, *str = NULL; int flg; @@ -118,30 +122,28 @@ io_UnquotStr(u_char * __restrict psLine) if (!psLine) return 0; - switch (*psLine) { - case '`': - case '"': - case '\'': - str = strdup((char*) psLine + 1); - for (pos = str, flg = 0; *pos; flg = ('\\' == *pos), pos++) { - if (!flg && *pos == *psLine) { - *pos = 0; - strlcpy((char*) psLine, str, strlen((char*) psLine) + 1); - break; - } + if (*psLine == '"' || *psLine == '\'') { + str = io_strdup(psLine + 1); + for (pos = str, flg = 0; *pos; flg = ('\\' == *pos), pos++) { + if (!flg && *pos == *psLine) { + *pos = 0; + strlcpy(psLine, str, strlen(psLine) + 1); + break; } - free(str); - return 1; + } + io_free(str); + return 1; } return 0; } /* - * io_Ch2Hex() Convert from Char string to Hex string + * io_Ch2Hex() - Convert from Char string to Hex string + * * @psLine = Text string * @lineLen = Length of Text string - * return: NULL nothing to do or error; !=0 Allocated new converted data without term\0 (must be free) + * return: NULL nothing to do or error; !=0 Allocated new converted data without term\0 (must be io_free) */ inline u_char * io_Ch2Hex(u_char *psLine, int lineLen) @@ -153,7 +155,7 @@ io_Ch2Hex(u_char *psLine, int lineLen) if (!psLine || !*psLine || !lineLen) return NULL; - str = malloc(lineLen / 2); + str = io_malloc(lineLen / 2); if (!str) { LOGERR; return NULL; @@ -170,10 +172,11 @@ io_Ch2Hex(u_char *psLine, int lineLen) /* - * io_Hex2Ch() Convert from Hex string to Char string + * io_Hex2Ch() - Convert from Hex string to Char string + * * @psLine = Text string * @lineLen = Length of Text string - * return: NULL nothing to do or error; !=0 Allocated new converted string(must be free) + * return: NULL nothing to do or error; !=0 Allocated new converted string(must be io_free) */ inline char * io_Hex2Ch(u_char *psLine, int lineLen) @@ -184,7 +187,7 @@ io_Hex2Ch(u_char *psLine, int lineLen) if (!psLine || !*psLine || !lineLen) return NULL; - str = malloc(lineLen * 2 + 1); + str = io_malloc(lineLen * 2 + 1); if (!str) { LOGERR; return NULL; @@ -201,9 +204,10 @@ io_Hex2Ch(u_char *psLine, int lineLen) } /* - * io_CopyEnv() Copy environment to new environment array; + * io_CopyEnv() - Copy environment to new environment array; + * * @oldenv = Environment array - * return: NULL error; !=NULL Allocated new environment array(must be free) + * return: NULL error; !=NULL Allocated new environment array(must be io_free) */ char ** io_CopyEnv(const char **oldenv) @@ -222,7 +226,7 @@ io_CopyEnv(const char **oldenv) num++; /* create and copy new environment */ - newenv = calloc(num + 1, sizeof(char*)); + newenv = io_calloc(num + 1, sizeof(char*)); if (!newenv) { LOGERR; return NULL; @@ -231,7 +235,7 @@ io_CopyEnv(const char **oldenv) for (i = 0; oldenv[i]; i++) if (*strchr(oldenv[i], '=')) { - *el = strdup(oldenv[i]); + *el = io_strdup(oldenv[i]); el++; } *el = NULL; @@ -240,10 +244,11 @@ io_CopyEnv(const char **oldenv) } /* - * io_ExecArgs() Build exec arguments from other array + * io_ExecArgs() - Build exec arguments from other array + * * @psProg = Program name for execute * @oldarg = Arguments array - * return: NULL error; !=NULL Allocated execution array(must be free) + * return: NULL error; !=NULL Allocated execution array(must be io_free) */ char ** io_ExecArgs(const char *psProg, const char **oldarg) @@ -260,25 +265,26 @@ io_ExecArgs(const char *psProg, const char **oldarg) for (num = 0; oldarg[num]; num++); /* create and copy new arguments */ - newarg = calloc(num + 2, sizeof(char*)); + newarg = io_calloc(num + 2, sizeof(char*)); if (!newarg) { LOGERR; return NULL; } else el = newarg; - *el = strdup(psProg); + *el = io_strdup(psProg); el++; for (i = 0; oldarg[i]; i++, el++) - *el = strdup(oldarg[i]); + *el = io_strdup(oldarg[i]); *el = NULL; return newarg; } /* - * io_FreeNullTerm() Free dynamic allocated null terminated array with strings + * io_FreeNullTerm() - Free dynamic allocated null terminated array with strings + * * @arr = Pointer to array for free * return: none */ @@ -290,8 +296,236 @@ io_FreeNullTerm(char *** __restrict arr) if (arr && *arr) { a = *arr; while (a && *a) - free(*a++); - free(*arr); + io_free(*a++); + io_free(*arr); *arr = NULL; } +} + +/* + * io_Path2File() - Parse and make path/filename pair + * + * @csArgs = Input argument line + * @psPath = Output Path, if ==NULL path not returned + * @pathLen = Size of path array + * @psFile = Output File + * @fileLen = Size of file array + * return: 0 error format; -1 error:: can`t read; >0 ok, number of readed items + */ +inline int +io_Path2File(const char * __restrict csArgs, char * __restrict psPath, + int pathLen, char * __restrict psFile, int fileLen) +{ + char *pos, *psBuf; + + if (!csArgs || !psFile || !fileLen) + return -1; + if (psPath && !pathLen) + return -1; + + psBuf = io_strdup(csArgs); + if (!psBuf) { + LOGERR; + return -1; + } + + pos = strrchr(psBuf, '/'); + if (!pos) { + strlcpy(psFile, psBuf, fileLen); + + io_free(psBuf); + return 1; + } else + *pos++ = 0; + + strlcpy(psFile, pos, fileLen); + if (psPath) + strlcpy(psPath, psBuf, pathLen); + + io_free(psBuf); + return 2; +} + +/* + * io_ether_ntoa() - Convert ethernet address to string + * + * @n = ethernet address structure, like struct ether_addr + * @a = string + * @len = string length + * return: NULL error or !=NULL string a + */ +inline char * +io_ether_ntoa(const struct io_ether_addr *n, char * __restrict a, int len) +{ + if (!n || !a) + return NULL; + + memset(a, 0, len); + if (snprintf(a, len, "%02x:%02x:%02x:%02x:%02x:%02x", + n->ether_addr_octet[0], n->ether_addr_octet[1], + n->ether_addr_octet[2], n->ether_addr_octet[3], + n->ether_addr_octet[4], n->ether_addr_octet[5]) < 17) + return NULL; + + return a; +} + +/* + * io_ether_aton() - Convert string to ethernet address + * + * @a = string + * @e = ethernet address structure, like struct ether_addr + * return: NULL error or !=NULL ethernet address structure + */ +inline struct io_ether_addr * +io_ether_aton(const char *a, struct io_ether_addr *e) +{ + int i; + u_int o0, o1, o2, o3, o4, o5; + + if (!a || !e) + return NULL; + + i = sscanf(a, "%x:%x:%x:%x:%x:%x", &o0, &o1, &o2, &o3, &o4, &o5); + if (i != 6) + 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; +} + +/* + * io_n2port() - Extract port from network structure + * + * @addr = Address + * return: 0 not supported family type or port number + */ +inline u_short +io_n2port(io_sockaddr_t * __restrict addr) +{ + u_short port = 0; + + if (!addr) + return port; + + switch (addr->sa.sa_family) { + case AF_INET: + return ntohs(addr->sin.sin_port); + case AF_INET6: + return ntohs(addr->sin6.sin6_port); + default: + break; + } + + return port; +} + +/* + * io_n2addr() - Extract address from network structure + * + * @addr = Address + * @val = Value for store string address + * return: NULL error or !=NULL string address from val + */ +const char * +io_n2addr(io_sockaddr_t * __restrict addr, ait_val_t * __restrict val) +{ + char str[INET6_ADDRSTRLEN] = { 0 }; + const char *ret = NULL; + + if (!addr || !val) + return ret; + + AIT_INIT_VAL(val); + switch (addr->sa.sa_family) { + case AF_INET: + if (!inet_ntop(AF_INET, &addr->sin.sin_addr, str, INET_ADDRSTRLEN)) { + LOGERR; + return ret; + } else + ret = str; + break; + case AF_INET6: + if (!inet_ntop(AF_INET6, &addr->sin6.sin6_addr, str, INET6_ADDRSTRLEN)) { + LOGERR; + return ret; + } else + ret = str; + break; + case AF_LOCAL: + ret = addr->sun.sun_path; + break; + default: + io_SetErr(EPROTONOSUPPORT, "Unsuported address family %d", + addr->sa.sa_family); + return ret; + } + + AIT_SET_STR(val, ret); + return (const char*) AIT_GET_STR(val); +} + +/* + * io_gethostbyname() - Get host and port and make network structure + * + * @psHost = Hostname + * @port = Port + * @addr = Network address structure + * return: NULL error or !=NULL network structure + */ +io_sockaddr_t * +io_gethostbyname(const char *psHost, u_short port, io_sockaddr_t * __restrict addr) +{ + struct hostent *host = NULL; + + if (!psHost || !addr) + return NULL; + else + memset(addr, 0, sizeof(io_sockaddr_t)); + + if (*psHost != '/') { + /* resolver */ + if (!addr->sa.sa_family) + host = gethostbyname(psHost); + else + host = gethostbyname2(psHost, addr->sa.sa_family); + if (!host) { + io_SetErr(EINVAL, "Resolver #%d - %s", h_errno, hstrerror(h_errno)); + return NULL; + } else + addr->sa.sa_family = host->h_addrtype; + } else + addr->sa.sa_family = AF_LOCAL; + + switch (addr->sa.sa_family) { + case AF_INET: + addr->sin.sin_len = sizeof(struct sockaddr_in); + addr->sin.sin_family = AF_INET; + addr->sin.sin_port = htons(port); + memcpy(&addr->sin.sin_addr, host->h_addr, sizeof addr->sin.sin_addr); + return addr; + case AF_INET6: + addr->sin6.sin6_len = sizeof(struct sockaddr_in6); + addr->sin6.sin6_family = AF_INET6; + addr->sin6.sin6_port = htons(port); + memcpy(&addr->sin6.sin6_addr, host->h_addr, sizeof addr->sin6.sin6_addr); + return addr; + case AF_LOCAL: + addr->sun.sun_len = sizeof(struct sockaddr_un); + addr->sun.sun_family = AF_LOCAL; + 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); + return addr; + default: + io_SetErr(EPROTONOSUPPORT, "Unsuported address family %d", addr->sa.sa_family); + break; + } + + return NULL; }