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