ping: support -I addr in family neutral manner; reuse a bit of common code

1 files changed, 30 insertions, 42 deletions

diff --git a/networking/ping.c b/networking/ping.c
index e765843..9bf3813 100644
--- a/networking/ping.c
+++ b/networking/ping.c
@@ -254,7 +254,7 @@ static union {
 	struct sockaddr_in6 sin6;
 #endif
 } pingaddr;
-static struct sockaddr_in sourceaddr;
+static len_and_sockaddr *source_lsa;
 static int pingsock = -1;
 static unsigned datalen; /* intentionally uninitialized to work around gcc bug */
 
@@ -561,9 +561,8 @@ static void ping4(len_and_sockaddr *lsa)
 
 	pingsock = create_icmp_socket();
 	pingaddr.sin = lsa->sin;
-	if (sourceaddr.sin_addr.s_addr) {
-		xbind(pingsock, (struct sockaddr*)&sourceaddr, sizeof(sourceaddr));
-	}
+	if (source_lsa)
+		xbind(pingsock, &lsa->sa, lsa->len);
 
 	/* enable broadcast pings */
 	setsockopt_broadcast(pingsock);
@@ -572,13 +571,6 @@ static void ping4(len_and_sockaddr *lsa)
 	sockopt = 48 * 1024; /* explain why 48k? */
 	setsockopt(pingsock, SOL_SOCKET, SO_RCVBUF, &sockopt, sizeof(sockopt));
 
-	printf("PING %s (%s)", hostname, dotted);
-	if (sourceaddr.sin_addr.s_addr) {
-		printf(" from %s",
-			inet_ntoa(*(struct in_addr *) &sourceaddr.sin_addr.s_addr));
-	}
-	printf(": %d data bytes\n", datalen);
-
 	signal(SIGINT, pingstats);
 
 	/* start the ping's going ... */
@@ -615,9 +607,9 @@ static void ping6(len_and_sockaddr *lsa)
 
 	pingsock = create_icmp6_socket();
 	pingaddr.sin6 = lsa->sin6;
-	//if (sourceaddr.sin_addr.s_addr) {
-	//	xbind(pingsock, (struct sockaddr*)&sourceaddr, sizeof(sourceaddr));
-	//}
+	/* untested whether "-I addr" really works for IPv6: */
+	if (source_lsa)
+		xbind(pingsock, &lsa->sa, lsa->len);
 
 #ifdef ICMP6_FILTER
 	{
@@ -652,8 +644,6 @@ static void ping6(len_and_sockaddr *lsa)
 	if (if_index)
 		pingaddr.sin6.sin6_scope_id = if_index;
 
-	printf("PING %s (%s): %d data bytes\n", hostname, dotted, datalen);
-
 	signal(SIGINT, pingstats);
 
 	/* start the ping's going ... */
@@ -695,25 +685,21 @@ static void ping6(len_and_sockaddr *lsa)
 }
 #endif
 
-/* TODO: consolidate ether-wake.c, dnsd.c, ifupdown.c, nslookup.c
- * versions of below thing. BTW we have far too many "%u.%u.%u.%u" too...
-*/
-static int parse_nipquad(const char *str, struct sockaddr_in* addr)
+static void ping(len_and_sockaddr *lsa)
 {
-	char dummy;
-	unsigned i1, i2, i3, i4;
-	if (sscanf(str, "%u.%u.%u.%u%c",
-			   &i1, &i2, &i3, &i4, &dummy) == 4
-	&& ( (i1|i2|i3|i4) <= 0xff )
-	) {
-		uint8_t* ptr = (uint8_t*)&addr->sin_addr;
-		ptr[0] = i1;
-		ptr[1] = i2;
-		ptr[2] = i3;
-		ptr[3] = i4;
-		return 0;
+	printf("PING %s (%s)", hostname, dotted);
+	if (source_lsa) {
+		printf(" from %s",
+			xmalloc_sockaddr2dotted_noport(&lsa->sa, lsa->len));
 	}
-	return 1; /* error */
+	printf(": %d data bytes\n", datalen);
+
+#if ENABLE_PING6
+	if (lsa->sa.sa_family == AF_INET6)
+		ping6(lsa);
+	else
+#endif
+		ping4(lsa);
 }
 
 int ping_main(int argc, char **argv);
@@ -732,9 +718,11 @@ int ping_main(int argc, char **argv)
 	if (option_mask32 & OPT_s) datalen = xatou16(opt_s); // -s
 	if (option_mask32 & OPT_I) { // -I
 		if_index = if_nametoindex(opt_I);
-		if (!if_index)
-			if (parse_nipquad(opt_I, &sourceaddr))
-				bb_show_usage();
+		if (!if_index) {
+			/* TODO: I'm not sure it takes IPv6 unless in [XX:XX..] format */
+			/* (ping doesn't support source IPv6 addresses yet anyway) */
+			source_lsa = xdotted2sockaddr(opt_I, 0);
+		}
 	}
 	myid = (int16_t) getpid();
 	hostname = argv[optind];
@@ -747,13 +735,13 @@ int ping_main(int argc, char **argv)
 #else
 	lsa = xhost_and_af2sockaddr(hostname, 0, AF_INET);
 #endif
+
+	if (source_lsa && source_lsa->sa.sa_family != lsa->sa.sa_family)
+		/* leaking it here... */
+		source_lsa = NULL;
+
 	dotted = xmalloc_sockaddr2dotted_noport(&lsa->sa, lsa->len);
-#if ENABLE_PING6
-	if (lsa->sa.sa_family == AF_INET6)
-		ping6(lsa);
-	else
-#endif
-		ping4(lsa);
+	ping(lsa);
 	pingstats(0);
 	return EXIT_SUCCESS;
 }