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