add prelocal table to manipulate locally destinated traffic
[project/netifd.git] / vlandev.c
1 /*
2  * netifd - network interface daemon
3  * Copyright (C) 2014 Gioacchino Mazzurco <gio@eigenlab.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
15 #include <string.h>
16
17 #include "netifd.h"
18 #include "device.h"
19 #include "interface.h"
20 #include "system.h"
21
22 enum {
23         VLANDEV_ATTR_TYPE,
24         VLANDEV_ATTR_IFNAME,
25         VLANDEV_ATTR_VID,
26         __VLANDEV_ATTR_MAX
27 };
28
29 static const struct blobmsg_policy vlandev_attrs[__VLANDEV_ATTR_MAX] = {
30         [VLANDEV_ATTR_TYPE] = { "type", BLOBMSG_TYPE_STRING },
31         [VLANDEV_ATTR_IFNAME] = { "ifname", BLOBMSG_TYPE_STRING },
32         [VLANDEV_ATTR_VID] = { "vid", BLOBMSG_TYPE_INT32 },
33 };
34
35 static const struct uci_blob_param_list vlandev_attr_list = {
36         .n_params = __VLANDEV_ATTR_MAX,
37         .params = vlandev_attrs,
38
39         .n_next = 1,
40         .next = { &device_attr_list },
41 };
42
43 struct vlandev_device {
44         struct device dev;
45         struct device_user parent;
46
47         device_state_cb set_state;
48
49         struct blob_attr *config_data;
50         struct blob_attr *ifname;
51         struct vlandev_config config;
52 };
53
54 static void
55 vlandev_base_cb(struct device_user *dev, enum device_event ev)
56 {
57         struct vlandev_device *mvdev = container_of(dev, struct vlandev_device, parent);
58
59         switch (ev) {
60         case DEV_EVENT_ADD:
61                 device_set_present(&mvdev->dev, true);
62                 break;
63         case DEV_EVENT_REMOVE:
64                 device_set_present(&mvdev->dev, false);
65                 break;
66         case DEV_EVENT_LINK_UP:
67                 device_set_link(&mvdev->dev, true);
68                 break;
69         case DEV_EVENT_LINK_DOWN:
70                 device_set_link(&mvdev->dev, false);
71                 break;
72         default:
73                 return;
74         }
75 }
76
77 static int
78 vlandev_set_down(struct vlandev_device *mvdev)
79 {
80         mvdev->set_state(&mvdev->dev, false);
81         system_vlandev_del(&mvdev->dev);
82         device_release(&mvdev->parent);
83
84         return 0;
85 }
86
87 static int
88 vlandev_set_up(struct vlandev_device *mvdev)
89 {
90         int ret;
91
92         ret = device_claim(&mvdev->parent);
93         if (ret < 0)
94                 return ret;
95
96         ret = system_vlandev_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_vlandev_del(&mvdev->dev);
108 release:
109         device_release(&mvdev->parent);
110         return ret;
111 }
112
113 static int
114 vlandev_set_state(struct device *dev, bool up)
115 {
116         struct vlandev_device *mvdev;
117
118         D(SYSTEM, "vlandev_set_state(%s, %u)\n", dev->ifname, up);
119
120         mvdev = container_of(dev, struct vlandev_device, dev);
121         if (up)
122                 return vlandev_set_up(mvdev);
123         else
124                 return vlandev_set_down(mvdev);
125 }
126
127 static void
128 vlandev_free(struct device *dev)
129 {
130         struct vlandev_device *mvdev;
131
132         mvdev = container_of(dev, struct vlandev_device, dev);
133         device_remove_user(&mvdev->parent);
134         free(mvdev->config_data);
135         free(mvdev);
136 }
137
138 static void
139 vlandev_dump_info(struct device *dev, struct blob_buf *b)
140 {
141         struct vlandev_device *mvdev;
142
143         mvdev = container_of(dev, struct vlandev_device, dev);
144         blobmsg_add_string(b, "parent", mvdev->parent.dev->ifname);
145         system_if_dump_info(dev, b);
146 }
147
148 static void
149 vlandev_config_init(struct device *dev)
150 {
151         struct vlandev_device *mvdev;
152         struct device *basedev = NULL;
153
154         mvdev = container_of(dev, struct vlandev_device, dev);
155         if (mvdev->ifname)
156                 basedev = device_get(blobmsg_data(mvdev->ifname), true);
157
158         device_add_user(&mvdev->parent, basedev);
159 }
160
161 static void
162 vlandev_apply_settings(struct vlandev_device *mvdev, struct blob_attr **tb)
163 {
164         struct vlandev_config *cfg = &mvdev->config;
165         struct blob_attr *cur;
166
167         cfg->proto = VLAN_PROTO_8021Q;
168         cfg->vid = 1;
169
170         if ((cur = tb[VLANDEV_ATTR_TYPE]))
171         {
172                 if(!strcmp(blobmsg_data(cur), "8021ad"))
173                         cfg->proto = VLAN_PROTO_8021AD;
174         }
175
176         if ((cur = tb[VLANDEV_ATTR_VID]))
177                 cfg->vid = (uint16_t) blobmsg_get_u32(cur);
178 }
179
180 static enum dev_change_type
181 vlandev_reload(struct device *dev, struct blob_attr *attr)
182 {
183         struct blob_attr *tb_dev[__DEV_ATTR_MAX];
184         struct blob_attr *tb_mv[__VLANDEV_ATTR_MAX];
185         enum dev_change_type ret = DEV_CONFIG_APPLIED;
186         struct vlandev_device *mvdev;
187
188         mvdev = container_of(dev, struct vlandev_device, dev);
189         attr = blob_memdup(attr);
190
191         blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
192                 blob_data(attr), blob_len(attr));
193         blobmsg_parse(vlandev_attrs, __VLANDEV_ATTR_MAX, tb_mv,
194                 blob_data(attr), blob_len(attr));
195
196         device_init_settings(dev, tb_dev);
197         vlandev_apply_settings(mvdev, tb_mv);
198         mvdev->ifname = tb_mv[VLANDEV_ATTR_IFNAME];
199
200         if (mvdev->config_data) {
201                 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
202                 struct blob_attr *otb_mv[__VLANDEV_ATTR_MAX];
203
204                 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
205                         blob_data(mvdev->config_data), blob_len(mvdev->config_data));
206
207                 if (uci_blob_diff(tb_dev, otb_dev, &device_attr_list, NULL))
208                     ret = DEV_CONFIG_RESTART;
209
210                 blobmsg_parse(vlandev_attrs, __VLANDEV_ATTR_MAX, otb_mv,
211                         blob_data(mvdev->config_data), blob_len(mvdev->config_data));
212
213                 if (uci_blob_diff(tb_mv, otb_mv, &vlandev_attr_list, NULL))
214                     ret = DEV_CONFIG_RESTART;
215
216                 vlandev_config_init(dev);
217         }
218
219         free(mvdev->config_data);
220         mvdev->config_data = attr;
221         return ret;
222 }
223
224 static struct device *
225 vlandev_create(const char *name, struct blob_attr *attr)
226 {
227         struct vlandev_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, &vlandev_device_type, name);
236         dev->config_pending = true;
237
238         mvdev->set_state = dev->set_state;
239         dev->set_state = vlandev_set_state;
240
241         dev->hotplug_ops = NULL;
242         mvdev->parent.cb = vlandev_base_cb;
243
244         vlandev_reload(dev, attr);
245
246         return dev;
247 }
248
249 const struct device_type vlandev_device_type = {
250         .name = "VLANDEV",
251         .config_params = &vlandev_attr_list,
252         .keep_link_status = true,
253
254         .create = vlandev_create,
255         .config_init = vlandev_config_init,
256         .reload = vlandev_reload,
257         .free = vlandev_free,
258         .dump_info = vlandev_dump_info,
259 };