mirror of
https://github.com/RT-Thread/rt-thread.git
synced 2026-09-20 17:44:20 +08:00
[net][sal][netdev] Add IPv6 option configuration and feature support in SAL and netdev
Signed-off-by: chenyong <1521761801@qq.com>
This commit is contained in:
chenyong
@@ -19,8 +19,10 @@
|
||||
#define isxdigit(c) (isdigit(c) || in_range(c, 'a', 'f') || in_range(c, 'A', 'F'))
|
||||
#define islower(c) in_range(c, 'a', 'z')
|
||||
#define isspace(c) (c == ' ' || c == '\f' || c == '\n' || c == '\r' || c == '\t' || c == '\v')
|
||||
#define xchar(i) ((i) < 10 ? '0' + (i) : 'A' + (i) - 10)
|
||||
#endif
|
||||
|
||||
#if NETDEV_IPV4
|
||||
|
||||
/**
|
||||
* Check whether "cp" is a valid ascii representation
|
||||
@@ -255,3 +257,358 @@ in_addr_t netdev_ipaddr_addr(const char *cp)
|
||||
}
|
||||
return (IPADDR_NONE);
|
||||
}
|
||||
|
||||
#endif /* NETDEV_IPV4 */
|
||||
|
||||
|
||||
#if NETDEV_IPV6
|
||||
|
||||
RT_WEAK const struct in6_addr in6addr_any = IN6ADDR_ANY_INIT;
|
||||
|
||||
/**
|
||||
* Check whether "cp" is a valid ascii representation
|
||||
* of an IPv6 address and convert to a binary address.
|
||||
* Returns 1 if the address is valid, 0 if not.
|
||||
*
|
||||
* @param cp IPv6 address in ascii representation (e.g. "FF01::1")
|
||||
* @param addr pointer to which to save the ip address in network order
|
||||
* @return 1 if cp could be converted to addr, 0 on failure
|
||||
*/
|
||||
int
|
||||
netdev_ip6addr_aton(const char *cp, ip6_addr_t *addr)
|
||||
{
|
||||
uint32_t addr_index, zero_blocks, current_block_index, current_block_value;
|
||||
const char *s;
|
||||
|
||||
/* Count the number of colons, to count the number of blocks in a "::" sequence
|
||||
zero_blocks may be 1 even if there are no :: sequences */
|
||||
zero_blocks = 8;
|
||||
for (s = cp; *s != 0; s++)
|
||||
{
|
||||
if (*s == ':')
|
||||
{
|
||||
zero_blocks--;
|
||||
}
|
||||
else if (!isxdigit(*s))
|
||||
{
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* parse each block */
|
||||
addr_index = 0;
|
||||
current_block_index = 0;
|
||||
current_block_value = 0;
|
||||
for (s = cp; *s != 0; s++)
|
||||
{
|
||||
if (*s == ':')
|
||||
{
|
||||
if (addr)
|
||||
{
|
||||
if (current_block_index & 0x1)
|
||||
{
|
||||
addr->addr[addr_index++] |= current_block_value;
|
||||
}
|
||||
else
|
||||
{
|
||||
addr->addr[addr_index] = current_block_value << 16;
|
||||
}
|
||||
}
|
||||
current_block_index++;
|
||||
current_block_value = 0;
|
||||
if (current_block_index > 7)
|
||||
{
|
||||
/* address too long! */
|
||||
return 0;
|
||||
}
|
||||
if (s[1] == ':')
|
||||
{
|
||||
if (s[2] == ':')
|
||||
{
|
||||
/* invalid format: three successive colons */
|
||||
return 0;
|
||||
}
|
||||
s++;
|
||||
/* "::" found, set zeros */
|
||||
while (zero_blocks > 0)
|
||||
{
|
||||
zero_blocks--;
|
||||
if (current_block_index & 0x1)
|
||||
{
|
||||
addr_index++;
|
||||
}
|
||||
else
|
||||
{
|
||||
if (addr)
|
||||
{
|
||||
addr->addr[addr_index] = 0;
|
||||
}
|
||||
}
|
||||
current_block_index++;
|
||||
if (current_block_index > 7)
|
||||
{
|
||||
/* address too long! */
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
else if (isxdigit(*s))
|
||||
{
|
||||
/* add current digit */
|
||||
current_block_value = (current_block_value << 4) +
|
||||
(isdigit(*s) ? (uint32_t)(*s - '0') : (uint32_t)(10 + (islower(*s) ? *s - 'a' : *s - 'A')));
|
||||
}
|
||||
else
|
||||
{
|
||||
/* unexpected digit, space? CRLF? */
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (addr)
|
||||
{
|
||||
if (current_block_index & 0x1)
|
||||
{
|
||||
addr->addr[addr_index++] |= current_block_value;
|
||||
}
|
||||
else
|
||||
{
|
||||
addr->addr[addr_index] = current_block_value << 16;
|
||||
}
|
||||
}
|
||||
|
||||
/* convert to network byte order. */
|
||||
if (addr)
|
||||
{
|
||||
for (addr_index = 0; addr_index < 4; addr_index++)
|
||||
{
|
||||
addr->addr[addr_index] = htonl(addr->addr[addr_index]);
|
||||
}
|
||||
}
|
||||
|
||||
if (current_block_index != 7)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
/**
|
||||
* Same as ipaddr_ntoa, but reentrant since a user-supplied buffer is used.
|
||||
*
|
||||
* @param addr ip6 address in network order to convert
|
||||
* @param buf target buffer where the string is stored
|
||||
* @param buflen length of buf
|
||||
* @return either pointer to buf which now holds the ASCII
|
||||
* representation of addr or NULL if buf was too small
|
||||
*/
|
||||
char *
|
||||
netdev_ip6addr_ntoa_r(const ip6_addr_t *addr, char *buf, int buflen)
|
||||
{
|
||||
uint32_t current_block_index, current_block_value, next_block_value;
|
||||
int32_t i;
|
||||
uint8_t zero_flag, empty_block_flag;
|
||||
|
||||
i = 0;
|
||||
empty_block_flag = 0; /* used to indicate a zero chain for "::' */
|
||||
|
||||
for (current_block_index = 0; current_block_index < 8; current_block_index++)
|
||||
{
|
||||
/* get the current 16-bit block */
|
||||
current_block_value = htonl(addr->addr[current_block_index >> 1]);
|
||||
if ((current_block_index & 0x1) == 0)
|
||||
{
|
||||
current_block_value = current_block_value >> 16;
|
||||
}
|
||||
current_block_value &= 0xffff;
|
||||
|
||||
/* Check for empty block. */
|
||||
if (current_block_value == 0)
|
||||
{
|
||||
if (current_block_index == 7 && empty_block_flag == 1)
|
||||
{
|
||||
/* special case, we must render a ':' for the last block. */
|
||||
buf[i++] = ':';
|
||||
if (i >= buflen)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
break;
|
||||
}
|
||||
if (empty_block_flag == 0)
|
||||
{
|
||||
/* generate empty block "::", but only if more than one contiguous zero block,
|
||||
* according to current formatting suggestions RFC 5952. */
|
||||
next_block_value = htonl(addr->addr[(current_block_index + 1) >> 1]);
|
||||
if ((current_block_index & 0x1) == 0x01)
|
||||
{
|
||||
next_block_value = next_block_value >> 16;
|
||||
}
|
||||
next_block_value &= 0xffff;
|
||||
if (next_block_value == 0)
|
||||
{
|
||||
empty_block_flag = 1;
|
||||
buf[i++] = ':';
|
||||
if (i >= buflen)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
continue; /* move on to next block. */
|
||||
}
|
||||
}
|
||||
else if (empty_block_flag == 1)
|
||||
{
|
||||
/* move on to next block. */
|
||||
continue;
|
||||
}
|
||||
}
|
||||
else if (empty_block_flag == 1)
|
||||
{
|
||||
/* Set this flag value so we don't produce multiple empty blocks. */
|
||||
empty_block_flag = 2;
|
||||
}
|
||||
|
||||
if (current_block_index > 0)
|
||||
{
|
||||
buf[i++] = ':';
|
||||
if (i >= buflen)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
}
|
||||
|
||||
if ((current_block_value & 0xf000) == 0)
|
||||
{
|
||||
zero_flag = 1;
|
||||
}
|
||||
else
|
||||
{
|
||||
buf[i++] = xchar(((current_block_value & 0xf000) >> 12));
|
||||
zero_flag = 0;
|
||||
if (i >= buflen)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
}
|
||||
|
||||
if (((current_block_value & 0xf00) == 0) && (zero_flag))
|
||||
{
|
||||
/* do nothing */
|
||||
}
|
||||
else
|
||||
{
|
||||
buf[i++] = xchar(((current_block_value & 0xf00) >> 8));
|
||||
zero_flag = 0;
|
||||
if (i >= buflen)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
}
|
||||
|
||||
if (((current_block_value & 0xf0) == 0) && (zero_flag))
|
||||
{
|
||||
/* do nothing */
|
||||
}
|
||||
else
|
||||
{
|
||||
buf[i++] = xchar(((current_block_value & 0xf0) >> 4));
|
||||
zero_flag = 0;
|
||||
if (i >= buflen)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
}
|
||||
|
||||
buf[i++] = xchar((current_block_value & 0xf));
|
||||
if (i >= buflen)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
}
|
||||
|
||||
buf[i] = 0;
|
||||
|
||||
return buf;
|
||||
}
|
||||
|
||||
/**
|
||||
* Convert numeric IPv6 address into ASCII representation.
|
||||
* returns ptr to static buffer; not reentrant!
|
||||
*
|
||||
* @param addr ip6 address in network order to convert
|
||||
* @return pointer to a global static (!) buffer that holds the ASCII
|
||||
* representation of addr
|
||||
*/
|
||||
char *
|
||||
netdev_ip6addr_ntoa(const ip6_addr_t *addr)
|
||||
{
|
||||
static char str[40];
|
||||
return netdev_ip6addr_ntoa_r(addr, str, 40);
|
||||
}
|
||||
|
||||
#endif /* NETDEV_IPV6 */
|
||||
|
||||
const char *
|
||||
netdev_inet_ntop(int af, const void *src, char *dst, int32_t size)
|
||||
{
|
||||
#define AF_INET 2
|
||||
#define AF_INET6 10
|
||||
|
||||
const char *ret = NULL;
|
||||
int size_int = (int)size;
|
||||
if (size_int < 0)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
switch (af)
|
||||
{
|
||||
#if NTEDEV_IPV4
|
||||
case AF_INET:
|
||||
return netdev_ip4addr_ntoa_r((const ip4_addr_t *)src, dst, size_int);
|
||||
#endif
|
||||
#if NETDEV_IPV6
|
||||
case AF_INET6:
|
||||
return netdev_ip6addr_ntoa_r((const ip6_addr_t *)src, dst, size_int);
|
||||
#endif
|
||||
default:
|
||||
break;
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
int
|
||||
netdev_inet_pton(int af, const char *src, void *dst)
|
||||
{
|
||||
#define AF_INET 2
|
||||
#define AF_INET6 10
|
||||
|
||||
int err;
|
||||
switch (af)
|
||||
{
|
||||
#if NETDEV_IPV4
|
||||
case AF_INET:
|
||||
err = netdev_ip4addr_aton(src, (ip4_addr_t *)dst);
|
||||
break;
|
||||
#endif
|
||||
#if NETDEV_IPV6
|
||||
case AF_INET6:
|
||||
{
|
||||
/* convert into temporary variable since ip6_addr_t might be larger
|
||||
than in6_addr when scopes are enabled */
|
||||
ip6_addr_t addr;
|
||||
err = netdev_ip6addr_aton(src, &addr);
|
||||
if (err)
|
||||
{
|
||||
rt_memcpy(dst, &addr.addr, sizeof(addr.addr));
|
||||
}
|
||||
break;
|
||||
}
|
||||
#endif
|
||||
default:
|
||||
err = -1;
|
||||
break;
|
||||
}
|
||||
return err;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user