• source navigation  • diff markup  • identifier search  • freetext search  • 

Sources/netifd/vlan.c

  1 /*
  2  * netifd - network interface daemon
  3  * Copyright (C) 2012 Felix Fietkau <nbd@openwrt.org>
  4  *
  5  * This program is free software; you can redistribute it and/or modify
  6  * it under the terms of the GNU General Public License version 2
  7  * as published by the Free Software Foundation
  8  *
  9  * This program is distributed in the hope that it will be useful,
 10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 12  * GNU General Public License for more details.
 13  */
 14 #include <string.h>
 15 #include <stdlib.h>
 16 #include <stdio.h>
 17 
 18 #include "netifd.h"
 19 #include "system.h"
 20 
 21 struct vlan_device {
 22         struct device dev;
 23         struct device_user dep;
 24 
 25         device_state_cb set_state;
 26         int id;
 27 };
 28 
 29 static void free_vlan_if(struct device *iface)
 30 {
 31         struct vlan_device *vldev;
 32 
 33         vldev = container_of(iface, struct vlan_device, dev);
 34         device_remove_user(&vldev->dep);
 35         device_cleanup(&vldev->dev);
 36         free(vldev);
 37 }
 38 
 39 static int vlan_set_device_state(struct device *dev, bool up)
 40 {
 41         struct vlan_device *vldev;
 42         int ret = 0;
 43 
 44         vldev = container_of(dev, struct vlan_device, dev);
 45         if (!up) {
 46                 vldev->set_state(dev, false);
 47                 system_vlan_del(dev);
 48                 device_release(&vldev->dep);
 49                 return 0;
 50         }
 51 
 52         ret = device_claim(&vldev->dep);
 53         if (ret < 0)
 54                 return ret;
 55 
 56         system_vlan_add(vldev->dep.dev, vldev->id);
 57         ret = vldev->set_state(dev, true);
 58         if (ret)
 59                 device_release(&vldev->dep);
 60 
 61         return ret;
 62 }
 63 
 64 static int vlan_dev_set_name(struct vlan_device *vldev, struct device *dev)
 65 {
 66         char *name;
 67 
 68         name = alloca(strlen(dev->ifname) + sizeof(".2147483647\0"));
 69         vldev->dev.hidden = dev->hidden;
 70         sprintf(name, "%s.%d", dev->ifname, vldev->id);
 71 
 72         return device_set_ifname(&vldev->dev, name);
 73 }
 74 
 75 static void vlan_dev_cb(struct device_user *dep, enum device_event ev)
 76 {
 77         struct vlan_device *vldev;
 78 
 79         vldev = container_of(dep, struct vlan_device, dep);
 80         switch(ev) {
 81         case DEV_EVENT_ADD:
 82                 device_set_present(&vldev->dev, true);
 83                 break;
 84         case DEV_EVENT_REMOVE:
 85                 device_set_present(&vldev->dev, false);
 86                 break;
 87         case DEV_EVENT_UPDATE_IFNAME:
 88                 if (vlan_dev_set_name(vldev, dep->dev) < 0)
 89                         free_vlan_if(&vldev->dev);
 90                 break;
 91         case DEV_EVENT_TOPO_CHANGE:
 92                 /* Propagate topo changes */
 93                 device_broadcast_event(&vldev->dev, DEV_EVENT_TOPO_CHANGE);
 94                 break;
 95         default:
 96                 break;
 97         }
 98 }
 99 
100 static struct device *get_vlan_device(struct device *dev, int id, bool create)
101 {
102         static struct device_type vlan_type = {
103                 .name = "VLAN",
104                 .config_params = &device_attr_list,
105                 .free = free_vlan_if,
106         };
107         struct vlan_device *vldev;
108         struct device_user *dep;
109 
110         /* look for an existing interface before creating a new one */
111         list_for_each_entry(dep, &dev->users.list, list.list) {
112                 if (dep->cb != vlan_dev_cb)
113                         continue;
114 
115                 vldev = container_of(dep, struct vlan_device, dep);
116                 if (vldev->id != id)
117                         continue;
118 
119                 return &vldev->dev;
120         }
121 
122         if (!create)
123                 return NULL;
124 
125         D(DEVICE, "Create vlan device '%s.%d'\n", dev->ifname, id);
126 
127         vldev = calloc(1, sizeof(*vldev));
128         if (!vldev)
129                 return NULL;
130 
131         vldev->id = id;
132 
133         if (device_init(&vldev->dev, &vlan_type, NULL) < 0)
134                 goto error;
135 
136         if (vlan_dev_set_name(vldev, dev) < 0)
137                 goto error;
138 
139         vldev->dev.default_config = true;
140 
141         vldev->set_state = vldev->dev.set_state;
142         vldev->dev.set_state = vlan_set_device_state;
143 
144         vldev->dep.cb = vlan_dev_cb;
145         device_add_user(&vldev->dep, dev);
146 
147         return &vldev->dev;
148 
149 error:
150         device_cleanup(&vldev->dev);
151         free(vldev);
152         return NULL;
153 }
154 
155 static char *split_vlan(char *s)
156 {
157         s = strchr(s, '.');
158         if (!s)
159                 goto out;
160 
161         *s = 0;
162         s++;
163 
164 out:
165         return s;
166 }
167 
168 struct device *get_vlan_device_chain(const char *ifname, bool create)
169 {
170         struct device *dev = NULL;
171         char *buf, *s, *next, *err = NULL;
172         int id;
173 
174         buf = strdup(ifname);
175         if (!buf)
176                 return NULL;
177 
178         s = split_vlan(buf);
179         dev = device_get(buf, create);
180         if (!dev)
181                 goto error;
182 
183         do {
184                 next = split_vlan(s);
185                 id = strtoul(s, &err, 10);
186                 if (err && *err)
187                         goto error;
188 
189                 dev = get_vlan_device(dev, id, create);
190                 if (!dev)
191                         goto error;
192 
193                 s = next;
194                 if (!s)
195                         goto out;
196         } while (1);
197 
198 error:
199         dev = NULL;
200 out:
201         free(buf);
202         return dev;
203 }
204 

This page was automatically generated by LXR 0.3.1.  •  OpenWrt