162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright 2009, Oracle.  All rights reserved.
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Convert socket addresses to presentation addresses and universal
662306a36Sopenharmony_ci * addresses, and vice versa.
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * Universal addresses are introduced by RFC 1833 and further refined by
962306a36Sopenharmony_ci * recent RFCs describing NFSv4.  The universal address format is part
1062306a36Sopenharmony_ci * of the external (network) interface provided by rpcbind version 3
1162306a36Sopenharmony_ci * and 4, and by NFSv4.  Such an address is a string containing a
1262306a36Sopenharmony_ci * presentation format IP address followed by a port number in
1362306a36Sopenharmony_ci * "hibyte.lobyte" format.
1462306a36Sopenharmony_ci *
1562306a36Sopenharmony_ci * IPv6 addresses can also include a scope ID, typically denoted by
1662306a36Sopenharmony_ci * a '%' followed by a device name or a non-negative integer.  Refer to
1762306a36Sopenharmony_ci * RFC 4291, Section 2.2 for details on IPv6 presentation formats.
1862306a36Sopenharmony_ci */
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci#include <net/ipv6.h>
2162306a36Sopenharmony_ci#include <linux/sunrpc/addr.h>
2262306a36Sopenharmony_ci#include <linux/sunrpc/msg_prot.h>
2362306a36Sopenharmony_ci#include <linux/slab.h>
2462306a36Sopenharmony_ci#include <linux/export.h>
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6)
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_cistatic size_t rpc_ntop6_noscopeid(const struct sockaddr *sap,
2962306a36Sopenharmony_ci				  char *buf, const int buflen)
3062306a36Sopenharmony_ci{
3162306a36Sopenharmony_ci	const struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)sap;
3262306a36Sopenharmony_ci	const struct in6_addr *addr = &sin6->sin6_addr;
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci	/*
3562306a36Sopenharmony_ci	 * RFC 4291, Section 2.2.2
3662306a36Sopenharmony_ci	 *
3762306a36Sopenharmony_ci	 * Shorthanded ANY address
3862306a36Sopenharmony_ci	 */
3962306a36Sopenharmony_ci	if (ipv6_addr_any(addr))
4062306a36Sopenharmony_ci		return snprintf(buf, buflen, "::");
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci	/*
4362306a36Sopenharmony_ci	 * RFC 4291, Section 2.2.2
4462306a36Sopenharmony_ci	 *
4562306a36Sopenharmony_ci	 * Shorthanded loopback address
4662306a36Sopenharmony_ci	 */
4762306a36Sopenharmony_ci	if (ipv6_addr_loopback(addr))
4862306a36Sopenharmony_ci		return snprintf(buf, buflen, "::1");
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ci	/*
5162306a36Sopenharmony_ci	 * RFC 4291, Section 2.2.3
5262306a36Sopenharmony_ci	 *
5362306a36Sopenharmony_ci	 * Special presentation address format for mapped v4
5462306a36Sopenharmony_ci	 * addresses.
5562306a36Sopenharmony_ci	 */
5662306a36Sopenharmony_ci	if (ipv6_addr_v4mapped(addr))
5762306a36Sopenharmony_ci		return snprintf(buf, buflen, "::ffff:%pI4",
5862306a36Sopenharmony_ci					&addr->s6_addr32[3]);
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_ci	/*
6162306a36Sopenharmony_ci	 * RFC 4291, Section 2.2.1
6262306a36Sopenharmony_ci	 */
6362306a36Sopenharmony_ci	return snprintf(buf, buflen, "%pI6c", addr);
6462306a36Sopenharmony_ci}
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_cistatic size_t rpc_ntop6(const struct sockaddr *sap,
6762306a36Sopenharmony_ci			char *buf, const size_t buflen)
6862306a36Sopenharmony_ci{
6962306a36Sopenharmony_ci	const struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)sap;
7062306a36Sopenharmony_ci	char scopebuf[IPV6_SCOPE_ID_LEN];
7162306a36Sopenharmony_ci	size_t len;
7262306a36Sopenharmony_ci	int rc;
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_ci	len = rpc_ntop6_noscopeid(sap, buf, buflen);
7562306a36Sopenharmony_ci	if (unlikely(len == 0))
7662306a36Sopenharmony_ci		return len;
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_ci	if (!(ipv6_addr_type(&sin6->sin6_addr) & IPV6_ADDR_LINKLOCAL))
7962306a36Sopenharmony_ci		return len;
8062306a36Sopenharmony_ci	if (sin6->sin6_scope_id == 0)
8162306a36Sopenharmony_ci		return len;
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci	rc = snprintf(scopebuf, sizeof(scopebuf), "%c%u",
8462306a36Sopenharmony_ci			IPV6_SCOPE_DELIMITER, sin6->sin6_scope_id);
8562306a36Sopenharmony_ci	if (unlikely((size_t)rc >= sizeof(scopebuf)))
8662306a36Sopenharmony_ci		return 0;
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci	len += rc;
8962306a36Sopenharmony_ci	if (unlikely(len >= buflen))
9062306a36Sopenharmony_ci		return 0;
9162306a36Sopenharmony_ci
9262306a36Sopenharmony_ci	strcat(buf, scopebuf);
9362306a36Sopenharmony_ci	return len;
9462306a36Sopenharmony_ci}
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_ci#else	/* !IS_ENABLED(CONFIG_IPV6) */
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_cistatic size_t rpc_ntop6_noscopeid(const struct sockaddr *sap,
9962306a36Sopenharmony_ci				  char *buf, const int buflen)
10062306a36Sopenharmony_ci{
10162306a36Sopenharmony_ci	return 0;
10262306a36Sopenharmony_ci}
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_cistatic size_t rpc_ntop6(const struct sockaddr *sap,
10562306a36Sopenharmony_ci			char *buf, const size_t buflen)
10662306a36Sopenharmony_ci{
10762306a36Sopenharmony_ci	return 0;
10862306a36Sopenharmony_ci}
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci#endif	/* !IS_ENABLED(CONFIG_IPV6) */
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_cistatic int rpc_ntop4(const struct sockaddr *sap,
11362306a36Sopenharmony_ci		     char *buf, const size_t buflen)
11462306a36Sopenharmony_ci{
11562306a36Sopenharmony_ci	const struct sockaddr_in *sin = (struct sockaddr_in *)sap;
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci	return snprintf(buf, buflen, "%pI4", &sin->sin_addr);
11862306a36Sopenharmony_ci}
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci/**
12162306a36Sopenharmony_ci * rpc_ntop - construct a presentation address in @buf
12262306a36Sopenharmony_ci * @sap: socket address
12362306a36Sopenharmony_ci * @buf: construction area
12462306a36Sopenharmony_ci * @buflen: size of @buf, in bytes
12562306a36Sopenharmony_ci *
12662306a36Sopenharmony_ci * Plants a %NUL-terminated string in @buf and returns the length
12762306a36Sopenharmony_ci * of the string, excluding the %NUL.  Otherwise zero is returned.
12862306a36Sopenharmony_ci */
12962306a36Sopenharmony_cisize_t rpc_ntop(const struct sockaddr *sap, char *buf, const size_t buflen)
13062306a36Sopenharmony_ci{
13162306a36Sopenharmony_ci	switch (sap->sa_family) {
13262306a36Sopenharmony_ci	case AF_INET:
13362306a36Sopenharmony_ci		return rpc_ntop4(sap, buf, buflen);
13462306a36Sopenharmony_ci	case AF_INET6:
13562306a36Sopenharmony_ci		return rpc_ntop6(sap, buf, buflen);
13662306a36Sopenharmony_ci	}
13762306a36Sopenharmony_ci
13862306a36Sopenharmony_ci	return 0;
13962306a36Sopenharmony_ci}
14062306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(rpc_ntop);
14162306a36Sopenharmony_ci
14262306a36Sopenharmony_cistatic size_t rpc_pton4(const char *buf, const size_t buflen,
14362306a36Sopenharmony_ci			struct sockaddr *sap, const size_t salen)
14462306a36Sopenharmony_ci{
14562306a36Sopenharmony_ci	struct sockaddr_in *sin = (struct sockaddr_in *)sap;
14662306a36Sopenharmony_ci	u8 *addr = (u8 *)&sin->sin_addr.s_addr;
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_ci	if (buflen > INET_ADDRSTRLEN || salen < sizeof(struct sockaddr_in))
14962306a36Sopenharmony_ci		return 0;
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci	memset(sap, 0, sizeof(struct sockaddr_in));
15262306a36Sopenharmony_ci
15362306a36Sopenharmony_ci	if (in4_pton(buf, buflen, addr, '\0', NULL) == 0)
15462306a36Sopenharmony_ci		return 0;
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci	sin->sin_family = AF_INET;
15762306a36Sopenharmony_ci	return sizeof(struct sockaddr_in);
15862306a36Sopenharmony_ci}
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6)
16162306a36Sopenharmony_cistatic int rpc_parse_scope_id(struct net *net, const char *buf,
16262306a36Sopenharmony_ci			      const size_t buflen, const char *delim,
16362306a36Sopenharmony_ci			      struct sockaddr_in6 *sin6)
16462306a36Sopenharmony_ci{
16562306a36Sopenharmony_ci	char p[IPV6_SCOPE_ID_LEN + 1];
16662306a36Sopenharmony_ci	size_t len;
16762306a36Sopenharmony_ci	u32 scope_id = 0;
16862306a36Sopenharmony_ci	struct net_device *dev;
16962306a36Sopenharmony_ci
17062306a36Sopenharmony_ci	if ((buf + buflen) == delim)
17162306a36Sopenharmony_ci		return 1;
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	if (*delim != IPV6_SCOPE_DELIMITER)
17462306a36Sopenharmony_ci		return 0;
17562306a36Sopenharmony_ci
17662306a36Sopenharmony_ci	if (!(ipv6_addr_type(&sin6->sin6_addr) & IPV6_ADDR_LINKLOCAL))
17762306a36Sopenharmony_ci		return 0;
17862306a36Sopenharmony_ci
17962306a36Sopenharmony_ci	len = (buf + buflen) - delim - 1;
18062306a36Sopenharmony_ci	if (len > IPV6_SCOPE_ID_LEN)
18162306a36Sopenharmony_ci		return 0;
18262306a36Sopenharmony_ci
18362306a36Sopenharmony_ci	memcpy(p, delim + 1, len);
18462306a36Sopenharmony_ci	p[len] = 0;
18562306a36Sopenharmony_ci
18662306a36Sopenharmony_ci	dev = dev_get_by_name(net, p);
18762306a36Sopenharmony_ci	if (dev != NULL) {
18862306a36Sopenharmony_ci		scope_id = dev->ifindex;
18962306a36Sopenharmony_ci		dev_put(dev);
19062306a36Sopenharmony_ci	} else {
19162306a36Sopenharmony_ci		if (kstrtou32(p, 10, &scope_id) != 0)
19262306a36Sopenharmony_ci			return 0;
19362306a36Sopenharmony_ci	}
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_ci	sin6->sin6_scope_id = scope_id;
19662306a36Sopenharmony_ci	return 1;
19762306a36Sopenharmony_ci}
19862306a36Sopenharmony_ci
19962306a36Sopenharmony_cistatic size_t rpc_pton6(struct net *net, const char *buf, const size_t buflen,
20062306a36Sopenharmony_ci			struct sockaddr *sap, const size_t salen)
20162306a36Sopenharmony_ci{
20262306a36Sopenharmony_ci	struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)sap;
20362306a36Sopenharmony_ci	u8 *addr = (u8 *)&sin6->sin6_addr.in6_u;
20462306a36Sopenharmony_ci	const char *delim;
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_ci	if (buflen > (INET6_ADDRSTRLEN + IPV6_SCOPE_ID_LEN) ||
20762306a36Sopenharmony_ci	    salen < sizeof(struct sockaddr_in6))
20862306a36Sopenharmony_ci		return 0;
20962306a36Sopenharmony_ci
21062306a36Sopenharmony_ci	memset(sap, 0, sizeof(struct sockaddr_in6));
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_ci	if (in6_pton(buf, buflen, addr, IPV6_SCOPE_DELIMITER, &delim) == 0)
21362306a36Sopenharmony_ci		return 0;
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	if (!rpc_parse_scope_id(net, buf, buflen, delim, sin6))
21662306a36Sopenharmony_ci		return 0;
21762306a36Sopenharmony_ci
21862306a36Sopenharmony_ci	sin6->sin6_family = AF_INET6;
21962306a36Sopenharmony_ci	return sizeof(struct sockaddr_in6);
22062306a36Sopenharmony_ci}
22162306a36Sopenharmony_ci#else
22262306a36Sopenharmony_cistatic size_t rpc_pton6(struct net *net, const char *buf, const size_t buflen,
22362306a36Sopenharmony_ci			struct sockaddr *sap, const size_t salen)
22462306a36Sopenharmony_ci{
22562306a36Sopenharmony_ci	return 0;
22662306a36Sopenharmony_ci}
22762306a36Sopenharmony_ci#endif
22862306a36Sopenharmony_ci
22962306a36Sopenharmony_ci/**
23062306a36Sopenharmony_ci * rpc_pton - Construct a sockaddr in @sap
23162306a36Sopenharmony_ci * @net: applicable network namespace
23262306a36Sopenharmony_ci * @buf: C string containing presentation format IP address
23362306a36Sopenharmony_ci * @buflen: length of presentation address in bytes
23462306a36Sopenharmony_ci * @sap: buffer into which to plant socket address
23562306a36Sopenharmony_ci * @salen: size of buffer in bytes
23662306a36Sopenharmony_ci *
23762306a36Sopenharmony_ci * Returns the size of the socket address if successful; otherwise
23862306a36Sopenharmony_ci * zero is returned.
23962306a36Sopenharmony_ci *
24062306a36Sopenharmony_ci * Plants a socket address in @sap and returns the size of the
24162306a36Sopenharmony_ci * socket address, if successful.  Returns zero if an error
24262306a36Sopenharmony_ci * occurred.
24362306a36Sopenharmony_ci */
24462306a36Sopenharmony_cisize_t rpc_pton(struct net *net, const char *buf, const size_t buflen,
24562306a36Sopenharmony_ci		struct sockaddr *sap, const size_t salen)
24662306a36Sopenharmony_ci{
24762306a36Sopenharmony_ci	unsigned int i;
24862306a36Sopenharmony_ci
24962306a36Sopenharmony_ci	for (i = 0; i < buflen; i++)
25062306a36Sopenharmony_ci		if (buf[i] == ':')
25162306a36Sopenharmony_ci			return rpc_pton6(net, buf, buflen, sap, salen);
25262306a36Sopenharmony_ci	return rpc_pton4(buf, buflen, sap, salen);
25362306a36Sopenharmony_ci}
25462306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(rpc_pton);
25562306a36Sopenharmony_ci
25662306a36Sopenharmony_ci/**
25762306a36Sopenharmony_ci * rpc_sockaddr2uaddr - Construct a universal address string from @sap.
25862306a36Sopenharmony_ci * @sap: socket address
25962306a36Sopenharmony_ci * @gfp_flags: allocation mode
26062306a36Sopenharmony_ci *
26162306a36Sopenharmony_ci * Returns a %NUL-terminated string in dynamically allocated memory;
26262306a36Sopenharmony_ci * otherwise NULL is returned if an error occurred.  Caller must
26362306a36Sopenharmony_ci * free the returned string.
26462306a36Sopenharmony_ci */
26562306a36Sopenharmony_cichar *rpc_sockaddr2uaddr(const struct sockaddr *sap, gfp_t gfp_flags)
26662306a36Sopenharmony_ci{
26762306a36Sopenharmony_ci	char portbuf[RPCBIND_MAXUADDRPLEN];
26862306a36Sopenharmony_ci	char addrbuf[RPCBIND_MAXUADDRLEN];
26962306a36Sopenharmony_ci	unsigned short port;
27062306a36Sopenharmony_ci
27162306a36Sopenharmony_ci	switch (sap->sa_family) {
27262306a36Sopenharmony_ci	case AF_INET:
27362306a36Sopenharmony_ci		if (rpc_ntop4(sap, addrbuf, sizeof(addrbuf)) == 0)
27462306a36Sopenharmony_ci			return NULL;
27562306a36Sopenharmony_ci		port = ntohs(((struct sockaddr_in *)sap)->sin_port);
27662306a36Sopenharmony_ci		break;
27762306a36Sopenharmony_ci	case AF_INET6:
27862306a36Sopenharmony_ci		if (rpc_ntop6_noscopeid(sap, addrbuf, sizeof(addrbuf)) == 0)
27962306a36Sopenharmony_ci			return NULL;
28062306a36Sopenharmony_ci		port = ntohs(((struct sockaddr_in6 *)sap)->sin6_port);
28162306a36Sopenharmony_ci		break;
28262306a36Sopenharmony_ci	default:
28362306a36Sopenharmony_ci		return NULL;
28462306a36Sopenharmony_ci	}
28562306a36Sopenharmony_ci
28662306a36Sopenharmony_ci	if (snprintf(portbuf, sizeof(portbuf),
28762306a36Sopenharmony_ci		     ".%u.%u", port >> 8, port & 0xff) >= (int)sizeof(portbuf))
28862306a36Sopenharmony_ci		return NULL;
28962306a36Sopenharmony_ci
29062306a36Sopenharmony_ci	if (strlcat(addrbuf, portbuf, sizeof(addrbuf)) >= sizeof(addrbuf))
29162306a36Sopenharmony_ci		return NULL;
29262306a36Sopenharmony_ci
29362306a36Sopenharmony_ci	return kstrdup(addrbuf, gfp_flags);
29462306a36Sopenharmony_ci}
29562306a36Sopenharmony_ci
29662306a36Sopenharmony_ci/**
29762306a36Sopenharmony_ci * rpc_uaddr2sockaddr - convert a universal address to a socket address.
29862306a36Sopenharmony_ci * @net: applicable network namespace
29962306a36Sopenharmony_ci * @uaddr: C string containing universal address to convert
30062306a36Sopenharmony_ci * @uaddr_len: length of universal address string
30162306a36Sopenharmony_ci * @sap: buffer into which to plant socket address
30262306a36Sopenharmony_ci * @salen: size of buffer
30362306a36Sopenharmony_ci *
30462306a36Sopenharmony_ci * @uaddr does not have to be '\0'-terminated, but kstrtou8() and
30562306a36Sopenharmony_ci * rpc_pton() require proper string termination to be successful.
30662306a36Sopenharmony_ci *
30762306a36Sopenharmony_ci * Returns the size of the socket address if successful; otherwise
30862306a36Sopenharmony_ci * zero is returned.
30962306a36Sopenharmony_ci */
31062306a36Sopenharmony_cisize_t rpc_uaddr2sockaddr(struct net *net, const char *uaddr,
31162306a36Sopenharmony_ci			  const size_t uaddr_len, struct sockaddr *sap,
31262306a36Sopenharmony_ci			  const size_t salen)
31362306a36Sopenharmony_ci{
31462306a36Sopenharmony_ci	char *c, buf[RPCBIND_MAXUADDRLEN + sizeof('\0')];
31562306a36Sopenharmony_ci	u8 portlo, porthi;
31662306a36Sopenharmony_ci	unsigned short port;
31762306a36Sopenharmony_ci
31862306a36Sopenharmony_ci	if (uaddr_len > RPCBIND_MAXUADDRLEN)
31962306a36Sopenharmony_ci		return 0;
32062306a36Sopenharmony_ci
32162306a36Sopenharmony_ci	memcpy(buf, uaddr, uaddr_len);
32262306a36Sopenharmony_ci
32362306a36Sopenharmony_ci	buf[uaddr_len] = '\0';
32462306a36Sopenharmony_ci	c = strrchr(buf, '.');
32562306a36Sopenharmony_ci	if (unlikely(c == NULL))
32662306a36Sopenharmony_ci		return 0;
32762306a36Sopenharmony_ci	if (unlikely(kstrtou8(c + 1, 10, &portlo) != 0))
32862306a36Sopenharmony_ci		return 0;
32962306a36Sopenharmony_ci
33062306a36Sopenharmony_ci	*c = '\0';
33162306a36Sopenharmony_ci	c = strrchr(buf, '.');
33262306a36Sopenharmony_ci	if (unlikely(c == NULL))
33362306a36Sopenharmony_ci		return 0;
33462306a36Sopenharmony_ci	if (unlikely(kstrtou8(c + 1, 10, &porthi) != 0))
33562306a36Sopenharmony_ci		return 0;
33662306a36Sopenharmony_ci
33762306a36Sopenharmony_ci	port = (unsigned short)((porthi << 8) | portlo);
33862306a36Sopenharmony_ci
33962306a36Sopenharmony_ci	*c = '\0';
34062306a36Sopenharmony_ci	if (rpc_pton(net, buf, strlen(buf), sap, salen) == 0)
34162306a36Sopenharmony_ci		return 0;
34262306a36Sopenharmony_ci
34362306a36Sopenharmony_ci	switch (sap->sa_family) {
34462306a36Sopenharmony_ci	case AF_INET:
34562306a36Sopenharmony_ci		((struct sockaddr_in *)sap)->sin_port = htons(port);
34662306a36Sopenharmony_ci		return sizeof(struct sockaddr_in);
34762306a36Sopenharmony_ci	case AF_INET6:
34862306a36Sopenharmony_ci		((struct sockaddr_in6 *)sap)->sin6_port = htons(port);
34962306a36Sopenharmony_ci		return sizeof(struct sockaddr_in6);
35062306a36Sopenharmony_ci	}
35162306a36Sopenharmony_ci
35262306a36Sopenharmony_ci	return 0;
35362306a36Sopenharmony_ci}
35462306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(rpc_uaddr2sockaddr);
355