#include <stdlib.h>
#include <assert.h>
#include <poll.h>
+#include <unistd.h>
+#include <fcntl.h>
void *io_loop_return;
struct io_plan io_debug(struct io_plan plan)
{
+ struct io_conn *ready = NULL;
+
if (io_plan_nodebug) {
io_plan_nodebug = false;
return plan;
}
- if (!io_debug_conn || !current)
- return plan;
-
- if (!io_debug_conn(current) && !io_debug_wakeup)
- return plan;
+ if (!current || !doing_debug_on(current)) {
+ if (!io_debug_wakeup)
+ return plan;
+ }
io_debug_wakeup = false;
current->plan = plan;
backend_plan_changed(current);
/* Call back into the loop immediately. */
- io_loop_return = io_loop();
- return plan;
+ io_loop_return = do_io_loop(&ready);
+
+ if (ready) {
+ set_current(ready);
+ if (!ready->plan.next) {
+ /* Call finish function immediately. */
+ if (ready->finish) {
+ errno = ready->plan.u.close.saved_errno;
+ ready->finish(ready, ready->finish_arg);
+ ready->finish = NULL;
+ }
+ backend_del_conn(ready);
+ } else {
+ /* Calls back in itself, via io_debug_io(). */
+ if (ready->plan.io(ready->fd.fd, &ready->plan) != 2)
+ abort();
+ }
+ set_current(NULL);
+ }
+
+ /* Return a do-nothing plan, so backend_plan_changed in
+ * io_ready doesn't do anything (it's already been called). */
+ return io_idle_();
+}
+
+int io_debug_io(int ret)
+{
+ /* Cache it for debugging; current changes. */
+ struct io_conn *conn = current;
+ int saved_errno = errno;
+
+ if (!doing_debug_on(conn))
+ return ret;
+
+ /* These will all go linearly through the io_debug() path above. */
+ switch (ret) {
+ case -1:
+ /* This will call io_debug above. */
+ errno = saved_errno;
+ io_close();
+ break;
+ case 0: /* Keep going with plan. */
+ io_debug(conn->plan);
+ break;
+ case 1: /* Done: get next plan. */
+ if (timeout_active(conn))
+ backend_del_timeout(conn);
+ conn->plan.next(conn, conn->plan.next_arg);
+ break;
+ default:
+ abort();
+ }
+
+ /* Normally-invalid value, used for sanity check. */
+ return 2;
}
static void debug_io_wake(struct io_conn *conn)
{
ssize_t ret = write(fd, plan->u.write.buf, plan->u.write.len);
if (ret < 0)
- return -1;
+ return io_debug_io(-1);
plan->u.write.buf += ret;
plan->u.write.len -= ret;
- return (plan->u.write.len == 0);
+ return io_debug_io(plan->u.write.len == 0);
}
/* Queue some data to be written. */
{
ssize_t ret = read(fd, plan->u.read.buf, plan->u.read.len);
if (ret <= 0)
- return -1;
+ return io_debug_io(-1);
plan->u.read.buf += ret;
plan->u.read.len -= ret;
- return (plan->u.read.len == 0);
+ return io_debug_io(plan->u.read.len == 0);
}
/* Queue a request to read into a buffer. */
{
ssize_t ret = read(fd, plan->u.readpart.buf, *plan->u.readpart.lenp);
if (ret <= 0)
- return -1;
+ return io_debug_io(-1);
*plan->u.readpart.lenp = ret;
- return 1;
+ return io_debug_io(1);
}
/* Queue a partial request to read into a buffer. */
{
ssize_t ret = write(fd, plan->u.writepart.buf, *plan->u.writepart.lenp);
if (ret < 0)
- return -1;
+ return io_debug_io(-1);
*plan->u.writepart.lenp = ret;
- return 1;
+ return io_debug_io(1);
}
/* Queue a partial write request. */
return plan;
}
+static int already_connected(int fd, struct io_plan *plan)
+{
+ return io_debug_io(1);
+}
+
+static int do_connect(int fd, struct io_plan *plan)
+{
+ int err, ret;
+ socklen_t len = sizeof(err);
+
+ /* Has async connect finished? */
+ ret = getsockopt(fd, SOL_SOCKET, SO_ERROR, &err, &len);
+ if (ret < 0)
+ return -1;
+
+ if (err == 0) {
+ /* Restore blocking if it was initially. */
+ fcntl(fd, F_SETFD, plan->u.len_len.len1);
+ return 1;
+ }
+ return 0;
+}
+
+struct io_plan io_connect_(int fd, const struct addrinfo *addr,
+ struct io_plan (*cb)(struct io_conn*, void *),
+ void *arg)
+{
+ struct io_plan plan;
+
+ assert(cb);
+
+ plan.next = cb;
+ plan.next_arg = arg;
+
+ /* Save old flags, set nonblock if not already. */
+ plan.u.len_len.len1 = fcntl(fd, F_GETFD);
+ fcntl(fd, F_SETFD, plan.u.len_len.len1 | O_NONBLOCK);
+
+ /* Immediate connect can happen. */
+ if (connect(fd, addr->ai_addr, addr->ai_addrlen) == 0) {
+ /* Dummy will be called immediately. */
+ plan.pollflag = POLLOUT;
+ plan.io = already_connected;
+ } else {
+ if (errno != EINPROGRESS)
+ return io_close_();
+
+ plan.pollflag = POLLIN;
+ plan.io = do_connect;
+ }
+ return plan;
+}
+
struct io_plan io_idle_(void)
{
struct io_plan plan;
void io_ready(struct io_conn *conn)
{
+ set_current(conn);
switch (conn->plan.io(conn->fd.fd, &conn->plan)) {
case -1: /* Failure means a new plan: close up. */
- set_current(conn);
conn->plan = io_close();
backend_plan_changed(conn);
- set_current(NULL);
break;
case 0: /* Keep going with plan. */
break;
case 1: /* Done: get next plan. */
- set_current(conn);
if (timeout_active(conn))
backend_del_timeout(conn);
conn->plan = conn->plan.next(conn, conn->plan.next_arg);
backend_plan_changed(conn);
- set_current(NULL);
}
+ set_current(NULL);
}
/* Close the connection, we're done. */