diff options
| -rw-r--r-- | networking/udhcp/d6_common.h | 4 | ||||
| -rw-r--r-- | networking/udhcp/d6_dhcpc.c | 11 | ||||
| -rw-r--r-- | networking/udhcp/d6_socket.c | 61 |
3 files changed, 71 insertions, 5 deletions
diff --git a/networking/udhcp/d6_common.h b/networking/udhcp/d6_common.h index eb211ea..f7cfa4a 100644 --- a/networking/udhcp/d6_common.h +++ b/networking/udhcp/d6_common.h @@ -91,10 +91,14 @@ struct client6_data_t { struct d6_option *ia_na; char **env_ptr; unsigned env_idx; + /* link-local IPv6 address */ + struct in6_addr ll_ip6; }; #define client6_data (*(struct client6_data_t*)(&bb_common_bufsiz1[COMMON_BUFSIZE - sizeof(struct client6_data_t)])) +int FAST_FUNC d6_read_interface(const char *interface, int *ifindex, struct in6_addr *nip6, uint8_t *mac); + int FAST_FUNC d6_listen_socket(int port, const char *inf); int FAST_FUNC d6_recv_kernel_packet( diff --git a/networking/udhcp/d6_dhcpc.c b/networking/udhcp/d6_dhcpc.c index bea589d..95f8939 100644 --- a/networking/udhcp/d6_dhcpc.c +++ b/networking/udhcp/d6_dhcpc.c @@ -311,7 +311,7 @@ static int d6_mcast_from_client_config_ifindex(struct d6_packet *packet, uint8_t return d6_send_raw_packet( packet, (end - (uint8_t*) packet), - /*src*/ NULL, CLIENT_PORT6, + /*src*/ &client6_data.ll_ip6, CLIENT_PORT6, /*dst*/ (struct in6_addr*)FF02__1_2, SERVER_PORT6, MAC_BCAST_ADDR, client_config.ifindex ); @@ -1003,9 +1003,9 @@ int udhcpc6_main(int argc UNUSED_PARAM, char **argv) udhcp_str2optset(optstr, &client_config.options); } - if (udhcp_read_interface(client_config.interface, + if (d6_read_interface(client_config.interface, &client_config.ifindex, - NULL, + &client6_data.ll_ip6, client_config.client_mac) ) { return 1; @@ -1106,13 +1106,14 @@ int udhcpc6_main(int argc UNUSED_PARAM, char **argv) * or if the status of the bridge changed). * Refresh ifindex and client_mac: */ - if (udhcp_read_interface(client_config.interface, + if (d6_read_interface(client_config.interface, &client_config.ifindex, - NULL, + &client6_data.ll_ip6, client_config.client_mac) ) { goto ret0; /* iface is gone? */ } + memcpy(clientid_mac_ptr, client_config.client_mac, 6); /* We will restart the wait in any case */ diff --git a/networking/udhcp/d6_socket.c b/networking/udhcp/d6_socket.c index 910f296..930e5e4 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) { |