1 /* 2 * (C) Copyright 2002 3 * Wolfgang Denk, DENX Software Engineering, wd@denx.de. 4 * 5 * (C) Copyright 2002 6 * Robert Schwebel, Pengutronix, <r.schwebel@pengutronix.de> 7 * 8 * (C) Copyright 2003 9 * Kai-Uwe Bloem, Auerswald GmbH & Co KG, <linux-development@auerswald.de> 10 * 11 * (C) Copyright 2005 12 * Wolfgang Denk, DENX Software Engineering, wd@denx.de. 13 * 14 * Added support for reading flash partition table from environment. 15 * Parsing routines are based on driver/mtd/cmdline.c from the linux 2.4 16 * kernel tree. 17 * 18 * (C) Copyright 2008 19 * Harald Welte, OpenMoko, Inc., Harald Welte <laforge@openmoko.org> 20 * 21 * $Id: cmdlinepart.c,v 1.17 2004/11/26 11:18:47 lavinen Exp $ 22 * Copyright 2002 SYSGO Real-Time Solutions GmbH 23 * 24 * SPDX-License-Identifier: GPL-2.0+ 25 */ 26 27 /* 28 * Three environment variables are used by the parsing routines: 29 * 30 * 'partition' - keeps current partition identifier 31 * 32 * partition := <part-id> 33 * <part-id> := <dev-id>,part_num 34 * 35 * 36 * 'mtdids' - linux kernel mtd device id <-> u-boot device id mapping 37 * 38 * mtdids=<idmap>[,<idmap>,...] 39 * 40 * <idmap> := <dev-id>=<mtd-id> 41 * <dev-id> := 'nand'|'nor'|'onenand'|'spi-nand'<dev-num> 42 * <dev-num> := mtd device number, 0... 43 * <mtd-id> := unique device tag used by linux kernel to find mtd device (mtd->name) 44 * 45 * 46 * 'mtdparts' - partition list 47 * 48 * mtdparts=mtdparts=<mtd-def>[;<mtd-def>...] 49 * 50 * <mtd-def> := <mtd-id>:<part-def>[,<part-def>...] 51 * <mtd-id> := unique device tag used by linux kernel to find mtd device (mtd->name) 52 * <part-def> := <size>[@<offset>][<name>][<ro-flag>] 53 * <size> := standard linux memsize OR '-' to denote all remaining space 54 * <offset> := partition start offset within the device 55 * <name> := '(' NAME ')' 56 * <ro-flag> := when set to 'ro' makes partition read-only (not used, passed to kernel) 57 * 58 * Notes: 59 * - each <mtd-id> used in mtdparts must albo exist in 'mtddis' mapping 60 * - if the above variables are not set defaults for a given target are used 61 * 62 * Examples: 63 * 64 * 1 NOR Flash, with 1 single writable partition: 65 * mtdids=nor0=edb7312-nor 66 * mtdparts=mtdparts=edb7312-nor:- 67 * 68 * 1 NOR Flash with 2 partitions, 1 NAND with one 69 * mtdids=nor0=edb7312-nor,nand0=edb7312-nand 70 * mtdparts=mtdparts=edb7312-nor:256k(ARMboot)ro,-(root);edb7312-nand:-(home) 71 * 72 */ 73 74 #include <common.h> 75 #include <command.h> 76 #include <malloc.h> 77 #include <jffs2/load_kernel.h> 78 #include <linux/list.h> 79 #include <linux/ctype.h> 80 #include <linux/err.h> 81 #include <linux/mtd/mtd.h> 82 83 #if defined(CONFIG_CMD_NAND) 84 #include <linux/mtd/rawnand.h> 85 #include <nand.h> 86 #endif 87 88 #if defined(CONFIG_CMD_ONENAND) 89 #include <linux/mtd/onenand.h> 90 #include <onenand_uboot.h> 91 #endif 92 93 DECLARE_GLOBAL_DATA_PTR; 94 95 /* special size referring to all the remaining space in a partition */ 96 #define SIZE_REMAINING (~0llu) 97 98 /* special offset value, it is used when not provided by user 99 * 100 * this value is used temporarily during parsing, later such offests 101 * are recalculated */ 102 #define OFFSET_NOT_SPECIFIED (~0llu) 103 104 /* minimum partition size */ 105 #define MIN_PART_SIZE 4096 106 107 /* this flag needs to be set in part_info struct mask_flags 108 * field for read-only partitions */ 109 #define MTD_WRITEABLE_CMD 1 110 111 /* default values for mtdids and mtdparts variables */ 112 #if !defined(MTDIDS_DEFAULT) 113 #ifdef CONFIG_MTDIDS_DEFAULT 114 #define MTDIDS_DEFAULT CONFIG_MTDIDS_DEFAULT 115 #else 116 #define MTDIDS_DEFAULT NULL 117 #endif 118 #endif 119 #if !defined(MTDPARTS_DEFAULT) 120 #ifdef CONFIG_MTDPARTS_DEFAULT 121 #define MTDPARTS_DEFAULT CONFIG_MTDPARTS_DEFAULT 122 #else 123 #define MTDPARTS_DEFAULT NULL 124 #endif 125 #endif 126 #if defined(CONFIG_SYS_MTDPARTS_RUNTIME) 127 extern void board_mtdparts_default(const char **mtdids, const char **mtdparts); 128 #endif 129 static const char *mtdids_default = MTDIDS_DEFAULT; 130 static const char *mtdparts_default = MTDPARTS_DEFAULT; 131 132 /* copies of last seen 'mtdids', 'mtdparts' and 'partition' env variables */ 133 #define MTDIDS_MAXLEN 128 134 #define MTDPARTS_MAXLEN 512 135 #define PARTITION_MAXLEN 16 136 static char last_ids[MTDIDS_MAXLEN + 1]; 137 static char last_parts[MTDPARTS_MAXLEN + 1]; 138 static char last_partition[PARTITION_MAXLEN + 1]; 139 140 /* low level jffs2 cache cleaning routine */ 141 extern void jffs2_free_cache(struct part_info *part); 142 143 /* mtdids mapping list, filled by parse_ids() */ 144 static struct list_head mtdids; 145 146 /* device/partition list, parse_cmdline() parses into here */ 147 static struct list_head devices; 148 149 /* current active device and partition number */ 150 struct mtd_device *current_mtd_dev = NULL; 151 u8 current_mtd_partnum = 0; 152 153 u8 use_defaults; 154 155 static struct part_info* mtd_part_info(struct mtd_device *dev, unsigned int part_num); 156 157 /* command line only routines */ 158 static struct mtdids* id_find_by_mtd_id(const char *mtd_id, unsigned int mtd_id_len); 159 static int device_del(struct mtd_device *dev); 160 161 /** 162 * Parses a string into a number. The number stored at ptr is 163 * potentially suffixed with K (for kilobytes, or 1024 bytes), 164 * M (for megabytes, or 1048576 bytes), or G (for gigabytes, or 165 * 1073741824). If the number is suffixed with K, M, or G, then 166 * the return value is the number multiplied by one kilobyte, one 167 * megabyte, or one gigabyte, respectively. 168 * 169 * @param ptr where parse begins 170 * @param retptr output pointer to next char after parse completes (output) 171 * @return resulting unsigned int 172 */ 173 static u64 memsize_parse (const char *const ptr, const char **retptr) 174 { 175 u64 ret = simple_strtoull(ptr, (char **)retptr, 0); 176 177 switch (**retptr) { 178 case 'G': 179 case 'g': 180 ret <<= 10; 181 /* Fallthrough */ 182 case 'M': 183 case 'm': 184 ret <<= 10; 185 /* Fallthrough */ 186 case 'K': 187 case 'k': 188 ret <<= 10; 189 (*retptr)++; 190 /* Fallthrough */ 191 default: 192 break; 193 } 194 195 return ret; 196 } 197 198 /** 199 * Format string describing supplied size. This routine does the opposite job 200 * to memsize_parse(). Size in bytes is converted to string and if possible 201 * shortened by using k (kilobytes), m (megabytes) or g (gigabytes) suffix. 202 * 203 * Note, that this routine does not check for buffer overflow, it's the caller 204 * who must assure enough space. 205 * 206 * @param buf output buffer 207 * @param size size to be converted to string 208 */ 209 static void memsize_format(char *buf, u64 size) 210 { 211 #define SIZE_GB ((u32)1024*1024*1024) 212 #define SIZE_MB ((u32)1024*1024) 213 #define SIZE_KB ((u32)1024) 214 215 if ((size % SIZE_GB) == 0) 216 sprintf(buf, "%llug", size/SIZE_GB); 217 else if ((size % SIZE_MB) == 0) 218 sprintf(buf, "%llum", size/SIZE_MB); 219 else if (size % SIZE_KB == 0) 220 sprintf(buf, "%lluk", size/SIZE_KB); 221 else 222 sprintf(buf, "%llu", size); 223 } 224 225 /** 226 * This routine does global indexing of all partitions. Resulting index for 227 * current partition is saved in 'mtddevnum'. Current partition name in 228 * 'mtddevname'. 229 */ 230 static void index_partitions(void) 231 { 232 u16 mtddevnum; 233 struct part_info *part; 234 struct list_head *dentry; 235 struct mtd_device *dev; 236 237 debug("--- index partitions ---\n"); 238 239 if (current_mtd_dev) { 240 mtddevnum = 0; 241 list_for_each(dentry, &devices) { 242 dev = list_entry(dentry, struct mtd_device, link); 243 if (dev == current_mtd_dev) { 244 mtddevnum += current_mtd_partnum; 245 env_set_ulong("mtddevnum", mtddevnum); 246 debug("=> mtddevnum %d,\n", mtddevnum); 247 break; 248 } 249 mtddevnum += dev->num_parts; 250 } 251 252 part = mtd_part_info(current_mtd_dev, current_mtd_partnum); 253 if (part) { 254 env_set("mtddevname", part->name); 255 256 debug("=> mtddevname %s\n", part->name); 257 } else { 258 env_set("mtddevname", NULL); 259 260 debug("=> mtddevname NULL\n"); 261 } 262 } else { 263 env_set("mtddevnum", NULL); 264 env_set("mtddevname", NULL); 265 266 debug("=> mtddevnum NULL\n=> mtddevname NULL\n"); 267 } 268 } 269 270 /** 271 * Save current device and partition in environment variable 'partition'. 272 */ 273 static void current_save(void) 274 { 275 char buf[16]; 276 277 debug("--- current_save ---\n"); 278 279 if (current_mtd_dev) { 280 sprintf(buf, "%s%d,%d", MTD_DEV_TYPE(current_mtd_dev->id->type), 281 current_mtd_dev->id->num, current_mtd_partnum); 282 283 env_set("partition", buf); 284 strncpy(last_partition, buf, 16); 285 286 debug("=> partition %s\n", buf); 287 } else { 288 env_set("partition", NULL); 289 last_partition[0] = '\0'; 290 291 debug("=> partition NULL\n"); 292 } 293 index_partitions(); 294 } 295 296 297 /** 298 * Produce a mtd_info given a type and num. 299 * 300 * @param type mtd type 301 * @param num mtd number 302 * @param mtd a pointer to an mtd_info instance (output) 303 * @return 0 if device is valid, 1 otherwise 304 */ 305 static int get_mtd_info(u8 type, u8 num, struct mtd_info **mtd) 306 { 307 char mtd_dev[16]; 308 309 sprintf(mtd_dev, "%s%d", MTD_DEV_TYPE(type), num); 310 *mtd = get_mtd_device_nm(mtd_dev); 311 if (IS_ERR(*mtd)) { 312 printf("Device %s not found!\n", mtd_dev); 313 return 1; 314 } 315 put_mtd_device(*mtd); 316 317 return 0; 318 } 319 320 /** 321 * Performs sanity check for supplied flash partition. 322 * Table of existing MTD flash devices is searched and partition device 323 * is located. Alignment with the granularity of nand erasesize is verified. 324 * 325 * @param id of the parent device 326 * @param part partition to validate 327 * @return 0 if partition is valid, 1 otherwise 328 */ 329 static int part_validate_eraseblock(struct mtdids *id, struct part_info *part) 330 { 331 struct mtd_info *mtd = NULL; 332 int i, j; 333 ulong start; 334 u64 offset, size; 335 336 if (get_mtd_info(id->type, id->num, &mtd)) 337 return 1; 338 339 part->sector_size = mtd->erasesize; 340 341 if (!mtd->numeraseregions) { 342 /* 343 * Only one eraseregion (NAND, SPI-NAND, OneNAND or uniform NOR), 344 * checking for alignment is easy here 345 */ 346 offset = part->offset; 347 if (do_div(offset, mtd->erasesize)) { 348 printf("%s%d: partition (%s) start offset" 349 "alignment incorrect\n", 350 MTD_DEV_TYPE(id->type), id->num, part->name); 351 return 1; 352 } 353 354 size = part->size; 355 if (do_div(size, mtd->erasesize)) { 356 printf("%s%d: partition (%s) size alignment incorrect\n", 357 MTD_DEV_TYPE(id->type), id->num, part->name); 358 return 1; 359 } 360 } else { 361 /* 362 * Multiple eraseregions (non-uniform NOR), 363 * checking for alignment is more complex here 364 */ 365 366 /* Check start alignment */ 367 for (i = 0; i < mtd->numeraseregions; i++) { 368 start = mtd->eraseregions[i].offset; 369 for (j = 0; j < mtd->eraseregions[i].numblocks; j++) { 370 if (part->offset == start) 371 goto start_ok; 372 start += mtd->eraseregions[i].erasesize; 373 } 374 } 375 376 printf("%s%d: partition (%s) start offset alignment incorrect\n", 377 MTD_DEV_TYPE(id->type), id->num, part->name); 378 return 1; 379 380 start_ok: 381 382 /* Check end/size alignment */ 383 for (i = 0; i < mtd->numeraseregions; i++) { 384 start = mtd->eraseregions[i].offset; 385 for (j = 0; j < mtd->eraseregions[i].numblocks; j++) { 386 if ((part->offset + part->size) == start) 387 goto end_ok; 388 start += mtd->eraseregions[i].erasesize; 389 } 390 } 391 /* Check last sector alignment */ 392 if ((part->offset + part->size) == start) 393 goto end_ok; 394 395 printf("%s%d: partition (%s) size alignment incorrect\n", 396 MTD_DEV_TYPE(id->type), id->num, part->name); 397 return 1; 398 399 end_ok: 400 return 0; 401 } 402 403 return 0; 404 } 405 406 407 /** 408 * Performs sanity check for supplied partition. Offset and size are 409 * verified to be within valid range. Partition type is checked and 410 * part_validate_eraseblock() is called with the argument of part. 411 * 412 * @param id of the parent device 413 * @param part partition to validate 414 * @return 0 if partition is valid, 1 otherwise 415 */ 416 static int part_validate(struct mtdids *id, struct part_info *part) 417 { 418 if (part->size == SIZE_REMAINING) 419 part->size = id->size - part->offset; 420 421 if (part->offset > id->size) { 422 printf("%s: offset %08llx beyond flash size %08llx\n", 423 id->mtd_id, part->offset, id->size); 424 return 1; 425 } 426 427 if ((part->offset + part->size) <= part->offset) { 428 printf("%s%d: partition (%s) size too big\n", 429 MTD_DEV_TYPE(id->type), id->num, part->name); 430 return 1; 431 } 432 433 if (part->offset + part->size > id->size) { 434 printf("%s: partitioning exceeds flash size\n", id->mtd_id); 435 return 1; 436 } 437 438 /* 439 * Now we need to check if the partition starts and ends on 440 * sector (eraseblock) regions 441 */ 442 return part_validate_eraseblock(id, part); 443 } 444 445 /** 446 * Delete selected partition from the partition list of the specified device. 447 * 448 * @param dev device to delete partition from 449 * @param part partition to delete 450 * @return 0 on success, 1 otherwise 451 */ 452 static int part_del(struct mtd_device *dev, struct part_info *part) 453 { 454 u8 current_save_needed = 0; 455 456 /* if there is only one partition, remove whole device */ 457 if (dev->num_parts == 1) 458 return device_del(dev); 459 460 /* otherwise just delete this partition */ 461 462 if (dev == current_mtd_dev) { 463 /* we are modyfing partitions for the current device, 464 * update current */ 465 struct part_info *curr_pi; 466 curr_pi = mtd_part_info(current_mtd_dev, current_mtd_partnum); 467 468 if (curr_pi) { 469 if (curr_pi == part) { 470 printf("current partition deleted, resetting current to 0\n"); 471 current_mtd_partnum = 0; 472 } else if (part->offset <= curr_pi->offset) { 473 current_mtd_partnum--; 474 } 475 current_save_needed = 1; 476 } 477 } 478 479 list_del(&part->link); 480 free(part); 481 dev->num_parts--; 482 483 if (current_save_needed > 0) 484 current_save(); 485 else 486 index_partitions(); 487 488 return 0; 489 } 490 491 /** 492 * Delete all partitions from parts head list, free memory. 493 * 494 * @param head list of partitions to delete 495 */ 496 static void part_delall(struct list_head *head) 497 { 498 struct list_head *entry, *n; 499 struct part_info *part_tmp; 500 501 /* clean tmp_list and free allocated memory */ 502 list_for_each_safe(entry, n, head) { 503 part_tmp = list_entry(entry, struct part_info, link); 504 505 list_del(entry); 506 free(part_tmp); 507 } 508 } 509 510 /** 511 * Add new partition to the supplied partition list. Make sure partitions are 512 * sorted by offset in ascending order. 513 * 514 * @param head list this partition is to be added to 515 * @param new partition to be added 516 */ 517 static int part_sort_add(struct mtd_device *dev, struct part_info *part) 518 { 519 struct list_head *entry; 520 struct part_info *new_pi, *curr_pi; 521 522 /* link partition to parrent dev */ 523 part->dev = dev; 524 525 if (list_empty(&dev->parts)) { 526 debug("part_sort_add: list empty\n"); 527 list_add(&part->link, &dev->parts); 528 dev->num_parts++; 529 index_partitions(); 530 return 0; 531 } 532 533 new_pi = list_entry(&part->link, struct part_info, link); 534 535 /* get current partition info if we are updating current device */ 536 curr_pi = NULL; 537 if (dev == current_mtd_dev) 538 curr_pi = mtd_part_info(current_mtd_dev, current_mtd_partnum); 539 540 list_for_each(entry, &dev->parts) { 541 struct part_info *pi; 542 543 pi = list_entry(entry, struct part_info, link); 544 545 /* be compliant with kernel cmdline, allow only one partition at offset zero */ 546 if ((new_pi->offset == pi->offset) && (pi->offset == 0)) { 547 printf("cannot add second partition at offset 0\n"); 548 return 1; 549 } 550 551 if (new_pi->offset <= pi->offset) { 552 list_add_tail(&part->link, entry); 553 dev->num_parts++; 554 555 if (curr_pi && (pi->offset <= curr_pi->offset)) { 556 /* we are modyfing partitions for the current 557 * device, update current */ 558 current_mtd_partnum++; 559 current_save(); 560 } else { 561 index_partitions(); 562 } 563 return 0; 564 } 565 } 566 567 list_add_tail(&part->link, &dev->parts); 568 dev->num_parts++; 569 index_partitions(); 570 return 0; 571 } 572 573 /** 574 * Add provided partition to the partition list of a given device. 575 * 576 * @param dev device to which partition is added 577 * @param part partition to be added 578 * @return 0 on success, 1 otherwise 579 */ 580 static int part_add(struct mtd_device *dev, struct part_info *part) 581 { 582 /* verify alignment and size */ 583 if (part_validate(dev->id, part) != 0) 584 return 1; 585 586 /* partition is ok, add it to the list */ 587 if (part_sort_add(dev, part) != 0) 588 return 1; 589 590 return 0; 591 } 592 593 /** 594 * Parse one partition definition, allocate memory and return pointer to this 595 * location in retpart. 596 * 597 * @param partdef pointer to the partition definition string i.e. <part-def> 598 * @param ret output pointer to next char after parse completes (output) 599 * @param retpart pointer to the allocated partition (output) 600 * @return 0 on success, 1 otherwise 601 */ 602 static int part_parse(const char *const partdef, const char **ret, struct part_info **retpart) 603 { 604 struct part_info *part; 605 u64 size; 606 u64 offset; 607 const char *name; 608 int name_len; 609 unsigned int mask_flags; 610 const char *p; 611 612 p = partdef; 613 *retpart = NULL; 614 *ret = NULL; 615 616 /* fetch the partition size */ 617 if (*p == '-') { 618 /* assign all remaining space to this partition */ 619 debug("'-': remaining size assigned\n"); 620 size = SIZE_REMAINING; 621 p++; 622 } else { 623 size = memsize_parse(p, &p); 624 if (size < MIN_PART_SIZE) { 625 printf("partition size too small (%llx)\n", size); 626 return 1; 627 } 628 } 629 630 /* check for offset */ 631 offset = OFFSET_NOT_SPECIFIED; 632 if (*p == '@') { 633 p++; 634 offset = memsize_parse(p, &p); 635 } 636 637 /* now look for the name */ 638 if (*p == '(') { 639 name = ++p; 640 if ((p = strchr(name, ')')) == NULL) { 641 printf("no closing ) found in partition name\n"); 642 return 1; 643 } 644 name_len = p - name + 1; 645 if ((name_len - 1) == 0) { 646 printf("empty partition name\n"); 647 return 1; 648 } 649 p++; 650 } else { 651 /* 0x00000000@0x00000000 */ 652 name_len = 22; 653 name = NULL; 654 } 655 656 /* test for options */ 657 mask_flags = 0; 658 if (strncmp(p, "ro", 2) == 0) { 659 mask_flags |= MTD_WRITEABLE_CMD; 660 p += 2; 661 } 662 663 /* check for next partition definition */ 664 if (*p == ',') { 665 if (size == SIZE_REMAINING) { 666 *ret = NULL; 667 printf("no partitions allowed after a fill-up partition\n"); 668 return 1; 669 } 670 *ret = ++p; 671 } else if ((*p == ';') || (*p == '\0')) { 672 *ret = p; 673 } else { 674 printf("unexpected character '%c' at the end of partition\n", *p); 675 *ret = NULL; 676 return 1; 677 } 678 679 /* allocate memory */ 680 part = (struct part_info *)malloc(sizeof(struct part_info) + name_len); 681 if (!part) { 682 printf("out of memory\n"); 683 return 1; 684 } 685 memset(part, 0, sizeof(struct part_info) + name_len); 686 part->size = size; 687 part->offset = offset; 688 part->mask_flags = mask_flags; 689 part->name = (char *)(part + 1); 690 691 if (name) { 692 /* copy user provided name */ 693 strncpy(part->name, name, name_len - 1); 694 part->auto_name = 0; 695 } else { 696 /* auto generated name in form of size@offset */ 697 snprintf(part->name, name_len, "0x%08llx@0x%08llx", size, offset); 698 part->auto_name = 1; 699 } 700 701 part->name[name_len - 1] = '\0'; 702 INIT_LIST_HEAD(&part->link); 703 704 debug("+ partition: name %-22s size 0x%08llx offset 0x%08llx mask flags %d\n", 705 part->name, part->size, 706 part->offset, part->mask_flags); 707 708 *retpart = part; 709 return 0; 710 } 711 712 /** 713 * Check device number to be within valid range for given device type. 714 * 715 * @param type mtd type 716 * @param num mtd number 717 * @param size a pointer to the size of the mtd device (output) 718 * @return 0 if device is valid, 1 otherwise 719 */ 720 static int mtd_device_validate(u8 type, u8 num, u64 *size) 721 { 722 struct mtd_info *mtd = NULL; 723 724 if (get_mtd_info(type, num, &mtd)) 725 return 1; 726 727 *size = mtd->size; 728 729 return 0; 730 } 731 732 /** 733 * Delete all mtd devices from a supplied devices list, free memory allocated for 734 * each device and delete all device partitions. 735 * 736 * @return 0 on success, 1 otherwise 737 */ 738 static int device_delall(struct list_head *head) 739 { 740 struct list_head *entry, *n; 741 struct mtd_device *dev_tmp; 742 743 /* clean devices list */ 744 list_for_each_safe(entry, n, head) { 745 dev_tmp = list_entry(entry, struct mtd_device, link); 746 list_del(entry); 747 part_delall(&dev_tmp->parts); 748 free(dev_tmp); 749 } 750 INIT_LIST_HEAD(&devices); 751 752 return 0; 753 } 754 755 /** 756 * If provided device exists it's partitions are deleted, device is removed 757 * from device list and device memory is freed. 758 * 759 * @param dev device to be deleted 760 * @return 0 on success, 1 otherwise 761 */ 762 static int device_del(struct mtd_device *dev) 763 { 764 part_delall(&dev->parts); 765 list_del(&dev->link); 766 free(dev); 767 768 if (dev == current_mtd_dev) { 769 /* we just deleted current device */ 770 if (list_empty(&devices)) { 771 current_mtd_dev = NULL; 772 } else { 773 /* reset first partition from first dev from the 774 * devices list as current */ 775 current_mtd_dev = list_entry(devices.next, struct mtd_device, link); 776 current_mtd_partnum = 0; 777 } 778 current_save(); 779 return 0; 780 } 781 782 index_partitions(); 783 return 0; 784 } 785 786 /** 787 * Search global device list and return pointer to the device of type and num 788 * specified. 789 * 790 * @param type device type 791 * @param num device number 792 * @return NULL if requested device does not exist 793 */ 794 struct mtd_device *device_find(u8 type, u8 num) 795 { 796 struct list_head *entry; 797 struct mtd_device *dev_tmp; 798 799 list_for_each(entry, &devices) { 800 dev_tmp = list_entry(entry, struct mtd_device, link); 801 802 if ((dev_tmp->id->type == type) && (dev_tmp->id->num == num)) 803 return dev_tmp; 804 } 805 806 return NULL; 807 } 808 809 /** 810 * Add specified device to the global device list. 811 * 812 * @param dev device to be added 813 */ 814 static void device_add(struct mtd_device *dev) 815 { 816 u8 current_save_needed = 0; 817 818 if (list_empty(&devices)) { 819 current_mtd_dev = dev; 820 current_mtd_partnum = 0; 821 current_save_needed = 1; 822 } 823 824 list_add_tail(&dev->link, &devices); 825 826 if (current_save_needed > 0) 827 current_save(); 828 else 829 index_partitions(); 830 } 831 832 /** 833 * Parse device type, name and mtd-id. If syntax is ok allocate memory and 834 * return pointer to the device structure. 835 * 836 * @param mtd_dev pointer to the device definition string i.e. <mtd-dev> 837 * @param ret output pointer to next char after parse completes (output) 838 * @param retdev pointer to the allocated device (output) 839 * @return 0 on success, 1 otherwise 840 */ 841 static int device_parse(const char *const mtd_dev, const char **ret, struct mtd_device **retdev) 842 { 843 struct mtd_device *dev; 844 struct part_info *part; 845 struct mtdids *id; 846 const char *mtd_id; 847 unsigned int mtd_id_len; 848 const char *p; 849 const char *pend; 850 LIST_HEAD(tmp_list); 851 struct list_head *entry, *n; 852 u16 num_parts; 853 u64 offset; 854 int err = 1; 855 856 debug("===device_parse===\n"); 857 858 assert(retdev); 859 *retdev = NULL; 860 861 if (ret) 862 *ret = NULL; 863 864 /* fetch <mtd-id> */ 865 mtd_id = p = mtd_dev; 866 if (!(p = strchr(mtd_id, ':'))) { 867 printf("no <mtd-id> identifier\n"); 868 return 1; 869 } 870 mtd_id_len = p - mtd_id + 1; 871 p++; 872 873 /* verify if we have a valid device specified */ 874 if ((id = id_find_by_mtd_id(mtd_id, mtd_id_len - 1)) == NULL) { 875 printf("invalid mtd device '%.*s'\n", mtd_id_len - 1, mtd_id); 876 return 1; 877 } 878 879 pend = strchr(p, ';'); 880 debug("dev type = %d (%s), dev num = %d, mtd-id = %s\n", 881 id->type, MTD_DEV_TYPE(id->type), 882 id->num, id->mtd_id); 883 debug("parsing partitions %.*s\n", (int)(pend ? pend - p : strlen(p)), p); 884 885 /* parse partitions */ 886 num_parts = 0; 887 888 offset = 0; 889 if ((dev = device_find(id->type, id->num)) != NULL) { 890 /* if device already exists start at the end of the last partition */ 891 part = list_entry(dev->parts.prev, struct part_info, link); 892 offset = part->offset + part->size; 893 } 894 895 while (p && (*p != '\0') && (*p != ';')) { 896 err = 1; 897 if ((part_parse(p, &p, &part) != 0) || (!part)) 898 break; 899 900 /* calculate offset when not specified */ 901 if (part->offset == OFFSET_NOT_SPECIFIED) 902 part->offset = offset; 903 else 904 offset = part->offset; 905 906 /* verify alignment and size */ 907 if (part_validate(id, part) != 0) 908 break; 909 910 offset += part->size; 911 912 /* partition is ok, add it to the list */ 913 list_add_tail(&part->link, &tmp_list); 914 num_parts++; 915 err = 0; 916 } 917 if (err == 1) { 918 part_delall(&tmp_list); 919 return 1; 920 } 921 922 debug("\ntotal partitions: %d\n", num_parts); 923 924 /* check for next device presence */ 925 if (p) { 926 if (*p == ';') { 927 if (ret) 928 *ret = ++p; 929 } else if (*p == '\0') { 930 if (ret) 931 *ret = p; 932 } else { 933 printf("unexpected character '%c' at the end of device\n", *p); 934 if (ret) 935 *ret = NULL; 936 return 1; 937 } 938 } 939 940 /* allocate memory for mtd_device structure */ 941 if ((dev = (struct mtd_device *)malloc(sizeof(struct mtd_device))) == NULL) { 942 printf("out of memory\n"); 943 return 1; 944 } 945 memset(dev, 0, sizeof(struct mtd_device)); 946 dev->id = id; 947 dev->num_parts = 0; /* part_sort_add increments num_parts */ 948 INIT_LIST_HEAD(&dev->parts); 949 INIT_LIST_HEAD(&dev->link); 950 951 /* move partitions from tmp_list to dev->parts */ 952 list_for_each_safe(entry, n, &tmp_list) { 953 part = list_entry(entry, struct part_info, link); 954 list_del(entry); 955 if (part_sort_add(dev, part) != 0) { 956 device_del(dev); 957 return 1; 958 } 959 } 960 961 *retdev = dev; 962 963 debug("===\n\n"); 964 return 0; 965 } 966 967 /** 968 * Initialize global device list. 969 * 970 * @return 0 on success, 1 otherwise 971 */ 972 static int mtd_devices_init(void) 973 { 974 last_parts[0] = '\0'; 975 current_mtd_dev = NULL; 976 current_save(); 977 978 return device_delall(&devices); 979 } 980 981 /* 982 * Search global mtdids list and find id of requested type and number. 983 * 984 * @return pointer to the id if it exists, NULL otherwise 985 */ 986 static struct mtdids* id_find(u8 type, u8 num) 987 { 988 struct list_head *entry; 989 struct mtdids *id; 990 991 list_for_each(entry, &mtdids) { 992 id = list_entry(entry, struct mtdids, link); 993 994 if ((id->type == type) && (id->num == num)) 995 return id; 996 } 997 998 return NULL; 999 } 1000 1001 /** 1002 * Search global mtdids list and find id of a requested mtd_id. 1003 * 1004 * Note: first argument is not null terminated. 1005 * 1006 * @param mtd_id string containing requested mtd_id 1007 * @param mtd_id_len length of supplied mtd_id 1008 * @return pointer to the id if it exists, NULL otherwise 1009 */ 1010 static struct mtdids* id_find_by_mtd_id(const char *mtd_id, unsigned int mtd_id_len) 1011 { 1012 struct list_head *entry; 1013 struct mtdids *id; 1014 1015 debug("--- id_find_by_mtd_id: '%.*s' (len = %d)\n", 1016 mtd_id_len, mtd_id, mtd_id_len); 1017 1018 list_for_each(entry, &mtdids) { 1019 id = list_entry(entry, struct mtdids, link); 1020 1021 debug("entry: '%s' (len = %zu)\n", 1022 id->mtd_id, strlen(id->mtd_id)); 1023 1024 if (mtd_id_len != strlen(id->mtd_id)) 1025 continue; 1026 if (strncmp(id->mtd_id, mtd_id, mtd_id_len) == 0) 1027 return id; 1028 } 1029 1030 return NULL; 1031 } 1032 1033 /** 1034 * Parse device id string <dev-id> := 'nand'|'nor'|'onenand'|'spi-nand'<dev-num>, 1035 * return device type and number. 1036 * 1037 * @param id string describing device id 1038 * @param ret_id output pointer to next char after parse completes (output) 1039 * @param dev_type parsed device type (output) 1040 * @param dev_num parsed device number (output) 1041 * @return 0 on success, 1 otherwise 1042 */ 1043 int mtd_id_parse(const char *id, const char **ret_id, u8 *dev_type, 1044 u8 *dev_num) 1045 { 1046 const char *p = id; 1047 1048 *dev_type = 0; 1049 if (strncmp(p, "nand", 4) == 0) { 1050 *dev_type = MTD_DEV_TYPE_NAND; 1051 p += 4; 1052 } else if (strncmp(p, "nor", 3) == 0) { 1053 *dev_type = MTD_DEV_TYPE_NOR; 1054 p += 3; 1055 } else if (strncmp(p, "onenand", 7) == 0) { 1056 *dev_type = MTD_DEV_TYPE_ONENAND; 1057 p += 7; 1058 } else if (strncmp(p, "spi-nand", 8) == 0) { 1059 *dev_type = MTD_DEV_TYPE_SPINAND; 1060 p += 8; 1061 } else { 1062 printf("incorrect device type in %s\n", id); 1063 return 1; 1064 } 1065 1066 if (!isdigit(*p)) { 1067 printf("incorrect device number in %s\n", id); 1068 return 1; 1069 } 1070 1071 *dev_num = simple_strtoul(p, (char **)&p, 0); 1072 if (ret_id) 1073 *ret_id = p; 1074 return 0; 1075 } 1076 1077 /** 1078 * Process all devices and generate corresponding mtdparts string describing 1079 * all partitions on all devices. 1080 * 1081 * @param buf output buffer holding generated mtdparts string (output) 1082 * @param buflen buffer size 1083 * @return 0 on success, 1 otherwise 1084 */ 1085 static int generate_mtdparts(char *buf, u32 buflen) 1086 { 1087 struct list_head *pentry, *dentry; 1088 struct mtd_device *dev; 1089 struct part_info *part, *prev_part; 1090 char *p = buf; 1091 char tmpbuf[32]; 1092 u64 size, offset; 1093 u32 len, part_cnt; 1094 u32 maxlen = buflen - 1; 1095 1096 debug("--- generate_mtdparts ---\n"); 1097 1098 if (list_empty(&devices)) { 1099 buf[0] = '\0'; 1100 return 0; 1101 } 1102 1103 strcpy(p, "mtdparts="); 1104 p += 9; 1105 1106 list_for_each(dentry, &devices) { 1107 dev = list_entry(dentry, struct mtd_device, link); 1108 1109 /* copy mtd_id */ 1110 len = strlen(dev->id->mtd_id) + 1; 1111 if (len > maxlen) 1112 goto cleanup; 1113 memcpy(p, dev->id->mtd_id, len - 1); 1114 p += len - 1; 1115 *(p++) = ':'; 1116 maxlen -= len; 1117 1118 /* format partitions */ 1119 prev_part = NULL; 1120 part_cnt = 0; 1121 list_for_each(pentry, &dev->parts) { 1122 part = list_entry(pentry, struct part_info, link); 1123 size = part->size; 1124 offset = part->offset; 1125 part_cnt++; 1126 1127 /* partition size */ 1128 memsize_format(tmpbuf, size); 1129 len = strlen(tmpbuf); 1130 if (len > maxlen) 1131 goto cleanup; 1132 memcpy(p, tmpbuf, len); 1133 p += len; 1134 maxlen -= len; 1135 1136 1137 /* add offset only when there is a gap between 1138 * partitions */ 1139 if ((!prev_part && (offset != 0)) || 1140 (prev_part && ((prev_part->offset + prev_part->size) != part->offset))) { 1141 1142 memsize_format(tmpbuf, offset); 1143 len = strlen(tmpbuf) + 1; 1144 if (len > maxlen) 1145 goto cleanup; 1146 *(p++) = '@'; 1147 memcpy(p, tmpbuf, len - 1); 1148 p += len - 1; 1149 maxlen -= len; 1150 } 1151 1152 /* copy name only if user supplied */ 1153 if(!part->auto_name) { 1154 len = strlen(part->name) + 2; 1155 if (len > maxlen) 1156 goto cleanup; 1157 1158 *(p++) = '('; 1159 memcpy(p, part->name, len - 2); 1160 p += len - 2; 1161 *(p++) = ')'; 1162 maxlen -= len; 1163 } 1164 1165 /* ro mask flag */ 1166 if (part->mask_flags && MTD_WRITEABLE_CMD) { 1167 len = 2; 1168 if (len > maxlen) 1169 goto cleanup; 1170 *(p++) = 'r'; 1171 *(p++) = 'o'; 1172 maxlen -= 2; 1173 } 1174 1175 /* print ',' separator if there are other partitions 1176 * following */ 1177 if (dev->num_parts > part_cnt) { 1178 if (1 > maxlen) 1179 goto cleanup; 1180 *(p++) = ','; 1181 maxlen--; 1182 } 1183 prev_part = part; 1184 } 1185 /* print ';' separator if there are other devices following */ 1186 if (dentry->next != &devices) { 1187 if (1 > maxlen) 1188 goto cleanup; 1189 *(p++) = ';'; 1190 maxlen--; 1191 } 1192 } 1193 1194 /* we still have at least one char left, as we decremented maxlen at 1195 * the begining */ 1196 *p = '\0'; 1197 1198 return 0; 1199 1200 cleanup: 1201 last_parts[0] = '\0'; 1202 return 1; 1203 } 1204 1205 /** 1206 * Call generate_mtdparts to process all devices and generate corresponding 1207 * mtdparts string, save it in mtdparts environment variable. 1208 * 1209 * @param buf output buffer holding generated mtdparts string (output) 1210 * @param buflen buffer size 1211 * @return 0 on success, 1 otherwise 1212 */ 1213 static int generate_mtdparts_save(char *buf, u32 buflen) 1214 { 1215 int ret; 1216 1217 ret = generate_mtdparts(buf, buflen); 1218 1219 if ((buf[0] != '\0') && (ret == 0)) 1220 env_set("mtdparts", buf); 1221 else 1222 env_set("mtdparts", NULL); 1223 1224 return ret; 1225 } 1226 1227 #if defined(CONFIG_CMD_MTDPARTS_SHOW_NET_SIZES) 1228 /** 1229 * Get the net size (w/o bad blocks) of the given partition. 1230 * 1231 * @param mtd the mtd info 1232 * @param part the partition 1233 * @return the calculated net size of this partition 1234 */ 1235 static uint64_t net_part_size(struct mtd_info *mtd, struct part_info *part) 1236 { 1237 uint64_t i, net_size = 0; 1238 1239 if (!mtd->block_isbad) 1240 return part->size; 1241 1242 for (i = 0; i < part->size; i += mtd->erasesize) { 1243 if (!mtd->block_isbad(mtd, part->offset + i)) 1244 net_size += mtd->erasesize; 1245 } 1246 1247 return net_size; 1248 } 1249 #endif 1250 1251 static void print_partition_table(void) 1252 { 1253 struct list_head *dentry, *pentry; 1254 struct part_info *part; 1255 struct mtd_device *dev; 1256 int part_num; 1257 1258 list_for_each(dentry, &devices) { 1259 dev = list_entry(dentry, struct mtd_device, link); 1260 /* list partitions for given device */ 1261 part_num = 0; 1262 #if defined(CONFIG_CMD_MTDPARTS_SHOW_NET_SIZES) 1263 struct mtd_info *mtd; 1264 1265 if (get_mtd_info(dev->id->type, dev->id->num, &mtd)) 1266 return; 1267 1268 printf("\ndevice %s%d <%s>, # parts = %d\n", 1269 MTD_DEV_TYPE(dev->id->type), dev->id->num, 1270 dev->id->mtd_id, dev->num_parts); 1271 printf(" #: name\t\tsize\t\tnet size\toffset\t\tmask_flags\n"); 1272 1273 list_for_each(pentry, &dev->parts) { 1274 u32 net_size; 1275 char *size_note; 1276 1277 part = list_entry(pentry, struct part_info, link); 1278 net_size = net_part_size(mtd, part); 1279 size_note = part->size == net_size ? " " : " (!)"; 1280 printf("%2d: %-20s0x%08x\t0x%08x%s\t0x%08x\t%d\n", 1281 part_num, part->name, part->size, 1282 net_size, size_note, part->offset, 1283 part->mask_flags); 1284 #else /* !defined(CONFIG_CMD_MTDPARTS_SHOW_NET_SIZES) */ 1285 printf("\ndevice %s%d <%s>, # parts = %d\n", 1286 MTD_DEV_TYPE(dev->id->type), dev->id->num, 1287 dev->id->mtd_id, dev->num_parts); 1288 printf(" #: name\t\tsize\t\toffset\t\tmask_flags\n"); 1289 1290 list_for_each(pentry, &dev->parts) { 1291 part = list_entry(pentry, struct part_info, link); 1292 printf("%2d: %-20s0x%08llx\t0x%08llx\t%d\n", 1293 part_num, part->name, part->size, 1294 part->offset, part->mask_flags); 1295 #endif /* defined(CONFIG_CMD_MTDPARTS_SHOW_NET_SIZES) */ 1296 part_num++; 1297 } 1298 } 1299 1300 if (list_empty(&devices)) 1301 printf("no partitions defined\n"); 1302 } 1303 1304 /** 1305 * Format and print out a partition list for each device from global device 1306 * list. 1307 */ 1308 static void list_partitions(void) 1309 { 1310 struct part_info *part; 1311 1312 debug("\n---list_partitions---\n"); 1313 print_partition_table(); 1314 1315 /* current_mtd_dev is not NULL only when we have non empty device list */ 1316 if (current_mtd_dev) { 1317 part = mtd_part_info(current_mtd_dev, current_mtd_partnum); 1318 if (part) { 1319 printf("\nactive partition: %s%d,%d - (%s) 0x%08llx @ 0x%08llx\n", 1320 MTD_DEV_TYPE(current_mtd_dev->id->type), 1321 current_mtd_dev->id->num, current_mtd_partnum, 1322 part->name, part->size, part->offset); 1323 } else { 1324 printf("could not get current partition info\n\n"); 1325 } 1326 } 1327 1328 printf("\ndefaults:\n"); 1329 printf("mtdids : %s\n", 1330 mtdids_default ? mtdids_default : "none"); 1331 /* 1332 * Using printf() here results in printbuffer overflow 1333 * if default mtdparts string is greater than console 1334 * printbuffer. Use puts() to prevent system crashes. 1335 */ 1336 puts("mtdparts: "); 1337 puts(mtdparts_default ? mtdparts_default : "none"); 1338 puts("\n"); 1339 } 1340 1341 /** 1342 * Given partition identifier in form of <dev_type><dev_num>,<part_num> find 1343 * corresponding device and verify partition number. 1344 * 1345 * @param id string describing device and partition or partition name 1346 * @param dev pointer to the requested device (output) 1347 * @param part_num verified partition number (output) 1348 * @param part pointer to requested partition (output) 1349 * @return 0 on success, 1 otherwise 1350 */ 1351 int find_dev_and_part(const char *id, struct mtd_device **dev, 1352 u8 *part_num, struct part_info **part) 1353 { 1354 struct list_head *dentry, *pentry; 1355 u8 type, dnum, pnum; 1356 const char *p; 1357 1358 debug("--- find_dev_and_part ---\nid = %s\n", id); 1359 1360 list_for_each(dentry, &devices) { 1361 *part_num = 0; 1362 *dev = list_entry(dentry, struct mtd_device, link); 1363 list_for_each(pentry, &(*dev)->parts) { 1364 *part = list_entry(pentry, struct part_info, link); 1365 if (strcmp((*part)->name, id) == 0) 1366 return 0; 1367 (*part_num)++; 1368 } 1369 } 1370 1371 p = id; 1372 *dev = NULL; 1373 *part = NULL; 1374 *part_num = 0; 1375 1376 if (mtd_id_parse(p, &p, &type, &dnum) != 0) 1377 return 1; 1378 1379 if ((*p++ != ',') || (*p == '\0')) { 1380 printf("no partition number specified\n"); 1381 return 1; 1382 } 1383 pnum = simple_strtoul(p, (char **)&p, 0); 1384 if (*p != '\0') { 1385 printf("unexpected trailing character '%c'\n", *p); 1386 return 1; 1387 } 1388 1389 if ((*dev = device_find(type, dnum)) == NULL) { 1390 printf("no such device %s%d\n", MTD_DEV_TYPE(type), dnum); 1391 return 1; 1392 } 1393 1394 if ((*part = mtd_part_info(*dev, pnum)) == NULL) { 1395 printf("no such partition\n"); 1396 *dev = NULL; 1397 return 1; 1398 } 1399 1400 *part_num = pnum; 1401 1402 return 0; 1403 } 1404 1405 /** 1406 * Find and delete partition. For partition id format see find_dev_and_part(). 1407 * 1408 * @param id string describing device and partition 1409 * @return 0 on success, 1 otherwise 1410 */ 1411 static int delete_partition(const char *id) 1412 { 1413 u8 pnum; 1414 struct mtd_device *dev; 1415 struct part_info *part; 1416 1417 if (find_dev_and_part(id, &dev, &pnum, &part) == 0) { 1418 1419 debug("delete_partition: device = %s%d, partition %d = (%s) 0x%08llx@0x%08llx\n", 1420 MTD_DEV_TYPE(dev->id->type), dev->id->num, pnum, 1421 part->name, part->size, part->offset); 1422 1423 if (part_del(dev, part) != 0) 1424 return 1; 1425 1426 if (generate_mtdparts_save(last_parts, MTDPARTS_MAXLEN) != 0) { 1427 printf("generated mtdparts too long, resetting to null\n"); 1428 return 1; 1429 } 1430 return 0; 1431 } 1432 1433 printf("partition %s not found\n", id); 1434 return 1; 1435 } 1436 1437 #if defined(CONFIG_CMD_MTDPARTS_SPREAD) 1438 /** 1439 * Increase the size of the given partition so that it's net size is at least 1440 * as large as the size member and such that the next partition would start on a 1441 * good block if it were adjacent to this partition. 1442 * 1443 * @param mtd the mtd device 1444 * @param part the partition 1445 * @param next_offset pointer to the offset of the next partition after this 1446 * partition's size has been modified (output) 1447 */ 1448 static void spread_partition(struct mtd_info *mtd, struct part_info *part, 1449 uint64_t *next_offset) 1450 { 1451 uint64_t net_size, padding_size = 0; 1452 int truncated; 1453 1454 mtd_get_len_incl_bad(mtd, part->offset, part->size, &net_size, 1455 &truncated); 1456 1457 /* 1458 * Absorb bad blocks immediately following this 1459 * partition also into the partition, such that 1460 * the next partition starts with a good block. 1461 */ 1462 if (!truncated) { 1463 mtd_get_len_incl_bad(mtd, part->offset + net_size, 1464 mtd->erasesize, &padding_size, &truncated); 1465 if (truncated) 1466 padding_size = 0; 1467 else 1468 padding_size -= mtd->erasesize; 1469 } 1470 1471 if (truncated) { 1472 printf("truncated partition %s to %lld bytes\n", part->name, 1473 (uint64_t) net_size + padding_size); 1474 } 1475 1476 part->size = net_size + padding_size; 1477 *next_offset = part->offset + part->size; 1478 } 1479 1480 /** 1481 * Adjust all of the partition sizes, such that all partitions are at least 1482 * as big as their mtdparts environment variable sizes and they each start 1483 * on a good block. 1484 * 1485 * @return 0 on success, 1 otherwise 1486 */ 1487 static int spread_partitions(void) 1488 { 1489 struct list_head *dentry, *pentry; 1490 struct mtd_device *dev; 1491 struct part_info *part; 1492 struct mtd_info *mtd; 1493 int part_num; 1494 uint64_t cur_offs; 1495 1496 list_for_each(dentry, &devices) { 1497 dev = list_entry(dentry, struct mtd_device, link); 1498 1499 if (get_mtd_info(dev->id->type, dev->id->num, &mtd)) 1500 return 1; 1501 1502 part_num = 0; 1503 cur_offs = 0; 1504 list_for_each(pentry, &dev->parts) { 1505 part = list_entry(pentry, struct part_info, link); 1506 1507 debug("spread_partitions: device = %s%d, partition %d =" 1508 " (%s) 0x%08llx@0x%08llx\n", 1509 MTD_DEV_TYPE(dev->id->type), dev->id->num, 1510 part_num, part->name, part->size, 1511 part->offset); 1512 1513 if (cur_offs > part->offset) 1514 part->offset = cur_offs; 1515 1516 spread_partition(mtd, part, &cur_offs); 1517 1518 part_num++; 1519 } 1520 } 1521 1522 index_partitions(); 1523 1524 if (generate_mtdparts_save(last_parts, MTDPARTS_MAXLEN) != 0) { 1525 printf("generated mtdparts too long, resetting to null\n"); 1526 return 1; 1527 } 1528 return 0; 1529 } 1530 #endif /* CONFIG_CMD_MTDPARTS_SPREAD */ 1531 1532 /** 1533 * The mtdparts variable tends to be long. If we need to access it 1534 * before the env is relocated, then we need to use our own stack 1535 * buffer. gd->env_buf will be too small. 1536 * 1537 * @param buf temporary buffer pointer MTDPARTS_MAXLEN long 1538 * @return mtdparts variable string, NULL if not found 1539 */ 1540 static const char *env_get_mtdparts(char *buf) 1541 { 1542 if (gd->flags & GD_FLG_ENV_READY) 1543 return env_get("mtdparts"); 1544 if (env_get_f("mtdparts", buf, MTDPARTS_MAXLEN) != -1) 1545 return buf; 1546 return NULL; 1547 } 1548 1549 /** 1550 * Accept character string describing mtd partitions and call device_parse() 1551 * for each entry. Add created devices to the global devices list. 1552 * 1553 * @param mtdparts string specifing mtd partitions 1554 * @return 0 on success, 1 otherwise 1555 */ 1556 static int parse_mtdparts(const char *const mtdparts) 1557 { 1558 const char *p; 1559 struct mtd_device *dev; 1560 int err = 1; 1561 char tmp_parts[MTDPARTS_MAXLEN]; 1562 1563 debug("\n---parse_mtdparts---\nmtdparts = %s\n\n", mtdparts); 1564 1565 /* delete all devices and partitions */ 1566 if (mtd_devices_init() != 0) { 1567 printf("could not initialise device list\n"); 1568 return err; 1569 } 1570 1571 /* re-read 'mtdparts' variable, mtd_devices_init may be updating env */ 1572 p = env_get_mtdparts(tmp_parts); 1573 if (!p) 1574 p = mtdparts; 1575 1576 if (strncmp(p, "mtdparts=", 9) != 0) { 1577 printf("mtdparts variable doesn't start with 'mtdparts='\n"); 1578 return err; 1579 } 1580 p += 9; 1581 1582 while (*p != '\0') { 1583 err = 1; 1584 if ((device_parse(p, &p, &dev) != 0) || (!dev)) 1585 break; 1586 1587 debug("+ device: %s\t%d\t%s\n", MTD_DEV_TYPE(dev->id->type), 1588 dev->id->num, dev->id->mtd_id); 1589 1590 /* check if parsed device is already on the list */ 1591 if (device_find(dev->id->type, dev->id->num) != NULL) { 1592 printf("device %s%d redefined, please correct mtdparts variable\n", 1593 MTD_DEV_TYPE(dev->id->type), dev->id->num); 1594 break; 1595 } 1596 1597 list_add_tail(&dev->link, &devices); 1598 err = 0; 1599 } 1600 if (err == 1) { 1601 free(dev); 1602 device_delall(&devices); 1603 } 1604 1605 return err; 1606 } 1607 1608 /** 1609 * Parse provided string describing mtdids mapping (see file header for mtdids 1610 * variable format). Allocate memory for each entry and add all found entries 1611 * to the global mtdids list. 1612 * 1613 * @param ids mapping string 1614 * @return 0 on success, 1 otherwise 1615 */ 1616 static int parse_mtdids(const char *const ids) 1617 { 1618 const char *p = ids; 1619 const char *mtd_id; 1620 int mtd_id_len; 1621 struct mtdids *id; 1622 struct list_head *entry, *n; 1623 struct mtdids *id_tmp; 1624 u8 type, num; 1625 u64 size; 1626 int ret = 1; 1627 1628 debug("\n---parse_mtdids---\nmtdids = %s\n\n", ids); 1629 1630 /* clean global mtdids list */ 1631 list_for_each_safe(entry, n, &mtdids) { 1632 id_tmp = list_entry(entry, struct mtdids, link); 1633 debug("mtdids del: %d %d\n", id_tmp->type, id_tmp->num); 1634 list_del(entry); 1635 free(id_tmp); 1636 } 1637 last_ids[0] = '\0'; 1638 INIT_LIST_HEAD(&mtdids); 1639 1640 while(p && (*p != '\0')) { 1641 1642 ret = 1; 1643 /* parse 'nor'|'nand'|'onenand'|'spi-nand'<dev-num> */ 1644 if (mtd_id_parse(p, &p, &type, &num) != 0) 1645 break; 1646 1647 if (*p != '=') { 1648 printf("mtdids: incorrect <dev-num>\n"); 1649 break; 1650 } 1651 p++; 1652 1653 /* check if requested device exists */ 1654 if (mtd_device_validate(type, num, &size) != 0) 1655 return 1; 1656 1657 /* locate <mtd-id> */ 1658 mtd_id = p; 1659 if ((p = strchr(mtd_id, ',')) != NULL) { 1660 mtd_id_len = p - mtd_id + 1; 1661 p++; 1662 } else { 1663 mtd_id_len = strlen(mtd_id) + 1; 1664 } 1665 if (mtd_id_len == 0) { 1666 printf("mtdids: no <mtd-id> identifier\n"); 1667 break; 1668 } 1669 1670 /* check if this id is already on the list */ 1671 int double_entry = 0; 1672 list_for_each(entry, &mtdids) { 1673 id_tmp = list_entry(entry, struct mtdids, link); 1674 if ((id_tmp->type == type) && (id_tmp->num == num)) { 1675 double_entry = 1; 1676 break; 1677 } 1678 } 1679 if (double_entry) { 1680 printf("device id %s%d redefined, please correct mtdids variable\n", 1681 MTD_DEV_TYPE(type), num); 1682 break; 1683 } 1684 1685 /* allocate mtdids structure */ 1686 if (!(id = (struct mtdids *)malloc(sizeof(struct mtdids) + mtd_id_len))) { 1687 printf("out of memory\n"); 1688 break; 1689 } 1690 memset(id, 0, sizeof(struct mtdids) + mtd_id_len); 1691 id->num = num; 1692 id->type = type; 1693 id->size = size; 1694 id->mtd_id = (char *)(id + 1); 1695 strncpy(id->mtd_id, mtd_id, mtd_id_len - 1); 1696 id->mtd_id[mtd_id_len - 1] = '\0'; 1697 INIT_LIST_HEAD(&id->link); 1698 1699 debug("+ id %s%d\t%16lld bytes\t%s\n", 1700 MTD_DEV_TYPE(id->type), id->num, 1701 id->size, id->mtd_id); 1702 1703 list_add_tail(&id->link, &mtdids); 1704 ret = 0; 1705 } 1706 if (ret == 1) { 1707 /* clean mtdids list and free allocated memory */ 1708 list_for_each_safe(entry, n, &mtdids) { 1709 id_tmp = list_entry(entry, struct mtdids, link); 1710 list_del(entry); 1711 free(id_tmp); 1712 } 1713 return 1; 1714 } 1715 1716 return 0; 1717 } 1718 1719 1720 /** 1721 * Parse and initialize global mtdids mapping and create global 1722 * device/partition list. 1723 * 1724 * @return 0 on success, 1 otherwise 1725 */ 1726 int mtdparts_init(void) 1727 { 1728 static int initialized = 0; 1729 const char *ids, *parts; 1730 const char *current_partition; 1731 int ids_changed; 1732 char tmp_ep[PARTITION_MAXLEN + 1]; 1733 char tmp_parts[MTDPARTS_MAXLEN]; 1734 1735 debug("\n---mtdparts_init---\n"); 1736 if (!initialized) { 1737 INIT_LIST_HEAD(&mtdids); 1738 INIT_LIST_HEAD(&devices); 1739 memset(last_ids, 0, sizeof(last_ids)); 1740 memset(last_parts, 0, sizeof(last_parts)); 1741 memset(last_partition, 0, sizeof(last_partition)); 1742 #if defined(CONFIG_SYS_MTDPARTS_RUNTIME) 1743 board_mtdparts_default(&mtdids_default, &mtdparts_default); 1744 #endif 1745 use_defaults = 1; 1746 initialized = 1; 1747 } 1748 1749 /* get variables */ 1750 ids = env_get("mtdids"); 1751 parts = env_get_mtdparts(tmp_parts); 1752 current_partition = env_get("partition"); 1753 1754 /* save it for later parsing, cannot rely on current partition pointer 1755 * as 'partition' variable may be updated during init */ 1756 memset(tmp_parts, 0, sizeof(tmp_parts)); 1757 memset(tmp_ep, 0, sizeof(tmp_ep)); 1758 if (current_partition) 1759 strncpy(tmp_ep, current_partition, PARTITION_MAXLEN); 1760 1761 debug("last_ids : %s\n", last_ids); 1762 debug("env_ids : %s\n", ids); 1763 debug("last_parts: %s\n", last_parts); 1764 debug("env_parts : %s\n\n", parts); 1765 1766 debug("last_partition : %s\n", last_partition); 1767 debug("env_partition : %s\n", current_partition); 1768 1769 /* if mtdids variable is empty try to use defaults */ 1770 if (!ids) { 1771 if (mtdids_default) { 1772 debug("mtdids variable not defined, using default\n"); 1773 ids = mtdids_default; 1774 env_set("mtdids", (char *)ids); 1775 } else { 1776 printf("mtdids not defined, no default present\n"); 1777 return 1; 1778 } 1779 } 1780 if (strlen(ids) > MTDIDS_MAXLEN - 1) { 1781 printf("mtdids too long (> %d)\n", MTDIDS_MAXLEN); 1782 return 1; 1783 } 1784 1785 /* use defaults when mtdparts variable is not defined 1786 * once mtdparts is saved environment, drop use_defaults flag */ 1787 if (!parts) { 1788 if (mtdparts_default && use_defaults) { 1789 parts = mtdparts_default; 1790 if (env_set("mtdparts", (char *)parts) == 0) 1791 use_defaults = 0; 1792 } else 1793 printf("mtdparts variable not set, see 'help mtdparts'\n"); 1794 } 1795 1796 if (parts && (strlen(parts) > MTDPARTS_MAXLEN - 1)) { 1797 printf("mtdparts too long (> %d)\n", MTDPARTS_MAXLEN); 1798 return 1; 1799 } 1800 1801 /* check if we have already parsed those mtdids */ 1802 if ((last_ids[0] != '\0') && (strcmp(last_ids, ids) == 0)) { 1803 ids_changed = 0; 1804 } else { 1805 ids_changed = 1; 1806 1807 if (parse_mtdids(ids) != 0) { 1808 mtd_devices_init(); 1809 return 1; 1810 } 1811 1812 /* ok it's good, save new ids */ 1813 strncpy(last_ids, ids, MTDIDS_MAXLEN); 1814 } 1815 1816 /* parse partitions if either mtdparts or mtdids were updated */ 1817 if (parts && ((last_parts[0] == '\0') || ((strcmp(last_parts, parts) != 0)) || ids_changed)) { 1818 if (parse_mtdparts(parts) != 0) 1819 return 1; 1820 1821 if (list_empty(&devices)) { 1822 printf("mtdparts_init: no valid partitions\n"); 1823 return 1; 1824 } 1825 1826 /* ok it's good, save new parts */ 1827 strncpy(last_parts, parts, MTDPARTS_MAXLEN); 1828 1829 /* reset first partition from first dev from the list as current */ 1830 current_mtd_dev = list_entry(devices.next, struct mtd_device, link); 1831 current_mtd_partnum = 0; 1832 current_save(); 1833 1834 debug("mtdparts_init: current_mtd_dev = %s%d, current_mtd_partnum = %d\n", 1835 MTD_DEV_TYPE(current_mtd_dev->id->type), 1836 current_mtd_dev->id->num, current_mtd_partnum); 1837 } 1838 1839 /* mtdparts variable was reset to NULL, delete all devices/partitions */ 1840 if (!parts && (last_parts[0] != '\0')) 1841 return mtd_devices_init(); 1842 1843 /* do not process current partition if mtdparts variable is null */ 1844 if (!parts) 1845 return 0; 1846 1847 /* is current partition set in environment? if so, use it */ 1848 if ((tmp_ep[0] != '\0') && (strcmp(tmp_ep, last_partition) != 0)) { 1849 struct part_info *p; 1850 struct mtd_device *cdev; 1851 u8 pnum; 1852 1853 debug("--- getting current partition: %s\n", tmp_ep); 1854 1855 if (find_dev_and_part(tmp_ep, &cdev, &pnum, &p) == 0) { 1856 current_mtd_dev = cdev; 1857 current_mtd_partnum = pnum; 1858 current_save(); 1859 } 1860 } else if (env_get("partition") == NULL) { 1861 debug("no partition variable set, setting...\n"); 1862 current_save(); 1863 } 1864 1865 return 0; 1866 } 1867 1868 /** 1869 * Return pointer to the partition of a requested number from a requested 1870 * device. 1871 * 1872 * @param dev device that is to be searched for a partition 1873 * @param part_num requested partition number 1874 * @return pointer to the part_info, NULL otherwise 1875 */ 1876 static struct part_info* mtd_part_info(struct mtd_device *dev, unsigned int part_num) 1877 { 1878 struct list_head *entry; 1879 struct part_info *part; 1880 int num; 1881 1882 if (!dev) 1883 return NULL; 1884 1885 debug("\n--- mtd_part_info: partition number %d for device %s%d (%s)\n", 1886 part_num, MTD_DEV_TYPE(dev->id->type), 1887 dev->id->num, dev->id->mtd_id); 1888 1889 if (part_num >= dev->num_parts) { 1890 printf("invalid partition number %d for device %s%d (%s)\n", 1891 part_num, MTD_DEV_TYPE(dev->id->type), 1892 dev->id->num, dev->id->mtd_id); 1893 return NULL; 1894 } 1895 1896 /* locate partition number, return it */ 1897 num = 0; 1898 list_for_each(entry, &dev->parts) { 1899 part = list_entry(entry, struct part_info, link); 1900 1901 if (part_num == num++) { 1902 return part; 1903 } 1904 } 1905 1906 return NULL; 1907 } 1908 1909 /***************************************************/ 1910 /* U-Boot commands */ 1911 /***************************************************/ 1912 /* command line only */ 1913 /** 1914 * Routine implementing u-boot chpart command. Sets new current partition based 1915 * on the user supplied partition id. For partition id format see find_dev_and_part(). 1916 * 1917 * @param cmdtp command internal data 1918 * @param flag command flag 1919 * @param argc number of arguments supplied to the command 1920 * @param argv arguments list 1921 * @return 0 on success, 1 otherwise 1922 */ 1923 static int do_chpart(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 1924 { 1925 /* command line only */ 1926 struct mtd_device *dev; 1927 struct part_info *part; 1928 u8 pnum; 1929 1930 if (mtdparts_init() !=0) 1931 return 1; 1932 1933 if (argc < 2) { 1934 printf("no partition id specified\n"); 1935 return 1; 1936 } 1937 1938 if (find_dev_and_part(argv[1], &dev, &pnum, &part) != 0) 1939 return 1; 1940 1941 current_mtd_dev = dev; 1942 current_mtd_partnum = pnum; 1943 current_save(); 1944 1945 printf("partition changed to %s%d,%d\n", 1946 MTD_DEV_TYPE(dev->id->type), dev->id->num, pnum); 1947 1948 return 0; 1949 } 1950 1951 /** 1952 * Routine implementing u-boot mtdparts command. Initialize/update default global 1953 * partition list and process user partition request (list, add, del). 1954 * 1955 * @param cmdtp command internal data 1956 * @param flag command flag 1957 * @param argc number of arguments supplied to the command 1958 * @param argv arguments list 1959 * @return 0 on success, 1 otherwise 1960 */ 1961 static int do_mtdparts(cmd_tbl_t *cmdtp, int flag, int argc, 1962 char * const argv[]) 1963 { 1964 if (argc == 2) { 1965 if (strcmp(argv[1], "default") == 0) { 1966 env_set("mtdids", NULL); 1967 env_set("mtdparts", NULL); 1968 env_set("partition", NULL); 1969 use_defaults = 1; 1970 1971 mtdparts_init(); 1972 return 0; 1973 } else if (strcmp(argv[1], "delall") == 0) { 1974 /* this may be the first run, initialize lists if needed */ 1975 mtdparts_init(); 1976 1977 env_set("mtdparts", NULL); 1978 1979 /* mtd_devices_init() calls current_save() */ 1980 return mtd_devices_init(); 1981 } 1982 } 1983 1984 /* make sure we are in sync with env variables */ 1985 if (mtdparts_init() != 0) 1986 return 1; 1987 1988 if (argc == 1) { 1989 list_partitions(); 1990 return 0; 1991 } 1992 1993 /* mtdparts add <mtd-dev> <size>[@<offset>] <name> [ro] */ 1994 if (((argc == 5) || (argc == 6)) && (strncmp(argv[1], "add", 3) == 0)) { 1995 #define PART_ADD_DESC_MAXLEN 64 1996 char tmpbuf[PART_ADD_DESC_MAXLEN]; 1997 #if defined(CONFIG_CMD_MTDPARTS_SPREAD) 1998 struct mtd_info *mtd; 1999 uint64_t next_offset; 2000 #endif 2001 u8 type, num, len; 2002 struct mtd_device *dev; 2003 struct mtd_device *dev_tmp; 2004 struct mtdids *id; 2005 struct part_info *p; 2006 2007 if (mtd_id_parse(argv[2], NULL, &type, &num) != 0) 2008 return 1; 2009 2010 if ((id = id_find(type, num)) == NULL) { 2011 printf("no such device %s defined in mtdids variable\n", argv[2]); 2012 return 1; 2013 } 2014 2015 len = strlen(id->mtd_id) + 1; /* 'mtd_id:' */ 2016 len += strlen(argv[3]); /* size@offset */ 2017 len += strlen(argv[4]) + 2; /* '(' name ')' */ 2018 if (argv[5] && (strlen(argv[5]) == 2)) 2019 len += 2; /* 'ro' */ 2020 2021 if (len >= PART_ADD_DESC_MAXLEN) { 2022 printf("too long partition description\n"); 2023 return 1; 2024 } 2025 sprintf(tmpbuf, "%s:%s(%s)%s", 2026 id->mtd_id, argv[3], argv[4], argv[5] ? argv[5] : ""); 2027 debug("add tmpbuf: %s\n", tmpbuf); 2028 2029 if ((device_parse(tmpbuf, NULL, &dev) != 0) || (!dev)) 2030 return 1; 2031 2032 debug("+ %s\t%d\t%s\n", MTD_DEV_TYPE(dev->id->type), 2033 dev->id->num, dev->id->mtd_id); 2034 2035 p = list_entry(dev->parts.next, struct part_info, link); 2036 2037 #if defined(CONFIG_CMD_MTDPARTS_SPREAD) 2038 if (get_mtd_info(dev->id->type, dev->id->num, &mtd)) 2039 return 1; 2040 2041 if (!strcmp(&argv[1][3], ".spread")) { 2042 spread_partition(mtd, p, &next_offset); 2043 debug("increased %s to %llu bytes\n", p->name, p->size); 2044 } 2045 #endif 2046 2047 dev_tmp = device_find(dev->id->type, dev->id->num); 2048 if (dev_tmp == NULL) { 2049 device_add(dev); 2050 } else if (part_add(dev_tmp, p) != 0) { 2051 /* merge new partition with existing ones*/ 2052 device_del(dev); 2053 return 1; 2054 } 2055 2056 if (generate_mtdparts_save(last_parts, MTDPARTS_MAXLEN) != 0) { 2057 printf("generated mtdparts too long, resetting to null\n"); 2058 return 1; 2059 } 2060 2061 return 0; 2062 } 2063 2064 /* mtdparts del part-id */ 2065 if ((argc == 3) && (strcmp(argv[1], "del") == 0)) { 2066 debug("del: part-id = %s\n", argv[2]); 2067 2068 return delete_partition(argv[2]); 2069 } 2070 2071 #if defined(CONFIG_CMD_MTDPARTS_SPREAD) 2072 if ((argc == 2) && (strcmp(argv[1], "spread") == 0)) 2073 return spread_partitions(); 2074 #endif /* CONFIG_CMD_MTDPARTS_SPREAD */ 2075 2076 return CMD_RET_USAGE; 2077 } 2078 2079 /***************************************************/ 2080 U_BOOT_CMD( 2081 chpart, 2, 0, do_chpart, 2082 "change active partition", 2083 "part-id\n" 2084 " - change active partition (e.g. part-id = nand0,1)" 2085 ); 2086 2087 #ifdef CONFIG_SYS_LONGHELP 2088 static char mtdparts_help_text[] = 2089 "\n" 2090 " - list partition table\n" 2091 "mtdparts delall\n" 2092 " - delete all partitions\n" 2093 "mtdparts del part-id\n" 2094 " - delete partition (e.g. part-id = nand0,1)\n" 2095 "mtdparts add <mtd-dev> <size>[@<offset>] [<name>] [ro]\n" 2096 " - add partition\n" 2097 #if defined(CONFIG_CMD_MTDPARTS_SPREAD) 2098 "mtdparts add.spread <mtd-dev> <size>[@<offset>] [<name>] [ro]\n" 2099 " - add partition, padding size by skipping bad blocks\n" 2100 #endif 2101 "mtdparts default\n" 2102 " - reset partition table to defaults\n" 2103 #if defined(CONFIG_CMD_MTDPARTS_SPREAD) 2104 "mtdparts spread\n" 2105 " - adjust the sizes of the partitions so they are\n" 2106 " at least as big as the mtdparts variable specifies\n" 2107 " and they each start on a good block\n\n" 2108 #else 2109 "\n" 2110 #endif /* CONFIG_CMD_MTDPARTS_SPREAD */ 2111 "-----\n\n" 2112 "this command uses three environment variables:\n\n" 2113 "'partition' - keeps current partition identifier\n\n" 2114 "partition := <part-id>\n" 2115 "<part-id> := <dev-id>,part_num\n\n" 2116 "'mtdids' - linux kernel mtd device id <-> u-boot device id mapping\n\n" 2117 "mtdids=<idmap>[,<idmap>,...]\n\n" 2118 "<idmap> := <dev-id>=<mtd-id>\n" 2119 "<dev-id> := 'nand'|'nor'|'onenand'|'spi-nand'<dev-num>\n" 2120 "<dev-num> := mtd device number, 0...\n" 2121 "<mtd-id> := unique device tag used by linux kernel to find mtd device (mtd->name)\n\n" 2122 "'mtdparts' - partition list\n\n" 2123 "mtdparts=mtdparts=<mtd-def>[;<mtd-def>...]\n\n" 2124 "<mtd-def> := <mtd-id>:<part-def>[,<part-def>...]\n" 2125 "<mtd-id> := unique device tag used by linux kernel to find mtd device (mtd->name)\n" 2126 "<part-def> := <size>[@<offset>][<name>][<ro-flag>]\n" 2127 "<size> := standard linux memsize OR '-' to denote all remaining space\n" 2128 "<offset> := partition start offset within the device\n" 2129 "<name> := '(' NAME ')'\n" 2130 "<ro-flag> := when set to 'ro' makes partition read-only (not used, passed to kernel)"; 2131 #endif 2132 2133 U_BOOT_CMD( 2134 mtdparts, 6, 0, do_mtdparts, 2135 "define flash/nand partitions", mtdparts_help_text 2136 ); 2137 /***************************************************/ 2138