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)
 {