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