bridge: fix stray semicolon, fixes a bug in bridge primary port reset
[project/netifd.git] / macvlan.c
1 /*
2  * netifd - network interface daemon
3  * Copyright (C) 2012 Felix Fietkau <nbd@openwrt.org>
4  * Copyright (C) 2013 Jo-Philipp Wich <jow@openwrt.org>
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2
8  * as published by the Free Software Foundation
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  */
15 #include <string.h>
16 #include <stdlib.h>
17 #include <stdio.h>
18 #include <assert.h>
19 #include <errno.h>
20 #include <net/ethernet.h>
21
22 #ifdef linux
23 #include <netinet/ether.h>
24 #endif
25
26 #include "netifd.h"
27 #include "device.h"
28 #include "interface.h"
29 #include "system.h"
30
31 enum {
32         MACVLAN_ATTR_IFNAME,
33         MACVLAN_ATTR_MACADDR,
34         MACVLAN_ATTR_MODE,
35         __MACVLAN_ATTR_MAX
36 };
37
38 static const struct blobmsg_policy macvlan_attrs[__MACVLAN_ATTR_MAX] = {
39         [MACVLAN_ATTR_IFNAME]  = { "ifname", BLOBMSG_TYPE_STRING },
40         [MACVLAN_ATTR_MACADDR] = { "macaddr", BLOBMSG_TYPE_STRING },
41         [MACVLAN_ATTR_MODE] = { "mode", BLOBMSG_TYPE_STRING },
42 };
43
44 static const struct uci_blob_param_list macvlan_attr_list = {
45         .n_params = __MACVLAN_ATTR_MAX,
46         .params = macvlan_attrs,
47 };
48
49 struct macvlan_device {
50         struct device dev;
51         struct device_user parent;
52
53         device_state_cb set_state;
54
55         struct blob_attr *config_data;
56         struct blob_attr *ifname;
57         struct macvlan_config config;
58 };
59
60 static void
61 macvlan_base_cb(struct device_user *dev, enum device_event ev)
62 {
63         struct macvlan_device *mvdev = container_of(dev, struct macvlan_device, parent);
64
65         switch (ev) {
66         case DEV_EVENT_ADD:
67                 device_set_present(&mvdev->dev, true);
68                 break;
69         case DEV_EVENT_REMOVE:
70                 device_set_present(&mvdev->dev, false);
71                 break;
72         default:
73                 return;
74         }
75 }
76
77 static int
78 macvlan_set_down(struct macvlan_device *mvdev)
79 {
80         mvdev->set_state(&mvdev->dev, false);
81         system_macvlan_del(&mvdev->dev);
82         device_release(&mvdev->parent);
83
84         return 0;
85 }
86
87 static int
88 macvlan_set_up(struct macvlan_device *mvdev)
89 {
90         int ret;
91
92         ret = device_claim(&mvdev->parent);
93         if (ret < 0)
94                 return ret;
95
96         ret = system_macvlan_add(&mvdev->dev, mvdev->parent.dev, &mvdev->config);
97         if (ret < 0)
98                 goto release;
99
100         ret = mvdev->set_state(&mvdev->dev, true);
101         if (ret)
102                 goto delete;
103
104         return 0;
105
106 delete:
107         system_macvlan_del(&mvdev->dev);
108 release:
109         device_release(&mvdev->parent);
110         return ret;
111 }
112
113 static int
114 macvlan_set_state(struct device *dev, bool up)
115 {
116         struct macvlan_device *mvdev;
117
118         D(SYSTEM, "macvlan_set_state(%s, %u)\n", dev->ifname, up);
119
120         mvdev = container_of(dev, struct macvlan_device, dev);
121         if (up)
122                 return macvlan_set_up(mvdev);
123         else
124                 return macvlan_set_down(mvdev);
125 }
126
127 static void
128 macvlan_free(struct device *dev)
129 {
130         struct macvlan_device *mvdev;
131
132         mvdev = container_of(dev, struct macvlan_device, dev);
133         device_remove_user(&mvdev->parent);
134         free(mvdev);
135 }
136
137 static void
138 macvlan_dump_info(struct device *dev, struct blob_buf *b)
139 {
140         struct macvlan_device *mvdev;
141
142         mvdev = container_of(dev, struct macvlan_device, dev);
143         blobmsg_add_string(b, "parent", mvdev->parent.dev->ifname);
144         system_if_dump_info(dev, b);
145 }
146
147 static void
148 macvlan_config_init(struct device *dev)
149 {
150         struct macvlan_device *mvdev;
151         struct device *basedev = NULL;
152
153         mvdev = container_of(dev, struct macvlan_device, dev);
154         if (mvdev->ifname)
155                 basedev = device_get(blobmsg_data(mvdev->ifname), true);
156
157         device_add_user(&mvdev->parent, basedev);
158 }
159
160 static void
161 macvlan_apply_settings(struct macvlan_device *mvdev, struct blob_attr **tb)
162 {
163         struct macvlan_config *cfg = &mvdev->config;
164         struct blob_attr *cur;
165         struct ether_addr *ea;
166
167         cfg->flags = 0;
168         cfg->mode = NULL;
169
170         if ((cur = tb[MACVLAN_ATTR_MACADDR])) {
171                 ea = ether_aton(blobmsg_data(cur));
172                 if (ea) {
173                         memcpy(cfg->macaddr, ea, 6);
174                         cfg->flags |= MACVLAN_OPT_MACADDR;
175                 }
176         }
177
178         if ((cur = tb[MACVLAN_ATTR_MODE]))
179                 cfg->mode = blobmsg_data(cur);
180 }
181
182 static enum dev_change_type
183 macvlan_reload(struct device *dev, struct blob_attr *attr)
184 {
185         struct blob_attr *tb_dev[__DEV_ATTR_MAX];
186         struct blob_attr *tb_mv[__MACVLAN_ATTR_MAX];
187         enum dev_change_type ret = DEV_CONFIG_APPLIED;
188         struct macvlan_device *mvdev;
189
190         mvdev = container_of(dev, struct macvlan_device, dev);
191
192         blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
193                 blob_data(attr), blob_len(attr));
194         blobmsg_parse(macvlan_attrs, __MACVLAN_ATTR_MAX, tb_mv,
195                 blob_data(attr), blob_len(attr));
196
197         device_init_settings(dev, tb_dev);
198         macvlan_apply_settings(mvdev, tb_mv);
199         mvdev->ifname = tb_mv[MACVLAN_ATTR_IFNAME];
200
201         if (mvdev->config_data) {
202                 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
203                 struct blob_attr *otb_mv[__MACVLAN_ATTR_MAX];
204
205                 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
206                         blob_data(mvdev->config_data), blob_len(mvdev->config_data));
207
208                 if (uci_blob_diff(tb_dev, otb_dev, &device_attr_list, NULL))
209                     ret = DEV_CONFIG_RESTART;
210
211                 blobmsg_parse(macvlan_attrs, __MACVLAN_ATTR_MAX, otb_mv,
212                         blob_data(mvdev->config_data), blob_len(mvdev->config_data));
213
214                 if (uci_blob_diff(tb_mv, otb_mv, &macvlan_attr_list, NULL))
215                     ret = DEV_CONFIG_RESTART;
216
217                 macvlan_config_init(dev);
218         }
219
220         mvdev->config_data = attr;
221         return ret;
222 }
223
224 static struct device *
225 macvlan_create(const char *name, struct blob_attr *attr)
226 {
227         struct macvlan_device *mvdev;
228         struct device *dev = NULL;
229
230         mvdev = calloc(1, sizeof(*mvdev));
231         if (!mvdev)
232                 return NULL;
233
234         dev = &mvdev->dev;
235         device_init(dev, &macvlan_device_type, name);
236         dev->config_pending = true;
237
238         mvdev->set_state = dev->set_state;
239         dev->set_state = macvlan_set_state;
240
241         dev->hotplug_ops = NULL;
242         mvdev->parent.cb = macvlan_base_cb;
243
244         macvlan_reload(dev, attr);
245
246         return dev;
247 }
248
249 const struct device_type macvlan_device_type = {
250         .name = "MAC VLAN",
251         .config_params = &macvlan_attr_list,
252
253         .create = macvlan_create,
254         .config_init = macvlan_config_init,
255         .reload = macvlan_reload,
256         .free = macvlan_free,
257         .dump_info = macvlan_dump_info,
258 };