disk/part_dos.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2001
   4  * Raymond Lo, lo@routefree.com
   5  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   6  */
   7
   8 /*
   9  * Support for harddisk partitions.
  10  *
  11  * To be compatible with LinuxPPC and Apple we use the standard Apple
  12  * SCSI disk partitioning scheme. For more information see:
  13  * http://developer.apple.com/techpubs/mac/Devices/Devices-126.html#MARKER-14-92
  14  */
  15
  16 #include <common.h>
  17 #include <command.h>
  18 #include <ide.h>
  19 #include <memalign.h>
  20 #include "part_dos.h"
  21
  22 #ifdef CONFIG_HAVE_BLOCK_DEVICE
  23
  24 #define DOS_PART_DEFAULT_SECTOR 512
  25
  26 /* should this be configurable? It looks like it's not very common at all
  27  * to use large numbers of partitions */
  28 #define MAX_EXT_PARTS 256
  29
  30 /* Convert char[4] in little endian format to the host format integer
  31  */
  32 static inline unsigned int le32_to_int(unsigned char *le32)
  33 {
  34     return ((le32[3] << 24) +
  35             (le32[2] << 16) +
  36             (le32[1] << 8) +
  37              le32[0]
  38            );
  39 }
  40
  41 static inline int is_extended(int part_type)
  42 {
  43     return (part_type == 0x5 ||
  44             part_type == 0xf ||
  45             part_type == 0x85);
  46 }
  47
  48 static inline int is_bootable(dos_partition_t *p)
  49 {
  50         return (p->sys_ind == 0xef) || (p->boot_ind == 0x80);
  51 }
  52
  53 static void print_one_part(dos_partition_t *p, lbaint_t ext_part_sector,
  54                            int part_num, unsigned int disksig)
  55 {
  56         lbaint_t lba_start = ext_part_sector + le32_to_int (p->start4);
  57         lbaint_t lba_size  = le32_to_int (p->size4);
  58
  59         printf("%3d\t%-10" LBAFlength "u\t%-10" LBAFlength
  60                 "u\t%08x-%02x\t%02x%s%s\n",
  61                 part_num, lba_start, lba_size, disksig, part_num, p->sys_ind,
  62                 (is_extended(p->sys_ind) ? " Extd" : ""),
  63                 (is_bootable(p) ? " Boot" : ""));
  64 }
  65
  66 static int test_block_type(unsigned char *buffer)
  67 {
  68         int slot;
  69         struct dos_partition *p;
  70
  71         if((buffer[DOS_PART_MAGIC_OFFSET + 0] != 0x55) ||
  72             (buffer[DOS_PART_MAGIC_OFFSET + 1] != 0xaa) ) {
  73                 return (-1);
  74         } /* no DOS Signature at all */
  75         p = (struct dos_partition *)&buffer[DOS_PART_TBL_OFFSET];
  76         for (slot = 0; slot < 3; slot++) {
  77                 if (p->boot_ind != 0 && p->boot_ind != 0x80) {
  78                         if (!slot &&
  79                             (strncmp((char *)&buffer[DOS_PBR_FSTYPE_OFFSET],
  80                                      "FAT", 3) == 0 ||
  81                              strncmp((char *)&buffer[DOS_PBR32_FSTYPE_OFFSET],
  82                                      "FAT32", 5) == 0)) {
  83                                 return DOS_PBR; /* is PBR */
  84                         } else {
  85                                 return -1;
  86                         }
  87                 }
  88         }
  89         return DOS_MBR;     /* Is MBR */
  90 }
  91
  92
  93 static int part_test_dos(struct blk_desc *dev_desc)
  94 {
  95 #ifndef CONFIG_SPL_BUILD
  96         ALLOC_CACHE_ALIGN_BUFFER(legacy_mbr, mbr,
  97                         DIV_ROUND_UP(dev_desc->blksz, sizeof(legacy_mbr)));
  98
  99         if (blk_dread(dev_desc, 0, 1, (ulong *)mbr) != 1)
 100                 return -1;
 101
 102         if (test_block_type((unsigned char *)mbr) != DOS_MBR)
 103                 return -1;
 104
 105         if (dev_desc->sig_type == SIG_TYPE_NONE &&
 106             mbr->unique_mbr_signature != 0) {
 107                 dev_desc->sig_type = SIG_TYPE_MBR;
 108                 dev_desc->mbr_sig = mbr->unique_mbr_signature;
 109         }
 110 #else
 111         ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz);
 112
 113         if (blk_dread(dev_desc, 0, 1, (ulong *)buffer) != 1)
 114                 return -1;
 115
 116         if (test_block_type(buffer) != DOS_MBR)
 117                 return -1;
 118 #endif
 119
 120         return 0;
 121 }
 122
 123 /*  Print a partition that is relative to its Extended partition table
 124  */
 125 static void print_partition_extended(struct blk_desc *dev_desc,
 126                                      lbaint_t ext_part_sector,
 127                                      lbaint_t relative,
 128                                      int part_num, unsigned int disksig)
 129 {
 130         ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz);
 131         dos_partition_t *pt;
 132         int i;
 133
 134         /* set a maximum recursion level */
 135         if (part_num > MAX_EXT_PARTS)
 136         {
 137                 printf("** Nested DOS partitions detected, stopping **\n");
 138                 return;
 139     }
 140
 141         if (blk_dread(dev_desc, ext_part_sector, 1, (ulong *)buffer) != 1) {
 142                 printf ("** Can't read partition table on %d:" LBAFU " **\n",
 143                         dev_desc->devnum, ext_part_sector);
 144                 return;
 145         }
 146         i=test_block_type(buffer);
 147         if (i != DOS_MBR) {
 148                 printf ("bad MBR sector signature 0x%02x%02x\n",
 149                         buffer[DOS_PART_MAGIC_OFFSET],
 150                         buffer[DOS_PART_MAGIC_OFFSET + 1]);
 151                 return;
 152         }
 153
 154         if (!ext_part_sector)
 155                 disksig = le32_to_int(&buffer[DOS_PART_DISKSIG_OFFSET]);
 156
 157         /* Print all primary/logical partitions */
 158         pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
 159         for (i = 0; i < 4; i++, pt++) {
 160                 /*
 161                  * fdisk does not show the extended partitions that
 162                  * are not in the MBR
 163                  */
 164
 165                 if ((pt->sys_ind != 0) &&
 166                     (ext_part_sector == 0 || !is_extended (pt->sys_ind)) ) {
 167                         print_one_part(pt, ext_part_sector, part_num, disksig);
 168                 }
 169
 170                 /* Reverse engr the fdisk part# assignment rule! */
 171                 if ((ext_part_sector == 0) ||
 172                     (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
 173                         part_num++;
 174                 }
 175         }
 176
 177         /* Follows the extended partitions */
 178         pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
 179         for (i = 0; i < 4; i++, pt++) {
 180                 if (is_extended (pt->sys_ind)) {
 181                         lbaint_t lba_start
 182                                 = le32_to_int (pt->start4) + relative;
 183
 184                         print_partition_extended(dev_desc, lba_start,
 185                                 ext_part_sector == 0  ? lba_start : relative,
 186                                 part_num, disksig);
 187                 }
 188         }
 189
 190         return;
 191 }
 192
 193
 194 /*  Print a partition that is relative to its Extended partition table
 195  */
 196 static int part_get_info_extended(struct blk_desc *dev_desc,
 197                                   lbaint_t ext_part_sector, lbaint_t relative,
 198                                   int part_num, int which_part,
 199                                   disk_partition_t *info, unsigned int disksig)
 200 {
 201         ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz);
 202         dos_partition_t *pt;
 203         int i;
 204         int dos_type;
 205
 206         /* set a maximum recursion level */
 207         if (part_num > MAX_EXT_PARTS)
 208         {
 209                 printf("** Nested DOS partitions detected, stopping **\n");
 210                 return -1;
 211     }
 212
 213         if (blk_dread(dev_desc, ext_part_sector, 1, (ulong *)buffer) != 1) {
 214                 printf ("** Can't read partition table on %d:" LBAFU " **\n",
 215                         dev_desc->devnum, ext_part_sector);
 216                 return -1;
 217         }
 218         if (buffer[DOS_PART_MAGIC_OFFSET] != 0x55 ||
 219                 buffer[DOS_PART_MAGIC_OFFSET + 1] != 0xaa) {
 220                 printf ("bad MBR sector signature 0x%02x%02x\n",
 221                         buffer[DOS_PART_MAGIC_OFFSET],
 222                         buffer[DOS_PART_MAGIC_OFFSET + 1]);
 223                 return -1;
 224         }
 225
 226 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
 227         if (!ext_part_sector)
 228                 disksig = le32_to_int(&buffer[DOS_PART_DISKSIG_OFFSET]);
 229 #endif
 230
 231         /* Print all primary/logical partitions */
 232         pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
 233         for (i = 0; i < 4; i++, pt++) {
 234                 /*
 235                  * fdisk does not show the extended partitions that
 236                  * are not in the MBR
 237                  */
 238                 if (((pt->boot_ind & ~0x80) == 0) &&
 239                     (pt->sys_ind != 0) &&
 240                     (part_num == which_part) &&
 241                     (ext_part_sector == 0 || is_extended(pt->sys_ind) == 0)) {
 242                         info->blksz = DOS_PART_DEFAULT_SECTOR;
 243                         info->start = (lbaint_t)(ext_part_sector +
 244                                         le32_to_int(pt->start4));
 245                         info->size  = (lbaint_t)le32_to_int(pt->size4);
 246                         part_set_generic_name(dev_desc, part_num,
 247                                               (char *)info->name);
 248                         /* sprintf(info->type, "%d, pt->sys_ind); */
 249                         strcpy((char *)info->type, "U-Boot");
 250                         info->bootable = is_bootable(pt);
 251 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
 252                         sprintf(info->uuid, "%08x-%02x", disksig, part_num);
 253 #endif
 254                         info->sys_ind = pt->sys_ind;
 255                         return 0;
 256                 }
 257
 258                 /* Reverse engr the fdisk part# assignment rule! */
 259                 if ((ext_part_sector == 0) ||
 260                     (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
 261                         part_num++;
 262                 }
 263         }
 264
 265         /* Follows the extended partitions */
 266         pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
 267         for (i = 0; i < 4; i++, pt++) {
 268                 if (is_extended (pt->sys_ind)) {
 269                         lbaint_t lba_start
 270                                 = le32_to_int (pt->start4) + relative;
 271
 272                         return part_get_info_extended(dev_desc, lba_start,
 273                                  ext_part_sector == 0 ? lba_start : relative,
 274                                  part_num, which_part, info, disksig);
 275                 }
 276         }
 277
 278         /* Check for DOS PBR if no partition is found */
 279         dos_type = test_block_type(buffer);
 280
 281         if (dos_type == DOS_PBR) {
 282                 info->start = 0;
 283                 info->size = dev_desc->lba;
 284                 info->blksz = DOS_PART_DEFAULT_SECTOR;
 285                 info->bootable = 0;
 286                 strcpy((char *)info->type, "U-Boot");
 287 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
 288                 info->uuid[0] = 0;
 289 #endif
 290                 return 0;
 291         }
 292
 293         return -1;
 294 }
 295
 296 void part_print_dos(struct blk_desc *dev_desc)
 297 {
 298         printf("Part\tStart Sector\tNum Sectors\tUUID\t\tType\n");
 299         print_partition_extended(dev_desc, 0, 0, 1, 0);
 300 }
 301
 302 int part_get_info_dos(struct blk_desc *dev_desc, int part,
 303                       disk_partition_t *info)
 304 {
 305         return part_get_info_extended(dev_desc, 0, 0, 1, part, info, 0);
 306 }
 307
 308 int is_valid_dos_buf(void *buf)
 309 {
 310         return test_block_type(buf) == DOS_MBR ? 0 : -1;
 311 }
 312
 313 int write_mbr_partition(struct blk_desc *dev_desc, void *buf)
 314 {
 315         if (is_valid_dos_buf(buf))
 316                 return -1;
 317
 318         /* write MBR */
 319         if (blk_dwrite(dev_desc, 0, 1, buf) != 1) {
 320                 printf("%s: failed writing '%s' (1 blks at 0x0)\n",
 321                        __func__, "MBR");
 322                 return 1;
 323         }
 324
 325         return 0;
 326 }
 327
 328 U_BOOT_PART_TYPE(dos) = {
 329         .name           = "DOS",
 330         .part_type      = PART_TYPE_DOS,
 331         .max_entries    = DOS_ENTRY_NUMBERS,
 332         .get_info       = part_get_info_ptr(part_get_info_dos),
 333         .print          = part_print_ptr(part_print_dos),
 334         .test           = part_test_dos,
 335 };
 336
 337 #endif