interface.c

   1 #include <string.h>
   2 #include <stdlib.h>
   3 #include <stdio.h>
   4
   5 #include "netifd.h"
   6 #include "proto.h"
   7 #include "ubus.h"
   8
   9 static LIST_HEAD(interfaces);
  10
  11 static void
  12 clear_interface_errors(struct interface *iface)
  13 {
  14         struct interface_error *error, *tmp;
  15
  16         list_for_each_entry_safe(error, tmp, &iface->errors, list) {
  17                 list_del(&error->list);
  18                 free(error);
  19         }
  20 }
  21
  22 void interface_add_error(struct interface *iface, const char *subsystem,
  23                          const char *code, const char **data, int n_data)
  24 {
  25         struct interface_error *error;
  26         int i, len = 0;
  27         int *datalen;
  28         char *dest;
  29
  30         if (n_data) {
  31                 len = n_data * sizeof(char *);
  32                 datalen = alloca(len);
  33                 for (i = 0; i < n_data; i++) {
  34                         datalen[i] = strlen(data[i]) + 1;
  35                         len += datalen[i];
  36                 }
  37         }
  38
  39         error = calloc(1, sizeof(*error) + sizeof(char *) + len);
  40         if (!error)
  41                 return;
  42
  43         list_add_tail(&error->list, &iface->errors);
  44         error->subsystem = subsystem;
  45         error->code = code;
  46
  47         dest = (char *) &error->data[n_data + 1];
  48         for (i = 0; i < n_data; i++) {
  49                 error->data[i] = dest;
  50                 memcpy(dest, data[i], datalen[i]);
  51                 dest += datalen[i];
  52         }
  53         error->data[n_data] = NULL;
  54 }
  55
  56 static void
  57 interface_event(struct interface *iface, enum interface_event ev)
  58 {
  59         /* TODO */
  60 }
  61
  62 static int
  63 __set_interface_up(struct interface *iface)
  64 {
  65         int ret;
  66
  67         if (iface->state != IFS_DOWN)
  68                 return 0;
  69
  70         ret = claim_device(iface->main_dev.dev);
  71         if (ret)
  72                 goto out;
  73
  74         iface->state = IFS_SETUP;
  75         ret = iface->proto->handler(iface->proto, PROTO_CMD_SETUP, false);
  76         if (ret)
  77                 goto release;
  78
  79         return 0;
  80
  81 release:
  82         release_device(iface->main_dev.dev);
  83 out:
  84         iface->state = IFS_DOWN;
  85         return ret;
  86 }
  87
  88 static void
  89 __set_interface_down(struct interface *iface, bool force)
  90 {
  91         clear_interface_errors(iface);
  92
  93         if (iface->state == IFS_DOWN ||
  94                 iface->state == IFS_TEARDOWN)
  95                 return;
  96
  97         iface->state = IFS_TEARDOWN;
  98         interface_event(iface, IFEV_DOWN);
  99
 100         iface->proto->handler(iface->proto, PROTO_CMD_TEARDOWN, force);
 101         release_device(iface->main_dev.dev);
 102 }
 103
 104 static void
 105 interface_cb(struct device_user *dep, enum device_event ev)
 106 {
 107         struct interface *iface;
 108         bool new_state;
 109
 110         iface = container_of(dep, struct interface, main_dev);
 111         switch (ev) {
 112         case DEV_EVENT_ADD:
 113                 new_state = true;
 114                 break;
 115         case DEV_EVENT_REMOVE:
 116                 new_state = false;
 117                 break;
 118         default:
 119                 return;
 120         }
 121
 122         if (iface->active == new_state)
 123                 return;
 124
 125         iface->active = new_state;
 126
 127         if (new_state) {
 128                 if (iface->autostart)
 129                         set_interface_up(iface);
 130         } else
 131                 __set_interface_down(iface, true);
 132 }
 133
 134 static void
 135 interface_proto_cb(struct interface_proto_state *state, enum interface_proto_event ev)
 136 {
 137         struct interface *iface = state->iface;
 138
 139         switch (ev) {
 140         case IFPEV_UP:
 141                 if (iface->state != IFS_SETUP)
 142                         return;
 143
 144                 iface->state = IFS_UP;
 145                 interface_event(iface, IFEV_UP);
 146                 break;
 147         case IFPEV_DOWN:
 148                 iface->state = IFS_DOWN;
 149                 break;
 150         }
 151 }
 152
 153 void interface_set_proto_state(struct interface *iface, struct interface_proto_state *state)
 154 {
 155         if (iface->proto) {
 156                 iface->proto->handler(iface->proto, PROTO_CMD_TEARDOWN, true);
 157                 iface->proto->free(iface->proto);
 158                 iface->proto = NULL;
 159         }
 160         iface->state = IFS_DOWN;
 161         iface->proto = state;
 162         if (!state)
 163                 return;
 164
 165         state->proto_event = interface_proto_cb;
 166         state->iface = iface;
 167 }
 168
 169 struct interface *
 170 alloc_interface(const char *name)
 171 {
 172         struct interface *iface;
 173
 174         iface = get_interface(name);
 175         if (iface)
 176                 return iface;
 177
 178         iface = calloc(1, sizeof(*iface));
 179
 180         interface_set_proto_state(iface, get_default_proto());
 181         if (!iface->proto) {
 182                 free(iface);
 183                 return NULL;
 184         }
 185
 186         iface->main_dev.cb = interface_cb;
 187         iface->l3_iface = &iface->main_dev;
 188         strncpy(iface->name, name, sizeof(iface->name) - 1);
 189         list_add(&iface->list, &interfaces);
 190         INIT_LIST_HEAD(&iface->errors);
 191
 192         netifd_ubus_add_interface(iface);
 193
 194         return iface;
 195 }
 196
 197 void
 198 free_interface(struct interface *iface)
 199 {
 200         netifd_ubus_remove_interface(iface);
 201         list_del(&iface->list);
 202         if (iface->proto->free)
 203                 iface->proto->free(iface->proto);
 204         free(iface);
 205 }
 206
 207 struct interface *
 208 get_interface(const char *name)
 209 {
 210         struct interface *iface;
 211
 212         list_for_each_entry(iface, &interfaces, list) {
 213                 if (!strcmp(iface->name, name))
 214                         return iface;
 215         }
 216         return NULL;
 217 }
 218
 219 void
 220 interface_remove_link(struct interface *iface, struct device *llif)
 221 {
 222         struct device *dev = iface->main_dev.dev;
 223
 224         if (dev && dev->hotplug_ops) {
 225                 dev->hotplug_ops->del(dev, llif);
 226                 return;
 227         }
 228
 229         remove_device_user(&iface->main_dev);
 230 }
 231
 232 int
 233 interface_add_link(struct interface *iface, struct device *llif)
 234 {
 235         struct device *dev = iface->main_dev.dev;
 236
 237         if (dev && dev->hotplug_ops)
 238                 return dev->hotplug_ops->add(dev, llif);
 239
 240         if (iface->main_dev.dev)
 241                 interface_remove_link(iface, NULL);
 242
 243         add_device_user(&iface->main_dev, llif);
 244
 245         return 0;
 246 }
 247
 248 int
 249 set_interface_up(struct interface *iface)
 250 {
 251         iface->autostart = true;
 252
 253         if (!iface->active) {
 254                 interface_add_error(iface, "interface", "NO_DEVICE", NULL, 0);
 255                 return -1;
 256         }
 257
 258         if (iface->state != IFS_DOWN)
 259                 return 0;
 260
 261         return __set_interface_up(iface);
 262 }
 263
 264 int
 265 set_interface_down(struct interface *iface)
 266 {
 267         iface->autostart = false;
 268         __set_interface_down(iface, false);
 269
 270         return 0;
 271 }