Commit | Line | Data |
---|---|---|
f31e7e40 DM |
1 | /* |
2 | * Functions related to generic helpers functions | |
3 | */ | |
4 | #include <linux/kernel.h> | |
5 | #include <linux/module.h> | |
6 | #include <linux/bio.h> | |
7 | #include <linux/blkdev.h> | |
8 | #include <linux/scatterlist.h> | |
9 | ||
10 | #include "blk.h" | |
11 | ||
5dba3089 LC |
12 | struct bio_batch { |
13 | atomic_t done; | |
14 | unsigned long flags; | |
15 | struct completion *wait; | |
16 | }; | |
17 | ||
18 | static void bio_batch_end_io(struct bio *bio, int err) | |
f31e7e40 | 19 | { |
5dba3089 LC |
20 | struct bio_batch *bb = bio->bi_private; |
21 | ||
8af1954d | 22 | if (err && (err != -EOPNOTSUPP)) |
5dba3089 | 23 | clear_bit(BIO_UPTODATE, &bb->flags); |
5dba3089 LC |
24 | if (atomic_dec_and_test(&bb->done)) |
25 | complete(bb->wait); | |
f31e7e40 DM |
26 | bio_put(bio); |
27 | } | |
28 | ||
29 | /** | |
30 | * blkdev_issue_discard - queue a discard | |
31 | * @bdev: blockdev to issue discard for | |
32 | * @sector: start sector | |
33 | * @nr_sects: number of sectors to discard | |
34 | * @gfp_mask: memory allocation flags (for bio_alloc) | |
35 | * @flags: BLKDEV_IFL_* flags to control behaviour | |
36 | * | |
37 | * Description: | |
38 | * Issue a discard request for the sectors in question. | |
39 | */ | |
40 | int blkdev_issue_discard(struct block_device *bdev, sector_t sector, | |
41 | sector_t nr_sects, gfp_t gfp_mask, unsigned long flags) | |
42 | { | |
43 | DECLARE_COMPLETION_ONSTACK(wait); | |
44 | struct request_queue *q = bdev_get_queue(bdev); | |
8c555367 | 45 | int type = REQ_WRITE | REQ_DISCARD; |
8dd2cb7e SL |
46 | sector_t max_discard_sectors; |
47 | sector_t granularity, alignment; | |
5dba3089 | 48 | struct bio_batch bb; |
f31e7e40 | 49 | struct bio *bio; |
f31e7e40 | 50 | int ret = 0; |
0cfbcafc | 51 | struct blk_plug plug; |
f31e7e40 DM |
52 | |
53 | if (!q) | |
54 | return -ENXIO; | |
55 | ||
56 | if (!blk_queue_discard(q)) | |
57 | return -EOPNOTSUPP; | |
58 | ||
f6ff53d3 PB |
59 | /* Zero-sector (unknown) and one-sector granularities are the same. */ |
60 | granularity = max(q->limits.discard_granularity >> 9, 1U); | |
8dd2cb7e SL |
61 | alignment = bdev_discard_alignment(bdev) >> 9; |
62 | alignment = sector_div(alignment, granularity); | |
f6ff53d3 | 63 | |
10d1f9e2 JA |
64 | /* |
65 | * Ensure that max_discard_sectors is of the proper | |
c6e66634 | 66 | * granularity, so that requests stay aligned after a split. |
10d1f9e2 JA |
67 | */ |
68 | max_discard_sectors = min(q->limits.max_discard_sectors, UINT_MAX >> 9); | |
8dd2cb7e SL |
69 | sector_div(max_discard_sectors, granularity); |
70 | max_discard_sectors *= granularity; | |
4c64500e | 71 | if (unlikely(!max_discard_sectors)) { |
0f799603 MS |
72 | /* Avoid infinite loop below. Being cautious never hurts. */ |
73 | return -EOPNOTSUPP; | |
10d1f9e2 | 74 | } |
f31e7e40 | 75 | |
dd3932ed | 76 | if (flags & BLKDEV_DISCARD_SECURE) { |
8d57a98c AH |
77 | if (!blk_queue_secdiscard(q)) |
78 | return -EOPNOTSUPP; | |
8c555367 | 79 | type |= REQ_SECURE; |
8d57a98c AH |
80 | } |
81 | ||
5dba3089 LC |
82 | atomic_set(&bb.done, 1); |
83 | bb.flags = 1 << BIO_UPTODATE; | |
84 | bb.wait = &wait; | |
85 | ||
0cfbcafc | 86 | blk_start_plug(&plug); |
5dba3089 | 87 | while (nr_sects) { |
c6e66634 | 88 | unsigned int req_sects; |
8dd2cb7e | 89 | sector_t end_sect, tmp; |
c6e66634 | 90 | |
f31e7e40 | 91 | bio = bio_alloc(gfp_mask, 1); |
66ac0280 CH |
92 | if (!bio) { |
93 | ret = -ENOMEM; | |
94 | break; | |
95 | } | |
96 | ||
c6e66634 PB |
97 | req_sects = min_t(sector_t, nr_sects, max_discard_sectors); |
98 | ||
99 | /* | |
100 | * If splitting a request, and the next starting sector would be | |
101 | * misaligned, stop the discard at the previous aligned sector. | |
102 | */ | |
103 | end_sect = sector + req_sects; | |
8dd2cb7e SL |
104 | tmp = end_sect; |
105 | if (req_sects < nr_sects && | |
106 | sector_div(tmp, granularity) != alignment) { | |
107 | end_sect = end_sect - alignment; | |
108 | sector_div(end_sect, granularity); | |
109 | end_sect = end_sect * granularity + alignment; | |
c6e66634 PB |
110 | req_sects = end_sect - sector; |
111 | } | |
112 | ||
f31e7e40 | 113 | bio->bi_sector = sector; |
5dba3089 | 114 | bio->bi_end_io = bio_batch_end_io; |
f31e7e40 | 115 | bio->bi_bdev = bdev; |
5dba3089 | 116 | bio->bi_private = &bb; |
f31e7e40 | 117 | |
c6e66634 PB |
118 | bio->bi_size = req_sects << 9; |
119 | nr_sects -= req_sects; | |
120 | sector = end_sect; | |
f31e7e40 | 121 | |
5dba3089 | 122 | atomic_inc(&bb.done); |
f31e7e40 | 123 | submit_bio(type, bio); |
163d66d4 JA |
124 | |
125 | /* | |
126 | * We can loop for a long time in here, if someone does | |
127 | * full device discards (like mkfs). Be nice and allow | |
128 | * us to schedule out to avoid softlocking if preempt | |
129 | * is disabled. | |
130 | */ | |
131 | cond_resched(); | |
5dba3089 | 132 | } |
0cfbcafc | 133 | blk_finish_plug(&plug); |
f31e7e40 | 134 | |
5dba3089 LC |
135 | /* Wait for bios in-flight */ |
136 | if (!atomic_dec_and_test(&bb.done)) | |
5577022f | 137 | wait_for_completion_io(&wait); |
f31e7e40 | 138 | |
8af1954d | 139 | if (!test_bit(BIO_UPTODATE, &bb.flags)) |
5dba3089 | 140 | ret = -EIO; |
66ac0280 | 141 | |
f31e7e40 | 142 | return ret; |
f31e7e40 DM |
143 | } |
144 | EXPORT_SYMBOL(blkdev_issue_discard); | |
3f14d792 | 145 | |
4363ac7c MP |
146 | /** |
147 | * blkdev_issue_write_same - queue a write same operation | |
148 | * @bdev: target blockdev | |
149 | * @sector: start sector | |
150 | * @nr_sects: number of sectors to write | |
151 | * @gfp_mask: memory allocation flags (for bio_alloc) | |
152 | * @page: page containing data to write | |
153 | * | |
154 | * Description: | |
155 | * Issue a write same request for the sectors in question. | |
156 | */ | |
157 | int blkdev_issue_write_same(struct block_device *bdev, sector_t sector, | |
158 | sector_t nr_sects, gfp_t gfp_mask, | |
159 | struct page *page) | |
160 | { | |
161 | DECLARE_COMPLETION_ONSTACK(wait); | |
162 | struct request_queue *q = bdev_get_queue(bdev); | |
163 | unsigned int max_write_same_sectors; | |
164 | struct bio_batch bb; | |
165 | struct bio *bio; | |
166 | int ret = 0; | |
167 | ||
168 | if (!q) | |
169 | return -ENXIO; | |
170 | ||
171 | max_write_same_sectors = q->limits.max_write_same_sectors; | |
172 | ||
173 | if (max_write_same_sectors == 0) | |
174 | return -EOPNOTSUPP; | |
175 | ||
176 | atomic_set(&bb.done, 1); | |
177 | bb.flags = 1 << BIO_UPTODATE; | |
178 | bb.wait = &wait; | |
179 | ||
180 | while (nr_sects) { | |
181 | bio = bio_alloc(gfp_mask, 1); | |
182 | if (!bio) { | |
183 | ret = -ENOMEM; | |
184 | break; | |
185 | } | |
186 | ||
187 | bio->bi_sector = sector; | |
188 | bio->bi_end_io = bio_batch_end_io; | |
189 | bio->bi_bdev = bdev; | |
190 | bio->bi_private = &bb; | |
191 | bio->bi_vcnt = 1; | |
192 | bio->bi_io_vec->bv_page = page; | |
193 | bio->bi_io_vec->bv_offset = 0; | |
194 | bio->bi_io_vec->bv_len = bdev_logical_block_size(bdev); | |
195 | ||
196 | if (nr_sects > max_write_same_sectors) { | |
197 | bio->bi_size = max_write_same_sectors << 9; | |
198 | nr_sects -= max_write_same_sectors; | |
199 | sector += max_write_same_sectors; | |
200 | } else { | |
201 | bio->bi_size = nr_sects << 9; | |
202 | nr_sects = 0; | |
203 | } | |
204 | ||
205 | atomic_inc(&bb.done); | |
206 | submit_bio(REQ_WRITE | REQ_WRITE_SAME, bio); | |
207 | } | |
208 | ||
209 | /* Wait for bios in-flight */ | |
210 | if (!atomic_dec_and_test(&bb.done)) | |
5577022f | 211 | wait_for_completion_io(&wait); |
4363ac7c MP |
212 | |
213 | if (!test_bit(BIO_UPTODATE, &bb.flags)) | |
214 | ret = -ENOTSUPP; | |
215 | ||
216 | return ret; | |
217 | } | |
218 | EXPORT_SYMBOL(blkdev_issue_write_same); | |
219 | ||
3f14d792 | 220 | /** |
291d24f6 | 221 | * blkdev_issue_zeroout - generate number of zero filed write bios |
3f14d792 DM |
222 | * @bdev: blockdev to issue |
223 | * @sector: start sector | |
224 | * @nr_sects: number of sectors to write | |
225 | * @gfp_mask: memory allocation flags (for bio_alloc) | |
3f14d792 DM |
226 | * |
227 | * Description: | |
228 | * Generate and issue number of bios with zerofiled pages. | |
3f14d792 DM |
229 | */ |
230 | ||
579e8f3c | 231 | int __blkdev_issue_zeroout(struct block_device *bdev, sector_t sector, |
dd3932ed | 232 | sector_t nr_sects, gfp_t gfp_mask) |
3f14d792 | 233 | { |
18edc8ea | 234 | int ret; |
3f14d792 DM |
235 | struct bio *bio; |
236 | struct bio_batch bb; | |
0aeea189 | 237 | unsigned int sz; |
3f14d792 DM |
238 | DECLARE_COMPLETION_ONSTACK(wait); |
239 | ||
0aeea189 | 240 | atomic_set(&bb.done, 1); |
3f14d792 DM |
241 | bb.flags = 1 << BIO_UPTODATE; |
242 | bb.wait = &wait; | |
3f14d792 | 243 | |
18edc8ea | 244 | ret = 0; |
3f14d792 DM |
245 | while (nr_sects != 0) { |
246 | bio = bio_alloc(gfp_mask, | |
247 | min(nr_sects, (sector_t)BIO_MAX_PAGES)); | |
18edc8ea DM |
248 | if (!bio) { |
249 | ret = -ENOMEM; | |
3f14d792 | 250 | break; |
18edc8ea | 251 | } |
3f14d792 DM |
252 | |
253 | bio->bi_sector = sector; | |
254 | bio->bi_bdev = bdev; | |
255 | bio->bi_end_io = bio_batch_end_io; | |
dd3932ed | 256 | bio->bi_private = &bb; |
3f14d792 | 257 | |
0341aafb JA |
258 | while (nr_sects != 0) { |
259 | sz = min((sector_t) PAGE_SIZE >> 9 , nr_sects); | |
3f14d792 DM |
260 | ret = bio_add_page(bio, ZERO_PAGE(0), sz << 9, 0); |
261 | nr_sects -= ret >> 9; | |
262 | sector += ret >> 9; | |
263 | if (ret < (sz << 9)) | |
264 | break; | |
265 | } | |
18edc8ea | 266 | ret = 0; |
0aeea189 | 267 | atomic_inc(&bb.done); |
3f14d792 DM |
268 | submit_bio(WRITE, bio); |
269 | } | |
3f14d792 | 270 | |
dd3932ed | 271 | /* Wait for bios in-flight */ |
0aeea189 | 272 | if (!atomic_dec_and_test(&bb.done)) |
5577022f | 273 | wait_for_completion_io(&wait); |
3f14d792 DM |
274 | |
275 | if (!test_bit(BIO_UPTODATE, &bb.flags)) | |
276 | /* One of bios in the batch was completed with error.*/ | |
277 | ret = -EIO; | |
278 | ||
3f14d792 DM |
279 | return ret; |
280 | } | |
579e8f3c MP |
281 | |
282 | /** | |
283 | * blkdev_issue_zeroout - zero-fill a block range | |
284 | * @bdev: blockdev to write | |
285 | * @sector: start sector | |
286 | * @nr_sects: number of sectors to write | |
287 | * @gfp_mask: memory allocation flags (for bio_alloc) | |
288 | * | |
289 | * Description: | |
290 | * Generate and issue number of bios with zerofiled pages. | |
291 | */ | |
292 | ||
293 | int blkdev_issue_zeroout(struct block_device *bdev, sector_t sector, | |
294 | sector_t nr_sects, gfp_t gfp_mask) | |
295 | { | |
296 | if (bdev_write_same(bdev)) { | |
297 | unsigned char bdn[BDEVNAME_SIZE]; | |
298 | ||
299 | if (!blkdev_issue_write_same(bdev, sector, nr_sects, gfp_mask, | |
300 | ZERO_PAGE(0))) | |
301 | return 0; | |
302 | ||
303 | bdevname(bdev, bdn); | |
304 | pr_err("%s: WRITE SAME failed. Manually zeroing.\n", bdn); | |
305 | } | |
306 | ||
307 | return __blkdev_issue_zeroout(bdev, sector, nr_sects, gfp_mask); | |
308 | } | |
3f14d792 | 309 | EXPORT_SYMBOL(blkdev_issue_zeroout); |