2 * Copyright (C) 2011-2014 Felix Fietkau <nbd@openwrt.org>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU Lesser General Public License version 2.1
6 * as published by the Free Software Foundation
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
14 #include <sys/types.h>
16 #include <sys/socket.h>
22 #include <libubox/usock.h>
23 #include <libubox/blob.h>
24 #include <libubox/blobmsg.h>
27 #include "libubus-internal.h"
29 #define STATIC_IOV(_var) { .iov_base = (char *) &(_var), .iov_len = sizeof(_var) }
31 #define UBUS_MSGBUF_REDUCTION_INTERVAL 16
33 static const struct blob_attr_info ubus_policy[UBUS_ATTR_MAX] = {
34 [UBUS_ATTR_STATUS] = { .type = BLOB_ATTR_INT32 },
35 [UBUS_ATTR_OBJID] = { .type = BLOB_ATTR_INT32 },
36 [UBUS_ATTR_OBJPATH] = { .type = BLOB_ATTR_STRING },
37 [UBUS_ATTR_METHOD] = { .type = BLOB_ATTR_STRING },
38 [UBUS_ATTR_ACTIVE] = { .type = BLOB_ATTR_INT8 },
39 [UBUS_ATTR_NO_REPLY] = { .type = BLOB_ATTR_INT8 },
40 [UBUS_ATTR_SUBSCRIBERS] = { .type = BLOB_ATTR_NESTED },
43 static struct blob_attr *attrbuf[UBUS_ATTR_MAX];
45 __hidden struct blob_attr **ubus_parse_msg(struct blob_attr *msg)
47 blob_parse(msg, attrbuf, ubus_policy, UBUS_ATTR_MAX);
51 static void wait_data(int fd, bool write)
53 struct pollfd pfd = { .fd = fd };
55 pfd.events = write ? POLLOUT : POLLIN;
59 static int writev_retry(int fd, struct iovec *iov, int iov_len, int sock_fd)
66 .cmsg_len = sizeof(fd_buf),
67 .cmsg_level = SOL_SOCKET,
68 .cmsg_type = SCM_RIGHTS,
71 struct msghdr msghdr = {
73 .msg_iovlen = iov_len,
74 .msg_control = &fd_buf,
75 .msg_controllen = sizeof(fd_buf),
83 msghdr.msg_control = NULL;
84 msghdr.msg_controllen = 0;
89 cur_len = sendmsg(fd, &msghdr, 0);
107 while (cur_len >= iov->iov_len) {
108 cur_len -= iov->iov_len;
114 iov->iov_base += cur_len;
115 iov->iov_len -= cur_len;
116 msghdr.msg_iov = iov;
117 msghdr.msg_iovlen = iov_len;
120 /* Should never reach here */
124 int __hidden ubus_send_msg(struct ubus_context *ctx, uint32_t seq,
125 struct blob_attr *msg, int cmd, uint32_t peer, int fd)
127 struct ubus_msghdr hdr;
128 struct iovec iov[2] = {
139 blob_buf_init(&b, 0);
143 iov[1].iov_base = (char *) msg;
144 iov[1].iov_len = blob_raw_len(msg);
146 ret = writev_retry(ctx->sock.fd, iov, ARRAY_SIZE(iov), fd);
148 ctx->sock.eof = true;
156 static int recv_retry(int fd, struct iovec *iov, bool wait, int *recv_fd)
158 int bytes, total = 0;
164 .cmsg_type = SCM_RIGHTS,
165 .cmsg_level = SOL_SOCKET,
166 .cmsg_len = sizeof(fd_buf),
169 struct msghdr msghdr = {
174 while (iov->iov_len > 0) {
176 wait_data(fd, false);
179 msghdr.msg_control = &fd_buf;
180 msghdr.msg_controllen = sizeof(fd_buf);
182 msghdr.msg_control = NULL;
183 msghdr.msg_controllen = 0;
187 bytes = recvmsg(fd, &msghdr, 0);
205 *recv_fd = fd_buf.fd;
210 iov->iov_len -= bytes;
211 iov->iov_base += bytes;
218 static bool ubus_validate_hdr(struct ubus_msghdr *hdr)
220 struct blob_attr *data = (struct blob_attr *) (hdr + 1);
222 if (hdr->version != 0)
225 if (blob_raw_len(data) < sizeof(*data))
228 if (blob_pad_len(data) > UBUS_MAX_MSGLEN)
234 static bool get_next_msg(struct ubus_context *ctx, int *recv_fd)
237 struct ubus_msghdr hdr;
238 struct blob_attr data;
240 struct iovec iov = STATIC_IOV(hdrbuf);
244 /* receive header + start attribute */
245 r = recv_retry(ctx->sock.fd, &iov, false, recv_fd);
248 ctx->sock.eof = true;
253 if (!ubus_validate_hdr(&hdrbuf.hdr))
256 len = blob_raw_len(&hdrbuf.data);
257 if (len > ctx->msgbuf_data_len)
258 ctx->msgbuf_reduction_counter = UBUS_MSGBUF_REDUCTION_INTERVAL;
259 else if (ctx->msgbuf_reduction_counter > 0 && len < UBUS_MSG_CHUNK_SIZE)
260 len = !--ctx->msgbuf_reduction_counter ? UBUS_MSG_CHUNK_SIZE : -1;
265 ctx->msgbuf.data = realloc(ctx->msgbuf.data, len * sizeof(char));
266 if (ctx->msgbuf.data)
267 ctx->msgbuf_data_len = len;
269 if (!ctx->msgbuf.data)
272 memcpy(&ctx->msgbuf.hdr, &hdrbuf.hdr, sizeof(hdrbuf.hdr));
273 memcpy(ctx->msgbuf.data, &hdrbuf.data, sizeof(hdrbuf.data));
275 iov.iov_base = (char *)ctx->msgbuf.data + sizeof(hdrbuf.data);
276 iov.iov_len = blob_len(ctx->msgbuf.data);
277 if (iov.iov_len > 0 && !recv_retry(ctx->sock.fd, &iov, true, NULL))
283 void __hidden ubus_handle_data(struct uloop_fd *u, unsigned int events)
285 struct ubus_context *ctx = container_of(u, struct ubus_context, sock);
286 struct ubus_msghdr *hdr = &ctx->msgbuf.hdr;
289 while (get_next_msg(ctx, &recv_fd)) {
290 ubus_process_msg(ctx, hdr, recv_fd);
296 ctx->connection_lost(ctx);
299 void __hidden ubus_poll_data(struct ubus_context *ctx, int timeout)
301 struct pollfd pfd = {
303 .events = POLLIN | POLLERR,
306 poll(&pfd, 1, timeout);
307 ubus_handle_data(&ctx->sock, ULOOP_READ);
311 ubus_refresh_state(struct ubus_context *ctx)
313 struct ubus_object *obj, *tmp;
314 struct ubus_object **objs;
317 /* clear all type IDs, they need to be registered again */
318 avl_for_each_element(&ctx->objects, obj, avl)
322 /* push out all objects again */
323 objs = alloca(ctx->objects.count * sizeof(*objs));
324 avl_remove_all_elements(&ctx->objects, obj, avl, tmp) {
329 for (n = i, i = 0; i < n; i++)
330 ubus_add_object(ctx, objs[i]);
333 int ubus_reconnect(struct ubus_context *ctx, const char *path)
336 struct ubus_msghdr hdr;
337 struct blob_attr data;
339 struct blob_attr *buf;
340 int ret = UBUS_STATUS_UNKNOWN_ERROR;
343 path = UBUS_UNIX_SOCKET;
345 if (ctx->sock.fd >= 0) {
346 if (ctx->sock.registered)
347 uloop_fd_delete(&ctx->sock);
352 ctx->sock.fd = usock(USOCK_UNIX, path, NULL);
353 if (ctx->sock.fd < 0)
354 return UBUS_STATUS_CONNECTION_FAILED;
356 if (read(ctx->sock.fd, &hdr, sizeof(hdr)) != sizeof(hdr))
359 if (!ubus_validate_hdr(&hdr.hdr))
362 if (hdr.hdr.type != UBUS_MSG_HELLO)
365 buf = calloc(1, blob_raw_len(&hdr.data));
369 memcpy(buf, &hdr.data, sizeof(hdr.data));
370 if (read(ctx->sock.fd, blob_data(buf), blob_len(buf)) != blob_len(buf))
373 ctx->local_id = hdr.hdr.peer;
377 ret = UBUS_STATUS_OK;
378 fcntl(ctx->sock.fd, F_SETFL, fcntl(ctx->sock.fd, F_GETFL) | O_NONBLOCK | O_CLOEXEC);
380 ubus_refresh_state(ctx);