block: pass no-op callback to INIT_WORK().
[platform/kernel/linux-rpi.git] / block / partition-generic.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  *  Code extracted from drivers/block/genhd.c
4  *  Copyright (C) 1991-1998  Linus Torvalds
5  *  Re-organised Feb 1998 Russell King
6  *
7  *  We now have independent partition support from the
8  *  block drivers, which allows all the partition code to
9  *  be grouped in one location, and it to be mostly self
10  *  contained.
11  */
12
13 #include <linux/init.h>
14 #include <linux/module.h>
15 #include <linux/fs.h>
16 #include <linux/slab.h>
17 #include <linux/kmod.h>
18 #include <linux/ctype.h>
19 #include <linux/genhd.h>
20 #include <linux/blktrace_api.h>
21
22 #include "partitions/check.h"
23
24 #ifdef CONFIG_BLK_DEV_MD
25 extern void md_autodetect_dev(dev_t dev);
26 #endif
27  
28 /*
29  * disk_name() is used by partition check code and the genhd driver.
30  * It formats the devicename of the indicated disk into
31  * the supplied buffer (of size at least 32), and returns
32  * a pointer to that same buffer (for convenience).
33  */
34
35 char *disk_name(struct gendisk *hd, int partno, char *buf)
36 {
37         if (!partno)
38                 snprintf(buf, BDEVNAME_SIZE, "%s", hd->disk_name);
39         else if (isdigit(hd->disk_name[strlen(hd->disk_name)-1]))
40                 snprintf(buf, BDEVNAME_SIZE, "%sp%d", hd->disk_name, partno);
41         else
42                 snprintf(buf, BDEVNAME_SIZE, "%s%d", hd->disk_name, partno);
43
44         return buf;
45 }
46
47 const char *bdevname(struct block_device *bdev, char *buf)
48 {
49         return disk_name(bdev->bd_disk, bdev->bd_part->partno, buf);
50 }
51
52 EXPORT_SYMBOL(bdevname);
53
54 const char *bio_devname(struct bio *bio, char *buf)
55 {
56         return disk_name(bio->bi_disk, bio->bi_partno, buf);
57 }
58 EXPORT_SYMBOL(bio_devname);
59
60 /*
61  * There's very little reason to use this, you should really
62  * have a struct block_device just about everywhere and use
63  * bdevname() instead.
64  */
65 const char *__bdevname(dev_t dev, char *buffer)
66 {
67         scnprintf(buffer, BDEVNAME_SIZE, "unknown-block(%u,%u)",
68                                 MAJOR(dev), MINOR(dev));
69         return buffer;
70 }
71
72 EXPORT_SYMBOL(__bdevname);
73
74 static ssize_t part_partition_show(struct device *dev,
75                                    struct device_attribute *attr, char *buf)
76 {
77         struct hd_struct *p = dev_to_part(dev);
78
79         return sprintf(buf, "%d\n", p->partno);
80 }
81
82 static ssize_t part_start_show(struct device *dev,
83                                struct device_attribute *attr, char *buf)
84 {
85         struct hd_struct *p = dev_to_part(dev);
86
87         return sprintf(buf, "%llu\n",(unsigned long long)p->start_sect);
88 }
89
90 ssize_t part_size_show(struct device *dev,
91                        struct device_attribute *attr, char *buf)
92 {
93         struct hd_struct *p = dev_to_part(dev);
94         return sprintf(buf, "%llu\n",(unsigned long long)part_nr_sects_read(p));
95 }
96
97 static ssize_t part_ro_show(struct device *dev,
98                             struct device_attribute *attr, char *buf)
99 {
100         struct hd_struct *p = dev_to_part(dev);
101         return sprintf(buf, "%d\n", p->policy ? 1 : 0);
102 }
103
104 static ssize_t part_alignment_offset_show(struct device *dev,
105                                           struct device_attribute *attr, char *buf)
106 {
107         struct hd_struct *p = dev_to_part(dev);
108         return sprintf(buf, "%llu\n", (unsigned long long)p->alignment_offset);
109 }
110
111 static ssize_t part_discard_alignment_show(struct device *dev,
112                                            struct device_attribute *attr, char *buf)
113 {
114         struct hd_struct *p = dev_to_part(dev);
115         return sprintf(buf, "%u\n", p->discard_alignment);
116 }
117
118 ssize_t part_stat_show(struct device *dev,
119                        struct device_attribute *attr, char *buf)
120 {
121         struct hd_struct *p = dev_to_part(dev);
122         struct request_queue *q = part_to_disk(p)->queue;
123         unsigned int inflight[2];
124         int cpu;
125
126         cpu = part_stat_lock();
127         part_round_stats(q, cpu, p);
128         part_stat_unlock();
129         part_in_flight(q, p, inflight);
130         return sprintf(buf,
131                 "%8lu %8lu %8llu %8u "
132                 "%8lu %8lu %8llu %8u "
133                 "%8u %8u %8u "
134                 "%8lu %8lu %8llu %8u"
135                 "\n",
136                 part_stat_read(p, ios[STAT_READ]),
137                 part_stat_read(p, merges[STAT_READ]),
138                 (unsigned long long)part_stat_read(p, sectors[STAT_READ]),
139                 (unsigned int)part_stat_read_msecs(p, STAT_READ),
140                 part_stat_read(p, ios[STAT_WRITE]),
141                 part_stat_read(p, merges[STAT_WRITE]),
142                 (unsigned long long)part_stat_read(p, sectors[STAT_WRITE]),
143                 (unsigned int)part_stat_read_msecs(p, STAT_WRITE),
144                 inflight[0],
145                 jiffies_to_msecs(part_stat_read(p, io_ticks)),
146                 jiffies_to_msecs(part_stat_read(p, time_in_queue)),
147                 part_stat_read(p, ios[STAT_DISCARD]),
148                 part_stat_read(p, merges[STAT_DISCARD]),
149                 (unsigned long long)part_stat_read(p, sectors[STAT_DISCARD]),
150                 (unsigned int)part_stat_read_msecs(p, STAT_DISCARD));
151 }
152
153 ssize_t part_inflight_show(struct device *dev, struct device_attribute *attr,
154                            char *buf)
155 {
156         struct hd_struct *p = dev_to_part(dev);
157         struct request_queue *q = part_to_disk(p)->queue;
158         unsigned int inflight[2];
159
160         part_in_flight_rw(q, p, inflight);
161         return sprintf(buf, "%8u %8u\n", inflight[0], inflight[1]);
162 }
163
164 #ifdef CONFIG_FAIL_MAKE_REQUEST
165 ssize_t part_fail_show(struct device *dev,
166                        struct device_attribute *attr, char *buf)
167 {
168         struct hd_struct *p = dev_to_part(dev);
169
170         return sprintf(buf, "%d\n", p->make_it_fail);
171 }
172
173 ssize_t part_fail_store(struct device *dev,
174                         struct device_attribute *attr,
175                         const char *buf, size_t count)
176 {
177         struct hd_struct *p = dev_to_part(dev);
178         int i;
179
180         if (count > 0 && sscanf(buf, "%d", &i) > 0)
181                 p->make_it_fail = (i == 0) ? 0 : 1;
182
183         return count;
184 }
185 #endif
186
187 static DEVICE_ATTR(partition, 0444, part_partition_show, NULL);
188 static DEVICE_ATTR(start, 0444, part_start_show, NULL);
189 static DEVICE_ATTR(size, 0444, part_size_show, NULL);
190 static DEVICE_ATTR(ro, 0444, part_ro_show, NULL);
191 static DEVICE_ATTR(alignment_offset, 0444, part_alignment_offset_show, NULL);
192 static DEVICE_ATTR(discard_alignment, 0444, part_discard_alignment_show, NULL);
193 static DEVICE_ATTR(stat, 0444, part_stat_show, NULL);
194 static DEVICE_ATTR(inflight, 0444, part_inflight_show, NULL);
195 #ifdef CONFIG_FAIL_MAKE_REQUEST
196 static struct device_attribute dev_attr_fail =
197         __ATTR(make-it-fail, 0644, part_fail_show, part_fail_store);
198 #endif
199
200 static struct attribute *part_attrs[] = {
201         &dev_attr_partition.attr,
202         &dev_attr_start.attr,
203         &dev_attr_size.attr,
204         &dev_attr_ro.attr,
205         &dev_attr_alignment_offset.attr,
206         &dev_attr_discard_alignment.attr,
207         &dev_attr_stat.attr,
208         &dev_attr_inflight.attr,
209 #ifdef CONFIG_FAIL_MAKE_REQUEST
210         &dev_attr_fail.attr,
211 #endif
212         NULL
213 };
214
215 static struct attribute_group part_attr_group = {
216         .attrs = part_attrs,
217 };
218
219 static const struct attribute_group *part_attr_groups[] = {
220         &part_attr_group,
221 #ifdef CONFIG_BLK_DEV_IO_TRACE
222         &blk_trace_attr_group,
223 #endif
224         NULL
225 };
226
227 static void part_release(struct device *dev)
228 {
229         struct hd_struct *p = dev_to_part(dev);
230         blk_free_devt(dev->devt);
231         hd_free_part(p);
232         kfree(p);
233 }
234
235 static int part_uevent(struct device *dev, struct kobj_uevent_env *env)
236 {
237         struct hd_struct *part = dev_to_part(dev);
238
239         add_uevent_var(env, "PARTN=%u", part->partno);
240         if (part->info && part->info->volname[0])
241                 add_uevent_var(env, "PARTNAME=%s", part->info->volname);
242         return 0;
243 }
244
245 struct device_type part_type = {
246         .name           = "partition",
247         .groups         = part_attr_groups,
248         .release        = part_release,
249         .uevent         = part_uevent,
250 };
251
252 static void delete_partition_work_fn(struct work_struct *work)
253 {
254         struct hd_struct *part = container_of(to_rcu_work(work), struct hd_struct,
255                                         rcu_work);
256
257         part->start_sect = 0;
258         part->nr_sects = 0;
259         part_stat_set_all(part, 0);
260         put_device(part_to_dev(part));
261 }
262
263 void __delete_partition(struct percpu_ref *ref)
264 {
265         struct hd_struct *part = container_of(ref, struct hd_struct, ref);
266         INIT_RCU_WORK(&part->rcu_work, delete_partition_work_fn);
267         queue_rcu_work(system_wq, &part->rcu_work);
268 }
269
270 /*
271  * Must be called either with bd_mutex held, before a disk can be opened or
272  * after all disk users are gone.
273  */
274 void delete_partition(struct gendisk *disk, int partno)
275 {
276         struct disk_part_tbl *ptbl =
277                 rcu_dereference_protected(disk->part_tbl, 1);
278         struct hd_struct *part;
279
280         if (partno >= ptbl->len)
281                 return;
282
283         part = rcu_dereference_protected(ptbl->part[partno], 1);
284         if (!part)
285                 return;
286
287         rcu_assign_pointer(ptbl->part[partno], NULL);
288         rcu_assign_pointer(ptbl->last_lookup, NULL);
289         kobject_put(part->holder_dir);
290         device_del(part_to_dev(part));
291
292         hd_struct_kill(part);
293 }
294
295 static ssize_t whole_disk_show(struct device *dev,
296                                struct device_attribute *attr, char *buf)
297 {
298         return 0;
299 }
300 static DEVICE_ATTR(whole_disk, 0444, whole_disk_show, NULL);
301
302 /*
303  * Must be called either with bd_mutex held, before a disk can be opened or
304  * after all disk users are gone.
305  */
306 struct hd_struct *add_partition(struct gendisk *disk, int partno,
307                                 sector_t start, sector_t len, int flags,
308                                 struct partition_meta_info *info)
309 {
310         struct hd_struct *p;
311         dev_t devt = MKDEV(0, 0);
312         struct device *ddev = disk_to_dev(disk);
313         struct device *pdev;
314         struct disk_part_tbl *ptbl;
315         const char *dname;
316         int err;
317
318         err = disk_expand_part_tbl(disk, partno);
319         if (err)
320                 return ERR_PTR(err);
321         ptbl = rcu_dereference_protected(disk->part_tbl, 1);
322
323         if (ptbl->part[partno])
324                 return ERR_PTR(-EBUSY);
325
326         p = kzalloc(sizeof(*p), GFP_KERNEL);
327         if (!p)
328                 return ERR_PTR(-EBUSY);
329
330         if (!init_part_stats(p)) {
331                 err = -ENOMEM;
332                 goto out_free;
333         }
334
335         seqcount_init(&p->nr_sects_seq);
336         pdev = part_to_dev(p);
337
338         p->start_sect = start;
339         p->alignment_offset =
340                 queue_limit_alignment_offset(&disk->queue->limits, start);
341         p->discard_alignment =
342                 queue_limit_discard_alignment(&disk->queue->limits, start);
343         p->nr_sects = len;
344         p->partno = partno;
345         p->policy = get_disk_ro(disk);
346
347         if (info) {
348                 struct partition_meta_info *pinfo = alloc_part_info(disk);
349                 if (!pinfo) {
350                         err = -ENOMEM;
351                         goto out_free_stats;
352                 }
353                 memcpy(pinfo, info, sizeof(*info));
354                 p->info = pinfo;
355         }
356
357         dname = dev_name(ddev);
358         if (isdigit(dname[strlen(dname) - 1]))
359                 dev_set_name(pdev, "%sp%d", dname, partno);
360         else
361                 dev_set_name(pdev, "%s%d", dname, partno);
362
363         device_initialize(pdev);
364         pdev->class = &block_class;
365         pdev->type = &part_type;
366         pdev->parent = ddev;
367
368         err = blk_alloc_devt(p, &devt);
369         if (err)
370                 goto out_free_info;
371         pdev->devt = devt;
372
373         /* delay uevent until 'holders' subdir is created */
374         dev_set_uevent_suppress(pdev, 1);
375         err = device_add(pdev);
376         if (err)
377                 goto out_put;
378
379         err = -ENOMEM;
380         p->holder_dir = kobject_create_and_add("holders", &pdev->kobj);
381         if (!p->holder_dir)
382                 goto out_del;
383
384         dev_set_uevent_suppress(pdev, 0);
385         if (flags & ADDPART_FLAG_WHOLEDISK) {
386                 err = device_create_file(pdev, &dev_attr_whole_disk);
387                 if (err)
388                         goto out_del;
389         }
390
391         err = hd_ref_init(p);
392         if (err) {
393                 if (flags & ADDPART_FLAG_WHOLEDISK)
394                         goto out_remove_file;
395                 goto out_del;
396         }
397
398         /* everything is up and running, commence */
399         rcu_assign_pointer(ptbl->part[partno], p);
400
401         /* suppress uevent if the disk suppresses it */
402         if (!dev_get_uevent_suppress(ddev))
403                 kobject_uevent(&pdev->kobj, KOBJ_ADD);
404         return p;
405
406 out_free_info:
407         free_part_info(p);
408 out_free_stats:
409         free_part_stats(p);
410 out_free:
411         kfree(p);
412         return ERR_PTR(err);
413 out_remove_file:
414         device_remove_file(pdev, &dev_attr_whole_disk);
415 out_del:
416         kobject_put(p->holder_dir);
417         device_del(pdev);
418 out_put:
419         put_device(pdev);
420         return ERR_PTR(err);
421 }
422
423 static bool disk_unlock_native_capacity(struct gendisk *disk)
424 {
425         const struct block_device_operations *bdops = disk->fops;
426
427         if (bdops->unlock_native_capacity &&
428             !(disk->flags & GENHD_FL_NATIVE_CAPACITY)) {
429                 printk(KERN_CONT "enabling native capacity\n");
430                 bdops->unlock_native_capacity(disk);
431                 disk->flags |= GENHD_FL_NATIVE_CAPACITY;
432                 return true;
433         } else {
434                 printk(KERN_CONT "truncated\n");
435                 return false;
436         }
437 }
438
439 static int drop_partitions(struct gendisk *disk, struct block_device *bdev)
440 {
441         struct disk_part_iter piter;
442         struct hd_struct *part;
443         int res;
444
445         if (bdev->bd_part_count || bdev->bd_super)
446                 return -EBUSY;
447         res = invalidate_partition(disk, 0);
448         if (res)
449                 return res;
450
451         disk_part_iter_init(&piter, disk, DISK_PITER_INCL_EMPTY);
452         while ((part = disk_part_iter_next(&piter)))
453                 delete_partition(disk, part->partno);
454         disk_part_iter_exit(&piter);
455
456         return 0;
457 }
458
459 static bool part_zone_aligned(struct gendisk *disk,
460                               struct block_device *bdev,
461                               sector_t from, sector_t size)
462 {
463         unsigned int zone_sectors = bdev_zone_sectors(bdev);
464
465         /*
466          * If this function is called, then the disk is a zoned block device
467          * (host-aware or host-managed). This can be detected even if the
468          * zoned block device support is disabled (CONFIG_BLK_DEV_ZONED not
469          * set). In this case, however, only host-aware devices will be seen
470          * as a block device is not created for host-managed devices. Without
471          * zoned block device support, host-aware drives can still be used as
472          * regular block devices (no zone operation) and their zone size will
473          * be reported as 0. Allow this case.
474          */
475         if (!zone_sectors)
476                 return true;
477
478         /*
479          * Check partition start and size alignement. If the drive has a
480          * smaller last runt zone, ignore it and allow the partition to
481          * use it. Check the zone size too: it should be a power of 2 number
482          * of sectors.
483          */
484         if (WARN_ON_ONCE(!is_power_of_2(zone_sectors))) {
485                 u32 rem;
486
487                 div_u64_rem(from, zone_sectors, &rem);
488                 if (rem)
489                         return false;
490                 if ((from + size) < get_capacity(disk)) {
491                         div_u64_rem(size, zone_sectors, &rem);
492                         if (rem)
493                                 return false;
494                 }
495
496         } else {
497
498                 if (from & (zone_sectors - 1))
499                         return false;
500                 if ((from + size) < get_capacity(disk) &&
501                     (size & (zone_sectors - 1)))
502                         return false;
503
504         }
505
506         return true;
507 }
508
509 int rescan_partitions(struct gendisk *disk, struct block_device *bdev)
510 {
511         struct parsed_partitions *state = NULL;
512         struct hd_struct *part;
513         int p, highest, res;
514 rescan:
515         if (state && !IS_ERR(state)) {
516                 free_partitions(state);
517                 state = NULL;
518         }
519
520         res = drop_partitions(disk, bdev);
521         if (res)
522                 return res;
523
524         if (disk->fops->revalidate_disk)
525                 disk->fops->revalidate_disk(disk);
526         check_disk_size_change(disk, bdev, true);
527         bdev->bd_invalidated = 0;
528         if (!get_capacity(disk) || !(state = check_partition(disk, bdev)))
529                 return 0;
530         if (IS_ERR(state)) {
531                 /*
532                  * I/O error reading the partition table.  If any
533                  * partition code tried to read beyond EOD, retry
534                  * after unlocking native capacity.
535                  */
536                 if (PTR_ERR(state) == -ENOSPC) {
537                         printk(KERN_WARNING "%s: partition table beyond EOD, ",
538                                disk->disk_name);
539                         if (disk_unlock_native_capacity(disk))
540                                 goto rescan;
541                 }
542                 return -EIO;
543         }
544         /*
545          * If any partition code tried to read beyond EOD, try
546          * unlocking native capacity even if partition table is
547          * successfully read as we could be missing some partitions.
548          */
549         if (state->access_beyond_eod) {
550                 printk(KERN_WARNING
551                        "%s: partition table partially beyond EOD, ",
552                        disk->disk_name);
553                 if (disk_unlock_native_capacity(disk))
554                         goto rescan;
555         }
556
557         /* tell userspace that the media / partition table may have changed */
558         kobject_uevent(&disk_to_dev(disk)->kobj, KOBJ_CHANGE);
559
560         /* Detect the highest partition number and preallocate
561          * disk->part_tbl.  This is an optimization and not strictly
562          * necessary.
563          */
564         for (p = 1, highest = 0; p < state->limit; p++)
565                 if (state->parts[p].size)
566                         highest = p;
567
568         disk_expand_part_tbl(disk, highest);
569
570         /* add partitions */
571         for (p = 1; p < state->limit; p++) {
572                 sector_t size, from;
573
574                 size = state->parts[p].size;
575                 if (!size)
576                         continue;
577
578                 from = state->parts[p].from;
579                 if (from >= get_capacity(disk)) {
580                         printk(KERN_WARNING
581                                "%s: p%d start %llu is beyond EOD, ",
582                                disk->disk_name, p, (unsigned long long) from);
583                         if (disk_unlock_native_capacity(disk))
584                                 goto rescan;
585                         continue;
586                 }
587
588                 if (from + size > get_capacity(disk)) {
589                         printk(KERN_WARNING
590                                "%s: p%d size %llu extends beyond EOD, ",
591                                disk->disk_name, p, (unsigned long long) size);
592
593                         if (disk_unlock_native_capacity(disk)) {
594                                 /* free state and restart */
595                                 goto rescan;
596                         } else {
597                                 /*
598                                  * we can not ignore partitions of broken tables
599                                  * created by for example camera firmware, but
600                                  * we limit them to the end of the disk to avoid
601                                  * creating invalid block devices
602                                  */
603                                 size = get_capacity(disk) - from;
604                         }
605                 }
606
607                 /*
608                  * On a zoned block device, partitions should be aligned on the
609                  * device zone size (i.e. zone boundary crossing not allowed).
610                  * Otherwise, resetting the write pointer of the last zone of
611                  * one partition may impact the following partition.
612                  */
613                 if (bdev_is_zoned(bdev) &&
614                     !part_zone_aligned(disk, bdev, from, size)) {
615                         printk(KERN_WARNING
616                                "%s: p%d start %llu+%llu is not zone aligned\n",
617                                disk->disk_name, p, (unsigned long long) from,
618                                (unsigned long long) size);
619                         continue;
620                 }
621
622                 part = add_partition(disk, p, from, size,
623                                      state->parts[p].flags,
624                                      &state->parts[p].info);
625                 if (IS_ERR(part)) {
626                         printk(KERN_ERR " %s: p%d could not be added: %ld\n",
627                                disk->disk_name, p, -PTR_ERR(part));
628                         continue;
629                 }
630 #ifdef CONFIG_BLK_DEV_MD
631                 if (state->parts[p].flags & ADDPART_FLAG_RAID)
632                         md_autodetect_dev(part_to_dev(part)->devt);
633 #endif
634         }
635         free_partitions(state);
636         return 0;
637 }
638
639 int invalidate_partitions(struct gendisk *disk, struct block_device *bdev)
640 {
641         int res;
642
643         if (!bdev->bd_invalidated)
644                 return 0;
645
646         res = drop_partitions(disk, bdev);
647         if (res)
648                 return res;
649
650         set_capacity(disk, 0);
651         check_disk_size_change(disk, bdev, false);
652         bdev->bd_invalidated = 0;
653         /* tell userspace that the media / partition table may have changed */
654         kobject_uevent(&disk_to_dev(disk)->kobj, KOBJ_CHANGE);
655
656         return 0;
657 }
658
659 unsigned char *read_dev_sector(struct block_device *bdev, sector_t n, Sector *p)
660 {
661         struct address_space *mapping = bdev->bd_inode->i_mapping;
662         struct page *page;
663
664         page = read_mapping_page(mapping, (pgoff_t)(n >> (PAGE_SHIFT-9)), NULL);
665         if (!IS_ERR(page)) {
666                 if (PageError(page))
667                         goto fail;
668                 p->v = page;
669                 return (unsigned char *)page_address(page) +  ((n & ((1 << (PAGE_SHIFT - 9)) - 1)) << 9);
670 fail:
671                 put_page(page);
672         }
673         p->v = NULL;
674         return NULL;
675 }
676
677 EXPORT_SYMBOL(read_dev_sector);