Add default gateway and DHCP handling (not fully working yet because of a kernel...
[oweals/relayd.git] / main.c
diff --git a/main.c b/main.c
index 62d7c2b25fd72e3d2fdbd6418755b9a2a337abae..ef669faa26aceb7b17cd611020ed306ae5bc9f0b 100644 (file)
--- a/main.c
+++ b/main.c
@@ -31,6 +31,7 @@
 
 #include "relayd.h"
 
+static LIST_HEAD(pending_routes);
 LIST_HEAD(interfaces);
 int debug;
 
@@ -39,6 +40,12 @@ static int inet_sock;
 static int forward_bcast;
 static int forward_dhcp;
 
+struct relayd_pending_route {
+       struct relayd_route rt;
+       struct uloop_timeout timeout;
+       uint8_t gateway[4];
+};
+
 static struct relayd_host *find_host_by_ipaddr(struct relayd_interface *rif, const uint8_t *ipaddr)
 {
        struct relayd_host *host;
@@ -81,20 +88,55 @@ static void add_arp(struct relayd_host *host)
        ioctl(inet_sock, SIOCSARP, &arp);
 }
 
+static void timeout_host_route(struct uloop_timeout *timeout)
+{
+       struct relayd_pending_route *rt;
+
+       rt = container_of(timeout, struct relayd_pending_route, timeout);
+       list_del(&rt->rt.list);
+       free(rt);
+}
+
+void relayd_add_host_route(struct relayd_host *host, const uint8_t *dest, uint8_t mask)
+{
+       struct relayd_route *rt;
+
+       list_for_each_entry(rt, &host->routes, list) {
+               if (!memcmp(rt->dest, dest, sizeof(rt->dest)) && rt->mask == mask)
+                       return;
+       }
+
+       rt = calloc(1, sizeof(*rt));
+       if (!rt)
+               return;
+
+       list_add(&rt->list, &host->routes);
+       memcpy(rt->dest, dest, sizeof(rt->dest));
+       rt->mask = mask;
+       relayd_add_route(host, rt);
+}
+
 static void del_host(struct relayd_host *host)
 {
+       struct relayd_route *route, *tmp;
+
        DPRINTF(1, "%s: deleting host "IP_FMT" ("MAC_FMT")\n", host->rif->ifname,
                IP_BUF(host->ipaddr), MAC_BUF(host->lladdr));
 
+       list_for_each_entry_safe(route, tmp, &host->routes, list) {
+               relayd_del_route(host, route);
+               list_del(&route->list);
+               free(route);
+       }
        if (host->rif->managed)
-               relayd_del_route(host);
+               relayd_del_route(host, NULL);
        uloop_timeout_cancel(&host->timeout);
        list_del(&host->list);
        free(host);
 }
 
 static void fill_arp_request(struct arp_packet *pkt, struct relayd_interface *rif,
-                             uint8_t spa[4], uint8_t tpa[4])
+                             const uint8_t spa[4], const uint8_t tpa[4])
 {
        memset(pkt, 0, sizeof(*pkt));
 
@@ -111,12 +153,11 @@ static void fill_arp_request(struct arp_packet *pkt, struct relayd_interface *ri
        pkt->arp.arp_pln = 4;
 }
 
-static void send_arp_request(struct relayd_host *host)
+static void send_arp_request(struct relayd_interface *rif, const uint8_t *ipaddr)
 {
-       struct relayd_interface *rif = host->rif;
        struct arp_packet pkt;
 
-       fill_arp_request(&pkt, host->rif, host->rif->src_ip, host->ipaddr);
+       fill_arp_request(&pkt, rif, rif->src_ip, ipaddr);
 
        pkt.arp.arp_op = htons(ARPOP_REQUEST);
        memcpy(pkt.arp.arp_spa, rif->src_ip, ETH_ALEN);
@@ -131,6 +172,36 @@ static void send_arp_request(struct relayd_host *host)
                (struct sockaddr *) &rif->sll, sizeof(rif->sll));
 }
 
+void relayd_add_pending_route(const uint8_t *gateway, const uint8_t *dest, uint8_t mask, int timeout)
+{
+       struct relayd_pending_route *rt;
+       struct relayd_interface *rif;
+       struct relayd_host *host;
+
+       host = find_host_by_ipaddr(NULL, gateway);
+       if (host) {
+               relayd_add_host_route(host, dest, mask);
+               return;
+       }
+
+       rt = calloc(1, sizeof(*rt));
+       if (!rt)
+               return;
+
+       memcpy(rt->gateway, gateway, sizeof(rt->gateway));
+       memcpy(rt->rt.dest, dest, sizeof(rt->rt.dest));
+       rt->rt.mask = mask;
+       list_add(&rt->rt.list, &pending_routes);
+       if (timeout <= 0)
+               return;
+
+       rt->timeout.cb = timeout_host_route;
+       uloop_timeout_set(&rt->timeout, 10000);
+       list_for_each_entry(rif, &interfaces, list) {
+               send_arp_request(rif, gateway);
+       }
+}
+
 static void send_arp_reply(struct relayd_interface *rif, uint8_t spa[4],
                            uint8_t tha[ETH_ALEN], uint8_t tpa[4])
 {
@@ -162,7 +233,7 @@ static void host_entry_timeout(struct uloop_timeout *timeout)
         * giving up on it.
         */
        if (host->rif->managed && host->cleanup_pending < 2) {
-               send_arp_request(host);
+               send_arp_request(host->rif, host->ipaddr);
                host->cleanup_pending++;
                uloop_timeout_set(&host->timeout, 1000);
                return;
@@ -173,11 +244,13 @@ static void host_entry_timeout(struct uloop_timeout *timeout)
 static struct relayd_host *add_host(struct relayd_interface *rif, const uint8_t *lladdr, const uint8_t *ipaddr)
 {
        struct relayd_host *host;
+       struct relayd_pending_route *route, *rtmp;
 
        DPRINTF(1, "%s: adding host "IP_FMT" ("MAC_FMT")\n", rif->ifname,
                        IP_BUF(ipaddr), MAC_BUF(lladdr));
 
        host = calloc(1, sizeof(*host));
+       INIT_LIST_HEAD(&host->routes);
        host->rif = rif;
        memcpy(host->ipaddr, ipaddr, sizeof(host->ipaddr));
        memcpy(host->lladdr, lladdr, sizeof(host->lladdr));
@@ -187,7 +260,20 @@ static struct relayd_host *add_host(struct relayd_interface *rif, const uint8_t
 
        add_arp(host);
        if (rif->managed)
-               relayd_add_route(host);
+               relayd_add_route(host, NULL);
+
+       list_for_each_entry_safe(route, rtmp, &pending_routes, rt.list) {
+               if (memcmp(route->gateway, ipaddr, 4) != 0)
+                       continue;
+
+               relayd_add_host_route(host, route->rt.dest, route->rt.mask);
+               if (!route->timeout.pending)
+                       continue;
+
+               uloop_timeout_cancel(&route->timeout);
+               list_del(&route->rt.list);
+               free(route);
+       }
 
        return host;
 }
@@ -207,8 +293,10 @@ struct relayd_host *relayd_refresh_host(struct relayd_interface *rif, const uint
                 * If the old entry is behind a managed interface, it will be pinged
                 * before we expire it
                 */
-               if (host && !host->cleanup_pending)
+               if (host && !host->cleanup_pending) {
                        uloop_timeout_set(&host->timeout, 1);
+                       return NULL;
+               }
 
                host = add_host(rif, lladdr, ipaddr);
        } else {
@@ -281,7 +369,8 @@ static void recv_arp_reply(struct relayd_interface *rif, struct arp_packet *pkt)
                MAC_BUF(pkt->eth.ether_shost),
                IP_BUF(pkt->arp.arp_tpa));
 
-       relayd_refresh_host(rif, pkt->arp.arp_sha, pkt->arp.arp_spa);
+       if (memcmp(pkt->arp.arp_sha, rif->sll.sll_addr, ETH_ALEN) != 0)
+               relayd_refresh_host(rif, pkt->arp.arp_sha, pkt->arp.arp_spa);
 
        if (!memcmp(pkt->arp.arp_tpa, rif->src_ip, 4))
                return;
@@ -459,6 +548,16 @@ static int init_interface(struct relayd_interface *rif)
        return 0;
 }
 
+static void ping_static_routes(void)
+{
+       struct relayd_pending_route *rt;
+       struct relayd_interface *rif;
+
+       list_for_each_entry(rt, &pending_routes, rt.list)
+               list_for_each_entry(rif, &interfaces, list)
+                       send_arp_request(rif, rt->gateway);
+}
+
 static int init_interfaces(void)
 {
        struct relayd_interface *rif;
@@ -496,24 +595,23 @@ static void free_interfaces(void)
        }
 }
 
-static int alloc_interface(const char *ifname, bool managed)
+static struct relayd_interface *alloc_interface(const char *ifname, bool managed)
 {
        struct relayd_interface *rif;
 
        if (strlen(ifname) >= IFNAMSIZ)
-               return -1;
+               return NULL;
 
        rif = calloc(1, sizeof(*rif));
        if (!rif)
-               return -1;
+               return NULL;
 
-       INIT_LIST_HEAD(&rif->list);
        INIT_LIST_HEAD(&rif->hosts);
        strcpy(rif->ifname, ifname);
        list_add(&rif->list, &interfaces);
        rif->managed = managed;
 
-       return 0;
+       return rif;
 }
 
 static void die(int signo)
@@ -536,6 +634,7 @@ static int usage(const char *progname)
                        "       -i <ifname>     Add an interface for relaying\n"
                        "       -I <ifname>     Same as -i, except with ARP cache and host route management\n"
                        "                       You need to specify at least two interfaces\n"
+                       "       -G <ip>         Set a gateway IP for clients\n"
                        "       -t <timeout>    Host entry expiry timeout\n"
                        "       -T <table>      Set routing table number for automatically added routes\n"
                        "       -B              Enable broadcast forwarding\n"
@@ -547,6 +646,8 @@ static int usage(const char *progname)
 
 int main(int argc, char **argv)
 {
+       struct relayd_interface *rif = NULL;
+       struct in_addr addr;
        bool managed;
        int ifnum = 0;
        int ch;
@@ -562,14 +663,15 @@ int main(int argc, char **argv)
        forward_bcast = 0;
        uloop_init();
 
-       while ((ch = getopt(argc, argv, "I:i:t:BDdT:")) != -1) {
+       while ((ch = getopt(argc, argv, "I:i:t:BDdT:G:")) != -1) {
                switch(ch) {
                case 'I':
                        managed = true;
                        /* fall through */
                case 'i':
                        ifnum++;
-                       if (alloc_interface(optarg, managed) < 0)
+                       rif = alloc_interface(optarg, managed);
+                       if (!rif)
                                return 1;
 
                        managed = false;
@@ -593,6 +695,13 @@ int main(int argc, char **argv)
                        if (route_table <= 0)
                                return usage(argv[0]);
                        break;
+               case 'G':
+                       if (!inet_aton(optarg, &addr)) {
+                               fprintf(stderr, "Address '%s' not found\n", optarg);
+                               return 1;
+                       }
+                       relayd_add_pending_route((uint8_t *) &addr.s_addr, (const uint8_t *) "\x00\x00\x00\x00", 0, 0);
+                       break;
                case '?':
                default:
                        return usage(argv[0]);
@@ -621,6 +730,8 @@ int main(int argc, char **argv)
        if (init_interfaces() < 0)
                return 1;
 
+       ping_static_routes();
+
        uloop_run();
        uloop_done();