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