487 lines
12 KiB
C
487 lines
12 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Generic address resultion entity
|
|
*
|
|
* Authors:
|
|
* net_random Alan Cox
|
|
* net_ratelimit Andi Kleen
|
|
* in{4,6}_pton YOSHIFUJI Hideaki, Copyright (C)2006 USAGI/WIDE Project
|
|
*
|
|
* Created by Alexey Kuznetsov <kuznet@ms2.inr.ac.ru>
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/ctype.h>
|
|
#include <linux/inet.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/net.h>
|
|
#include <linux/string.h>
|
|
#include <linux/types.h>
|
|
#include <linux/percpu.h>
|
|
#include <linux/init.h>
|
|
#include <linux/ratelimit.h>
|
|
#include <linux/socket.h>
|
|
|
|
#include <net/sock.h>
|
|
#include <net/net_ratelimit.h>
|
|
#include <net/ipv6.h>
|
|
|
|
#include <asm/byteorder.h>
|
|
#include <linux/uaccess.h>
|
|
|
|
DEFINE_RATELIMIT_STATE(net_ratelimit_state, 5 * HZ, 10);
|
|
/*
|
|
* All net warning printk()s should be guarded by this function.
|
|
*/
|
|
int net_ratelimit(void)
|
|
{
|
|
return __ratelimit(&net_ratelimit_state);
|
|
}
|
|
EXPORT_SYMBOL(net_ratelimit);
|
|
|
|
/*
|
|
* Convert an ASCII string to binary IP.
|
|
* This is outside of net/ipv4/ because various code that uses IP addresses
|
|
* is otherwise not dependent on the TCP/IP stack.
|
|
*/
|
|
|
|
__be32 in_aton(const char *str)
|
|
{
|
|
unsigned int l;
|
|
unsigned int val;
|
|
int i;
|
|
|
|
l = 0;
|
|
for (i = 0; i < 4; i++) {
|
|
l <<= 8;
|
|
if (*str != '\0') {
|
|
val = 0;
|
|
while (*str != '\0' && *str != '.' && *str != '\n') {
|
|
val *= 10;
|
|
val += *str - '0';
|
|
str++;
|
|
}
|
|
l |= val;
|
|
if (*str != '\0')
|
|
str++;
|
|
}
|
|
}
|
|
return htonl(l);
|
|
}
|
|
EXPORT_SYMBOL(in_aton);
|
|
|
|
#define IN6PTON_XDIGIT 0x00010000
|
|
#define IN6PTON_DIGIT 0x00020000
|
|
#define IN6PTON_COLON_MASK 0x00700000
|
|
#define IN6PTON_COLON_1 0x00100000 /* single : requested */
|
|
#define IN6PTON_COLON_2 0x00200000 /* second : requested */
|
|
#define IN6PTON_COLON_1_2 0x00400000 /* :: requested */
|
|
#define IN6PTON_DOT 0x00800000 /* . */
|
|
#define IN6PTON_DELIM 0x10000000
|
|
#define IN6PTON_NULL 0x20000000 /* first/tail */
|
|
#define IN6PTON_UNKNOWN 0x40000000
|
|
|
|
static inline int xdigit2bin(char c, int delim)
|
|
{
|
|
int val;
|
|
|
|
if (c == delim || c == '\0')
|
|
return IN6PTON_DELIM;
|
|
if (c == ':')
|
|
return IN6PTON_COLON_MASK;
|
|
if (c == '.')
|
|
return IN6PTON_DOT;
|
|
|
|
val = hex_to_bin(c);
|
|
if (val >= 0)
|
|
return val | IN6PTON_XDIGIT | (val < 10 ? IN6PTON_DIGIT : 0);
|
|
|
|
if (delim == -1)
|
|
return IN6PTON_DELIM;
|
|
return IN6PTON_UNKNOWN;
|
|
}
|
|
|
|
/**
|
|
* in4_pton - convert an IPv4 address from literal to binary representation
|
|
* @src: the start of the IPv4 address string
|
|
* @srclen: the length of the string, -1 means strlen(src)
|
|
* @dst: the binary (u8[4] array) representation of the IPv4 address
|
|
* @delim: the delimiter of the IPv4 address in @src, -1 means no delimiter
|
|
* @end: A pointer to the end of the parsed string will be placed here
|
|
*
|
|
* Return one on success, return zero when any error occurs
|
|
* and @end will point to the end of the parsed string.
|
|
*
|
|
*/
|
|
int in4_pton(const char *src, int srclen,
|
|
u8 *dst,
|
|
int delim, const char **end)
|
|
{
|
|
const char *s;
|
|
u8 *d;
|
|
u8 dbuf[4];
|
|
int ret = 0;
|
|
int i;
|
|
int w = 0;
|
|
|
|
if (srclen < 0)
|
|
srclen = strlen(src);
|
|
s = src;
|
|
d = dbuf;
|
|
i = 0;
|
|
while (1) {
|
|
int c;
|
|
c = xdigit2bin(srclen > 0 ? *s : '\0', delim);
|
|
if (!(c & (IN6PTON_DIGIT | IN6PTON_DOT | IN6PTON_DELIM | IN6PTON_COLON_MASK))) {
|
|
goto out;
|
|
}
|
|
if (c & (IN6PTON_DOT | IN6PTON_DELIM | IN6PTON_COLON_MASK)) {
|
|
if (w == 0)
|
|
goto out;
|
|
*d++ = w & 0xff;
|
|
w = 0;
|
|
i++;
|
|
if (c & (IN6PTON_DELIM | IN6PTON_COLON_MASK)) {
|
|
if (i != 4)
|
|
goto out;
|
|
break;
|
|
}
|
|
goto cont;
|
|
}
|
|
w = (w * 10) + c;
|
|
if ((w & 0xffff) > 255) {
|
|
goto out;
|
|
}
|
|
cont:
|
|
if (i >= 4)
|
|
goto out;
|
|
s++;
|
|
srclen--;
|
|
}
|
|
ret = 1;
|
|
memcpy(dst, dbuf, sizeof(dbuf));
|
|
out:
|
|
if (end)
|
|
*end = s;
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL(in4_pton);
|
|
|
|
/**
|
|
* in6_pton - convert an IPv6 address from literal to binary representation
|
|
* @src: the start of the IPv6 address string
|
|
* @srclen: the length of the string, -1 means strlen(src)
|
|
* @dst: the binary (u8[16] array) representation of the IPv6 address
|
|
* @delim: the delimiter of the IPv6 address in @src, -1 means no delimiter
|
|
* @end: A pointer to the end of the parsed string will be placed here
|
|
*
|
|
* Return one on success, return zero when any error occurs
|
|
* and @end will point to the end of the parsed string.
|
|
*
|
|
*/
|
|
int in6_pton(const char *src, int srclen,
|
|
u8 *dst,
|
|
int delim, const char **end)
|
|
{
|
|
const char *s, *tok = NULL;
|
|
u8 *d, *dc = NULL;
|
|
u8 dbuf[16];
|
|
int ret = 0;
|
|
int i;
|
|
int state = IN6PTON_COLON_1_2 | IN6PTON_XDIGIT | IN6PTON_NULL;
|
|
int w = 0;
|
|
|
|
memset(dbuf, 0, sizeof(dbuf));
|
|
|
|
s = src;
|
|
d = dbuf;
|
|
if (srclen < 0)
|
|
srclen = strlen(src);
|
|
|
|
while (1) {
|
|
int c;
|
|
|
|
c = xdigit2bin(srclen > 0 ? *s : '\0', delim);
|
|
if (!(c & state))
|
|
goto out;
|
|
if (c & (IN6PTON_DELIM | IN6PTON_COLON_MASK)) {
|
|
/* process one 16-bit word */
|
|
if (!(state & IN6PTON_NULL)) {
|
|
*d++ = (w >> 8) & 0xff;
|
|
*d++ = w & 0xff;
|
|
}
|
|
w = 0;
|
|
if (c & IN6PTON_DELIM) {
|
|
/* We've processed last word */
|
|
break;
|
|
}
|
|
/*
|
|
* COLON_1 => XDIGIT
|
|
* COLON_2 => XDIGIT|DELIM
|
|
* COLON_1_2 => COLON_2
|
|
*/
|
|
switch (state & IN6PTON_COLON_MASK) {
|
|
case IN6PTON_COLON_2:
|
|
dc = d;
|
|
state = IN6PTON_XDIGIT | IN6PTON_DELIM;
|
|
if (dc - dbuf >= sizeof(dbuf))
|
|
state |= IN6PTON_NULL;
|
|
break;
|
|
case IN6PTON_COLON_1|IN6PTON_COLON_1_2:
|
|
state = IN6PTON_XDIGIT | IN6PTON_COLON_2;
|
|
break;
|
|
case IN6PTON_COLON_1:
|
|
state = IN6PTON_XDIGIT;
|
|
break;
|
|
case IN6PTON_COLON_1_2:
|
|
state = IN6PTON_COLON_2;
|
|
break;
|
|
default:
|
|
state = 0;
|
|
}
|
|
tok = s + 1;
|
|
goto cont;
|
|
}
|
|
|
|
if (c & IN6PTON_DOT) {
|
|
ret = in4_pton(tok ? tok : s, srclen + (int)(s - tok), d, delim, &s);
|
|
if (ret > 0) {
|
|
d += 4;
|
|
break;
|
|
}
|
|
goto out;
|
|
}
|
|
|
|
w = (w << 4) | (0xff & c);
|
|
state = IN6PTON_COLON_1 | IN6PTON_DELIM;
|
|
if (!(w & 0xf000)) {
|
|
state |= IN6PTON_XDIGIT;
|
|
}
|
|
if (!dc && d + 2 < dbuf + sizeof(dbuf)) {
|
|
state |= IN6PTON_COLON_1_2;
|
|
state &= ~IN6PTON_DELIM;
|
|
}
|
|
if (d + 2 >= dbuf + sizeof(dbuf)) {
|
|
state &= ~(IN6PTON_COLON_1|IN6PTON_COLON_1_2);
|
|
}
|
|
cont:
|
|
if ((dc && d + 4 < dbuf + sizeof(dbuf)) ||
|
|
d + 4 == dbuf + sizeof(dbuf)) {
|
|
state |= IN6PTON_DOT;
|
|
}
|
|
if (d >= dbuf + sizeof(dbuf)) {
|
|
state &= ~(IN6PTON_XDIGIT|IN6PTON_COLON_MASK);
|
|
}
|
|
s++;
|
|
srclen--;
|
|
}
|
|
|
|
i = 15; d--;
|
|
|
|
if (dc) {
|
|
while (d >= dc)
|
|
dst[i--] = *d--;
|
|
while (i >= dc - dbuf)
|
|
dst[i--] = 0;
|
|
while (i >= 0)
|
|
dst[i--] = *d--;
|
|
} else
|
|
memcpy(dst, dbuf, sizeof(dbuf));
|
|
|
|
ret = 1;
|
|
out:
|
|
if (end)
|
|
*end = s;
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL(in6_pton);
|
|
|
|
static int inet4_pton(const char *src, u16 port_num,
|
|
struct sockaddr_storage *addr)
|
|
{
|
|
struct sockaddr_in *addr4 = (struct sockaddr_in *)addr;
|
|
size_t srclen = strlen(src);
|
|
|
|
if (srclen > INET_ADDRSTRLEN)
|
|
return -EINVAL;
|
|
|
|
if (in4_pton(src, srclen, (u8 *)&addr4->sin_addr.s_addr,
|
|
'\n', NULL) == 0)
|
|
return -EINVAL;
|
|
|
|
addr4->sin_family = AF_INET;
|
|
addr4->sin_port = htons(port_num);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int inet6_pton(struct net *net, const char *src, u16 port_num,
|
|
struct sockaddr_storage *addr)
|
|
{
|
|
struct sockaddr_in6 *addr6 = (struct sockaddr_in6 *)addr;
|
|
const char *scope_delim;
|
|
size_t srclen = strlen(src);
|
|
|
|
if (srclen > INET6_ADDRSTRLEN)
|
|
return -EINVAL;
|
|
|
|
if (in6_pton(src, srclen, (u8 *)&addr6->sin6_addr.s6_addr,
|
|
'%', &scope_delim) == 0)
|
|
return -EINVAL;
|
|
|
|
if (ipv6_addr_type(&addr6->sin6_addr) & IPV6_ADDR_LINKLOCAL &&
|
|
src + srclen != scope_delim && *scope_delim == '%') {
|
|
struct net_device *dev;
|
|
char scope_id[16];
|
|
size_t scope_len = min_t(size_t, sizeof(scope_id) - 1,
|
|
src + srclen - scope_delim - 1);
|
|
|
|
memcpy(scope_id, scope_delim + 1, scope_len);
|
|
scope_id[scope_len] = '\0';
|
|
|
|
dev = dev_get_by_name(net, scope_id);
|
|
if (dev) {
|
|
addr6->sin6_scope_id = dev->ifindex;
|
|
dev_put(dev);
|
|
} else if (kstrtouint(scope_id, 0, &addr6->sin6_scope_id)) {
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
addr6->sin6_family = AF_INET6;
|
|
addr6->sin6_port = htons(port_num);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* inet_pton_with_scope - convert an IPv4/IPv6 and port to socket address
|
|
* @net: net namespace (used for scope handling)
|
|
* @af: address family, AF_INET, AF_INET6 or AF_UNSPEC for either
|
|
* @src: the start of the address string
|
|
* @port: the start of the port string (or NULL for none)
|
|
* @addr: output socket address
|
|
*
|
|
* Return zero on success, return errno when any error occurs.
|
|
*/
|
|
int inet_pton_with_scope(struct net *net, __kernel_sa_family_t af,
|
|
const char *src, const char *port, struct sockaddr_storage *addr)
|
|
{
|
|
u16 port_num;
|
|
int ret = -EINVAL;
|
|
|
|
if (port) {
|
|
if (kstrtou16(port, 0, &port_num))
|
|
return -EINVAL;
|
|
} else {
|
|
port_num = 0;
|
|
}
|
|
|
|
switch (af) {
|
|
case AF_INET:
|
|
ret = inet4_pton(src, port_num, addr);
|
|
break;
|
|
case AF_INET6:
|
|
ret = inet6_pton(net, src, port_num, addr);
|
|
break;
|
|
case AF_UNSPEC:
|
|
ret = inet4_pton(src, port_num, addr);
|
|
if (ret)
|
|
ret = inet6_pton(net, src, port_num, addr);
|
|
break;
|
|
default:
|
|
pr_err("unexpected address family %d\n", af);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL(inet_pton_with_scope);
|
|
|
|
bool inet_addr_is_any(struct sockaddr *addr)
|
|
{
|
|
if (addr->sa_family == AF_INET6) {
|
|
struct sockaddr_in6 *in6 = (struct sockaddr_in6 *)addr;
|
|
const struct sockaddr_in6 in6_any =
|
|
{ .sin6_addr = IN6ADDR_ANY_INIT };
|
|
|
|
if (!memcmp(in6->sin6_addr.s6_addr,
|
|
in6_any.sin6_addr.s6_addr, 16))
|
|
return true;
|
|
} else if (addr->sa_family == AF_INET) {
|
|
struct sockaddr_in *in = (struct sockaddr_in *)addr;
|
|
|
|
if (in->sin_addr.s_addr == htonl(INADDR_ANY))
|
|
return true;
|
|
} else {
|
|
pr_warn("unexpected address family %u\n", addr->sa_family);
|
|
}
|
|
|
|
return false;
|
|
}
|
|
EXPORT_SYMBOL(inet_addr_is_any);
|
|
|
|
void inet_proto_csum_replace4(__sum16 *sum, struct sk_buff *skb,
|
|
__be32 from, __be32 to, bool pseudohdr)
|
|
{
|
|
if (skb->ip_summed != CHECKSUM_PARTIAL) {
|
|
csum_replace4(sum, from, to);
|
|
if (skb->ip_summed == CHECKSUM_COMPLETE && pseudohdr)
|
|
skb->csum = ~csum_add(csum_sub(~(skb->csum),
|
|
(__force __wsum)from),
|
|
(__force __wsum)to);
|
|
} else if (pseudohdr)
|
|
*sum = ~csum_fold(csum_add(csum_sub(csum_unfold(*sum),
|
|
(__force __wsum)from),
|
|
(__force __wsum)to));
|
|
}
|
|
EXPORT_SYMBOL(inet_proto_csum_replace4);
|
|
|
|
/**
|
|
* inet_proto_csum_replace16 - update layer 4 header checksum field
|
|
* @sum: Layer 4 header checksum field
|
|
* @skb: sk_buff for the packet
|
|
* @from: old IPv6 address
|
|
* @to: new IPv6 address
|
|
* @pseudohdr: True if layer 4 header checksum includes pseudoheader
|
|
*
|
|
* Update layer 4 header as per the update in IPv6 src/dst address.
|
|
*
|
|
* There is no need to update skb->csum in this function, because update in two
|
|
* fields a.) IPv6 src/dst address and b.) L4 header checksum cancels each other
|
|
* for skb->csum calculation. Whereas inet_proto_csum_replace4 function needs to
|
|
* update skb->csum, because update in 3 fields a.) IPv4 src/dst address,
|
|
* b.) IPv4 Header checksum and c.) L4 header checksum results in same diff as
|
|
* L4 Header checksum for skb->csum calculation.
|
|
*/
|
|
void inet_proto_csum_replace16(__sum16 *sum, struct sk_buff *skb,
|
|
const __be32 *from, const __be32 *to,
|
|
bool pseudohdr)
|
|
{
|
|
__be32 diff[] = {
|
|
~from[0], ~from[1], ~from[2], ~from[3],
|
|
to[0], to[1], to[2], to[3],
|
|
};
|
|
if (skb->ip_summed != CHECKSUM_PARTIAL) {
|
|
*sum = csum_fold(csum_partial(diff, sizeof(diff),
|
|
~csum_unfold(*sum)));
|
|
} else if (pseudohdr)
|
|
*sum = ~csum_fold(csum_partial(diff, sizeof(diff),
|
|
csum_unfold(*sum)));
|
|
}
|
|
EXPORT_SYMBOL(inet_proto_csum_replace16);
|
|
|
|
void inet_proto_csum_replace_by_diff(__sum16 *sum, struct sk_buff *skb,
|
|
__wsum diff, bool pseudohdr)
|
|
{
|
|
if (skb->ip_summed != CHECKSUM_PARTIAL) {
|
|
csum_replace_by_diff(sum, diff);
|
|
if (skb->ip_summed == CHECKSUM_COMPLETE && pseudohdr)
|
|
skb->csum = ~csum_sub(diff, skb->csum);
|
|
} else if (pseudohdr) {
|
|
*sum = ~csum_fold(csum_add(diff, csum_unfold(*sum)));
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(inet_proto_csum_replace_by_diff);
|