Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 1 | /* |
| 2 | * Ram backed block device driver. |
| 3 | * |
| 4 | * Copyright (C) 2007 Nick Piggin |
| 5 | * Copyright (C) 2007 Novell Inc. |
| 6 | * |
| 7 | * Parts derived from drivers/block/rd.c, and drivers/block/loop.c, copyright |
| 8 | * of their respective owners. |
| 9 | */ |
| 10 | |
| 11 | #include <linux/init.h> |
| 12 | #include <linux/module.h> |
| 13 | #include <linux/moduleparam.h> |
| 14 | #include <linux/major.h> |
| 15 | #include <linux/blkdev.h> |
| 16 | #include <linux/bio.h> |
| 17 | #include <linux/highmem.h> |
Arnd Bergmann | 2a48fc0 | 2010-06-02 14:28:52 +0200 | [diff] [blame] | 18 | #include <linux/mutex.h> |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 19 | #include <linux/radix-tree.h> |
Al Viro | ff01bb4 | 2011-09-16 02:31:11 -0400 | [diff] [blame] | 20 | #include <linux/fs.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 21 | #include <linux/slab.h> |
Dan Williams | 34c0fd5 | 2016-01-15 16:56:14 -0800 | [diff] [blame] | 22 | #ifdef CONFIG_BLK_DEV_RAM_DAX |
| 23 | #include <linux/pfn_t.h> |
| 24 | #endif |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 25 | |
| 26 | #include <asm/uaccess.h> |
| 27 | |
| 28 | #define SECTOR_SHIFT 9 |
| 29 | #define PAGE_SECTORS_SHIFT (PAGE_SHIFT - SECTOR_SHIFT) |
| 30 | #define PAGE_SECTORS (1 << PAGE_SECTORS_SHIFT) |
| 31 | |
| 32 | /* |
| 33 | * Each block ramdisk device has a radix_tree brd_pages of pages that stores |
| 34 | * the pages containing the block device's contents. A brd page's ->index is |
| 35 | * its offset in PAGE_SIZE units. This is similar to, but in no way connected |
| 36 | * with, the kernel's pagecache or buffer cache (which sit above our block |
| 37 | * device). |
| 38 | */ |
| 39 | struct brd_device { |
| 40 | int brd_number; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 41 | |
| 42 | struct request_queue *brd_queue; |
| 43 | struct gendisk *brd_disk; |
| 44 | struct list_head brd_list; |
| 45 | |
| 46 | /* |
| 47 | * Backing store of pages and lock to protect it. This is the contents |
| 48 | * of the block device. |
| 49 | */ |
| 50 | spinlock_t brd_lock; |
| 51 | struct radix_tree_root brd_pages; |
| 52 | }; |
| 53 | |
| 54 | /* |
| 55 | * Look up and return a brd's page for a given sector. |
| 56 | */ |
Arnd Bergmann | 2a48fc0 | 2010-06-02 14:28:52 +0200 | [diff] [blame] | 57 | static DEFINE_MUTEX(brd_mutex); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 58 | static struct page *brd_lookup_page(struct brd_device *brd, sector_t sector) |
| 59 | { |
| 60 | pgoff_t idx; |
| 61 | struct page *page; |
| 62 | |
| 63 | /* |
| 64 | * The page lifetime is protected by the fact that we have opened the |
| 65 | * device node -- brd pages will never be deleted under us, so we |
| 66 | * don't need any further locking or refcounting. |
| 67 | * |
| 68 | * This is strictly true for the radix-tree nodes as well (ie. we |
| 69 | * don't actually need the rcu_read_lock()), however that is not a |
| 70 | * documented feature of the radix-tree API so it is better to be |
| 71 | * safe here (we don't have total exclusion from radix tree updates |
| 72 | * here, only deletes). |
| 73 | */ |
| 74 | rcu_read_lock(); |
| 75 | idx = sector >> PAGE_SECTORS_SHIFT; /* sector to page index */ |
| 76 | page = radix_tree_lookup(&brd->brd_pages, idx); |
| 77 | rcu_read_unlock(); |
| 78 | |
| 79 | BUG_ON(page && page->index != idx); |
| 80 | |
| 81 | return page; |
| 82 | } |
| 83 | |
| 84 | /* |
| 85 | * Look up and return a brd's page for a given sector. |
| 86 | * If one does not exist, allocate an empty page, and insert that. Then |
| 87 | * return it. |
| 88 | */ |
| 89 | static struct page *brd_insert_page(struct brd_device *brd, sector_t sector) |
| 90 | { |
| 91 | pgoff_t idx; |
| 92 | struct page *page; |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 93 | gfp_t gfp_flags; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 94 | |
| 95 | page = brd_lookup_page(brd, sector); |
| 96 | if (page) |
| 97 | return page; |
| 98 | |
| 99 | /* |
| 100 | * Must use NOIO because we don't want to recurse back into the |
| 101 | * block or filesystem layers from page reclaim. |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 102 | * |
Matthew Wilcox | a7a97fc | 2015-02-16 15:59:41 -0800 | [diff] [blame] | 103 | * Cannot support DAX and highmem, because our ->direct_access |
| 104 | * routine for DAX must return memory that is always addressable. |
| 105 | * If DAX was reworked to use pfns and kmap throughout, this |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 106 | * restriction might be able to be lifted. |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 107 | */ |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 108 | gfp_flags = GFP_NOIO | __GFP_ZERO; |
Matthew Wilcox | a7a97fc | 2015-02-16 15:59:41 -0800 | [diff] [blame] | 109 | #ifndef CONFIG_BLK_DEV_RAM_DAX |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 110 | gfp_flags |= __GFP_HIGHMEM; |
| 111 | #endif |
Petr Tesarik | 26defe3 | 2008-04-22 05:36:52 +0200 | [diff] [blame] | 112 | page = alloc_page(gfp_flags); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 113 | if (!page) |
| 114 | return NULL; |
| 115 | |
| 116 | if (radix_tree_preload(GFP_NOIO)) { |
| 117 | __free_page(page); |
| 118 | return NULL; |
| 119 | } |
| 120 | |
| 121 | spin_lock(&brd->brd_lock); |
| 122 | idx = sector >> PAGE_SECTORS_SHIFT; |
Brian Behlendorf | dfd20b2 | 2013-05-24 15:55:28 -0700 | [diff] [blame] | 123 | page->index = idx; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 124 | if (radix_tree_insert(&brd->brd_pages, idx, page)) { |
| 125 | __free_page(page); |
| 126 | page = radix_tree_lookup(&brd->brd_pages, idx); |
| 127 | BUG_ON(!page); |
| 128 | BUG_ON(page->index != idx); |
Brian Behlendorf | dfd20b2 | 2013-05-24 15:55:28 -0700 | [diff] [blame] | 129 | } |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 130 | spin_unlock(&brd->brd_lock); |
| 131 | |
| 132 | radix_tree_preload_end(); |
| 133 | |
| 134 | return page; |
| 135 | } |
| 136 | |
Nick Piggin | b7c3357 | 2010-05-26 15:41:14 +0200 | [diff] [blame] | 137 | static void brd_free_page(struct brd_device *brd, sector_t sector) |
| 138 | { |
| 139 | struct page *page; |
| 140 | pgoff_t idx; |
| 141 | |
| 142 | spin_lock(&brd->brd_lock); |
| 143 | idx = sector >> PAGE_SECTORS_SHIFT; |
| 144 | page = radix_tree_delete(&brd->brd_pages, idx); |
| 145 | spin_unlock(&brd->brd_lock); |
| 146 | if (page) |
| 147 | __free_page(page); |
| 148 | } |
| 149 | |
| 150 | static void brd_zero_page(struct brd_device *brd, sector_t sector) |
| 151 | { |
| 152 | struct page *page; |
| 153 | |
| 154 | page = brd_lookup_page(brd, sector); |
| 155 | if (page) |
| 156 | clear_highpage(page); |
| 157 | } |
| 158 | |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 159 | /* |
| 160 | * Free all backing store pages and radix tree. This must only be called when |
| 161 | * there are no other users of the device. |
| 162 | */ |
| 163 | #define FREE_BATCH 16 |
| 164 | static void brd_free_pages(struct brd_device *brd) |
| 165 | { |
| 166 | unsigned long pos = 0; |
| 167 | struct page *pages[FREE_BATCH]; |
| 168 | int nr_pages; |
| 169 | |
| 170 | do { |
| 171 | int i; |
| 172 | |
| 173 | nr_pages = radix_tree_gang_lookup(&brd->brd_pages, |
| 174 | (void **)pages, pos, FREE_BATCH); |
| 175 | |
| 176 | for (i = 0; i < nr_pages; i++) { |
| 177 | void *ret; |
| 178 | |
| 179 | BUG_ON(pages[i]->index < pos); |
| 180 | pos = pages[i]->index; |
| 181 | ret = radix_tree_delete(&brd->brd_pages, pos); |
| 182 | BUG_ON(!ret || ret != pages[i]); |
| 183 | __free_page(pages[i]); |
| 184 | } |
| 185 | |
| 186 | pos++; |
| 187 | |
| 188 | /* |
| 189 | * This assumes radix_tree_gang_lookup always returns as |
| 190 | * many pages as possible. If the radix-tree code changes, |
| 191 | * so will this have to. |
| 192 | */ |
| 193 | } while (nr_pages == FREE_BATCH); |
| 194 | } |
| 195 | |
| 196 | /* |
| 197 | * copy_to_brd_setup must be called before copy_to_brd. It may sleep. |
| 198 | */ |
| 199 | static int copy_to_brd_setup(struct brd_device *brd, sector_t sector, size_t n) |
| 200 | { |
| 201 | unsigned int offset = (sector & (PAGE_SECTORS-1)) << SECTOR_SHIFT; |
| 202 | size_t copy; |
| 203 | |
| 204 | copy = min_t(size_t, n, PAGE_SIZE - offset); |
| 205 | if (!brd_insert_page(brd, sector)) |
Matthew Wilcox | 96f8d8e | 2014-06-04 16:07:50 -0700 | [diff] [blame] | 206 | return -ENOSPC; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 207 | if (copy < n) { |
| 208 | sector += copy >> SECTOR_SHIFT; |
| 209 | if (!brd_insert_page(brd, sector)) |
Matthew Wilcox | 96f8d8e | 2014-06-04 16:07:50 -0700 | [diff] [blame] | 210 | return -ENOSPC; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 211 | } |
| 212 | return 0; |
| 213 | } |
| 214 | |
Nick Piggin | b7c3357 | 2010-05-26 15:41:14 +0200 | [diff] [blame] | 215 | static void discard_from_brd(struct brd_device *brd, |
| 216 | sector_t sector, size_t n) |
| 217 | { |
| 218 | while (n >= PAGE_SIZE) { |
| 219 | /* |
| 220 | * Don't want to actually discard pages here because |
| 221 | * re-allocating the pages can result in writeback |
| 222 | * deadlocks under heavy load. |
| 223 | */ |
| 224 | if (0) |
| 225 | brd_free_page(brd, sector); |
| 226 | else |
| 227 | brd_zero_page(brd, sector); |
| 228 | sector += PAGE_SIZE >> SECTOR_SHIFT; |
| 229 | n -= PAGE_SIZE; |
| 230 | } |
| 231 | } |
| 232 | |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 233 | /* |
| 234 | * Copy n bytes from src to the brd starting at sector. Does not sleep. |
| 235 | */ |
| 236 | static void copy_to_brd(struct brd_device *brd, const void *src, |
| 237 | sector_t sector, size_t n) |
| 238 | { |
| 239 | struct page *page; |
| 240 | void *dst; |
| 241 | unsigned int offset = (sector & (PAGE_SECTORS-1)) << SECTOR_SHIFT; |
| 242 | size_t copy; |
| 243 | |
| 244 | copy = min_t(size_t, n, PAGE_SIZE - offset); |
| 245 | page = brd_lookup_page(brd, sector); |
| 246 | BUG_ON(!page); |
| 247 | |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 248 | dst = kmap_atomic(page); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 249 | memcpy(dst + offset, src, copy); |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 250 | kunmap_atomic(dst); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 251 | |
| 252 | if (copy < n) { |
| 253 | src += copy; |
| 254 | sector += copy >> SECTOR_SHIFT; |
| 255 | copy = n - copy; |
| 256 | page = brd_lookup_page(brd, sector); |
| 257 | BUG_ON(!page); |
| 258 | |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 259 | dst = kmap_atomic(page); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 260 | memcpy(dst, src, copy); |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 261 | kunmap_atomic(dst); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 262 | } |
| 263 | } |
| 264 | |
| 265 | /* |
| 266 | * Copy n bytes to dst from the brd starting at sector. Does not sleep. |
| 267 | */ |
| 268 | static void copy_from_brd(void *dst, struct brd_device *brd, |
| 269 | sector_t sector, size_t n) |
| 270 | { |
| 271 | struct page *page; |
| 272 | void *src; |
| 273 | unsigned int offset = (sector & (PAGE_SECTORS-1)) << SECTOR_SHIFT; |
| 274 | size_t copy; |
| 275 | |
| 276 | copy = min_t(size_t, n, PAGE_SIZE - offset); |
| 277 | page = brd_lookup_page(brd, sector); |
| 278 | if (page) { |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 279 | src = kmap_atomic(page); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 280 | memcpy(dst, src + offset, copy); |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 281 | kunmap_atomic(src); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 282 | } else |
| 283 | memset(dst, 0, copy); |
| 284 | |
| 285 | if (copy < n) { |
| 286 | dst += copy; |
| 287 | sector += copy >> SECTOR_SHIFT; |
| 288 | copy = n - copy; |
| 289 | page = brd_lookup_page(brd, sector); |
| 290 | if (page) { |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 291 | src = kmap_atomic(page); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 292 | memcpy(dst, src, copy); |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 293 | kunmap_atomic(src); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 294 | } else |
| 295 | memset(dst, 0, copy); |
| 296 | } |
| 297 | } |
| 298 | |
| 299 | /* |
| 300 | * Process a single bvec of a bio. |
| 301 | */ |
| 302 | static int brd_do_bvec(struct brd_device *brd, struct page *page, |
Jens Axboe | c11f0c0 | 2016-08-05 08:11:04 -0600 | [diff] [blame] | 303 | unsigned int len, unsigned int off, bool is_write, |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 304 | sector_t sector) |
| 305 | { |
| 306 | void *mem; |
| 307 | int err = 0; |
| 308 | |
Jens Axboe | c11f0c0 | 2016-08-05 08:11:04 -0600 | [diff] [blame] | 309 | if (is_write) { |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 310 | err = copy_to_brd_setup(brd, sector, len); |
| 311 | if (err) |
| 312 | goto out; |
| 313 | } |
| 314 | |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 315 | mem = kmap_atomic(page); |
Jens Axboe | c11f0c0 | 2016-08-05 08:11:04 -0600 | [diff] [blame] | 316 | if (!is_write) { |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 317 | copy_from_brd(mem + off, brd, sector, len); |
| 318 | flush_dcache_page(page); |
Nick Piggin | c2572f2 | 2009-04-15 10:32:07 +0200 | [diff] [blame] | 319 | } else { |
| 320 | flush_dcache_page(page); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 321 | copy_to_brd(brd, mem + off, sector, len); |
Nick Piggin | c2572f2 | 2009-04-15 10:32:07 +0200 | [diff] [blame] | 322 | } |
Cong Wang | cfd8005 | 2011-11-25 23:14:18 +0800 | [diff] [blame] | 323 | kunmap_atomic(mem); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 324 | |
| 325 | out: |
| 326 | return err; |
| 327 | } |
| 328 | |
Jens Axboe | dece163 | 2015-11-05 10:41:16 -0700 | [diff] [blame] | 329 | static blk_qc_t brd_make_request(struct request_queue *q, struct bio *bio) |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 330 | { |
| 331 | struct block_device *bdev = bio->bi_bdev; |
| 332 | struct brd_device *brd = bdev->bd_disk->private_data; |
Kent Overstreet | 7988613 | 2013-11-23 17:19:00 -0800 | [diff] [blame] | 333 | struct bio_vec bvec; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 334 | sector_t sector; |
Kent Overstreet | 7988613 | 2013-11-23 17:19:00 -0800 | [diff] [blame] | 335 | struct bvec_iter iter; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 336 | |
Kent Overstreet | 4f024f3 | 2013-10-11 15:44:27 -0700 | [diff] [blame] | 337 | sector = bio->bi_iter.bi_sector; |
Kent Overstreet | f73a1c7 | 2012-09-25 15:05:12 -0700 | [diff] [blame] | 338 | if (bio_end_sector(bio) > get_capacity(bdev->bd_disk)) |
Christoph Hellwig | 4246a0b | 2015-07-20 15:29:37 +0200 | [diff] [blame] | 339 | goto io_error; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 340 | |
Mike Christie | 95fe6c1 | 2016-06-05 14:31:48 -0500 | [diff] [blame] | 341 | if (unlikely(bio_op(bio) == REQ_OP_DISCARD)) { |
Jan Kara | 2dbe549 | 2015-11-04 17:13:39 +0100 | [diff] [blame] | 342 | if (sector & ((PAGE_SIZE >> SECTOR_SHIFT) - 1) || |
Bart Van Assche | 5e4298b | 2015-12-15 16:38:22 +0100 | [diff] [blame] | 343 | bio->bi_iter.bi_size & ~PAGE_MASK) |
Jan Kara | 2dbe549 | 2015-11-04 17:13:39 +0100 | [diff] [blame] | 344 | goto io_error; |
Kent Overstreet | 4f024f3 | 2013-10-11 15:44:27 -0700 | [diff] [blame] | 345 | discard_from_brd(brd, sector, bio->bi_iter.bi_size); |
Nick Piggin | b7c3357 | 2010-05-26 15:41:14 +0200 | [diff] [blame] | 346 | goto out; |
| 347 | } |
| 348 | |
Kent Overstreet | 7988613 | 2013-11-23 17:19:00 -0800 | [diff] [blame] | 349 | bio_for_each_segment(bvec, bio, iter) { |
| 350 | unsigned int len = bvec.bv_len; |
Christoph Hellwig | 4246a0b | 2015-07-20 15:29:37 +0200 | [diff] [blame] | 351 | int err; |
| 352 | |
Jens Axboe | c11f0c0 | 2016-08-05 08:11:04 -0600 | [diff] [blame] | 353 | err = brd_do_bvec(brd, bvec.bv_page, len, bvec.bv_offset, |
| 354 | op_is_write(bio_op(bio)), sector); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 355 | if (err) |
Christoph Hellwig | 4246a0b | 2015-07-20 15:29:37 +0200 | [diff] [blame] | 356 | goto io_error; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 357 | sector += len >> SECTOR_SHIFT; |
| 358 | } |
| 359 | |
| 360 | out: |
Christoph Hellwig | 4246a0b | 2015-07-20 15:29:37 +0200 | [diff] [blame] | 361 | bio_endio(bio); |
Jens Axboe | dece163 | 2015-11-05 10:41:16 -0700 | [diff] [blame] | 362 | return BLK_QC_T_NONE; |
Christoph Hellwig | 4246a0b | 2015-07-20 15:29:37 +0200 | [diff] [blame] | 363 | io_error: |
| 364 | bio_io_error(bio); |
Jens Axboe | dece163 | 2015-11-05 10:41:16 -0700 | [diff] [blame] | 365 | return BLK_QC_T_NONE; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 366 | } |
| 367 | |
Matthew Wilcox | a72132c | 2014-06-04 16:07:49 -0700 | [diff] [blame] | 368 | static int brd_rw_page(struct block_device *bdev, sector_t sector, |
Jens Axboe | c11f0c0 | 2016-08-05 08:11:04 -0600 | [diff] [blame] | 369 | struct page *page, bool is_write) |
Matthew Wilcox | a72132c | 2014-06-04 16:07:49 -0700 | [diff] [blame] | 370 | { |
| 371 | struct brd_device *brd = bdev->bd_disk->private_data; |
Jens Axboe | c11f0c0 | 2016-08-05 08:11:04 -0600 | [diff] [blame] | 372 | int err = brd_do_bvec(brd, page, PAGE_SIZE, 0, is_write, sector); |
| 373 | page_endio(page, is_write, err); |
Matthew Wilcox | a72132c | 2014-06-04 16:07:49 -0700 | [diff] [blame] | 374 | return err; |
| 375 | } |
| 376 | |
Matthew Wilcox | a7a97fc | 2015-02-16 15:59:41 -0800 | [diff] [blame] | 377 | #ifdef CONFIG_BLK_DEV_RAM_DAX |
Matthew Wilcox | dd22f55 | 2015-01-07 18:05:34 +0200 | [diff] [blame] | 378 | static long brd_direct_access(struct block_device *bdev, sector_t sector, |
Dan Williams | 7a9eb20 | 2016-06-03 18:06:47 -0700 | [diff] [blame] | 379 | void **kaddr, pfn_t *pfn, long size) |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 380 | { |
| 381 | struct brd_device *brd = bdev->bd_disk->private_data; |
| 382 | struct page *page; |
| 383 | |
| 384 | if (!brd) |
| 385 | return -ENODEV; |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 386 | page = brd_insert_page(brd, sector); |
| 387 | if (!page) |
Matthew Wilcox | 96f8d8e | 2014-06-04 16:07:50 -0700 | [diff] [blame] | 388 | return -ENOSPC; |
Dan Williams | 7a9eb20 | 2016-06-03 18:06:47 -0700 | [diff] [blame] | 389 | *kaddr = page_address(page); |
Dan Williams | 34c0fd5 | 2016-01-15 16:56:14 -0800 | [diff] [blame] | 390 | *pfn = page_to_pfn_t(page); |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 391 | |
Matthew Wilcox | dd22f55 | 2015-01-07 18:05:34 +0200 | [diff] [blame] | 392 | return PAGE_SIZE; |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 393 | } |
Matthew Wilcox | a7a97fc | 2015-02-16 15:59:41 -0800 | [diff] [blame] | 394 | #else |
| 395 | #define brd_direct_access NULL |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 396 | #endif |
| 397 | |
Al Viro | 2b9ecd0 | 2008-03-02 09:24:35 -0500 | [diff] [blame] | 398 | static int brd_ioctl(struct block_device *bdev, fmode_t mode, |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 399 | unsigned int cmd, unsigned long arg) |
| 400 | { |
| 401 | int error; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 402 | struct brd_device *brd = bdev->bd_disk->private_data; |
| 403 | |
| 404 | if (cmd != BLKFLSBUF) |
| 405 | return -ENOTTY; |
| 406 | |
| 407 | /* |
| 408 | * ram device BLKFLSBUF has special semantics, we want to actually |
| 409 | * release and destroy the ramdisk data. |
| 410 | */ |
Arnd Bergmann | 2a48fc0 | 2010-06-02 14:28:52 +0200 | [diff] [blame] | 411 | mutex_lock(&brd_mutex); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 412 | mutex_lock(&bdev->bd_mutex); |
| 413 | error = -EBUSY; |
| 414 | if (bdev->bd_openers <= 1) { |
| 415 | /* |
Al Viro | ff01bb4 | 2011-09-16 02:31:11 -0400 | [diff] [blame] | 416 | * Kill the cache first, so it isn't written back to the |
| 417 | * device. |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 418 | * |
| 419 | * Another thread might instantiate more buffercache here, |
| 420 | * but there is not much we can do to close that race. |
| 421 | */ |
Al Viro | ff01bb4 | 2011-09-16 02:31:11 -0400 | [diff] [blame] | 422 | kill_bdev(bdev); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 423 | brd_free_pages(brd); |
| 424 | error = 0; |
| 425 | } |
| 426 | mutex_unlock(&bdev->bd_mutex); |
Arnd Bergmann | 2a48fc0 | 2010-06-02 14:28:52 +0200 | [diff] [blame] | 427 | mutex_unlock(&brd_mutex); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 428 | |
| 429 | return error; |
| 430 | } |
| 431 | |
Alexey Dobriyan | 83d5cde | 2009-09-21 17:01:13 -0700 | [diff] [blame] | 432 | static const struct block_device_operations brd_fops = { |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 433 | .owner = THIS_MODULE, |
Matthew Wilcox | a72132c | 2014-06-04 16:07:49 -0700 | [diff] [blame] | 434 | .rw_page = brd_rw_page, |
Arnd Bergmann | 8a6cfeb | 2010-07-08 10:18:46 +0200 | [diff] [blame] | 435 | .ioctl = brd_ioctl, |
Nick Piggin | 75acb9c | 2008-02-08 04:19:50 -0800 | [diff] [blame] | 436 | .direct_access = brd_direct_access, |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 437 | }; |
| 438 | |
| 439 | /* |
| 440 | * And now the modules code and kernel interface. |
| 441 | */ |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 442 | static int rd_nr = CONFIG_BLK_DEV_RAM_COUNT; |
Namhyung Kim | 8892cba | 2011-05-26 21:06:50 +0200 | [diff] [blame] | 443 | module_param(rd_nr, int, S_IRUGO); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 444 | MODULE_PARM_DESC(rd_nr, "Maximum number of brd devices"); |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 445 | |
| 446 | int rd_size = CONFIG_BLK_DEV_RAM_SIZE; |
Namhyung Kim | 8892cba | 2011-05-26 21:06:50 +0200 | [diff] [blame] | 447 | module_param(rd_size, int, S_IRUGO); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 448 | MODULE_PARM_DESC(rd_size, "Size of each RAM disk in kbytes."); |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 449 | |
| 450 | static int max_part = 1; |
Namhyung Kim | 8892cba | 2011-05-26 21:06:50 +0200 | [diff] [blame] | 451 | module_param(max_part, int, S_IRUGO); |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 452 | MODULE_PARM_DESC(max_part, "Num Minors to reserve between devices"); |
| 453 | |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 454 | MODULE_LICENSE("GPL"); |
| 455 | MODULE_ALIAS_BLOCKDEV_MAJOR(RAMDISK_MAJOR); |
Nick Piggin | efedf51 | 2008-06-04 17:18:42 +0200 | [diff] [blame] | 456 | MODULE_ALIAS("rd"); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 457 | |
| 458 | #ifndef MODULE |
| 459 | /* Legacy boot options - nonmodular */ |
| 460 | static int __init ramdisk_size(char *str) |
| 461 | { |
| 462 | rd_size = simple_strtol(str, NULL, 0); |
| 463 | return 1; |
| 464 | } |
Robert P. J. Day | 1adbee5 | 2009-06-10 12:57:08 -0700 | [diff] [blame] | 465 | __setup("ramdisk_size=", ramdisk_size); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 466 | #endif |
| 467 | |
| 468 | /* |
| 469 | * The device scheme is derived from loop.c. Keep them in synch where possible |
| 470 | * (should share code eventually). |
| 471 | */ |
| 472 | static LIST_HEAD(brd_devices); |
| 473 | static DEFINE_MUTEX(brd_devices_mutex); |
| 474 | |
| 475 | static struct brd_device *brd_alloc(int i) |
| 476 | { |
| 477 | struct brd_device *brd; |
| 478 | struct gendisk *disk; |
| 479 | |
| 480 | brd = kzalloc(sizeof(*brd), GFP_KERNEL); |
| 481 | if (!brd) |
| 482 | goto out; |
| 483 | brd->brd_number = i; |
| 484 | spin_lock_init(&brd->brd_lock); |
| 485 | INIT_RADIX_TREE(&brd->brd_pages, GFP_ATOMIC); |
| 486 | |
| 487 | brd->brd_queue = blk_alloc_queue(GFP_KERNEL); |
| 488 | if (!brd->brd_queue) |
| 489 | goto out_free_dev; |
Boaz Harrosh | c8fa317 | 2015-01-07 18:09:38 +0200 | [diff] [blame] | 490 | |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 491 | blk_queue_make_request(brd->brd_queue, brd_make_request); |
Martin K. Petersen | 086fa5f | 2010-02-26 00:20:38 -0500 | [diff] [blame] | 492 | blk_queue_max_hw_sectors(brd->brd_queue, 1024); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 493 | blk_queue_bounce_limit(brd->brd_queue, BLK_BOUNCE_ANY); |
| 494 | |
Boaz Harrosh | c8fa317 | 2015-01-07 18:09:38 +0200 | [diff] [blame] | 495 | /* This is so fdisk will align partitions on 4k, because of |
| 496 | * direct_access API needing 4k alignment, returning a PFN |
| 497 | * (This is only a problem on very small devices <= 4M, |
| 498 | * otherwise fdisk will align on 1M. Regardless this call |
| 499 | * is harmless) |
| 500 | */ |
| 501 | blk_queue_physical_block_size(brd->brd_queue, PAGE_SIZE); |
| 502 | |
Nick Piggin | b7c3357 | 2010-05-26 15:41:14 +0200 | [diff] [blame] | 503 | brd->brd_queue->limits.discard_granularity = PAGE_SIZE; |
Jens Axboe | 2bb4cd5 | 2015-07-14 08:15:12 -0600 | [diff] [blame] | 504 | blk_queue_max_discard_sectors(brd->brd_queue, UINT_MAX); |
Nick Piggin | b7c3357 | 2010-05-26 15:41:14 +0200 | [diff] [blame] | 505 | brd->brd_queue->limits.discard_zeroes_data = 1; |
| 506 | queue_flag_set_unlocked(QUEUE_FLAG_DISCARD, brd->brd_queue); |
Toshi Kani | 163d4ba | 2016-06-23 17:05:50 -0400 | [diff] [blame] | 507 | #ifdef CONFIG_BLK_DEV_RAM_DAX |
| 508 | queue_flag_set_unlocked(QUEUE_FLAG_DAX, brd->brd_queue); |
| 509 | #endif |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 510 | disk = brd->brd_disk = alloc_disk(max_part); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 511 | if (!disk) |
| 512 | goto out_free_queue; |
| 513 | disk->major = RAMDISK_MAJOR; |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 514 | disk->first_minor = i * max_part; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 515 | disk->fops = &brd_fops; |
| 516 | disk->private_data = brd; |
| 517 | disk->queue = brd->brd_queue; |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 518 | disk->flags = GENHD_FL_EXT_DEVT; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 519 | sprintf(disk->disk_name, "ram%d", i); |
| 520 | set_capacity(disk, rd_size * 2); |
| 521 | |
| 522 | return brd; |
| 523 | |
| 524 | out_free_queue: |
| 525 | blk_cleanup_queue(brd->brd_queue); |
| 526 | out_free_dev: |
| 527 | kfree(brd); |
| 528 | out: |
| 529 | return NULL; |
| 530 | } |
| 531 | |
| 532 | static void brd_free(struct brd_device *brd) |
| 533 | { |
| 534 | put_disk(brd->brd_disk); |
| 535 | blk_cleanup_queue(brd->brd_queue); |
| 536 | brd_free_pages(brd); |
| 537 | kfree(brd); |
| 538 | } |
| 539 | |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 540 | static struct brd_device *brd_init_one(int i, bool *new) |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 541 | { |
| 542 | struct brd_device *brd; |
| 543 | |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 544 | *new = false; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 545 | list_for_each_entry(brd, &brd_devices, brd_list) { |
| 546 | if (brd->brd_number == i) |
| 547 | goto out; |
| 548 | } |
| 549 | |
| 550 | brd = brd_alloc(i); |
| 551 | if (brd) { |
| 552 | add_disk(brd->brd_disk); |
| 553 | list_add_tail(&brd->brd_list, &brd_devices); |
| 554 | } |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 555 | *new = true; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 556 | out: |
| 557 | return brd; |
| 558 | } |
| 559 | |
| 560 | static void brd_del_one(struct brd_device *brd) |
| 561 | { |
| 562 | list_del(&brd->brd_list); |
| 563 | del_gendisk(brd->brd_disk); |
| 564 | brd_free(brd); |
| 565 | } |
| 566 | |
| 567 | static struct kobject *brd_probe(dev_t dev, int *part, void *data) |
| 568 | { |
| 569 | struct brd_device *brd; |
| 570 | struct kobject *kobj; |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 571 | bool new; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 572 | |
| 573 | mutex_lock(&brd_devices_mutex); |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 574 | brd = brd_init_one(MINOR(dev) / max_part, &new); |
Mikulas Patocka | a207f59 | 2013-10-14 12:13:24 -0400 | [diff] [blame] | 575 | kobj = brd ? get_disk(brd->brd_disk) : NULL; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 576 | mutex_unlock(&brd_devices_mutex); |
| 577 | |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 578 | if (new) |
| 579 | *part = 0; |
| 580 | |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 581 | return kobj; |
| 582 | } |
| 583 | |
| 584 | static int __init brd_init(void) |
| 585 | { |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 586 | struct brd_device *brd, *next; |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 587 | int i; |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 588 | |
| 589 | /* |
| 590 | * brd module now has a feature to instantiate underlying device |
| 591 | * structure on-demand, provided that there is an access dev node. |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 592 | * |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 593 | * (1) if rd_nr is specified, create that many upfront. else |
| 594 | * it defaults to CONFIG_BLK_DEV_RAM_COUNT |
| 595 | * (2) User can further extend brd devices by create dev node themselves |
| 596 | * and have kernel automatically instantiate actual device |
| 597 | * on-demand. Example: |
| 598 | * mknod /path/devnod_name b 1 X # 1 is the rd major |
| 599 | * fdisk -l /path/devnod_name |
| 600 | * If (X / max_part) was not already created it will be created |
| 601 | * dynamically. |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 602 | */ |
Laurent Vivier | d7853d1 | 2008-04-30 00:55:06 -0700 | [diff] [blame] | 603 | |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 604 | if (register_blkdev(RAMDISK_MAJOR, "ramdisk")) |
| 605 | return -EIO; |
| 606 | |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 607 | if (unlikely(!max_part)) |
| 608 | max_part = 1; |
| 609 | |
| 610 | for (i = 0; i < rd_nr; i++) { |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 611 | brd = brd_alloc(i); |
| 612 | if (!brd) |
| 613 | goto out_free; |
| 614 | list_add_tail(&brd->brd_list, &brd_devices); |
| 615 | } |
| 616 | |
| 617 | /* point of no return */ |
| 618 | |
| 619 | list_for_each_entry(brd, &brd_devices, brd_list) |
| 620 | add_disk(brd->brd_disk); |
| 621 | |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 622 | blk_register_region(MKDEV(RAMDISK_MAJOR, 0), 1UL << MINORBITS, |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 623 | THIS_MODULE, brd_probe, NULL, NULL); |
| 624 | |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 625 | pr_info("brd: module loaded\n"); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 626 | return 0; |
| 627 | |
| 628 | out_free: |
| 629 | list_for_each_entry_safe(brd, next, &brd_devices, brd_list) { |
| 630 | list_del(&brd->brd_list); |
| 631 | brd_free(brd); |
| 632 | } |
Akinobu Mita | c82f296 | 2008-08-20 14:09:09 -0700 | [diff] [blame] | 633 | unregister_blkdev(RAMDISK_MAJOR, "ramdisk"); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 634 | |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 635 | pr_info("brd: module NOT loaded !!!\n"); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 636 | return -ENOMEM; |
| 637 | } |
| 638 | |
| 639 | static void __exit brd_exit(void) |
| 640 | { |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 641 | struct brd_device *brd, *next; |
| 642 | |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 643 | list_for_each_entry_safe(brd, next, &brd_devices, brd_list) |
| 644 | brd_del_one(brd); |
| 645 | |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 646 | blk_unregister_region(MKDEV(RAMDISK_MAJOR, 0), 1UL << MINORBITS); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 647 | unregister_blkdev(RAMDISK_MAJOR, "ramdisk"); |
Boaz Harrosh | 937af5e | 2015-01-07 18:07:56 +0200 | [diff] [blame] | 648 | |
| 649 | pr_info("brd: module unloaded\n"); |
Nick Piggin | 9db5579 | 2008-02-08 04:19:49 -0800 | [diff] [blame] | 650 | } |
| 651 | |
| 652 | module_init(brd_init); |
| 653 | module_exit(brd_exit); |
| 654 | |