Merge branch 'fix/hda' into for-linus
[platform/adaptation/renesas_rcar/renesas_kernel.git] / mm / bounce.c
1 /* bounce buffer handling for block devices
2  *
3  * - Split from highmem.c
4  */
5
6 #include <linux/mm.h>
7 #include <linux/module.h>
8 #include <linux/swap.h>
9 #include <linux/gfp.h>
10 #include <linux/bio.h>
11 #include <linux/pagemap.h>
12 #include <linux/mempool.h>
13 #include <linux/blkdev.h>
14 #include <linux/init.h>
15 #include <linux/hash.h>
16 #include <linux/highmem.h>
17 #include <asm/tlbflush.h>
18
19 #include <trace/events/block.h>
20
21 #define POOL_SIZE       64
22 #define ISA_POOL_SIZE   16
23
24 static mempool_t *page_pool, *isa_page_pool;
25
26 #ifdef CONFIG_HIGHMEM
27 static __init int init_emergency_pool(void)
28 {
29         struct sysinfo i;
30         si_meminfo(&i);
31         si_swapinfo(&i);
32
33         if (!i.totalhigh)
34                 return 0;
35
36         page_pool = mempool_create_page_pool(POOL_SIZE, 0);
37         BUG_ON(!page_pool);
38         printk("highmem bounce pool size: %d pages\n", POOL_SIZE);
39
40         return 0;
41 }
42
43 __initcall(init_emergency_pool);
44
45 /*
46  * highmem version, map in to vec
47  */
48 static void bounce_copy_vec(struct bio_vec *to, unsigned char *vfrom)
49 {
50         unsigned long flags;
51         unsigned char *vto;
52
53         local_irq_save(flags);
54         vto = kmap_atomic(to->bv_page, KM_BOUNCE_READ);
55         memcpy(vto + to->bv_offset, vfrom, to->bv_len);
56         kunmap_atomic(vto, KM_BOUNCE_READ);
57         local_irq_restore(flags);
58 }
59
60 #else /* CONFIG_HIGHMEM */
61
62 #define bounce_copy_vec(to, vfrom)      \
63         memcpy(page_address((to)->bv_page) + (to)->bv_offset, vfrom, (to)->bv_len)
64
65 #endif /* CONFIG_HIGHMEM */
66
67 /*
68  * allocate pages in the DMA region for the ISA pool
69  */
70 static void *mempool_alloc_pages_isa(gfp_t gfp_mask, void *data)
71 {
72         return mempool_alloc_pages(gfp_mask | GFP_DMA, data);
73 }
74
75 /*
76  * gets called "every" time someone init's a queue with BLK_BOUNCE_ISA
77  * as the max address, so check if the pool has already been created.
78  */
79 int init_emergency_isa_pool(void)
80 {
81         if (isa_page_pool)
82                 return 0;
83
84         isa_page_pool = mempool_create(ISA_POOL_SIZE, mempool_alloc_pages_isa,
85                                        mempool_free_pages, (void *) 0);
86         BUG_ON(!isa_page_pool);
87
88         printk("isa bounce pool size: %d pages\n", ISA_POOL_SIZE);
89         return 0;
90 }
91
92 /*
93  * Simple bounce buffer support for highmem pages. Depending on the
94  * queue gfp mask set, *to may or may not be a highmem page. kmap it
95  * always, it will do the Right Thing
96  */
97 static void copy_to_high_bio_irq(struct bio *to, struct bio *from)
98 {
99         unsigned char *vfrom;
100         struct bio_vec *tovec, *fromvec;
101         int i;
102
103         __bio_for_each_segment(tovec, to, i, 0) {
104                 fromvec = from->bi_io_vec + i;
105
106                 /*
107                  * not bounced
108                  */
109                 if (tovec->bv_page == fromvec->bv_page)
110                         continue;
111
112                 /*
113                  * fromvec->bv_offset and fromvec->bv_len might have been
114                  * modified by the block layer, so use the original copy,
115                  * bounce_copy_vec already uses tovec->bv_len
116                  */
117                 vfrom = page_address(fromvec->bv_page) + tovec->bv_offset;
118
119                 flush_dcache_page(tovec->bv_page);
120                 bounce_copy_vec(tovec, vfrom);
121         }
122 }
123
124 static void bounce_end_io(struct bio *bio, mempool_t *pool, int err)
125 {
126         struct bio *bio_orig = bio->bi_private;
127         struct bio_vec *bvec, *org_vec;
128         int i;
129
130         if (test_bit(BIO_EOPNOTSUPP, &bio->bi_flags))
131                 set_bit(BIO_EOPNOTSUPP, &bio_orig->bi_flags);
132
133         /*
134          * free up bounce indirect pages used
135          */
136         __bio_for_each_segment(bvec, bio, i, 0) {
137                 org_vec = bio_orig->bi_io_vec + i;
138                 if (bvec->bv_page == org_vec->bv_page)
139                         continue;
140
141                 dec_zone_page_state(bvec->bv_page, NR_BOUNCE);
142                 mempool_free(bvec->bv_page, pool);
143         }
144
145         bio_endio(bio_orig, err);
146         bio_put(bio);
147 }
148
149 static void bounce_end_io_write(struct bio *bio, int err)
150 {
151         bounce_end_io(bio, page_pool, err);
152 }
153
154 static void bounce_end_io_write_isa(struct bio *bio, int err)
155 {
156
157         bounce_end_io(bio, isa_page_pool, err);
158 }
159
160 static void __bounce_end_io_read(struct bio *bio, mempool_t *pool, int err)
161 {
162         struct bio *bio_orig = bio->bi_private;
163
164         if (test_bit(BIO_UPTODATE, &bio->bi_flags))
165                 copy_to_high_bio_irq(bio_orig, bio);
166
167         bounce_end_io(bio, pool, err);
168 }
169
170 static void bounce_end_io_read(struct bio *bio, int err)
171 {
172         __bounce_end_io_read(bio, page_pool, err);
173 }
174
175 static void bounce_end_io_read_isa(struct bio *bio, int err)
176 {
177         __bounce_end_io_read(bio, isa_page_pool, err);
178 }
179
180 static void __blk_queue_bounce(struct request_queue *q, struct bio **bio_orig,
181                                mempool_t *pool)
182 {
183         struct page *page;
184         struct bio *bio = NULL;
185         int i, rw = bio_data_dir(*bio_orig);
186         struct bio_vec *to, *from;
187
188         bio_for_each_segment(from, *bio_orig, i) {
189                 page = from->bv_page;
190
191                 /*
192                  * is destination page below bounce pfn?
193                  */
194                 if (page_to_pfn(page) <= queue_bounce_pfn(q))
195                         continue;
196
197                 /*
198                  * irk, bounce it
199                  */
200                 if (!bio) {
201                         unsigned int cnt = (*bio_orig)->bi_vcnt;
202
203                         bio = bio_alloc(GFP_NOIO, cnt);
204                         memset(bio->bi_io_vec, 0, cnt * sizeof(struct bio_vec));
205                 }
206                         
207
208                 to = bio->bi_io_vec + i;
209
210                 to->bv_page = mempool_alloc(pool, q->bounce_gfp);
211                 to->bv_len = from->bv_len;
212                 to->bv_offset = from->bv_offset;
213                 inc_zone_page_state(to->bv_page, NR_BOUNCE);
214
215                 if (rw == WRITE) {
216                         char *vto, *vfrom;
217
218                         flush_dcache_page(from->bv_page);
219                         vto = page_address(to->bv_page) + to->bv_offset;
220                         vfrom = kmap(from->bv_page) + from->bv_offset;
221                         memcpy(vto, vfrom, to->bv_len);
222                         kunmap(from->bv_page);
223                 }
224         }
225
226         /*
227          * no pages bounced
228          */
229         if (!bio)
230                 return;
231
232         trace_block_bio_bounce(q, *bio_orig);
233
234         /*
235          * at least one page was bounced, fill in possible non-highmem
236          * pages
237          */
238         __bio_for_each_segment(from, *bio_orig, i, 0) {
239                 to = bio_iovec_idx(bio, i);
240                 if (!to->bv_page) {
241                         to->bv_page = from->bv_page;
242                         to->bv_len = from->bv_len;
243                         to->bv_offset = from->bv_offset;
244                 }
245         }
246
247         bio->bi_bdev = (*bio_orig)->bi_bdev;
248         bio->bi_flags |= (1 << BIO_BOUNCED);
249         bio->bi_sector = (*bio_orig)->bi_sector;
250         bio->bi_rw = (*bio_orig)->bi_rw;
251
252         bio->bi_vcnt = (*bio_orig)->bi_vcnt;
253         bio->bi_idx = (*bio_orig)->bi_idx;
254         bio->bi_size = (*bio_orig)->bi_size;
255
256         if (pool == page_pool) {
257                 bio->bi_end_io = bounce_end_io_write;
258                 if (rw == READ)
259                         bio->bi_end_io = bounce_end_io_read;
260         } else {
261                 bio->bi_end_io = bounce_end_io_write_isa;
262                 if (rw == READ)
263                         bio->bi_end_io = bounce_end_io_read_isa;
264         }
265
266         bio->bi_private = *bio_orig;
267         *bio_orig = bio;
268 }
269
270 void blk_queue_bounce(struct request_queue *q, struct bio **bio_orig)
271 {
272         mempool_t *pool;
273
274         /*
275          * Data-less bio, nothing to bounce
276          */
277         if (!bio_has_data(*bio_orig))
278                 return;
279
280         /*
281          * for non-isa bounce case, just check if the bounce pfn is equal
282          * to or bigger than the highest pfn in the system -- in that case,
283          * don't waste time iterating over bio segments
284          */
285         if (!(q->bounce_gfp & GFP_DMA)) {
286                 if (queue_bounce_pfn(q) >= blk_max_pfn)
287                         return;
288                 pool = page_pool;
289         } else {
290                 BUG_ON(!isa_page_pool);
291                 pool = isa_page_pool;
292         }
293
294         /*
295          * slow path
296          */
297         __blk_queue_bounce(q, bio_orig, pool);
298 }
299
300 EXPORT_SYMBOL(blk_queue_bounce);