main.c

   1 /*
   2  *   Copyright (C) 2010 Felix Fietkau <nbd@openwrt.org>
   3  *
   4  *   This program is free software; you can redistribute it and/or modify
   5  *   it under the terms of the GNU General Public License v2 as published by
   6  *   the Free Software Foundation.
   7  *
   8  *   This program is distributed in the hope that it will be useful,
   9  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11  *   GNU General Public License for more details.
  12  *
  13  *   You should have received a copy of the GNU General Public License
  14  *   along with this program; if not, write to the Free Software
  15  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
  16  *
  17  */
  18 #include <sys/ioctl.h>
  19 #include <sys/socket.h>
  20
  21 #include <stdio.h>
  22 #include <unistd.h>
  23 #include <fcntl.h>
  24 #include <stddef.h>
  25 #include <stdlib.h>
  26 #include <stdint.h>
  27 #include <stdbool.h>
  28 #include <errno.h>
  29 #include <signal.h>
  30 #include <string.h>
  31
  32 #include "relayd.h"
  33
  34 static LIST_HEAD(pending_routes);
  35 LIST_HEAD(interfaces);
  36 int debug;
  37
  38 static int host_timeout;
  39 static int host_ping_tries;
  40 static int inet_sock;
  41 static int forward_bcast;
  42 static int forward_dhcp;
  43
  44 uint8_t local_addr[4];
  45 int local_route_table;
  46
  47 struct relayd_pending_route {
  48         struct relayd_route rt;
  49         struct uloop_timeout timeout;
  50         uint8_t gateway[4];
  51 };
  52
  53 static struct relayd_host *find_host_by_ipaddr(struct relayd_interface *rif, const uint8_t *ipaddr)
  54 {
  55         struct relayd_host *host;
  56
  57         if (!rif) {
  58                 list_for_each_entry(rif, &interfaces, list) {
  59                         host = find_host_by_ipaddr(rif, ipaddr);
  60                         if (!host)
  61                                 continue;
  62
  63                         return host;
  64                 }
  65                 return NULL;
  66         }
  67
  68         list_for_each_entry(host, &rif->hosts, list) {
  69                 if (memcmp(ipaddr, host->ipaddr, sizeof(host->ipaddr)) != 0)
  70                         continue;
  71
  72                 return host;
  73         }
  74         return NULL;
  75 }
  76
  77 static void add_arp(struct relayd_host *host)
  78 {
  79         struct sockaddr_in *sin;
  80         struct arpreq arp;
  81
  82         strncpy(arp.arp_dev, host->rif->ifname, sizeof(arp.arp_dev));
  83         arp.arp_flags = ATF_COM;
  84
  85         arp.arp_ha.sa_family = ARPHRD_ETHER;
  86         memcpy(arp.arp_ha.sa_data, host->lladdr, ETH_ALEN);
  87
  88         sin = (struct sockaddr_in *) &arp.arp_pa;
  89         sin->sin_family = AF_INET;
  90         memcpy(&sin->sin_addr, host->ipaddr, sizeof(host->ipaddr));
  91
  92         ioctl(inet_sock, SIOCSARP, &arp);
  93 }
  94
  95 static void timeout_host_route(struct uloop_timeout *timeout)
  96 {
  97         struct relayd_pending_route *rt;
  98
  99         rt = container_of(timeout, struct relayd_pending_route, timeout);
 100         list_del(&rt->rt.list);
 101         free(rt);
 102 }
 103
 104 void relayd_add_host_route(struct relayd_host *host, const uint8_t *dest, uint8_t mask)
 105 {
 106         struct relayd_route *rt;
 107
 108         list_for_each_entry(rt, &host->routes, list) {
 109                 if (!memcmp(rt->dest, dest, sizeof(rt->dest)) && rt->mask == mask)
 110                         return;
 111         }
 112
 113         rt = calloc(1, sizeof(*rt));
 114         if (!rt)
 115                 return;
 116
 117         list_add(&rt->list, &host->routes);
 118         memcpy(rt->dest, dest, sizeof(rt->dest));
 119         rt->mask = mask;
 120         relayd_add_route(host, rt);
 121 }
 122
 123 static void del_host(struct relayd_host *host)
 124 {
 125         struct relayd_route *route, *tmp;
 126
 127         DPRINTF(1, "%s: deleting host "IP_FMT" ("MAC_FMT")\n", host->rif->ifname,
 128                 IP_BUF(host->ipaddr), MAC_BUF(host->lladdr));
 129
 130         list_for_each_entry_safe(route, tmp, &host->routes, list) {
 131                 relayd_del_route(host, route);
 132                 list_del(&route->list);
 133                 free(route);
 134         }
 135         if (host->rif->managed)
 136                 relayd_del_route(host, NULL);
 137         uloop_timeout_cancel(&host->timeout);
 138         list_del(&host->list);
 139         free(host);
 140 }
 141
 142 static void fill_arp_packet(struct arp_packet *pkt, struct relayd_interface *rif,
 143                              const uint8_t spa[4], const uint8_t tpa[4])
 144 {
 145         memset(pkt, 0, sizeof(*pkt));
 146
 147         pkt->eth.ether_type = htons(ETHERTYPE_ARP);
 148         memcpy(pkt->eth.ether_shost, rif->sll.sll_addr, ETH_ALEN);
 149
 150         memcpy(pkt->arp.arp_sha, rif->sll.sll_addr, ETH_ALEN);
 151         memcpy(pkt->arp.arp_spa, spa, 4);
 152         memcpy(pkt->arp.arp_tpa, tpa, 4);
 153
 154         pkt->arp.arp_hrd = htons(ARPHRD_ETHER);
 155         pkt->arp.arp_pro = htons(ETH_P_IP);
 156         pkt->arp.arp_hln = ETH_ALEN;
 157         pkt->arp.arp_pln = 4;
 158 }
 159
 160 static void send_arp_request(struct relayd_interface *rif, const uint8_t *ipaddr)
 161 {
 162         struct arp_packet pkt;
 163
 164         fill_arp_packet(&pkt, rif, rif->src_ip, ipaddr);
 165
 166         pkt.arp.arp_op = htons(ARPOP_REQUEST);
 167         memcpy(pkt.arp.arp_spa, rif->src_ip, ETH_ALEN);
 168         memset(pkt.arp.arp_tha, 0, ETH_ALEN);
 169         memset(pkt.eth.ether_dhost, 0xff, ETH_ALEN);
 170
 171         DPRINTF(2, "%s: sending ARP who-has "IP_FMT", tell "IP_FMT" ("MAC_FMT")\n",
 172                 rif->ifname, IP_BUF(pkt.arp.arp_tpa),
 173                 IP_BUF(pkt.arp.arp_spa), MAC_BUF(pkt.eth.ether_shost));
 174
 175         sendto(rif->fd.fd, &pkt, sizeof(pkt), 0,
 176                 (struct sockaddr *) &rif->sll, sizeof(rif->sll));
 177 }
 178
 179 void relayd_add_pending_route(const uint8_t *gateway, const uint8_t *dest, uint8_t mask, int timeout)
 180 {
 181         struct relayd_pending_route *rt;
 182         struct relayd_interface *rif;
 183         struct relayd_host *host;
 184
 185         host = find_host_by_ipaddr(NULL, gateway);
 186         if (host) {
 187                 relayd_add_host_route(host, dest, mask);
 188                 return;
 189         }
 190
 191         rt = calloc(1, sizeof(*rt));
 192         if (!rt)
 193                 return;
 194
 195         memcpy(rt->gateway, gateway, sizeof(rt->gateway));
 196         memcpy(rt->rt.dest, dest, sizeof(rt->rt.dest));
 197         rt->rt.mask = mask;
 198         list_add(&rt->rt.list, &pending_routes);
 199         if (timeout <= 0)
 200                 return;
 201
 202         rt->timeout.cb = timeout_host_route;
 203         uloop_timeout_set(&rt->timeout, 10000);
 204         list_for_each_entry(rif, &interfaces, list) {
 205                 send_arp_request(rif, gateway);
 206         }
 207 }
 208
 209 static void send_arp_reply(struct relayd_interface *rif, const uint8_t spa[4],
 210                            const uint8_t tha[ETH_ALEN], const uint8_t tpa[4])
 211 {
 212         struct arp_packet pkt;
 213
 214         fill_arp_packet(&pkt, rif, spa, tpa);
 215
 216         if (tha) {
 217                 pkt.arp.arp_op = htons(ARPOP_REPLY);
 218                 memcpy(pkt.eth.ether_dhost, tha, ETH_ALEN);
 219                 memcpy(pkt.arp.arp_tha, tha, ETH_ALEN);
 220
 221                 DPRINTF(2, "%s: sending ARP reply to "IP_FMT", "IP_FMT" is at ("MAC_FMT")\n",
 222                         rif->ifname, IP_BUF(pkt.arp.arp_tpa),
 223                         IP_BUF(pkt.arp.arp_spa), MAC_BUF(pkt.eth.ether_shost));
 224         } else {
 225                 pkt.arp.arp_op = htons(ARPOP_REQUEST);
 226                 memset(pkt.eth.ether_dhost, 0xff, ETH_ALEN);
 227                 memset(pkt.arp.arp_tha, 0xff, ETH_ALEN);
 228
 229                 DPRINTF(2, "%s: sending gratuitous ARP: "IP_FMT" is at ("MAC_FMT")\n",
 230                         rif->ifname, IP_BUF(pkt.arp.arp_tpa),
 231                         MAC_BUF(pkt.eth.ether_shost));
 232         }
 233
 234         sendto(rif->fd.fd, &pkt, sizeof(pkt), 0,
 235                 (struct sockaddr *) &rif->sll, sizeof(rif->sll));
 236
 237         if (tha)
 238                 return;
 239
 240         /*
 241          * Gratuitous ARP comes in two flavours, request and reply.
 242          * Some operating systems only accept request, some only reply.
 243          * Let's just send both...
 244          */
 245         pkt.arp.arp_op = htons(ARPOP_REPLY);
 246
 247         sendto(rif->fd.fd, &pkt, sizeof(pkt), 0,
 248                 (struct sockaddr *) &rif->sll, sizeof(rif->sll));
 249
 250 }
 251
 252 static void host_entry_timeout(struct uloop_timeout *timeout)
 253 {
 254         struct relayd_host *host = container_of(timeout, struct relayd_host, timeout);
 255         struct relayd_interface *rif;
 256
 257         /*
 258          * When a host is behind a managed interface, we must not expire its host
 259          * entry prematurely, as this will cause routes to the node to expire,
 260          * leading to loss of connectivity from the other side.
 261          * When the timeout is reached, try pinging the host a few times before
 262          * giving up on it.
 263          */
 264         if (host->rif->managed && host->cleanup_pending < host_ping_tries) {
 265                 list_for_each_entry(rif, &interfaces, list) {
 266                         send_arp_request(rif, host->ipaddr);
 267                 }
 268                 host->cleanup_pending++;
 269                 uloop_timeout_set(&host->timeout, 1000);
 270                 return;
 271         }
 272         del_host(host);
 273 }
 274
 275 static struct relayd_host *add_host(struct relayd_interface *rif, const uint8_t *lladdr, const uint8_t *ipaddr)
 276 {
 277         struct relayd_host *host;
 278         struct relayd_pending_route *route, *rtmp;
 279
 280         DPRINTF(1, "%s: adding host "IP_FMT" ("MAC_FMT")\n", rif->ifname,
 281                         IP_BUF(ipaddr), MAC_BUF(lladdr));
 282
 283         host = calloc(1, sizeof(*host));
 284         INIT_LIST_HEAD(&host->routes);
 285         host->rif = rif;
 286         memcpy(host->ipaddr, ipaddr, sizeof(host->ipaddr));
 287         memcpy(host->lladdr, lladdr, sizeof(host->lladdr));
 288         list_add(&host->list, &rif->hosts);
 289         host->timeout.cb = host_entry_timeout;
 290         uloop_timeout_set(&host->timeout, host_timeout * 1000);
 291
 292         add_arp(host);
 293         if (rif->managed)
 294                 relayd_add_route(host, NULL);
 295
 296         list_for_each_entry_safe(route, rtmp, &pending_routes, rt.list) {
 297                 if (memcmp(route->gateway, ipaddr, 4) != 0)
 298                         continue;
 299
 300                 relayd_add_host_route(host, route->rt.dest, route->rt.mask);
 301                 if (!route->timeout.pending)
 302                         continue;
 303
 304                 uloop_timeout_cancel(&route->timeout);
 305                 list_del(&route->rt.list);
 306                 free(route);
 307         }
 308
 309         return host;
 310 }
 311
 312 static void send_gratuitous_arp(struct relayd_interface *rif, const uint8_t *spa)
 313 {
 314         struct relayd_interface *to_rif;
 315
 316         list_for_each_entry(to_rif, &interfaces, list) {
 317                 if (rif == to_rif)
 318                         continue;
 319
 320                 send_arp_reply(to_rif, spa, NULL, spa);
 321         }
 322 }
 323
 324
 325 struct relayd_host *relayd_refresh_host(struct relayd_interface *rif, const uint8_t *lladdr, const uint8_t *ipaddr)
 326 {
 327         struct relayd_host *host;
 328
 329         host = find_host_by_ipaddr(rif, ipaddr);
 330         if (!host) {
 331                 host = find_host_by_ipaddr(NULL, ipaddr);
 332
 333                 /*
 334                  * When we suddenly see the host appearing on a different interface,
 335                  * reduce the timeout to make the old entry expire faster, in case the
 336                  * host has moved.
 337                  * If the old entry is behind a managed interface, it will be pinged
 338                  * before we expire it
 339                  */
 340                 if (host && !host->cleanup_pending) {
 341                         uloop_timeout_set(&host->timeout, 1);
 342                         return NULL;
 343                 }
 344
 345                 host = add_host(rif, lladdr, ipaddr);
 346         } else {
 347                 host->cleanup_pending = false;
 348                 uloop_timeout_set(&host->timeout, host_timeout * 1000);
 349                 send_gratuitous_arp(rif, ipaddr);
 350         }
 351
 352         return host;
 353 }
 354
 355 static void relay_arp_request(struct relayd_interface *from_rif, struct arp_packet *pkt)
 356 {
 357         struct relayd_interface *rif;
 358         struct arp_packet reqpkt;
 359
 360         memcpy(&reqpkt, pkt, sizeof(reqpkt));
 361         list_for_each_entry(rif, &interfaces, list) {
 362                 if (rif == from_rif)
 363                         continue;
 364
 365                 memcpy(reqpkt.eth.ether_shost, rif->sll.sll_addr, ETH_ALEN);
 366                 memset(reqpkt.eth.ether_dhost, 0xff, ETH_ALEN);
 367                 memcpy(reqpkt.arp.arp_sha, rif->sll.sll_addr, ETH_ALEN);
 368                 memset(reqpkt.arp.arp_tha, 0, ETH_ALEN);
 369
 370                 DPRINTF(2, "%s: sending ARP who-has "IP_FMT", tell "IP_FMT" ("MAC_FMT")\n",
 371                         rif->ifname, IP_BUF(reqpkt.arp.arp_tpa),
 372                         IP_BUF(reqpkt.arp.arp_spa), MAC_BUF(reqpkt.eth.ether_shost));
 373
 374                 sendto(rif->fd.fd, &reqpkt, sizeof(reqpkt), 0,
 375                         (struct sockaddr *) &rif->sll, sizeof(rif->sll));
 376         }
 377 }
 378
 379 static void recv_arp_request(struct relayd_interface *rif, struct arp_packet *pkt)
 380 {
 381         struct relayd_host *host;
 382
 383         DPRINTF(2, "%s: ARP who-has "IP_FMT", tell "IP_FMT" ("MAC_FMT")\n",
 384                 rif->ifname,
 385                 IP_BUF(pkt->arp.arp_tpa),
 386                 IP_BUF(pkt->arp.arp_spa),
 387                 MAC_BUF(pkt->eth.ether_shost));
 388
 389         if (!memcmp(pkt->arp.arp_spa, "\x00\x00\x00\x00", 4))
 390                 return;
 391
 392         host = find_host_by_ipaddr(NULL, pkt->arp.arp_spa);
 393         if (!host || host->rif != rif)
 394                 relayd_refresh_host(rif, pkt->eth.ether_shost, pkt->arp.arp_spa);
 395
 396         if (local_route_table && !memcmp(pkt->arp.arp_tpa, local_addr, sizeof(local_addr))) {
 397                 send_arp_reply(rif, local_addr, pkt->arp.arp_sha, pkt->arp.arp_spa);
 398                 return;
 399         }
 400
 401         host = find_host_by_ipaddr(NULL, pkt->arp.arp_tpa);
 402
 403         /*
 404          * If a host is being pinged because of a timeout, do not use the cached
 405          * entry here. That way we can avoid giving out stale data in case the node
 406          * has moved. We shouldn't relay requests here either, as we might miss our
 407          * chance to create a host route.
 408          */
 409         if (host && host->cleanup_pending)
 410                 return;
 411
 412         relay_arp_request(rif, pkt);
 413 }
 414
 415 static void recv_arp_reply(struct relayd_interface *rif, struct arp_packet *pkt)
 416 {
 417         struct relayd_host *host;
 418
 419         DPRINTF(2, "%s: received ARP reply for "IP_FMT" from "MAC_FMT", deliver to "IP_FMT"\n",
 420                 rif->ifname,
 421                 IP_BUF(pkt->arp.arp_spa),
 422                 MAC_BUF(pkt->eth.ether_shost),
 423                 IP_BUF(pkt->arp.arp_tpa));
 424
 425         if (memcmp(pkt->arp.arp_sha, rif->sll.sll_addr, ETH_ALEN) != 0)
 426                 relayd_refresh_host(rif, pkt->arp.arp_sha, pkt->arp.arp_spa);
 427
 428         host = find_host_by_ipaddr(NULL, pkt->arp.arp_tpa);
 429         if (!host)
 430                 return;
 431
 432         if (host->rif == rif)
 433                 return;
 434
 435         send_arp_reply(host->rif, pkt->arp.arp_spa, host->lladdr, host->ipaddr);
 436 }
 437
 438 static void recv_packet(struct uloop_fd *fd, unsigned int events)
 439 {
 440         struct relayd_interface *rif = container_of(fd, struct relayd_interface, fd);
 441         struct arp_packet *pkt;
 442         static char pktbuf[4096];
 443         int pktlen;
 444
 445         do {
 446                 if (rif->fd.error)
 447                         uloop_end();
 448
 449                 pktlen = recv(rif->fd.fd, pktbuf, sizeof(pktbuf), 0);
 450                 if (pktlen < 0) {
 451                         if (errno == EINTR)
 452                                 continue;
 453
 454                         break;
 455                 }
 456
 457                 if (!pktlen)
 458                         break;
 459
 460                 pkt = (void *)pktbuf;
 461                 if (pkt->arp.arp_op == htons(ARPOP_REPLY))
 462                         recv_arp_reply(rif, pkt);
 463                 else if (pkt->arp.arp_op == htons(ARPOP_REQUEST))
 464                         recv_arp_request(rif, pkt);
 465                 else
 466                         DPRINTF(1, "received unknown packet type: %04x\n", ntohs(pkt->arp.arp_op));
 467
 468         } while (1);
 469 }
 470
 471 void relayd_forward_bcast_packet(struct relayd_interface *from_rif, void *packet, int len)
 472 {
 473         struct relayd_interface *rif;
 474         struct ether_header *eth = packet;
 475
 476         list_for_each_entry(rif, &interfaces, list) {
 477                 if (rif == from_rif)
 478                         continue;
 479
 480                 DPRINTF(3, "%s: forwarding broadcast packet to %s\n", from_rif->ifname, rif->ifname);
 481                 memcpy(eth->ether_shost, rif->sll.sll_addr, ETH_ALEN);
 482                 send(rif->bcast_fd.fd, packet, len, 0);
 483         }
 484 }
 485
 486 static void recv_bcast_packet(struct uloop_fd *fd, unsigned int events)
 487 {
 488         struct relayd_interface *rif = container_of(fd, struct relayd_interface, bcast_fd);
 489         static char pktbuf[4096];
 490         int pktlen;
 491
 492         do {
 493                 if (rif->fd.error)
 494                         uloop_end();
 495
 496                 pktlen = recv(rif->bcast_fd.fd, pktbuf, sizeof(pktbuf), 0);
 497                 if (pktlen < 0) {
 498                         if (errno == EINTR)
 499                                 continue;
 500
 501                         break;
 502                 }
 503
 504                 if (!pktlen)
 505                         break;
 506
 507                 if (!forward_bcast && !forward_dhcp)
 508                         continue;
 509
 510                 if (relayd_handle_dhcp_packet(rif, pktbuf, pktlen, forward_dhcp))
 511                         continue;
 512
 513                 if (forward_bcast)
 514                         relayd_forward_bcast_packet(rif, pktbuf, pktlen);
 515         } while (1);
 516 }
 517
 518
 519 static int init_interface(struct relayd_interface *rif)
 520 {
 521         struct sockaddr_ll *sll = &rif->sll;
 522         struct sockaddr_in *sin;
 523         struct ifreq ifr;
 524         int fd = rif->fd.fd;
 525 #ifdef PACKET_RECV_TYPE
 526         unsigned int pkt_type;
 527 #endif
 528
 529         fd = socket(AF_PACKET, SOCK_RAW, htons(ETH_P_ARP));
 530         if (fd < 0)
 531                 return -1;
 532
 533         rif->fd.fd = fd;
 534
 535         memset(&ifr, 0, sizeof(ifr));
 536         strcpy(ifr.ifr_name, rif->ifname);
 537
 538         if (ioctl(fd, SIOCGIFHWADDR, &ifr) < 0) {
 539                 perror("ioctl(SIOCGIFHWADDR)");
 540                 return -1;
 541         }
 542
 543         memcpy(sll->sll_addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
 544         sll->sll_family = AF_PACKET;
 545         sll->sll_protocol = htons(ETH_P_ARP);
 546         sll->sll_pkttype = PACKET_BROADCAST;
 547         sll->sll_hatype = ARPHRD_ETHER;
 548         sll->sll_halen = ETH_ALEN;
 549
 550         if (ioctl(fd, SIOCGIFINDEX, &ifr) < 0) {
 551                 perror("ioctl(SIOCGIFINDEX)");
 552                 return -1;
 553         }
 554
 555         sll->sll_ifindex = ifr.ifr_ifindex;
 556
 557         if (ioctl(fd, SIOCGIFADDR, &ifr) < 0) {
 558                 memcpy(rif->src_ip, DUMMY_IP, sizeof(rif->src_ip));
 559         } else {
 560                 sin = (struct sockaddr_in *) &ifr.ifr_addr;
 561                 memcpy(rif->src_ip, &sin->sin_addr.s_addr, sizeof(rif->src_ip));
 562         }
 563
 564         if (bind(fd, (struct sockaddr *)sll, sizeof(struct sockaddr_ll)) < 0) {
 565                 perror("bind(ETH_P_ARP)");
 566                 return -1;
 567         }
 568
 569         rif->fd.cb = recv_packet;
 570         uloop_fd_add(&rif->fd, ULOOP_READ | ULOOP_EDGE_TRIGGER);
 571
 572         if (!forward_bcast && !forward_dhcp)
 573                 return 0;
 574
 575         fd = socket(AF_PACKET, SOCK_RAW, htons(ETH_P_IP));
 576         if (fd < 0)
 577                 return 0;
 578
 579         rif->bcast_fd.fd = fd;
 580         rif->bcast_fd.cb = recv_bcast_packet;
 581
 582         memcpy(&rif->bcast_sll, &rif->sll, sizeof(rif->bcast_sll));
 583         sll = &rif->bcast_sll;
 584         sll->sll_protocol = htons(ETH_P_IP);
 585
 586         if (bind(fd, (struct sockaddr *)sll, sizeof(struct sockaddr_ll)) < 0) {
 587                 perror("bind(ETH_P_IP)");
 588                 return 0;
 589         }
 590
 591 #ifdef PACKET_RECV_TYPE
 592         pkt_type = (1 << PACKET_BROADCAST) | (1 << PACKET_MULTICAST);
 593         setsockopt(fd, SOL_PACKET, PACKET_RECV_TYPE, &pkt_type, sizeof(pkt_type));
 594 #endif
 595
 596         uloop_fd_add(&rif->bcast_fd, ULOOP_READ | ULOOP_EDGE_TRIGGER);
 597         relayd_add_interface_routes(rif);
 598         return 0;
 599 }
 600
 601 static void ping_static_routes(void)
 602 {
 603         struct relayd_pending_route *rt;
 604         struct relayd_interface *rif;
 605
 606         list_for_each_entry(rt, &pending_routes, rt.list)
 607                 list_for_each_entry(rif, &interfaces, list)
 608                         send_arp_request(rif, rt->gateway);
 609 }
 610
 611 static int init_interfaces(void)
 612 {
 613         struct relayd_interface *rif;
 614         int ret;
 615
 616         list_for_each_entry(rif, &interfaces, list) {
 617                 ret = init_interface(rif);
 618                 if (ret < 0)
 619                         return ret;
 620         }
 621
 622         return 0;
 623 }
 624
 625 static void cleanup_hosts(void)
 626 {
 627         struct relayd_interface *rif;
 628         struct relayd_host *host, *tmp;
 629
 630         list_for_each_entry(rif, &interfaces, list) {
 631                 list_for_each_entry_safe(host, tmp, &rif->hosts, list) {
 632                         del_host(host);
 633                 }
 634         }
 635 }
 636
 637 static void free_interfaces(void)
 638 {
 639         struct relayd_interface *rif, *rtmp;
 640
 641         list_for_each_entry_safe(rif, rtmp, &interfaces, list) {
 642                 relayd_del_interface_routes(rif);
 643                 list_del(&rif->list);
 644                 free(rif);
 645         }
 646 }
 647
 648 static struct relayd_interface *alloc_interface(const char *ifname, bool managed)
 649 {
 650         struct relayd_interface *rif;
 651
 652         if (strlen(ifname) >= IFNAMSIZ)
 653                 return NULL;
 654
 655         rif = calloc(1, sizeof(*rif));
 656         if (!rif)
 657                 return NULL;
 658
 659         INIT_LIST_HEAD(&rif->hosts);
 660         strcpy(rif->ifname, ifname);
 661         list_add(&rif->list, &interfaces);
 662         rif->managed = managed;
 663
 664         return rif;
 665 }
 666
 667 static void die(int signo)
 668 {
 669         /*
 670          * When we hit SIGTERM, clean up interfaces directly, so that we
 671          * won't leave our routing in an invalid state.
 672          */
 673         cleanup_hosts();
 674         free_interfaces();
 675         exit(1);
 676 }
 677
 678 static int usage(const char *progname)
 679 {
 680         fprintf(stderr, "Usage: %s <options>\n"
 681                         "\n"
 682                         "Options:\n"
 683                         "       -d              Enable debug messages\n"
 684                         "       -i <ifname>     Add an interface for relaying\n"
 685                         "       -I <ifname>     Same as -i, except with ARP cache and host route management\n"
 686                         "                       You need to specify at least two interfaces\n"
 687                         "       -G <ip>         Set a gateway IP for clients\n"
 688                         "       -R <gateway>:<net>/<mask>\n"
 689                         "                       Add a static route for <net>/<mask> via <gateway>\n"
 690                         "       -t <timeout>    Host entry expiry timeout\n"
 691                         "       -p <tries>      Number of ARP ping attempts before considering a host dead\n"
 692                         "       -T <table>      Set routing table number for automatically added routes\n"
 693                         "       -B              Enable broadcast forwarding\n"
 694                         "       -D              Enable DHCP forwarding\n"
 695                         "       -L <ipaddr>     Enable local access using <ipaddr> as source address\n"
 696                         "\n",
 697                 progname);
 698         return -1;
 699 }
 700
 701 int main(int argc, char **argv)
 702 {
 703         struct relayd_interface *rif = NULL;
 704         struct in_addr addr, addr2;
 705         bool local_addr_valid = false;
 706         bool managed;
 707         int ifnum = 0;
 708         char *s, *s2;
 709         int mask;
 710         int ch;
 711
 712         debug = 0;
 713         inet_sock = socket(AF_INET, SOCK_DGRAM, 0);
 714         if (inet_sock < 0) {
 715                 perror("socket(AF_INET)");
 716                 return 1;
 717         }
 718
 719         host_timeout = 30;
 720         host_ping_tries = 5;
 721         forward_bcast = 0;
 722         local_route_table = 0;
 723         uloop_init();
 724
 725         while ((ch = getopt(argc, argv, "I:i:t:p:BDdT:G:R:L:")) != -1) {
 726                 switch(ch) {
 727                 case 'I':
 728                         managed = true;
 729                         /* fall through */
 730                 case 'i':
 731                         ifnum++;
 732                         rif = alloc_interface(optarg, managed);
 733                         if (!rif)
 734                                 return 1;
 735
 736                         managed = false;
 737                         break;
 738                 case 't':
 739                         host_timeout = atoi(optarg);
 740                         if (host_timeout <= 0)
 741                                 return usage(argv[0]);
 742                         break;
 743                 case 'p':
 744                         host_ping_tries = atoi(optarg);
 745                         if (host_ping_tries <= 0)
 746                                 return usage(argv[0]);
 747                         break;
 748                 case 'd':
 749                         debug++;
 750                         break;
 751                 case 'B':
 752                         forward_bcast = 1;
 753                         break;
 754                 case 'D':
 755                         forward_dhcp = 1;
 756                         break;
 757                 case 'T':
 758                         route_table = atoi(optarg);
 759                         if (route_table <= 0)
 760                                 return usage(argv[0]);
 761                         break;
 762                 case 'G':
 763                         if (!inet_aton(optarg, &addr)) {
 764                                 fprintf(stderr, "Address '%s' not found\n", optarg);
 765                                 return 1;
 766                         }
 767                         relayd_add_pending_route((uint8_t *) &addr.s_addr, (const uint8_t *) "\x00\x00\x00\x00", 0, 0);
 768                         break;
 769                 case 'L':
 770                         if (!inet_aton(optarg, &addr)) {
 771                                 fprintf(stderr, "Address '%s' not found\n", optarg);
 772                                 return 1;
 773                         }
 774                         memcpy(&local_addr, &addr.s_addr, sizeof(local_addr));
 775                         local_addr_valid = true;
 776                         break;
 777                 case 'R':
 778                         s = strchr(optarg, ':');
 779                         if (!s)
 780                                 return usage(argv[0]);
 781
 782                         *(s++) = 0;
 783                         if (!inet_aton(optarg, &addr)) {
 784                                 fprintf(stderr, "Address '%s' not found\n", optarg);
 785                                 return 1;
 786                         }
 787
 788                         s2 = strchr(s, '/');
 789                         if (!s2)
 790                                 return usage(argv[0]);
 791
 792                         *(s2++) = 0;
 793                         if (!inet_aton(s, &addr2)) {
 794                                 fprintf(stderr, "Address '%s' not found\n", s);
 795                                 return 1;
 796                         }
 797
 798                         mask = atoi(s2);
 799                         if (mask < 0 || mask > 32)
 800                                 return usage(argv[0]);
 801
 802                         relayd_add_pending_route((uint8_t *) &addr.s_addr, (uint8_t *) &addr2.s_addr, mask, 0);
 803                         break;
 804                 case '?':
 805                 default:
 806                         return usage(argv[0]);
 807                 }
 808         }
 809
 810         if (list_empty(&interfaces))
 811                 return usage(argv[0]);
 812
 813         if (ifnum < 2) {
 814                 fprintf(stderr, "ERROR: Need at least 2 interfaces for relaying\n");
 815                 return -1;
 816         }
 817
 818         argc -= optind;
 819         argv += optind;
 820
 821         signal(SIGTERM, die);
 822         signal(SIGHUP, die);
 823         signal(SIGUSR1, die);
 824         signal(SIGUSR2, die);
 825
 826         if (local_addr_valid)
 827                 local_route_table = route_table++;
 828
 829         if (relayd_rtnl_init() < 0)
 830                 return 1;
 831
 832         if (init_interfaces() < 0)
 833                 return 1;
 834
 835         ping_static_routes();
 836
 837         uloop_run();
 838         uloop_done();
 839
 840         cleanup_hosts();
 841         free_interfaces();
 842         relayd_rtnl_done();
 843         close(inet_sock);
 844
 845         return 0;
 846 }