X-Git-Url: http://git.archive.openwrt.org/?a=blobdiff_plain;ds=sidebyside;f=libubus-io.c;h=9a6c7cd77ec168be2b6779fc9fe05aea751c0fa2;hb=1d5ac421a5b3dca60562e876ba70d0c2fe46b3d2;hp=78943bc83ac1535b28e291d34a38c9665414f330;hpb=b20a8a01c7faea5bcc9d34d10dcf7736589021b8;p=project%2Fubus.git diff --git a/libubus-io.c b/libubus-io.c index 78943bc..9a6c7cd 100644 --- a/libubus-io.c +++ b/libubus-io.c @@ -1,5 +1,5 @@ /* - * Copyright (C) 2011-2012 Felix Fietkau + * Copyright (C) 2011-2014 Felix Fietkau * * 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 @@ -54,12 +54,37 @@ static void wait_data(int fd, bool write) poll(&pfd, 1, 0); } -static int writev_retry(int fd, struct iovec *iov, int iov_len) +static int writev_retry(int fd, struct iovec *iov, int iov_len, int sock_fd) { + static struct { + struct cmsghdr h; + int fd; + } fd_buf = { + .h = { + .cmsg_len = sizeof(fd_buf), + .cmsg_level = SOL_SOCKET, + .cmsg_type = SCM_RIGHTS, + } + }; + struct msghdr msghdr = { + .msg_iov = iov, + .msg_iovlen = iov_len, + .msg_control = &fd_buf, + .msg_controllen = sizeof(fd_buf), + }; int len = 0; do { - int cur_len = writev(fd, iov, iov_len); + int cur_len; + + if (sock_fd < 0) { + msghdr.msg_control = NULL; + msghdr.msg_controllen = 0; + } else { + fd_buf.fd = sock_fd; + } + + cur_len = sendmsg(fd, &msghdr, 0); if (cur_len < 0) { switch(errno) { case EAGAIN: @@ -72,6 +97,10 @@ static int writev_retry(int fd, struct iovec *iov, int iov_len) } continue; } + + if (len > 0) + sock_fd = -1; + len += cur_len; while (cur_len >= iov->iov_len) { cur_len -= iov->iov_len; @@ -88,7 +117,7 @@ static int writev_retry(int fd, struct iovec *iov, int iov_len) } int __hidden ubus_send_msg(struct ubus_context *ctx, uint32_t seq, - struct blob_attr *msg, int cmd, uint32_t peer) + struct blob_attr *msg, int cmd, uint32_t peer, int fd) { struct ubus_msghdr hdr; struct iovec iov[2] = { @@ -109,22 +138,48 @@ int __hidden ubus_send_msg(struct ubus_context *ctx, uint32_t seq, iov[1].iov_base = (char *) msg; iov[1].iov_len = blob_raw_len(msg); - ret = writev_retry(ctx->sock.fd, iov, ARRAY_SIZE(iov)); + ret = writev_retry(ctx->sock.fd, iov, ARRAY_SIZE(iov), fd); if (ret < 0) ctx->sock.eof = true; + if (fd >= 0) + close(fd); + return ret; } -static int recv_retry(int fd, struct iovec *iov, bool wait) +static int recv_retry(int fd, struct iovec *iov, bool wait, int *recv_fd) { int bytes, total = 0; + static struct { + struct cmsghdr h; + int fd; + } fd_buf = { + .h = { + .cmsg_type = SCM_RIGHTS, + .cmsg_level = SOL_SOCKET, + .cmsg_len = sizeof(fd_buf), + }, + }; + struct msghdr msghdr = { + .msg_iov = iov, + .msg_iovlen = 1, + }; while (iov->iov_len > 0) { if (wait) wait_data(fd, false); - bytes = read(fd, iov->iov_base, iov->iov_len); + if (recv_fd) { + msghdr.msg_control = &fd_buf; + msghdr.msg_controllen = sizeof(fd_buf); + } else { + msghdr.msg_control = NULL; + msghdr.msg_controllen = 0; + } + + fd_buf.fd = -1; + bytes = recvmsg(fd, &msghdr, 0); if (!bytes) return -1; @@ -141,6 +196,11 @@ static int recv_retry(int fd, struct iovec *iov, bool wait) if (!wait && !bytes) return 0; + if (recv_fd) + *recv_fd = fd_buf.fd; + + recv_fd = NULL; + wait = true; iov->iov_len -= bytes; iov->iov_base += bytes; @@ -152,26 +212,28 @@ static int recv_retry(int fd, struct iovec *iov, bool wait) static bool ubus_validate_hdr(struct ubus_msghdr *hdr) { + struct blob_attr *data = ubus_msghdr_data(hdr); + if (hdr->version != 0) return false; - if (blob_raw_len(hdr->data) < sizeof(*hdr->data)) + if (blob_raw_len(data) < sizeof(*data)) return false; - if (blob_pad_len(hdr->data) > UBUS_MAX_MSGLEN) + if (blob_pad_len(data) > UBUS_MAX_MSGLEN) return false; return true; } -static bool get_next_msg(struct ubus_context *ctx) +static bool get_next_msg(struct ubus_context *ctx, int *recv_fd) { struct iovec iov = STATIC_IOV(ctx->msgbuf.hdr); int r; /* receive header + start attribute */ iov.iov_len += sizeof(struct blob_attr); - r = recv_retry(ctx->sock.fd, &iov, false); + r = recv_retry(ctx->sock.fd, &iov, false, recv_fd); if (r <= 0) { if (r < 0) ctx->sock.eof = true; @@ -179,8 +241,8 @@ static bool get_next_msg(struct ubus_context *ctx) return false; } - iov.iov_len = blob_len(ctx->msgbuf.hdr.data); - if (iov.iov_len > 0 && !recv_retry(ctx->sock.fd, &iov, true)) + iov.iov_len = blob_len(ubus_msghdr_data(&ctx->msgbuf.hdr)); + if (iov.iov_len > 0 && !recv_retry(ctx->sock.fd, &iov, true, NULL)) return false; return ubus_validate_hdr(&ctx->msgbuf.hdr); @@ -190,9 +252,10 @@ void __hidden 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; + int recv_fd = -1; - while (get_next_msg(ctx)) { - ubus_process_msg(ctx, hdr); + while (get_next_msg(ctx, &recv_fd)) { + ubus_process_msg(ctx, hdr, recv_fd); if (uloop_cancelled) break; } @@ -201,6 +264,17 @@ void __hidden ubus_handle_data(struct uloop_fd *u, unsigned int events) ctx->connection_lost(ctx); } +void __hidden ubus_poll_data(struct ubus_context *ctx, int timeout) +{ + struct pollfd pfd = { + .fd = ctx->sock.fd, + .events = POLLIN | POLLERR, + }; + + poll(&pfd, 1, timeout); + ubus_handle_data(&ctx->sock, ULOOP_READ); +} + static void ubus_refresh_state(struct ubus_context *ctx) {