udhcp6: read_interface should save link-local ipv6 address

Patch is based on work by tiggerswelt.net. They say:
"Using this patch it was no problem to acquire an IPv6-Address via DHCPv6
using ISC DHCPD6 on server-side."

Signed-off-by: Denys Vlasenko <vda.linux@googlemail.com>

1 files changed, 61 insertions, 0 deletions

diff --git a/networking/udhcp/d6_socket.c b/networking/udhcp/d6_socket.c
index 910f296a3..930e5e4f5 100644
--- a/networking/udhcp/d6_socket.c
+++ b/networking/udhcp/d6_socket.c
@@ -7,6 +7,67 @@
 #include "common.h"
 #include "d6_common.h"
 #include <net/if.h>
+#include <ifaddrs.h>
+#include <netpacket/packet.h>
+
+int FAST_FUNC d6_read_interface(const char *interface, int *ifindex, struct in6_addr *nip6, uint8_t *mac)
+{
+	int retval = 3;
+	struct ifaddrs *ifap, *ifa;
+
+	getifaddrs(&ifap);
+
+	for (ifa = ifap; ifa; ifa = ifa->ifa_next) {
+		struct sockaddr_in6 *sip6;
+
+		if (!ifa->ifa_addr || (strcmp(ifa->ifa_name, interface) != 0))
+			continue;
+
+		sip6 = (struct sockaddr_in6*)(ifa->ifa_addr);
+
+		if (ifa->ifa_addr->sa_family == AF_PACKET) {
+			struct sockaddr_ll *sll = (struct sockaddr_ll*)(ifa->ifa_addr);
+			memcpy(mac, sll->sll_addr, 6);
+			log1("MAC %02x:%02x:%02x:%02x:%02x:%02x", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
+			log1("adapter index %d", sll->sll_ifindex);
+			*ifindex = sll->sll_ifindex;
+			retval &= (0xf - (1<<0));
+		}
+#if 0
+		if (ifa->ifa_addr->sa_family == AF_INET) {
+			*nip = ((struct sockaddr_in *)ifa->ifa_addr)->sin_addr.s_addr;
+			log1("IP %s", inet_ntoa(((struct sockaddr_in *)ifa->ifa_addr)->sin_addr));
+		}
+#endif
+		if (ifa->ifa_addr->sa_family == AF_INET6
+		 && IN6_IS_ADDR_LINKLOCAL(&sip6->sin6_addr)
+		) {
+			*nip6 = sip6->sin6_addr; /* struct copy */
+			log1(
+				"IPv6 %02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x:%02x%02x",
+				nip6->s6_addr[0], nip6->s6_addr[1],
+				nip6->s6_addr[2], nip6->s6_addr[3],
+				nip6->s6_addr[4], nip6->s6_addr[5],
+				nip6->s6_addr[6], nip6->s6_addr[7],
+				nip6->s6_addr[8], nip6->s6_addr[9],
+				nip6->s6_addr[10], nip6->s6_addr[11],
+				nip6->s6_addr[12], nip6->s6_addr[13],
+				nip6->s6_addr[14], nip6->s6_addr[15]
+			);
+			retval &= (0xf - (1<<1));
+		}
+	}
+
+	freeifaddrs(ifap);
+	if (retval == 0)
+		return retval;
+
+	if (retval & (1<<0))
+		bb_error_msg("can't get %s", "MAC");
+	if (retval & (1<<1))
+		bb_error_msg("can't get %s", "link-local IPv6 address");
+	return -1;
+}
 
 int FAST_FUNC d6_listen_socket(int port, const char *inf)
 {