OSDN Git Service

Revert "usb: dwc3: turn off VBUS when leaving host mode"
[sagit-ice-cold/kernel_xiaomi_msm8998.git] / block / genhd.c
1 /*
2  *  gendisk handling
3  */
4
5 #include <linux/module.h>
6 #include <linux/fs.h>
7 #include <linux/genhd.h>
8 #include <linux/kdev_t.h>
9 #include <linux/kernel.h>
10 #include <linux/blkdev.h>
11 #include <linux/backing-dev.h>
12 #include <linux/init.h>
13 #include <linux/spinlock.h>
14 #include <linux/proc_fs.h>
15 #include <linux/seq_file.h>
16 #include <linux/slab.h>
17 #include <linux/kmod.h>
18 #include <linux/kobj_map.h>
19 #include <linux/mutex.h>
20 #include <linux/idr.h>
21 #include <linux/log2.h>
22 #include <linux/pm_runtime.h>
23
24 #include "blk.h"
25
26 static DEFINE_MUTEX(block_class_lock);
27 struct kobject *block_depr;
28
29 /* for extended dynamic devt allocation, currently only one major is used */
30 #define NR_EXT_DEVT             (1 << MINORBITS)
31
32 /* For extended devt allocation.  ext_devt_lock prevents look up
33  * results from going away underneath its user.
34  */
35 static DEFINE_SPINLOCK(ext_devt_lock);
36 static DEFINE_IDR(ext_devt_idr);
37
38 static struct device_type disk_type;
39
40 static void disk_check_events(struct disk_events *ev,
41                               unsigned int *clearing_ptr);
42 static void disk_alloc_events(struct gendisk *disk);
43 static void disk_add_events(struct gendisk *disk);
44 static void disk_del_events(struct gendisk *disk);
45 static void disk_release_events(struct gendisk *disk);
46
47 /**
48  * disk_get_part - get partition
49  * @disk: disk to look partition from
50  * @partno: partition number
51  *
52  * Look for partition @partno from @disk.  If found, increment
53  * reference count and return it.
54  *
55  * CONTEXT:
56  * Don't care.
57  *
58  * RETURNS:
59  * Pointer to the found partition on success, NULL if not found.
60  */
61 struct hd_struct *disk_get_part(struct gendisk *disk, int partno)
62 {
63         struct hd_struct *part = NULL;
64         struct disk_part_tbl *ptbl;
65
66         if (unlikely(partno < 0))
67                 return NULL;
68
69         rcu_read_lock();
70
71         ptbl = rcu_dereference(disk->part_tbl);
72         if (likely(partno < ptbl->len)) {
73                 part = rcu_dereference(ptbl->part[partno]);
74                 if (part)
75                         get_device(part_to_dev(part));
76         }
77
78         rcu_read_unlock();
79
80         return part;
81 }
82 EXPORT_SYMBOL_GPL(disk_get_part);
83
84 /**
85  * disk_part_iter_init - initialize partition iterator
86  * @piter: iterator to initialize
87  * @disk: disk to iterate over
88  * @flags: DISK_PITER_* flags
89  *
90  * Initialize @piter so that it iterates over partitions of @disk.
91  *
92  * CONTEXT:
93  * Don't care.
94  */
95 void disk_part_iter_init(struct disk_part_iter *piter, struct gendisk *disk,
96                           unsigned int flags)
97 {
98         struct disk_part_tbl *ptbl;
99
100         rcu_read_lock();
101         ptbl = rcu_dereference(disk->part_tbl);
102
103         piter->disk = disk;
104         piter->part = NULL;
105
106         if (flags & DISK_PITER_REVERSE)
107                 piter->idx = ptbl->len - 1;
108         else if (flags & (DISK_PITER_INCL_PART0 | DISK_PITER_INCL_EMPTY_PART0))
109                 piter->idx = 0;
110         else
111                 piter->idx = 1;
112
113         piter->flags = flags;
114
115         rcu_read_unlock();
116 }
117 EXPORT_SYMBOL_GPL(disk_part_iter_init);
118
119 /**
120  * disk_part_iter_next - proceed iterator to the next partition and return it
121  * @piter: iterator of interest
122  *
123  * Proceed @piter to the next partition and return it.
124  *
125  * CONTEXT:
126  * Don't care.
127  */
128 struct hd_struct *disk_part_iter_next(struct disk_part_iter *piter)
129 {
130         struct disk_part_tbl *ptbl;
131         int inc, end;
132
133         /* put the last partition */
134         disk_put_part(piter->part);
135         piter->part = NULL;
136
137         /* get part_tbl */
138         rcu_read_lock();
139         ptbl = rcu_dereference(piter->disk->part_tbl);
140
141         /* determine iteration parameters */
142         if (piter->flags & DISK_PITER_REVERSE) {
143                 inc = -1;
144                 if (piter->flags & (DISK_PITER_INCL_PART0 |
145                                     DISK_PITER_INCL_EMPTY_PART0))
146                         end = -1;
147                 else
148                         end = 0;
149         } else {
150                 inc = 1;
151                 end = ptbl->len;
152         }
153
154         /* iterate to the next partition */
155         for (; piter->idx != end; piter->idx += inc) {
156                 struct hd_struct *part;
157
158                 part = rcu_dereference(ptbl->part[piter->idx]);
159                 if (!part)
160                         continue;
161                 if (!part_nr_sects_read(part) &&
162                     !(piter->flags & DISK_PITER_INCL_EMPTY) &&
163                     !(piter->flags & DISK_PITER_INCL_EMPTY_PART0 &&
164                       piter->idx == 0))
165                         continue;
166
167                 get_device(part_to_dev(part));
168                 piter->part = part;
169                 piter->idx += inc;
170                 break;
171         }
172
173         rcu_read_unlock();
174
175         return piter->part;
176 }
177 EXPORT_SYMBOL_GPL(disk_part_iter_next);
178
179 /**
180  * disk_part_iter_exit - finish up partition iteration
181  * @piter: iter of interest
182  *
183  * Called when iteration is over.  Cleans up @piter.
184  *
185  * CONTEXT:
186  * Don't care.
187  */
188 void disk_part_iter_exit(struct disk_part_iter *piter)
189 {
190         disk_put_part(piter->part);
191         piter->part = NULL;
192 }
193 EXPORT_SYMBOL_GPL(disk_part_iter_exit);
194
195 static inline int sector_in_part(struct hd_struct *part, sector_t sector)
196 {
197         return part->start_sect <= sector &&
198                 sector < part->start_sect + part_nr_sects_read(part);
199 }
200
201 /**
202  * disk_map_sector_rcu - map sector to partition
203  * @disk: gendisk of interest
204  * @sector: sector to map
205  *
206  * Find out which partition @sector maps to on @disk.  This is
207  * primarily used for stats accounting.
208  *
209  * CONTEXT:
210  * RCU read locked.  The returned partition pointer is valid only
211  * while preemption is disabled.
212  *
213  * RETURNS:
214  * Found partition on success, part0 is returned if no partition matches
215  */
216 struct hd_struct *disk_map_sector_rcu(struct gendisk *disk, sector_t sector)
217 {
218         struct disk_part_tbl *ptbl;
219         struct hd_struct *part;
220         int i;
221
222         ptbl = rcu_dereference(disk->part_tbl);
223
224         part = rcu_dereference(ptbl->last_lookup);
225         if (part && sector_in_part(part, sector))
226                 return part;
227
228         for (i = 1; i < ptbl->len; i++) {
229                 part = rcu_dereference(ptbl->part[i]);
230
231                 if (part && sector_in_part(part, sector)) {
232                         rcu_assign_pointer(ptbl->last_lookup, part);
233                         return part;
234                 }
235         }
236         return &disk->part0;
237 }
238 EXPORT_SYMBOL_GPL(disk_map_sector_rcu);
239
240 /*
241  * Can be deleted altogether. Later.
242  *
243  */
244 static struct blk_major_name {
245         struct blk_major_name *next;
246         int major;
247         char name[16];
248 } *major_names[BLKDEV_MAJOR_HASH_SIZE];
249
250 /* index in the above - for now: assume no multimajor ranges */
251 static inline int major_to_index(unsigned major)
252 {
253         return major % BLKDEV_MAJOR_HASH_SIZE;
254 }
255
256 #ifdef CONFIG_PROC_FS
257 void blkdev_show(struct seq_file *seqf, off_t offset)
258 {
259         struct blk_major_name *dp;
260
261         if (offset < BLKDEV_MAJOR_HASH_SIZE) {
262                 mutex_lock(&block_class_lock);
263                 for (dp = major_names[offset]; dp; dp = dp->next)
264                         seq_printf(seqf, "%3d %s\n", dp->major, dp->name);
265                 mutex_unlock(&block_class_lock);
266         }
267 }
268 #endif /* CONFIG_PROC_FS */
269
270 /**
271  * register_blkdev - register a new block device
272  *
273  * @major: the requested major device number [1..255]. If @major=0, try to
274  *         allocate any unused major number.
275  * @name: the name of the new block device as a zero terminated string
276  *
277  * The @name must be unique within the system.
278  *
279  * The return value depends on the @major input parameter.
280  *  - if a major device number was requested in range [1..255] then the
281  *    function returns zero on success, or a negative error code
282  *  - if any unused major number was requested with @major=0 parameter
283  *    then the return value is the allocated major number in range
284  *    [1..255] or a negative error code otherwise
285  */
286 int register_blkdev(unsigned int major, const char *name)
287 {
288         struct blk_major_name **n, *p;
289         int index, ret = 0;
290
291         mutex_lock(&block_class_lock);
292
293         /* temporary */
294         if (major == 0) {
295                 for (index = ARRAY_SIZE(major_names)-1; index > 0; index--) {
296                         if (major_names[index] == NULL)
297                                 break;
298                 }
299
300                 if (index == 0) {
301                         printk("register_blkdev: failed to get major for %s\n",
302                                name);
303                         ret = -EBUSY;
304                         goto out;
305                 }
306                 major = index;
307                 ret = major;
308         }
309
310         p = kmalloc(sizeof(struct blk_major_name), GFP_KERNEL);
311         if (p == NULL) {
312                 ret = -ENOMEM;
313                 goto out;
314         }
315
316         p->major = major;
317         strlcpy(p->name, name, sizeof(p->name));
318         p->next = NULL;
319         index = major_to_index(major);
320
321         for (n = &major_names[index]; *n; n = &(*n)->next) {
322                 if ((*n)->major == major)
323                         break;
324         }
325         if (!*n)
326                 *n = p;
327         else
328                 ret = -EBUSY;
329
330         if (ret < 0) {
331                 printk("register_blkdev: cannot get major %d for %s\n",
332                        major, name);
333                 kfree(p);
334         }
335 out:
336         mutex_unlock(&block_class_lock);
337         return ret;
338 }
339
340 EXPORT_SYMBOL(register_blkdev);
341
342 void unregister_blkdev(unsigned int major, const char *name)
343 {
344         struct blk_major_name **n;
345         struct blk_major_name *p = NULL;
346         int index = major_to_index(major);
347
348         mutex_lock(&block_class_lock);
349         for (n = &major_names[index]; *n; n = &(*n)->next)
350                 if ((*n)->major == major)
351                         break;
352         if (!*n || strcmp((*n)->name, name)) {
353                 WARN_ON(1);
354         } else {
355                 p = *n;
356                 *n = p->next;
357         }
358         mutex_unlock(&block_class_lock);
359         kfree(p);
360 }
361
362 EXPORT_SYMBOL(unregister_blkdev);
363
364 static struct kobj_map *bdev_map;
365
366 /**
367  * blk_mangle_minor - scatter minor numbers apart
368  * @minor: minor number to mangle
369  *
370  * Scatter consecutively allocated @minor number apart if MANGLE_DEVT
371  * is enabled.  Mangling twice gives the original value.
372  *
373  * RETURNS:
374  * Mangled value.
375  *
376  * CONTEXT:
377  * Don't care.
378  */
379 static int blk_mangle_minor(int minor)
380 {
381 #ifdef CONFIG_DEBUG_BLOCK_EXT_DEVT
382         int i;
383
384         for (i = 0; i < MINORBITS / 2; i++) {
385                 int low = minor & (1 << i);
386                 int high = minor & (1 << (MINORBITS - 1 - i));
387                 int distance = MINORBITS - 1 - 2 * i;
388
389                 minor ^= low | high;    /* clear both bits */
390                 low <<= distance;       /* swap the positions */
391                 high >>= distance;
392                 minor |= low | high;    /* and set */
393         }
394 #endif
395         return minor;
396 }
397
398 /**
399  * blk_alloc_devt - allocate a dev_t for a partition
400  * @part: partition to allocate dev_t for
401  * @devt: out parameter for resulting dev_t
402  *
403  * Allocate a dev_t for block device.
404  *
405  * RETURNS:
406  * 0 on success, allocated dev_t is returned in *@devt.  -errno on
407  * failure.
408  *
409  * CONTEXT:
410  * Might sleep.
411  */
412 int blk_alloc_devt(struct hd_struct *part, dev_t *devt)
413 {
414         struct gendisk *disk = part_to_disk(part);
415         int idx;
416
417         /* in consecutive minor range? */
418         if (part->partno < disk->minors) {
419                 *devt = MKDEV(disk->major, disk->first_minor + part->partno);
420                 return 0;
421         }
422
423         /* allocate ext devt */
424         idr_preload(GFP_KERNEL);
425
426         spin_lock_bh(&ext_devt_lock);
427         idx = idr_alloc(&ext_devt_idr, part, 0, NR_EXT_DEVT, GFP_NOWAIT);
428         spin_unlock_bh(&ext_devt_lock);
429
430         idr_preload_end();
431         if (idx < 0)
432                 return idx == -ENOSPC ? -EBUSY : idx;
433
434         *devt = MKDEV(BLOCK_EXT_MAJOR, blk_mangle_minor(idx));
435         return 0;
436 }
437
438 /**
439  * blk_free_devt - free a dev_t
440  * @devt: dev_t to free
441  *
442  * Free @devt which was allocated using blk_alloc_devt().
443  *
444  * CONTEXT:
445  * Might sleep.
446  */
447 void blk_free_devt(dev_t devt)
448 {
449         if (devt == MKDEV(0, 0))
450                 return;
451
452         if (MAJOR(devt) == BLOCK_EXT_MAJOR) {
453                 spin_lock_bh(&ext_devt_lock);
454                 idr_remove(&ext_devt_idr, blk_mangle_minor(MINOR(devt)));
455                 spin_unlock_bh(&ext_devt_lock);
456         }
457 }
458
459 static char *bdevt_str(dev_t devt, char *buf)
460 {
461         if (MAJOR(devt) <= 0xff && MINOR(devt) <= 0xff) {
462                 char tbuf[BDEVT_SIZE];
463                 snprintf(tbuf, BDEVT_SIZE, "%02x%02x", MAJOR(devt), MINOR(devt));
464                 snprintf(buf, BDEVT_SIZE, "%-9s", tbuf);
465         } else
466                 snprintf(buf, BDEVT_SIZE, "%03x:%05x", MAJOR(devt), MINOR(devt));
467
468         return buf;
469 }
470
471 /*
472  * Register device numbers dev..(dev+range-1)
473  * range must be nonzero
474  * The hash chain is sorted on range, so that subranges can override.
475  */
476 void blk_register_region(dev_t devt, unsigned long range, struct module *module,
477                          struct kobject *(*probe)(dev_t, int *, void *),
478                          int (*lock)(dev_t, void *), void *data)
479 {
480         kobj_map(bdev_map, devt, range, module, probe, lock, data);
481 }
482
483 EXPORT_SYMBOL(blk_register_region);
484
485 void blk_unregister_region(dev_t devt, unsigned long range)
486 {
487         kobj_unmap(bdev_map, devt, range);
488 }
489
490 EXPORT_SYMBOL(blk_unregister_region);
491
492 static struct kobject *exact_match(dev_t devt, int *partno, void *data)
493 {
494         struct gendisk *p = data;
495
496         return &disk_to_dev(p)->kobj;
497 }
498
499 static int exact_lock(dev_t devt, void *data)
500 {
501         struct gendisk *p = data;
502
503         if (!get_disk(p))
504                 return -1;
505         return 0;
506 }
507
508 static void register_disk(struct gendisk *disk)
509 {
510         struct device *ddev = disk_to_dev(disk);
511         struct block_device *bdev;
512         struct disk_part_iter piter;
513         struct hd_struct *part;
514         int err;
515
516         ddev->parent = disk->driverfs_dev;
517
518         dev_set_name(ddev, "%s", disk->disk_name);
519
520         /* delay uevents, until we scanned partition table */
521         dev_set_uevent_suppress(ddev, 1);
522
523         if (device_add(ddev))
524                 return;
525         if (!sysfs_deprecated) {
526                 err = sysfs_create_link(block_depr, &ddev->kobj,
527                                         kobject_name(&ddev->kobj));
528                 if (err) {
529                         device_del(ddev);
530                         return;
531                 }
532         }
533
534         /*
535          * avoid probable deadlock caused by allocating memory with
536          * GFP_KERNEL in runtime_resume callback of its all ancestor
537          * devices
538          */
539         pm_runtime_set_memalloc_noio(ddev, true);
540
541         disk->part0.holder_dir = kobject_create_and_add("holders", &ddev->kobj);
542         disk->slave_dir = kobject_create_and_add("slaves", &ddev->kobj);
543
544         /* No minors to use for partitions */
545         if (!disk_part_scan_enabled(disk))
546                 goto exit;
547
548         /* No such device (e.g., media were just removed) */
549         if (!get_capacity(disk))
550                 goto exit;
551
552         bdev = bdget_disk(disk, 0);
553         if (!bdev)
554                 goto exit;
555
556         bdev->bd_invalidated = 1;
557         err = blkdev_get(bdev, FMODE_READ, NULL);
558         if (err < 0)
559                 goto exit;
560         blkdev_put(bdev, FMODE_READ);
561
562 exit:
563         /* announce disk after possible partitions are created */
564         dev_set_uevent_suppress(ddev, 0);
565         kobject_uevent(&ddev->kobj, KOBJ_ADD);
566
567         /* announce possible partitions */
568         disk_part_iter_init(&piter, disk, 0);
569         while ((part = disk_part_iter_next(&piter)))
570                 kobject_uevent(&part_to_dev(part)->kobj, KOBJ_ADD);
571         disk_part_iter_exit(&piter);
572 }
573
574 /**
575  * add_disk - add partitioning information to kernel list
576  * @disk: per-device partitioning information
577  *
578  * This function registers the partitioning information in @disk
579  * with the kernel.
580  *
581  * FIXME: error handling
582  */
583 void add_disk(struct gendisk *disk)
584 {
585         struct backing_dev_info *bdi;
586         dev_t devt;
587         int retval;
588
589         /* minors == 0 indicates to use ext devt from part0 and should
590          * be accompanied with EXT_DEVT flag.  Make sure all
591          * parameters make sense.
592          */
593         WARN_ON(disk->minors && !(disk->major || disk->first_minor));
594         WARN_ON(!disk->minors && !(disk->flags & GENHD_FL_EXT_DEVT));
595
596         disk->flags |= GENHD_FL_UP;
597
598         retval = blk_alloc_devt(&disk->part0, &devt);
599         if (retval) {
600                 WARN_ON(1);
601                 return;
602         }
603         disk_to_dev(disk)->devt = devt;
604
605         /* ->major and ->first_minor aren't supposed to be
606          * dereferenced from here on, but set them just in case.
607          */
608         disk->major = MAJOR(devt);
609         disk->first_minor = MINOR(devt);
610
611         disk_alloc_events(disk);
612
613         /* Register BDI before referencing it from bdev */
614         bdi = disk->queue->backing_dev_info;
615         bdi_register_owner(bdi, disk_to_dev(disk));
616
617         blk_register_region(disk_devt(disk), disk->minors, NULL,
618                             exact_match, exact_lock, disk);
619         register_disk(disk);
620         blk_register_queue(disk);
621
622         /*
623          * Take an extra ref on queue which will be put on disk_release()
624          * so that it sticks around as long as @disk is there.
625          */
626         WARN_ON_ONCE(!blk_get_queue(disk->queue));
627
628         retval = sysfs_create_link(&disk_to_dev(disk)->kobj, &bdi->dev->kobj,
629                                    "bdi");
630         WARN_ON(retval);
631
632         disk_add_events(disk);
633         blk_integrity_add(disk);
634 }
635 EXPORT_SYMBOL(add_disk);
636
637 void del_gendisk(struct gendisk *disk)
638 {
639         struct disk_part_iter piter;
640         struct hd_struct *part;
641
642         blk_integrity_del(disk);
643         disk_del_events(disk);
644
645         /* invalidate stuff */
646         disk_part_iter_init(&piter, disk,
647                              DISK_PITER_INCL_EMPTY | DISK_PITER_REVERSE);
648         while ((part = disk_part_iter_next(&piter))) {
649                 bdev_unhash_inode(MKDEV(disk->major,
650                                         disk->first_minor + part->partno));
651                 invalidate_partition(disk, part->partno);
652                 delete_partition(disk, part->partno);
653         }
654         disk_part_iter_exit(&piter);
655
656         invalidate_partition(disk, 0);
657         set_capacity(disk, 0);
658         disk->flags &= ~GENHD_FL_UP;
659
660         sysfs_remove_link(&disk_to_dev(disk)->kobj, "bdi");
661         if (disk->queue) {
662                 /*
663                  * Unregister bdi before releasing device numbers (as they can
664                  * get reused and we'd get clashes in sysfs).
665                  */
666                 bdi_unregister(disk->queue->backing_dev_info);
667                 blk_unregister_queue(disk);
668         } else {
669                 WARN_ON(1);
670         }
671         blk_unregister_region(disk_devt(disk), disk->minors);
672
673         part_stat_set_all(&disk->part0, 0);
674         disk->part0.stamp = 0;
675
676         kobject_put(disk->part0.holder_dir);
677         kobject_put(disk->slave_dir);
678         if (!sysfs_deprecated)
679                 sysfs_remove_link(block_depr, dev_name(disk_to_dev(disk)));
680         pm_runtime_set_memalloc_noio(disk_to_dev(disk), false);
681         device_del(disk_to_dev(disk));
682 }
683 EXPORT_SYMBOL(del_gendisk);
684
685 /**
686  * get_gendisk - get partitioning information for a given device
687  * @devt: device to get partitioning information for
688  * @partno: returned partition index
689  *
690  * This function gets the structure containing partitioning
691  * information for the given device @devt.
692  */
693 struct gendisk *get_gendisk(dev_t devt, int *partno)
694 {
695         struct gendisk *disk = NULL;
696
697         if (MAJOR(devt) != BLOCK_EXT_MAJOR) {
698                 struct kobject *kobj;
699
700                 kobj = kobj_lookup(bdev_map, devt, partno);
701                 if (kobj)
702                         disk = dev_to_disk(kobj_to_dev(kobj));
703         } else {
704                 struct hd_struct *part;
705
706                 spin_lock_bh(&ext_devt_lock);
707                 part = idr_find(&ext_devt_idr, blk_mangle_minor(MINOR(devt)));
708                 if (part && get_disk(part_to_disk(part))) {
709                         *partno = part->partno;
710                         disk = part_to_disk(part);
711                 }
712                 spin_unlock_bh(&ext_devt_lock);
713         }
714
715         return disk;
716 }
717 EXPORT_SYMBOL(get_gendisk);
718
719 /**
720  * bdget_disk - do bdget() by gendisk and partition number
721  * @disk: gendisk of interest
722  * @partno: partition number
723  *
724  * Find partition @partno from @disk, do bdget() on it.
725  *
726  * CONTEXT:
727  * Don't care.
728  *
729  * RETURNS:
730  * Resulting block_device on success, NULL on failure.
731  */
732 struct block_device *bdget_disk(struct gendisk *disk, int partno)
733 {
734         struct hd_struct *part;
735         struct block_device *bdev = NULL;
736
737         part = disk_get_part(disk, partno);
738         if (part)
739                 bdev = bdget(part_devt(part));
740         disk_put_part(part);
741
742         return bdev;
743 }
744 EXPORT_SYMBOL(bdget_disk);
745
746 /*
747  * print a full list of all partitions - intended for places where the root
748  * filesystem can't be mounted and thus to give the victim some idea of what
749  * went wrong
750  */
751 void __init printk_all_partitions(void)
752 {
753         struct class_dev_iter iter;
754         struct device *dev;
755
756         class_dev_iter_init(&iter, &block_class, NULL, &disk_type);
757         while ((dev = class_dev_iter_next(&iter))) {
758                 struct gendisk *disk = dev_to_disk(dev);
759                 struct disk_part_iter piter;
760                 struct hd_struct *part;
761                 char name_buf[BDEVNAME_SIZE];
762                 char devt_buf[BDEVT_SIZE];
763
764                 /*
765                  * Don't show empty devices or things that have been
766                  * suppressed
767                  */
768                 if (get_capacity(disk) == 0 ||
769                     (disk->flags & GENHD_FL_SUPPRESS_PARTITION_INFO))
770                         continue;
771
772                 /*
773                  * Note, unlike /proc/partitions, I am showing the
774                  * numbers in hex - the same format as the root=
775                  * option takes.
776                  */
777                 disk_part_iter_init(&piter, disk, DISK_PITER_INCL_PART0);
778                 while ((part = disk_part_iter_next(&piter))) {
779                         bool is_part0 = part == &disk->part0;
780
781                         printk("%s%s %10llu %s %s", is_part0 ? "" : "  ",
782                                bdevt_str(part_devt(part), devt_buf),
783                                (unsigned long long)part_nr_sects_read(part) >> 1
784                                , disk_name(disk, part->partno, name_buf),
785                                part->info ? part->info->uuid : "");
786                         if (is_part0) {
787                                 if (disk->driverfs_dev != NULL &&
788                                     disk->driverfs_dev->driver != NULL)
789                                         printk(" driver: %s\n",
790                                               disk->driverfs_dev->driver->name);
791                                 else
792                                         printk(" (driver?)\n");
793                         } else
794                                 printk("\n");
795                 }
796                 disk_part_iter_exit(&piter);
797         }
798         class_dev_iter_exit(&iter);
799 }
800
801 #ifdef CONFIG_PROC_FS
802 /* iterator */
803 static void *disk_seqf_start(struct seq_file *seqf, loff_t *pos)
804 {
805         loff_t skip = *pos;
806         struct class_dev_iter *iter;
807         struct device *dev;
808
809         iter = kmalloc(sizeof(*iter), GFP_KERNEL);
810         if (!iter)
811                 return ERR_PTR(-ENOMEM);
812
813         seqf->private = iter;
814         class_dev_iter_init(iter, &block_class, NULL, &disk_type);
815         do {
816                 dev = class_dev_iter_next(iter);
817                 if (!dev)
818                         return NULL;
819         } while (skip--);
820
821         return dev_to_disk(dev);
822 }
823
824 static void *disk_seqf_next(struct seq_file *seqf, void *v, loff_t *pos)
825 {
826         struct device *dev;
827
828         (*pos)++;
829         dev = class_dev_iter_next(seqf->private);
830         if (dev)
831                 return dev_to_disk(dev);
832
833         return NULL;
834 }
835
836 static void disk_seqf_stop(struct seq_file *seqf, void *v)
837 {
838         struct class_dev_iter *iter = seqf->private;
839
840         /* stop is called even after start failed :-( */
841         if (iter) {
842                 class_dev_iter_exit(iter);
843                 kfree(iter);
844                 seqf->private = NULL;
845         }
846 }
847
848 static void *show_partition_start(struct seq_file *seqf, loff_t *pos)
849 {
850         void *p;
851
852         p = disk_seqf_start(seqf, pos);
853         if (!IS_ERR_OR_NULL(p) && !*pos)
854                 seq_puts(seqf, "major minor  #blocks  name\n\n");
855         return p;
856 }
857
858 static int show_partition(struct seq_file *seqf, void *v)
859 {
860         struct gendisk *sgp = v;
861         struct disk_part_iter piter;
862         struct hd_struct *part;
863         char buf[BDEVNAME_SIZE];
864
865         /* Don't show non-partitionable removeable devices or empty devices */
866         if (!get_capacity(sgp) || (!disk_max_parts(sgp) &&
867                                    (sgp->flags & GENHD_FL_REMOVABLE)))
868                 return 0;
869         if (sgp->flags & GENHD_FL_SUPPRESS_PARTITION_INFO)
870                 return 0;
871
872         /* show the full disk and all non-0 size partitions of it */
873         disk_part_iter_init(&piter, sgp, DISK_PITER_INCL_PART0);
874         while ((part = disk_part_iter_next(&piter)))
875                 seq_printf(seqf, "%4d  %7d %10llu %s\n",
876                            MAJOR(part_devt(part)), MINOR(part_devt(part)),
877                            (unsigned long long)part_nr_sects_read(part) >> 1,
878                            disk_name(sgp, part->partno, buf));
879         disk_part_iter_exit(&piter);
880
881         return 0;
882 }
883
884 static const struct seq_operations partitions_op = {
885         .start  = show_partition_start,
886         .next   = disk_seqf_next,
887         .stop   = disk_seqf_stop,
888         .show   = show_partition
889 };
890
891 static int partitions_open(struct inode *inode, struct file *file)
892 {
893         return seq_open(file, &partitions_op);
894 }
895
896 static const struct file_operations proc_partitions_operations = {
897         .open           = partitions_open,
898         .read           = seq_read,
899         .llseek         = seq_lseek,
900         .release        = seq_release,
901 };
902 #endif
903
904
905 static struct kobject *base_probe(dev_t devt, int *partno, void *data)
906 {
907         if (request_module("block-major-%d-%d", MAJOR(devt), MINOR(devt)) > 0)
908                 /* Make old-style 2.4 aliases work */
909                 request_module("block-major-%d", MAJOR(devt));
910         return NULL;
911 }
912
913 static int __init genhd_device_init(void)
914 {
915         int error;
916
917         block_class.dev_kobj = sysfs_dev_block_kobj;
918         error = class_register(&block_class);
919         if (unlikely(error))
920                 return error;
921         bdev_map = kobj_map_init(base_probe, &block_class_lock);
922         blk_dev_init();
923
924         register_blkdev(BLOCK_EXT_MAJOR, "blkext");
925
926         /* create top-level block dir */
927         if (!sysfs_deprecated)
928                 block_depr = kobject_create_and_add("block", NULL);
929         return 0;
930 }
931
932 subsys_initcall(genhd_device_init);
933
934 static ssize_t disk_range_show(struct device *dev,
935                                struct device_attribute *attr, char *buf)
936 {
937         struct gendisk *disk = dev_to_disk(dev);
938
939         return sprintf(buf, "%d\n", disk->minors);
940 }
941
942 static ssize_t disk_ext_range_show(struct device *dev,
943                                    struct device_attribute *attr, char *buf)
944 {
945         struct gendisk *disk = dev_to_disk(dev);
946
947         return sprintf(buf, "%d\n", disk_max_parts(disk));
948 }
949
950 static ssize_t disk_removable_show(struct device *dev,
951                                    struct device_attribute *attr, char *buf)
952 {
953         struct gendisk *disk = dev_to_disk(dev);
954
955         return sprintf(buf, "%d\n",
956                        (disk->flags & GENHD_FL_REMOVABLE ? 1 : 0));
957 }
958
959 static ssize_t disk_ro_show(struct device *dev,
960                                    struct device_attribute *attr, char *buf)
961 {
962         struct gendisk *disk = dev_to_disk(dev);
963
964         return sprintf(buf, "%d\n", get_disk_ro(disk) ? 1 : 0);
965 }
966
967 static ssize_t disk_capability_show(struct device *dev,
968                                     struct device_attribute *attr, char *buf)
969 {
970         struct gendisk *disk = dev_to_disk(dev);
971
972         return sprintf(buf, "%x\n", disk->flags);
973 }
974
975 static ssize_t disk_alignment_offset_show(struct device *dev,
976                                           struct device_attribute *attr,
977                                           char *buf)
978 {
979         struct gendisk *disk = dev_to_disk(dev);
980
981         return sprintf(buf, "%d\n", queue_alignment_offset(disk->queue));
982 }
983
984 static ssize_t disk_discard_alignment_show(struct device *dev,
985                                            struct device_attribute *attr,
986                                            char *buf)
987 {
988         struct gendisk *disk = dev_to_disk(dev);
989
990         return sprintf(buf, "%d\n", queue_discard_alignment(disk->queue));
991 }
992
993 static DEVICE_ATTR(range, S_IRUGO, disk_range_show, NULL);
994 static DEVICE_ATTR(ext_range, S_IRUGO, disk_ext_range_show, NULL);
995 static DEVICE_ATTR(removable, S_IRUGO, disk_removable_show, NULL);
996 static DEVICE_ATTR(ro, S_IRUGO, disk_ro_show, NULL);
997 static DEVICE_ATTR(size, S_IRUGO, part_size_show, NULL);
998 static DEVICE_ATTR(alignment_offset, S_IRUGO, disk_alignment_offset_show, NULL);
999 static DEVICE_ATTR(discard_alignment, S_IRUGO, disk_discard_alignment_show,
1000                    NULL);
1001 static DEVICE_ATTR(capability, S_IRUGO, disk_capability_show, NULL);
1002 static DEVICE_ATTR(stat, S_IRUGO, part_stat_show, NULL);
1003 static DEVICE_ATTR(inflight, S_IRUGO, part_inflight_show, NULL);
1004 #ifdef CONFIG_FAIL_MAKE_REQUEST
1005 static struct device_attribute dev_attr_fail =
1006         __ATTR(make-it-fail, S_IRUGO|S_IWUSR, part_fail_show, part_fail_store);
1007 #endif
1008 #ifdef CONFIG_FAIL_IO_TIMEOUT
1009 static struct device_attribute dev_attr_fail_timeout =
1010         __ATTR(io-timeout-fail,  S_IRUGO|S_IWUSR, part_timeout_show,
1011                 part_timeout_store);
1012 #endif
1013
1014 static struct attribute *disk_attrs[] = {
1015         &dev_attr_range.attr,
1016         &dev_attr_ext_range.attr,
1017         &dev_attr_removable.attr,
1018         &dev_attr_ro.attr,
1019         &dev_attr_size.attr,
1020         &dev_attr_alignment_offset.attr,
1021         &dev_attr_discard_alignment.attr,
1022         &dev_attr_capability.attr,
1023         &dev_attr_stat.attr,
1024         &dev_attr_inflight.attr,
1025 #ifdef CONFIG_FAIL_MAKE_REQUEST
1026         &dev_attr_fail.attr,
1027 #endif
1028 #ifdef CONFIG_FAIL_IO_TIMEOUT
1029         &dev_attr_fail_timeout.attr,
1030 #endif
1031         NULL
1032 };
1033
1034 static struct attribute_group disk_attr_group = {
1035         .attrs = disk_attrs,
1036 };
1037
1038 static const struct attribute_group *disk_attr_groups[] = {
1039         &disk_attr_group,
1040         NULL
1041 };
1042
1043 /**
1044  * disk_replace_part_tbl - replace disk->part_tbl in RCU-safe way
1045  * @disk: disk to replace part_tbl for
1046  * @new_ptbl: new part_tbl to install
1047  *
1048  * Replace disk->part_tbl with @new_ptbl in RCU-safe way.  The
1049  * original ptbl is freed using RCU callback.
1050  *
1051  * LOCKING:
1052  * Matching bd_mutx locked.
1053  */
1054 static void disk_replace_part_tbl(struct gendisk *disk,
1055                                   struct disk_part_tbl *new_ptbl)
1056 {
1057         struct disk_part_tbl *old_ptbl = disk->part_tbl;
1058
1059         rcu_assign_pointer(disk->part_tbl, new_ptbl);
1060
1061         if (old_ptbl) {
1062                 rcu_assign_pointer(old_ptbl->last_lookup, NULL);
1063                 kfree_rcu(old_ptbl, rcu_head);
1064         }
1065 }
1066
1067 /**
1068  * disk_expand_part_tbl - expand disk->part_tbl
1069  * @disk: disk to expand part_tbl for
1070  * @partno: expand such that this partno can fit in
1071  *
1072  * Expand disk->part_tbl such that @partno can fit in.  disk->part_tbl
1073  * uses RCU to allow unlocked dereferencing for stats and other stuff.
1074  *
1075  * LOCKING:
1076  * Matching bd_mutex locked, might sleep.
1077  *
1078  * RETURNS:
1079  * 0 on success, -errno on failure.
1080  */
1081 int disk_expand_part_tbl(struct gendisk *disk, int partno)
1082 {
1083         struct disk_part_tbl *old_ptbl = disk->part_tbl;
1084         struct disk_part_tbl *new_ptbl;
1085         int len = old_ptbl ? old_ptbl->len : 0;
1086         int i, target;
1087         size_t size;
1088
1089         /*
1090          * check for int overflow, since we can get here from blkpg_ioctl()
1091          * with a user passed 'partno'.
1092          */
1093         target = partno + 1;
1094         if (target < 0)
1095                 return -EINVAL;
1096
1097         /* disk_max_parts() is zero during initialization, ignore if so */
1098         if (disk_max_parts(disk) && target > disk_max_parts(disk))
1099                 return -EINVAL;
1100
1101         if (target <= len)
1102                 return 0;
1103
1104         size = sizeof(*new_ptbl) + target * sizeof(new_ptbl->part[0]);
1105         new_ptbl = kzalloc_node(size, GFP_KERNEL, disk->node_id);
1106         if (!new_ptbl)
1107                 return -ENOMEM;
1108
1109         new_ptbl->len = target;
1110
1111         for (i = 0; i < len; i++)
1112                 rcu_assign_pointer(new_ptbl->part[i], old_ptbl->part[i]);
1113
1114         disk_replace_part_tbl(disk, new_ptbl);
1115         return 0;
1116 }
1117
1118 static void disk_release(struct device *dev)
1119 {
1120         struct gendisk *disk = dev_to_disk(dev);
1121
1122         blk_free_devt(dev->devt);
1123         disk_release_events(disk);
1124         kfree(disk->random);
1125         disk_replace_part_tbl(disk, NULL);
1126         hd_free_part(&disk->part0);
1127         if (disk->queue)
1128                 blk_put_queue(disk->queue);
1129         kfree(disk);
1130 }
1131
1132 static int disk_uevent(struct device *dev, struct kobj_uevent_env *env)
1133 {
1134         struct gendisk *disk = dev_to_disk(dev);
1135         struct disk_part_iter piter;
1136         struct hd_struct *part;
1137         int cnt = 0;
1138
1139         disk_part_iter_init(&piter, disk, 0);
1140         while((part = disk_part_iter_next(&piter)))
1141                 cnt++;
1142         disk_part_iter_exit(&piter);
1143         add_uevent_var(env, "NPARTS=%u", cnt);
1144         return 0;
1145 }
1146
1147 struct class block_class = {
1148         .name           = "block",
1149 };
1150
1151 static char *block_devnode(struct device *dev, umode_t *mode,
1152                            kuid_t *uid, kgid_t *gid)
1153 {
1154         struct gendisk *disk = dev_to_disk(dev);
1155
1156         if (disk->devnode)
1157                 return disk->devnode(disk, mode);
1158         return NULL;
1159 }
1160
1161 static struct device_type disk_type = {
1162         .name           = "disk",
1163         .groups         = disk_attr_groups,
1164         .release        = disk_release,
1165         .devnode        = block_devnode,
1166         .uevent         = disk_uevent,
1167 };
1168
1169 #ifdef CONFIG_PROC_FS
1170 /*
1171  * aggregate disk stat collector.  Uses the same stats that the sysfs
1172  * entries do, above, but makes them available through one seq_file.
1173  *
1174  * The output looks suspiciously like /proc/partitions with a bunch of
1175  * extra fields.
1176  */
1177 static int diskstats_show(struct seq_file *seqf, void *v)
1178 {
1179         struct gendisk *gp = v;
1180         struct disk_part_iter piter;
1181         struct hd_struct *hd;
1182         char buf[BDEVNAME_SIZE];
1183         int cpu;
1184
1185         /*
1186         if (&disk_to_dev(gp)->kobj.entry == block_class.devices.next)
1187                 seq_puts(seqf,  "major minor name"
1188                                 "     rio rmerge rsect ruse wio wmerge "
1189                                 "wsect wuse running use aveq"
1190                                 "\n\n");
1191         */
1192
1193         disk_part_iter_init(&piter, gp, DISK_PITER_INCL_EMPTY_PART0);
1194         while ((hd = disk_part_iter_next(&piter))) {
1195                 cpu = part_stat_lock();
1196                 part_round_stats(cpu, hd);
1197                 part_stat_unlock();
1198                 seq_printf(seqf, "%4d %7d %s %lu %lu %lu "
1199                            "%u %lu %lu %lu %u %u %u %u\n",
1200                            MAJOR(part_devt(hd)), MINOR(part_devt(hd)),
1201                            disk_name(gp, hd->partno, buf),
1202                            part_stat_read(hd, ios[READ]),
1203                            part_stat_read(hd, merges[READ]),
1204                            part_stat_read(hd, sectors[READ]),
1205                            jiffies_to_msecs(part_stat_read(hd, ticks[READ])),
1206                            part_stat_read(hd, ios[WRITE]),
1207                            part_stat_read(hd, merges[WRITE]),
1208                            part_stat_read(hd, sectors[WRITE]),
1209                            jiffies_to_msecs(part_stat_read(hd, ticks[WRITE])),
1210                            part_in_flight(hd),
1211                            jiffies_to_msecs(part_stat_read(hd, io_ticks)),
1212                            jiffies_to_msecs(part_stat_read(hd, time_in_queue))
1213                         );
1214         }
1215         disk_part_iter_exit(&piter);
1216
1217         return 0;
1218 }
1219
1220 static const struct seq_operations diskstats_op = {
1221         .start  = disk_seqf_start,
1222         .next   = disk_seqf_next,
1223         .stop   = disk_seqf_stop,
1224         .show   = diskstats_show
1225 };
1226
1227 static int diskstats_open(struct inode *inode, struct file *file)
1228 {
1229         return seq_open(file, &diskstats_op);
1230 }
1231
1232 static const struct file_operations proc_diskstats_operations = {
1233         .open           = diskstats_open,
1234         .read           = seq_read,
1235         .llseek         = seq_lseek,
1236         .release        = seq_release,
1237 };
1238
1239 static int __init proc_genhd_init(void)
1240 {
1241         proc_create("diskstats", 0, NULL, &proc_diskstats_operations);
1242         proc_create("partitions", 0, NULL, &proc_partitions_operations);
1243         return 0;
1244 }
1245 module_init(proc_genhd_init);
1246 #endif /* CONFIG_PROC_FS */
1247
1248 dev_t blk_lookup_devt(const char *name, int partno)
1249 {
1250         dev_t devt = MKDEV(0, 0);
1251         struct class_dev_iter iter;
1252         struct device *dev;
1253
1254         class_dev_iter_init(&iter, &block_class, NULL, &disk_type);
1255         while ((dev = class_dev_iter_next(&iter))) {
1256                 struct gendisk *disk = dev_to_disk(dev);
1257                 struct hd_struct *part;
1258
1259                 if (strcmp(dev_name(dev), name))
1260                         continue;
1261
1262                 if (partno < disk->minors) {
1263                         /* We need to return the right devno, even
1264                          * if the partition doesn't exist yet.
1265                          */
1266                         devt = MKDEV(MAJOR(dev->devt),
1267                                      MINOR(dev->devt) + partno);
1268                         break;
1269                 }
1270                 part = disk_get_part(disk, partno);
1271                 if (part) {
1272                         devt = part_devt(part);
1273                         disk_put_part(part);
1274                         break;
1275                 }
1276                 disk_put_part(part);
1277         }
1278         class_dev_iter_exit(&iter);
1279         return devt;
1280 }
1281 EXPORT_SYMBOL(blk_lookup_devt);
1282
1283 struct gendisk *alloc_disk(int minors)
1284 {
1285         return alloc_disk_node(minors, NUMA_NO_NODE);
1286 }
1287 EXPORT_SYMBOL(alloc_disk);
1288
1289 struct gendisk *alloc_disk_node(int minors, int node_id)
1290 {
1291         struct gendisk *disk;
1292
1293         disk = kzalloc_node(sizeof(struct gendisk), GFP_KERNEL, node_id);
1294         if (disk) {
1295                 if (!init_part_stats(&disk->part0)) {
1296                         kfree(disk);
1297                         return NULL;
1298                 }
1299                 disk->node_id = node_id;
1300                 if (disk_expand_part_tbl(disk, 0)) {
1301                         free_part_stats(&disk->part0);
1302                         kfree(disk);
1303                         return NULL;
1304                 }
1305                 disk->part_tbl->part[0] = &disk->part0;
1306
1307                 /*
1308                  * set_capacity() and get_capacity() currently don't use
1309                  * seqcounter to read/update the part0->nr_sects. Still init
1310                  * the counter as we can read the sectors in IO submission
1311                  * patch using seqence counters.
1312                  *
1313                  * TODO: Ideally set_capacity() and get_capacity() should be
1314                  * converted to make use of bd_mutex and sequence counters.
1315                  */
1316                 seqcount_init(&disk->part0.nr_sects_seq);
1317                 if (hd_ref_init(&disk->part0)) {
1318                         hd_free_part(&disk->part0);
1319                         kfree(disk);
1320                         return NULL;
1321                 }
1322
1323                 disk->minors = minors;
1324                 rand_initialize_disk(disk);
1325                 disk_to_dev(disk)->class = &block_class;
1326                 disk_to_dev(disk)->type = &disk_type;
1327                 device_initialize(disk_to_dev(disk));
1328         }
1329         return disk;
1330 }
1331 EXPORT_SYMBOL(alloc_disk_node);
1332
1333 struct kobject *get_disk(struct gendisk *disk)
1334 {
1335         struct module *owner;
1336         struct kobject *kobj;
1337
1338         if (!disk->fops)
1339                 return NULL;
1340         owner = disk->fops->owner;
1341         if (owner && !try_module_get(owner))
1342                 return NULL;
1343         kobj = kobject_get(&disk_to_dev(disk)->kobj);
1344         if (kobj == NULL) {
1345                 module_put(owner);
1346                 return NULL;
1347         }
1348         return kobj;
1349
1350 }
1351
1352 EXPORT_SYMBOL(get_disk);
1353
1354 void put_disk(struct gendisk *disk)
1355 {
1356         if (disk)
1357                 kobject_put(&disk_to_dev(disk)->kobj);
1358 }
1359
1360 EXPORT_SYMBOL(put_disk);
1361
1362 static void set_disk_ro_uevent(struct gendisk *gd, int ro)
1363 {
1364         char event[] = "DISK_RO=1";
1365         char *envp[] = { event, NULL };
1366
1367         if (!ro)
1368                 event[8] = '0';
1369         kobject_uevent_env(&disk_to_dev(gd)->kobj, KOBJ_CHANGE, envp);
1370 }
1371
1372 void set_device_ro(struct block_device *bdev, int flag)
1373 {
1374         bdev->bd_part->policy = flag;
1375 }
1376
1377 EXPORT_SYMBOL(set_device_ro);
1378
1379 void set_disk_ro(struct gendisk *disk, int flag)
1380 {
1381         struct disk_part_iter piter;
1382         struct hd_struct *part;
1383
1384         if (disk->part0.policy != flag) {
1385                 set_disk_ro_uevent(disk, flag);
1386                 disk->part0.policy = flag;
1387         }
1388
1389         disk_part_iter_init(&piter, disk, DISK_PITER_INCL_EMPTY);
1390         while ((part = disk_part_iter_next(&piter)))
1391                 part->policy = flag;
1392         disk_part_iter_exit(&piter);
1393 }
1394
1395 EXPORT_SYMBOL(set_disk_ro);
1396
1397 int bdev_read_only(struct block_device *bdev)
1398 {
1399         if (!bdev)
1400                 return 0;
1401         return bdev->bd_part->policy;
1402 }
1403
1404 EXPORT_SYMBOL(bdev_read_only);
1405
1406 int invalidate_partition(struct gendisk *disk, int partno)
1407 {
1408         int res = 0;
1409         struct block_device *bdev = bdget_disk(disk, partno);
1410         if (bdev) {
1411                 fsync_bdev(bdev);
1412                 res = __invalidate_device(bdev, true);
1413                 bdput(bdev);
1414         }
1415         return res;
1416 }
1417
1418 EXPORT_SYMBOL(invalidate_partition);
1419
1420 /*
1421  * Disk events - monitor disk events like media change and eject request.
1422  */
1423 struct disk_events {
1424         struct list_head        node;           /* all disk_event's */
1425         struct gendisk          *disk;          /* the associated disk */
1426         spinlock_t              lock;
1427
1428         struct mutex            block_mutex;    /* protects blocking */
1429         int                     block;          /* event blocking depth */
1430         unsigned int            pending;        /* events already sent out */
1431         unsigned int            clearing;       /* events being cleared */
1432
1433         long                    poll_msecs;     /* interval, -1 for default */
1434         struct delayed_work     dwork;
1435 };
1436
1437 static const char *disk_events_strs[] = {
1438         [ilog2(DISK_EVENT_MEDIA_CHANGE)]        = "media_change",
1439         [ilog2(DISK_EVENT_EJECT_REQUEST)]       = "eject_request",
1440 };
1441
1442 static char *disk_uevents[] = {
1443         [ilog2(DISK_EVENT_MEDIA_CHANGE)]        = "DISK_MEDIA_CHANGE=1",
1444         [ilog2(DISK_EVENT_EJECT_REQUEST)]       = "DISK_EJECT_REQUEST=1",
1445 };
1446
1447 /* list of all disk_events */
1448 static DEFINE_MUTEX(disk_events_mutex);
1449 static LIST_HEAD(disk_events);
1450
1451 /* disable in-kernel polling by default */
1452 static unsigned long disk_events_dfl_poll_msecs = 0;
1453
1454 static unsigned long disk_events_poll_jiffies(struct gendisk *disk)
1455 {
1456         struct disk_events *ev = disk->ev;
1457         long intv_msecs = 0;
1458
1459         /*
1460          * If device-specific poll interval is set, always use it.  If
1461          * the default is being used, poll iff there are events which
1462          * can't be monitored asynchronously.
1463          */
1464         if (ev->poll_msecs >= 0)
1465                 intv_msecs = ev->poll_msecs;
1466         else if (disk->events & ~disk->async_events)
1467                 intv_msecs = disk_events_dfl_poll_msecs;
1468
1469         return msecs_to_jiffies(intv_msecs);
1470 }
1471
1472 /**
1473  * disk_block_events - block and flush disk event checking
1474  * @disk: disk to block events for
1475  *
1476  * On return from this function, it is guaranteed that event checking
1477  * isn't in progress and won't happen until unblocked by
1478  * disk_unblock_events().  Events blocking is counted and the actual
1479  * unblocking happens after the matching number of unblocks are done.
1480  *
1481  * Note that this intentionally does not block event checking from
1482  * disk_clear_events().
1483  *
1484  * CONTEXT:
1485  * Might sleep.
1486  */
1487 void disk_block_events(struct gendisk *disk)
1488 {
1489         struct disk_events *ev = disk->ev;
1490         unsigned long flags;
1491         bool cancel;
1492
1493         if (!ev)
1494                 return;
1495
1496         /*
1497          * Outer mutex ensures that the first blocker completes canceling
1498          * the event work before further blockers are allowed to finish.
1499          */
1500         mutex_lock(&ev->block_mutex);
1501
1502         spin_lock_irqsave(&ev->lock, flags);
1503         cancel = !ev->block++;
1504         spin_unlock_irqrestore(&ev->lock, flags);
1505
1506         if (cancel)
1507                 cancel_delayed_work_sync(&disk->ev->dwork);
1508
1509         mutex_unlock(&ev->block_mutex);
1510 }
1511
1512 static void __disk_unblock_events(struct gendisk *disk, bool check_now)
1513 {
1514         struct disk_events *ev = disk->ev;
1515         unsigned long intv;
1516         unsigned long flags;
1517
1518         spin_lock_irqsave(&ev->lock, flags);
1519
1520         if (WARN_ON_ONCE(ev->block <= 0))
1521                 goto out_unlock;
1522
1523         if (--ev->block)
1524                 goto out_unlock;
1525
1526         /*
1527          * Not exactly a latency critical operation, set poll timer
1528          * slack to 25% and kick event check.
1529          */
1530         intv = disk_events_poll_jiffies(disk);
1531         set_timer_slack(&ev->dwork.timer, intv / 4);
1532         if (check_now)
1533                 queue_delayed_work(system_freezable_power_efficient_wq,
1534                                 &ev->dwork, 0);
1535         else if (intv)
1536                 queue_delayed_work(system_freezable_power_efficient_wq,
1537                                 &ev->dwork, intv);
1538 out_unlock:
1539         spin_unlock_irqrestore(&ev->lock, flags);
1540 }
1541
1542 /**
1543  * disk_unblock_events - unblock disk event checking
1544  * @disk: disk to unblock events for
1545  *
1546  * Undo disk_block_events().  When the block count reaches zero, it
1547  * starts events polling if configured.
1548  *
1549  * CONTEXT:
1550  * Don't care.  Safe to call from irq context.
1551  */
1552 void disk_unblock_events(struct gendisk *disk)
1553 {
1554         if (disk->ev)
1555                 __disk_unblock_events(disk, false);
1556 }
1557
1558 /**
1559  * disk_flush_events - schedule immediate event checking and flushing
1560  * @disk: disk to check and flush events for
1561  * @mask: events to flush
1562  *
1563  * Schedule immediate event checking on @disk if not blocked.  Events in
1564  * @mask are scheduled to be cleared from the driver.  Note that this
1565  * doesn't clear the events from @disk->ev.
1566  *
1567  * CONTEXT:
1568  * If @mask is non-zero must be called with bdev->bd_mutex held.
1569  */
1570 void disk_flush_events(struct gendisk *disk, unsigned int mask)
1571 {
1572         struct disk_events *ev = disk->ev;
1573
1574         if (!ev)
1575                 return;
1576
1577         spin_lock_irq(&ev->lock);
1578         ev->clearing |= mask;
1579         if (!ev->block)
1580                 mod_delayed_work(system_freezable_power_efficient_wq,
1581                                 &ev->dwork, 0);
1582         spin_unlock_irq(&ev->lock);
1583 }
1584
1585 /**
1586  * disk_clear_events - synchronously check, clear and return pending events
1587  * @disk: disk to fetch and clear events from
1588  * @mask: mask of events to be fetched and cleared
1589  *
1590  * Disk events are synchronously checked and pending events in @mask
1591  * are cleared and returned.  This ignores the block count.
1592  *
1593  * CONTEXT:
1594  * Might sleep.
1595  */
1596 unsigned int disk_clear_events(struct gendisk *disk, unsigned int mask)
1597 {
1598         const struct block_device_operations *bdops = disk->fops;
1599         struct disk_events *ev = disk->ev;
1600         unsigned int pending;
1601         unsigned int clearing = mask;
1602
1603         if (!ev) {
1604                 /* for drivers still using the old ->media_changed method */
1605                 if ((mask & DISK_EVENT_MEDIA_CHANGE) &&
1606                     bdops->media_changed && bdops->media_changed(disk))
1607                         return DISK_EVENT_MEDIA_CHANGE;
1608                 return 0;
1609         }
1610
1611         disk_block_events(disk);
1612
1613         /*
1614          * store the union of mask and ev->clearing on the stack so that the
1615          * race with disk_flush_events does not cause ambiguity (ev->clearing
1616          * can still be modified even if events are blocked).
1617          */
1618         spin_lock_irq(&ev->lock);
1619         clearing |= ev->clearing;
1620         ev->clearing = 0;
1621         spin_unlock_irq(&ev->lock);
1622
1623         disk_check_events(ev, &clearing);
1624         /*
1625          * if ev->clearing is not 0, the disk_flush_events got called in the
1626          * middle of this function, so we want to run the workfn without delay.
1627          */
1628         __disk_unblock_events(disk, ev->clearing ? true : false);
1629
1630         /* then, fetch and clear pending events */
1631         spin_lock_irq(&ev->lock);
1632         pending = ev->pending & mask;
1633         ev->pending &= ~mask;
1634         spin_unlock_irq(&ev->lock);
1635         WARN_ON_ONCE(clearing & mask);
1636
1637         return pending;
1638 }
1639
1640 /*
1641  * Separate this part out so that a different pointer for clearing_ptr can be
1642  * passed in for disk_clear_events.
1643  */
1644 static void disk_events_workfn(struct work_struct *work)
1645 {
1646         struct delayed_work *dwork = to_delayed_work(work);
1647         struct disk_events *ev = container_of(dwork, struct disk_events, dwork);
1648
1649         disk_check_events(ev, &ev->clearing);
1650 }
1651
1652 static void disk_check_events(struct disk_events *ev,
1653                               unsigned int *clearing_ptr)
1654 {
1655         struct gendisk *disk = ev->disk;
1656         char *envp[ARRAY_SIZE(disk_uevents) + 1] = { };
1657         unsigned int clearing = *clearing_ptr;
1658         unsigned int events;
1659         unsigned long intv;
1660         int nr_events = 0, i;
1661
1662         /* check events */
1663         events = disk->fops->check_events(disk, clearing);
1664
1665         /* accumulate pending events and schedule next poll if necessary */
1666         spin_lock_irq(&ev->lock);
1667
1668         events &= ~ev->pending;
1669         ev->pending |= events;
1670         *clearing_ptr &= ~clearing;
1671
1672         intv = disk_events_poll_jiffies(disk);
1673         if (!ev->block && intv)
1674                 queue_delayed_work(system_freezable_power_efficient_wq,
1675                                 &ev->dwork, intv);
1676
1677         spin_unlock_irq(&ev->lock);
1678
1679         /*
1680          * Tell userland about new events.  Only the events listed in
1681          * @disk->events are reported.  Unlisted events are processed the
1682          * same internally but never get reported to userland.
1683          */
1684         for (i = 0; i < ARRAY_SIZE(disk_uevents); i++)
1685                 if (events & disk->events & (1 << i))
1686                         envp[nr_events++] = disk_uevents[i];
1687
1688         if (nr_events)
1689                 kobject_uevent_env(&disk_to_dev(disk)->kobj, KOBJ_CHANGE, envp);
1690 }
1691
1692 /*
1693  * A disk events enabled device has the following sysfs nodes under
1694  * its /sys/block/X/ directory.
1695  *
1696  * events               : list of all supported events
1697  * events_async         : list of events which can be detected w/o polling
1698  * events_poll_msecs    : polling interval, 0: disable, -1: system default
1699  */
1700 static ssize_t __disk_events_show(unsigned int events, char *buf)
1701 {
1702         const char *delim = "";
1703         ssize_t pos = 0;
1704         int i;
1705
1706         for (i = 0; i < ARRAY_SIZE(disk_events_strs); i++)
1707                 if (events & (1 << i)) {
1708                         pos += sprintf(buf + pos, "%s%s",
1709                                        delim, disk_events_strs[i]);
1710                         delim = " ";
1711                 }
1712         if (pos)
1713                 pos += sprintf(buf + pos, "\n");
1714         return pos;
1715 }
1716
1717 static ssize_t disk_events_show(struct device *dev,
1718                                 struct device_attribute *attr, char *buf)
1719 {
1720         struct gendisk *disk = dev_to_disk(dev);
1721
1722         return __disk_events_show(disk->events, buf);
1723 }
1724
1725 static ssize_t disk_events_async_show(struct device *dev,
1726                                       struct device_attribute *attr, char *buf)
1727 {
1728         struct gendisk *disk = dev_to_disk(dev);
1729
1730         return __disk_events_show(disk->async_events, buf);
1731 }
1732
1733 static ssize_t disk_events_poll_msecs_show(struct device *dev,
1734                                            struct device_attribute *attr,
1735                                            char *buf)
1736 {
1737         struct gendisk *disk = dev_to_disk(dev);
1738
1739         return sprintf(buf, "%ld\n", disk->ev->poll_msecs);
1740 }
1741
1742 static ssize_t disk_events_poll_msecs_store(struct device *dev,
1743                                             struct device_attribute *attr,
1744                                             const char *buf, size_t count)
1745 {
1746         struct gendisk *disk = dev_to_disk(dev);
1747         long intv;
1748
1749         if (!count || !sscanf(buf, "%ld", &intv))
1750                 return -EINVAL;
1751
1752         if (intv < 0 && intv != -1)
1753                 return -EINVAL;
1754
1755         disk_block_events(disk);
1756         disk->ev->poll_msecs = intv;
1757         __disk_unblock_events(disk, true);
1758
1759         return count;
1760 }
1761
1762 static const DEVICE_ATTR(events, S_IRUGO, disk_events_show, NULL);
1763 static const DEVICE_ATTR(events_async, S_IRUGO, disk_events_async_show, NULL);
1764 static const DEVICE_ATTR(events_poll_msecs, S_IRUGO|S_IWUSR,
1765                          disk_events_poll_msecs_show,
1766                          disk_events_poll_msecs_store);
1767
1768 static const struct attribute *disk_events_attrs[] = {
1769         &dev_attr_events.attr,
1770         &dev_attr_events_async.attr,
1771         &dev_attr_events_poll_msecs.attr,
1772         NULL,
1773 };
1774
1775 /*
1776  * The default polling interval can be specified by the kernel
1777  * parameter block.events_dfl_poll_msecs which defaults to 0
1778  * (disable).  This can also be modified runtime by writing to
1779  * /sys/module/block/events_dfl_poll_msecs.
1780  */
1781 static int disk_events_set_dfl_poll_msecs(const char *val,
1782                                           const struct kernel_param *kp)
1783 {
1784         struct disk_events *ev;
1785         int ret;
1786
1787         ret = param_set_ulong(val, kp);
1788         if (ret < 0)
1789                 return ret;
1790
1791         mutex_lock(&disk_events_mutex);
1792
1793         list_for_each_entry(ev, &disk_events, node)
1794                 disk_flush_events(ev->disk, 0);
1795
1796         mutex_unlock(&disk_events_mutex);
1797
1798         return 0;
1799 }
1800
1801 static const struct kernel_param_ops disk_events_dfl_poll_msecs_param_ops = {
1802         .set    = disk_events_set_dfl_poll_msecs,
1803         .get    = param_get_ulong,
1804 };
1805
1806 #undef MODULE_PARAM_PREFIX
1807 #define MODULE_PARAM_PREFIX     "block."
1808
1809 module_param_cb(events_dfl_poll_msecs, &disk_events_dfl_poll_msecs_param_ops,
1810                 &disk_events_dfl_poll_msecs, 0644);
1811
1812 /*
1813  * disk_{alloc|add|del|release}_events - initialize and destroy disk_events.
1814  */
1815 static void disk_alloc_events(struct gendisk *disk)
1816 {
1817         struct disk_events *ev;
1818
1819         if (!disk->fops->check_events)
1820                 return;
1821
1822         ev = kzalloc(sizeof(*ev), GFP_KERNEL);
1823         if (!ev) {
1824                 pr_warn("%s: failed to initialize events\n", disk->disk_name);
1825                 return;
1826         }
1827
1828         INIT_LIST_HEAD(&ev->node);
1829         ev->disk = disk;
1830         spin_lock_init(&ev->lock);
1831         mutex_init(&ev->block_mutex);
1832         ev->block = 1;
1833         ev->poll_msecs = -1;
1834         INIT_DELAYED_WORK(&ev->dwork, disk_events_workfn);
1835
1836         disk->ev = ev;
1837 }
1838
1839 static void disk_add_events(struct gendisk *disk)
1840 {
1841         if (!disk->ev)
1842                 return;
1843
1844         /* FIXME: error handling */
1845         if (sysfs_create_files(&disk_to_dev(disk)->kobj, disk_events_attrs) < 0)
1846                 pr_warn("%s: failed to create sysfs files for events\n",
1847                         disk->disk_name);
1848
1849         mutex_lock(&disk_events_mutex);
1850         list_add_tail(&disk->ev->node, &disk_events);
1851         mutex_unlock(&disk_events_mutex);
1852
1853         /*
1854          * Block count is initialized to 1 and the following initial
1855          * unblock kicks it into action.
1856          */
1857         __disk_unblock_events(disk, true);
1858 }
1859
1860 static void disk_del_events(struct gendisk *disk)
1861 {
1862         if (!disk->ev)
1863                 return;
1864
1865         disk_block_events(disk);
1866
1867         mutex_lock(&disk_events_mutex);
1868         list_del_init(&disk->ev->node);
1869         mutex_unlock(&disk_events_mutex);
1870
1871         sysfs_remove_files(&disk_to_dev(disk)->kobj, disk_events_attrs);
1872 }
1873
1874 static void disk_release_events(struct gendisk *disk)
1875 {
1876         /* the block count should be 1 from disk_del_events() */
1877         WARN_ON_ONCE(disk->ev && disk->ev->block != 1);
1878         kfree(disk->ev);
1879 }