drm/edid/firmware: Add built-in edid/1280x720.bin firmware
[platform/kernel/linux-starfive.git] / io_uring / kbuf.c
1 // SPDX-License-Identifier: GPL-2.0
2 #include <linux/kernel.h>
3 #include <linux/errno.h>
4 #include <linux/fs.h>
5 #include <linux/file.h>
6 #include <linux/mm.h>
7 #include <linux/slab.h>
8 #include <linux/namei.h>
9 #include <linux/poll.h>
10 #include <linux/io_uring.h>
11
12 #include <uapi/linux/io_uring.h>
13
14 #include "io_uring.h"
15 #include "opdef.h"
16 #include "kbuf.h"
17
18 #define IO_BUFFER_LIST_BUF_PER_PAGE (PAGE_SIZE / sizeof(struct io_uring_buf))
19
20 #define BGID_ARRAY      64
21
22 struct io_provide_buf {
23         struct file                     *file;
24         __u64                           addr;
25         __u32                           len;
26         __u32                           bgid;
27         __u16                           nbufs;
28         __u16                           bid;
29 };
30
31 static inline struct io_buffer_list *io_buffer_get_list(struct io_ring_ctx *ctx,
32                                                         unsigned int bgid)
33 {
34         if (ctx->io_bl && bgid < BGID_ARRAY)
35                 return &ctx->io_bl[bgid];
36
37         return xa_load(&ctx->io_bl_xa, bgid);
38 }
39
40 static int io_buffer_add_list(struct io_ring_ctx *ctx,
41                               struct io_buffer_list *bl, unsigned int bgid)
42 {
43         bl->bgid = bgid;
44         if (bgid < BGID_ARRAY)
45                 return 0;
46
47         return xa_err(xa_store(&ctx->io_bl_xa, bgid, bl, GFP_KERNEL));
48 }
49
50 void io_kbuf_recycle_legacy(struct io_kiocb *req, unsigned issue_flags)
51 {
52         struct io_ring_ctx *ctx = req->ctx;
53         struct io_buffer_list *bl;
54         struct io_buffer *buf;
55
56         /*
57          * For legacy provided buffer mode, don't recycle if we already did
58          * IO to this buffer. For ring-mapped provided buffer mode, we should
59          * increment ring->head to explicitly monopolize the buffer to avoid
60          * multiple use.
61          */
62         if (req->flags & REQ_F_PARTIAL_IO)
63                 return;
64
65         io_ring_submit_lock(ctx, issue_flags);
66
67         buf = req->kbuf;
68         bl = io_buffer_get_list(ctx, buf->bgid);
69         list_add(&buf->list, &bl->buf_list);
70         req->flags &= ~REQ_F_BUFFER_SELECTED;
71         req->buf_index = buf->bgid;
72
73         io_ring_submit_unlock(ctx, issue_flags);
74         return;
75 }
76
77 unsigned int __io_put_kbuf(struct io_kiocb *req, unsigned issue_flags)
78 {
79         unsigned int cflags;
80
81         /*
82          * We can add this buffer back to two lists:
83          *
84          * 1) The io_buffers_cache list. This one is protected by the
85          *    ctx->uring_lock. If we already hold this lock, add back to this
86          *    list as we can grab it from issue as well.
87          * 2) The io_buffers_comp list. This one is protected by the
88          *    ctx->completion_lock.
89          *
90          * We migrate buffers from the comp_list to the issue cache list
91          * when we need one.
92          */
93         if (req->flags & REQ_F_BUFFER_RING) {
94                 /* no buffers to recycle for this case */
95                 cflags = __io_put_kbuf_list(req, NULL);
96         } else if (issue_flags & IO_URING_F_UNLOCKED) {
97                 struct io_ring_ctx *ctx = req->ctx;
98
99                 spin_lock(&ctx->completion_lock);
100                 cflags = __io_put_kbuf_list(req, &ctx->io_buffers_comp);
101                 spin_unlock(&ctx->completion_lock);
102         } else {
103                 lockdep_assert_held(&req->ctx->uring_lock);
104
105                 cflags = __io_put_kbuf_list(req, &req->ctx->io_buffers_cache);
106         }
107         return cflags;
108 }
109
110 static void __user *io_provided_buffer_select(struct io_kiocb *req, size_t *len,
111                                               struct io_buffer_list *bl)
112 {
113         if (!list_empty(&bl->buf_list)) {
114                 struct io_buffer *kbuf;
115
116                 kbuf = list_first_entry(&bl->buf_list, struct io_buffer, list);
117                 list_del(&kbuf->list);
118                 if (*len == 0 || *len > kbuf->len)
119                         *len = kbuf->len;
120                 req->flags |= REQ_F_BUFFER_SELECTED;
121                 req->kbuf = kbuf;
122                 req->buf_index = kbuf->bid;
123                 return u64_to_user_ptr(kbuf->addr);
124         }
125         return NULL;
126 }
127
128 static void __user *io_ring_buffer_select(struct io_kiocb *req, size_t *len,
129                                           struct io_buffer_list *bl,
130                                           unsigned int issue_flags)
131 {
132         struct io_uring_buf_ring *br = bl->buf_ring;
133         struct io_uring_buf *buf;
134         __u16 head = bl->head;
135
136         if (unlikely(smp_load_acquire(&br->tail) == head))
137                 return NULL;
138
139         head &= bl->mask;
140         if (head < IO_BUFFER_LIST_BUF_PER_PAGE) {
141                 buf = &br->bufs[head];
142         } else {
143                 int off = head & (IO_BUFFER_LIST_BUF_PER_PAGE - 1);
144                 int index = head / IO_BUFFER_LIST_BUF_PER_PAGE;
145                 buf = page_address(bl->buf_pages[index]);
146                 buf += off;
147         }
148         if (*len == 0 || *len > buf->len)
149                 *len = buf->len;
150         req->flags |= REQ_F_BUFFER_RING;
151         req->buf_list = bl;
152         req->buf_index = buf->bid;
153
154         if (issue_flags & IO_URING_F_UNLOCKED || !file_can_poll(req->file)) {
155                 /*
156                  * If we came in unlocked, we have no choice but to consume the
157                  * buffer here, otherwise nothing ensures that the buffer won't
158                  * get used by others. This does mean it'll be pinned until the
159                  * IO completes, coming in unlocked means we're being called from
160                  * io-wq context and there may be further retries in async hybrid
161                  * mode. For the locked case, the caller must call commit when
162                  * the transfer completes (or if we get -EAGAIN and must poll of
163                  * retry).
164                  */
165                 req->buf_list = NULL;
166                 bl->head++;
167         }
168         return u64_to_user_ptr(buf->addr);
169 }
170
171 void __user *io_buffer_select(struct io_kiocb *req, size_t *len,
172                               unsigned int issue_flags)
173 {
174         struct io_ring_ctx *ctx = req->ctx;
175         struct io_buffer_list *bl;
176         void __user *ret = NULL;
177
178         io_ring_submit_lock(req->ctx, issue_flags);
179
180         bl = io_buffer_get_list(ctx, req->buf_index);
181         if (likely(bl)) {
182                 if (bl->buf_nr_pages)
183                         ret = io_ring_buffer_select(req, len, bl, issue_flags);
184                 else
185                         ret = io_provided_buffer_select(req, len, bl);
186         }
187         io_ring_submit_unlock(req->ctx, issue_flags);
188         return ret;
189 }
190
191 static __cold int io_init_bl_list(struct io_ring_ctx *ctx)
192 {
193         int i;
194
195         ctx->io_bl = kcalloc(BGID_ARRAY, sizeof(struct io_buffer_list),
196                                 GFP_KERNEL);
197         if (!ctx->io_bl)
198                 return -ENOMEM;
199
200         for (i = 0; i < BGID_ARRAY; i++) {
201                 INIT_LIST_HEAD(&ctx->io_bl[i].buf_list);
202                 ctx->io_bl[i].bgid = i;
203         }
204
205         return 0;
206 }
207
208 static int __io_remove_buffers(struct io_ring_ctx *ctx,
209                                struct io_buffer_list *bl, unsigned nbufs)
210 {
211         unsigned i = 0;
212
213         /* shouldn't happen */
214         if (!nbufs)
215                 return 0;
216
217         if (bl->buf_nr_pages) {
218                 int j;
219
220                 i = bl->buf_ring->tail - bl->head;
221                 for (j = 0; j < bl->buf_nr_pages; j++)
222                         unpin_user_page(bl->buf_pages[j]);
223                 kvfree(bl->buf_pages);
224                 bl->buf_pages = NULL;
225                 bl->buf_nr_pages = 0;
226                 /* make sure it's seen as empty */
227                 INIT_LIST_HEAD(&bl->buf_list);
228                 return i;
229         }
230
231         /* protects io_buffers_cache */
232         lockdep_assert_held(&ctx->uring_lock);
233
234         while (!list_empty(&bl->buf_list)) {
235                 struct io_buffer *nxt;
236
237                 nxt = list_first_entry(&bl->buf_list, struct io_buffer, list);
238                 list_move(&nxt->list, &ctx->io_buffers_cache);
239                 if (++i == nbufs)
240                         return i;
241                 cond_resched();
242         }
243
244         return i;
245 }
246
247 void io_destroy_buffers(struct io_ring_ctx *ctx)
248 {
249         struct io_buffer_list *bl;
250         unsigned long index;
251         int i;
252
253         for (i = 0; i < BGID_ARRAY; i++) {
254                 if (!ctx->io_bl)
255                         break;
256                 __io_remove_buffers(ctx, &ctx->io_bl[i], -1U);
257         }
258
259         xa_for_each(&ctx->io_bl_xa, index, bl) {
260                 xa_erase(&ctx->io_bl_xa, bl->bgid);
261                 __io_remove_buffers(ctx, bl, -1U);
262                 kfree(bl);
263         }
264
265         while (!list_empty(&ctx->io_buffers_pages)) {
266                 struct page *page;
267
268                 page = list_first_entry(&ctx->io_buffers_pages, struct page, lru);
269                 list_del_init(&page->lru);
270                 __free_page(page);
271         }
272 }
273
274 int io_remove_buffers_prep(struct io_kiocb *req, const struct io_uring_sqe *sqe)
275 {
276         struct io_provide_buf *p = io_kiocb_to_cmd(req, struct io_provide_buf);
277         u64 tmp;
278
279         if (sqe->rw_flags || sqe->addr || sqe->len || sqe->off ||
280             sqe->splice_fd_in)
281                 return -EINVAL;
282
283         tmp = READ_ONCE(sqe->fd);
284         if (!tmp || tmp > USHRT_MAX)
285                 return -EINVAL;
286
287         memset(p, 0, sizeof(*p));
288         p->nbufs = tmp;
289         p->bgid = READ_ONCE(sqe->buf_group);
290         return 0;
291 }
292
293 int io_remove_buffers(struct io_kiocb *req, unsigned int issue_flags)
294 {
295         struct io_provide_buf *p = io_kiocb_to_cmd(req, struct io_provide_buf);
296         struct io_ring_ctx *ctx = req->ctx;
297         struct io_buffer_list *bl;
298         int ret = 0;
299
300         io_ring_submit_lock(ctx, issue_flags);
301
302         ret = -ENOENT;
303         bl = io_buffer_get_list(ctx, p->bgid);
304         if (bl) {
305                 ret = -EINVAL;
306                 /* can't use provide/remove buffers command on mapped buffers */
307                 if (!bl->buf_nr_pages)
308                         ret = __io_remove_buffers(ctx, bl, p->nbufs);
309         }
310         if (ret < 0)
311                 req_set_fail(req);
312
313         /* complete before unlock, IOPOLL may need the lock */
314         io_req_set_res(req, ret, 0);
315         __io_req_complete(req, issue_flags);
316         io_ring_submit_unlock(ctx, issue_flags);
317         return IOU_ISSUE_SKIP_COMPLETE;
318 }
319
320 int io_provide_buffers_prep(struct io_kiocb *req, const struct io_uring_sqe *sqe)
321 {
322         unsigned long size, tmp_check;
323         struct io_provide_buf *p = io_kiocb_to_cmd(req, struct io_provide_buf);
324         u64 tmp;
325
326         if (sqe->rw_flags || sqe->splice_fd_in)
327                 return -EINVAL;
328
329         tmp = READ_ONCE(sqe->fd);
330         if (!tmp || tmp > USHRT_MAX)
331                 return -E2BIG;
332         p->nbufs = tmp;
333         p->addr = READ_ONCE(sqe->addr);
334         p->len = READ_ONCE(sqe->len);
335
336         if (check_mul_overflow((unsigned long)p->len, (unsigned long)p->nbufs,
337                                 &size))
338                 return -EOVERFLOW;
339         if (check_add_overflow((unsigned long)p->addr, size, &tmp_check))
340                 return -EOVERFLOW;
341
342         size = (unsigned long)p->len * p->nbufs;
343         if (!access_ok(u64_to_user_ptr(p->addr), size))
344                 return -EFAULT;
345
346         p->bgid = READ_ONCE(sqe->buf_group);
347         tmp = READ_ONCE(sqe->off);
348         if (tmp > USHRT_MAX)
349                 return -E2BIG;
350         if (tmp + p->nbufs >= USHRT_MAX)
351                 return -EINVAL;
352         p->bid = tmp;
353         return 0;
354 }
355
356 static int io_refill_buffer_cache(struct io_ring_ctx *ctx)
357 {
358         struct io_buffer *buf;
359         struct page *page;
360         int bufs_in_page;
361
362         /*
363          * Completions that don't happen inline (eg not under uring_lock) will
364          * add to ->io_buffers_comp. If we don't have any free buffers, check
365          * the completion list and splice those entries first.
366          */
367         if (!list_empty_careful(&ctx->io_buffers_comp)) {
368                 spin_lock(&ctx->completion_lock);
369                 if (!list_empty(&ctx->io_buffers_comp)) {
370                         list_splice_init(&ctx->io_buffers_comp,
371                                                 &ctx->io_buffers_cache);
372                         spin_unlock(&ctx->completion_lock);
373                         return 0;
374                 }
375                 spin_unlock(&ctx->completion_lock);
376         }
377
378         /*
379          * No free buffers and no completion entries either. Allocate a new
380          * page worth of buffer entries and add those to our freelist.
381          */
382         page = alloc_page(GFP_KERNEL_ACCOUNT);
383         if (!page)
384                 return -ENOMEM;
385
386         list_add(&page->lru, &ctx->io_buffers_pages);
387
388         buf = page_address(page);
389         bufs_in_page = PAGE_SIZE / sizeof(*buf);
390         while (bufs_in_page) {
391                 list_add_tail(&buf->list, &ctx->io_buffers_cache);
392                 buf++;
393                 bufs_in_page--;
394         }
395
396         return 0;
397 }
398
399 static int io_add_buffers(struct io_ring_ctx *ctx, struct io_provide_buf *pbuf,
400                           struct io_buffer_list *bl)
401 {
402         struct io_buffer *buf;
403         u64 addr = pbuf->addr;
404         int i, bid = pbuf->bid;
405
406         for (i = 0; i < pbuf->nbufs; i++) {
407                 if (list_empty(&ctx->io_buffers_cache) &&
408                     io_refill_buffer_cache(ctx))
409                         break;
410                 buf = list_first_entry(&ctx->io_buffers_cache, struct io_buffer,
411                                         list);
412                 list_move_tail(&buf->list, &bl->buf_list);
413                 buf->addr = addr;
414                 buf->len = min_t(__u32, pbuf->len, MAX_RW_COUNT);
415                 buf->bid = bid;
416                 buf->bgid = pbuf->bgid;
417                 addr += pbuf->len;
418                 bid++;
419                 cond_resched();
420         }
421
422         return i ? 0 : -ENOMEM;
423 }
424
425 int io_provide_buffers(struct io_kiocb *req, unsigned int issue_flags)
426 {
427         struct io_provide_buf *p = io_kiocb_to_cmd(req, struct io_provide_buf);
428         struct io_ring_ctx *ctx = req->ctx;
429         struct io_buffer_list *bl;
430         int ret = 0;
431
432         io_ring_submit_lock(ctx, issue_flags);
433
434         if (unlikely(p->bgid < BGID_ARRAY && !ctx->io_bl)) {
435                 ret = io_init_bl_list(ctx);
436                 if (ret)
437                         goto err;
438         }
439
440         bl = io_buffer_get_list(ctx, p->bgid);
441         if (unlikely(!bl)) {
442                 bl = kzalloc(sizeof(*bl), GFP_KERNEL_ACCOUNT);
443                 if (!bl) {
444                         ret = -ENOMEM;
445                         goto err;
446                 }
447                 INIT_LIST_HEAD(&bl->buf_list);
448                 ret = io_buffer_add_list(ctx, bl, p->bgid);
449                 if (ret) {
450                         kfree(bl);
451                         goto err;
452                 }
453         }
454         /* can't add buffers via this command for a mapped buffer ring */
455         if (bl->buf_nr_pages) {
456                 ret = -EINVAL;
457                 goto err;
458         }
459
460         ret = io_add_buffers(ctx, p, bl);
461 err:
462         if (ret < 0)
463                 req_set_fail(req);
464         /* complete before unlock, IOPOLL may need the lock */
465         io_req_set_res(req, ret, 0);
466         __io_req_complete(req, issue_flags);
467         io_ring_submit_unlock(ctx, issue_flags);
468         return IOU_ISSUE_SKIP_COMPLETE;
469 }
470
471 int io_register_pbuf_ring(struct io_ring_ctx *ctx, void __user *arg)
472 {
473         struct io_uring_buf_ring *br;
474         struct io_uring_buf_reg reg;
475         struct io_buffer_list *bl, *free_bl = NULL;
476         struct page **pages;
477         int nr_pages;
478
479         if (copy_from_user(&reg, arg, sizeof(reg)))
480                 return -EFAULT;
481
482         if (reg.pad || reg.resv[0] || reg.resv[1] || reg.resv[2])
483                 return -EINVAL;
484         if (!reg.ring_addr)
485                 return -EFAULT;
486         if (reg.ring_addr & ~PAGE_MASK)
487                 return -EINVAL;
488         if (!is_power_of_2(reg.ring_entries))
489                 return -EINVAL;
490
491         /* cannot disambiguate full vs empty due to head/tail size */
492         if (reg.ring_entries >= 65536)
493                 return -EINVAL;
494
495         if (unlikely(reg.bgid < BGID_ARRAY && !ctx->io_bl)) {
496                 int ret = io_init_bl_list(ctx);
497                 if (ret)
498                         return ret;
499         }
500
501         bl = io_buffer_get_list(ctx, reg.bgid);
502         if (bl) {
503                 /* if mapped buffer ring OR classic exists, don't allow */
504                 if (bl->buf_nr_pages || !list_empty(&bl->buf_list))
505                         return -EEXIST;
506         } else {
507                 free_bl = bl = kzalloc(sizeof(*bl), GFP_KERNEL);
508                 if (!bl)
509                         return -ENOMEM;
510         }
511
512         pages = io_pin_pages(reg.ring_addr,
513                              flex_array_size(br, bufs, reg.ring_entries),
514                              &nr_pages);
515         if (IS_ERR(pages)) {
516                 kfree(free_bl);
517                 return PTR_ERR(pages);
518         }
519
520         br = page_address(pages[0]);
521         bl->buf_pages = pages;
522         bl->buf_nr_pages = nr_pages;
523         bl->nr_entries = reg.ring_entries;
524         bl->buf_ring = br;
525         bl->mask = reg.ring_entries - 1;
526         io_buffer_add_list(ctx, bl, reg.bgid);
527         return 0;
528 }
529
530 int io_unregister_pbuf_ring(struct io_ring_ctx *ctx, void __user *arg)
531 {
532         struct io_uring_buf_reg reg;
533         struct io_buffer_list *bl;
534
535         if (copy_from_user(&reg, arg, sizeof(reg)))
536                 return -EFAULT;
537         if (reg.pad || reg.resv[0] || reg.resv[1] || reg.resv[2])
538                 return -EINVAL;
539
540         bl = io_buffer_get_list(ctx, reg.bgid);
541         if (!bl)
542                 return -ENOENT;
543         if (!bl->buf_nr_pages)
544                 return -EINVAL;
545
546         __io_remove_buffers(ctx, bl, -1U);
547         if (bl->bgid >= BGID_ARRAY) {
548                 xa_erase(&ctx->io_bl_xa, bl->bgid);
549                 kfree(bl);
550         }
551         return 0;
552 }