watch add/remove -> subscribe/unsubscribe:
[project/ubus.git] / libubus.c
index 5c6bd8a..03899d6 100644 (file)
--- a/libubus.c
+++ b/libubus.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (C) 2011 Felix Fietkau <nbd@openwrt.org>
+ * Copyright (C) 2011-2012 Felix Fietkau <nbd@openwrt.org>
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU Lesser General Public License version 2.1
  */
 
 #include <sys/types.h>
-#include <sys/uio.h>
 #include <sys/socket.h>
-#include <fcntl.h>
 #include <unistd.h>
 
 #include <libubox/blob.h>
 #include <libubox/blobmsg.h>
-#include <libubox/usock.h>
 
 #include "libubus.h"
+#include "libubus-internal.h"
 #include "ubusmsg.h"
 
-#define STATIC_IOV(_var) { .iov_base = (char *) &(_var), .iov_len = sizeof(_var) }
-
 const char *__ubus_strerror[__UBUS_STATUS_LAST] = {
        [UBUS_STATUS_OK] = "Success",
        [UBUS_STATUS_INVALID_COMMAND] = "Invalid command",
@@ -36,17 +32,11 @@ const char *__ubus_strerror[__UBUS_STATUS_LAST] = {
        [UBUS_STATUS_PERMISSION_DENIED] = "Permission denied",
        [UBUS_STATUS_TIMEOUT] = "Request timed out",
        [UBUS_STATUS_NOT_SUPPORTED] = "Operation not supported",
+       [UBUS_STATUS_UNKNOWN_ERROR] = "Unknown error",
+       [UBUS_STATUS_CONNECTION_FAILED] = "Connection failed",
 };
 
-static struct blob_buf b;
-
-static const struct blob_attr_info ubus_policy[UBUS_ATTR_MAX] = {
-       [UBUS_ATTR_STATUS] = { .type = BLOB_ATTR_INT32 },
-       [UBUS_ATTR_OBJID] = { .type = BLOB_ATTR_INT32 },
-       [UBUS_ATTR_OBJPATH] = { .type = BLOB_ATTR_STRING },
-       [UBUS_ATTR_METHOD] = { .type = BLOB_ATTR_STRING },
-};
-static struct blob_attr *attrbuf[UBUS_ATTR_MAX];
+struct blob_buf b __hidden = {};
 
 struct ubus_pending_data {
        struct list_head list;
@@ -54,6 +44,13 @@ struct ubus_pending_data {
        struct blob_attr data[];
 };
 
+struct ubus_pending_invoke {
+       struct list_head list;
+       struct ubus_msghdr hdr;
+};
+
+static void ubus_process_pending_invoke(struct ubus_context *ctx);
+
 static int ubus_cmp_id(const void *k1, const void *k2, void *ptr)
 {
        const uint32_t *id1 = k1, *id2 = k2;
@@ -64,12 +61,6 @@ static int ubus_cmp_id(const void *k1, const void *k2, void *ptr)
                return *id1 > *id2;
 }
 
-static struct blob_attr **ubus_parse_msg(struct blob_attr *msg)
-{
-       blob_parse(msg, attrbuf, ubus_policy, UBUS_ATTR_MAX);
-       return attrbuf;
-}
-
 const char *ubus_strerror(int error)
 {
        static char err[32];
@@ -87,138 +78,9 @@ out:
        return err;
 }
 
-static int writev_retry(int fd, struct iovec *iov, int iov_len)
-{
-       int len = 0;
-
-       do {
-               int cur_len = writev(fd, iov, iov_len);
-               if (cur_len < 0) {
-                       switch(errno) {
-                       case EAGAIN:
-                               /* turn off non-blocking mode */
-                               fcntl(fd, F_SETFL, fcntl(fd, F_GETFL) &
-                                     ~O_NONBLOCK);
-                               break;
-                       case EINTR:
-                               break;
-                       default:
-                               return -1;
-                       }
-                       continue;
-               }
-               len += cur_len;
-               while (cur_len >= iov->iov_len) {
-                       cur_len -= iov->iov_len;
-                       iov_len--;
-                       iov++;
-                       if (!cur_len || !iov_len)
-                               return len;
-               }
-               iov->iov_len -= cur_len;
-       } while (1);
-}
-
-static int ubus_send_msg(struct ubus_context *ctx, uint32_t seq,
-                        struct blob_attr *msg, int cmd, uint32_t peer)
-{
-       struct ubus_msghdr hdr;
-       struct iovec iov[2] = {
-               STATIC_IOV(hdr)
-       };
-
-       hdr.version = 0;
-       hdr.type = cmd;
-       hdr.seq = seq;
-       hdr.peer = peer;
-
-       if (!msg) {
-               blob_buf_init(&b, 0);
-               msg = b.head;
-       }
-
-       iov[1].iov_base = (char *) msg;
-       iov[1].iov_len = blob_raw_len(msg);
-
-       return writev_retry(ctx->sock.fd, iov, ARRAY_SIZE(iov));
-}
-
-static int ubus_start_request(struct ubus_context *ctx, struct ubus_request *req,
-                             struct blob_attr *msg, int cmd, uint32_t peer)
-{
-       memset(req, 0, sizeof(*req));
-
-       if (msg && blob_pad_len(msg) > UBUS_MAX_MSGLEN)
-               return -1;
-
-       INIT_LIST_HEAD(&req->list);
-       INIT_LIST_HEAD(&req->pending);
-       req->ctx = ctx;
-       req->peer = peer;
-       req->seq = ++ctx->request_seq;
-       return ubus_send_msg(ctx, req->seq, msg, cmd, peer);
-}
-
-static bool recv_retry(int fd, struct iovec *iov, bool wait)
-{
-       int bytes;
-
-       while (iov->iov_len > 0) {
-               bytes = read(fd, iov->iov_base, iov->iov_len);
-               if (bytes < 0) {
-                       bytes = 0;
-                       if (uloop_cancelled)
-                               return false;
-                       if (errno == EINTR)
-                               continue;
-
-                       if (errno != EAGAIN)
-                               return false;
-               }
-               if (!wait && !bytes)
-                       return false;
-
-               wait = true;
-               iov->iov_len -= bytes;
-               iov->iov_base += bytes;
-       }
-
-       return true;
-}
-
-static bool ubus_validate_hdr(struct ubus_msghdr *hdr)
-{
-       if (hdr->version != 0)
-               return false;
-
-       if (blob_raw_len(hdr->data) < sizeof(*hdr->data))
-               return false;
-
-       if (blob_pad_len(hdr->data) > UBUS_MAX_MSGLEN)
-               return false;
-
-       return true;
-}
-
-static bool get_next_msg(struct ubus_context *ctx)
-{
-       struct iovec iov = STATIC_IOV(ctx->msgbuf.hdr);
-
-       /* receive header + start attribute */
-       iov.iov_len += sizeof(struct blob_attr);
-       if (!recv_retry(ctx->sock.fd, &iov, false))
-               return false;
-
-       iov.iov_len = blob_len(ctx->msgbuf.hdr.data);
-       if (iov.iov_len > 0 && !recv_retry(ctx->sock.fd, &iov, true))
-               return false;
-
-       return ubus_validate_hdr(&ctx->msgbuf.hdr);
-}
-
 static bool ubus_get_status(struct ubus_msghdr *hdr, int *ret)
 {
-       ubus_parse_msg(hdr->data);
+       struct blob_attr **attrbuf = ubus_parse_msg(hdr->data);
 
        if (!attrbuf[UBUS_ATTR_STATUS])
                return false;
@@ -271,7 +133,7 @@ static int ubus_process_req_status(struct ubus_request *req, struct ubus_msghdr
        int ret = UBUS_STATUS_INVALID_ARGUMENT;
 
        if (!list_empty(&req->list))
-               list_del(&req->list);
+               list_del_init(&req->list);
 
        ubus_get_status(hdr, &ret);
        req->peer = hdr->peer;
@@ -323,59 +185,17 @@ static struct ubus_request *ubus_find_request(struct ubus_context *ctx, uint32_t
        return NULL;
 }
 
-static void ubus_process_invoke(struct ubus_context *ctx, struct ubus_msghdr *hdr)
+void ubus_complete_deferred_request(struct ubus_context *ctx, struct ubus_request_data *req, int ret)
 {
-       struct ubus_request_data req;
-       struct ubus_object *obj;
-       uint32_t objid = 0;
-       int method;
-       int ret = 0;
-
-       ubus_parse_msg(hdr->data);
-
-       if (!attrbuf[UBUS_ATTR_OBJID])
-               return;
-
-       objid = blob_get_u32(attrbuf[UBUS_ATTR_OBJID]);
-
-       if (!attrbuf[UBUS_ATTR_METHOD]) {
-               ret = UBUS_STATUS_INVALID_ARGUMENT;
-               goto send;
-       }
-
-       obj = avl_find_element(&ctx->objects, &objid, obj, avl);
-       if (!obj) {
-               ret = UBUS_STATUS_NOT_FOUND;
-               goto send;
-       }
-
-       for (method = 0; method < obj->n_methods; method++)
-               if (!obj->methods[method].name ||
-                   !strcmp(obj->methods[method].name,
-                           blob_data(attrbuf[UBUS_ATTR_METHOD])))
-                       goto found;
-
-       /* not found */
-       ret = UBUS_STATUS_METHOD_NOT_FOUND;
-       goto send;
-
-found:
-       req.object = objid;
-       req.peer = hdr->peer;
-       req.seq = hdr->seq;
-       ret = obj->methods[method].handler(ctx, obj, &req,
-                                          blob_data(attrbuf[UBUS_ATTR_METHOD]),
-                                          attrbuf[UBUS_ATTR_DATA]);
-
-send:
        blob_buf_init(&b, 0);
        blob_put_int32(&b, UBUS_ATTR_STATUS, ret);
-       blob_put_int32(&b, UBUS_ATTR_OBJID, objid);
-       ubus_send_msg(ctx, hdr->seq, b.head, UBUS_MSG_STATUS, hdr->peer);
+       blob_put_int32(&b, UBUS_ATTR_OBJID, req->object);
+       ubus_send_msg(ctx, req->seq, b.head, UBUS_MSG_STATUS, req->peer);
 }
 
-static void ubus_process_msg(struct ubus_context *ctx, struct ubus_msghdr *hdr)
+void __hidden ubus_process_msg(struct ubus_context *ctx, struct ubus_msghdr *hdr)
 {
+       struct ubus_pending_invoke *pending;
        struct ubus_request *req;
 
        switch(hdr->type) {
@@ -394,8 +214,37 @@ static void ubus_process_msg(struct ubus_context *ctx, struct ubus_msghdr *hdr)
                break;
 
        case UBUS_MSG_INVOKE:
-               ubus_process_invoke(ctx, hdr);
+               if (ctx->stack_depth > 2) {
+                       pending = calloc(1, sizeof(*pending) +
+                               blob_raw_len(hdr->data));
+
+                       if (!pending)
+                               return;
+
+                       memcpy(&pending->hdr, hdr, sizeof(*hdr) +
+                               blob_raw_len(hdr->data));
+                       list_add(&pending->list, &ctx->pending);
+               } else {
+                       ubus_process_invoke(ctx, hdr);
+               }
                break;
+
+       case UBUS_MSG_UNSUBSCRIBE:
+               ubus_process_unsubscribe(ctx, hdr);
+               break;
+       }
+}
+
+static void ubus_process_pending_invoke(struct ubus_context *ctx)
+{
+       struct ubus_pending_invoke *pending, *tmp;
+
+       list_for_each_entry_safe(pending, tmp, &ctx->pending, list) {
+               list_del(&pending->list);
+               ubus_process_msg(ctx, &pending->hdr);
+               free(pending);
+               if (ctx->stack_depth > 2)
+                       break;
        }
 }
 
@@ -406,7 +255,7 @@ void ubus_abort_request(struct ubus_context *ctx, struct ubus_request *req)
 
        req->cancelled = true;
        ubus_process_req_data(req);
-       list_del(&req->list);
+       list_del_init(&req->list);
 }
 
 void ubus_complete_request_async(struct ubus_context *ctx, struct ubus_request *req)
@@ -417,21 +266,6 @@ void ubus_complete_request_async(struct ubus_context *ctx, struct ubus_request *
        list_add(&req->list, &ctx->requests);
 }
 
-static void ubus_handle_data(struct uloop_fd *u, unsigned int events)
-{
-       struct ubus_context *ctx = container_of(u, struct ubus_context, sock);
-       struct ubus_msghdr *hdr = &ctx->msgbuf.hdr;
-
-       while (get_next_msg(ctx)) {
-               ubus_process_msg(ctx, hdr);
-               if (uloop_cancelled)
-                       break;
-       }
-
-       if (u->eof)
-               ctx->connection_lost(ctx);
-}
-
 static void ubus_sync_req_cb(struct ubus_request *req, int ret)
 {
        req->status_msg = true;
@@ -458,7 +292,6 @@ int ubus_complete_request(struct ubus_context *ctx, struct ubus_request *req,
        struct ubus_sync_req_cb cb;
        ubus_complete_handler_t complete_cb = req->complete_cb;
        bool registered = ctx->sock.registered;
-       bool cancelled = uloop_cancelled;
        int status = UBUS_STATUS_NO_DATA;
 
        if (!registered) {
@@ -476,7 +309,14 @@ int ubus_complete_request(struct ubus_context *ctx, struct ubus_request *req,
        ubus_complete_request_async(ctx, req);
        req->complete_cb = ubus_sync_req_cb;
 
-       uloop_run();
+       ctx->stack_depth++;
+       while (!req->status_msg) {
+               bool cancelled = uloop_cancelled;
+               uloop_cancelled = false;
+               uloop_run();
+               uloop_cancelled = cancelled;
+       }
+       ctx->stack_depth--;
 
        if (timeout)
                uloop_timeout_cancel(&cb.timeout);
@@ -488,10 +328,12 @@ int ubus_complete_request(struct ubus_context *ctx, struct ubus_request *req,
        if (req->complete_cb)
                req->complete_cb(req, status);
 
-       uloop_cancelled = cancelled;
        if (!registered)
                uloop_fd_delete(&ctx->sock);
 
+       if (!ctx->stack_depth)
+               ubus_process_pending_invoke(ctx);
+
        return status;
 }
 
@@ -521,6 +363,22 @@ static void ubus_lookup_cb(struct ubus_request *ureq, int type, struct blob_attr
        req->cb(ureq->ctx, &obj, ureq->priv);
 }
 
+int __hidden ubus_start_request(struct ubus_context *ctx, struct ubus_request *req,
+                               struct blob_attr *msg, int cmd, uint32_t peer)
+{
+       memset(req, 0, sizeof(*req));
+
+       if (msg && blob_pad_len(msg) > UBUS_MAX_MSGLEN)
+               return -1;
+
+       INIT_LIST_HEAD(&req->list);
+       INIT_LIST_HEAD(&req->pending);
+       req->ctx = ctx;
+       req->peer = peer;
+       req->seq = ++ctx->request_seq;
+       return ubus_send_msg(ctx, req->seq, msg, cmd, peer);
+}
+
 int ubus_lookup(struct ubus_context *ctx, const char *path,
                ubus_lookup_handler_t cb, void *priv)
 {
@@ -611,130 +469,7 @@ int ubus_invoke(struct ubus_context *ctx, uint32_t obj, const char *method,
        return ubus_complete_request(ctx, &req, timeout);
 }
 
-static void ubus_add_object_cb(struct ubus_request *req, int type, struct blob_attr *msg)
-{
-       struct ubus_object *obj = req->priv;
-
-       ubus_parse_msg(msg);
-
-       if (!attrbuf[UBUS_ATTR_OBJID])
-               return;
-
-       obj->id = blob_get_u32(attrbuf[UBUS_ATTR_OBJID]);
-
-       if (attrbuf[UBUS_ATTR_OBJTYPE])
-               obj->type->id = blob_get_u32(attrbuf[UBUS_ATTR_OBJTYPE]);
-
-       obj->avl.key = &obj->id;
-       avl_insert(&req->ctx->objects, &obj->avl);
-}
-
-static void ubus_push_method_data(const struct ubus_method *m)
-{
-       void *mtbl;
-       int i;
-
-       mtbl = blobmsg_open_table(&b, m->name);
-
-       for (i = 0; i < m->n_policy; i++)
-               blobmsg_add_u32(&b, m->policy[i].name, m->policy[i].type);
-
-       blobmsg_close_table(&b, mtbl);
-}
-
-static bool ubus_push_object_type(const struct ubus_object_type *type)
-{
-       void *s;
-       int i;
-
-       s = blob_nest_start(&b, UBUS_ATTR_SIGNATURE);
-
-       for (i = 0; i < type->n_methods; i++)
-               ubus_push_method_data(&type->methods[i]);
-
-       blob_nest_end(&b, s);
-
-       return true;
-}
-
-static int __ubus_add_object(struct ubus_context *ctx, struct ubus_object *obj)
-{
-       struct ubus_request req;
-       int ret;
-
-       blob_buf_init(&b, 0);
-
-       if (obj->name && obj->type) {
-               blob_put_string(&b, UBUS_ATTR_OBJPATH, obj->name);
 
-               if (obj->type->id)
-                       blob_put_int32(&b, UBUS_ATTR_OBJTYPE, obj->type->id);
-               else if (!ubus_push_object_type(obj->type))
-                       return UBUS_STATUS_INVALID_ARGUMENT;
-       }
-
-       if (ubus_start_request(ctx, &req, b.head, UBUS_MSG_ADD_OBJECT, 0) < 0)
-               return UBUS_STATUS_INVALID_ARGUMENT;
-
-       req.raw_data_cb = ubus_add_object_cb;
-       req.priv = obj;
-       ret = ubus_complete_request(ctx, &req, 0);
-       if (ret)
-               return ret;
-
-       if (!obj->id)
-               return UBUS_STATUS_NO_DATA;
-
-       return 0;
-}
-
-int ubus_add_object(struct ubus_context *ctx, struct ubus_object *obj)
-{
-       if (!obj->name || !obj->type)
-               return UBUS_STATUS_INVALID_ARGUMENT;
-
-       return __ubus_add_object(ctx, obj);
-}
-
-static void ubus_remove_object_cb(struct ubus_request *req, int type, struct blob_attr *msg)
-{
-       struct ubus_object *obj = req->priv;
-
-       ubus_parse_msg(msg);
-
-       if (!attrbuf[UBUS_ATTR_OBJID])
-               return;
-
-       obj->id = 0;
-
-       if (attrbuf[UBUS_ATTR_OBJTYPE] && obj->type)
-               obj->type->id = 0;
-
-       avl_delete(&req->ctx->objects, &obj->avl);
-}
-
-int ubus_remove_object(struct ubus_context *ctx, struct ubus_object *obj)
-{
-       struct ubus_request req;
-       int ret;
-
-       blob_buf_init(&b, 0);
-       blob_put_int32(&b, UBUS_ATTR_OBJID, obj->id);
-
-       if (ubus_start_request(ctx, &req, b.head, UBUS_MSG_REMOVE_OBJECT, 0) < 0)
-               return UBUS_STATUS_INVALID_ARGUMENT;
-
-       req.raw_data_cb = ubus_remove_object_cb;
-       req.priv = obj;
-       ret = ubus_complete_request(ctx, &req, 0);
-       if (ret)
-               return ret;
-
-       if (obj->id)
-               return UBUS_STATUS_NO_DATA;
-
-       return 0;
-}
 
 static int ubus_event_cb(struct ubus_context *ctx, struct ubus_object *obj,
                         struct ubus_request_data *req,
@@ -767,7 +502,7 @@ int ubus_register_event_handler(struct ubus_context *ctx,
                if (!!obj->name ^ !!obj->type)
                        return UBUS_STATUS_INVALID_ARGUMENT;
 
-               ret = __ubus_add_object(ctx, obj);
+               ret = ubus_add_object(ctx, obj);
                if (ret)
                        return ret;
        }
@@ -812,63 +547,24 @@ static void ubus_default_connection_lost(struct ubus_context *ctx)
 struct ubus_context *ubus_connect(const char *path)
 {
        struct ubus_context *ctx;
-       struct {
-               struct ubus_msghdr hdr;
-               struct blob_attr data;
-       } hdr;
-       struct blob_attr *buf;
-
-       if (!path)
-               path = UBUS_UNIX_SOCKET;
 
        ctx = calloc(1, sizeof(*ctx));
        if (!ctx)
-               goto error;
-
-       ctx->sock.fd = usock(USOCK_UNIX, path, NULL);
-       if (ctx->sock.fd < 0)
-               goto error_free;
+               return NULL;
 
+       ctx->sock.fd = -1;
        ctx->sock.cb = ubus_handle_data;
-
-       if (read(ctx->sock.fd, &hdr, sizeof(hdr)) != sizeof(hdr))
-               goto error_close;
-
-       if (!ubus_validate_hdr(&hdr.hdr))
-               goto error_close;
-
-       if (hdr.hdr.type != UBUS_MSG_HELLO)
-               goto error_close;
-
-       buf = calloc(1, blob_raw_len(&hdr.data));
-       if (!buf)
-               goto error_close;
-
-       memcpy(buf, &hdr.data, sizeof(hdr.data));
-       if (read(ctx->sock.fd, blob_data(buf), blob_len(buf)) != blob_len(buf))
-               goto error_free_buf;
-
-       ctx->local_id = hdr.hdr.peer;
-       free(buf);
-
        ctx->connection_lost = ubus_default_connection_lost;
 
        INIT_LIST_HEAD(&ctx->requests);
+       INIT_LIST_HEAD(&ctx->pending);
        avl_init(&ctx->objects, ubus_cmp_id, false, NULL);
-
-       if (!ctx->local_id)
-               goto error_close;
+       if (ubus_reconnect(ctx, path)) {
+               free(ctx);
+               ctx = NULL;
+       }
 
        return ctx;
-
-error_free_buf:
-       free(buf);
-error_close:
-       close(ctx->sock.fd);
-error_free:
-       free(ctx);
-error:
-       return NULL;
 }
 
 void ubus_free(struct ubus_context *ctx)