| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 1 | /* | 
 | 2 |  * Copyright 2009, Oracle.  All rights reserved. | 
 | 3 |  * | 
 | 4 |  * Convert socket addresses to presentation addresses and universal | 
 | 5 |  * addresses, and vice versa. | 
 | 6 |  * | 
 | 7 |  * Universal addresses are introduced by RFC 1833 and further refined by | 
 | 8 |  * recent RFCs describing NFSv4.  The universal address format is part | 
 | 9 |  * of the external (network) interface provided by rpcbind version 3 | 
 | 10 |  * and 4, and by NFSv4.  Such an address is a string containing a | 
 | 11 |  * presentation format IP address followed by a port number in | 
 | 12 |  * "hibyte.lobyte" format. | 
 | 13 |  * | 
 | 14 |  * IPv6 addresses can also include a scope ID, typically denoted by | 
 | 15 |  * a '%' followed by a device name or a non-negative integer.  Refer to | 
 | 16 |  * RFC 4291, Section 2.2 for details on IPv6 presentation formats. | 
 | 17 |  */ | 
 | 18 |  | 
 | 19 | #include <net/ipv6.h> | 
 | 20 | #include <linux/sunrpc/clnt.h> | 
| Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 21 | #include <linux/slab.h> | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 22 |  | 
 | 23 | #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE) | 
 | 24 |  | 
 | 25 | static size_t rpc_ntop6_noscopeid(const struct sockaddr *sap, | 
 | 26 | 				  char *buf, const int buflen) | 
 | 27 | { | 
 | 28 | 	const struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)sap; | 
 | 29 | 	const struct in6_addr *addr = &sin6->sin6_addr; | 
 | 30 |  | 
 | 31 | 	/* | 
 | 32 | 	 * RFC 4291, Section 2.2.2 | 
 | 33 | 	 * | 
 | 34 | 	 * Shorthanded ANY address | 
 | 35 | 	 */ | 
 | 36 | 	if (ipv6_addr_any(addr)) | 
 | 37 | 		return snprintf(buf, buflen, "::"); | 
 | 38 |  | 
 | 39 | 	/* | 
 | 40 | 	 * RFC 4291, Section 2.2.2 | 
 | 41 | 	 * | 
 | 42 | 	 * Shorthanded loopback address | 
 | 43 | 	 */ | 
 | 44 | 	if (ipv6_addr_loopback(addr)) | 
 | 45 | 		return snprintf(buf, buflen, "::1"); | 
 | 46 |  | 
 | 47 | 	/* | 
 | 48 | 	 * RFC 4291, Section 2.2.3 | 
 | 49 | 	 * | 
 | 50 | 	 * Special presentation address format for mapped v4 | 
 | 51 | 	 * addresses. | 
 | 52 | 	 */ | 
 | 53 | 	if (ipv6_addr_v4mapped(addr)) | 
 | 54 | 		return snprintf(buf, buflen, "::ffff:%pI4", | 
 | 55 | 					&addr->s6_addr32[3]); | 
 | 56 |  | 
 | 57 | 	/* | 
 | 58 | 	 * RFC 4291, Section 2.2.1 | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 59 | 	 */ | 
| Chuck Lever | dd1fd90 | 2009-12-03 15:58:56 -0500 | [diff] [blame] | 60 | 	return snprintf(buf, buflen, "%pI6c", addr); | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 61 | } | 
 | 62 |  | 
 | 63 | static size_t rpc_ntop6(const struct sockaddr *sap, | 
 | 64 | 			char *buf, const size_t buflen) | 
 | 65 | { | 
 | 66 | 	const struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)sap; | 
 | 67 | 	char scopebuf[IPV6_SCOPE_ID_LEN]; | 
 | 68 | 	size_t len; | 
 | 69 | 	int rc; | 
 | 70 |  | 
 | 71 | 	len = rpc_ntop6_noscopeid(sap, buf, buflen); | 
 | 72 | 	if (unlikely(len == 0)) | 
 | 73 | 		return len; | 
 | 74 |  | 
| Chuck Lever | f1a89a1 | 2010-01-12 17:41:10 -0500 | [diff] [blame] | 75 | 	if (!(ipv6_addr_type(&sin6->sin6_addr) & IPV6_ADDR_LINKLOCAL)) | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 76 | 		return len; | 
| Chuck Lever | 7a88efe | 2010-01-12 17:41:20 -0500 | [diff] [blame] | 77 | 	if (sin6->sin6_scope_id == 0) | 
 | 78 | 		return len; | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 79 |  | 
 | 80 | 	rc = snprintf(scopebuf, sizeof(scopebuf), "%c%u", | 
 | 81 | 			IPV6_SCOPE_DELIMITER, sin6->sin6_scope_id); | 
 | 82 | 	if (unlikely((size_t)rc > sizeof(scopebuf))) | 
 | 83 | 		return 0; | 
 | 84 |  | 
 | 85 | 	len += rc; | 
 | 86 | 	if (unlikely(len > buflen)) | 
 | 87 | 		return 0; | 
 | 88 |  | 
 | 89 | 	strcat(buf, scopebuf); | 
 | 90 | 	return len; | 
 | 91 | } | 
 | 92 |  | 
 | 93 | #else	/* !(defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)) */ | 
 | 94 |  | 
 | 95 | static size_t rpc_ntop6_noscopeid(const struct sockaddr *sap, | 
 | 96 | 				  char *buf, const int buflen) | 
 | 97 | { | 
 | 98 | 	return 0; | 
 | 99 | } | 
 | 100 |  | 
 | 101 | static size_t rpc_ntop6(const struct sockaddr *sap, | 
 | 102 | 			char *buf, const size_t buflen) | 
 | 103 | { | 
 | 104 | 	return 0; | 
 | 105 | } | 
 | 106 |  | 
 | 107 | #endif	/* !(defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)) */ | 
 | 108 |  | 
 | 109 | static int rpc_ntop4(const struct sockaddr *sap, | 
 | 110 | 		     char *buf, const size_t buflen) | 
 | 111 | { | 
 | 112 | 	const struct sockaddr_in *sin = (struct sockaddr_in *)sap; | 
 | 113 |  | 
 | 114 | 	return snprintf(buf, buflen, "%pI4", &sin->sin_addr); | 
 | 115 | } | 
 | 116 |  | 
 | 117 | /** | 
 | 118 |  * rpc_ntop - construct a presentation address in @buf | 
 | 119 |  * @sap: socket address | 
 | 120 |  * @buf: construction area | 
 | 121 |  * @buflen: size of @buf, in bytes | 
 | 122 |  * | 
 | 123 |  * Plants a %NUL-terminated string in @buf and returns the length | 
 | 124 |  * of the string, excluding the %NUL.  Otherwise zero is returned. | 
 | 125 |  */ | 
 | 126 | size_t rpc_ntop(const struct sockaddr *sap, char *buf, const size_t buflen) | 
 | 127 | { | 
 | 128 | 	switch (sap->sa_family) { | 
 | 129 | 	case AF_INET: | 
 | 130 | 		return rpc_ntop4(sap, buf, buflen); | 
 | 131 | 	case AF_INET6: | 
 | 132 | 		return rpc_ntop6(sap, buf, buflen); | 
 | 133 | 	} | 
 | 134 |  | 
 | 135 | 	return 0; | 
 | 136 | } | 
 | 137 | EXPORT_SYMBOL_GPL(rpc_ntop); | 
 | 138 |  | 
 | 139 | static size_t rpc_pton4(const char *buf, const size_t buflen, | 
 | 140 | 			struct sockaddr *sap, const size_t salen) | 
 | 141 | { | 
 | 142 | 	struct sockaddr_in *sin = (struct sockaddr_in *)sap; | 
 | 143 | 	u8 *addr = (u8 *)&sin->sin_addr.s_addr; | 
 | 144 |  | 
 | 145 | 	if (buflen > INET_ADDRSTRLEN || salen < sizeof(struct sockaddr_in)) | 
 | 146 | 		return 0; | 
 | 147 |  | 
 | 148 | 	memset(sap, 0, sizeof(struct sockaddr_in)); | 
 | 149 |  | 
 | 150 | 	if (in4_pton(buf, buflen, addr, '\0', NULL) == 0) | 
 | 151 | 		return 0; | 
 | 152 |  | 
 | 153 | 	sin->sin_family = AF_INET; | 
 | 154 | 	return sizeof(struct sockaddr_in);; | 
 | 155 | } | 
 | 156 |  | 
 | 157 | #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE) | 
 | 158 | static int rpc_parse_scope_id(const char *buf, const size_t buflen, | 
 | 159 | 			      const char *delim, struct sockaddr_in6 *sin6) | 
 | 160 | { | 
 | 161 | 	char *p; | 
 | 162 | 	size_t len; | 
 | 163 |  | 
 | 164 | 	if ((buf + buflen) == delim) | 
 | 165 | 		return 1; | 
 | 166 |  | 
 | 167 | 	if (*delim != IPV6_SCOPE_DELIMITER) | 
 | 168 | 		return 0; | 
 | 169 |  | 
| Chuck Lever | f1a89a1 | 2010-01-12 17:41:10 -0500 | [diff] [blame] | 170 | 	if (!(ipv6_addr_type(&sin6->sin6_addr) & IPV6_ADDR_LINKLOCAL)) | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 171 | 		return 0; | 
 | 172 |  | 
 | 173 | 	len = (buf + buflen) - delim - 1; | 
 | 174 | 	p = kstrndup(delim + 1, len, GFP_KERNEL); | 
 | 175 | 	if (p) { | 
 | 176 | 		unsigned long scope_id = 0; | 
 | 177 | 		struct net_device *dev; | 
 | 178 |  | 
 | 179 | 		dev = dev_get_by_name(&init_net, p); | 
 | 180 | 		if (dev != NULL) { | 
 | 181 | 			scope_id = dev->ifindex; | 
 | 182 | 			dev_put(dev); | 
 | 183 | 		} else { | 
 | 184 | 			if (strict_strtoul(p, 10, &scope_id) == 0) { | 
 | 185 | 				kfree(p); | 
 | 186 | 				return 0; | 
 | 187 | 			} | 
 | 188 | 		} | 
 | 189 |  | 
 | 190 | 		kfree(p); | 
 | 191 |  | 
 | 192 | 		sin6->sin6_scope_id = scope_id; | 
 | 193 | 		return 1; | 
 | 194 | 	} | 
 | 195 |  | 
 | 196 | 	return 0; | 
 | 197 | } | 
 | 198 |  | 
 | 199 | static size_t rpc_pton6(const char *buf, const size_t buflen, | 
 | 200 | 			struct sockaddr *sap, const size_t salen) | 
 | 201 | { | 
 | 202 | 	struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)sap; | 
 | 203 | 	u8 *addr = (u8 *)&sin6->sin6_addr.in6_u; | 
 | 204 | 	const char *delim; | 
 | 205 |  | 
 | 206 | 	if (buflen > (INET6_ADDRSTRLEN + IPV6_SCOPE_ID_LEN) || | 
 | 207 | 	    salen < sizeof(struct sockaddr_in6)) | 
 | 208 | 		return 0; | 
 | 209 |  | 
 | 210 | 	memset(sap, 0, sizeof(struct sockaddr_in6)); | 
 | 211 |  | 
 | 212 | 	if (in6_pton(buf, buflen, addr, IPV6_SCOPE_DELIMITER, &delim) == 0) | 
 | 213 | 		return 0; | 
 | 214 |  | 
 | 215 | 	if (!rpc_parse_scope_id(buf, buflen, delim, sin6)) | 
 | 216 | 		return 0; | 
 | 217 |  | 
 | 218 | 	sin6->sin6_family = AF_INET6; | 
 | 219 | 	return sizeof(struct sockaddr_in6); | 
 | 220 | } | 
 | 221 | #else | 
 | 222 | static size_t rpc_pton6(const char *buf, const size_t buflen, | 
 | 223 | 			struct sockaddr *sap, const size_t salen) | 
 | 224 | { | 
 | 225 | 	return 0; | 
 | 226 | } | 
 | 227 | #endif | 
 | 228 |  | 
 | 229 | /** | 
 | 230 |  * rpc_pton - Construct a sockaddr in @sap | 
 | 231 |  * @buf: C string containing presentation format IP address | 
 | 232 |  * @buflen: length of presentation address in bytes | 
 | 233 |  * @sap: buffer into which to plant socket address | 
 | 234 |  * @salen: size of buffer in bytes | 
 | 235 |  * | 
 | 236 |  * Returns the size of the socket address if successful; otherwise | 
 | 237 |  * zero is returned. | 
 | 238 |  * | 
 | 239 |  * Plants a socket address in @sap and returns the size of the | 
 | 240 |  * socket address, if successful.  Returns zero if an error | 
 | 241 |  * occurred. | 
 | 242 |  */ | 
 | 243 | size_t rpc_pton(const char *buf, const size_t buflen, | 
 | 244 | 		struct sockaddr *sap, const size_t salen) | 
 | 245 | { | 
 | 246 | 	unsigned int i; | 
 | 247 |  | 
 | 248 | 	for (i = 0; i < buflen; i++) | 
 | 249 | 		if (buf[i] == ':') | 
 | 250 | 			return rpc_pton6(buf, buflen, sap, salen); | 
 | 251 | 	return rpc_pton4(buf, buflen, sap, salen); | 
 | 252 | } | 
 | 253 | EXPORT_SYMBOL_GPL(rpc_pton); | 
 | 254 |  | 
 | 255 | /** | 
 | 256 |  * rpc_sockaddr2uaddr - Construct a universal address string from @sap. | 
 | 257 |  * @sap: socket address | 
 | 258 |  * | 
 | 259 |  * Returns a %NUL-terminated string in dynamically allocated memory; | 
 | 260 |  * otherwise NULL is returned if an error occurred.  Caller must | 
 | 261 |  * free the returned string. | 
 | 262 |  */ | 
 | 263 | char *rpc_sockaddr2uaddr(const struct sockaddr *sap) | 
 | 264 | { | 
 | 265 | 	char portbuf[RPCBIND_MAXUADDRPLEN]; | 
 | 266 | 	char addrbuf[RPCBIND_MAXUADDRLEN]; | 
 | 267 | 	unsigned short port; | 
 | 268 |  | 
 | 269 | 	switch (sap->sa_family) { | 
 | 270 | 	case AF_INET: | 
 | 271 | 		if (rpc_ntop4(sap, addrbuf, sizeof(addrbuf)) == 0) | 
 | 272 | 			return NULL; | 
 | 273 | 		port = ntohs(((struct sockaddr_in *)sap)->sin_port); | 
 | 274 | 		break; | 
 | 275 | 	case AF_INET6: | 
 | 276 | 		if (rpc_ntop6_noscopeid(sap, addrbuf, sizeof(addrbuf)) == 0) | 
 | 277 | 			return NULL; | 
 | 278 | 		port = ntohs(((struct sockaddr_in6 *)sap)->sin6_port); | 
 | 279 | 		break; | 
 | 280 | 	default: | 
 | 281 | 		return NULL; | 
 | 282 | 	} | 
 | 283 |  | 
 | 284 | 	if (snprintf(portbuf, sizeof(portbuf), | 
 | 285 | 		     ".%u.%u", port >> 8, port & 0xff) > (int)sizeof(portbuf)) | 
 | 286 | 		return NULL; | 
 | 287 |  | 
 | 288 | 	if (strlcat(addrbuf, portbuf, sizeof(addrbuf)) > sizeof(addrbuf)) | 
 | 289 | 		return NULL; | 
 | 290 |  | 
 | 291 | 	return kstrdup(addrbuf, GFP_KERNEL); | 
 | 292 | } | 
 | 293 | EXPORT_SYMBOL_GPL(rpc_sockaddr2uaddr); | 
 | 294 |  | 
 | 295 | /** | 
 | 296 |  * rpc_uaddr2sockaddr - convert a universal address to a socket address. | 
 | 297 |  * @uaddr: C string containing universal address to convert | 
 | 298 |  * @uaddr_len: length of universal address string | 
 | 299 |  * @sap: buffer into which to plant socket address | 
 | 300 |  * @salen: size of buffer | 
 | 301 |  * | 
| Chuck Lever | 1e360a6 | 2009-11-13 10:52:55 -0500 | [diff] [blame] | 302 |  * @uaddr does not have to be '\0'-terminated, but strict_strtoul() and | 
 | 303 |  * rpc_pton() require proper string termination to be successful. | 
 | 304 |  * | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 305 |  * Returns the size of the socket address if successful; otherwise | 
 | 306 |  * zero is returned. | 
 | 307 |  */ | 
 | 308 | size_t rpc_uaddr2sockaddr(const char *uaddr, const size_t uaddr_len, | 
 | 309 | 			  struct sockaddr *sap, const size_t salen) | 
 | 310 | { | 
| Chuck Lever | 1e360a6 | 2009-11-13 10:52:55 -0500 | [diff] [blame] | 311 | 	char *c, buf[RPCBIND_MAXUADDRLEN + sizeof('\0')]; | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 312 | 	unsigned long portlo, porthi; | 
 | 313 | 	unsigned short port; | 
 | 314 |  | 
| Chuck Lever | 1e360a6 | 2009-11-13 10:52:55 -0500 | [diff] [blame] | 315 | 	if (uaddr_len > RPCBIND_MAXUADDRLEN) | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 316 | 		return 0; | 
 | 317 |  | 
 | 318 | 	memcpy(buf, uaddr, uaddr_len); | 
 | 319 |  | 
| Chuck Lever | 1e360a6 | 2009-11-13 10:52:55 -0500 | [diff] [blame] | 320 | 	buf[uaddr_len] = '\0'; | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 321 | 	c = strrchr(buf, '.'); | 
 | 322 | 	if (unlikely(c == NULL)) | 
 | 323 | 		return 0; | 
 | 324 | 	if (unlikely(strict_strtoul(c + 1, 10, &portlo) != 0)) | 
 | 325 | 		return 0; | 
 | 326 | 	if (unlikely(portlo > 255)) | 
 | 327 | 		return 0; | 
 | 328 |  | 
| Chuck Lever | 1e360a6 | 2009-11-13 10:52:55 -0500 | [diff] [blame] | 329 | 	*c = '\0'; | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 330 | 	c = strrchr(buf, '.'); | 
 | 331 | 	if (unlikely(c == NULL)) | 
 | 332 | 		return 0; | 
 | 333 | 	if (unlikely(strict_strtoul(c + 1, 10, &porthi) != 0)) | 
 | 334 | 		return 0; | 
 | 335 | 	if (unlikely(porthi > 255)) | 
 | 336 | 		return 0; | 
 | 337 |  | 
 | 338 | 	port = (unsigned short)((porthi << 8) | portlo); | 
 | 339 |  | 
| Chuck Lever | 1e360a6 | 2009-11-13 10:52:55 -0500 | [diff] [blame] | 340 | 	*c = '\0'; | 
| Chuck Lever | a02d692 | 2009-08-09 15:09:34 -0400 | [diff] [blame] | 341 | 	if (rpc_pton(buf, strlen(buf), sap, salen) == 0) | 
 | 342 | 		return 0; | 
 | 343 |  | 
 | 344 | 	switch (sap->sa_family) { | 
 | 345 | 	case AF_INET: | 
 | 346 | 		((struct sockaddr_in *)sap)->sin_port = htons(port); | 
 | 347 | 		return sizeof(struct sockaddr_in); | 
 | 348 | 	case AF_INET6: | 
 | 349 | 		((struct sockaddr_in6 *)sap)->sin6_port = htons(port); | 
 | 350 | 		return sizeof(struct sockaddr_in6); | 
 | 351 | 	} | 
 | 352 |  | 
 | 353 | 	return 0; | 
 | 354 | } | 
 | 355 | EXPORT_SYMBOL_GPL(rpc_uaddr2sockaddr); |