2 * Copyright (C) 2011-2012 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 static const struct blob_attr_info ubus_policy[UBUS_ATTR_MAX] = {
32 [UBUS_ATTR_STATUS] = { .type = BLOB_ATTR_INT32 },
33 [UBUS_ATTR_OBJID] = { .type = BLOB_ATTR_INT32 },
34 [UBUS_ATTR_OBJPATH] = { .type = BLOB_ATTR_STRING },
35 [UBUS_ATTR_METHOD] = { .type = BLOB_ATTR_STRING },
38 static struct blob_attr *attrbuf[UBUS_ATTR_MAX];
40 __hidden struct blob_attr **ubus_parse_msg(struct blob_attr *msg)
42 blob_parse(msg, attrbuf, ubus_policy, UBUS_ATTR_MAX);
46 static void wait_data(int fd, bool write)
48 struct pollfd pfd = { .fd = fd };
50 pfd.events = write ? POLLOUT : POLLIN;
54 static int writev_retry(int fd, struct iovec *iov, int iov_len)
59 int cur_len = writev(fd, iov, iov_len);
73 while (cur_len >= iov->iov_len) {
74 cur_len -= iov->iov_len;
77 if (!cur_len || !iov_len)
80 iov->iov_len -= cur_len;
84 int __hidden ubus_send_msg(struct ubus_context *ctx, uint32_t seq,
85 struct blob_attr *msg, int cmd, uint32_t peer)
87 struct ubus_msghdr hdr;
88 struct iovec iov[2] = {
102 iov[1].iov_base = (char *) msg;
103 iov[1].iov_len = blob_raw_len(msg);
105 return writev_retry(ctx->sock.fd, iov, ARRAY_SIZE(iov));
108 static bool recv_retry(int fd, struct iovec *iov, bool wait)
112 while (iov->iov_len > 0) {
114 wait_data(fd, false);
116 bytes = read(fd, iov->iov_base, iov->iov_len);
131 iov->iov_len -= bytes;
132 iov->iov_base += bytes;
138 static bool ubus_validate_hdr(struct ubus_msghdr *hdr)
140 if (hdr->version != 0)
143 if (blob_raw_len(hdr->data) < sizeof(*hdr->data))
146 if (blob_pad_len(hdr->data) > UBUS_MAX_MSGLEN)
152 static bool get_next_msg(struct ubus_context *ctx)
154 struct iovec iov = STATIC_IOV(ctx->msgbuf.hdr);
156 /* receive header + start attribute */
157 iov.iov_len += sizeof(struct blob_attr);
158 if (!recv_retry(ctx->sock.fd, &iov, false))
161 iov.iov_len = blob_len(ctx->msgbuf.hdr.data);
162 if (iov.iov_len > 0 && !recv_retry(ctx->sock.fd, &iov, true))
165 return ubus_validate_hdr(&ctx->msgbuf.hdr);
168 void __hidden ubus_handle_data(struct uloop_fd *u, unsigned int events)
170 struct ubus_context *ctx = container_of(u, struct ubus_context, sock);
171 struct ubus_msghdr *hdr = &ctx->msgbuf.hdr;
173 while (get_next_msg(ctx)) {
174 ubus_process_msg(ctx, hdr);
180 ctx->connection_lost(ctx);
184 ubus_refresh_state(struct ubus_context *ctx)
186 struct ubus_object *obj, *tmp;
188 /* clear all type IDs, they need to be registered again */
189 avl_for_each_element(&ctx->objects, obj, avl)
192 /* push out all objects again */
193 avl_for_each_element_safe(&ctx->objects, obj, avl, tmp) {
195 avl_delete(&ctx->objects, &obj->avl);
196 ubus_add_object(ctx, obj);
200 int ubus_reconnect(struct ubus_context *ctx, const char *path)
203 struct ubus_msghdr hdr;
204 struct blob_attr data;
206 struct blob_attr *buf;
207 int ret = UBUS_STATUS_UNKNOWN_ERROR;
210 path = UBUS_UNIX_SOCKET;
212 if (ctx->sock.fd >= 0) {
213 if (ctx->sock.registered)
214 uloop_fd_delete(&ctx->sock);
219 ctx->sock.fd = usock(USOCK_UNIX, path, NULL);
220 if (ctx->sock.fd < 0)
221 return UBUS_STATUS_CONNECTION_FAILED;
223 if (read(ctx->sock.fd, &hdr, sizeof(hdr)) != sizeof(hdr))
226 if (!ubus_validate_hdr(&hdr.hdr))
229 if (hdr.hdr.type != UBUS_MSG_HELLO)
232 buf = calloc(1, blob_raw_len(&hdr.data));
236 memcpy(buf, &hdr.data, sizeof(hdr.data));
237 if (read(ctx->sock.fd, blob_data(buf), blob_len(buf)) != blob_len(buf))
240 ctx->local_id = hdr.hdr.peer;
244 ret = UBUS_STATUS_OK;
245 fcntl(ctx->sock.fd, F_SETFL, fcntl(ctx->sock.fd, F_GETFL) | O_NONBLOCK);
247 ubus_refresh_state(ctx);