1
2
3
4
5#include <linux/kernel.h>
6#include <linux/module.h>
7#include <linux/bio.h>
8#include <linux/blkdev.h>
9#include <linux/scatterlist.h>
10
11#include "blk.h"
12
13struct bio *blk_next_bio(struct bio *bio, unsigned int nr_pages, gfp_t gfp)
14{
15 struct bio *new = bio_alloc(gfp, nr_pages);
16
17 if (bio) {
18 bio_chain(bio, new);
19 submit_bio(bio);
20 }
21
22 return new;
23}
24
25int __blkdev_issue_discard(struct block_device *bdev, sector_t sector,
26 sector_t nr_sects, gfp_t gfp_mask, int flags,
27 struct bio **biop)
28{
29 struct request_queue *q = bdev_get_queue(bdev);
30 struct bio *bio = *biop;
31 unsigned int op;
32 sector_t bs_mask;
33
34 if (!q)
35 return -ENXIO;
36
37 if (bdev_read_only(bdev))
38 return -EPERM;
39
40 if (flags & BLKDEV_DISCARD_SECURE) {
41 if (!blk_queue_secure_erase(q))
42 return -EOPNOTSUPP;
43 op = REQ_OP_SECURE_ERASE;
44 } else {
45 if (!blk_queue_discard(q))
46 return -EOPNOTSUPP;
47 op = REQ_OP_DISCARD;
48 }
49
50 bs_mask = (bdev_logical_block_size(bdev) >> 9) - 1;
51 if ((sector | nr_sects) & bs_mask)
52 return -EINVAL;
53
54 if (!nr_sects)
55 return -EINVAL;
56
57 while (nr_sects) {
58 sector_t req_sects = min_t(sector_t, nr_sects,
59 bio_allowed_max_sectors(q));
60
61 WARN_ON_ONCE((req_sects << 9) > UINT_MAX);
62
63 bio = blk_next_bio(bio, 0, gfp_mask);
64 bio->bi_iter.bi_sector = sector;
65 bio_set_dev(bio, bdev);
66 bio_set_op_attrs(bio, op, 0);
67
68 bio->bi_iter.bi_size = req_sects << 9;
69 sector += req_sects;
70 nr_sects -= req_sects;
71
72
73
74
75
76
77
78 cond_resched();
79 }
80
81 *biop = bio;
82 return 0;
83}
84EXPORT_SYMBOL(__blkdev_issue_discard);
85
86
87
88
89
90
91
92
93
94
95
96
97int blkdev_issue_discard(struct block_device *bdev, sector_t sector,
98 sector_t nr_sects, gfp_t gfp_mask, unsigned long flags)
99{
100 struct bio *bio = NULL;
101 struct blk_plug plug;
102 int ret;
103
104 blk_start_plug(&plug);
105 ret = __blkdev_issue_discard(bdev, sector, nr_sects, gfp_mask, flags,
106 &bio);
107 if (!ret && bio) {
108 ret = submit_bio_wait(bio);
109 if (ret == -EOPNOTSUPP)
110 ret = 0;
111 bio_put(bio);
112 }
113 blk_finish_plug(&plug);
114
115 return ret;
116}
117EXPORT_SYMBOL(blkdev_issue_discard);
118
119
120
121
122
123
124
125
126
127
128
129
130
131static int __blkdev_issue_write_same(struct block_device *bdev, sector_t sector,
132 sector_t nr_sects, gfp_t gfp_mask, struct page *page,
133 struct bio **biop)
134{
135 struct request_queue *q = bdev_get_queue(bdev);
136 unsigned int max_write_same_sectors;
137 struct bio *bio = *biop;
138 sector_t bs_mask;
139
140 if (!q)
141 return -ENXIO;
142
143 if (bdev_read_only(bdev))
144 return -EPERM;
145
146 bs_mask = (bdev_logical_block_size(bdev) >> 9) - 1;
147 if ((sector | nr_sects) & bs_mask)
148 return -EINVAL;
149
150 if (!bdev_write_same(bdev))
151 return -EOPNOTSUPP;
152
153
154 max_write_same_sectors = bio_allowed_max_sectors(q);
155
156 while (nr_sects) {
157 bio = blk_next_bio(bio, 1, gfp_mask);
158 bio->bi_iter.bi_sector = sector;
159 bio_set_dev(bio, bdev);
160 bio->bi_vcnt = 1;
161 bio->bi_io_vec->bv_page = page;
162 bio->bi_io_vec->bv_offset = 0;
163 bio->bi_io_vec->bv_len = bdev_logical_block_size(bdev);
164 bio_set_op_attrs(bio, REQ_OP_WRITE_SAME, 0);
165
166 if (nr_sects > max_write_same_sectors) {
167 bio->bi_iter.bi_size = max_write_same_sectors << 9;
168 nr_sects -= max_write_same_sectors;
169 sector += max_write_same_sectors;
170 } else {
171 bio->bi_iter.bi_size = nr_sects << 9;
172 nr_sects = 0;
173 }
174 cond_resched();
175 }
176
177 *biop = bio;
178 return 0;
179}
180
181
182
183
184
185
186
187
188
189
190
191
192int blkdev_issue_write_same(struct block_device *bdev, sector_t sector,
193 sector_t nr_sects, gfp_t gfp_mask,
194 struct page *page)
195{
196 struct bio *bio = NULL;
197 struct blk_plug plug;
198 int ret;
199
200 blk_start_plug(&plug);
201 ret = __blkdev_issue_write_same(bdev, sector, nr_sects, gfp_mask, page,
202 &bio);
203 if (ret == 0 && bio) {
204 ret = submit_bio_wait(bio);
205 bio_put(bio);
206 }
207 blk_finish_plug(&plug);
208 return ret;
209}
210EXPORT_SYMBOL(blkdev_issue_write_same);
211
212static int __blkdev_issue_write_zeroes(struct block_device *bdev,
213 sector_t sector, sector_t nr_sects, gfp_t gfp_mask,
214 struct bio **biop, unsigned flags)
215{
216 struct bio *bio = *biop;
217 unsigned int max_write_zeroes_sectors;
218 struct request_queue *q = bdev_get_queue(bdev);
219
220 if (!q)
221 return -ENXIO;
222
223 if (bdev_read_only(bdev))
224 return -EPERM;
225
226
227 max_write_zeroes_sectors = bdev_write_zeroes_sectors(bdev);
228
229 if (max_write_zeroes_sectors == 0)
230 return -EOPNOTSUPP;
231
232 while (nr_sects) {
233 bio = blk_next_bio(bio, 0, gfp_mask);
234 bio->bi_iter.bi_sector = sector;
235 bio_set_dev(bio, bdev);
236 bio->bi_opf = REQ_OP_WRITE_ZEROES;
237 if (flags & BLKDEV_ZERO_NOUNMAP)
238 bio->bi_opf |= REQ_NOUNMAP;
239
240 if (nr_sects > max_write_zeroes_sectors) {
241 bio->bi_iter.bi_size = max_write_zeroes_sectors << 9;
242 nr_sects -= max_write_zeroes_sectors;
243 sector += max_write_zeroes_sectors;
244 } else {
245 bio->bi_iter.bi_size = nr_sects << 9;
246 nr_sects = 0;
247 }
248 cond_resched();
249 }
250
251 *biop = bio;
252 return 0;
253}
254
255
256
257
258
259
260
261static unsigned int __blkdev_sectors_to_bio_pages(sector_t nr_sects)
262{
263 sector_t pages = DIV_ROUND_UP_SECTOR_T(nr_sects, PAGE_SIZE / 512);
264
265 return min(pages, (sector_t)BIO_MAX_PAGES);
266}
267
268static int __blkdev_issue_zero_pages(struct block_device *bdev,
269 sector_t sector, sector_t nr_sects, gfp_t gfp_mask,
270 struct bio **biop)
271{
272 struct request_queue *q = bdev_get_queue(bdev);
273 struct bio *bio = *biop;
274 int bi_size = 0;
275 unsigned int sz;
276
277 if (!q)
278 return -ENXIO;
279
280 if (bdev_read_only(bdev))
281 return -EPERM;
282
283 while (nr_sects != 0) {
284 bio = blk_next_bio(bio, __blkdev_sectors_to_bio_pages(nr_sects),
285 gfp_mask);
286 bio->bi_iter.bi_sector = sector;
287 bio_set_dev(bio, bdev);
288 bio_set_op_attrs(bio, REQ_OP_WRITE, 0);
289
290 while (nr_sects != 0) {
291 sz = min((sector_t) PAGE_SIZE, nr_sects << 9);
292 bi_size = bio_add_page(bio, ZERO_PAGE(0), sz, 0);
293 nr_sects -= bi_size >> 9;
294 sector += bi_size >> 9;
295 if (bi_size < sz)
296 break;
297 }
298 cond_resched();
299 }
300
301 *biop = bio;
302 return 0;
303}
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324int __blkdev_issue_zeroout(struct block_device *bdev, sector_t sector,
325 sector_t nr_sects, gfp_t gfp_mask, struct bio **biop,
326 unsigned flags)
327{
328 int ret;
329 sector_t bs_mask;
330
331 bs_mask = (bdev_logical_block_size(bdev) >> 9) - 1;
332 if ((sector | nr_sects) & bs_mask)
333 return -EINVAL;
334
335 ret = __blkdev_issue_write_zeroes(bdev, sector, nr_sects, gfp_mask,
336 biop, flags);
337 if (ret != -EOPNOTSUPP || (flags & BLKDEV_ZERO_NOFALLBACK))
338 return ret;
339
340 return __blkdev_issue_zero_pages(bdev, sector, nr_sects, gfp_mask,
341 biop);
342}
343EXPORT_SYMBOL(__blkdev_issue_zeroout);
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358int blkdev_issue_zeroout(struct block_device *bdev, sector_t sector,
359 sector_t nr_sects, gfp_t gfp_mask, unsigned flags)
360{
361 int ret = 0;
362 sector_t bs_mask;
363 struct bio *bio;
364 struct blk_plug plug;
365 bool try_write_zeroes = !!bdev_write_zeroes_sectors(bdev);
366
367 bs_mask = (bdev_logical_block_size(bdev) >> 9) - 1;
368 if ((sector | nr_sects) & bs_mask)
369 return -EINVAL;
370
371retry:
372 bio = NULL;
373 blk_start_plug(&plug);
374 if (try_write_zeroes) {
375 ret = __blkdev_issue_write_zeroes(bdev, sector, nr_sects,
376 gfp_mask, &bio, flags);
377 } else if (!(flags & BLKDEV_ZERO_NOFALLBACK)) {
378 ret = __blkdev_issue_zero_pages(bdev, sector, nr_sects,
379 gfp_mask, &bio);
380 } else {
381
382 ret = -EOPNOTSUPP;
383 }
384 if (ret == 0 && bio) {
385 ret = submit_bio_wait(bio);
386 bio_put(bio);
387 }
388 blk_finish_plug(&plug);
389 if (ret && try_write_zeroes) {
390 if (!(flags & BLKDEV_ZERO_NOFALLBACK)) {
391 try_write_zeroes = false;
392 goto retry;
393 }
394 if (!bdev_write_zeroes_sectors(bdev)) {
395
396
397
398
399
400
401 ret = -EOPNOTSUPP;
402 }
403 }
404
405 return ret;
406}
407EXPORT_SYMBOL(blkdev_issue_zeroout);
408