riscv: Kconfig: Add select ARM_AMBA to SOC_STARFIVE
[platform/kernel/linux-starfive.git] / io_uring / msg_ring.c
index 90d2fc6..cd922d2 100644 (file)
@@ -15,6 +15,7 @@
 
 struct io_msg {
        struct file                     *file;
+       struct file                     *src_file;
        u64 user_data;
        u32 len;
        u32 cmd;
@@ -23,31 +24,12 @@ struct io_msg {
        u32 flags;
 };
 
-static int io_msg_ring_data(struct io_kiocb *req)
+static void io_double_unlock_ctx(struct io_ring_ctx *octx)
 {
-       struct io_ring_ctx *target_ctx = req->file->private_data;
-       struct io_msg *msg = io_kiocb_to_cmd(req, struct io_msg);
-
-       if (msg->src_fd || msg->dst_fd || msg->flags)
-               return -EINVAL;
-
-       if (io_post_aux_cqe(target_ctx, msg->user_data, msg->len, 0, true))
-               return 0;
-
-       return -EOVERFLOW;
-}
-
-static void io_double_unlock_ctx(struct io_ring_ctx *ctx,
-                                struct io_ring_ctx *octx,
-                                unsigned int issue_flags)
-{
-       if (issue_flags & IO_URING_F_UNLOCKED)
-               mutex_unlock(&ctx->uring_lock);
        mutex_unlock(&octx->uring_lock);
 }
 
-static int io_double_lock_ctx(struct io_ring_ctx *ctx,
-                             struct io_ring_ctx *octx,
+static int io_double_lock_ctx(struct io_ring_ctx *octx,
                              unsigned int issue_flags)
 {
        /*
@@ -60,69 +42,118 @@ static int io_double_lock_ctx(struct io_ring_ctx *ctx,
                        return -EAGAIN;
                return 0;
        }
+       mutex_lock(&octx->uring_lock);
+       return 0;
+}
 
-       /* Always grab smallest value ctx first. We know ctx != octx. */
-       if (ctx < octx) {
-               mutex_lock(&ctx->uring_lock);
-               mutex_lock(&octx->uring_lock);
-       } else {
-               mutex_lock(&octx->uring_lock);
-               mutex_lock(&ctx->uring_lock);
-       }
+void io_msg_ring_cleanup(struct io_kiocb *req)
+{
+       struct io_msg *msg = io_kiocb_to_cmd(req, struct io_msg);
 
-       return 0;
+       if (WARN_ON_ONCE(!msg->src_file))
+               return;
+
+       fput(msg->src_file);
+       msg->src_file = NULL;
 }
 
-static int io_msg_send_fd(struct io_kiocb *req, unsigned int issue_flags)
+static int io_msg_ring_data(struct io_kiocb *req, unsigned int issue_flags)
 {
        struct io_ring_ctx *target_ctx = req->file->private_data;
        struct io_msg *msg = io_kiocb_to_cmd(req, struct io_msg);
-       struct io_ring_ctx *ctx = req->ctx;
-       unsigned long file_ptr;
-       struct file *src_file;
        int ret;
 
-       if (target_ctx == ctx)
+       if (msg->src_fd || msg->dst_fd || msg->flags)
                return -EINVAL;
+       if (target_ctx->flags & IORING_SETUP_R_DISABLED)
+               return -EBADFD;
 
-       ret = io_double_lock_ctx(ctx, target_ctx, issue_flags);
-       if (unlikely(ret))
-               return ret;
+       ret = -EOVERFLOW;
+       if (target_ctx->flags & IORING_SETUP_IOPOLL) {
+               if (unlikely(io_double_lock_ctx(target_ctx, issue_flags)))
+                       return -EAGAIN;
+               if (io_post_aux_cqe(target_ctx, msg->user_data, msg->len, 0, true))
+                       ret = 0;
+               io_double_unlock_ctx(target_ctx);
+       } else {
+               if (io_post_aux_cqe(target_ctx, msg->user_data, msg->len, 0, true))
+                       ret = 0;
+       }
 
-       ret = -EBADF;
-       if (unlikely(msg->src_fd >= ctx->nr_user_files))
-               goto out_unlock;
+       return ret;
+}
 
-       msg->src_fd = array_index_nospec(msg->src_fd, ctx->nr_user_files);
-       file_ptr = io_fixed_file_slot(&ctx->file_table, msg->src_fd)->file_ptr;
-       if (!file_ptr)
-               goto out_unlock;
+static struct file *io_msg_grab_file(struct io_kiocb *req, unsigned int issue_flags)
+{
+       struct io_msg *msg = io_kiocb_to_cmd(req, struct io_msg);
+       struct io_ring_ctx *ctx = req->ctx;
+       struct file *file = NULL;
+       unsigned long file_ptr;
+       int idx = msg->src_fd;
+
+       io_ring_submit_lock(ctx, issue_flags);
+       if (likely(idx < ctx->nr_user_files)) {
+               idx = array_index_nospec(idx, ctx->nr_user_files);
+               file_ptr = io_fixed_file_slot(&ctx->file_table, idx)->file_ptr;
+               file = (struct file *) (file_ptr & FFS_MASK);
+               if (file)
+                       get_file(file);
+       }
+       io_ring_submit_unlock(ctx, issue_flags);
+       return file;
+}
 
-       src_file = (struct file *) (file_ptr & FFS_MASK);
-       get_file(src_file);
+static int io_msg_install_complete(struct io_kiocb *req, unsigned int issue_flags)
+{
+       struct io_ring_ctx *target_ctx = req->file->private_data;
+       struct io_msg *msg = io_kiocb_to_cmd(req, struct io_msg);
+       struct file *src_file = msg->src_file;
+       int ret;
+
+       if (unlikely(io_double_lock_ctx(target_ctx, issue_flags)))
+               return -EAGAIN;
 
        ret = __io_fixed_fd_install(target_ctx, src_file, msg->dst_fd);
-       if (ret < 0) {
-               fput(src_file);
+       if (ret < 0)
                goto out_unlock;
-       }
+
+       msg->src_file = NULL;
+       req->flags &= ~REQ_F_NEED_CLEANUP;
 
        if (msg->flags & IORING_MSG_RING_CQE_SKIP)
                goto out_unlock;
-
        /*
         * If this fails, the target still received the file descriptor but
         * wasn't notified of the fact. This means that if this request
         * completes with -EOVERFLOW, then the sender must ensure that a
         * later IORING_OP_MSG_RING delivers the message.
         */
-       if (!io_post_aux_cqe(target_ctx, msg->user_data, msg->len, 0, true))
+       if (!io_post_aux_cqe(target_ctx, msg->user_data, ret, 0, true))
                ret = -EOVERFLOW;
 out_unlock:
-       io_double_unlock_ctx(ctx, target_ctx, issue_flags);
+       io_double_unlock_ctx(target_ctx);
        return ret;
 }
 
+static int io_msg_send_fd(struct io_kiocb *req, unsigned int issue_flags)
+{
+       struct io_ring_ctx *target_ctx = req->file->private_data;
+       struct io_msg *msg = io_kiocb_to_cmd(req, struct io_msg);
+       struct io_ring_ctx *ctx = req->ctx;
+       struct file *src_file = msg->src_file;
+
+       if (target_ctx == ctx)
+               return -EINVAL;
+       if (!src_file) {
+               src_file = io_msg_grab_file(req, issue_flags);
+               if (!src_file)
+                       return -EBADF;
+               msg->src_file = src_file;
+               req->flags |= REQ_F_NEED_CLEANUP;
+       }
+       return io_msg_install_complete(req, issue_flags);
+}
+
 int io_msg_ring_prep(struct io_kiocb *req, const struct io_uring_sqe *sqe)
 {
        struct io_msg *msg = io_kiocb_to_cmd(req, struct io_msg);
@@ -130,6 +161,7 @@ int io_msg_ring_prep(struct io_kiocb *req, const struct io_uring_sqe *sqe)
        if (unlikely(sqe->buf_index || sqe->personality))
                return -EINVAL;
 
+       msg->src_file = NULL;
        msg->user_data = READ_ONCE(sqe->off);
        msg->len = READ_ONCE(sqe->len);
        msg->cmd = READ_ONCE(sqe->addr);
@@ -153,7 +185,7 @@ int io_msg_ring(struct io_kiocb *req, unsigned int issue_flags)
 
        switch (msg->cmd) {
        case IORING_MSG_DATA:
-               ret = io_msg_ring_data(req);
+               ret = io_msg_ring_data(req, issue_flags);
                break;
        case IORING_MSG_SEND_FD:
                ret = io_msg_send_fd(req, issue_flags);
@@ -164,12 +196,10 @@ int io_msg_ring(struct io_kiocb *req, unsigned int issue_flags)
        }
 
 done:
+       if (ret == -EAGAIN)
+               return -EAGAIN;
        if (ret < 0)
                req_set_fail(req);
        io_req_set_res(req, ret, 0);
-       /* put file to avoid an attempt to IOPOLL the req */
-       if (!(req->flags & REQ_F_FIXED_FILE))
-               io_put_file(req->file);
-       req->file = NULL;
        return IOU_OK;
 }