drivers/mtd/mtdpart.c

   1 /*
   2  * Simple MTD partitioning layer
   3  *
   4  * Copyright © 2000 Nicolas Pitre <nico@fluxnic.net>
   5  * Copyright © 2002 Thomas Gleixner <gleixner@linutronix.de>
   6  * Copyright © 2000-2010 David Woodhouse <dwmw2@infradead.org>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  21  *
  22  */
  23
  24 #include <linux/module.h>
  25 #include <linux/types.h>
  26 #include <linux/kernel.h>
  27 #include <linux/slab.h>
  28 #include <linux/list.h>
  29 #include <linux/kmod.h>
  30 #include <linux/mtd/mtd.h>
  31 #include <linux/mtd/partitions.h>
  32 #include <linux/err.h>
  33
  34 #include "mtdcore.h"
  35
  36 /* Our partition linked list */
  37 static LIST_HEAD(mtd_partitions);
  38 static DEFINE_MUTEX(mtd_partitions_mutex);
  39
  40 /* Our partition node structure */
  41 struct mtd_part {
  42         struct mtd_info mtd;
  43         struct mtd_info *master;
  44         uint64_t offset;
  45         struct list_head list;
  46 };
  47
  48 /*
  49  * Given a pointer to the MTD object in the mtd_part structure, we can retrieve
  50  * the pointer to that structure.
  51  */
  52 static inline struct mtd_part *mtd_to_part(const struct mtd_info *mtd)
  53 {
  54         return container_of(mtd, struct mtd_part, mtd);
  55 }
  56
  57
  58 /*
  59  * MTD methods which simply translate the effective address and pass through
  60  * to the _real_ device.
  61  */
  62
  63 static int part_read(struct mtd_info *mtd, loff_t from, size_t len,
  64                 size_t *retlen, u_char *buf)
  65 {
  66         struct mtd_part *part = mtd_to_part(mtd);
  67         struct mtd_ecc_stats stats;
  68         int res;
  69
  70         stats = part->master->ecc_stats;
  71         res = part->master->_read(part->master, from + part->offset, len,
  72                                   retlen, buf);
  73         if (unlikely(mtd_is_eccerr(res)))
  74                 mtd->ecc_stats.failed +=
  75                         part->master->ecc_stats.failed - stats.failed;
  76         else
  77                 mtd->ecc_stats.corrected +=
  78                         part->master->ecc_stats.corrected - stats.corrected;
  79         return res;
  80 }
  81
  82 static int part_point(struct mtd_info *mtd, loff_t from, size_t len,
  83                 size_t *retlen, void **virt, resource_size_t *phys)
  84 {
  85         struct mtd_part *part = mtd_to_part(mtd);
  86
  87         return part->master->_point(part->master, from + part->offset, len,
  88                                     retlen, virt, phys);
  89 }
  90
  91 static int part_unpoint(struct mtd_info *mtd, loff_t from, size_t len)
  92 {
  93         struct mtd_part *part = mtd_to_part(mtd);
  94
  95         return part->master->_unpoint(part->master, from + part->offset, len);
  96 }
  97
  98 static unsigned long part_get_unmapped_area(struct mtd_info *mtd,
  99                                             unsigned long len,
 100                                             unsigned long offset,
 101                                             unsigned long flags)
 102 {
 103         struct mtd_part *part = mtd_to_part(mtd);
 104
 105         offset += part->offset;
 106         return part->master->_get_unmapped_area(part->master, len, offset,
 107                                                 flags);
 108 }
 109
 110 static int part_read_oob(struct mtd_info *mtd, loff_t from,
 111                 struct mtd_oob_ops *ops)
 112 {
 113         struct mtd_part *part = mtd_to_part(mtd);
 114         int res;
 115
 116         if (from >= mtd->size)
 117                 return -EINVAL;
 118         if (ops->datbuf && from + ops->len > mtd->size)
 119                 return -EINVAL;
 120
 121         /*
 122          * If OOB is also requested, make sure that we do not read past the end
 123          * of this partition.
 124          */
 125         if (ops->oobbuf) {
 126                 size_t len, pages;
 127
 128                 len = mtd_oobavail(mtd, ops);
 129                 pages = mtd_div_by_ws(mtd->size, mtd);
 130                 pages -= mtd_div_by_ws(from, mtd);
 131                 if (ops->ooboffs + ops->ooblen > pages * len)
 132                         return -EINVAL;
 133         }
 134
 135         res = part->master->_read_oob(part->master, from + part->offset, ops);
 136         if (unlikely(res)) {
 137                 if (mtd_is_bitflip(res))
 138                         mtd->ecc_stats.corrected++;
 139                 if (mtd_is_eccerr(res))
 140                         mtd->ecc_stats.failed++;
 141         }
 142         return res;
 143 }
 144
 145 static int part_read_user_prot_reg(struct mtd_info *mtd, loff_t from,
 146                 size_t len, size_t *retlen, u_char *buf)
 147 {
 148         struct mtd_part *part = mtd_to_part(mtd);
 149         return part->master->_read_user_prot_reg(part->master, from, len,
 150                                                  retlen, buf);
 151 }
 152
 153 static int part_get_user_prot_info(struct mtd_info *mtd, size_t len,
 154                                    size_t *retlen, struct otp_info *buf)
 155 {
 156         struct mtd_part *part = mtd_to_part(mtd);
 157         return part->master->_get_user_prot_info(part->master, len, retlen,
 158                                                  buf);
 159 }
 160
 161 static int part_read_fact_prot_reg(struct mtd_info *mtd, loff_t from,
 162                 size_t len, size_t *retlen, u_char *buf)
 163 {
 164         struct mtd_part *part = mtd_to_part(mtd);
 165         return part->master->_read_fact_prot_reg(part->master, from, len,
 166                                                  retlen, buf);
 167 }
 168
 169 static int part_get_fact_prot_info(struct mtd_info *mtd, size_t len,
 170                                    size_t *retlen, struct otp_info *buf)
 171 {
 172         struct mtd_part *part = mtd_to_part(mtd);
 173         return part->master->_get_fact_prot_info(part->master, len, retlen,
 174                                                  buf);
 175 }
 176
 177 static int part_write(struct mtd_info *mtd, loff_t to, size_t len,
 178                 size_t *retlen, const u_char *buf)
 179 {
 180         struct mtd_part *part = mtd_to_part(mtd);
 181         return part->master->_write(part->master, to + part->offset, len,
 182                                     retlen, buf);
 183 }
 184
 185 static int part_panic_write(struct mtd_info *mtd, loff_t to, size_t len,
 186                 size_t *retlen, const u_char *buf)
 187 {
 188         struct mtd_part *part = mtd_to_part(mtd);
 189         return part->master->_panic_write(part->master, to + part->offset, len,
 190                                           retlen, buf);
 191 }
 192
 193 static int part_write_oob(struct mtd_info *mtd, loff_t to,
 194                 struct mtd_oob_ops *ops)
 195 {
 196         struct mtd_part *part = mtd_to_part(mtd);
 197
 198         if (to >= mtd->size)
 199                 return -EINVAL;
 200         if (ops->datbuf && to + ops->len > mtd->size)
 201                 return -EINVAL;
 202         return part->master->_write_oob(part->master, to + part->offset, ops);
 203 }
 204
 205 static int part_write_user_prot_reg(struct mtd_info *mtd, loff_t from,
 206                 size_t len, size_t *retlen, u_char *buf)
 207 {
 208         struct mtd_part *part = mtd_to_part(mtd);
 209         return part->master->_write_user_prot_reg(part->master, from, len,
 210                                                   retlen, buf);
 211 }
 212
 213 static int part_lock_user_prot_reg(struct mtd_info *mtd, loff_t from,
 214                 size_t len)
 215 {
 216         struct mtd_part *part = mtd_to_part(mtd);
 217         return part->master->_lock_user_prot_reg(part->master, from, len);
 218 }
 219
 220 static int part_writev(struct mtd_info *mtd, const struct kvec *vecs,
 221                 unsigned long count, loff_t to, size_t *retlen)
 222 {
 223         struct mtd_part *part = mtd_to_part(mtd);
 224         return part->master->_writev(part->master, vecs, count,
 225                                      to + part->offset, retlen);
 226 }
 227
 228 static int part_erase(struct mtd_info *mtd, struct erase_info *instr)
 229 {
 230         struct mtd_part *part = mtd_to_part(mtd);
 231         int ret;
 232
 233         instr->addr += part->offset;
 234         ret = part->master->_erase(part->master, instr);
 235         if (ret) {
 236                 if (instr->fail_addr != MTD_FAIL_ADDR_UNKNOWN)
 237                         instr->fail_addr -= part->offset;
 238                 instr->addr -= part->offset;
 239         }
 240         return ret;
 241 }
 242
 243 void mtd_erase_callback(struct erase_info *instr)
 244 {
 245         if (instr->mtd->_erase == part_erase) {
 246                 struct mtd_part *part = mtd_to_part(instr->mtd);
 247
 248                 if (instr->fail_addr != MTD_FAIL_ADDR_UNKNOWN)
 249                         instr->fail_addr -= part->offset;
 250                 instr->addr -= part->offset;
 251         }
 252         if (instr->callback)
 253                 instr->callback(instr);
 254 }
 255 EXPORT_SYMBOL_GPL(mtd_erase_callback);
 256
 257 static int part_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len)
 258 {
 259         struct mtd_part *part = mtd_to_part(mtd);
 260         return part->master->_lock(part->master, ofs + part->offset, len);
 261 }
 262
 263 static int part_unlock(struct mtd_info *mtd, loff_t ofs, uint64_t len)
 264 {
 265         struct mtd_part *part = mtd_to_part(mtd);
 266         return part->master->_unlock(part->master, ofs + part->offset, len);
 267 }
 268
 269 static int part_is_locked(struct mtd_info *mtd, loff_t ofs, uint64_t len)
 270 {
 271         struct mtd_part *part = mtd_to_part(mtd);
 272         return part->master->_is_locked(part->master, ofs + part->offset, len);
 273 }
 274
 275 static void part_sync(struct mtd_info *mtd)
 276 {
 277         struct mtd_part *part = mtd_to_part(mtd);
 278         part->master->_sync(part->master);
 279 }
 280
 281 static int part_suspend(struct mtd_info *mtd)
 282 {
 283         struct mtd_part *part = mtd_to_part(mtd);
 284         return part->master->_suspend(part->master);
 285 }
 286
 287 static void part_resume(struct mtd_info *mtd)
 288 {
 289         struct mtd_part *part = mtd_to_part(mtd);
 290         part->master->_resume(part->master);
 291 }
 292
 293 static int part_block_isreserved(struct mtd_info *mtd, loff_t ofs)
 294 {
 295         struct mtd_part *part = mtd_to_part(mtd);
 296         ofs += part->offset;
 297         return part->master->_block_isreserved(part->master, ofs);
 298 }
 299
 300 static int part_block_isbad(struct mtd_info *mtd, loff_t ofs)
 301 {
 302         struct mtd_part *part = mtd_to_part(mtd);
 303         ofs += part->offset;
 304         return part->master->_block_isbad(part->master, ofs);
 305 }
 306
 307 static int part_block_markbad(struct mtd_info *mtd, loff_t ofs)
 308 {
 309         struct mtd_part *part = mtd_to_part(mtd);
 310         int res;
 311
 312         ofs += part->offset;
 313         res = part->master->_block_markbad(part->master, ofs);
 314         if (!res)
 315                 mtd->ecc_stats.badblocks++;
 316         return res;
 317 }
 318
 319 static int part_get_device(struct mtd_info *mtd)
 320 {
 321         struct mtd_part *part = mtd_to_part(mtd);
 322         return part->master->_get_device(part->master);
 323 }
 324
 325 static void part_put_device(struct mtd_info *mtd)
 326 {
 327         struct mtd_part *part = mtd_to_part(mtd);
 328         part->master->_put_device(part->master);
 329 }
 330
 331 static int part_ooblayout_ecc(struct mtd_info *mtd, int section,
 332                               struct mtd_oob_region *oobregion)
 333 {
 334         struct mtd_part *part = mtd_to_part(mtd);
 335
 336         return mtd_ooblayout_ecc(part->master, section, oobregion);
 337 }
 338
 339 static int part_ooblayout_free(struct mtd_info *mtd, int section,
 340                                struct mtd_oob_region *oobregion)
 341 {
 342         struct mtd_part *part = mtd_to_part(mtd);
 343
 344         return mtd_ooblayout_free(part->master, section, oobregion);
 345 }
 346
 347 static const struct mtd_ooblayout_ops part_ooblayout_ops = {
 348         .ecc = part_ooblayout_ecc,
 349         .free = part_ooblayout_free,
 350 };
 351
 352 static int part_max_bad_blocks(struct mtd_info *mtd, loff_t ofs, size_t len)
 353 {
 354         struct mtd_part *part = mtd_to_part(mtd);
 355
 356         return part->master->_max_bad_blocks(part->master,
 357                                              ofs + part->offset, len);
 358 }
 359
 360 static inline void free_partition(struct mtd_part *p)
 361 {
 362         kfree(p->mtd.name);
 363         kfree(p);
 364 }
 365
 366 /*
 367  * This function unregisters and destroy all slave MTD objects which are
 368  * attached to the given master MTD object.
 369  */
 370
 371 int del_mtd_partitions(struct mtd_info *master)
 372 {
 373         struct mtd_part *slave, *next;
 374         int ret, err = 0;
 375
 376         mutex_lock(&mtd_partitions_mutex);
 377         list_for_each_entry_safe(slave, next, &mtd_partitions, list)
 378                 if (slave->master == master) {
 379                         ret = del_mtd_device(&slave->mtd);
 380                         if (ret < 0) {
 381                                 err = ret;
 382                                 continue;
 383                         }
 384                         list_del(&slave->list);
 385                         free_partition(slave);
 386                 }
 387         mutex_unlock(&mtd_partitions_mutex);
 388
 389         return err;
 390 }
 391
 392 static struct mtd_part *allocate_partition(struct mtd_info *master,
 393                         const struct mtd_partition *part, int partno,
 394                         uint64_t cur_offset)
 395 {
 396         struct mtd_part *slave;
 397         char *name;
 398
 399         /* allocate the partition structure */
 400         slave = kzalloc(sizeof(*slave), GFP_KERNEL);
 401         name = kstrdup(part->name, GFP_KERNEL);
 402         if (!name || !slave) {
 403                 printk(KERN_ERR"memory allocation error while creating partitions for \"%s\"\n",
 404                        master->name);
 405                 kfree(name);
 406                 kfree(slave);
 407                 return ERR_PTR(-ENOMEM);
 408         }
 409
 410         /* set up the MTD object for this partition */
 411         slave->mtd.type = master->type;
 412         slave->mtd.flags = master->flags & ~part->mask_flags;
 413         slave->mtd.size = part->size;
 414         slave->mtd.writesize = master->writesize;
 415         slave->mtd.writebufsize = master->writebufsize;
 416         slave->mtd.oobsize = master->oobsize;
 417         slave->mtd.oobavail = master->oobavail;
 418         slave->mtd.subpage_sft = master->subpage_sft;
 419         slave->mtd.pairing = master->pairing;
 420
 421         slave->mtd.name = name;
 422         slave->mtd.owner = master->owner;
 423
 424         /* NOTE: Historically, we didn't arrange MTDs as a tree out of
 425          * concern for showing the same data in multiple partitions.
 426          * However, it is very useful to have the master node present,
 427          * so the MTD_PARTITIONED_MASTER option allows that. The master
 428          * will have device nodes etc only if this is set, so make the
 429          * parent conditional on that option. Note, this is a way to
 430          * distinguish between the master and the partition in sysfs.
 431          */
 432         slave->mtd.dev.parent = IS_ENABLED(CONFIG_MTD_PARTITIONED_MASTER) ?
 433                                 &master->dev :
 434                                 master->dev.parent;
 435
 436         slave->mtd._read = part_read;
 437         slave->mtd._write = part_write;
 438
 439         if (master->_panic_write)
 440                 slave->mtd._panic_write = part_panic_write;
 441
 442         if (master->_point && master->_unpoint) {
 443                 slave->mtd._point = part_point;
 444                 slave->mtd._unpoint = part_unpoint;
 445         }
 446
 447         if (master->_get_unmapped_area)
 448                 slave->mtd._get_unmapped_area = part_get_unmapped_area;
 449         if (master->_read_oob)
 450                 slave->mtd._read_oob = part_read_oob;
 451         if (master->_write_oob)
 452                 slave->mtd._write_oob = part_write_oob;
 453         if (master->_read_user_prot_reg)
 454                 slave->mtd._read_user_prot_reg = part_read_user_prot_reg;
 455         if (master->_read_fact_prot_reg)
 456                 slave->mtd._read_fact_prot_reg = part_read_fact_prot_reg;
 457         if (master->_write_user_prot_reg)
 458                 slave->mtd._write_user_prot_reg = part_write_user_prot_reg;
 459         if (master->_lock_user_prot_reg)
 460                 slave->mtd._lock_user_prot_reg = part_lock_user_prot_reg;
 461         if (master->_get_user_prot_info)
 462                 slave->mtd._get_user_prot_info = part_get_user_prot_info;
 463         if (master->_get_fact_prot_info)
 464                 slave->mtd._get_fact_prot_info = part_get_fact_prot_info;
 465         if (master->_sync)
 466                 slave->mtd._sync = part_sync;
 467         if (!partno && !master->dev.class && master->_suspend &&
 468             master->_resume) {
 469                         slave->mtd._suspend = part_suspend;
 470                         slave->mtd._resume = part_resume;
 471         }
 472         if (master->_writev)
 473                 slave->mtd._writev = part_writev;
 474         if (master->_lock)
 475                 slave->mtd._lock = part_lock;
 476         if (master->_unlock)
 477                 slave->mtd._unlock = part_unlock;
 478         if (master->_is_locked)
 479                 slave->mtd._is_locked = part_is_locked;
 480         if (master->_block_isreserved)
 481                 slave->mtd._block_isreserved = part_block_isreserved;
 482         if (master->_block_isbad)
 483                 slave->mtd._block_isbad = part_block_isbad;
 484         if (master->_block_markbad)
 485                 slave->mtd._block_markbad = part_block_markbad;
 486         if (master->_max_bad_blocks)
 487                 slave->mtd._max_bad_blocks = part_max_bad_blocks;
 488
 489         if (master->_get_device)
 490                 slave->mtd._get_device = part_get_device;
 491         if (master->_put_device)
 492                 slave->mtd._put_device = part_put_device;
 493
 494         slave->mtd._erase = part_erase;
 495         slave->master = master;
 496         slave->offset = part->offset;
 497
 498         if (slave->offset == MTDPART_OFS_APPEND)
 499                 slave->offset = cur_offset;
 500         if (slave->offset == MTDPART_OFS_NXTBLK) {
 501                 slave->offset = cur_offset;
 502                 if (mtd_mod_by_eb(cur_offset, master) != 0) {
 503                         /* Round up to next erasesize */
 504                         slave->offset = (mtd_div_by_eb(cur_offset, master) + 1) * master->erasesize;
 505                         printk(KERN_NOTICE "Moving partition %d: "
 506                                "0x%012llx -> 0x%012llx\n", partno,
 507                                (unsigned long long)cur_offset, (unsigned long long)slave->offset);
 508                 }
 509         }
 510         if (slave->offset == MTDPART_OFS_RETAIN) {
 511                 slave->offset = cur_offset;
 512                 if (master->size - slave->offset >= slave->mtd.size) {
 513                         slave->mtd.size = master->size - slave->offset
 514                                                         - slave->mtd.size;
 515                 } else {
 516                         printk(KERN_ERR "mtd partition \"%s\" doesn't have enough space: %#llx < %#llx, disabled\n",
 517                                 part->name, master->size - slave->offset,
 518                                 slave->mtd.size);
 519                         /* register to preserve ordering */
 520                         goto out_register;
 521                 }
 522         }
 523         if (slave->mtd.size == MTDPART_SIZ_FULL)
 524                 slave->mtd.size = master->size - slave->offset;
 525
 526         printk(KERN_NOTICE "0x%012llx-0x%012llx : \"%s\"\n", (unsigned long long)slave->offset,
 527                 (unsigned long long)(slave->offset + slave->mtd.size), slave->mtd.name);
 528
 529         /* let's do some sanity checks */
 530         if (slave->offset >= master->size) {
 531                 /* let's register it anyway to preserve ordering */
 532                 slave->offset = 0;
 533                 slave->mtd.size = 0;
 534                 printk(KERN_ERR"mtd: partition \"%s\" is out of reach -- disabled\n",
 535                         part->name);
 536                 goto out_register;
 537         }
 538         if (slave->offset + slave->mtd.size > master->size) {
 539                 slave->mtd.size = master->size - slave->offset;
 540                 printk(KERN_WARNING"mtd: partition \"%s\" extends beyond the end of device \"%s\" -- size truncated to %#llx\n",
 541                         part->name, master->name, (unsigned long long)slave->mtd.size);
 542         }
 543         if (master->numeraseregions > 1) {
 544                 /* Deal with variable erase size stuff */
 545                 int i, max = master->numeraseregions;
 546                 u64 end = slave->offset + slave->mtd.size;
 547                 struct mtd_erase_region_info *regions = master->eraseregions;
 548
 549                 /* Find the first erase regions which is part of this
 550                  * partition. */
 551                 for (i = 0; i < max && regions[i].offset <= slave->offset; i++)
 552                         ;
 553                 /* The loop searched for the region _behind_ the first one */
 554                 if (i > 0)
 555                         i--;
 556
 557                 /* Pick biggest erasesize */
 558                 for (; i < max && regions[i].offset < end; i++) {
 559                         if (slave->mtd.erasesize < regions[i].erasesize) {
 560                                 slave->mtd.erasesize = regions[i].erasesize;
 561                         }
 562                 }
 563                 BUG_ON(slave->mtd.erasesize == 0);
 564         } else {
 565                 /* Single erase size */
 566                 slave->mtd.erasesize = master->erasesize;
 567         }
 568
 569         if ((slave->mtd.flags & MTD_WRITEABLE) &&
 570             mtd_mod_by_eb(slave->offset, &slave->mtd)) {
 571                 /* Doesn't start on a boundary of major erase size */
 572                 /* FIXME: Let it be writable if it is on a boundary of
 573                  * _minor_ erase size though */
 574                 slave->mtd.flags &= ~MTD_WRITEABLE;
 575                 printk(KERN_WARNING"mtd: partition \"%s\" doesn't start on an erase block boundary -- force read-only\n",
 576                         part->name);
 577         }
 578         if ((slave->mtd.flags & MTD_WRITEABLE) &&
 579             mtd_mod_by_eb(slave->mtd.size, &slave->mtd)) {
 580                 slave->mtd.flags &= ~MTD_WRITEABLE;
 581                 printk(KERN_WARNING"mtd: partition \"%s\" doesn't end on an erase block -- force read-only\n",
 582                         part->name);
 583         }
 584
 585         mtd_set_ooblayout(&slave->mtd, &part_ooblayout_ops);
 586         slave->mtd.ecc_step_size = master->ecc_step_size;
 587         slave->mtd.ecc_strength = master->ecc_strength;
 588         slave->mtd.bitflip_threshold = master->bitflip_threshold;
 589
 590         if (master->_block_isbad) {
 591                 uint64_t offs = 0;
 592
 593                 while (offs < slave->mtd.size) {
 594                         if (mtd_block_isreserved(master, offs + slave->offset))
 595                                 slave->mtd.ecc_stats.bbtblocks++;
 596                         else if (mtd_block_isbad(master, offs + slave->offset))
 597                                 slave->mtd.ecc_stats.badblocks++;
 598                         offs += slave->mtd.erasesize;
 599                 }
 600         }
 601
 602 out_register:
 603         return slave;
 604 }
 605
 606 static ssize_t mtd_partition_offset_show(struct device *dev,
 607                 struct device_attribute *attr, char *buf)
 608 {
 609         struct mtd_info *mtd = dev_get_drvdata(dev);
 610         struct mtd_part *part = mtd_to_part(mtd);
 611         return snprintf(buf, PAGE_SIZE, "%lld\n", part->offset);
 612 }
 613
 614 static DEVICE_ATTR(offset, S_IRUGO, mtd_partition_offset_show, NULL);
 615
 616 static const struct attribute *mtd_partition_attrs[] = {
 617         &dev_attr_offset.attr,
 618         NULL
 619 };
 620
 621 static int mtd_add_partition_attrs(struct mtd_part *new)
 622 {
 623         int ret = sysfs_create_files(&new->mtd.dev.kobj, mtd_partition_attrs);
 624         if (ret)
 625                 printk(KERN_WARNING
 626                        "mtd: failed to create partition attrs, err=%d\n", ret);
 627         return ret;
 628 }
 629
 630 int mtd_add_partition(struct mtd_info *master, const char *name,
 631                       long long offset, long long length)
 632 {
 633         struct mtd_partition part;
 634         struct mtd_part *new;
 635         int ret = 0;
 636
 637         /* the direct offset is expected */
 638         if (offset == MTDPART_OFS_APPEND ||
 639             offset == MTDPART_OFS_NXTBLK)
 640                 return -EINVAL;
 641
 642         if (length == MTDPART_SIZ_FULL)
 643                 length = master->size - offset;
 644
 645         if (length <= 0)
 646                 return -EINVAL;
 647
 648         memset(&part, 0, sizeof(part));
 649         part.name = name;
 650         part.size = length;
 651         part.offset = offset;
 652
 653         new = allocate_partition(master, &part, -1, offset);
 654         if (IS_ERR(new))
 655                 return PTR_ERR(new);
 656
 657         mutex_lock(&mtd_partitions_mutex);
 658         list_add(&new->list, &mtd_partitions);
 659         mutex_unlock(&mtd_partitions_mutex);
 660
 661         add_mtd_device(&new->mtd);
 662
 663         mtd_add_partition_attrs(new);
 664
 665         return ret;
 666 }
 667 EXPORT_SYMBOL_GPL(mtd_add_partition);
 668
 669 int mtd_del_partition(struct mtd_info *master, int partno)
 670 {
 671         struct mtd_part *slave, *next;
 672         int ret = -EINVAL;
 673
 674         mutex_lock(&mtd_partitions_mutex);
 675         list_for_each_entry_safe(slave, next, &mtd_partitions, list)
 676                 if ((slave->master == master) &&
 677                     (slave->mtd.index == partno)) {
 678                         sysfs_remove_files(&slave->mtd.dev.kobj,
 679                                            mtd_partition_attrs);
 680                         ret = del_mtd_device(&slave->mtd);
 681                         if (ret < 0)
 682                                 break;
 683
 684                         list_del(&slave->list);
 685                         free_partition(slave);
 686                         break;
 687                 }
 688         mutex_unlock(&mtd_partitions_mutex);
 689
 690         return ret;
 691 }
 692 EXPORT_SYMBOL_GPL(mtd_del_partition);
 693
 694 /*
 695  * This function, given a master MTD object and a partition table, creates
 696  * and registers slave MTD objects which are bound to the master according to
 697  * the partition definitions.
 698  *
 699  * For historical reasons, this function's caller only registers the master
 700  * if the MTD_PARTITIONED_MASTER config option is set.
 701  */
 702
 703 int add_mtd_partitions(struct mtd_info *master,
 704                        const struct mtd_partition *parts,
 705                        int nbparts)
 706 {
 707         struct mtd_part *slave;
 708         uint64_t cur_offset = 0;
 709         int i;
 710
 711         printk(KERN_NOTICE "Creating %d MTD partitions on \"%s\":\n", nbparts, master->name);
 712
 713         for (i = 0; i < nbparts; i++) {
 714                 slave = allocate_partition(master, parts + i, i, cur_offset);
 715                 if (IS_ERR(slave)) {
 716                         del_mtd_partitions(master);
 717                         return PTR_ERR(slave);
 718                 }
 719
 720                 mutex_lock(&mtd_partitions_mutex);
 721                 list_add(&slave->list, &mtd_partitions);
 722                 mutex_unlock(&mtd_partitions_mutex);
 723
 724                 add_mtd_device(&slave->mtd);
 725                 mtd_add_partition_attrs(slave);
 726
 727                 cur_offset = slave->offset + slave->mtd.size;
 728         }
 729
 730         return 0;
 731 }
 732
 733 static DEFINE_SPINLOCK(part_parser_lock);
 734 static LIST_HEAD(part_parsers);
 735
 736 static struct mtd_part_parser *mtd_part_parser_get(const char *name)
 737 {
 738         struct mtd_part_parser *p, *ret = NULL;
 739
 740         spin_lock(&part_parser_lock);
 741
 742         list_for_each_entry(p, &part_parsers, list)
 743                 if (!strcmp(p->name, name) && try_module_get(p->owner)) {
 744                         ret = p;
 745                         break;
 746                 }
 747
 748         spin_unlock(&part_parser_lock);
 749
 750         return ret;
 751 }
 752
 753 static inline void mtd_part_parser_put(const struct mtd_part_parser *p)
 754 {
 755         module_put(p->owner);
 756 }
 757
 758 /*
 759  * Many partition parsers just expected the core to kfree() all their data in
 760  * one chunk. Do that by default.
 761  */
 762 static void mtd_part_parser_cleanup_default(const struct mtd_partition *pparts,
 763                                             int nr_parts)
 764 {
 765         kfree(pparts);
 766 }
 767
 768 int __register_mtd_parser(struct mtd_part_parser *p, struct module *owner)
 769 {
 770         p->owner = owner;
 771
 772         if (!p->cleanup)
 773                 p->cleanup = &mtd_part_parser_cleanup_default;
 774
 775         spin_lock(&part_parser_lock);
 776         list_add(&p->list, &part_parsers);
 777         spin_unlock(&part_parser_lock);
 778
 779         return 0;
 780 }
 781 EXPORT_SYMBOL_GPL(__register_mtd_parser);
 782
 783 void deregister_mtd_parser(struct mtd_part_parser *p)
 784 {
 785         spin_lock(&part_parser_lock);
 786         list_del(&p->list);
 787         spin_unlock(&part_parser_lock);
 788 }
 789 EXPORT_SYMBOL_GPL(deregister_mtd_parser);
 790
 791 /*
 792  * Do not forget to update 'parse_mtd_partitions()' kerneldoc comment if you
 793  * are changing this array!
 794  */
 795 static const char * const default_mtd_part_types[] = {
 796         "cmdlinepart",
 797         "ofpart",
 798         NULL
 799 };
 800
 801 /**
 802  * parse_mtd_partitions - parse MTD partitions
 803  * @master: the master partition (describes whole MTD device)
 804  * @types: names of partition parsers to try or %NULL
 805  * @pparts: info about partitions found is returned here
 806  * @data: MTD partition parser-specific data
 807  *
 808  * This function tries to find partition on MTD device @master. It uses MTD
 809  * partition parsers, specified in @types. However, if @types is %NULL, then
 810  * the default list of parsers is used. The default list contains only the
 811  * "cmdlinepart" and "ofpart" parsers ATM.
 812  * Note: If there are more then one parser in @types, the kernel only takes the
 813  * partitions parsed out by the first parser.
 814  *
 815  * This function may return:
 816  * o a negative error code in case of failure
 817  * o zero otherwise, and @pparts will describe the partitions, number of
 818  *   partitions, and the parser which parsed them. Caller must release
 819  *   resources with mtd_part_parser_cleanup() when finished with the returned
 820  *   data.
 821  */
 822 int parse_mtd_partitions(struct mtd_info *master, const char *const *types,
 823                          struct mtd_partitions *pparts,
 824                          struct mtd_part_parser_data *data)
 825 {
 826         struct mtd_part_parser *parser;
 827         int ret, err = 0;
 828
 829         if (!types)
 830                 types = default_mtd_part_types;
 831
 832         for ( ; *types; types++) {
 833                 pr_debug("%s: parsing partitions %s\n", master->name, *types);
 834                 parser = mtd_part_parser_get(*types);
 835                 if (!parser && !request_module("%s", *types))
 836                         parser = mtd_part_parser_get(*types);
 837                 pr_debug("%s: got parser %s\n", master->name,
 838                          parser ? parser->name : NULL);
 839                 if (!parser)
 840                         continue;
 841                 ret = (*parser->parse_fn)(master, &pparts->parts, data);
 842                 pr_debug("%s: parser %s: %i\n",
 843                          master->name, parser->name, ret);
 844                 if (ret > 0) {
 845                         printk(KERN_NOTICE "%d %s partitions found on MTD device %s\n",
 846                                ret, parser->name, master->name);
 847                         pparts->nr_parts = ret;
 848                         pparts->parser = parser;
 849                         return 0;
 850                 }
 851                 mtd_part_parser_put(parser);
 852                 /*
 853                  * Stash the first error we see; only report it if no parser
 854                  * succeeds
 855                  */
 856                 if (ret < 0 && !err)
 857                         err = ret;
 858         }
 859         return err;
 860 }
 861
 862 void mtd_part_parser_cleanup(struct mtd_partitions *parts)
 863 {
 864         const struct mtd_part_parser *parser;
 865
 866         if (!parts)
 867                 return;
 868
 869         parser = parts->parser;
 870         if (parser) {
 871                 if (parser->cleanup)
 872                         parser->cleanup(parts->parts, parts->nr_parts);
 873
 874                 mtd_part_parser_put(parser);
 875         }
 876 }
 877
 878 int mtd_is_partition(const struct mtd_info *mtd)
 879 {
 880         struct mtd_part *part;
 881         int ispart = 0;
 882
 883         mutex_lock(&mtd_partitions_mutex);
 884         list_for_each_entry(part, &mtd_partitions, list)
 885                 if (&part->mtd == mtd) {
 886                         ispart = 1;
 887                         break;
 888                 }
 889         mutex_unlock(&mtd_partitions_mutex);
 890
 891         return ispart;
 892 }
 893 EXPORT_SYMBOL_GPL(mtd_is_partition);
 894
 895 /* Returns the size of the entire flash chip */
 896 uint64_t mtd_get_device_size(const struct mtd_info *mtd)
 897 {
 898         if (!mtd_is_partition(mtd))
 899                 return mtd->size;
 900
 901         return mtd_to_part(mtd)->master->size;
 902 }
 903 EXPORT_SYMBOL_GPL(mtd_get_device_size);