firewall3: fix left shift on 64 bit systems in fw3_bitlen2netmask
[project/firewall3.git] / utils.c
diff --git a/utils.c b/utils.c
index 7f2dd64..b2fbe02 100644 (file)
--- a/utils.c
+++ b/utils.c
@@ -16,6 +16,7 @@
  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  */
 
  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  */
 
+#define _GNU_SOURCE
 #include "utils.h"
 #include "options.h"
 
 #include "utils.h"
 #include "options.h"
 
@@ -132,6 +133,32 @@ info(const char* format, ...)
        fprintf(stderr, "\n");
 }
 
        fprintf(stderr, "\n");
 }
 
+void *
+fw3_alloc(size_t size)
+{
+       void *mem;
+
+       mem = calloc(1, size);
+
+       if (!mem)
+               error("Out of memory while allocating %d bytes", size);
+
+       return mem;
+}
+
+char *
+fw3_strdup(const char *s)
+{
+       char *ns;
+
+       ns = strdup(s);
+
+       if (!ns)
+               error("Out of memory while duplicating string '%s'", s);
+
+       return ns;
+}
+
 const char *
 fw3_find_command(const char *cmd)
 {
 const char *
 fw3_find_command(const char *cmd)
 {
@@ -198,7 +225,7 @@ __fw3_command_pipe(bool silent, const char *command, ...)
                return false;
 
        argn = 2;
                return false;
 
        argn = 2;
-       args = malloc(argn * sizeof(arg));
+       args = calloc(argn, sizeof(arg));
 
        if (!args)
                return false;
 
        if (!args)
                return false;
@@ -244,6 +271,7 @@ __fw3_command_pipe(bool silent, const char *command, ...)
                signal(SIGPIPE, SIG_IGN);
                pipe_pid = pid;
                close(pfds[0]);
                signal(SIGPIPE, SIG_IGN);
                pipe_pid = pid;
                close(pfds[0]);
+               fcntl(pfds[1], F_SETFD, fcntl(pfds[1], F_GETFD) | FD_CLOEXEC);
        }
 
        pipe_fd = fdopen(pfds[1], "w");
        }
 
        pipe_fd = fdopen(pfds[1], "w");
@@ -347,95 +375,242 @@ fw3_unlock(void)
 }
 
 
 }
 
 
-bool
-fw3_read_statefile(void *state)
+static void
+write_defaults_uci(struct uci_context *ctx, struct fw3_defaults *d,
+                   struct uci_package *dest)
 {
 {
-       FILE *sf;
+       char buf[sizeof("0xffffffff\0")];
+       struct uci_ptr ptr = { .p = dest };
+
+       uci_add_section(ctx, dest, "defaults", &ptr.s);
+
+       ptr.o      = NULL;
+       ptr.option = "input";
+       ptr.value  = fw3_flag_names[d->policy_input];
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "output";
+       ptr.value  = fw3_flag_names[d->policy_output];
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "forward";
+       ptr.value  = fw3_flag_names[d->policy_forward];
+       uci_set(ctx, &ptr);
+
+       sprintf(buf, "0x%x", d->flags[0]);
+       ptr.o      = NULL;
+       ptr.option = "__flags_v4";
+       ptr.value  = buf;
+       uci_set(ctx, &ptr);
+
+       sprintf(buf, "0x%x", d->flags[1]);
+       ptr.o      = NULL;
+       ptr.option = "__flags_v6";
+       ptr.value  = buf;
+       uci_set(ctx, &ptr);
+}
 
 
-       int type;
-       char line[128];
-       const char *p, *name;
+static void
+write_zone_uci(struct uci_context *ctx, struct fw3_zone *z,
+               struct uci_package *dest, struct ifaddrs *ifaddr)
+{
+       struct fw3_device *dev;
+       struct fw3_address *sub;
+       struct ifaddrs *ifa;
+       enum fw3_family fam = FW3_FAMILY_ANY;
 
 
-       uint32_t flags[2];
+       char *p, buf[INET6_ADDRSTRLEN];
 
 
-       struct fw3_state *s = state;
-       struct fw3_zone *zone;
-       struct fw3_ipset *ipset;
+       struct uci_ptr ptr = { .p = dest };
 
 
-       sf = fopen(FW3_STATEFILE, "r");
+       if (!z->enabled)
+               return;
 
 
-       if (!sf)
-               return false;
+       if (fw3_no_table(z->flags[0]) && !fw3_no_table(z->flags[1]))
+               fam = FW3_FAMILY_V6;
+       else if (!fw3_no_table(z->flags[0]) && fw3_no_table(z->flags[1]))
+               fam = FW3_FAMILY_V4;
+       else if (fw3_no_table(z->flags[0]) && fw3_no_table(z->flags[1]))
+               return;
 
 
-       while (fgets(line, sizeof(line), sf))
+       uci_add_section(ctx, dest, "zone", &ptr.s);
+
+       ptr.o      = NULL;
+       ptr.option = "name";
+       ptr.value  = z->name;
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "input";
+       ptr.value  = fw3_flag_names[z->policy_input];
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "output";
+       ptr.value  = fw3_flag_names[z->policy_output];
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "forward";
+       ptr.value  = fw3_flag_names[z->policy_forward];
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "masq";
+       ptr.value  = z->masq ? "1" : "0";
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "conntrack";
+       ptr.value  = z->conntrack ? "1" : "0";
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "mtu_fix";
+       ptr.value  = z->mtu_fix ? "1" : "0";
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "custom_chains";
+       ptr.value  = z->custom_chains ? "1" : "0";
+       uci_set(ctx, &ptr);
+
+       if (fam != FW3_FAMILY_ANY)
        {
        {
-               p = strtok(line, " \t\n");
+               ptr.o      = NULL;
+               ptr.option = "family";
+               ptr.value  = fw3_flag_names[fam];
+               uci_set(ctx, &ptr);
+       }
+
+       ptr.o      = NULL;
+       ptr.option = "device";
 
 
-               if (!p)
+       fw3_foreach(dev, &z->devices)
+       {
+               if (!dev)
                        continue;
 
                        continue;
 
-               type = strtoul(p, NULL, 16);
-               name = strtok(NULL, " \t\n");
+               p = buf;
 
 
-               if (!name)
-                       continue;
+               if (dev->invert)
+                       p += sprintf(p, "!");
 
 
-               if (!(p = strtok(NULL, " \t\n")))
-                       continue;
+               if (*dev->network)
+                       p += sprintf(p, "%s@%s", dev->name, dev->network);
+               else
+                       p += sprintf(p, "%s", dev->name);
 
 
-               flags[0] = strtoul(p, NULL, 16);
+               ptr.value = buf;
+               uci_add_list(ctx, &ptr);
+       }
+
+       ptr.o      = NULL;
+       ptr.option = "subnet";
 
 
-               if (!(p = strtok(NULL, " \t\n")))
+       fw3_foreach(sub, &z->subnets)
+       {
+               if (!sub)
                        continue;
 
                        continue;
 
-               flags[1] = strtoul(p, NULL, 16);
+               ptr.value = fw3_address_to_string(sub, true, false);
+               uci_add_list(ctx, &ptr);
+       }
+
+       ptr.o      = NULL;
+       ptr.option = "__addrs";
 
 
-               switch (type)
+       fw3_foreach(dev, &z->devices)
+       {
+               if (!dev)
+                       continue;
+
+               for (ifa = ifaddr; ifa; ifa = ifa->ifa_next)
                {
                {
-               case FW3_TYPE_DEFAULTS:
-                       s->defaults.flags[0] = flags[0];
-                       s->defaults.flags[1] = flags[1];
-                       break;
+                       if (!ifa->ifa_addr || strcmp(dev->name, ifa->ifa_name))
+                               continue;
 
 
-               case FW3_TYPE_ZONE:
-                       if (!(zone = fw3_lookup_zone(state, name, false)))
-                       {
-                               zone = fw3_alloc_zone();
+                       if (ifa->ifa_addr->sa_family == AF_INET)
+                               inet_ntop(AF_INET,
+                                         &((struct sockaddr_in *)ifa->ifa_addr)->sin_addr,
+                                         buf, sizeof(buf));
+                       else if (ifa->ifa_addr->sa_family == AF_INET6)
+                               inet_ntop(AF_INET6,
+                                         &((struct sockaddr_in6 *)ifa->ifa_addr)->sin6_addr,
+                                         buf, sizeof(buf));
+                       else
+                               continue;
 
 
-                               if (!zone)
-                                       continue;
+                       ptr.value = buf;
+                       uci_add_list(ctx, &ptr);
+               }
+       }
 
 
-                               zone->name = strdup(name);
-                               list_add_tail(&zone->list, &s->zones);
-                       }
+       sprintf(buf, "0x%x", z->flags[0]);
+       ptr.o      = NULL;
+       ptr.option = "__flags_v4";
+       ptr.value  = buf;
+       uci_set(ctx, &ptr);
+
+       sprintf(buf, "0x%x", z->flags[1]);
+       ptr.o      = NULL;
+       ptr.option = "__flags_v6";
+       ptr.value  = buf;
+       uci_set(ctx, &ptr);
+}
 
 
-                       zone->flags[0] = flags[0];
-                       zone->flags[1] = flags[1];
-                       list_add_tail(&zone->running_list, &s->running_zones);
-                       break;
+static void
+write_ipset_uci(struct uci_context *ctx, struct fw3_ipset *s,
+                struct uci_package *dest)
+{
+       struct fw3_ipset_datatype *type;
 
 
-               case FW3_TYPE_IPSET:
-                       if (!(ipset = fw3_lookup_ipset(state, name, false)))
-                       {
-                               ipset = fw3_alloc_ipset();
+       char buf[sizeof("65535-65535\0")];
 
 
-                               if (!ipset)
-                                       continue;
+       struct uci_ptr ptr = { .p = dest };
 
 
-                               ipset->name = strdup(name);
-                               list_add_tail(&ipset->list, &s->ipsets);
-                       }
+       if (!s->enabled || s->external)
+               return;
 
 
-                       ipset->flags[0] = flags[0];
-                       ipset->flags[1] = flags[1];
-                       list_add_tail(&ipset->running_list, &s->running_ipsets);
-                       break;
-               }
+       uci_add_section(ctx, dest, "ipset", &ptr.s);
+
+       ptr.o      = NULL;
+       ptr.option = "name";
+       ptr.value  = s->name;
+       uci_set(ctx, &ptr);
+
+       ptr.o      = NULL;
+       ptr.option = "storage";
+       ptr.value  = fw3_ipset_method_names[s->method];
+       uci_set(ctx, &ptr);
+
+       list_for_each_entry(type, &s->datatypes, list)
+       {
+               sprintf(buf, "%s_%s", type->dir, fw3_ipset_type_names[type->type]);
+               ptr.o      = NULL;
+               ptr.option = "match";
+               ptr.value  = buf;
+               uci_add_list(ctx, &ptr);
        }
 
        }
 
-       fclose(sf);
+       if (s->iprange.set)
+       {
+               ptr.o      = NULL;
+               ptr.option = "iprange";
+               ptr.value  = fw3_address_to_string(&s->iprange, false, false);
+               uci_set(ctx, &ptr);
+       }
 
 
-       return true;
+       if (s->portrange.set)
+       {
+               sprintf(buf, "%u-%u", s->portrange.port_min, s->portrange.port_max);
+               ptr.o      = NULL;
+               ptr.option = "portrange";
+               ptr.value  = buf;
+               uci_set(ctx, &ptr);
+       }
 }
 
 void
 }
 
 void
@@ -443,68 +618,61 @@ fw3_write_statefile(void *state)
 {
        FILE *sf;
        struct fw3_state *s = state;
 {
        FILE *sf;
        struct fw3_state *s = state;
-       struct fw3_defaults *d = &s->defaults;
        struct fw3_zone *z;
        struct fw3_ipset *i;
        struct fw3_zone *z;
        struct fw3_ipset *i;
+       struct ifaddrs *ifaddr;
 
 
-       if (fw3_no_table(d->flags[0]) && fw3_no_table(d->flags[1]))
-       {
-               if (unlink(FW3_STATEFILE))
-                       warn("Unable to remove state %s: %s",
-                            FW3_STATEFILE, strerror(errno));
-
-               return;
-       }
-
-       sf = fopen(FW3_STATEFILE, "w");
+       struct uci_package *p;
 
 
-       if (!sf)
+       if (fw3_no_family(s->defaults.flags[0]) &&
+           fw3_no_family(s->defaults.flags[1]))
        {
        {
-               warn("Cannot create state %s: %s", FW3_STATEFILE, strerror(errno));
-               return;
+               unlink(FW3_STATEFILE);
        }
        }
-
-       fprintf(sf, "%x - %x %x\n", FW3_TYPE_DEFAULTS, d->flags[0], d->flags[1]);
-
-       list_for_each_entry(z, &s->running_zones, running_list)
+       else
        {
        {
-               if (!fw3_no_table(z->flags[0]) || !fw3_no_table(z->flags[1]))
+               sf = fopen(FW3_STATEFILE, "w+");
+
+               if (!sf)
                {
                {
-                       fprintf(sf, "%x %s %x %x\n",
-                                       FW3_TYPE_ZONE, z->name, z->flags[0], z->flags[1]);
+                       warn("Cannot create state %s: %s", FW3_STATEFILE, strerror(errno));
+                       return;
                }
                }
-       }
 
 
-       list_for_each_entry(i, &s->running_ipsets, running_list)
-       {
-               if (!fw3_no_family(i->flags[0]) || !fw3_no_family(i->flags[1]))
+               if (getifaddrs(&ifaddr))
                {
                {
-                       fprintf(sf, "%x %s %x %x\n",
-                                       FW3_TYPE_IPSET, i->name, i->flags[0], i->flags[1]);
+                       warn("Cannot get interface addresses: %s", strerror(errno));
+                       ifaddr = NULL;
                }
                }
-       }
 
 
-       fclose(sf);
-}
+               if ((p = uci_lookup_package(s->uci, "fw3_state")) != NULL)
+                       uci_unload(s->uci, p);
 
 
+               uci_import(s->uci, sf, "fw3_state", NULL, true);
 
 
-struct object_list_heads
-{
-       struct list_head list;
-       struct list_head running_list;
-};
+               if ((p = uci_lookup_package(s->uci, "fw3_state")) != NULL)
+               {
+                       write_defaults_uci(s->uci, &s->defaults, p);
 
 
-void
-fw3_set_running(void *object, struct list_head *dest)
-{
-       struct object_list_heads *o = object;
+                       list_for_each_entry(z, &s->zones, list)
+                               write_zone_uci(s->uci, z, p, ifaddr);
+
+                       list_for_each_entry(i, &s->ipsets, list)
+                               write_ipset_uci(s->uci, i, p);
+
+                       uci_export(s->uci, sf, p, true);
+                       uci_unload(s->uci, p);
+               }
 
 
-       if (dest && !o->running_list.next)
-               list_add_tail(&o->running_list, dest);
-       else if (!dest && o->running_list.next)
-               list_del(&o->running_list);
+               fsync(fileno(sf));
+               fclose(sf);
+
+               if (ifaddr)
+                       freeifaddrs(ifaddr);
+       }
 }
 
 }
 
+
 void
 fw3_free_object(void *obj, const void *opts)
 {
 void
 fw3_free_object(void *obj, const void *opts)
 {
@@ -526,3 +694,204 @@ fw3_free_object(void *obj, const void *opts)
 
        free(obj);
 }
 
        free(obj);
 }
+
+void
+fw3_free_list(struct list_head *head)
+{
+       struct list_head *entry, *tmp;
+
+       if (!head)
+               return;
+
+       list_for_each_safe(entry, tmp, head)
+       {
+               list_del(entry);
+               free(entry);
+       }
+
+       free(head);
+}
+
+bool
+fw3_hotplug(bool add, void *zone, void *device)
+{
+       struct fw3_zone *z = zone;
+       struct fw3_device *d = device;
+
+       if (!*d->network)
+               return false;
+
+       switch (fork())
+       {
+       case -1:
+               warn("Unable to fork(): %s\n", strerror(errno));
+               return false;
+
+       case 0:
+               break;
+
+       default:
+               return true;
+       }
+
+       close(0);
+       close(1);
+       close(2);
+       if (chdir("/")) {};
+
+       clearenv();
+       setenv("ACTION",    add ? "add" : "remove", 1);
+       setenv("ZONE",      z->name,                1);
+       setenv("INTERFACE", d->network,             1);
+       setenv("DEVICE",    d->name,                1);
+
+       execl(FW3_HOTPLUG, FW3_HOTPLUG, "firewall", NULL);
+
+       /* unreached */
+       return false;
+}
+
+int
+fw3_netmask2bitlen(int family, void *mask)
+{
+       int bits;
+       struct in_addr *v4;
+       struct in6_addr *v6;
+
+       if (family == FW3_FAMILY_V6)
+               for (bits = 0, v6 = mask;
+                    bits < 128 && (v6->s6_addr[bits / 8] << (bits % 8)) & 128;
+                    bits++);
+       else
+               for (bits = 0, v4 = mask;
+                    bits < 32 && (ntohl(v4->s_addr) << bits) & 0x80000000;
+                    bits++);
+
+       return bits;
+}
+
+bool
+fw3_bitlen2netmask(int family, int bits, void *mask)
+{
+       int i;
+       uint8_t rem, b;
+       struct in_addr *v4;
+       struct in6_addr *v6;
+
+       if (family == FW3_FAMILY_V6)
+       {
+               if (bits < -128 || bits > 128)
+                       return false;
+
+               v6 = mask;
+               rem = abs(bits);
+
+               for (i = 0; i < sizeof(v6->s6_addr); i++)
+               {
+                       b = (rem > 8) ? 8 : rem;
+                       v6->s6_addr[i] = (uint8_t)(0xFF << (8 - b));
+                       rem -= b;
+               }
+
+               if (bits < 0)
+                       for (i = 0; i < sizeof(v6->s6_addr); i++)
+                               v6->s6_addr[i] = ~v6->s6_addr[i];
+       }
+       else
+       {
+               if (bits < -32 || bits > 32)
+                       return false;
+
+               v4 = mask;
+               v4->s_addr = bits ? htonl(~((1 << (32 - abs(bits))) - 1)) : 0;
+
+               if (bits < 0)
+                       v4->s_addr = ~v4->s_addr;
+       }
+
+       return true;
+}
+
+void
+fw3_flush_conntrack(void *state)
+{
+       bool found;
+       struct fw3_state *s = state;
+       struct fw3_address *addr;
+       struct fw3_device *dev;
+       struct fw3_zone *zone;
+       struct ifaddrs *ifaddr, *ifa;
+       struct sockaddr_in *sin;
+       struct sockaddr_in6 *sin6;
+       char buf[INET6_ADDRSTRLEN];
+       FILE *ct;
+
+       if (!state)
+       {
+               if ((ct = fopen("/proc/net/nf_conntrack", "w")) != NULL)
+               {
+                       info(" * Flushing conntrack table ...");
+
+                       fwrite("f\n", 1, 2, ct);
+                       fclose(ct);
+               }
+
+               return;
+       }
+
+       if (getifaddrs(&ifaddr))
+       {
+               warn("Cannot get interface addresses: %s", strerror(errno));
+               return;
+       }
+
+       if ((ct = fopen("/proc/net/nf_conntrack", "w")) != NULL)
+       {
+               list_for_each_entry(zone, &s->zones, list)
+               list_for_each_entry(addr, &zone->old_addrs, list)
+               {
+                       found = false;
+
+                       list_for_each_entry(dev, &zone->devices, list)
+                       {
+                               for (ifa = ifaddr; ifa && !found; ifa = ifa->ifa_next)
+                               {
+                                       if (!ifa->ifa_addr || strcmp(dev->name, ifa->ifa_name))
+                                               continue;
+
+                                       sin = (struct sockaddr_in *)ifa->ifa_addr;
+                                       sin6 = (struct sockaddr_in6 *)ifa->ifa_addr;
+
+                                       if (addr->family == FW3_FAMILY_V4 &&
+                                               sin->sin_family == AF_INET)
+                                       {
+                                               found = !memcmp(&addr->address.v4, &sin->sin_addr,
+                                                                               sizeof(sin->sin_addr));
+                                       }
+                                       else if (addr->family == FW3_FAMILY_V6 &&
+                                                        sin6->sin6_family == AF_INET6)
+                                       {
+                                               found = !memcmp(&addr->address.v6, &sin6->sin6_addr,
+                                                                               sizeof(sin6->sin6_addr));
+                                       }
+                               }
+
+                               if (found)
+                                       break;
+                       }
+
+                       if (!found)
+                       {
+                               inet_ntop(addr->family == FW3_FAMILY_V4 ? AF_INET : AF_INET6,
+                                                 &addr->address.v4, buf, sizeof(buf));
+
+                               info(" * Flushing conntrack: %s", buf);
+                               fprintf(ct, "%s\n", buf);
+                       }
+               }
+
+               fclose(ct);
+       }
+
+       freeifaddrs(ifaddr);
+}