interface.c

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