GNU Linux-libre 4.19.314-gnu1
[releases.git] / drivers / mtd / ubi / build.c
1 /*
2  * Copyright (c) International Business Machines Corp., 2006
3  * Copyright (c) Nokia Corporation, 2007
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; either version 2 of the License, or
8  * (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See
13  * the GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program; if not, write to the Free Software
17  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
18  *
19  * Author: Artem Bityutskiy (Битюцкий Артём),
20  *         Frank Haverkamp
21  */
22
23 /*
24  * This file includes UBI initialization and building of UBI devices.
25  *
26  * When UBI is initialized, it attaches all the MTD devices specified as the
27  * module load parameters or the kernel boot parameters. If MTD devices were
28  * specified, UBI does not attach any MTD device, but it is possible to do
29  * later using the "UBI control device".
30  */
31
32 #include <linux/err.h>
33 #include <linux/module.h>
34 #include <linux/moduleparam.h>
35 #include <linux/stringify.h>
36 #include <linux/namei.h>
37 #include <linux/stat.h>
38 #include <linux/miscdevice.h>
39 #include <linux/mtd/partitions.h>
40 #include <linux/log2.h>
41 #include <linux/kthread.h>
42 #include <linux/kernel.h>
43 #include <linux/slab.h>
44 #include <linux/major.h>
45 #include "ubi.h"
46
47 /* Maximum length of the 'mtd=' parameter */
48 #define MTD_PARAM_LEN_MAX 64
49
50 /* Maximum number of comma-separated items in the 'mtd=' parameter */
51 #define MTD_PARAM_MAX_COUNT 4
52
53 /* Maximum value for the number of bad PEBs per 1024 PEBs */
54 #define MAX_MTD_UBI_BEB_LIMIT 768
55
56 #ifdef CONFIG_MTD_UBI_MODULE
57 #define ubi_is_module() 1
58 #else
59 #define ubi_is_module() 0
60 #endif
61
62 /**
63  * struct mtd_dev_param - MTD device parameter description data structure.
64  * @name: MTD character device node path, MTD device name, or MTD device number
65  *        string
66  * @vid_hdr_offs: VID header offset
67  * @max_beb_per1024: maximum expected number of bad PEBs per 1024 PEBs
68  */
69 struct mtd_dev_param {
70         char name[MTD_PARAM_LEN_MAX];
71         int ubi_num;
72         int vid_hdr_offs;
73         int max_beb_per1024;
74 };
75
76 /* Numbers of elements set in the @mtd_dev_param array */
77 static int mtd_devs;
78
79 /* MTD devices specification parameters */
80 static struct mtd_dev_param mtd_dev_param[UBI_MAX_DEVICES];
81 #ifdef CONFIG_MTD_UBI_FASTMAP
82 /* UBI module parameter to enable fastmap automatically on non-fastmap images */
83 static bool fm_autoconvert;
84 static bool fm_debug;
85 #endif
86
87 /* Slab cache for wear-leveling entries */
88 struct kmem_cache *ubi_wl_entry_slab;
89
90 /* UBI control character device */
91 static struct miscdevice ubi_ctrl_cdev = {
92         .minor = MISC_DYNAMIC_MINOR,
93         .name = "ubi_ctrl",
94         .fops = &ubi_ctrl_cdev_operations,
95 };
96
97 /* All UBI devices in system */
98 static struct ubi_device *ubi_devices[UBI_MAX_DEVICES];
99
100 /* Serializes UBI devices creations and removals */
101 DEFINE_MUTEX(ubi_devices_mutex);
102
103 /* Protects @ubi_devices and @ubi->ref_count */
104 static DEFINE_SPINLOCK(ubi_devices_lock);
105
106 /* "Show" method for files in '/<sysfs>/class/ubi/' */
107 /* UBI version attribute ('/<sysfs>/class/ubi/version') */
108 static ssize_t version_show(struct class *class, struct class_attribute *attr,
109                             char *buf)
110 {
111         return sprintf(buf, "%d\n", UBI_VERSION);
112 }
113 static CLASS_ATTR_RO(version);
114
115 static struct attribute *ubi_class_attrs[] = {
116         &class_attr_version.attr,
117         NULL,
118 };
119 ATTRIBUTE_GROUPS(ubi_class);
120
121 /* Root UBI "class" object (corresponds to '/<sysfs>/class/ubi/') */
122 struct class ubi_class = {
123         .name           = UBI_NAME_STR,
124         .owner          = THIS_MODULE,
125         .class_groups   = ubi_class_groups,
126 };
127
128 static ssize_t dev_attribute_show(struct device *dev,
129                                   struct device_attribute *attr, char *buf);
130
131 /* UBI device attributes (correspond to files in '/<sysfs>/class/ubi/ubiX') */
132 static struct device_attribute dev_eraseblock_size =
133         __ATTR(eraseblock_size, S_IRUGO, dev_attribute_show, NULL);
134 static struct device_attribute dev_avail_eraseblocks =
135         __ATTR(avail_eraseblocks, S_IRUGO, dev_attribute_show, NULL);
136 static struct device_attribute dev_total_eraseblocks =
137         __ATTR(total_eraseblocks, S_IRUGO, dev_attribute_show, NULL);
138 static struct device_attribute dev_volumes_count =
139         __ATTR(volumes_count, S_IRUGO, dev_attribute_show, NULL);
140 static struct device_attribute dev_max_ec =
141         __ATTR(max_ec, S_IRUGO, dev_attribute_show, NULL);
142 static struct device_attribute dev_reserved_for_bad =
143         __ATTR(reserved_for_bad, S_IRUGO, dev_attribute_show, NULL);
144 static struct device_attribute dev_bad_peb_count =
145         __ATTR(bad_peb_count, S_IRUGO, dev_attribute_show, NULL);
146 static struct device_attribute dev_max_vol_count =
147         __ATTR(max_vol_count, S_IRUGO, dev_attribute_show, NULL);
148 static struct device_attribute dev_min_io_size =
149         __ATTR(min_io_size, S_IRUGO, dev_attribute_show, NULL);
150 static struct device_attribute dev_bgt_enabled =
151         __ATTR(bgt_enabled, S_IRUGO, dev_attribute_show, NULL);
152 static struct device_attribute dev_mtd_num =
153         __ATTR(mtd_num, S_IRUGO, dev_attribute_show, NULL);
154 static struct device_attribute dev_ro_mode =
155         __ATTR(ro_mode, S_IRUGO, dev_attribute_show, NULL);
156
157 /**
158  * ubi_volume_notify - send a volume change notification.
159  * @ubi: UBI device description object
160  * @vol: volume description object of the changed volume
161  * @ntype: notification type to send (%UBI_VOLUME_ADDED, etc)
162  *
163  * This is a helper function which notifies all subscribers about a volume
164  * change event (creation, removal, re-sizing, re-naming, updating). Returns
165  * zero in case of success and a negative error code in case of failure.
166  */
167 int ubi_volume_notify(struct ubi_device *ubi, struct ubi_volume *vol, int ntype)
168 {
169         int ret;
170         struct ubi_notification nt;
171
172         ubi_do_get_device_info(ubi, &nt.di);
173         ubi_do_get_volume_info(ubi, vol, &nt.vi);
174
175         switch (ntype) {
176         case UBI_VOLUME_ADDED:
177         case UBI_VOLUME_REMOVED:
178         case UBI_VOLUME_RESIZED:
179         case UBI_VOLUME_RENAMED:
180                 ret = ubi_update_fastmap(ubi);
181                 if (ret)
182                         ubi_msg(ubi, "Unable to write a new fastmap: %i", ret);
183         }
184
185         return blocking_notifier_call_chain(&ubi_notifiers, ntype, &nt);
186 }
187
188 /**
189  * ubi_notify_all - send a notification to all volumes.
190  * @ubi: UBI device description object
191  * @ntype: notification type to send (%UBI_VOLUME_ADDED, etc)
192  * @nb: the notifier to call
193  *
194  * This function walks all volumes of UBI device @ubi and sends the @ntype
195  * notification for each volume. If @nb is %NULL, then all registered notifiers
196  * are called, otherwise only the @nb notifier is called. Returns the number of
197  * sent notifications.
198  */
199 int ubi_notify_all(struct ubi_device *ubi, int ntype, struct notifier_block *nb)
200 {
201         struct ubi_notification nt;
202         int i, count = 0;
203
204         ubi_do_get_device_info(ubi, &nt.di);
205
206         mutex_lock(&ubi->device_mutex);
207         for (i = 0; i < ubi->vtbl_slots; i++) {
208                 /*
209                  * Since the @ubi->device is locked, and we are not going to
210                  * change @ubi->volumes, we do not have to lock
211                  * @ubi->volumes_lock.
212                  */
213                 if (!ubi->volumes[i])
214                         continue;
215
216                 ubi_do_get_volume_info(ubi, ubi->volumes[i], &nt.vi);
217                 if (nb)
218                         nb->notifier_call(nb, ntype, &nt);
219                 else
220                         blocking_notifier_call_chain(&ubi_notifiers, ntype,
221                                                      &nt);
222                 count += 1;
223         }
224         mutex_unlock(&ubi->device_mutex);
225
226         return count;
227 }
228
229 /**
230  * ubi_enumerate_volumes - send "add" notification for all existing volumes.
231  * @nb: the notifier to call
232  *
233  * This function walks all UBI devices and volumes and sends the
234  * %UBI_VOLUME_ADDED notification for each volume. If @nb is %NULL, then all
235  * registered notifiers are called, otherwise only the @nb notifier is called.
236  * Returns the number of sent notifications.
237  */
238 int ubi_enumerate_volumes(struct notifier_block *nb)
239 {
240         int i, count = 0;
241
242         /*
243          * Since the @ubi_devices_mutex is locked, and we are not going to
244          * change @ubi_devices, we do not have to lock @ubi_devices_lock.
245          */
246         for (i = 0; i < UBI_MAX_DEVICES; i++) {
247                 struct ubi_device *ubi = ubi_devices[i];
248
249                 if (!ubi)
250                         continue;
251                 count += ubi_notify_all(ubi, UBI_VOLUME_ADDED, nb);
252         }
253
254         return count;
255 }
256
257 /**
258  * ubi_get_device - get UBI device.
259  * @ubi_num: UBI device number
260  *
261  * This function returns UBI device description object for UBI device number
262  * @ubi_num, or %NULL if the device does not exist. This function increases the
263  * device reference count to prevent removal of the device. In other words, the
264  * device cannot be removed if its reference count is not zero.
265  */
266 struct ubi_device *ubi_get_device(int ubi_num)
267 {
268         struct ubi_device *ubi;
269
270         spin_lock(&ubi_devices_lock);
271         ubi = ubi_devices[ubi_num];
272         if (ubi) {
273                 ubi_assert(ubi->ref_count >= 0);
274                 ubi->ref_count += 1;
275                 get_device(&ubi->dev);
276         }
277         spin_unlock(&ubi_devices_lock);
278
279         return ubi;
280 }
281
282 /**
283  * ubi_put_device - drop an UBI device reference.
284  * @ubi: UBI device description object
285  */
286 void ubi_put_device(struct ubi_device *ubi)
287 {
288         spin_lock(&ubi_devices_lock);
289         ubi->ref_count -= 1;
290         put_device(&ubi->dev);
291         spin_unlock(&ubi_devices_lock);
292 }
293
294 /**
295  * ubi_get_by_major - get UBI device by character device major number.
296  * @major: major number
297  *
298  * This function is similar to 'ubi_get_device()', but it searches the device
299  * by its major number.
300  */
301 struct ubi_device *ubi_get_by_major(int major)
302 {
303         int i;
304         struct ubi_device *ubi;
305
306         spin_lock(&ubi_devices_lock);
307         for (i = 0; i < UBI_MAX_DEVICES; i++) {
308                 ubi = ubi_devices[i];
309                 if (ubi && MAJOR(ubi->cdev.dev) == major) {
310                         ubi_assert(ubi->ref_count >= 0);
311                         ubi->ref_count += 1;
312                         get_device(&ubi->dev);
313                         spin_unlock(&ubi_devices_lock);
314                         return ubi;
315                 }
316         }
317         spin_unlock(&ubi_devices_lock);
318
319         return NULL;
320 }
321
322 /**
323  * ubi_major2num - get UBI device number by character device major number.
324  * @major: major number
325  *
326  * This function searches UBI device number object by its major number. If UBI
327  * device was not found, this function returns -ENODEV, otherwise the UBI device
328  * number is returned.
329  */
330 int ubi_major2num(int major)
331 {
332         int i, ubi_num = -ENODEV;
333
334         spin_lock(&ubi_devices_lock);
335         for (i = 0; i < UBI_MAX_DEVICES; i++) {
336                 struct ubi_device *ubi = ubi_devices[i];
337
338                 if (ubi && MAJOR(ubi->cdev.dev) == major) {
339                         ubi_num = ubi->ubi_num;
340                         break;
341                 }
342         }
343         spin_unlock(&ubi_devices_lock);
344
345         return ubi_num;
346 }
347
348 /* "Show" method for files in '/<sysfs>/class/ubi/ubiX/' */
349 static ssize_t dev_attribute_show(struct device *dev,
350                                   struct device_attribute *attr, char *buf)
351 {
352         ssize_t ret;
353         struct ubi_device *ubi;
354
355         /*
356          * The below code looks weird, but it actually makes sense. We get the
357          * UBI device reference from the contained 'struct ubi_device'. But it
358          * is unclear if the device was removed or not yet. Indeed, if the
359          * device was removed before we increased its reference count,
360          * 'ubi_get_device()' will return -ENODEV and we fail.
361          *
362          * Remember, 'struct ubi_device' is freed in the release function, so
363          * we still can use 'ubi->ubi_num'.
364          */
365         ubi = container_of(dev, struct ubi_device, dev);
366
367         if (attr == &dev_eraseblock_size)
368                 ret = sprintf(buf, "%d\n", ubi->leb_size);
369         else if (attr == &dev_avail_eraseblocks)
370                 ret = sprintf(buf, "%d\n", ubi->avail_pebs);
371         else if (attr == &dev_total_eraseblocks)
372                 ret = sprintf(buf, "%d\n", ubi->good_peb_count);
373         else if (attr == &dev_volumes_count)
374                 ret = sprintf(buf, "%d\n", ubi->vol_count - UBI_INT_VOL_COUNT);
375         else if (attr == &dev_max_ec)
376                 ret = sprintf(buf, "%d\n", ubi->max_ec);
377         else if (attr == &dev_reserved_for_bad)
378                 ret = sprintf(buf, "%d\n", ubi->beb_rsvd_pebs);
379         else if (attr == &dev_bad_peb_count)
380                 ret = sprintf(buf, "%d\n", ubi->bad_peb_count);
381         else if (attr == &dev_max_vol_count)
382                 ret = sprintf(buf, "%d\n", ubi->vtbl_slots);
383         else if (attr == &dev_min_io_size)
384                 ret = sprintf(buf, "%d\n", ubi->min_io_size);
385         else if (attr == &dev_bgt_enabled)
386                 ret = sprintf(buf, "%d\n", ubi->thread_enabled);
387         else if (attr == &dev_mtd_num)
388                 ret = sprintf(buf, "%d\n", ubi->mtd->index);
389         else if (attr == &dev_ro_mode)
390                 ret = sprintf(buf, "%d\n", ubi->ro_mode);
391         else
392                 ret = -EINVAL;
393
394         return ret;
395 }
396
397 static struct attribute *ubi_dev_attrs[] = {
398         &dev_eraseblock_size.attr,
399         &dev_avail_eraseblocks.attr,
400         &dev_total_eraseblocks.attr,
401         &dev_volumes_count.attr,
402         &dev_max_ec.attr,
403         &dev_reserved_for_bad.attr,
404         &dev_bad_peb_count.attr,
405         &dev_max_vol_count.attr,
406         &dev_min_io_size.attr,
407         &dev_bgt_enabled.attr,
408         &dev_mtd_num.attr,
409         &dev_ro_mode.attr,
410         NULL
411 };
412 ATTRIBUTE_GROUPS(ubi_dev);
413
414 static void dev_release(struct device *dev)
415 {
416         struct ubi_device *ubi = container_of(dev, struct ubi_device, dev);
417
418         kfree(ubi);
419 }
420
421 /**
422  * kill_volumes - destroy all user volumes.
423  * @ubi: UBI device description object
424  */
425 static void kill_volumes(struct ubi_device *ubi)
426 {
427         int i;
428
429         for (i = 0; i < ubi->vtbl_slots; i++)
430                 if (ubi->volumes[i])
431                         ubi_free_volume(ubi, ubi->volumes[i]);
432 }
433
434 /**
435  * uif_init - initialize user interfaces for an UBI device.
436  * @ubi: UBI device description object
437  *
438  * This function initializes various user interfaces for an UBI device. If the
439  * initialization fails at an early stage, this function frees all the
440  * resources it allocated, returns an error.
441  *
442  * This function returns zero in case of success and a negative error code in
443  * case of failure.
444  */
445 static int uif_init(struct ubi_device *ubi)
446 {
447         int i, err;
448         dev_t dev;
449
450         sprintf(ubi->ubi_name, UBI_NAME_STR "%d", ubi->ubi_num);
451
452         /*
453          * Major numbers for the UBI character devices are allocated
454          * dynamically. Major numbers of volume character devices are
455          * equivalent to ones of the corresponding UBI character device. Minor
456          * numbers of UBI character devices are 0, while minor numbers of
457          * volume character devices start from 1. Thus, we allocate one major
458          * number and ubi->vtbl_slots + 1 minor numbers.
459          */
460         err = alloc_chrdev_region(&dev, 0, ubi->vtbl_slots + 1, ubi->ubi_name);
461         if (err) {
462                 ubi_err(ubi, "cannot register UBI character devices");
463                 return err;
464         }
465
466         ubi->dev.devt = dev;
467
468         ubi_assert(MINOR(dev) == 0);
469         cdev_init(&ubi->cdev, &ubi_cdev_operations);
470         dbg_gen("%s major is %u", ubi->ubi_name, MAJOR(dev));
471         ubi->cdev.owner = THIS_MODULE;
472
473         dev_set_name(&ubi->dev, UBI_NAME_STR "%d", ubi->ubi_num);
474         err = cdev_device_add(&ubi->cdev, &ubi->dev);
475         if (err)
476                 goto out_unreg;
477
478         for (i = 0; i < ubi->vtbl_slots; i++)
479                 if (ubi->volumes[i]) {
480                         err = ubi_add_volume(ubi, ubi->volumes[i]);
481                         if (err) {
482                                 ubi_err(ubi, "cannot add volume %d", i);
483                                 ubi->volumes[i] = NULL;
484                                 goto out_volumes;
485                         }
486                 }
487
488         return 0;
489
490 out_volumes:
491         kill_volumes(ubi);
492         cdev_device_del(&ubi->cdev, &ubi->dev);
493 out_unreg:
494         unregister_chrdev_region(ubi->cdev.dev, ubi->vtbl_slots + 1);
495         ubi_err(ubi, "cannot initialize UBI %s, error %d",
496                 ubi->ubi_name, err);
497         return err;
498 }
499
500 /**
501  * uif_close - close user interfaces for an UBI device.
502  * @ubi: UBI device description object
503  *
504  * Note, since this function un-registers UBI volume device objects (@vol->dev),
505  * the memory allocated voe the volumes is freed as well (in the release
506  * function).
507  */
508 static void uif_close(struct ubi_device *ubi)
509 {
510         kill_volumes(ubi);
511         cdev_device_del(&ubi->cdev, &ubi->dev);
512         unregister_chrdev_region(ubi->cdev.dev, ubi->vtbl_slots + 1);
513 }
514
515 /**
516  * ubi_free_internal_volumes - free internal volumes.
517  * @ubi: UBI device description object
518  */
519 void ubi_free_internal_volumes(struct ubi_device *ubi)
520 {
521         int i;
522
523         for (i = ubi->vtbl_slots;
524              i < ubi->vtbl_slots + UBI_INT_VOL_COUNT; i++) {
525                 ubi_eba_replace_table(ubi->volumes[i], NULL);
526                 ubi_fastmap_destroy_checkmap(ubi->volumes[i]);
527                 kfree(ubi->volumes[i]);
528         }
529 }
530
531 static int get_bad_peb_limit(const struct ubi_device *ubi, int max_beb_per1024)
532 {
533         int limit, device_pebs;
534         uint64_t device_size;
535
536         if (!max_beb_per1024) {
537                 /*
538                  * Since max_beb_per1024 has not been set by the user in either
539                  * the cmdline or Kconfig, use mtd_max_bad_blocks to set the
540                  * limit if it is supported by the device.
541                  */
542                 limit = mtd_max_bad_blocks(ubi->mtd, 0, ubi->mtd->size);
543                 if (limit < 0)
544                         return 0;
545                 return limit;
546         }
547
548         /*
549          * Here we are using size of the entire flash chip and
550          * not just the MTD partition size because the maximum
551          * number of bad eraseblocks is a percentage of the
552          * whole device and bad eraseblocks are not fairly
553          * distributed over the flash chip. So the worst case
554          * is that all the bad eraseblocks of the chip are in
555          * the MTD partition we are attaching (ubi->mtd).
556          */
557         device_size = mtd_get_device_size(ubi->mtd);
558         device_pebs = mtd_div_by_eb(device_size, ubi->mtd);
559         limit = mult_frac(device_pebs, max_beb_per1024, 1024);
560
561         /* Round it up */
562         if (mult_frac(limit, 1024, max_beb_per1024) < device_pebs)
563                 limit += 1;
564
565         return limit;
566 }
567
568 /**
569  * io_init - initialize I/O sub-system for a given UBI device.
570  * @ubi: UBI device description object
571  * @max_beb_per1024: maximum expected number of bad PEB per 1024 PEBs
572  *
573  * If @ubi->vid_hdr_offset or @ubi->leb_start is zero, default offsets are
574  * assumed:
575  *   o EC header is always at offset zero - this cannot be changed;
576  *   o VID header starts just after the EC header at the closest address
577  *     aligned to @io->hdrs_min_io_size;
578  *   o data starts just after the VID header at the closest address aligned to
579  *     @io->min_io_size
580  *
581  * This function returns zero in case of success and a negative error code in
582  * case of failure.
583  */
584 static int io_init(struct ubi_device *ubi, int max_beb_per1024)
585 {
586         dbg_gen("sizeof(struct ubi_ainf_peb) %zu", sizeof(struct ubi_ainf_peb));
587         dbg_gen("sizeof(struct ubi_wl_entry) %zu", sizeof(struct ubi_wl_entry));
588
589         if (ubi->mtd->numeraseregions != 0) {
590                 /*
591                  * Some flashes have several erase regions. Different regions
592                  * may have different eraseblock size and other
593                  * characteristics. It looks like mostly multi-region flashes
594                  * have one "main" region and one or more small regions to
595                  * store boot loader code or boot parameters or whatever. I
596                  * guess we should just pick the largest region. But this is
597                  * not implemented.
598                  */
599                 ubi_err(ubi, "multiple regions, not implemented");
600                 return -EINVAL;
601         }
602
603         if (ubi->vid_hdr_offset < 0)
604                 return -EINVAL;
605
606         /*
607          * Note, in this implementation we support MTD devices with 0x7FFFFFFF
608          * physical eraseblocks maximum.
609          */
610
611         ubi->peb_size   = ubi->mtd->erasesize;
612         ubi->peb_count  = mtd_div_by_eb(ubi->mtd->size, ubi->mtd);
613         ubi->flash_size = ubi->mtd->size;
614
615         if (mtd_can_have_bb(ubi->mtd)) {
616                 ubi->bad_allowed = 1;
617                 ubi->bad_peb_limit = get_bad_peb_limit(ubi, max_beb_per1024);
618         }
619
620         if (ubi->mtd->type == MTD_NORFLASH) {
621                 ubi_assert(ubi->mtd->writesize == 1);
622                 ubi->nor_flash = 1;
623         }
624
625         ubi->min_io_size = ubi->mtd->writesize;
626         ubi->hdrs_min_io_size = ubi->mtd->writesize >> ubi->mtd->subpage_sft;
627
628         /*
629          * Make sure minimal I/O unit is power of 2. Note, there is no
630          * fundamental reason for this assumption. It is just an optimization
631          * which allows us to avoid costly division operations.
632          */
633         if (!is_power_of_2(ubi->min_io_size)) {
634                 ubi_err(ubi, "min. I/O unit (%d) is not power of 2",
635                         ubi->min_io_size);
636                 return -EINVAL;
637         }
638
639         ubi_assert(ubi->hdrs_min_io_size > 0);
640         ubi_assert(ubi->hdrs_min_io_size <= ubi->min_io_size);
641         ubi_assert(ubi->min_io_size % ubi->hdrs_min_io_size == 0);
642
643         ubi->max_write_size = ubi->mtd->writebufsize;
644         /*
645          * Maximum write size has to be greater or equivalent to min. I/O
646          * size, and be multiple of min. I/O size.
647          */
648         if (ubi->max_write_size < ubi->min_io_size ||
649             ubi->max_write_size % ubi->min_io_size ||
650             !is_power_of_2(ubi->max_write_size)) {
651                 ubi_err(ubi, "bad write buffer size %d for %d min. I/O unit",
652                         ubi->max_write_size, ubi->min_io_size);
653                 return -EINVAL;
654         }
655
656         /* Calculate default aligned sizes of EC and VID headers */
657         ubi->ec_hdr_alsize = ALIGN(UBI_EC_HDR_SIZE, ubi->hdrs_min_io_size);
658         ubi->vid_hdr_alsize = ALIGN(UBI_VID_HDR_SIZE, ubi->hdrs_min_io_size);
659
660         dbg_gen("min_io_size      %d", ubi->min_io_size);
661         dbg_gen("max_write_size   %d", ubi->max_write_size);
662         dbg_gen("hdrs_min_io_size %d", ubi->hdrs_min_io_size);
663         dbg_gen("ec_hdr_alsize    %d", ubi->ec_hdr_alsize);
664         dbg_gen("vid_hdr_alsize   %d", ubi->vid_hdr_alsize);
665
666         if (ubi->vid_hdr_offset == 0)
667                 /* Default offset */
668                 ubi->vid_hdr_offset = ubi->vid_hdr_aloffset =
669                                       ubi->ec_hdr_alsize;
670         else {
671                 ubi->vid_hdr_aloffset = ubi->vid_hdr_offset &
672                                                 ~(ubi->hdrs_min_io_size - 1);
673                 ubi->vid_hdr_shift = ubi->vid_hdr_offset -
674                                                 ubi->vid_hdr_aloffset;
675         }
676
677         /*
678          * Memory allocation for VID header is ubi->vid_hdr_alsize
679          * which is described in comments in io.c.
680          * Make sure VID header shift + UBI_VID_HDR_SIZE not exceeds
681          * ubi->vid_hdr_alsize, so that all vid header operations
682          * won't access memory out of bounds.
683          */
684         if ((ubi->vid_hdr_shift + UBI_VID_HDR_SIZE) > ubi->vid_hdr_alsize) {
685                 ubi_err(ubi, "Invalid VID header offset %d, VID header shift(%d)"
686                         " + VID header size(%zu) > VID header aligned size(%d).",
687                         ubi->vid_hdr_offset, ubi->vid_hdr_shift,
688                         UBI_VID_HDR_SIZE, ubi->vid_hdr_alsize);
689                 return -EINVAL;
690         }
691
692         /* Similar for the data offset */
693         ubi->leb_start = ubi->vid_hdr_offset + UBI_VID_HDR_SIZE;
694         ubi->leb_start = ALIGN(ubi->leb_start, ubi->min_io_size);
695
696         dbg_gen("vid_hdr_offset   %d", ubi->vid_hdr_offset);
697         dbg_gen("vid_hdr_aloffset %d", ubi->vid_hdr_aloffset);
698         dbg_gen("vid_hdr_shift    %d", ubi->vid_hdr_shift);
699         dbg_gen("leb_start        %d", ubi->leb_start);
700
701         /* The shift must be aligned to 32-bit boundary */
702         if (ubi->vid_hdr_shift % 4) {
703                 ubi_err(ubi, "unaligned VID header shift %d",
704                         ubi->vid_hdr_shift);
705                 return -EINVAL;
706         }
707
708         /* Check sanity */
709         if (ubi->vid_hdr_offset < UBI_EC_HDR_SIZE ||
710             ubi->leb_start < ubi->vid_hdr_offset + UBI_VID_HDR_SIZE ||
711             ubi->leb_start > ubi->peb_size - UBI_VID_HDR_SIZE ||
712             ubi->leb_start & (ubi->min_io_size - 1)) {
713                 ubi_err(ubi, "bad VID header (%d) or data offsets (%d)",
714                         ubi->vid_hdr_offset, ubi->leb_start);
715                 return -EINVAL;
716         }
717
718         /*
719          * Set maximum amount of physical erroneous eraseblocks to be 10%.
720          * Erroneous PEB are those which have read errors.
721          */
722         ubi->max_erroneous = ubi->peb_count / 10;
723         if (ubi->max_erroneous < 16)
724                 ubi->max_erroneous = 16;
725         dbg_gen("max_erroneous    %d", ubi->max_erroneous);
726
727         /*
728          * It may happen that EC and VID headers are situated in one minimal
729          * I/O unit. In this case we can only accept this UBI image in
730          * read-only mode.
731          */
732         if (ubi->vid_hdr_offset + UBI_VID_HDR_SIZE <= ubi->hdrs_min_io_size) {
733                 ubi_warn(ubi, "EC and VID headers are in the same minimal I/O unit, switch to read-only mode");
734                 ubi->ro_mode = 1;
735         }
736
737         ubi->leb_size = ubi->peb_size - ubi->leb_start;
738
739         if (!(ubi->mtd->flags & MTD_WRITEABLE)) {
740                 ubi_msg(ubi, "MTD device %d is write-protected, attach in read-only mode",
741                         ubi->mtd->index);
742                 ubi->ro_mode = 1;
743         }
744
745         /*
746          * Note, ideally, we have to initialize @ubi->bad_peb_count here. But
747          * unfortunately, MTD does not provide this information. We should loop
748          * over all physical eraseblocks and invoke mtd->block_is_bad() for
749          * each physical eraseblock. So, we leave @ubi->bad_peb_count
750          * uninitialized so far.
751          */
752
753         return 0;
754 }
755
756 /**
757  * autoresize - re-size the volume which has the "auto-resize" flag set.
758  * @ubi: UBI device description object
759  * @vol_id: ID of the volume to re-size
760  *
761  * This function re-sizes the volume marked by the %UBI_VTBL_AUTORESIZE_FLG in
762  * the volume table to the largest possible size. See comments in ubi-header.h
763  * for more description of the flag. Returns zero in case of success and a
764  * negative error code in case of failure.
765  */
766 static int autoresize(struct ubi_device *ubi, int vol_id)
767 {
768         struct ubi_volume_desc desc;
769         struct ubi_volume *vol = ubi->volumes[vol_id];
770         int err, old_reserved_pebs = vol->reserved_pebs;
771
772         if (ubi->ro_mode) {
773                 ubi_warn(ubi, "skip auto-resize because of R/O mode");
774                 return 0;
775         }
776
777         /*
778          * Clear the auto-resize flag in the volume in-memory copy of the
779          * volume table, and 'ubi_resize_volume()' will propagate this change
780          * to the flash.
781          */
782         ubi->vtbl[vol_id].flags &= ~UBI_VTBL_AUTORESIZE_FLG;
783
784         if (ubi->avail_pebs == 0) {
785                 struct ubi_vtbl_record vtbl_rec;
786
787                 /*
788                  * No available PEBs to re-size the volume, clear the flag on
789                  * flash and exit.
790                  */
791                 vtbl_rec = ubi->vtbl[vol_id];
792                 err = ubi_change_vtbl_record(ubi, vol_id, &vtbl_rec);
793                 if (err)
794                         ubi_err(ubi, "cannot clean auto-resize flag for volume %d",
795                                 vol_id);
796         } else {
797                 desc.vol = vol;
798                 err = ubi_resize_volume(&desc,
799                                         old_reserved_pebs + ubi->avail_pebs);
800                 if (err)
801                         ubi_err(ubi, "cannot auto-resize volume %d",
802                                 vol_id);
803         }
804
805         if (err)
806                 return err;
807
808         ubi_msg(ubi, "volume %d (\"%s\") re-sized from %d to %d LEBs",
809                 vol_id, vol->name, old_reserved_pebs, vol->reserved_pebs);
810         return 0;
811 }
812
813 /**
814  * ubi_attach_mtd_dev - attach an MTD device.
815  * @mtd: MTD device description object
816  * @ubi_num: number to assign to the new UBI device
817  * @vid_hdr_offset: VID header offset
818  * @max_beb_per1024: maximum expected number of bad PEB per 1024 PEBs
819  *
820  * This function attaches MTD device @mtd_dev to UBI and assign @ubi_num number
821  * to the newly created UBI device, unless @ubi_num is %UBI_DEV_NUM_AUTO, in
822  * which case this function finds a vacant device number and assigns it
823  * automatically. Returns the new UBI device number in case of success and a
824  * negative error code in case of failure.
825  *
826  * Note, the invocations of this function has to be serialized by the
827  * @ubi_devices_mutex.
828  */
829 int ubi_attach_mtd_dev(struct mtd_info *mtd, int ubi_num,
830                        int vid_hdr_offset, int max_beb_per1024)
831 {
832         struct ubi_device *ubi;
833         int i, err;
834
835         if (max_beb_per1024 < 0 || max_beb_per1024 > MAX_MTD_UBI_BEB_LIMIT)
836                 return -EINVAL;
837
838         if (!max_beb_per1024)
839                 max_beb_per1024 = CONFIG_MTD_UBI_BEB_LIMIT;
840
841         /*
842          * Check if we already have the same MTD device attached.
843          *
844          * Note, this function assumes that UBI devices creations and deletions
845          * are serialized, so it does not take the &ubi_devices_lock.
846          */
847         for (i = 0; i < UBI_MAX_DEVICES; i++) {
848                 ubi = ubi_devices[i];
849                 if (ubi && mtd->index == ubi->mtd->index) {
850                         pr_err("ubi: mtd%d is already attached to ubi%d\n",
851                                 mtd->index, i);
852                         return -EEXIST;
853                 }
854         }
855
856         /*
857          * Make sure this MTD device is not emulated on top of an UBI volume
858          * already. Well, generally this recursion works fine, but there are
859          * different problems like the UBI module takes a reference to itself
860          * by attaching (and thus, opening) the emulated MTD device. This
861          * results in inability to unload the module. And in general it makes
862          * no sense to attach emulated MTD devices, so we prohibit this.
863          */
864         if (mtd->type == MTD_UBIVOLUME) {
865                 pr_err("ubi: refuse attaching mtd%d - it is already emulated on top of UBI\n",
866                         mtd->index);
867                 return -EINVAL;
868         }
869
870         /*
871          * Both UBI and UBIFS have been designed for SLC NAND and NOR flashes.
872          * MLC NAND is different and needs special care, otherwise UBI or UBIFS
873          * will die soon and you will lose all your data.
874          */
875         if (mtd->type == MTD_MLCNANDFLASH) {
876                 pr_err("ubi: refuse attaching mtd%d - MLC NAND is not supported\n",
877                         mtd->index);
878                 return -EINVAL;
879         }
880
881         /* UBI cannot work on flashes with zero erasesize. */
882         if (!mtd->erasesize) {
883                 pr_err("ubi: refuse attaching mtd%d - zero erasesize flash is not supported\n",
884                         mtd->index);
885                 return -EINVAL;
886         }
887
888         if (ubi_num == UBI_DEV_NUM_AUTO) {
889                 /* Search for an empty slot in the @ubi_devices array */
890                 for (ubi_num = 0; ubi_num < UBI_MAX_DEVICES; ubi_num++)
891                         if (!ubi_devices[ubi_num])
892                                 break;
893                 if (ubi_num == UBI_MAX_DEVICES) {
894                         pr_err("ubi: only %d UBI devices may be created\n",
895                                 UBI_MAX_DEVICES);
896                         return -ENFILE;
897                 }
898         } else {
899                 if (ubi_num >= UBI_MAX_DEVICES)
900                         return -EINVAL;
901
902                 /* Make sure ubi_num is not busy */
903                 if (ubi_devices[ubi_num]) {
904                         pr_err("ubi: ubi%i already exists\n", ubi_num);
905                         return -EEXIST;
906                 }
907         }
908
909         ubi = kzalloc(sizeof(struct ubi_device), GFP_KERNEL);
910         if (!ubi)
911                 return -ENOMEM;
912
913         device_initialize(&ubi->dev);
914         ubi->dev.release = dev_release;
915         ubi->dev.class = &ubi_class;
916         ubi->dev.groups = ubi_dev_groups;
917
918         ubi->mtd = mtd;
919         ubi->ubi_num = ubi_num;
920         ubi->vid_hdr_offset = vid_hdr_offset;
921         ubi->autoresize_vol_id = -1;
922
923 #ifdef CONFIG_MTD_UBI_FASTMAP
924         ubi->fm_pool.used = ubi->fm_pool.size = 0;
925         ubi->fm_wl_pool.used = ubi->fm_wl_pool.size = 0;
926
927         /*
928          * fm_pool.max_size is 5% of the total number of PEBs but it's also
929          * between UBI_FM_MAX_POOL_SIZE and UBI_FM_MIN_POOL_SIZE.
930          */
931         ubi->fm_pool.max_size = min(((int)mtd_div_by_eb(ubi->mtd->size,
932                 ubi->mtd) / 100) * 5, UBI_FM_MAX_POOL_SIZE);
933         ubi->fm_pool.max_size = max(ubi->fm_pool.max_size,
934                 UBI_FM_MIN_POOL_SIZE);
935
936         ubi->fm_wl_pool.max_size = ubi->fm_pool.max_size / 2;
937         ubi->fm_disabled = !fm_autoconvert;
938         if (fm_debug)
939                 ubi_enable_dbg_chk_fastmap(ubi);
940
941         if (!ubi->fm_disabled && (int)mtd_div_by_eb(ubi->mtd->size, ubi->mtd)
942             <= UBI_FM_MAX_START) {
943                 ubi_err(ubi, "More than %i PEBs are needed for fastmap, sorry.",
944                         UBI_FM_MAX_START);
945                 ubi->fm_disabled = 1;
946         }
947
948         ubi_msg(ubi, "default fastmap pool size: %d", ubi->fm_pool.max_size);
949         ubi_msg(ubi, "default fastmap WL pool size: %d",
950                 ubi->fm_wl_pool.max_size);
951 #else
952         ubi->fm_disabled = 1;
953 #endif
954         mutex_init(&ubi->buf_mutex);
955         mutex_init(&ubi->ckvol_mutex);
956         mutex_init(&ubi->device_mutex);
957         spin_lock_init(&ubi->volumes_lock);
958         init_rwsem(&ubi->fm_protect);
959         init_rwsem(&ubi->fm_eba_sem);
960
961         ubi_msg(ubi, "attaching mtd%d", mtd->index);
962
963         err = io_init(ubi, max_beb_per1024);
964         if (err)
965                 goto out_free;
966
967         err = -ENOMEM;
968         ubi->peb_buf = vmalloc(ubi->peb_size);
969         if (!ubi->peb_buf)
970                 goto out_free;
971
972 #ifdef CONFIG_MTD_UBI_FASTMAP
973         ubi->fm_size = ubi_calc_fm_size(ubi);
974         ubi->fm_buf = vzalloc(ubi->fm_size);
975         if (!ubi->fm_buf)
976                 goto out_free;
977 #endif
978         err = ubi_attach(ubi, 0);
979         if (err) {
980                 ubi_err(ubi, "failed to attach mtd%d, error %d",
981                         mtd->index, err);
982                 goto out_free;
983         }
984
985         if (ubi->autoresize_vol_id != -1) {
986                 err = autoresize(ubi, ubi->autoresize_vol_id);
987                 if (err)
988                         goto out_detach;
989         }
990
991         err = uif_init(ubi);
992         if (err)
993                 goto out_detach;
994
995         err = ubi_debugfs_init_dev(ubi);
996         if (err)
997                 goto out_uif;
998
999         ubi->bgt_thread = kthread_create(ubi_thread, ubi, "%s", ubi->bgt_name);
1000         if (IS_ERR(ubi->bgt_thread)) {
1001                 err = PTR_ERR(ubi->bgt_thread);
1002                 ubi_err(ubi, "cannot spawn \"%s\", error %d",
1003                         ubi->bgt_name, err);
1004                 goto out_debugfs;
1005         }
1006
1007         ubi_msg(ubi, "attached mtd%d (name \"%s\", size %llu MiB)",
1008                 mtd->index, mtd->name, ubi->flash_size >> 20);
1009         ubi_msg(ubi, "PEB size: %d bytes (%d KiB), LEB size: %d bytes",
1010                 ubi->peb_size, ubi->peb_size >> 10, ubi->leb_size);
1011         ubi_msg(ubi, "min./max. I/O unit sizes: %d/%d, sub-page size %d",
1012                 ubi->min_io_size, ubi->max_write_size, ubi->hdrs_min_io_size);
1013         ubi_msg(ubi, "VID header offset: %d (aligned %d), data offset: %d",
1014                 ubi->vid_hdr_offset, ubi->vid_hdr_aloffset, ubi->leb_start);
1015         ubi_msg(ubi, "good PEBs: %d, bad PEBs: %d, corrupted PEBs: %d",
1016                 ubi->good_peb_count, ubi->bad_peb_count, ubi->corr_peb_count);
1017         ubi_msg(ubi, "user volume: %d, internal volumes: %d, max. volumes count: %d",
1018                 ubi->vol_count - UBI_INT_VOL_COUNT, UBI_INT_VOL_COUNT,
1019                 ubi->vtbl_slots);
1020         ubi_msg(ubi, "max/mean erase counter: %d/%d, WL threshold: %d, image sequence number: %u",
1021                 ubi->max_ec, ubi->mean_ec, CONFIG_MTD_UBI_WL_THRESHOLD,
1022                 ubi->image_seq);
1023         ubi_msg(ubi, "available PEBs: %d, total reserved PEBs: %d, PEBs reserved for bad PEB handling: %d",
1024                 ubi->avail_pebs, ubi->rsvd_pebs, ubi->beb_rsvd_pebs);
1025
1026         /*
1027          * The below lock makes sure we do not race with 'ubi_thread()' which
1028          * checks @ubi->thread_enabled. Otherwise we may fail to wake it up.
1029          */
1030         spin_lock(&ubi->wl_lock);
1031         ubi->thread_enabled = 1;
1032         wake_up_process(ubi->bgt_thread);
1033         spin_unlock(&ubi->wl_lock);
1034
1035         ubi_devices[ubi_num] = ubi;
1036         ubi_notify_all(ubi, UBI_VOLUME_ADDED, NULL);
1037         return ubi_num;
1038
1039 out_debugfs:
1040         ubi_debugfs_exit_dev(ubi);
1041 out_uif:
1042         uif_close(ubi);
1043 out_detach:
1044         ubi_wl_close(ubi);
1045         ubi_free_internal_volumes(ubi);
1046         vfree(ubi->vtbl);
1047 out_free:
1048         vfree(ubi->peb_buf);
1049         vfree(ubi->fm_buf);
1050         put_device(&ubi->dev);
1051         return err;
1052 }
1053
1054 /**
1055  * ubi_detach_mtd_dev - detach an MTD device.
1056  * @ubi_num: UBI device number to detach from
1057  * @anyway: detach MTD even if device reference count is not zero
1058  *
1059  * This function destroys an UBI device number @ubi_num and detaches the
1060  * underlying MTD device. Returns zero in case of success and %-EBUSY if the
1061  * UBI device is busy and cannot be destroyed, and %-EINVAL if it does not
1062  * exist.
1063  *
1064  * Note, the invocations of this function has to be serialized by the
1065  * @ubi_devices_mutex.
1066  */
1067 int ubi_detach_mtd_dev(int ubi_num, int anyway)
1068 {
1069         struct ubi_device *ubi;
1070
1071         if (ubi_num < 0 || ubi_num >= UBI_MAX_DEVICES)
1072                 return -EINVAL;
1073
1074         ubi = ubi_get_device(ubi_num);
1075         if (!ubi)
1076                 return -EINVAL;
1077
1078         spin_lock(&ubi_devices_lock);
1079         put_device(&ubi->dev);
1080         ubi->ref_count -= 1;
1081         if (ubi->ref_count) {
1082                 if (!anyway) {
1083                         spin_unlock(&ubi_devices_lock);
1084                         return -EBUSY;
1085                 }
1086                 /* This may only happen if there is a bug */
1087                 ubi_err(ubi, "%s reference count %d, destroy anyway",
1088                         ubi->ubi_name, ubi->ref_count);
1089         }
1090         ubi_devices[ubi_num] = NULL;
1091         spin_unlock(&ubi_devices_lock);
1092
1093         ubi_assert(ubi_num == ubi->ubi_num);
1094         ubi_notify_all(ubi, UBI_VOLUME_REMOVED, NULL);
1095         ubi_msg(ubi, "detaching mtd%d", ubi->mtd->index);
1096 #ifdef CONFIG_MTD_UBI_FASTMAP
1097         /* If we don't write a new fastmap at detach time we lose all
1098          * EC updates that have been made since the last written fastmap.
1099          * In case of fastmap debugging we omit the update to simulate an
1100          * unclean shutdown. */
1101         if (!ubi_dbg_chk_fastmap(ubi))
1102                 ubi_update_fastmap(ubi);
1103 #endif
1104         /*
1105          * Before freeing anything, we have to stop the background thread to
1106          * prevent it from doing anything on this device while we are freeing.
1107          */
1108         if (ubi->bgt_thread)
1109                 kthread_stop(ubi->bgt_thread);
1110
1111 #ifdef CONFIG_MTD_UBI_FASTMAP
1112         cancel_work_sync(&ubi->fm_work);
1113 #endif
1114         ubi_debugfs_exit_dev(ubi);
1115         uif_close(ubi);
1116
1117         ubi_wl_close(ubi);
1118         ubi_free_internal_volumes(ubi);
1119         vfree(ubi->vtbl);
1120         vfree(ubi->peb_buf);
1121         vfree(ubi->fm_buf);
1122         ubi_msg(ubi, "mtd%d is detached", ubi->mtd->index);
1123         put_mtd_device(ubi->mtd);
1124         put_device(&ubi->dev);
1125         return 0;
1126 }
1127
1128 /**
1129  * open_mtd_by_chdev - open an MTD device by its character device node path.
1130  * @mtd_dev: MTD character device node path
1131  *
1132  * This helper function opens an MTD device by its character node device path.
1133  * Returns MTD device description object in case of success and a negative
1134  * error code in case of failure.
1135  */
1136 static struct mtd_info * __init open_mtd_by_chdev(const char *mtd_dev)
1137 {
1138         int err, minor;
1139         struct path path;
1140         struct kstat stat;
1141
1142         /* Probably this is an MTD character device node path */
1143         err = kern_path(mtd_dev, LOOKUP_FOLLOW, &path);
1144         if (err)
1145                 return ERR_PTR(err);
1146
1147         err = vfs_getattr(&path, &stat, STATX_TYPE, AT_STATX_SYNC_AS_STAT);
1148         path_put(&path);
1149         if (err)
1150                 return ERR_PTR(err);
1151
1152         /* MTD device number is defined by the major / minor numbers */
1153         if (MAJOR(stat.rdev) != MTD_CHAR_MAJOR || !S_ISCHR(stat.mode))
1154                 return ERR_PTR(-EINVAL);
1155
1156         minor = MINOR(stat.rdev);
1157
1158         if (minor & 1)
1159                 /*
1160                  * Just do not think the "/dev/mtdrX" devices support is need,
1161                  * so do not support them to avoid doing extra work.
1162                  */
1163                 return ERR_PTR(-EINVAL);
1164
1165         return get_mtd_device(NULL, minor / 2);
1166 }
1167
1168 /**
1169  * open_mtd_device - open MTD device by name, character device path, or number.
1170  * @mtd_dev: name, character device node path, or MTD device device number
1171  *
1172  * This function tries to open and MTD device described by @mtd_dev string,
1173  * which is first treated as ASCII MTD device number, and if it is not true, it
1174  * is treated as MTD device name, and if that is also not true, it is treated
1175  * as MTD character device node path. Returns MTD device description object in
1176  * case of success and a negative error code in case of failure.
1177  */
1178 static struct mtd_info * __init open_mtd_device(const char *mtd_dev)
1179 {
1180         struct mtd_info *mtd;
1181         int mtd_num;
1182         char *endp;
1183
1184         mtd_num = simple_strtoul(mtd_dev, &endp, 0);
1185         if (*endp != '\0' || mtd_dev == endp) {
1186                 /*
1187                  * This does not look like an ASCII integer, probably this is
1188                  * MTD device name.
1189                  */
1190                 mtd = get_mtd_device_nm(mtd_dev);
1191                 if (IS_ERR(mtd) && PTR_ERR(mtd) == -ENODEV)
1192                         /* Probably this is an MTD character device node path */
1193                         mtd = open_mtd_by_chdev(mtd_dev);
1194         } else
1195                 mtd = get_mtd_device(NULL, mtd_num);
1196
1197         return mtd;
1198 }
1199
1200 static int __init ubi_init(void)
1201 {
1202         int err, i, k;
1203
1204         /* Ensure that EC and VID headers have correct size */
1205         BUILD_BUG_ON(sizeof(struct ubi_ec_hdr) != 64);
1206         BUILD_BUG_ON(sizeof(struct ubi_vid_hdr) != 64);
1207
1208         if (mtd_devs > UBI_MAX_DEVICES) {
1209                 pr_err("UBI error: too many MTD devices, maximum is %d\n",
1210                        UBI_MAX_DEVICES);
1211                 return -EINVAL;
1212         }
1213
1214         /* Create base sysfs directory and sysfs files */
1215         err = class_register(&ubi_class);
1216         if (err < 0)
1217                 return err;
1218
1219         err = misc_register(&ubi_ctrl_cdev);
1220         if (err) {
1221                 pr_err("UBI error: cannot register device\n");
1222                 goto out;
1223         }
1224
1225         ubi_wl_entry_slab = kmem_cache_create("ubi_wl_entry_slab",
1226                                               sizeof(struct ubi_wl_entry),
1227                                               0, 0, NULL);
1228         if (!ubi_wl_entry_slab) {
1229                 err = -ENOMEM;
1230                 goto out_dev_unreg;
1231         }
1232
1233         err = ubi_debugfs_init();
1234         if (err)
1235                 goto out_slab;
1236
1237
1238         /* Attach MTD devices */
1239         for (i = 0; i < mtd_devs; i++) {
1240                 struct mtd_dev_param *p = &mtd_dev_param[i];
1241                 struct mtd_info *mtd;
1242
1243                 cond_resched();
1244
1245                 mtd = open_mtd_device(p->name);
1246                 if (IS_ERR(mtd)) {
1247                         err = PTR_ERR(mtd);
1248                         pr_err("UBI error: cannot open mtd %s, error %d\n",
1249                                p->name, err);
1250                         /* See comment below re-ubi_is_module(). */
1251                         if (ubi_is_module())
1252                                 goto out_detach;
1253                         continue;
1254                 }
1255
1256                 mutex_lock(&ubi_devices_mutex);
1257                 err = ubi_attach_mtd_dev(mtd, p->ubi_num,
1258                                          p->vid_hdr_offs, p->max_beb_per1024);
1259                 mutex_unlock(&ubi_devices_mutex);
1260                 if (err < 0) {
1261                         pr_err("UBI error: cannot attach mtd%d\n",
1262                                mtd->index);
1263                         put_mtd_device(mtd);
1264
1265                         /*
1266                          * Originally UBI stopped initializing on any error.
1267                          * However, later on it was found out that this
1268                          * behavior is not very good when UBI is compiled into
1269                          * the kernel and the MTD devices to attach are passed
1270                          * through the command line. Indeed, UBI failure
1271                          * stopped whole boot sequence.
1272                          *
1273                          * To fix this, we changed the behavior for the
1274                          * non-module case, but preserved the old behavior for
1275                          * the module case, just for compatibility. This is a
1276                          * little inconsistent, though.
1277                          */
1278                         if (ubi_is_module())
1279                                 goto out_detach;
1280                 }
1281         }
1282
1283         err = ubiblock_init();
1284         if (err) {
1285                 pr_err("UBI error: block: cannot initialize, error %d\n", err);
1286
1287                 /* See comment above re-ubi_is_module(). */
1288                 if (ubi_is_module())
1289                         goto out_detach;
1290         }
1291
1292         return 0;
1293
1294 out_detach:
1295         for (k = 0; k < i; k++)
1296                 if (ubi_devices[k]) {
1297                         mutex_lock(&ubi_devices_mutex);
1298                         ubi_detach_mtd_dev(ubi_devices[k]->ubi_num, 1);
1299                         mutex_unlock(&ubi_devices_mutex);
1300                 }
1301         ubi_debugfs_exit();
1302 out_slab:
1303         kmem_cache_destroy(ubi_wl_entry_slab);
1304 out_dev_unreg:
1305         misc_deregister(&ubi_ctrl_cdev);
1306 out:
1307         class_unregister(&ubi_class);
1308         pr_err("UBI error: cannot initialize UBI, error %d\n", err);
1309         return err;
1310 }
1311 late_initcall(ubi_init);
1312
1313 static void __exit ubi_exit(void)
1314 {
1315         int i;
1316
1317         ubiblock_exit();
1318
1319         for (i = 0; i < UBI_MAX_DEVICES; i++)
1320                 if (ubi_devices[i]) {
1321                         mutex_lock(&ubi_devices_mutex);
1322                         ubi_detach_mtd_dev(ubi_devices[i]->ubi_num, 1);
1323                         mutex_unlock(&ubi_devices_mutex);
1324                 }
1325         ubi_debugfs_exit();
1326         kmem_cache_destroy(ubi_wl_entry_slab);
1327         misc_deregister(&ubi_ctrl_cdev);
1328         class_unregister(&ubi_class);
1329 }
1330 module_exit(ubi_exit);
1331
1332 /**
1333  * bytes_str_to_int - convert a number of bytes string into an integer.
1334  * @str: the string to convert
1335  *
1336  * This function returns positive resulting integer in case of success and a
1337  * negative error code in case of failure.
1338  */
1339 static int bytes_str_to_int(const char *str)
1340 {
1341         char *endp;
1342         unsigned long result;
1343
1344         result = simple_strtoul(str, &endp, 0);
1345         if (str == endp || result >= INT_MAX) {
1346                 pr_err("UBI error: incorrect bytes count: \"%s\"\n", str);
1347                 return -EINVAL;
1348         }
1349
1350         switch (*endp) {
1351         case 'G':
1352                 result *= 1024;
1353         case 'M':
1354                 result *= 1024;
1355         case 'K':
1356                 result *= 1024;
1357                 if (endp[1] == 'i' && endp[2] == 'B')
1358                         endp += 2;
1359         case '\0':
1360                 break;
1361         default:
1362                 pr_err("UBI error: incorrect bytes count: \"%s\"\n", str);
1363                 return -EINVAL;
1364         }
1365
1366         return result;
1367 }
1368
1369 /**
1370  * ubi_mtd_param_parse - parse the 'mtd=' UBI parameter.
1371  * @val: the parameter value to parse
1372  * @kp: not used
1373  *
1374  * This function returns zero in case of success and a negative error code in
1375  * case of error.
1376  */
1377 static int ubi_mtd_param_parse(const char *val, const struct kernel_param *kp)
1378 {
1379         int i, len;
1380         struct mtd_dev_param *p;
1381         char buf[MTD_PARAM_LEN_MAX];
1382         char *pbuf = &buf[0];
1383         char *tokens[MTD_PARAM_MAX_COUNT], *token;
1384
1385         if (!val)
1386                 return -EINVAL;
1387
1388         if (mtd_devs == UBI_MAX_DEVICES) {
1389                 pr_err("UBI error: too many parameters, max. is %d\n",
1390                        UBI_MAX_DEVICES);
1391                 return -EINVAL;
1392         }
1393
1394         len = strnlen(val, MTD_PARAM_LEN_MAX);
1395         if (len == MTD_PARAM_LEN_MAX) {
1396                 pr_err("UBI error: parameter \"%s\" is too long, max. is %d\n",
1397                        val, MTD_PARAM_LEN_MAX);
1398                 return -EINVAL;
1399         }
1400
1401         if (len == 0) {
1402                 pr_warn("UBI warning: empty 'mtd=' parameter - ignored\n");
1403                 return 0;
1404         }
1405
1406         strcpy(buf, val);
1407
1408         /* Get rid of the final newline */
1409         if (buf[len - 1] == '\n')
1410                 buf[len - 1] = '\0';
1411
1412         for (i = 0; i < MTD_PARAM_MAX_COUNT; i++)
1413                 tokens[i] = strsep(&pbuf, ",");
1414
1415         if (pbuf) {
1416                 pr_err("UBI error: too many arguments at \"%s\"\n", val);
1417                 return -EINVAL;
1418         }
1419
1420         p = &mtd_dev_param[mtd_devs];
1421         strcpy(&p->name[0], tokens[0]);
1422
1423         token = tokens[1];
1424         if (token) {
1425                 p->vid_hdr_offs = bytes_str_to_int(token);
1426
1427                 if (p->vid_hdr_offs < 0)
1428                         return p->vid_hdr_offs;
1429         }
1430
1431         token = tokens[2];
1432         if (token) {
1433                 int err = kstrtoint(token, 10, &p->max_beb_per1024);
1434
1435                 if (err) {
1436                         pr_err("UBI error: bad value for max_beb_per1024 parameter: %s",
1437                                token);
1438                         return -EINVAL;
1439                 }
1440         }
1441
1442         token = tokens[3];
1443         if (token) {
1444                 int err = kstrtoint(token, 10, &p->ubi_num);
1445
1446                 if (err) {
1447                         pr_err("UBI error: bad value for ubi_num parameter: %s",
1448                                token);
1449                         return -EINVAL;
1450                 }
1451         } else
1452                 p->ubi_num = UBI_DEV_NUM_AUTO;
1453
1454         mtd_devs += 1;
1455         return 0;
1456 }
1457
1458 module_param_call(mtd, ubi_mtd_param_parse, NULL, NULL, 0400);
1459 MODULE_PARM_DESC(mtd, "MTD devices to attach. Parameter format: mtd=<name|num|path>[,<vid_hdr_offs>[,max_beb_per1024[,ubi_num]]].\n"
1460                       "Multiple \"mtd\" parameters may be specified.\n"
1461                       "MTD devices may be specified by their number, name, or path to the MTD character device node.\n"
1462                       "Optional \"vid_hdr_offs\" parameter specifies UBI VID header position to be used by UBI. (default value if 0)\n"
1463                       "Optional \"max_beb_per1024\" parameter specifies the maximum expected bad eraseblock per 1024 eraseblocks. (default value ("
1464                       __stringify(CONFIG_MTD_UBI_BEB_LIMIT) ") if 0)\n"
1465                       "Optional \"ubi_num\" parameter specifies UBI device number which have to be assigned to the newly created UBI device (assigned automatically by default)\n"
1466                       "\n"
1467                       "Example 1: mtd=/dev/mtd0 - attach MTD device /dev/mtd0.\n"
1468                       "Example 2: mtd=content,1984 mtd=4 - attach MTD device with name \"content\" using VID header offset 1984, and MTD device number 4 with default VID header offset.\n"
1469                       "Example 3: mtd=/dev/mtd1,0,25 - attach MTD device /dev/mtd1 using default VID header offset and reserve 25*nand_size_in_blocks/1024 erase blocks for bad block handling.\n"
1470                       "Example 4: mtd=/dev/mtd1,0,0,5 - attach MTD device /dev/mtd1 to UBI 5 and using default values for the other fields.\n"
1471                       "\t(e.g. if the NAND *chipset* has 4096 PEB, 100 will be reserved for this UBI device).");
1472 #ifdef CONFIG_MTD_UBI_FASTMAP
1473 module_param(fm_autoconvert, bool, 0644);
1474 MODULE_PARM_DESC(fm_autoconvert, "Set this parameter to enable fastmap automatically on images without a fastmap.");
1475 module_param(fm_debug, bool, 0);
1476 MODULE_PARM_DESC(fm_debug, "Set this parameter to enable fastmap debugging by default. Warning, this will make fastmap slow!");
1477 #endif
1478 MODULE_VERSION(__stringify(UBI_VERSION));
1479 MODULE_DESCRIPTION("UBI - Unsorted Block Images");
1480 MODULE_AUTHOR("Artem Bityutskiy");
1481 MODULE_LICENSE("GPL");