Fix upstream detection
[project/odhcpd.git] / src / ubus.c
1 #include <syslog.h>
2 #include <libubus.h>
3 #include <libubox/uloop.h>
4 #include <arpa/inet.h>
5
6 #include "odhcpd.h"
7 #include "dhcpv6.h"
8 #include "dhcpv4.h"
9
10
11 static struct ubus_context *ubus = NULL;
12 static struct ubus_subscriber netifd;
13 static struct blob_buf b;
14 static struct blob_attr *dump = NULL;
15 static uint32_t objid = 0;
16
17
18 static int handle_dhcpv4_leases(struct ubus_context *ctx, _unused struct ubus_object *obj,
19 struct ubus_request_data *req, _unused const char *method,
20 _unused struct blob_attr *msg)
21 {
22 blob_buf_init(&b, 0);
23 void *a = blobmsg_open_table(&b, "device");
24 time_t now = odhcpd_time();
25
26 struct interface *iface;
27 list_for_each_entry(iface, &interfaces, head) {
28 if (iface->dhcpv4 != RELAYD_SERVER)
29 continue;
30
31 void *i = blobmsg_open_table(&b, iface->ifname);
32 void *j = blobmsg_open_array(&b, "leases");
33
34 struct dhcpv4_assignment *lease;
35 list_for_each_entry(lease, &iface->dhcpv4_assignments, head) {
36 if (lease->valid_until < now)
37 continue;
38
39 void *l = blobmsg_open_table(&b, NULL);
40
41 char *buf = blobmsg_alloc_string_buffer(&b, "mac", 13);
42 odhcpd_hexlify(buf, lease->hwaddr, sizeof(lease->hwaddr));
43 blobmsg_add_string_buffer(&b);
44
45 blobmsg_add_string(&b, "hostname", lease->hostname);
46
47 buf = blobmsg_alloc_string_buffer(&b, "ip", INET_ADDRSTRLEN);
48 struct in_addr addr = {htonl(lease->addr)};
49 inet_ntop(AF_INET, &addr, buf, INET_ADDRSTRLEN);
50 blobmsg_add_string_buffer(&b);
51
52 blobmsg_add_u32(&b, "valid", now - lease->valid_until);
53
54 blobmsg_close_table(&b, l);
55 }
56
57 blobmsg_close_array(&b, j);
58 blobmsg_close_table(&b, i);
59 }
60
61 blobmsg_close_table(&b, a);
62 ubus_send_reply(ctx, req, b.head);
63 return 0;
64 }
65
66
67 static int handle_dhcpv6_leases(_unused struct ubus_context *ctx, _unused struct ubus_object *obj,
68 _unused struct ubus_request_data *req, _unused const char *method,
69 _unused struct blob_attr *msg)
70 {
71 blob_buf_init(&b, 0);
72 void *a = blobmsg_open_table(&b, "device");
73 time_t now = odhcpd_time();
74
75 struct interface *iface;
76 list_for_each_entry(iface, &interfaces, head) {
77 if (iface->dhcpv6 != RELAYD_SERVER)
78 continue;
79
80 void *i = blobmsg_open_table(&b, iface->ifname);
81 void *j = blobmsg_open_array(&b, "leases");
82
83 struct dhcpv6_assignment *lease;
84 list_for_each_entry(lease, &iface->ia_assignments, head) {
85 if (lease->valid_until < now)
86 continue;
87
88 void *l = blobmsg_open_table(&b, NULL);
89
90 char *buf = blobmsg_alloc_string_buffer(&b, "duid", 264);
91 odhcpd_hexlify(buf, lease->clid_data, lease->clid_len);
92 blobmsg_add_string_buffer(&b);
93
94 blobmsg_add_u32(&b, "iaid", ntohl(lease->iaid));
95 blobmsg_add_string(&b, "hostname", (lease->hostname) ? lease->hostname : "");
96 blobmsg_add_u32(&b, "assigned", lease->assigned);
97 blobmsg_add_u32(&b, "length", lease->length);
98
99 void *m = blobmsg_open_array(&b, "ipv6");
100 struct in6_addr addr;
101 for (size_t i = 0; i < iface->ia_addr_len; ++i) {
102 if (iface->ia_addr[i].prefix > 64)
103 continue;
104
105 addr = iface->ia_addr[i].addr;
106 if (lease->length == 128)
107 addr.s6_addr32[3] = htonl(lease->assigned);
108 else
109 addr.s6_addr32[1] |= htonl(lease->assigned);
110
111 char *c = blobmsg_alloc_string_buffer(&b, NULL, INET6_ADDRSTRLEN);
112 inet_ntop(AF_INET6, &addr, c, INET6_ADDRSTRLEN);
113 blobmsg_add_string_buffer(&b);
114 }
115 blobmsg_close_table(&b, m);
116
117 blobmsg_add_u32(&b, "valid", now - lease->valid_until);
118
119 blobmsg_close_table(&b, l);
120 }
121
122 blobmsg_close_array(&b, j);
123 blobmsg_close_table(&b, i);
124 }
125
126 blobmsg_close_table(&b, a);
127 ubus_send_reply(ctx, req, b.head);
128 return 0;
129 }
130
131
132 static struct ubus_method main_object_methods[] = {
133 {.name = "ipv4leases", .handler = handle_dhcpv4_leases},
134 {.name = "ipv6leases", .handler = handle_dhcpv6_leases},
135 };
136
137 static struct ubus_object_type main_object_type =
138 UBUS_OBJECT_TYPE("dhcp", main_object_methods);
139
140 static struct ubus_object main_object = {
141 .name = "dhcp",
142 .type = &main_object_type,
143 .methods = main_object_methods,
144 .n_methods = ARRAY_SIZE(main_object_methods),
145 };
146
147
148 enum {
149 DUMP_ATTR_INTERFACE,
150 DUMP_ATTR_MAX
151 };
152
153 static const struct blobmsg_policy dump_attrs[DUMP_ATTR_MAX] = {
154 [DUMP_ATTR_INTERFACE] = { .name = "interface", .type = BLOBMSG_TYPE_ARRAY },
155 };
156
157
158 enum {
159 IFACE_ATTR_INTERFACE,
160 IFACE_ATTR_IFNAME,
161 IFACE_ATTR_UP,
162 IFACE_ATTR_DATA,
163 IFACE_ATTR_MAX,
164 };
165
166 static const struct blobmsg_policy iface_attrs[IFACE_ATTR_MAX] = {
167 [IFACE_ATTR_INTERFACE] = { .name = "interface", .type = BLOBMSG_TYPE_STRING },
168 [IFACE_ATTR_IFNAME] = { .name = "ifname", .type = BLOBMSG_TYPE_STRING },
169 [IFACE_ATTR_UP] = { .name = "up", .type = BLOBMSG_TYPE_BOOL },
170 [IFACE_ATTR_DATA] = { .name = "data", .type = BLOBMSG_TYPE_TABLE },
171 };
172
173 static void handle_dump(_unused struct ubus_request *req, _unused int type, struct blob_attr *msg)
174 {
175 struct blob_attr *tb[DUMP_ATTR_INTERFACE];
176 blobmsg_parse(dump_attrs, DUMP_ATTR_MAX, tb, blob_data(msg), blob_len(msg));
177
178 if (!tb[DUMP_ATTR_INTERFACE])
179 return;
180
181 free(dump);
182 dump = blob_memdup(tb[DUMP_ATTR_INTERFACE]);
183 raise(SIGHUP);
184 }
185
186
187 static int handle_update(_unused struct ubus_context *ctx, _unused struct ubus_object *obj,
188 _unused struct ubus_request_data *req, _unused const char *method,
189 struct blob_attr *msg)
190 {
191 struct blob_attr *tb[IFACE_ATTR_MAX];
192 blobmsg_parse(iface_attrs, IFACE_ATTR_MAX, tb, blob_data(msg), blob_len(msg));
193
194 const char *interface = (tb[IFACE_ATTR_INTERFACE]) ?
195 blobmsg_get_string(tb[IFACE_ATTR_INTERFACE]) : "";
196 const char *ifname = (tb[IFACE_ATTR_IFNAME]) ?
197 blobmsg_get_string(tb[IFACE_ATTR_IFNAME]) : "";
198
199 struct interface *c, *iface = NULL;
200 list_for_each_entry(c, &interfaces, head)
201 if (!strcmp(interface, c->name) || !strcmp(ifname, c->ifname))
202 iface = c;
203
204 if (iface && iface->ignore)
205 return 0;
206
207 ubus_invoke(ubus, objid, "dump", NULL, handle_dump, NULL, 0);
208 return 0;
209 }
210
211
212 static void subscribe_netifd(void)
213 {
214 netifd.cb = handle_update;
215 ubus_subscribe(ubus, &netifd, objid);
216 ubus_invoke(ubus, objid, "dump", NULL, handle_dump, NULL, 0);
217 }
218
219
220 void ubus_apply_network(void)
221 {
222 struct blob_attr *c;
223 int rem;
224
225 if (!dump)
226 return;
227
228 blobmsg_for_each_attr(c, dump, rem) {
229 struct blob_attr *tb[IFACE_ATTR_MAX];
230 blobmsg_parse(iface_attrs, IFACE_ATTR_MAX, tb, blob_data(c), blob_len(c));
231
232 if (!tb[IFACE_ATTR_INTERFACE] || !tb[IFACE_ATTR_DATA])
233 continue;
234
235 const char *interface = (tb[IFACE_ATTR_INTERFACE]) ?
236 blobmsg_get_string(tb[IFACE_ATTR_INTERFACE]) : "";
237 const char *ifname = (tb[IFACE_ATTR_IFNAME]) ?
238 blobmsg_get_string(tb[IFACE_ATTR_IFNAME]) : "";
239
240 struct interface *c;
241 list_for_each_entry(c, &interfaces, head) {
242 char *f = memmem(c->upstream, c->upstream_len,
243 interface, strlen(interface) + 1);
244 if (strcmp(interface, c->name) && strcmp(ifname, c->ifname) &&
245 (!f || (f != c->upstream && f[-1] != 0)))
246 continue;
247
248 if (!c || !c->ignore)
249 config_parse_interface(tb[IFACE_ATTR_DATA], interface, false);
250 }
251 }
252 }
253
254
255 enum {
256 OBJ_ATTR_ID,
257 OBJ_ATTR_PATH,
258 OBJ_ATTR_MAX
259 };
260
261 static const struct blobmsg_policy obj_attrs[OBJ_ATTR_MAX] = {
262 [OBJ_ATTR_ID] = { .name = "id", .type = BLOBMSG_TYPE_INT32 },
263 [OBJ_ATTR_PATH] = { .name = "path", .type = BLOBMSG_TYPE_STRING },
264 };
265
266
267 static void handle_event(_unused struct ubus_context *ctx, _unused struct ubus_event_handler *ev,
268 _unused const char *type, struct blob_attr *msg)
269 {
270 struct blob_attr *tb[OBJ_ATTR_MAX];
271 blobmsg_parse(obj_attrs, OBJ_ATTR_MAX, tb, blob_data(msg), blob_len(msg));
272 objid = 0;
273
274 if (!tb[OBJ_ATTR_ID] || !tb[OBJ_ATTR_PATH])
275 return;
276
277 if (strcmp(blobmsg_get_string(tb[OBJ_ATTR_PATH]), "network.interface"))
278 return;
279
280 objid = blobmsg_get_u32(tb[OBJ_ATTR_ID]);
281 subscribe_netifd();
282 }
283
284 static struct ubus_event_handler event_handler = { .cb = handle_event };
285
286
287 const char* ubus_get_ifname(const char *name)
288 {
289 struct blob_attr *c;
290 int rem;
291
292 if (!dump)
293 return NULL;
294
295 blobmsg_for_each_attr(c, dump, rem) {
296 struct blob_attr *tb[IFACE_ATTR_MAX];
297 blobmsg_parse(iface_attrs, IFACE_ATTR_MAX, tb, blob_data(c), blob_len(c));
298
299 if (!tb[IFACE_ATTR_INTERFACE] || strcmp(name,
300 blobmsg_get_string(tb[IFACE_ATTR_INTERFACE])))
301 continue;
302
303 if (tb[IFACE_ATTR_IFNAME])
304 return blobmsg_get_string(tb[IFACE_ATTR_IFNAME]);
305 }
306
307 return NULL;
308 }
309
310
311 int init_ubus(void)
312 {
313 if (!(ubus = ubus_connect(NULL))) {
314 syslog(LOG_ERR, "Unable to connect to ubus: %s", strerror(errno));
315 return -1;
316 }
317
318 ubus_add_uloop(ubus);
319 ubus_add_object(ubus, &main_object);
320 ubus_register_event_handler(ubus, &event_handler, "ubus.object.add");
321 if (!ubus_lookup_id(ubus, "network.interface", &objid))
322 subscribe_netifd();
323
324 return 0;
325 }
326