Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/mason/linux...
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / fs / bio.c
1 /*
2 * Copyright (C) 2001 Jens Axboe <axboe@kernel.dk>
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
7 *
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
12 *
13 * You should have received a copy of the GNU General Public Licens
14 * along with this program; if not, write to the Free Software
15 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-
16 *
17 */
18 #include <linux/mm.h>
19 #include <linux/swap.h>
20 #include <linux/bio.h>
21 #include <linux/blkdev.h>
22 #include <linux/slab.h>
23 #include <linux/init.h>
24 #include <linux/kernel.h>
25 #include <linux/module.h>
26 #include <linux/mempool.h>
27 #include <linux/workqueue.h>
28 #include <scsi/sg.h> /* for struct sg_iovec */
29
30 #include <trace/events/block.h>
31
32 /*
33 * Test patch to inline a certain number of bi_io_vec's inside the bio
34 * itself, to shrink a bio data allocation from two mempool calls to one
35 */
36 #define BIO_INLINE_VECS 4
37
38 static mempool_t *bio_split_pool __read_mostly;
39
40 /*
41 * if you change this list, also change bvec_alloc or things will
42 * break badly! cannot be bigger than what you can fit into an
43 * unsigned short
44 */
45 #define BV(x) { .nr_vecs = x, .name = "biovec-"__stringify(x) }
46 static struct biovec_slab bvec_slabs[BIOVEC_NR_POOLS] __read_mostly = {
47 BV(1), BV(4), BV(16), BV(64), BV(128), BV(BIO_MAX_PAGES),
48 };
49 #undef BV
50
51 /*
52 * fs_bio_set is the bio_set containing bio and iovec memory pools used by
53 * IO code that does not need private memory pools.
54 */
55 struct bio_set *fs_bio_set;
56
57 /*
58 * Our slab pool management
59 */
60 struct bio_slab {
61 struct kmem_cache *slab;
62 unsigned int slab_ref;
63 unsigned int slab_size;
64 char name[8];
65 };
66 static DEFINE_MUTEX(bio_slab_lock);
67 static struct bio_slab *bio_slabs;
68 static unsigned int bio_slab_nr, bio_slab_max;
69
70 static struct kmem_cache *bio_find_or_create_slab(unsigned int extra_size)
71 {
72 unsigned int sz = sizeof(struct bio) + extra_size;
73 struct kmem_cache *slab = NULL;
74 struct bio_slab *bslab;
75 unsigned int i, entry = -1;
76
77 mutex_lock(&bio_slab_lock);
78
79 i = 0;
80 while (i < bio_slab_nr) {
81 bslab = &bio_slabs[i];
82
83 if (!bslab->slab && entry == -1)
84 entry = i;
85 else if (bslab->slab_size == sz) {
86 slab = bslab->slab;
87 bslab->slab_ref++;
88 break;
89 }
90 i++;
91 }
92
93 if (slab)
94 goto out_unlock;
95
96 if (bio_slab_nr == bio_slab_max && entry == -1) {
97 bio_slab_max <<= 1;
98 bio_slabs = krealloc(bio_slabs,
99 bio_slab_max * sizeof(struct bio_slab),
100 GFP_KERNEL);
101 if (!bio_slabs)
102 goto out_unlock;
103 }
104 if (entry == -1)
105 entry = bio_slab_nr++;
106
107 bslab = &bio_slabs[entry];
108
109 snprintf(bslab->name, sizeof(bslab->name), "bio-%d", entry);
110 slab = kmem_cache_create(bslab->name, sz, 0, SLAB_HWCACHE_ALIGN, NULL);
111 if (!slab)
112 goto out_unlock;
113
114 printk(KERN_INFO "bio: create slab <%s> at %d\n", bslab->name, entry);
115 bslab->slab = slab;
116 bslab->slab_ref = 1;
117 bslab->slab_size = sz;
118 out_unlock:
119 mutex_unlock(&bio_slab_lock);
120 return slab;
121 }
122
123 static void bio_put_slab(struct bio_set *bs)
124 {
125 struct bio_slab *bslab = NULL;
126 unsigned int i;
127
128 mutex_lock(&bio_slab_lock);
129
130 for (i = 0; i < bio_slab_nr; i++) {
131 if (bs->bio_slab == bio_slabs[i].slab) {
132 bslab = &bio_slabs[i];
133 break;
134 }
135 }
136
137 if (WARN(!bslab, KERN_ERR "bio: unable to find slab!\n"))
138 goto out;
139
140 WARN_ON(!bslab->slab_ref);
141
142 if (--bslab->slab_ref)
143 goto out;
144
145 kmem_cache_destroy(bslab->slab);
146 bslab->slab = NULL;
147
148 out:
149 mutex_unlock(&bio_slab_lock);
150 }
151
152 unsigned int bvec_nr_vecs(unsigned short idx)
153 {
154 return bvec_slabs[idx].nr_vecs;
155 }
156
157 void bvec_free_bs(struct bio_set *bs, struct bio_vec *bv, unsigned int idx)
158 {
159 BIO_BUG_ON(idx >= BIOVEC_NR_POOLS);
160
161 if (idx == BIOVEC_MAX_IDX)
162 mempool_free(bv, bs->bvec_pool);
163 else {
164 struct biovec_slab *bvs = bvec_slabs + idx;
165
166 kmem_cache_free(bvs->slab, bv);
167 }
168 }
169
170 struct bio_vec *bvec_alloc_bs(gfp_t gfp_mask, int nr, unsigned long *idx,
171 struct bio_set *bs)
172 {
173 struct bio_vec *bvl;
174
175 /*
176 * see comment near bvec_array define!
177 */
178 switch (nr) {
179 case 1:
180 *idx = 0;
181 break;
182 case 2 ... 4:
183 *idx = 1;
184 break;
185 case 5 ... 16:
186 *idx = 2;
187 break;
188 case 17 ... 64:
189 *idx = 3;
190 break;
191 case 65 ... 128:
192 *idx = 4;
193 break;
194 case 129 ... BIO_MAX_PAGES:
195 *idx = 5;
196 break;
197 default:
198 return NULL;
199 }
200
201 /*
202 * idx now points to the pool we want to allocate from. only the
203 * 1-vec entry pool is mempool backed.
204 */
205 if (*idx == BIOVEC_MAX_IDX) {
206 fallback:
207 bvl = mempool_alloc(bs->bvec_pool, gfp_mask);
208 } else {
209 struct biovec_slab *bvs = bvec_slabs + *idx;
210 gfp_t __gfp_mask = gfp_mask & ~(__GFP_WAIT | __GFP_IO);
211
212 /*
213 * Make this allocation restricted and don't dump info on
214 * allocation failures, since we'll fallback to the mempool
215 * in case of failure.
216 */
217 __gfp_mask |= __GFP_NOMEMALLOC | __GFP_NORETRY | __GFP_NOWARN;
218
219 /*
220 * Try a slab allocation. If this fails and __GFP_WAIT
221 * is set, retry with the 1-entry mempool
222 */
223 bvl = kmem_cache_alloc(bvs->slab, __gfp_mask);
224 if (unlikely(!bvl && (gfp_mask & __GFP_WAIT))) {
225 *idx = BIOVEC_MAX_IDX;
226 goto fallback;
227 }
228 }
229
230 return bvl;
231 }
232
233 void bio_free(struct bio *bio, struct bio_set *bs)
234 {
235 void *p;
236
237 if (bio_has_allocated_vec(bio))
238 bvec_free_bs(bs, bio->bi_io_vec, BIO_POOL_IDX(bio));
239
240 if (bio_integrity(bio))
241 bio_integrity_free(bio, bs);
242
243 /*
244 * If we have front padding, adjust the bio pointer before freeing
245 */
246 p = bio;
247 if (bs->front_pad)
248 p -= bs->front_pad;
249
250 mempool_free(p, bs->bio_pool);
251 }
252 EXPORT_SYMBOL(bio_free);
253
254 void bio_init(struct bio *bio)
255 {
256 memset(bio, 0, sizeof(*bio));
257 bio->bi_flags = 1 << BIO_UPTODATE;
258 atomic_set(&bio->bi_cnt, 1);
259 }
260 EXPORT_SYMBOL(bio_init);
261
262 /**
263 * bio_alloc_bioset - allocate a bio for I/O
264 * @gfp_mask: the GFP_ mask given to the slab allocator
265 * @nr_iovecs: number of iovecs to pre-allocate
266 * @bs: the bio_set to allocate from.
267 *
268 * Description:
269 * bio_alloc_bioset will try its own mempool to satisfy the allocation.
270 * If %__GFP_WAIT is set then we will block on the internal pool waiting
271 * for a &struct bio to become free.
272 *
273 * Note that the caller must set ->bi_destructor on successful return
274 * of a bio, to do the appropriate freeing of the bio once the reference
275 * count drops to zero.
276 **/
277 struct bio *bio_alloc_bioset(gfp_t gfp_mask, int nr_iovecs, struct bio_set *bs)
278 {
279 unsigned long idx = BIO_POOL_NONE;
280 struct bio_vec *bvl = NULL;
281 struct bio *bio;
282 void *p;
283
284 p = mempool_alloc(bs->bio_pool, gfp_mask);
285 if (unlikely(!p))
286 return NULL;
287 bio = p + bs->front_pad;
288
289 bio_init(bio);
290
291 if (unlikely(!nr_iovecs))
292 goto out_set;
293
294 if (nr_iovecs <= BIO_INLINE_VECS) {
295 bvl = bio->bi_inline_vecs;
296 nr_iovecs = BIO_INLINE_VECS;
297 } else {
298 bvl = bvec_alloc_bs(gfp_mask, nr_iovecs, &idx, bs);
299 if (unlikely(!bvl))
300 goto err_free;
301
302 nr_iovecs = bvec_nr_vecs(idx);
303 }
304 out_set:
305 bio->bi_flags |= idx << BIO_POOL_OFFSET;
306 bio->bi_max_vecs = nr_iovecs;
307 bio->bi_io_vec = bvl;
308 return bio;
309
310 err_free:
311 mempool_free(p, bs->bio_pool);
312 return NULL;
313 }
314 EXPORT_SYMBOL(bio_alloc_bioset);
315
316 static void bio_fs_destructor(struct bio *bio)
317 {
318 bio_free(bio, fs_bio_set);
319 }
320
321 /**
322 * bio_alloc - allocate a new bio, memory pool backed
323 * @gfp_mask: allocation mask to use
324 * @nr_iovecs: number of iovecs
325 *
326 * bio_alloc will allocate a bio and associated bio_vec array that can hold
327 * at least @nr_iovecs entries. Allocations will be done from the
328 * fs_bio_set. Also see @bio_alloc_bioset and @bio_kmalloc.
329 *
330 * If %__GFP_WAIT is set, then bio_alloc will always be able to allocate
331 * a bio. This is due to the mempool guarantees. To make this work, callers
332 * must never allocate more than 1 bio at a time from this pool. Callers
333 * that need to allocate more than 1 bio must always submit the previously
334 * allocated bio for IO before attempting to allocate a new one. Failure to
335 * do so can cause livelocks under memory pressure.
336 *
337 * RETURNS:
338 * Pointer to new bio on success, NULL on failure.
339 */
340 struct bio *bio_alloc(gfp_t gfp_mask, int nr_iovecs)
341 {
342 struct bio *bio = bio_alloc_bioset(gfp_mask, nr_iovecs, fs_bio_set);
343
344 if (bio)
345 bio->bi_destructor = bio_fs_destructor;
346
347 return bio;
348 }
349 EXPORT_SYMBOL(bio_alloc);
350
351 static void bio_kmalloc_destructor(struct bio *bio)
352 {
353 if (bio_integrity(bio))
354 bio_integrity_free(bio, fs_bio_set);
355 kfree(bio);
356 }
357
358 /**
359 * bio_kmalloc - allocate a bio for I/O using kmalloc()
360 * @gfp_mask: the GFP_ mask given to the slab allocator
361 * @nr_iovecs: number of iovecs to pre-allocate
362 *
363 * Description:
364 * Allocate a new bio with @nr_iovecs bvecs. If @gfp_mask contains
365 * %__GFP_WAIT, the allocation is guaranteed to succeed.
366 *
367 **/
368 struct bio *bio_kmalloc(gfp_t gfp_mask, int nr_iovecs)
369 {
370 struct bio *bio;
371
372 if (nr_iovecs > UIO_MAXIOV)
373 return NULL;
374
375 bio = kmalloc(sizeof(struct bio) + nr_iovecs * sizeof(struct bio_vec),
376 gfp_mask);
377 if (unlikely(!bio))
378 return NULL;
379
380 bio_init(bio);
381 bio->bi_flags |= BIO_POOL_NONE << BIO_POOL_OFFSET;
382 bio->bi_max_vecs = nr_iovecs;
383 bio->bi_io_vec = bio->bi_inline_vecs;
384 bio->bi_destructor = bio_kmalloc_destructor;
385
386 return bio;
387 }
388 EXPORT_SYMBOL(bio_kmalloc);
389
390 void zero_fill_bio(struct bio *bio)
391 {
392 unsigned long flags;
393 struct bio_vec *bv;
394 int i;
395
396 bio_for_each_segment(bv, bio, i) {
397 char *data = bvec_kmap_irq(bv, &flags);
398 memset(data, 0, bv->bv_len);
399 flush_dcache_page(bv->bv_page);
400 bvec_kunmap_irq(data, &flags);
401 }
402 }
403 EXPORT_SYMBOL(zero_fill_bio);
404
405 /**
406 * bio_put - release a reference to a bio
407 * @bio: bio to release reference to
408 *
409 * Description:
410 * Put a reference to a &struct bio, either one you have gotten with
411 * bio_alloc, bio_get or bio_clone. The last put of a bio will free it.
412 **/
413 void bio_put(struct bio *bio)
414 {
415 BIO_BUG_ON(!atomic_read(&bio->bi_cnt));
416
417 /*
418 * last put frees it
419 */
420 if (atomic_dec_and_test(&bio->bi_cnt)) {
421 bio->bi_next = NULL;
422 bio->bi_destructor(bio);
423 }
424 }
425 EXPORT_SYMBOL(bio_put);
426
427 inline int bio_phys_segments(struct request_queue *q, struct bio *bio)
428 {
429 if (unlikely(!bio_flagged(bio, BIO_SEG_VALID)))
430 blk_recount_segments(q, bio);
431
432 return bio->bi_phys_segments;
433 }
434 EXPORT_SYMBOL(bio_phys_segments);
435
436 /**
437 * __bio_clone - clone a bio
438 * @bio: destination bio
439 * @bio_src: bio to clone
440 *
441 * Clone a &bio. Caller will own the returned bio, but not
442 * the actual data it points to. Reference count of returned
443 * bio will be one.
444 */
445 void __bio_clone(struct bio *bio, struct bio *bio_src)
446 {
447 memcpy(bio->bi_io_vec, bio_src->bi_io_vec,
448 bio_src->bi_max_vecs * sizeof(struct bio_vec));
449
450 /*
451 * most users will be overriding ->bi_bdev with a new target,
452 * so we don't set nor calculate new physical/hw segment counts here
453 */
454 bio->bi_sector = bio_src->bi_sector;
455 bio->bi_bdev = bio_src->bi_bdev;
456 bio->bi_flags |= 1 << BIO_CLONED;
457 bio->bi_rw = bio_src->bi_rw;
458 bio->bi_vcnt = bio_src->bi_vcnt;
459 bio->bi_size = bio_src->bi_size;
460 bio->bi_idx = bio_src->bi_idx;
461 }
462 EXPORT_SYMBOL(__bio_clone);
463
464 /**
465 * bio_clone - clone a bio
466 * @bio: bio to clone
467 * @gfp_mask: allocation priority
468 *
469 * Like __bio_clone, only also allocates the returned bio
470 */
471 struct bio *bio_clone(struct bio *bio, gfp_t gfp_mask)
472 {
473 struct bio *b = bio_alloc_bioset(gfp_mask, bio->bi_max_vecs, fs_bio_set);
474
475 if (!b)
476 return NULL;
477
478 b->bi_destructor = bio_fs_destructor;
479 __bio_clone(b, bio);
480
481 if (bio_integrity(bio)) {
482 int ret;
483
484 ret = bio_integrity_clone(b, bio, gfp_mask, fs_bio_set);
485
486 if (ret < 0) {
487 bio_put(b);
488 return NULL;
489 }
490 }
491
492 return b;
493 }
494 EXPORT_SYMBOL(bio_clone);
495
496 /**
497 * bio_get_nr_vecs - return approx number of vecs
498 * @bdev: I/O target
499 *
500 * Return the approximate number of pages we can send to this target.
501 * There's no guarantee that you will be able to fit this number of pages
502 * into a bio, it does not account for dynamic restrictions that vary
503 * on offset.
504 */
505 int bio_get_nr_vecs(struct block_device *bdev)
506 {
507 struct request_queue *q = bdev_get_queue(bdev);
508 int nr_pages;
509
510 nr_pages = ((queue_max_sectors(q) << 9) + PAGE_SIZE - 1) >> PAGE_SHIFT;
511 if (nr_pages > queue_max_segments(q))
512 nr_pages = queue_max_segments(q);
513
514 return nr_pages;
515 }
516 EXPORT_SYMBOL(bio_get_nr_vecs);
517
518 static int __bio_add_page(struct request_queue *q, struct bio *bio, struct page
519 *page, unsigned int len, unsigned int offset,
520 unsigned short max_sectors)
521 {
522 int retried_segments = 0;
523 struct bio_vec *bvec;
524
525 /*
526 * cloned bio must not modify vec list
527 */
528 if (unlikely(bio_flagged(bio, BIO_CLONED)))
529 return 0;
530
531 if (((bio->bi_size + len) >> 9) > max_sectors)
532 return 0;
533
534 /*
535 * For filesystems with a blocksize smaller than the pagesize
536 * we will often be called with the same page as last time and
537 * a consecutive offset. Optimize this special case.
538 */
539 if (bio->bi_vcnt > 0) {
540 struct bio_vec *prev = &bio->bi_io_vec[bio->bi_vcnt - 1];
541
542 if (page == prev->bv_page &&
543 offset == prev->bv_offset + prev->bv_len) {
544 unsigned int prev_bv_len = prev->bv_len;
545 prev->bv_len += len;
546
547 if (q->merge_bvec_fn) {
548 struct bvec_merge_data bvm = {
549 /* prev_bvec is already charged in
550 bi_size, discharge it in order to
551 simulate merging updated prev_bvec
552 as new bvec. */
553 .bi_bdev = bio->bi_bdev,
554 .bi_sector = bio->bi_sector,
555 .bi_size = bio->bi_size - prev_bv_len,
556 .bi_rw = bio->bi_rw,
557 };
558
559 if (q->merge_bvec_fn(q, &bvm, prev) < prev->bv_len) {
560 prev->bv_len -= len;
561 return 0;
562 }
563 }
564
565 goto done;
566 }
567 }
568
569 if (bio->bi_vcnt >= bio->bi_max_vecs)
570 return 0;
571
572 /*
573 * we might lose a segment or two here, but rather that than
574 * make this too complex.
575 */
576
577 while (bio->bi_phys_segments >= queue_max_segments(q)) {
578
579 if (retried_segments)
580 return 0;
581
582 retried_segments = 1;
583 blk_recount_segments(q, bio);
584 }
585
586 /*
587 * setup the new entry, we might clear it again later if we
588 * cannot add the page
589 */
590 bvec = &bio->bi_io_vec[bio->bi_vcnt];
591 bvec->bv_page = page;
592 bvec->bv_len = len;
593 bvec->bv_offset = offset;
594
595 /*
596 * if queue has other restrictions (eg varying max sector size
597 * depending on offset), it can specify a merge_bvec_fn in the
598 * queue to get further control
599 */
600 if (q->merge_bvec_fn) {
601 struct bvec_merge_data bvm = {
602 .bi_bdev = bio->bi_bdev,
603 .bi_sector = bio->bi_sector,
604 .bi_size = bio->bi_size,
605 .bi_rw = bio->bi_rw,
606 };
607
608 /*
609 * merge_bvec_fn() returns number of bytes it can accept
610 * at this offset
611 */
612 if (q->merge_bvec_fn(q, &bvm, bvec) < bvec->bv_len) {
613 bvec->bv_page = NULL;
614 bvec->bv_len = 0;
615 bvec->bv_offset = 0;
616 return 0;
617 }
618 }
619
620 /* If we may be able to merge these biovecs, force a recount */
621 if (bio->bi_vcnt && (BIOVEC_PHYS_MERGEABLE(bvec-1, bvec)))
622 bio->bi_flags &= ~(1 << BIO_SEG_VALID);
623
624 bio->bi_vcnt++;
625 bio->bi_phys_segments++;
626 done:
627 bio->bi_size += len;
628 return len;
629 }
630
631 /**
632 * bio_add_pc_page - attempt to add page to bio
633 * @q: the target queue
634 * @bio: destination bio
635 * @page: page to add
636 * @len: vec entry length
637 * @offset: vec entry offset
638 *
639 * Attempt to add a page to the bio_vec maplist. This can fail for a
640 * number of reasons, such as the bio being full or target block device
641 * limitations. The target block device must allow bio's up to PAGE_SIZE,
642 * so it is always possible to add a single page to an empty bio.
643 *
644 * This should only be used by REQ_PC bios.
645 */
646 int bio_add_pc_page(struct request_queue *q, struct bio *bio, struct page *page,
647 unsigned int len, unsigned int offset)
648 {
649 return __bio_add_page(q, bio, page, len, offset,
650 queue_max_hw_sectors(q));
651 }
652 EXPORT_SYMBOL(bio_add_pc_page);
653
654 /**
655 * bio_add_page - attempt to add page to bio
656 * @bio: destination bio
657 * @page: page to add
658 * @len: vec entry length
659 * @offset: vec entry offset
660 *
661 * Attempt to add a page to the bio_vec maplist. This can fail for a
662 * number of reasons, such as the bio being full or target block device
663 * limitations. The target block device must allow bio's up to PAGE_SIZE,
664 * so it is always possible to add a single page to an empty bio.
665 */
666 int bio_add_page(struct bio *bio, struct page *page, unsigned int len,
667 unsigned int offset)
668 {
669 struct request_queue *q = bdev_get_queue(bio->bi_bdev);
670 return __bio_add_page(q, bio, page, len, offset, queue_max_sectors(q));
671 }
672 EXPORT_SYMBOL(bio_add_page);
673
674 struct bio_map_data {
675 struct bio_vec *iovecs;
676 struct sg_iovec *sgvecs;
677 int nr_sgvecs;
678 int is_our_pages;
679 };
680
681 static void bio_set_map_data(struct bio_map_data *bmd, struct bio *bio,
682 struct sg_iovec *iov, int iov_count,
683 int is_our_pages)
684 {
685 memcpy(bmd->iovecs, bio->bi_io_vec, sizeof(struct bio_vec) * bio->bi_vcnt);
686 memcpy(bmd->sgvecs, iov, sizeof(struct sg_iovec) * iov_count);
687 bmd->nr_sgvecs = iov_count;
688 bmd->is_our_pages = is_our_pages;
689 bio->bi_private = bmd;
690 }
691
692 static void bio_free_map_data(struct bio_map_data *bmd)
693 {
694 kfree(bmd->iovecs);
695 kfree(bmd->sgvecs);
696 kfree(bmd);
697 }
698
699 static struct bio_map_data *bio_alloc_map_data(int nr_segs, int iov_count,
700 gfp_t gfp_mask)
701 {
702 struct bio_map_data *bmd;
703
704 if (iov_count > UIO_MAXIOV)
705 return NULL;
706
707 bmd = kmalloc(sizeof(*bmd), gfp_mask);
708 if (!bmd)
709 return NULL;
710
711 bmd->iovecs = kmalloc(sizeof(struct bio_vec) * nr_segs, gfp_mask);
712 if (!bmd->iovecs) {
713 kfree(bmd);
714 return NULL;
715 }
716
717 bmd->sgvecs = kmalloc(sizeof(struct sg_iovec) * iov_count, gfp_mask);
718 if (bmd->sgvecs)
719 return bmd;
720
721 kfree(bmd->iovecs);
722 kfree(bmd);
723 return NULL;
724 }
725
726 static int __bio_copy_iov(struct bio *bio, struct bio_vec *iovecs,
727 struct sg_iovec *iov, int iov_count,
728 int to_user, int from_user, int do_free_page)
729 {
730 int ret = 0, i;
731 struct bio_vec *bvec;
732 int iov_idx = 0;
733 unsigned int iov_off = 0;
734
735 __bio_for_each_segment(bvec, bio, i, 0) {
736 char *bv_addr = page_address(bvec->bv_page);
737 unsigned int bv_len = iovecs[i].bv_len;
738
739 while (bv_len && iov_idx < iov_count) {
740 unsigned int bytes;
741 char __user *iov_addr;
742
743 bytes = min_t(unsigned int,
744 iov[iov_idx].iov_len - iov_off, bv_len);
745 iov_addr = iov[iov_idx].iov_base + iov_off;
746
747 if (!ret) {
748 if (to_user)
749 ret = copy_to_user(iov_addr, bv_addr,
750 bytes);
751
752 if (from_user)
753 ret = copy_from_user(bv_addr, iov_addr,
754 bytes);
755
756 if (ret)
757 ret = -EFAULT;
758 }
759
760 bv_len -= bytes;
761 bv_addr += bytes;
762 iov_addr += bytes;
763 iov_off += bytes;
764
765 if (iov[iov_idx].iov_len == iov_off) {
766 iov_idx++;
767 iov_off = 0;
768 }
769 }
770
771 if (do_free_page)
772 __free_page(bvec->bv_page);
773 }
774
775 return ret;
776 }
777
778 /**
779 * bio_uncopy_user - finish previously mapped bio
780 * @bio: bio being terminated
781 *
782 * Free pages allocated from bio_copy_user() and write back data
783 * to user space in case of a read.
784 */
785 int bio_uncopy_user(struct bio *bio)
786 {
787 struct bio_map_data *bmd = bio->bi_private;
788 int ret = 0;
789
790 if (!bio_flagged(bio, BIO_NULL_MAPPED))
791 ret = __bio_copy_iov(bio, bmd->iovecs, bmd->sgvecs,
792 bmd->nr_sgvecs, bio_data_dir(bio) == READ,
793 0, bmd->is_our_pages);
794 bio_free_map_data(bmd);
795 bio_put(bio);
796 return ret;
797 }
798 EXPORT_SYMBOL(bio_uncopy_user);
799
800 /**
801 * bio_copy_user_iov - copy user data to bio
802 * @q: destination block queue
803 * @map_data: pointer to the rq_map_data holding pages (if necessary)
804 * @iov: the iovec.
805 * @iov_count: number of elements in the iovec
806 * @write_to_vm: bool indicating writing to pages or not
807 * @gfp_mask: memory allocation flags
808 *
809 * Prepares and returns a bio for indirect user io, bouncing data
810 * to/from kernel pages as necessary. Must be paired with
811 * call bio_uncopy_user() on io completion.
812 */
813 struct bio *bio_copy_user_iov(struct request_queue *q,
814 struct rq_map_data *map_data,
815 struct sg_iovec *iov, int iov_count,
816 int write_to_vm, gfp_t gfp_mask)
817 {
818 struct bio_map_data *bmd;
819 struct bio_vec *bvec;
820 struct page *page;
821 struct bio *bio;
822 int i, ret;
823 int nr_pages = 0;
824 unsigned int len = 0;
825 unsigned int offset = map_data ? map_data->offset & ~PAGE_MASK : 0;
826
827 for (i = 0; i < iov_count; i++) {
828 unsigned long uaddr;
829 unsigned long end;
830 unsigned long start;
831
832 uaddr = (unsigned long)iov[i].iov_base;
833 end = (uaddr + iov[i].iov_len + PAGE_SIZE - 1) >> PAGE_SHIFT;
834 start = uaddr >> PAGE_SHIFT;
835
836 /*
837 * Overflow, abort
838 */
839 if (end < start)
840 return ERR_PTR(-EINVAL);
841
842 nr_pages += end - start;
843 len += iov[i].iov_len;
844 }
845
846 if (offset)
847 nr_pages++;
848
849 bmd = bio_alloc_map_data(nr_pages, iov_count, gfp_mask);
850 if (!bmd)
851 return ERR_PTR(-ENOMEM);
852
853 ret = -ENOMEM;
854 bio = bio_kmalloc(gfp_mask, nr_pages);
855 if (!bio)
856 goto out_bmd;
857
858 if (!write_to_vm)
859 bio->bi_rw |= REQ_WRITE;
860
861 ret = 0;
862
863 if (map_data) {
864 nr_pages = 1 << map_data->page_order;
865 i = map_data->offset / PAGE_SIZE;
866 }
867 while (len) {
868 unsigned int bytes = PAGE_SIZE;
869
870 bytes -= offset;
871
872 if (bytes > len)
873 bytes = len;
874
875 if (map_data) {
876 if (i == map_data->nr_entries * nr_pages) {
877 ret = -ENOMEM;
878 break;
879 }
880
881 page = map_data->pages[i / nr_pages];
882 page += (i % nr_pages);
883
884 i++;
885 } else {
886 page = alloc_page(q->bounce_gfp | gfp_mask);
887 if (!page) {
888 ret = -ENOMEM;
889 break;
890 }
891 }
892
893 if (bio_add_pc_page(q, bio, page, bytes, offset) < bytes)
894 break;
895
896 len -= bytes;
897 offset = 0;
898 }
899
900 if (ret)
901 goto cleanup;
902
903 /*
904 * success
905 */
906 if ((!write_to_vm && (!map_data || !map_data->null_mapped)) ||
907 (map_data && map_data->from_user)) {
908 ret = __bio_copy_iov(bio, bio->bi_io_vec, iov, iov_count, 0, 1, 0);
909 if (ret)
910 goto cleanup;
911 }
912
913 bio_set_map_data(bmd, bio, iov, iov_count, map_data ? 0 : 1);
914 return bio;
915 cleanup:
916 if (!map_data)
917 bio_for_each_segment(bvec, bio, i)
918 __free_page(bvec->bv_page);
919
920 bio_put(bio);
921 out_bmd:
922 bio_free_map_data(bmd);
923 return ERR_PTR(ret);
924 }
925
926 /**
927 * bio_copy_user - copy user data to bio
928 * @q: destination block queue
929 * @map_data: pointer to the rq_map_data holding pages (if necessary)
930 * @uaddr: start of user address
931 * @len: length in bytes
932 * @write_to_vm: bool indicating writing to pages or not
933 * @gfp_mask: memory allocation flags
934 *
935 * Prepares and returns a bio for indirect user io, bouncing data
936 * to/from kernel pages as necessary. Must be paired with
937 * call bio_uncopy_user() on io completion.
938 */
939 struct bio *bio_copy_user(struct request_queue *q, struct rq_map_data *map_data,
940 unsigned long uaddr, unsigned int len,
941 int write_to_vm, gfp_t gfp_mask)
942 {
943 struct sg_iovec iov;
944
945 iov.iov_base = (void __user *)uaddr;
946 iov.iov_len = len;
947
948 return bio_copy_user_iov(q, map_data, &iov, 1, write_to_vm, gfp_mask);
949 }
950 EXPORT_SYMBOL(bio_copy_user);
951
952 static struct bio *__bio_map_user_iov(struct request_queue *q,
953 struct block_device *bdev,
954 struct sg_iovec *iov, int iov_count,
955 int write_to_vm, gfp_t gfp_mask)
956 {
957 int i, j;
958 int nr_pages = 0;
959 struct page **pages;
960 struct bio *bio;
961 int cur_page = 0;
962 int ret, offset;
963
964 for (i = 0; i < iov_count; i++) {
965 unsigned long uaddr = (unsigned long)iov[i].iov_base;
966 unsigned long len = iov[i].iov_len;
967 unsigned long end = (uaddr + len + PAGE_SIZE - 1) >> PAGE_SHIFT;
968 unsigned long start = uaddr >> PAGE_SHIFT;
969
970 /*
971 * Overflow, abort
972 */
973 if (end < start)
974 return ERR_PTR(-EINVAL);
975
976 nr_pages += end - start;
977 /*
978 * buffer must be aligned to at least hardsector size for now
979 */
980 if (uaddr & queue_dma_alignment(q))
981 return ERR_PTR(-EINVAL);
982 }
983
984 if (!nr_pages)
985 return ERR_PTR(-EINVAL);
986
987 bio = bio_kmalloc(gfp_mask, nr_pages);
988 if (!bio)
989 return ERR_PTR(-ENOMEM);
990
991 ret = -ENOMEM;
992 pages = kcalloc(nr_pages, sizeof(struct page *), gfp_mask);
993 if (!pages)
994 goto out;
995
996 for (i = 0; i < iov_count; i++) {
997 unsigned long uaddr = (unsigned long)iov[i].iov_base;
998 unsigned long len = iov[i].iov_len;
999 unsigned long end = (uaddr + len + PAGE_SIZE - 1) >> PAGE_SHIFT;
1000 unsigned long start = uaddr >> PAGE_SHIFT;
1001 const int local_nr_pages = end - start;
1002 const int page_limit = cur_page + local_nr_pages;
1003
1004 ret = get_user_pages_fast(uaddr, local_nr_pages,
1005 write_to_vm, &pages[cur_page]);
1006 if (ret < local_nr_pages) {
1007 ret = -EFAULT;
1008 goto out_unmap;
1009 }
1010
1011 offset = uaddr & ~PAGE_MASK;
1012 for (j = cur_page; j < page_limit; j++) {
1013 unsigned int bytes = PAGE_SIZE - offset;
1014
1015 if (len <= 0)
1016 break;
1017
1018 if (bytes > len)
1019 bytes = len;
1020
1021 /*
1022 * sorry...
1023 */
1024 if (bio_add_pc_page(q, bio, pages[j], bytes, offset) <
1025 bytes)
1026 break;
1027
1028 len -= bytes;
1029 offset = 0;
1030 }
1031
1032 cur_page = j;
1033 /*
1034 * release the pages we didn't map into the bio, if any
1035 */
1036 while (j < page_limit)
1037 page_cache_release(pages[j++]);
1038 }
1039
1040 kfree(pages);
1041
1042 /*
1043 * set data direction, and check if mapped pages need bouncing
1044 */
1045 if (!write_to_vm)
1046 bio->bi_rw |= REQ_WRITE;
1047
1048 bio->bi_bdev = bdev;
1049 bio->bi_flags |= (1 << BIO_USER_MAPPED);
1050 return bio;
1051
1052 out_unmap:
1053 for (i = 0; i < nr_pages; i++) {
1054 if(!pages[i])
1055 break;
1056 page_cache_release(pages[i]);
1057 }
1058 out:
1059 kfree(pages);
1060 bio_put(bio);
1061 return ERR_PTR(ret);
1062 }
1063
1064 /**
1065 * bio_map_user - map user address into bio
1066 * @q: the struct request_queue for the bio
1067 * @bdev: destination block device
1068 * @uaddr: start of user address
1069 * @len: length in bytes
1070 * @write_to_vm: bool indicating writing to pages or not
1071 * @gfp_mask: memory allocation flags
1072 *
1073 * Map the user space address into a bio suitable for io to a block
1074 * device. Returns an error pointer in case of error.
1075 */
1076 struct bio *bio_map_user(struct request_queue *q, struct block_device *bdev,
1077 unsigned long uaddr, unsigned int len, int write_to_vm,
1078 gfp_t gfp_mask)
1079 {
1080 struct sg_iovec iov;
1081
1082 iov.iov_base = (void __user *)uaddr;
1083 iov.iov_len = len;
1084
1085 return bio_map_user_iov(q, bdev, &iov, 1, write_to_vm, gfp_mask);
1086 }
1087 EXPORT_SYMBOL(bio_map_user);
1088
1089 /**
1090 * bio_map_user_iov - map user sg_iovec table into bio
1091 * @q: the struct request_queue for the bio
1092 * @bdev: destination block device
1093 * @iov: the iovec.
1094 * @iov_count: number of elements in the iovec
1095 * @write_to_vm: bool indicating writing to pages or not
1096 * @gfp_mask: memory allocation flags
1097 *
1098 * Map the user space address into a bio suitable for io to a block
1099 * device. Returns an error pointer in case of error.
1100 */
1101 struct bio *bio_map_user_iov(struct request_queue *q, struct block_device *bdev,
1102 struct sg_iovec *iov, int iov_count,
1103 int write_to_vm, gfp_t gfp_mask)
1104 {
1105 struct bio *bio;
1106
1107 bio = __bio_map_user_iov(q, bdev, iov, iov_count, write_to_vm,
1108 gfp_mask);
1109 if (IS_ERR(bio))
1110 return bio;
1111
1112 /*
1113 * subtle -- if __bio_map_user() ended up bouncing a bio,
1114 * it would normally disappear when its bi_end_io is run.
1115 * however, we need it for the unmap, so grab an extra
1116 * reference to it
1117 */
1118 bio_get(bio);
1119
1120 return bio;
1121 }
1122
1123 static void __bio_unmap_user(struct bio *bio)
1124 {
1125 struct bio_vec *bvec;
1126 int i;
1127
1128 /*
1129 * make sure we dirty pages we wrote to
1130 */
1131 __bio_for_each_segment(bvec, bio, i, 0) {
1132 if (bio_data_dir(bio) == READ)
1133 set_page_dirty_lock(bvec->bv_page);
1134
1135 page_cache_release(bvec->bv_page);
1136 }
1137
1138 bio_put(bio);
1139 }
1140
1141 /**
1142 * bio_unmap_user - unmap a bio
1143 * @bio: the bio being unmapped
1144 *
1145 * Unmap a bio previously mapped by bio_map_user(). Must be called with
1146 * a process context.
1147 *
1148 * bio_unmap_user() may sleep.
1149 */
1150 void bio_unmap_user(struct bio *bio)
1151 {
1152 __bio_unmap_user(bio);
1153 bio_put(bio);
1154 }
1155 EXPORT_SYMBOL(bio_unmap_user);
1156
1157 static void bio_map_kern_endio(struct bio *bio, int err)
1158 {
1159 bio_put(bio);
1160 }
1161
1162 static struct bio *__bio_map_kern(struct request_queue *q, void *data,
1163 unsigned int len, gfp_t gfp_mask)
1164 {
1165 unsigned long kaddr = (unsigned long)data;
1166 unsigned long end = (kaddr + len + PAGE_SIZE - 1) >> PAGE_SHIFT;
1167 unsigned long start = kaddr >> PAGE_SHIFT;
1168 const int nr_pages = end - start;
1169 int offset, i;
1170 struct bio *bio;
1171
1172 bio = bio_kmalloc(gfp_mask, nr_pages);
1173 if (!bio)
1174 return ERR_PTR(-ENOMEM);
1175
1176 offset = offset_in_page(kaddr);
1177 for (i = 0; i < nr_pages; i++) {
1178 unsigned int bytes = PAGE_SIZE - offset;
1179
1180 if (len <= 0)
1181 break;
1182
1183 if (bytes > len)
1184 bytes = len;
1185
1186 if (bio_add_pc_page(q, bio, virt_to_page(data), bytes,
1187 offset) < bytes)
1188 break;
1189
1190 data += bytes;
1191 len -= bytes;
1192 offset = 0;
1193 }
1194
1195 bio->bi_end_io = bio_map_kern_endio;
1196 return bio;
1197 }
1198
1199 /**
1200 * bio_map_kern - map kernel address into bio
1201 * @q: the struct request_queue for the bio
1202 * @data: pointer to buffer to map
1203 * @len: length in bytes
1204 * @gfp_mask: allocation flags for bio allocation
1205 *
1206 * Map the kernel address into a bio suitable for io to a block
1207 * device. Returns an error pointer in case of error.
1208 */
1209 struct bio *bio_map_kern(struct request_queue *q, void *data, unsigned int len,
1210 gfp_t gfp_mask)
1211 {
1212 struct bio *bio;
1213
1214 bio = __bio_map_kern(q, data, len, gfp_mask);
1215 if (IS_ERR(bio))
1216 return bio;
1217
1218 if (bio->bi_size == len)
1219 return bio;
1220
1221 /*
1222 * Don't support partial mappings.
1223 */
1224 bio_put(bio);
1225 return ERR_PTR(-EINVAL);
1226 }
1227 EXPORT_SYMBOL(bio_map_kern);
1228
1229 static void bio_copy_kern_endio(struct bio *bio, int err)
1230 {
1231 struct bio_vec *bvec;
1232 const int read = bio_data_dir(bio) == READ;
1233 struct bio_map_data *bmd = bio->bi_private;
1234 int i;
1235 char *p = bmd->sgvecs[0].iov_base;
1236
1237 __bio_for_each_segment(bvec, bio, i, 0) {
1238 char *addr = page_address(bvec->bv_page);
1239 int len = bmd->iovecs[i].bv_len;
1240
1241 if (read)
1242 memcpy(p, addr, len);
1243
1244 __free_page(bvec->bv_page);
1245 p += len;
1246 }
1247
1248 bio_free_map_data(bmd);
1249 bio_put(bio);
1250 }
1251
1252 /**
1253 * bio_copy_kern - copy kernel address into bio
1254 * @q: the struct request_queue for the bio
1255 * @data: pointer to buffer to copy
1256 * @len: length in bytes
1257 * @gfp_mask: allocation flags for bio and page allocation
1258 * @reading: data direction is READ
1259 *
1260 * copy the kernel address into a bio suitable for io to a block
1261 * device. Returns an error pointer in case of error.
1262 */
1263 struct bio *bio_copy_kern(struct request_queue *q, void *data, unsigned int len,
1264 gfp_t gfp_mask, int reading)
1265 {
1266 struct bio *bio;
1267 struct bio_vec *bvec;
1268 int i;
1269
1270 bio = bio_copy_user(q, NULL, (unsigned long)data, len, 1, gfp_mask);
1271 if (IS_ERR(bio))
1272 return bio;
1273
1274 if (!reading) {
1275 void *p = data;
1276
1277 bio_for_each_segment(bvec, bio, i) {
1278 char *addr = page_address(bvec->bv_page);
1279
1280 memcpy(addr, p, bvec->bv_len);
1281 p += bvec->bv_len;
1282 }
1283 }
1284
1285 bio->bi_end_io = bio_copy_kern_endio;
1286
1287 return bio;
1288 }
1289 EXPORT_SYMBOL(bio_copy_kern);
1290
1291 /*
1292 * bio_set_pages_dirty() and bio_check_pages_dirty() are support functions
1293 * for performing direct-IO in BIOs.
1294 *
1295 * The problem is that we cannot run set_page_dirty() from interrupt context
1296 * because the required locks are not interrupt-safe. So what we can do is to
1297 * mark the pages dirty _before_ performing IO. And in interrupt context,
1298 * check that the pages are still dirty. If so, fine. If not, redirty them
1299 * in process context.
1300 *
1301 * We special-case compound pages here: normally this means reads into hugetlb
1302 * pages. The logic in here doesn't really work right for compound pages
1303 * because the VM does not uniformly chase down the head page in all cases.
1304 * But dirtiness of compound pages is pretty meaningless anyway: the VM doesn't
1305 * handle them at all. So we skip compound pages here at an early stage.
1306 *
1307 * Note that this code is very hard to test under normal circumstances because
1308 * direct-io pins the pages with get_user_pages(). This makes
1309 * is_page_cache_freeable return false, and the VM will not clean the pages.
1310 * But other code (eg, pdflush) could clean the pages if they are mapped
1311 * pagecache.
1312 *
1313 * Simply disabling the call to bio_set_pages_dirty() is a good way to test the
1314 * deferred bio dirtying paths.
1315 */
1316
1317 /*
1318 * bio_set_pages_dirty() will mark all the bio's pages as dirty.
1319 */
1320 void bio_set_pages_dirty(struct bio *bio)
1321 {
1322 struct bio_vec *bvec = bio->bi_io_vec;
1323 int i;
1324
1325 for (i = 0; i < bio->bi_vcnt; i++) {
1326 struct page *page = bvec[i].bv_page;
1327
1328 if (page && !PageCompound(page))
1329 set_page_dirty_lock(page);
1330 }
1331 }
1332
1333 static void bio_release_pages(struct bio *bio)
1334 {
1335 struct bio_vec *bvec = bio->bi_io_vec;
1336 int i;
1337
1338 for (i = 0; i < bio->bi_vcnt; i++) {
1339 struct page *page = bvec[i].bv_page;
1340
1341 if (page)
1342 put_page(page);
1343 }
1344 }
1345
1346 /*
1347 * bio_check_pages_dirty() will check that all the BIO's pages are still dirty.
1348 * If they are, then fine. If, however, some pages are clean then they must
1349 * have been written out during the direct-IO read. So we take another ref on
1350 * the BIO and the offending pages and re-dirty the pages in process context.
1351 *
1352 * It is expected that bio_check_pages_dirty() will wholly own the BIO from
1353 * here on. It will run one page_cache_release() against each page and will
1354 * run one bio_put() against the BIO.
1355 */
1356
1357 static void bio_dirty_fn(struct work_struct *work);
1358
1359 static DECLARE_WORK(bio_dirty_work, bio_dirty_fn);
1360 static DEFINE_SPINLOCK(bio_dirty_lock);
1361 static struct bio *bio_dirty_list;
1362
1363 /*
1364 * This runs in process context
1365 */
1366 static void bio_dirty_fn(struct work_struct *work)
1367 {
1368 unsigned long flags;
1369 struct bio *bio;
1370
1371 spin_lock_irqsave(&bio_dirty_lock, flags);
1372 bio = bio_dirty_list;
1373 bio_dirty_list = NULL;
1374 spin_unlock_irqrestore(&bio_dirty_lock, flags);
1375
1376 while (bio) {
1377 struct bio *next = bio->bi_private;
1378
1379 bio_set_pages_dirty(bio);
1380 bio_release_pages(bio);
1381 bio_put(bio);
1382 bio = next;
1383 }
1384 }
1385
1386 void bio_check_pages_dirty(struct bio *bio)
1387 {
1388 struct bio_vec *bvec = bio->bi_io_vec;
1389 int nr_clean_pages = 0;
1390 int i;
1391
1392 for (i = 0; i < bio->bi_vcnt; i++) {
1393 struct page *page = bvec[i].bv_page;
1394
1395 if (PageDirty(page) || PageCompound(page)) {
1396 page_cache_release(page);
1397 bvec[i].bv_page = NULL;
1398 } else {
1399 nr_clean_pages++;
1400 }
1401 }
1402
1403 if (nr_clean_pages) {
1404 unsigned long flags;
1405
1406 spin_lock_irqsave(&bio_dirty_lock, flags);
1407 bio->bi_private = bio_dirty_list;
1408 bio_dirty_list = bio;
1409 spin_unlock_irqrestore(&bio_dirty_lock, flags);
1410 schedule_work(&bio_dirty_work);
1411 } else {
1412 bio_put(bio);
1413 }
1414 }
1415
1416 #if ARCH_IMPLEMENTS_FLUSH_DCACHE_PAGE
1417 void bio_flush_dcache_pages(struct bio *bi)
1418 {
1419 int i;
1420 struct bio_vec *bvec;
1421
1422 bio_for_each_segment(bvec, bi, i)
1423 flush_dcache_page(bvec->bv_page);
1424 }
1425 EXPORT_SYMBOL(bio_flush_dcache_pages);
1426 #endif
1427
1428 /**
1429 * bio_endio - end I/O on a bio
1430 * @bio: bio
1431 * @error: error, if any
1432 *
1433 * Description:
1434 * bio_endio() will end I/O on the whole bio. bio_endio() is the
1435 * preferred way to end I/O on a bio, it takes care of clearing
1436 * BIO_UPTODATE on error. @error is 0 on success, and and one of the
1437 * established -Exxxx (-EIO, for instance) error values in case
1438 * something went wrong. No one should call bi_end_io() directly on a
1439 * bio unless they own it and thus know that it has an end_io
1440 * function.
1441 **/
1442 void bio_endio(struct bio *bio, int error)
1443 {
1444 if (error)
1445 clear_bit(BIO_UPTODATE, &bio->bi_flags);
1446 else if (!test_bit(BIO_UPTODATE, &bio->bi_flags))
1447 error = -EIO;
1448
1449 if (bio->bi_end_io)
1450 bio->bi_end_io(bio, error);
1451 }
1452 EXPORT_SYMBOL(bio_endio);
1453
1454 void bio_pair_release(struct bio_pair *bp)
1455 {
1456 if (atomic_dec_and_test(&bp->cnt)) {
1457 struct bio *master = bp->bio1.bi_private;
1458
1459 bio_endio(master, bp->error);
1460 mempool_free(bp, bp->bio2.bi_private);
1461 }
1462 }
1463 EXPORT_SYMBOL(bio_pair_release);
1464
1465 static void bio_pair_end_1(struct bio *bi, int err)
1466 {
1467 struct bio_pair *bp = container_of(bi, struct bio_pair, bio1);
1468
1469 if (err)
1470 bp->error = err;
1471
1472 bio_pair_release(bp);
1473 }
1474
1475 static void bio_pair_end_2(struct bio *bi, int err)
1476 {
1477 struct bio_pair *bp = container_of(bi, struct bio_pair, bio2);
1478
1479 if (err)
1480 bp->error = err;
1481
1482 bio_pair_release(bp);
1483 }
1484
1485 /*
1486 * split a bio - only worry about a bio with a single page in its iovec
1487 */
1488 struct bio_pair *bio_split(struct bio *bi, int first_sectors)
1489 {
1490 struct bio_pair *bp = mempool_alloc(bio_split_pool, GFP_NOIO);
1491
1492 if (!bp)
1493 return bp;
1494
1495 trace_block_split(bdev_get_queue(bi->bi_bdev), bi,
1496 bi->bi_sector + first_sectors);
1497
1498 BUG_ON(bi->bi_vcnt != 1);
1499 BUG_ON(bi->bi_idx != 0);
1500 atomic_set(&bp->cnt, 3);
1501 bp->error = 0;
1502 bp->bio1 = *bi;
1503 bp->bio2 = *bi;
1504 bp->bio2.bi_sector += first_sectors;
1505 bp->bio2.bi_size -= first_sectors << 9;
1506 bp->bio1.bi_size = first_sectors << 9;
1507
1508 bp->bv1 = bi->bi_io_vec[0];
1509 bp->bv2 = bi->bi_io_vec[0];
1510 bp->bv2.bv_offset += first_sectors << 9;
1511 bp->bv2.bv_len -= first_sectors << 9;
1512 bp->bv1.bv_len = first_sectors << 9;
1513
1514 bp->bio1.bi_io_vec = &bp->bv1;
1515 bp->bio2.bi_io_vec = &bp->bv2;
1516
1517 bp->bio1.bi_max_vecs = 1;
1518 bp->bio2.bi_max_vecs = 1;
1519
1520 bp->bio1.bi_end_io = bio_pair_end_1;
1521 bp->bio2.bi_end_io = bio_pair_end_2;
1522
1523 bp->bio1.bi_private = bi;
1524 bp->bio2.bi_private = bio_split_pool;
1525
1526 if (bio_integrity(bi))
1527 bio_integrity_split(bi, bp, first_sectors);
1528
1529 return bp;
1530 }
1531 EXPORT_SYMBOL(bio_split);
1532
1533 /**
1534 * bio_sector_offset - Find hardware sector offset in bio
1535 * @bio: bio to inspect
1536 * @index: bio_vec index
1537 * @offset: offset in bv_page
1538 *
1539 * Return the number of hardware sectors between beginning of bio
1540 * and an end point indicated by a bio_vec index and an offset
1541 * within that vector's page.
1542 */
1543 sector_t bio_sector_offset(struct bio *bio, unsigned short index,
1544 unsigned int offset)
1545 {
1546 unsigned int sector_sz;
1547 struct bio_vec *bv;
1548 sector_t sectors;
1549 int i;
1550
1551 sector_sz = queue_logical_block_size(bio->bi_bdev->bd_disk->queue);
1552 sectors = 0;
1553
1554 if (index >= bio->bi_idx)
1555 index = bio->bi_vcnt - 1;
1556
1557 __bio_for_each_segment(bv, bio, i, 0) {
1558 if (i == index) {
1559 if (offset > bv->bv_offset)
1560 sectors += (offset - bv->bv_offset) / sector_sz;
1561 break;
1562 }
1563
1564 sectors += bv->bv_len / sector_sz;
1565 }
1566
1567 return sectors;
1568 }
1569 EXPORT_SYMBOL(bio_sector_offset);
1570
1571 /*
1572 * create memory pools for biovec's in a bio_set.
1573 * use the global biovec slabs created for general use.
1574 */
1575 static int biovec_create_pools(struct bio_set *bs, int pool_entries)
1576 {
1577 struct biovec_slab *bp = bvec_slabs + BIOVEC_MAX_IDX;
1578
1579 bs->bvec_pool = mempool_create_slab_pool(pool_entries, bp->slab);
1580 if (!bs->bvec_pool)
1581 return -ENOMEM;
1582
1583 return 0;
1584 }
1585
1586 static void biovec_free_pools(struct bio_set *bs)
1587 {
1588 mempool_destroy(bs->bvec_pool);
1589 }
1590
1591 void bioset_free(struct bio_set *bs)
1592 {
1593 if (bs->bio_pool)
1594 mempool_destroy(bs->bio_pool);
1595
1596 bioset_integrity_free(bs);
1597 biovec_free_pools(bs);
1598 bio_put_slab(bs);
1599
1600 kfree(bs);
1601 }
1602 EXPORT_SYMBOL(bioset_free);
1603
1604 /**
1605 * bioset_create - Create a bio_set
1606 * @pool_size: Number of bio and bio_vecs to cache in the mempool
1607 * @front_pad: Number of bytes to allocate in front of the returned bio
1608 *
1609 * Description:
1610 * Set up a bio_set to be used with @bio_alloc_bioset. Allows the caller
1611 * to ask for a number of bytes to be allocated in front of the bio.
1612 * Front pad allocation is useful for embedding the bio inside
1613 * another structure, to avoid allocating extra data to go with the bio.
1614 * Note that the bio must be embedded at the END of that structure always,
1615 * or things will break badly.
1616 */
1617 struct bio_set *bioset_create(unsigned int pool_size, unsigned int front_pad)
1618 {
1619 unsigned int back_pad = BIO_INLINE_VECS * sizeof(struct bio_vec);
1620 struct bio_set *bs;
1621
1622 bs = kzalloc(sizeof(*bs), GFP_KERNEL);
1623 if (!bs)
1624 return NULL;
1625
1626 bs->front_pad = front_pad;
1627
1628 bs->bio_slab = bio_find_or_create_slab(front_pad + back_pad);
1629 if (!bs->bio_slab) {
1630 kfree(bs);
1631 return NULL;
1632 }
1633
1634 bs->bio_pool = mempool_create_slab_pool(pool_size, bs->bio_slab);
1635 if (!bs->bio_pool)
1636 goto bad;
1637
1638 if (!biovec_create_pools(bs, pool_size))
1639 return bs;
1640
1641 bad:
1642 bioset_free(bs);
1643 return NULL;
1644 }
1645 EXPORT_SYMBOL(bioset_create);
1646
1647 static void __init biovec_init_slabs(void)
1648 {
1649 int i;
1650
1651 for (i = 0; i < BIOVEC_NR_POOLS; i++) {
1652 int size;
1653 struct biovec_slab *bvs = bvec_slabs + i;
1654
1655 if (bvs->nr_vecs <= BIO_INLINE_VECS) {
1656 bvs->slab = NULL;
1657 continue;
1658 }
1659
1660 size = bvs->nr_vecs * sizeof(struct bio_vec);
1661 bvs->slab = kmem_cache_create(bvs->name, size, 0,
1662 SLAB_HWCACHE_ALIGN|SLAB_PANIC, NULL);
1663 }
1664 }
1665
1666 static int __init init_bio(void)
1667 {
1668 bio_slab_max = 2;
1669 bio_slab_nr = 0;
1670 bio_slabs = kzalloc(bio_slab_max * sizeof(struct bio_slab), GFP_KERNEL);
1671 if (!bio_slabs)
1672 panic("bio: can't allocate bios\n");
1673
1674 bio_integrity_init();
1675 biovec_init_slabs();
1676
1677 fs_bio_set = bioset_create(BIO_POOL_SIZE, 0);
1678 if (!fs_bio_set)
1679 panic("bio: can't allocate bios\n");
1680
1681 if (bioset_integrity_create(fs_bio_set, BIO_POOL_SIZE))
1682 panic("bio: can't create integrity pool\n");
1683
1684 bio_split_pool = mempool_create_kmalloc_pool(BIO_SPLIT_ENTRIES,
1685 sizeof(struct bio_pair));
1686 if (!bio_split_pool)
1687 panic("bio: can't create split pool\n");
1688
1689 return 0;
1690 }
1691 subsys_initcall(init_bio);