| /* |
| * Copyright (C) 2009-2016 Tobias Brunner |
| * HSR Hochschule fuer Technik Rapperswil |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License as published by the |
| * Free Software Foundation; either version 2 of the License, or (at your |
| * option) any later version. See <http://www.fsf.org/copyleft/gpl.txt>. |
| * |
| * 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. |
| */ |
| |
| #include <sys/types.h> |
| #include <sys/socket.h> |
| #include <sys/sysctl.h> |
| #include <net/if.h> |
| #include <net/if_dl.h> |
| #include <ifaddrs.h> |
| #include <net/route.h> |
| #include <unistd.h> |
| #include <errno.h> |
| |
| #include "kernel_pfroute_net.h" |
| |
| #include <daemon.h> |
| #include <utils/debug.h> |
| #include <networking/host.h> |
| #include <networking/tun_device.h> |
| #include <threading/thread.h> |
| #include <threading/mutex.h> |
| #include <threading/condvar.h> |
| #include <threading/rwlock.h> |
| #include <threading/spinlock.h> |
| #include <collections/hashtable.h> |
| #include <collections/linked_list.h> |
| #include <processing/jobs/callback_job.h> |
| |
| #ifndef HAVE_STRUCT_SOCKADDR_SA_LEN |
| #error Cannot compile this plugin on systems where 'struct sockaddr' has no sa_len member. |
| #endif |
| |
| /** properly align sockaddrs */ |
| #ifdef __APPLE__ |
| /* Apple always uses 4 bytes */ |
| #define SA_ALIGN 4 |
| #else |
| /* while on other platforms like FreeBSD it depends on the architecture */ |
| #define SA_ALIGN sizeof(long) |
| #endif |
| #define SA_LEN(len) ((len) > 0 ? (((len)+SA_ALIGN-1) & ~(SA_ALIGN-1)) : SA_ALIGN) |
| |
| /** delay before firing roam events (ms) */ |
| #define ROAM_DELAY 100 |
| |
| /** delay before reinstalling routes (ms) */ |
| #define ROUTE_DELAY 100 |
| |
| typedef struct addr_entry_t addr_entry_t; |
| |
| /** |
| * IP address in an inface_entry_t |
| */ |
| struct addr_entry_t { |
| |
| /** The ip address */ |
| host_t *ip; |
| |
| /** virtual IP managed by us */ |
| bool virtual; |
| }; |
| |
| /** |
| * destroy a addr_entry_t object |
| */ |
| static void addr_entry_destroy(addr_entry_t *this) |
| { |
| this->ip->destroy(this->ip); |
| free(this); |
| } |
| |
| typedef struct iface_entry_t iface_entry_t; |
| |
| /** |
| * A network interface on this system, containing addr_entry_t's |
| */ |
| struct iface_entry_t { |
| |
| /** interface index */ |
| int ifindex; |
| |
| /** name of the interface */ |
| char ifname[IFNAMSIZ]; |
| |
| /** interface flags, as in netdevice(7) SIOCGIFFLAGS */ |
| u_int flags; |
| |
| /** list of addresses as host_t */ |
| linked_list_t *addrs; |
| |
| /** TRUE if usable by config */ |
| bool usable; |
| }; |
| |
| /** |
| * destroy an interface entry |
| */ |
| static void iface_entry_destroy(iface_entry_t *this) |
| { |
| this->addrs->destroy_function(this->addrs, (void*)addr_entry_destroy); |
| free(this); |
| } |
| |
| /** |
| * check if an interface is up |
| */ |
| static inline bool iface_entry_up(iface_entry_t *iface) |
| { |
| return (iface->flags & IFF_UP) == IFF_UP; |
| } |
| |
| /** |
| * check if an interface is up and usable |
| */ |
| static inline bool iface_entry_up_and_usable(iface_entry_t *iface) |
| { |
| return iface->usable && iface_entry_up(iface); |
| } |
| |
| typedef struct addr_map_entry_t addr_map_entry_t; |
| |
| /** |
| * Entry that maps an IP address to an interface entry |
| */ |
| struct addr_map_entry_t { |
| /** The IP address */ |
| host_t *ip; |
| |
| /** The address entry for this IP address */ |
| addr_entry_t *addr; |
| |
| /** The interface this address is installed on */ |
| iface_entry_t *iface; |
| }; |
| |
| /** |
| * Hash a addr_map_entry_t object, all entries with the same IP address |
| * are stored in the same bucket |
| */ |
| static u_int addr_map_entry_hash(addr_map_entry_t *this) |
| { |
| return chunk_hash(this->ip->get_address(this->ip)); |
| } |
| |
| /** |
| * Compare two addr_map_entry_t objects, two entries are equal if they are |
| * installed on the same interface |
| */ |
| static bool addr_map_entry_equals(addr_map_entry_t *a, addr_map_entry_t *b) |
| { |
| return a->iface->ifindex == b->iface->ifindex && |
| a->ip->ip_equals(a->ip, b->ip); |
| } |
| |
| /** |
| * Used with get_match this finds an address entry if it is installed on |
| * an up and usable interface |
| */ |
| static bool addr_map_entry_match_up_and_usable(addr_map_entry_t *a, |
| addr_map_entry_t *b) |
| { |
| return !b->addr->virtual && iface_entry_up_and_usable(b->iface) && |
| a->ip->ip_equals(a->ip, b->ip); |
| } |
| |
| /** |
| * Used with get_match this finds an address entry if it is installed as virtual |
| * IP address |
| */ |
| static bool addr_map_entry_match_virtual(addr_map_entry_t *a, addr_map_entry_t *b) |
| { |
| return b->addr->virtual && a->ip->ip_equals(a->ip, b->ip); |
| } |
| |
| /** |
| * Used with get_match this finds an address entry if it is installed on |
| * any active local interface |
| */ |
| static bool addr_map_entry_match_up(addr_map_entry_t *a, addr_map_entry_t *b) |
| { |
| return !b->addr->virtual && iface_entry_up(b->iface) && |
| a->ip->ip_equals(a->ip, b->ip); |
| } |
| |
| typedef struct route_entry_t route_entry_t; |
| |
| /** |
| * Installed routing entry |
| */ |
| struct route_entry_t { |
| /** Name of the interface the route is bound to */ |
| char *if_name; |
| |
| /** Gateway for this route */ |
| host_t *gateway; |
| |
| /** Destination net */ |
| chunk_t dst_net; |
| |
| /** Destination net prefixlen */ |
| uint8_t prefixlen; |
| }; |
| |
| /** |
| * Clone a route_entry_t object. |
| */ |
| static route_entry_t *route_entry_clone(route_entry_t *this) |
| { |
| route_entry_t *route; |
| |
| INIT(route, |
| .if_name = strdup(this->if_name), |
| .gateway = this->gateway ? this->gateway->clone(this->gateway) : NULL, |
| .dst_net = chunk_clone(this->dst_net), |
| .prefixlen = this->prefixlen, |
| ); |
| return route; |
| } |
| |
| /** |
| * Destroy a route_entry_t object |
| */ |
| static void route_entry_destroy(route_entry_t *this) |
| { |
| free(this->if_name); |
| DESTROY_IF(this->gateway); |
| chunk_free(&this->dst_net); |
| free(this); |
| } |
| |
| /** |
| * Hash a route_entry_t object |
| */ |
| static u_int route_entry_hash(route_entry_t *this) |
| { |
| return chunk_hash_inc(chunk_from_thing(this->prefixlen), |
| chunk_hash(this->dst_net)); |
| } |
| |
| /** |
| * Compare two route_entry_t objects |
| */ |
| static bool route_entry_equals(route_entry_t *a, route_entry_t *b) |
| { |
| if (a->if_name && b->if_name && streq(a->if_name, b->if_name) && |
| chunk_equals(a->dst_net, b->dst_net) && a->prefixlen == b->prefixlen) |
| { |
| return (!a->gateway && !b->gateway) || (a->gateway && b->gateway && |
| a->gateway->ip_equals(a->gateway, b->gateway)); |
| } |
| return FALSE; |
| } |
| |
| typedef struct net_change_t net_change_t; |
| |
| /** |
| * Queued network changes |
| */ |
| struct net_change_t { |
| /** Name of the interface that got activated (or an IP appeared on) */ |
| char *if_name; |
| }; |
| |
| /** |
| * Destroy a net_change_t object |
| */ |
| static void net_change_destroy(net_change_t *this) |
| { |
| free(this->if_name); |
| free(this); |
| } |
| |
| /** |
| * Hash a net_change_t object |
| */ |
| static u_int net_change_hash(net_change_t *this) |
| { |
| return chunk_hash(chunk_create(this->if_name, strlen(this->if_name))); |
| } |
| |
| /** |
| * Compare two net_change_t objects |
| */ |
| static bool net_change_equals(net_change_t *a, net_change_t *b) |
| { |
| return streq(a->if_name, b->if_name); |
| } |
| |
| typedef struct private_kernel_pfroute_net_t private_kernel_pfroute_net_t; |
| |
| /** |
| * Private variables and functions of kernel_pfroute class. |
| */ |
| struct private_kernel_pfroute_net_t |
| { |
| /** |
| * Public part of the kernel_pfroute_t object. |
| */ |
| kernel_pfroute_net_t public; |
| |
| /** |
| * lock to access lists and maps |
| */ |
| rwlock_t *lock; |
| |
| /** |
| * Cached list of interfaces and their addresses (iface_entry_t) |
| */ |
| linked_list_t *ifaces; |
| |
| /** |
| * Map for IP addresses to iface_entry_t objects (addr_map_entry_t) |
| */ |
| hashlist_t *addrs; |
| |
| /** |
| * List of tun devices we installed for virtual IPs |
| */ |
| linked_list_t *tuns; |
| |
| /** |
| * mutex to communicate exclusively with PF_KEY |
| */ |
| mutex_t *mutex; |
| |
| /** |
| * condvar to signal if PF_KEY query got a response |
| */ |
| condvar_t *condvar; |
| |
| /** |
| * installed routes |
| */ |
| hashtable_t *routes; |
| |
| /** |
| * mutex for routes |
| */ |
| mutex_t *routes_lock; |
| |
| /** |
| * interface changes which may trigger route reinstallation |
| */ |
| hashtable_t *net_changes; |
| |
| /** |
| * mutex for route reinstallation triggers |
| */ |
| mutex_t *net_changes_lock; |
| |
| /** |
| * time of last route reinstallation |
| */ |
| timeval_t last_route_reinstall; |
| |
| /** |
| * pid to send PF_ROUTE messages with |
| */ |
| pid_t pid; |
| |
| /** |
| * PF_ROUTE socket to communicate with the kernel |
| */ |
| int socket; |
| |
| /** |
| * sequence number for messages sent to the kernel |
| */ |
| int seq; |
| |
| /** |
| * Sequence number a query is waiting for |
| */ |
| int waiting_seq; |
| |
| /** |
| * Allocated reply message from kernel |
| */ |
| struct rt_msghdr *reply; |
| |
| /** |
| * earliest time of the next roam event |
| */ |
| timeval_t next_roam; |
| |
| /** |
| * roam event due to address change |
| */ |
| bool roam_address; |
| |
| /** |
| * lock to check and update roam event time |
| */ |
| spinlock_t *roam_lock; |
| |
| /** |
| * Time in ms to wait for IP addresses to appear/disappear |
| */ |
| int vip_wait; |
| |
| /** |
| * whether to actually install virtual IPs |
| */ |
| bool install_virtual_ip; |
| }; |
| |
| |
| /** |
| * Forward declaration |
| */ |
| static status_t manage_route(private_kernel_pfroute_net_t *this, int op, |
| chunk_t dst_net, uint8_t prefixlen, |
| host_t *gateway, char *if_name); |
| |
| /** |
| * Clear the queued network changes. |
| */ |
| static void net_changes_clear(private_kernel_pfroute_net_t *this) |
| { |
| enumerator_t *enumerator; |
| net_change_t *change; |
| |
| enumerator = this->net_changes->create_enumerator(this->net_changes); |
| while (enumerator->enumerate(enumerator, NULL, (void**)&change)) |
| { |
| this->net_changes->remove_at(this->net_changes, enumerator); |
| net_change_destroy(change); |
| } |
| enumerator->destroy(enumerator); |
| } |
| |
| /** |
| * Act upon queued network changes. |
| */ |
| static job_requeue_t reinstall_routes(private_kernel_pfroute_net_t *this) |
| { |
| enumerator_t *enumerator; |
| route_entry_t *route; |
| |
| this->net_changes_lock->lock(this->net_changes_lock); |
| this->routes_lock->lock(this->routes_lock); |
| |
| enumerator = this->routes->create_enumerator(this->routes); |
| while (enumerator->enumerate(enumerator, NULL, (void**)&route)) |
| { |
| net_change_t *change, lookup = { |
| .if_name = route->if_name, |
| }; |
| /* check if a change for the outgoing interface is queued */ |
| change = this->net_changes->get(this->net_changes, &lookup); |
| if (change) |
| { |
| manage_route(this, RTM_ADD, route->dst_net, route->prefixlen, |
| route->gateway, route->if_name); |
| } |
| } |
| enumerator->destroy(enumerator); |
| this->routes_lock->unlock(this->routes_lock); |
| |
| net_changes_clear(this); |
| this->net_changes_lock->unlock(this->net_changes_lock); |
| return JOB_REQUEUE_NONE; |
| } |
| |
| /** |
| * Queue route reinstallation caused by network changes for a given interface. |
| * |
| * The route reinstallation is delayed for a while and only done once for |
| * several calls during this delay, in order to avoid doing it too often. |
| * The interface name is freed. |
| */ |
| static void queue_route_reinstall(private_kernel_pfroute_net_t *this, |
| char *if_name) |
| { |
| net_change_t *update, *found; |
| timeval_t now; |
| job_t *job; |
| |
| INIT(update, |
| .if_name = if_name |
| ); |
| |
| this->net_changes_lock->lock(this->net_changes_lock); |
| found = this->net_changes->put(this->net_changes, update, update); |
| if (found) |
| { |
| net_change_destroy(found); |
| } |
| time_monotonic(&now); |
| if (timercmp(&now, &this->last_route_reinstall, >)) |
| { |
| timeval_add_ms(&now, ROUTE_DELAY); |
| this->last_route_reinstall = now; |
| |
| job = (job_t*)callback_job_create((callback_job_cb_t)reinstall_routes, |
| this, NULL, NULL); |
| lib->scheduler->schedule_job_ms(lib->scheduler, job, ROUTE_DELAY); |
| } |
| this->net_changes_lock->unlock(this->net_changes_lock); |
| } |
| |
| /** |
| * Add an address map entry |
| */ |
| static void addr_map_entry_add(private_kernel_pfroute_net_t *this, |
| addr_entry_t *addr, iface_entry_t *iface) |
| { |
| addr_map_entry_t *entry; |
| |
| INIT(entry, |
| .ip = addr->ip, |
| .addr = addr, |
| .iface = iface, |
| ); |
| entry = this->addrs->ht.put(&this->addrs->ht, entry, entry); |
| free(entry); |
| } |
| |
| /** |
| * Remove an address map entry (the argument order is a bit strange because |
| * it is also used with linked_list_t.invoke_function) |
| */ |
| static void addr_map_entry_remove(addr_entry_t *addr, iface_entry_t *iface, |
| private_kernel_pfroute_net_t *this) |
| { |
| addr_map_entry_t *entry, lookup = { |
| .ip = addr->ip, |
| .addr = addr, |
| .iface = iface, |
| }; |
| |
| entry = this->addrs->ht.remove(&this->addrs->ht, &lookup); |
| free(entry); |
| } |
| |
| /** |
| * callback function that raises the delayed roam event |
| */ |
| static job_requeue_t roam_event(private_kernel_pfroute_net_t *this) |
| { |
| bool address; |
| |
| this->roam_lock->lock(this->roam_lock); |
| address = this->roam_address; |
| this->roam_address = FALSE; |
| this->roam_lock->unlock(this->roam_lock); |
| charon->kernel->roam(charon->kernel, address); |
| return JOB_REQUEUE_NONE; |
| } |
| |
| /** |
| * fire a roaming event. we delay it for a bit and fire only one event |
| * for multiple calls. otherwise we would create too many events. |
| */ |
| static void fire_roam_event(private_kernel_pfroute_net_t *this, bool address) |
| { |
| timeval_t now; |
| job_t *job; |
| |
| time_monotonic(&now); |
| this->roam_lock->lock(this->roam_lock); |
| this->roam_address |= address; |
| if (!timercmp(&now, &this->next_roam, >)) |
| { |
| this->roam_lock->unlock(this->roam_lock); |
| return; |
| } |
| timeval_add_ms(&now, ROAM_DELAY); |
| this->next_roam = now; |
| this->roam_lock->unlock(this->roam_lock); |
| |
| job = (job_t*)callback_job_create((callback_job_cb_t)roam_event, |
| this, NULL, NULL); |
| lib->scheduler->schedule_job_ms(lib->scheduler, job, ROAM_DELAY); |
| } |
| |
| /** |
| * Data for enumerator over rtmsg sockaddrs |
| */ |
| typedef struct { |
| /** implements enumerator */ |
| enumerator_t public; |
| /** copy of attribute bitfield */ |
| int types; |
| /** bytes remaining in buffer */ |
| int remaining; |
| /** next sockaddr to enumerate */ |
| struct sockaddr *addr; |
| } rt_enumerator_t; |
| |
| METHOD(enumerator_t, rt_enumerate, bool, |
| rt_enumerator_t *this, va_list args) |
| { |
| struct sockaddr **addr; |
| int i, type, *xtype; |
| |
| VA_ARGS_VGET(args, xtype, addr); |
| |
| if (this->remaining < sizeof(this->addr->sa_len) || |
| this->remaining < this->addr->sa_len) |
| { |
| return FALSE; |
| } |
| for (i = 0; i < RTAX_MAX; i++) |
| { |
| type = (1 << i); |
| if (this->types & type) |
| { |
| this->types &= ~type; |
| *addr = this->addr; |
| *xtype = i; |
| this->remaining -= SA_LEN(this->addr->sa_len); |
| this->addr = (struct sockaddr*)((char*)this->addr + |
| SA_LEN(this->addr->sa_len)); |
| return TRUE; |
| } |
| } |
| return FALSE; |
| } |
| |
| /** |
| * Create an enumerator over sockaddrs in rt/if messages |
| */ |
| static enumerator_t *create_rt_enumerator(int types, int remaining, |
| struct sockaddr *addr) |
| { |
| rt_enumerator_t *this; |
| |
| INIT(this, |
| .public = { |
| .enumerate = enumerator_enumerate_default, |
| .venumerate = _rt_enumerate, |
| .destroy = (void*)free, |
| }, |
| .types = types, |
| .remaining = remaining, |
| .addr = addr, |
| ); |
| return &this->public; |
| } |
| |
| /** |
| * Create a safe enumerator over sockaddrs in rt_msghdr |
| */ |
| static enumerator_t *create_rtmsg_enumerator(struct rt_msghdr *hdr) |
| { |
| return create_rt_enumerator(hdr->rtm_addrs, hdr->rtm_msglen - sizeof(*hdr), |
| (struct sockaddr *)(hdr + 1)); |
| } |
| |
| /** |
| * Create a safe enumerator over sockaddrs in ifa_msghdr |
| */ |
| static enumerator_t *create_ifamsg_enumerator(struct ifa_msghdr *hdr) |
| { |
| return create_rt_enumerator(hdr->ifam_addrs, hdr->ifam_msglen - sizeof(*hdr), |
| (struct sockaddr *)(hdr + 1)); |
| } |
| |
| /** |
| * Process an RTM_*ADDR message from the kernel |
| */ |
| static void process_addr(private_kernel_pfroute_net_t *this, |
| struct ifa_msghdr *ifa) |
| { |
| struct sockaddr *sockaddr; |
| host_t *host = NULL; |
| enumerator_t *ifaces, *addrs; |
| iface_entry_t *iface; |
| addr_entry_t *addr; |
| bool found = FALSE, changed = FALSE, roam = FALSE; |
| enumerator_t *enumerator; |
| char *ifname = NULL; |
| int type; |
| |
| enumerator = create_ifamsg_enumerator(ifa); |
| while (enumerator->enumerate(enumerator, &type, &sockaddr)) |
| { |
| if (type == RTAX_IFA) |
| { |
| host = host_create_from_sockaddr(sockaddr); |
| break; |
| } |
| } |
| enumerator->destroy(enumerator); |
| |
| if (!host || host->is_anyaddr(host)) |
| { |
| DESTROY_IF(host); |
| return; |
| } |
| |
| this->lock->write_lock(this->lock); |
| ifaces = this->ifaces->create_enumerator(this->ifaces); |
| while (ifaces->enumerate(ifaces, &iface)) |
| { |
| if (iface->ifindex == ifa->ifam_index) |
| { |
| addrs = iface->addrs->create_enumerator(iface->addrs); |
| while (addrs->enumerate(addrs, &addr)) |
| { |
| if (host->ip_equals(host, addr->ip)) |
| { |
| found = TRUE; |
| if (ifa->ifam_type == RTM_DELADDR) |
| { |
| iface->addrs->remove_at(iface->addrs, addrs); |
| if (!addr->virtual && iface->usable) |
| { |
| changed = TRUE; |
| DBG1(DBG_KNL, "%H disappeared from %s", |
| host, iface->ifname); |
| } |
| addr_map_entry_remove(addr, iface, this); |
| addr_entry_destroy(addr); |
| } |
| } |
| } |
| addrs->destroy(addrs); |
| |
| if (!found && ifa->ifam_type == RTM_NEWADDR) |
| { |
| INIT(addr, |
| .ip = host->clone(host), |
| ); |
| changed = TRUE; |
| ifname = strdup(iface->ifname); |
| iface->addrs->insert_last(iface->addrs, addr); |
| addr_map_entry_add(this, addr, iface); |
| if (iface->usable) |
| { |
| DBG1(DBG_KNL, "%H appeared on %s", host, iface->ifname); |
| } |
| } |
| |
| if (changed && iface_entry_up_and_usable(iface)) |
| { |
| roam = TRUE; |
| } |
| break; |
| } |
| } |
| ifaces->destroy(ifaces); |
| this->lock->unlock(this->lock); |
| host->destroy(host); |
| |
| if (roam && ifname) |
| { |
| queue_route_reinstall(this, ifname); |
| } |
| else |
| { |
| free(ifname); |
| } |
| |
| if (roam) |
| { |
| fire_roam_event(this, TRUE); |
| } |
| } |
| |
| /** |
| * Re-initialize address list of an interface if it changes state |
| */ |
| static void repopulate_iface(private_kernel_pfroute_net_t *this, |
| iface_entry_t *iface) |
| { |
| struct ifaddrs *ifap, *ifa; |
| addr_entry_t *addr; |
| |
| while (iface->addrs->remove_last(iface->addrs, (void**)&addr) == SUCCESS) |
| { |
| addr_map_entry_remove(addr, iface, this); |
| addr_entry_destroy(addr); |
| } |
| |
| if (getifaddrs(&ifap) == 0) |
| { |
| for (ifa = ifap; ifa != NULL; ifa = ifa->ifa_next) |
| { |
| if (ifa->ifa_addr && streq(ifa->ifa_name, iface->ifname)) |
| { |
| switch (ifa->ifa_addr->sa_family) |
| { |
| case AF_INET: |
| case AF_INET6: |
| INIT(addr, |
| .ip = host_create_from_sockaddr(ifa->ifa_addr), |
| ); |
| iface->addrs->insert_last(iface->addrs, addr); |
| addr_map_entry_add(this, addr, iface); |
| break; |
| default: |
| break; |
| } |
| } |
| } |
| freeifaddrs(ifap); |
| } |
| } |
| |
| /** |
| * Process an RTM_IFINFO message from the kernel |
| */ |
| static void process_link(private_kernel_pfroute_net_t *this, |
| struct if_msghdr *msg) |
| { |
| enumerator_t *enumerator; |
| iface_entry_t *iface; |
| bool roam = FALSE, found = FALSE, update_routes = FALSE; |
| |
| this->lock->write_lock(this->lock); |
| enumerator = this->ifaces->create_enumerator(this->ifaces); |
| while (enumerator->enumerate(enumerator, &iface)) |
| { |
| if (iface->ifindex == msg->ifm_index) |
| { |
| if (iface->usable) |
| { |
| if (!(iface->flags & IFF_UP) && (msg->ifm_flags & IFF_UP)) |
| { |
| roam = update_routes = TRUE; |
| DBG1(DBG_KNL, "interface %s activated", iface->ifname); |
| } |
| else if ((iface->flags & IFF_UP) && !(msg->ifm_flags & IFF_UP)) |
| { |
| roam = TRUE; |
| DBG1(DBG_KNL, "interface %s deactivated", iface->ifname); |
| } |
| } |
| #ifdef __APPLE__ |
| /* There seems to be a race condition on 10.10, where we get |
| * the RTM_IFINFO, but getifaddrs() does not return the virtual |
| * IP installed on a tun device, but we also don't get a |
| * RTM_NEWADDR. We therefore could miss the new address, letting |
| * virtual IP installation fail. Delaying getifaddrs() helps, |
| * but is obviously not a clean fix. */ |
| usleep(50000); |
| #endif |
| iface->flags = msg->ifm_flags; |
| repopulate_iface(this, iface); |
| found = TRUE; |
| break; |
| } |
| } |
| enumerator->destroy(enumerator); |
| |
| if (!found) |
| { |
| INIT(iface, |
| .ifindex = msg->ifm_index, |
| .flags = msg->ifm_flags, |
| .addrs = linked_list_create(), |
| ); |
| #ifdef __APPLE__ |
| /* Similar to the issue described above, on 10.13 we need this delay as |
| * we might otherwise not be able to convert the index to a name yet. */ |
| usleep(50000); |
| #endif |
| if (if_indextoname(iface->ifindex, iface->ifname)) |
| { |
| DBG1(DBG_KNL, "interface %s appeared", iface->ifname); |
| iface->usable = charon->kernel->is_interface_usable(charon->kernel, |
| iface->ifname); |
| repopulate_iface(this, iface); |
| this->ifaces->insert_last(this->ifaces, iface); |
| if (iface->usable) |
| { |
| roam = update_routes = TRUE; |
| } |
| } |
| else |
| { |
| free(iface); |
| } |
| } |
| this->lock->unlock(this->lock); |
| |
| if (update_routes) |
| { |
| queue_route_reinstall(this, strdup(iface->ifname)); |
| } |
| |
| if (roam) |
| { |
| fire_roam_event(this, TRUE); |
| } |
| } |
| |
| #ifdef HAVE_RTM_IFANNOUNCE |
| |
| /** |
| * Process an RTM_IFANNOUNCE message from the kernel |
| */ |
| static void process_announce(private_kernel_pfroute_net_t *this, |
| struct if_announcemsghdr *msg) |
| { |
| enumerator_t *enumerator; |
| iface_entry_t *iface; |
| |
| if (msg->ifan_what != IFAN_DEPARTURE) |
| { |
| /* we handle new interfaces in process_link() */ |
| return; |
| } |
| |
| this->lock->write_lock(this->lock); |
| enumerator = this->ifaces->create_enumerator(this->ifaces); |
| while (enumerator->enumerate(enumerator, &iface)) |
| { |
| if (iface->ifindex == msg->ifan_index) |
| { |
| DBG1(DBG_KNL, "interface %s disappeared", iface->ifname); |
| this->ifaces->remove_at(this->ifaces, enumerator); |
| iface_entry_destroy(iface); |
| break; |
| } |
| } |
| enumerator->destroy(enumerator); |
| this->lock->unlock(this->lock); |
| } |
| |
| #endif /* HAVE_RTM_IFANNOUNCE */ |
| |
| /** |
| * Process an RTM_*ROUTE message from the kernel |
| */ |
| static void process_route(private_kernel_pfroute_net_t *this, |
| struct rt_msghdr *msg) |
| { |
| |
| } |
| |
| /** |
| * Receives PF_ROUTE messages from kernel |
| */ |
| static bool receive_events(private_kernel_pfroute_net_t *this, int fd, |
| watcher_event_t event) |
| { |
| struct { |
| union { |
| struct rt_msghdr rtm; |
| struct if_msghdr ifm; |
| struct ifa_msghdr ifam; |
| #ifdef HAVE_RTM_IFANNOUNCE |
| struct if_announcemsghdr ifanm; |
| #endif |
| }; |
| char buf[sizeof(struct sockaddr_storage) * RTAX_MAX]; |
| } msg; |
| int len, hdrlen; |
| |
| len = recv(this->socket, &msg, sizeof(msg), MSG_DONTWAIT); |
| if (len < 0) |
| { |
| switch (errno) |
| { |
| case EINTR: |
| case EAGAIN: |
| return TRUE; |
| default: |
| DBG1(DBG_KNL, "unable to receive from PF_ROUTE event socket"); |
| sleep(1); |
| return TRUE; |
| } |
| } |
| |
| if (len < offsetof(struct rt_msghdr, rtm_flags) || len < msg.rtm.rtm_msglen) |
| { |
| DBG1(DBG_KNL, "received invalid PF_ROUTE message"); |
| return TRUE; |
| } |
| if (msg.rtm.rtm_version != RTM_VERSION) |
| { |
| DBG1(DBG_KNL, "received PF_ROUTE message with unsupported version: %d", |
| msg.rtm.rtm_version); |
| return TRUE; |
| } |
| switch (msg.rtm.rtm_type) |
| { |
| case RTM_NEWADDR: |
| case RTM_DELADDR: |
| hdrlen = sizeof(msg.ifam); |
| break; |
| case RTM_IFINFO: |
| hdrlen = sizeof(msg.ifm); |
| break; |
| #ifdef HAVE_RTM_IFANNOUNCE |
| case RTM_IFANNOUNCE: |
| hdrlen = sizeof(msg.ifanm); |
| break; |
| #endif /* HAVE_RTM_IFANNOUNCE */ |
| case RTM_ADD: |
| case RTM_DELETE: |
| case RTM_GET: |
| hdrlen = sizeof(msg.rtm); |
| break; |
| default: |
| return TRUE; |
| } |
| if (msg.rtm.rtm_msglen < hdrlen) |
| { |
| DBG1(DBG_KNL, "ignoring short PF_ROUTE message"); |
| return TRUE; |
| } |
| switch (msg.rtm.rtm_type) |
| { |
| case RTM_NEWADDR: |
| case RTM_DELADDR: |
| process_addr(this, &msg.ifam); |
| break; |
| case RTM_IFINFO: |
| process_link(this, &msg.ifm); |
| break; |
| #ifdef HAVE_RTM_IFANNOUNCE |
| case RTM_IFANNOUNCE: |
| process_announce(this, &msg.ifanm); |
| break; |
| #endif /* HAVE_RTM_IFANNOUNCE */ |
| case RTM_ADD: |
| case RTM_DELETE: |
| process_route(this, &msg.rtm); |
| break; |
| default: |
| break; |
| } |
| |
| this->mutex->lock(this->mutex); |
| if (msg.rtm.rtm_pid == this->pid && msg.rtm.rtm_seq == this->waiting_seq) |
| { |
| /* seems like the message someone is waiting for, deliver */ |
| this->reply = realloc(this->reply, msg.rtm.rtm_msglen); |
| memcpy(this->reply, &msg, msg.rtm.rtm_msglen); |
| } |
| /* signal on any event, add_ip()/del_ip() might wait for it */ |
| this->condvar->broadcast(this->condvar); |
| this->mutex->unlock(this->mutex); |
| |
| return TRUE; |
| } |
| |
| |
| /** enumerator over addresses */ |
| typedef struct { |
| private_kernel_pfroute_net_t* this; |
| /** which addresses to enumerate */ |
| kernel_address_type_t which; |
| } address_enumerator_t; |
| |
| CALLBACK(address_enumerator_destroy, void, |
| address_enumerator_t *data) |
| { |
| data->this->lock->unlock(data->this->lock); |
| free(data); |
| } |
| |
| CALLBACK(filter_addresses, bool, |
| address_enumerator_t *data, enumerator_t *orig, va_list args) |
| { |
| addr_entry_t *addr; |
| host_t *ip, **out; |
| struct sockaddr_in6 *sin6; |
| |
| VA_ARGS_VGET(args, out); |
| |
| while (orig->enumerate(orig, &addr)) |
| { |
| if (!(data->which & ADDR_TYPE_VIRTUAL) && addr->virtual) |
| { /* skip virtual interfaces added by us */ |
| continue; |
| } |
| if (!(data->which & ADDR_TYPE_REGULAR) && !addr->virtual) |
| { /* address is regular, but not requested */ |
| continue; |
| } |
| ip = addr->ip; |
| if (ip->get_family(ip) == AF_INET6) |
| { |
| sin6 = (struct sockaddr_in6 *)ip->get_sockaddr(ip); |
| if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)) |
| { /* skip addresses with a unusable scope */ |
| continue; |
| } |
| } |
| *out = ip; |
| return TRUE; |
| } |
| return FALSE; |
| } |
| |
| /** |
| * enumerator constructor for interfaces |
| */ |
| static enumerator_t *create_iface_enumerator(iface_entry_t *iface, |
| address_enumerator_t *data) |
| { |
| return enumerator_create_filter(iface->addrs->create_enumerator(iface->addrs), |
| filter_addresses, data, NULL); |
| } |
| |
| CALLBACK(filter_interfaces, bool, |
| address_enumerator_t *data, enumerator_t *orig, va_list args) |
| { |
| iface_entry_t *iface, **out; |
| |
| VA_ARGS_VGET(args, out); |
| |
| while (orig->enumerate(orig, &iface)) |
| { |
| if (!(data->which & ADDR_TYPE_IGNORED) && !iface->usable) |
| { /* skip interfaces excluded by config */ |
| continue; |
| } |
| if (!(data->which & ADDR_TYPE_LOOPBACK) && (iface->flags & IFF_LOOPBACK)) |
| { /* ignore loopback devices */ |
| continue; |
| } |
| if (!(data->which & ADDR_TYPE_DOWN) && !(iface->flags & IFF_UP)) |
| { /* skip interfaces not up */ |
| continue; |
| } |
| *out = iface; |
| return TRUE; |
| } |
| return FALSE; |
| } |
| |
| METHOD(kernel_net_t, create_address_enumerator, enumerator_t*, |
| private_kernel_pfroute_net_t *this, kernel_address_type_t which) |
| { |
| address_enumerator_t *data; |
| |
| INIT(data, |
| .this = this, |
| .which = which, |
| ); |
| |
| this->lock->read_lock(this->lock); |
| return enumerator_create_nested( |
| enumerator_create_filter( |
| this->ifaces->create_enumerator(this->ifaces), |
| filter_interfaces, data, NULL), |
| (void*)create_iface_enumerator, data, |
| address_enumerator_destroy); |
| } |
| |
| METHOD(kernel_net_t, get_features, kernel_feature_t, |
| private_kernel_pfroute_net_t *this) |
| { |
| return KERNEL_REQUIRE_EXCLUDE_ROUTE; |
| } |
| |
| METHOD(kernel_net_t, get_interface_name, bool, |
| private_kernel_pfroute_net_t *this, host_t* ip, char **name) |
| { |
| addr_map_entry_t *entry, lookup = { |
| .ip = ip, |
| }; |
| |
| if (ip->is_anyaddr(ip)) |
| { |
| return FALSE; |
| } |
| this->lock->read_lock(this->lock); |
| /* first try to find it on an up and usable interface */ |
| entry = this->addrs->get_match(this->addrs, &lookup, |
| (void*)addr_map_entry_match_up_and_usable); |
| if (entry) |
| { |
| if (name) |
| { |
| *name = strdup(entry->iface->ifname); |
| DBG2(DBG_KNL, "%H is on interface %s", ip, *name); |
| } |
| this->lock->unlock(this->lock); |
| return TRUE; |
| } |
| /* check if it is a virtual IP */ |
| entry = this->addrs->get_match(this->addrs, &lookup, |
| (void*)addr_map_entry_match_virtual); |
| if (entry) |
| { |
| if (name) |
| { |
| *name = strdup(entry->iface->ifname); |
| DBG2(DBG_KNL, "virtual IP %H is on interface %s", ip, *name); |
| } |
| this->lock->unlock(this->lock); |
| return TRUE; |
| } |
| /* maybe it is installed on an ignored interface */ |
| entry = this->addrs->get_match(this->addrs, &lookup, |
| (void*)addr_map_entry_match_up); |
| if (!entry) |
| { /* the address does not exist, is on a down interface */ |
| DBG2(DBG_KNL, "%H is not a local address or the interface is down", ip); |
| } |
| this->lock->unlock(this->lock); |
| return FALSE; |
| } |
| |
| METHOD(kernel_net_t, add_ip, status_t, |
| private_kernel_pfroute_net_t *this, host_t *vip, int prefix, |
| char *ifname) |
| { |
| enumerator_t *ifaces, *addrs; |
| iface_entry_t *iface; |
| addr_entry_t *addr; |
| tun_device_t *tun; |
| bool timeout = FALSE; |
| |
| if (!this->install_virtual_ip) |
| { /* disabled by config */ |
| return SUCCESS; |
| } |
| |
| tun = tun_device_create(NULL); |
| if (!tun) |
| { |
| return FAILED; |
| } |
| if (prefix == -1) |
| { |
| prefix = vip->get_address(vip).len * 8; |
| } |
| if (!tun->up(tun) || !tun->set_address(tun, vip, prefix)) |
| { |
| tun->destroy(tun); |
| return FAILED; |
| } |
| |
| /* wait until address appears */ |
| this->mutex->lock(this->mutex); |
| while (!timeout && !get_interface_name(this, vip, NULL)) |
| { |
| timeout = this->condvar->timed_wait(this->condvar, this->mutex, |
| this->vip_wait); |
| } |
| this->mutex->unlock(this->mutex); |
| if (timeout) |
| { |
| DBG1(DBG_KNL, "virtual IP %H did not appear on %s", |
| vip, tun->get_name(tun)); |
| tun->destroy(tun); |
| return FAILED; |
| } |
| |
| this->lock->write_lock(this->lock); |
| this->tuns->insert_last(this->tuns, tun); |
| |
| ifaces = this->ifaces->create_enumerator(this->ifaces); |
| while (ifaces->enumerate(ifaces, &iface)) |
| { |
| if (streq(iface->ifname, tun->get_name(tun))) |
| { |
| addrs = iface->addrs->create_enumerator(iface->addrs); |
| while (addrs->enumerate(addrs, &addr)) |
| { |
| if (addr->ip->ip_equals(addr->ip, vip)) |
| { |
| addr->virtual = TRUE; |
| } |
| } |
| addrs->destroy(addrs); |
| /* during IKEv1 reauthentication, children get moved from |
| * old the new SA before the virtual IP is available. This |
| * kills the route for our virtual IP, reinstall. */ |
| queue_route_reinstall(this, strdup(iface->ifname)); |
| break; |
| } |
| } |
| ifaces->destroy(ifaces); |
| /* lets do this while holding the lock, thus preventing another thread |
| * from deleting the TUN device concurrently, hopefully listeners are quick |
| * and cause no deadlocks */ |
| charon->kernel->tun(charon->kernel, tun, TRUE); |
| this->lock->unlock(this->lock); |
| |
| return SUCCESS; |
| } |
| |
| METHOD(kernel_net_t, del_ip, status_t, |
| private_kernel_pfroute_net_t *this, host_t *vip, int prefix, |
| bool wait) |
| { |
| enumerator_t *enumerator; |
| tun_device_t *tun; |
| host_t *addr; |
| bool timeout = FALSE, found = FALSE; |
| |
| if (!this->install_virtual_ip) |
| { /* disabled by config */ |
| return SUCCESS; |
| } |
| |
| this->lock->write_lock(this->lock); |
| enumerator = this->tuns->create_enumerator(this->tuns); |
| while (enumerator->enumerate(enumerator, &tun)) |
| { |
| addr = tun->get_address(tun, NULL); |
| if (addr && addr->ip_equals(addr, vip)) |
| { |
| this->tuns->remove_at(this->tuns, enumerator); |
| charon->kernel->tun(charon->kernel, tun, FALSE); |
| tun->destroy(tun); |
| found = TRUE; |
| break; |
| } |
| } |
| enumerator->destroy(enumerator); |
| this->lock->unlock(this->lock); |
| |
| if (!found) |
| { |
| return NOT_FOUND; |
| } |
| /* wait until address disappears */ |
| if (wait) |
| { |
| this->mutex->lock(this->mutex); |
| while (!timeout && get_interface_name(this, vip, NULL)) |
| { |
| timeout = this->condvar->timed_wait(this->condvar, this->mutex, |
| this->vip_wait); |
| } |
| this->mutex->unlock(this->mutex); |
| if (timeout) |
| { |
| DBG1(DBG_KNL, "virtual IP %H did not disappear from tun", vip); |
| return FAILED; |
| } |
| } |
| return SUCCESS; |
| } |
| |
| /** |
| * Append a sockaddr_in/in6 of given type to routing message |
| */ |
| static void add_rt_addr(struct rt_msghdr *hdr, int type, host_t *addr) |
| { |
| if (addr) |
| { |
| int len; |
| |
| len = *addr->get_sockaddr_len(addr); |
| memcpy((char*)hdr + hdr->rtm_msglen, addr->get_sockaddr(addr), len); |
| hdr->rtm_msglen += SA_LEN(len); |
| hdr->rtm_addrs |= type; |
| } |
| } |
| |
| /** |
| * Append a subnet mask sockaddr using the given prefix to routing message |
| */ |
| static void add_rt_mask(struct rt_msghdr *hdr, int type, int family, int prefix) |
| { |
| host_t *mask; |
| |
| mask = host_create_netmask(family, prefix); |
| if (mask) |
| { |
| add_rt_addr(hdr, type, mask); |
| mask->destroy(mask); |
| } |
| } |
| |
| /** |
| * Append an interface name sockaddr_dl to routing message |
| */ |
| static void add_rt_ifname(struct rt_msghdr *hdr, int type, char *name) |
| { |
| struct sockaddr_dl sdl = { |
| .sdl_len = sizeof(struct sockaddr_dl), |
| .sdl_family = AF_LINK, |
| .sdl_nlen = strlen(name), |
| }; |
| |
| if (strlen(name) <= sizeof(sdl.sdl_data)) |
| { |
| memcpy(sdl.sdl_data, name, sdl.sdl_nlen); |
| memcpy((char*)hdr + hdr->rtm_msglen, &sdl, sdl.sdl_len); |
| hdr->rtm_msglen += SA_LEN(sdl.sdl_len); |
| hdr->rtm_addrs |= type; |
| } |
| } |
| |
| /** |
| * Add or remove a route |
| */ |
| static status_t manage_route(private_kernel_pfroute_net_t *this, int op, |
| chunk_t dst_net, uint8_t prefixlen, |
| host_t *gateway, char *if_name) |
| { |
| struct { |
| struct rt_msghdr hdr; |
| char buf[sizeof(struct sockaddr_storage) * RTAX_MAX]; |
| } msg = { |
| .hdr = { |
| .rtm_version = RTM_VERSION, |
| .rtm_type = op, |
| .rtm_flags = RTF_UP | RTF_STATIC, |
| .rtm_pid = this->pid, |
| .rtm_seq = ref_get(&this->seq), |
| }, |
| }; |
| host_t *dst; |
| int type; |
| |
| if (prefixlen == 0 && dst_net.len) |
| { |
| status_t status; |
| chunk_t half; |
| |
| half = chunk_clonea(dst_net); |
| half.ptr[0] |= 0x80; |
| prefixlen = 1; |
| status = manage_route(this, op, half, prefixlen, gateway, if_name); |
| if (status != SUCCESS) |
| { |
| return status; |
| } |
| } |
| |
| dst = host_create_from_chunk(AF_UNSPEC, dst_net, 0); |
| if (!dst) |
| { |
| return FAILED; |
| } |
| |
| if ((dst->get_family(dst) == AF_INET && prefixlen == 32) || |
| (dst->get_family(dst) == AF_INET6 && prefixlen == 128)) |
| { |
| msg.hdr.rtm_flags |= RTF_HOST | RTF_GATEWAY; |
| } |
| |
| msg.hdr.rtm_msglen = sizeof(struct rt_msghdr); |
| for (type = 0; type < RTAX_MAX; type++) |
| { |
| switch (type) |
| { |
| case RTAX_DST: |
| add_rt_addr(&msg.hdr, RTA_DST, dst); |
| break; |
| case RTAX_NETMASK: |
| if (!(msg.hdr.rtm_flags & RTF_HOST)) |
| { |
| add_rt_mask(&msg.hdr, RTA_NETMASK, |
| dst->get_family(dst), prefixlen); |
| } |
| break; |
| case RTAX_IFP: |
| if (if_name) |
| { |
| add_rt_ifname(&msg.hdr, RTA_IFP, if_name); |
| } |
| break; |
| case RTAX_GATEWAY: |
| if (gateway && |
| gateway->get_family(gateway) == dst->get_family(dst)) |
| { |
| add_rt_addr(&msg.hdr, RTA_GATEWAY, gateway); |
| } |
| break; |
| default: |
| break; |
| } |
| } |
| dst->destroy(dst); |
| |
| if (send(this->socket, &msg, msg.hdr.rtm_msglen, 0) != msg.hdr.rtm_msglen) |
| { |
| if (errno == EEXIST) |
| { |
| return ALREADY_DONE; |
| } |
| DBG1(DBG_KNL, "%s PF_ROUTE route failed: %s", |
| op == RTM_ADD ? "adding" : "deleting", strerror(errno)); |
| return FAILED; |
| } |
| return SUCCESS; |
| } |
| |
| METHOD(kernel_net_t, add_route, status_t, |
| private_kernel_pfroute_net_t *this, chunk_t dst_net, uint8_t prefixlen, |
| host_t *gateway, host_t *src_ip, char *if_name, bool pass) |
| { |
| status_t status; |
| route_entry_t *found, route = { |
| .dst_net = dst_net, |
| .prefixlen = prefixlen, |
| .gateway = gateway, |
| .if_name = if_name, |
| }; |
| |
| this->routes_lock->lock(this->routes_lock); |
| found = this->routes->get(this->routes, &route); |
| if (found) |
| { |
| this->routes_lock->unlock(this->routes_lock); |
| return ALREADY_DONE; |
| } |
| status = manage_route(this, RTM_ADD, dst_net, prefixlen, gateway, if_name); |
| if (status == SUCCESS) |
| { |
| found = route_entry_clone(&route); |
| this->routes->put(this->routes, found, found); |
| } |
| this->routes_lock->unlock(this->routes_lock); |
| return status; |
| } |
| |
| METHOD(kernel_net_t, del_route, status_t, |
| private_kernel_pfroute_net_t *this, chunk_t dst_net, uint8_t prefixlen, |
| host_t *gateway, host_t *src_ip, char *if_name, bool pass) |
| { |
| status_t status; |
| route_entry_t *found, route = { |
| .dst_net = dst_net, |
| .prefixlen = prefixlen, |
| .gateway = gateway, |
| .if_name = if_name, |
| }; |
| |
| this->routes_lock->lock(this->routes_lock); |
| found = this->routes->get(this->routes, &route); |
| if (!found) |
| { |
| this->routes_lock->unlock(this->routes_lock); |
| return NOT_FOUND; |
| } |
| this->routes->remove(this->routes, found); |
| route_entry_destroy(found); |
| status = manage_route(this, RTM_DELETE, dst_net, prefixlen, gateway, |
| if_name); |
| this->routes_lock->unlock(this->routes_lock); |
| return status; |
| } |
| |
| /** |
| * Do a route lookup for dest and return either the nexthop or the source |
| * address. |
| */ |
| static host_t *get_route(private_kernel_pfroute_net_t *this, bool nexthop, |
| host_t *dest, host_t *src, char **iface) |
| { |
| struct { |
| struct rt_msghdr hdr; |
| char buf[sizeof(struct sockaddr_storage) * RTAX_MAX]; |
| } msg = { |
| .hdr = { |
| .rtm_version = RTM_VERSION, |
| .rtm_type = RTM_GET, |
| .rtm_pid = this->pid, |
| .rtm_seq = ref_get(&this->seq), |
| }, |
| }; |
| host_t *host = NULL; |
| enumerator_t *enumerator; |
| struct sockaddr *addr; |
| bool failed = FALSE; |
| int type; |
| |
| retry: |
| msg.hdr.rtm_msglen = sizeof(struct rt_msghdr); |
| for (type = 0; type < RTAX_MAX; type++) |
| { |
| switch (type) |
| { |
| case RTAX_DST: |
| add_rt_addr(&msg.hdr, RTA_DST, dest); |
| break; |
| case RTAX_IFA: |
| add_rt_addr(&msg.hdr, RTA_IFA, src); |
| break; |
| case RTAX_IFP: |
| if (!nexthop) |
| { /* add an empty IFP to ensure we get a source address */ |
| add_rt_ifname(&msg.hdr, RTA_IFP, ""); |
| } |
| break; |
| default: |
| break; |
| } |
| } |
| this->mutex->lock(this->mutex); |
| |
| while (this->waiting_seq) |
| { |
| this->condvar->wait(this->condvar, this->mutex); |
| } |
| this->waiting_seq = msg.hdr.rtm_seq; |
| if (send(this->socket, &msg, msg.hdr.rtm_msglen, 0) == msg.hdr.rtm_msglen) |
| { |
| while (TRUE) |
| { |
| if (this->condvar->timed_wait(this->condvar, this->mutex, 1000)) |
| { /* timed out? */ |
| break; |
| } |
| if (!this->reply) |
| { |
| continue; |
| } |
| enumerator = create_rtmsg_enumerator(this->reply); |
| while (enumerator->enumerate(enumerator, &type, &addr)) |
| { |
| if (nexthop) |
| { |
| if (type == RTAX_DST && this->reply->rtm_flags & RTF_HOST) |
| { /* probably a cloned/cached direct route, only use that |
| * as fallback if no gateway is found */ |
| host = host ?: host_create_from_sockaddr(addr); |
| } |
| if (type == RTAX_GATEWAY) |
| { /* could actually be a MAC address */ |
| host_t *gtw = host_create_from_sockaddr(addr); |
| if (gtw) |
| { |
| DESTROY_IF(host); |
| host = gtw; |
| } |
| } |
| if (type == RTAX_IFP && addr->sa_family == AF_LINK) |
| { |
| struct sockaddr_dl *sdl = (struct sockaddr_dl*)addr; |
| if (iface) |
| { |
| free(*iface); |
| *iface = strndup(sdl->sdl_data, sdl->sdl_nlen); |
| } |
| } |
| } |
| else |
| { |
| if (type == RTAX_IFA) |
| { |
| host = host_create_from_sockaddr(addr); |
| } |
| } |
| } |
| enumerator->destroy(enumerator); |
| break; |
| } |
| } |
| else |
| { |
| failed = TRUE; |
| } |
| free(this->reply); |
| this->reply = NULL; |
| /* signal completion of query to a waiting thread */ |
| this->waiting_seq = 0; |
| this->condvar->signal(this->condvar); |
| this->mutex->unlock(this->mutex); |
| |
| if (failed) |
| { |
| if (src) |
| { /* the given source address might be gone, try again without */ |
| src = NULL; |
| msg.hdr.rtm_seq = ref_get(&this->seq); |
| msg.hdr.rtm_addrs = 0; |
| memset(msg.buf, 0, sizeof(msg.buf)); |
| goto retry; |
| } |
| DBG1(DBG_KNL, "PF_ROUTE lookup failed: %s", strerror(errno)); |
| } |
| if (nexthop) |
| { |
| host = host ?: dest->clone(dest); |
| } |
| else |
| { /* make sure the source address is not virtual and usable */ |
| addr_entry_t *entry, lookup = { |
| .ip = host, |
| }; |
| |
| if (!host) |
| { |
| return NULL; |
| } |
| this->lock->read_lock(this->lock); |
| entry = this->addrs->get_match(this->addrs, &lookup, |
| (void*)addr_map_entry_match_up_and_usable); |
| this->lock->unlock(this->lock); |
| if (!entry) |
| { |
| host->destroy(host); |
| return NULL; |
| } |
| } |
| DBG2(DBG_KNL, "using %H as %s to reach %H", host, |
| nexthop ? "nexthop" : "address", dest); |
| return host; |
| } |
| |
| METHOD(kernel_net_t, get_source_addr, host_t*, |
| private_kernel_pfroute_net_t *this, host_t *dest, host_t *src) |
| { |
| return get_route(this, FALSE, dest, src, NULL); |
| } |
| |
| METHOD(kernel_net_t, get_nexthop, host_t*, |
| private_kernel_pfroute_net_t *this, host_t *dest, int prefix, host_t *src, |
| char **iface) |
| { |
| if (iface) |
| { |
| *iface = NULL; |
| } |
| return get_route(this, TRUE, dest, src, iface); |
| } |
| |
| /** |
| * Get the number of set bits in the given netmask |
| */ |
| static uint8_t sockaddr_to_netmask(sockaddr_t *sockaddr, host_t *dst) |
| { |
| uint8_t len = 0, i, byte, mask = 0; |
| struct sockaddr_storage ss; |
| char *addr; |
| |
| /* at least some older FreeBSD versions send us shorter sockaddrs |
| * with the family set to -1 (255) */ |
| if (sockaddr->sa_family == 255) |
| { |
| memset(&ss, 0, sizeof(ss)); |
| memcpy(&ss, sockaddr, sockaddr->sa_len); |
| /* use the address family and length of the destination as hint */ |
| ss.ss_len = *dst->get_sockaddr_len(dst); |
| ss.ss_family = dst->get_family(dst); |
| sockaddr = (sockaddr_t*)&ss; |
| } |
| |
| switch (sockaddr->sa_family) |
| { |
| case AF_INET: |
| len = 4; |
| addr = (char*)&((struct sockaddr_in*)sockaddr)->sin_addr; |
| break; |
| case AF_INET6: |
| len = 16; |
| addr = (char*)&((struct sockaddr_in6*)sockaddr)->sin6_addr; |
| break; |
| default: |
| break; |
| } |
| |
| for (i = 0; i < len; i++) |
| { |
| byte = addr[i]; |
| |
| if (byte == 0x00) |
| { |
| break; |
| } |
| if (byte == 0xff) |
| { |
| mask += 8; |
| } |
| else |
| { |
| while (byte & 0x80) |
| { |
| mask++; |
| byte <<= 1; |
| } |
| } |
| } |
| return mask; |
| } |
| |
| /** enumerator over subnets */ |
| typedef struct { |
| enumerator_t public; |
| /** sysctl result */ |
| char *buf; |
| /** length of the complete result */ |
| size_t len; |
| /** start of the current route entry */ |
| char *current; |
| /** last subnet enumerated */ |
| host_t *net; |
| /** interface of current net */ |
| char *ifname; |
| } subnet_enumerator_t; |
| |
| METHOD(enumerator_t, destroy_subnet_enumerator, void, |
| subnet_enumerator_t *this) |
| { |
| DESTROY_IF(this->net); |
| free(this->ifname); |
| free(this->buf); |
| free(this); |
| } |
| |
| METHOD(enumerator_t, enumerate_subnets, bool, |
| subnet_enumerator_t *this, va_list args) |
| { |
| enumerator_t *enumerator; |
| host_t **net; |
| struct rt_msghdr *rtm; |
| struct sockaddr *addr; |
| uint8_t *mask; |
| char **ifname; |
| int type; |
| |
| VA_ARGS_VGET(args, net, mask, ifname); |
| |
| if (!this->current) |
| { |
| this->current = this->buf; |
| } |
| else |
| { |
| rtm = (struct rt_msghdr*)this->current; |
| this->current += rtm->rtm_msglen; |
| DESTROY_IF(this->net); |
| this->net = NULL; |
| free(this->ifname); |
| this->ifname = NULL; |
| } |
| |
| for (; this->current < this->buf + this->len; |
| this->current += rtm->rtm_msglen) |
| { |
| struct sockaddr *netmask = NULL; |
| uint8_t netbits = 0; |
| |
| rtm = (struct rt_msghdr*)this->current; |
| |
| if (rtm->rtm_version != RTM_VERSION) |
| { |
| continue; |
| } |
| if (rtm->rtm_flags & RTF_GATEWAY || |
| rtm->rtm_flags & RTF_HOST || |
| rtm->rtm_flags & RTF_REJECT) |
| { |
| continue; |
| } |
| enumerator = create_rtmsg_enumerator(rtm); |
| while (enumerator->enumerate(enumerator, &type, &addr)) |
| { |
| if (type == RTAX_DST) |
| { |
| this->net = this->net ?: host_create_from_sockaddr(addr); |
| } |
| if (type == RTAX_NETMASK) |
| { |
| netmask = addr; |
| } |
| if (type == RTAX_IFP && addr->sa_family == AF_LINK) |
| { |
| struct sockaddr_dl *sdl = (struct sockaddr_dl*)addr; |
| free(this->ifname); |
| this->ifname = strndup(sdl->sdl_data, sdl->sdl_nlen); |
| } |
| } |
| if (this->net && netmask) |
| { |
| netbits = sockaddr_to_netmask(netmask, this->net); |
| } |
| enumerator->destroy(enumerator); |
| |
| if (this->net && this->ifname) |
| { |
| *net = this->net; |
| *mask = netbits ?: this->net->get_address(this->net).len * 8; |
| *ifname = this->ifname; |
| return TRUE; |
| } |
| } |
| return FALSE; |
| } |
| |
| METHOD(kernel_net_t, create_local_subnet_enumerator, enumerator_t*, |
| private_kernel_pfroute_net_t *this) |
| { |
| subnet_enumerator_t *enumerator; |
| char *buf; |
| size_t len; |
| int mib[7] = { |
| CTL_NET, PF_ROUTE, 0, AF_UNSPEC, NET_RT_DUMP, 0, 0 |
| }; |
| |
| if (sysctl(mib, countof(mib), NULL, &len, NULL, 0) < 0) |
| { |
| DBG2(DBG_KNL, "enumerating local subnets failed"); |
| return enumerator_create_empty(); |
| } |
| buf = malloc(len); |
| if (sysctl(mib, countof(mib), buf, &len, NULL, 0) < 0) |
| { |
| DBG2(DBG_KNL, "enumerating local subnets failed"); |
| free(buf); |
| return enumerator_create_empty(); |
| } |
| |
| INIT(enumerator, |
| .public = { |
| .enumerate = enumerator_enumerate_default, |
| .venumerate = _enumerate_subnets, |
| .destroy = _destroy_subnet_enumerator, |
| }, |
| .buf = buf, |
| .len = len, |
| ); |
| return &enumerator->public; |
| } |
| |
| /** |
| * Initialize a list of local addresses. |
| */ |
| static status_t init_address_list(private_kernel_pfroute_net_t *this) |
| { |
| struct ifaddrs *ifap, *ifa; |
| iface_entry_t *iface, *current; |
| addr_entry_t *addr; |
| enumerator_t *ifaces, *addrs; |
| |
| DBG2(DBG_KNL, "known interfaces and IP addresses:"); |
| |
| if (getifaddrs(&ifap) < 0) |
| { |
| DBG1(DBG_KNL, " failed to get interfaces!"); |
| return FAILED; |
| } |
| |
| for (ifa = ifap; ifa != NULL; ifa = ifa->ifa_next) |
| { |
| if (ifa->ifa_addr == NULL) |
| { |
| continue; |
| } |
| switch(ifa->ifa_addr->sa_family) |
| { |
| case AF_LINK: |
| case AF_INET: |
| case AF_INET6: |
| { |
| iface = NULL; |
| ifaces = this->ifaces->create_enumerator(this->ifaces); |
| while (ifaces->enumerate(ifaces, ¤t)) |
| { |
| if (streq(current->ifname, ifa->ifa_name)) |
| { |
| iface = current; |
| break; |
| } |
| } |
| ifaces->destroy(ifaces); |
| |
| if (!iface) |
| { |
| INIT(iface, |
| .ifindex = if_nametoindex(ifa->ifa_name), |
| .flags = ifa->ifa_flags, |
| .addrs = linked_list_create(), |
| .usable = charon->kernel->is_interface_usable( |
| charon->kernel, ifa->ifa_name), |
| ); |
| memcpy(iface->ifname, ifa->ifa_name, IFNAMSIZ); |
| this->ifaces->insert_last(this->ifaces, iface); |
| } |
| |
| if (ifa->ifa_addr->sa_family != AF_LINK) |
| { |
| INIT(addr, |
| .ip = host_create_from_sockaddr(ifa->ifa_addr), |
| ); |
| iface->addrs->insert_last(iface->addrs, addr); |
| addr_map_entry_add(this, addr, iface); |
| } |
| } |
| } |
| } |
| freeifaddrs(ifap); |
| |
| ifaces = this->ifaces->create_enumerator(this->ifaces); |
| while (ifaces->enumerate(ifaces, &iface)) |
| { |
| if (iface->usable && iface->flags & IFF_UP) |
| { |
| DBG2(DBG_KNL, " %s", iface->ifname); |
| addrs = iface->addrs->create_enumerator(iface->addrs); |
| while (addrs->enumerate(addrs, (void**)&addr)) |
| { |
| DBG2(DBG_KNL, " %H", addr->ip); |
| } |
| addrs->destroy(addrs); |
| } |
| } |
| ifaces->destroy(ifaces); |
| |
| return SUCCESS; |
| } |
| |
| METHOD(kernel_net_t, destroy, void, |
| private_kernel_pfroute_net_t *this) |
| { |
| enumerator_t *enumerator; |
| route_entry_t *route; |
| |
| enumerator = this->routes->create_enumerator(this->routes); |
| while (enumerator->enumerate(enumerator, NULL, (void**)&route)) |
| { |
| manage_route(this, RTM_DELETE, route->dst_net, route->prefixlen, |
| route->gateway, route->if_name); |
| route_entry_destroy(route); |
| } |
| enumerator->destroy(enumerator); |
| this->routes->destroy(this->routes); |
| this->routes_lock->destroy(this->routes_lock); |
| |
| if (this->socket != -1) |
| { |
| lib->watcher->remove(lib->watcher, this->socket); |
| close(this->socket); |
| } |
| |
| net_changes_clear(this); |
| this->net_changes->destroy(this->net_changes); |
| this->net_changes_lock->destroy(this->net_changes_lock); |
| |
| this->addrs->ht.destroy_function(&this->addrs->ht, (void*)free); |
| this->ifaces->destroy_function(this->ifaces, (void*)iface_entry_destroy); |
| this->tuns->destroy(this->tuns); |
| this->lock->destroy(this->lock); |
| this->mutex->destroy(this->mutex); |
| this->condvar->destroy(this->condvar); |
| this->roam_lock->destroy(this->roam_lock); |
| free(this->reply); |
| free(this); |
| } |
| |
| /* |
| * Described in header. |
| */ |
| kernel_pfroute_net_t *kernel_pfroute_net_create() |
| { |
| private_kernel_pfroute_net_t *this; |
| |
| INIT(this, |
| .public = { |
| .interface = { |
| .get_features = _get_features, |
| .get_interface = _get_interface_name, |
| .create_address_enumerator = _create_address_enumerator, |
| .create_local_subnet_enumerator = _create_local_subnet_enumerator, |
| .get_source_addr = _get_source_addr, |
| .get_nexthop = _get_nexthop, |
| .add_ip = _add_ip, |
| .del_ip = _del_ip, |
| .add_route = _add_route, |
| .del_route = _del_route, |
| .destroy = _destroy, |
| }, |
| }, |
| .pid = getpid(), |
| .ifaces = linked_list_create(), |
| .addrs = hashlist_create( |
| (hashtable_hash_t)addr_map_entry_hash, |
| (hashtable_equals_t)addr_map_entry_equals, 16), |
| .routes = hashtable_create((hashtable_hash_t)route_entry_hash, |
| (hashtable_equals_t)route_entry_equals, 16), |
| .net_changes = hashtable_create( |
| (hashtable_hash_t)net_change_hash, |
| (hashtable_equals_t)net_change_equals, 16), |
| .tuns = linked_list_create(), |
| .lock = rwlock_create(RWLOCK_TYPE_DEFAULT), |
| .mutex = mutex_create(MUTEX_TYPE_DEFAULT), |
| .condvar = condvar_create(CONDVAR_TYPE_DEFAULT), |
| .routes_lock = mutex_create(MUTEX_TYPE_DEFAULT), |
| .net_changes_lock = mutex_create(MUTEX_TYPE_DEFAULT), |
| .roam_lock = spinlock_create(), |
| .vip_wait = lib->settings->get_int(lib->settings, |
| "%s.plugins.kernel-pfroute.vip_wait", 1000, lib->ns), |
| .install_virtual_ip = lib->settings->get_bool(lib->settings, |
| "%s.install_virtual_ip", TRUE, lib->ns), |
| ); |
| timerclear(&this->last_route_reinstall); |
| timerclear(&this->next_roam); |
| |
| /* create a PF_ROUTE socket to communicate with the kernel */ |
| this->socket = socket(PF_ROUTE, SOCK_RAW, AF_UNSPEC); |
| if (this->socket == -1) |
| { |
| DBG1(DBG_KNL, "unable to create PF_ROUTE socket"); |
| destroy(this); |
| return NULL; |
| } |
| |
| if (streq(lib->ns, "starter")) |
| { |
| /* starter has no threads, so we do not register for kernel events */ |
| if (shutdown(this->socket, SHUT_RD) != 0) |
| { |
| DBG1(DBG_KNL, "closing read end of PF_ROUTE socket failed: %s", |
| strerror(errno)); |
| } |
| } |
| else |
| { |
| lib->watcher->add(lib->watcher, this->socket, WATCHER_READ, |
| (watcher_cb_t)receive_events, this); |
| } |
| if (init_address_list(this) != SUCCESS) |
| { |
| DBG1(DBG_KNL, "unable to get interface list"); |
| destroy(this); |
| return NULL; |
| } |
| |
| return &this->public; |
| } |