/* vim: set expandtab ts=4 sw=4: */ /* * You may redistribute this program and/or modify it under the terms of * the GNU General Public License as published by the Free Software Foundation, * either version 3 of the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see . */ #include "util/platform/netdev/NetPlatform.h" #include "exception/Er.h" #include "util/AddrTools.h" #include "util/platform/Sockaddr.h" #include "util/CString.h" #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include static Er_DEFUN(void addIp4Address(const char* interfaceName, const uint8_t address[4], int prefixLen, struct Log* logger, struct Allocator* alloc)) { struct ifaliasreq ifaliasreq; struct sockaddr_in* in; memset(&ifaliasreq, 0, sizeof(ifaliasreq)); snprintf(ifaliasreq.ifra_name,IFNAMSIZ, "%s",interfaceName); char myIp[40]; snprintf(myIp, 40, "%u.%u.%u.%u", address[0], address[1], address[2], address[3]); in_addr_t nmask = ( ~((1 << (32 - prefixLen)) - 1) ); char myMask[40]; snprintf(myMask,40,"%u",nmask); in = (struct sockaddr_in *) &ifaliasreq.ifra_addr; in->sin_family = AF_INET; in->sin_len = sizeof(ifaliasreq.ifra_addr); int err = inet_aton(myIp, &in->sin_addr); if (err == 0){ Er_raise(alloc, "inet_aton(myIp) failed"); } in = (struct sockaddr_in *) &ifaliasreq.ifra_mask; in->sin_family = AF_INET; in->sin_len = sizeof(ifaliasreq.ifra_mask); err = inet_aton(myMask, &in->sin_addr); if (err == 0){ Er_raise(alloc, "inet_aton(myMask) failed"); } in = (struct sockaddr_in *) &ifaliasreq.ifra_broadaddr; in->sin_family = AF_INET; in->sin_len = sizeof(ifaliasreq.ifra_broadaddr); in->sin_addr.s_addr = ((struct sockaddr_in *) &ifaliasreq.ifra_addr)->sin_addr.s_addr | ~ ((struct sockaddr_in *) &ifaliasreq.ifra_mask)->sin_addr.s_addr; int s = socket(PF_INET, SOCK_STREAM, 0); if (ioctl(s, SIOCAIFADDR, &ifaliasreq) == -1){ int err = errno; close(s); Er_raise(alloc, "ioctl(SIOCAIFADDR) [%s] for [%s]", strerror(err), interfaceName); } Log_info(logger, "Configured IPv4 [%s/%s] for [%s]", myIp, myMask, interfaceName); close(s); Er_ret(); } static Er_DEFUN(void addIp6Address(const char* interfaceName, const uint8_t address[16], int prefixLen, struct Log* logger, struct Allocator* alloc)) { /* stringify our IP address */ char myIp[40]; AddrTools_printIp((uint8_t*)myIp, address); /* set up the interface ip assignment request */ struct in6_aliasreq in6_addreq; memset(&in6_addreq, 0, sizeof(in6_addreq)); in6_addreq.ifra_lifetime.ia6t_vltime = ND6_INFINITE_LIFETIME; in6_addreq.ifra_lifetime.ia6t_pltime = ND6_INFINITE_LIFETIME; /* parse the IPv6 address and add it to the request */ struct addrinfo hints, *result; bzero(&hints, sizeof(struct addrinfo)); hints.ai_family = AF_INET6; int err = getaddrinfo((const char *)myIp, NULL, &hints, &result); if (err) { // Should never happen since the address is specified as binary. Er_raise(alloc, "bad IPv6 address [%s]", gai_strerror(err)); } memcpy(&in6_addreq.ifra_addr, result->ai_addr, result->ai_addrlen); /* turn the prefixlen into a mask, and add it to the request */ struct sockaddr_in6* mask = &in6_addreq.ifra_prefixmask; u_char *cp; int len = prefixLen; mask->sin6_len = sizeof(*mask); if ((prefixLen == 0) || (prefixLen == 128)) { memset(&mask->sin6_addr, 0xff, sizeof(struct in6_addr)); } else { memset((void *)&mask->sin6_addr, 0x00, sizeof(mask->sin6_addr)); for (cp = (u_char *)&mask->sin6_addr; len > 7; len -= 8) { *cp++ = 0xff; } *cp = 0xff << (8 - len); } CString_safeStrncpy(in6_addreq.ifra_name, interfaceName, sizeof(in6_addreq.ifra_name)); /* do the actual assignment ioctl */ int s = socket(AF_INET6, SOCK_DGRAM, 0); if (s < 0) { Er_raise(alloc, "socket() [%s]", strerror(errno)); } if (ioctl(s, SIOCAIFADDR_IN6, &in6_addreq) < 0) { int err = errno; close(s); Er_raise(alloc, "ioctl(SIOCAIFADDR) [%s]", strerror(err)); } Log_info(logger, "Configured IPv6 [%s/%i] for [%s]", myIp, prefixLen, interfaceName); close(s); Er_ret(); } Er_DEFUN(void NetPlatform_addAddress(const char* interfaceName, const uint8_t* address, int prefixLen, int addrFam, struct Log* logger, struct Allocator* tempAlloc)) { if (addrFam == Sockaddr_AF_INET6) { Er(addIp6Address(interfaceName, address, prefixLen, logger, tempAlloc)); } else if (addrFam == Sockaddr_AF_INET) { Er(addIp4Address(interfaceName, address, prefixLen, logger, tempAlloc)); } else { Assert_true(0); } Er_ret(); } Er_DEFUN(void NetPlatform_setMTU(const char* interfaceName, uint32_t mtu, struct Log* logger, struct Allocator* errAlloc)) { int s = socket(AF_INET6, SOCK_DGRAM, 0); if (s < 0) { Er_raise(errAlloc, "socket() [%s]", strerror(errno)); } struct ifreq ifRequest; CString_safeStrncpy(ifRequest.ifr_name, interfaceName, IFNAMSIZ); ifRequest.ifr_mtu = mtu; Log_info(logger, "Setting MTU for device [%s] to [%u] bytes.", interfaceName, mtu); if (ioctl(s, SIOCSIFMTU, &ifRequest) < 0) { int err = errno; close(s); Er_raise(errAlloc, "ioctl(SIOCSIFMTU) failed [%s]", strerror(err)); } Er_ret(); } Er_DEFUN(void NetPlatform_setRoutes(const char* ifName, struct Sockaddr** prefixSet, int prefixCount, struct Log* logger, struct Allocator* tempAlloc)) { Er_raise(tempAlloc, "NetPlatform_setRoutes is not implemented in this platform."); }