blob: 94fae7166d7b169731edd7d41c5d7f0eb37237e5 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
wdenkfe8c2802002-11-03 00:38:21 +00002/*
3 * (C) Copyright 2001
4 * Raymond Lo, lo@routefree.com
5 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
wdenkfe8c2802002-11-03 00:38:21 +00006 */
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>
Simon Glasse6f6f9e2020-05-10 11:39:58 -060017#include <blk.h>
wdenkfe8c2802002-11-03 00:38:21 +000018#include <command.h>
19#include <ide.h>
Simon Glasscf92e052015-09-02 17:24:58 -060020#include <memalign.h>
Marek Szyprowski97163dd2020-12-23 13:55:12 +010021#include <asm/unaligned.h>
Marek Szyprowskicb571f92020-12-23 13:55:13 +010022#include <linux/compiler.h>
wdenkfe8c2802002-11-03 00:38:21 +000023#include "part_dos.h"
Simon Glasse6f6f9e2020-05-10 11:39:58 -060024#include <part.h>
wdenkfe8c2802002-11-03 00:38:21 +000025
Adam Ford1811a922018-02-06 12:43:56 -060026#ifdef CONFIG_HAVE_BLOCK_DEVICE
wdenkfe8c2802002-11-03 00:38:21 +000027
Darwin Dingel4a36be92014-06-06 15:48:26 +120028#define DOS_PART_DEFAULT_SECTOR 512
29
Paul Emge232e2f42019-07-08 16:37:03 -070030/* should this be configurable? It looks like it's not very common at all
31 * to use large numbers of partitions */
32#define MAX_EXT_PARTS 256
33
wdenkfe8c2802002-11-03 00:38:21 +000034static inline int is_extended(int part_type)
35{
Marek Szyprowski80bd05f2020-12-23 13:55:11 +010036 return (part_type == DOS_PART_TYPE_EXTENDED ||
37 part_type == DOS_PART_TYPE_EXTENDED_LBA ||
38 part_type == DOS_PART_TYPE_EXTENDED_LINUX);
wdenkfe8c2802002-11-03 00:38:21 +000039}
40
Heinrich Schuchardt25801ac2020-03-19 13:49:34 +010041static int get_bootable(dos_partition_t *p)
Rob Herring40e0e562012-08-23 11:31:43 +000042{
Heinrich Schuchardt25801ac2020-03-19 13:49:34 +010043 int ret = 0;
44
45 if (p->sys_ind == 0xef)
46 ret |= PART_EFI_SYSTEM_PARTITION;
47 if (p->boot_ind == 0x80)
48 ret |= PART_BOOTABLE;
49 return ret;
Rob Herring40e0e562012-08-23 11:31:43 +000050}
51
Stefan Monnierd29892b2015-08-25 15:24:13 -040052static void print_one_part(dos_partition_t *p, lbaint_t ext_part_sector,
Stephen Warrene2e9b372012-10-08 08:14:40 +000053 int part_num, unsigned int disksig)
wdenkfe8c2802002-11-03 00:38:21 +000054{
Marek Szyprowski97163dd2020-12-23 13:55:12 +010055 lbaint_t lba_start = ext_part_sector + get_unaligned_le32(p->start4);
56 lbaint_t lba_size = get_unaligned_le32(p->size4);
wdenkfe8c2802002-11-03 00:38:21 +000057
Stefan Monnierd29892b2015-08-25 15:24:13 -040058 printf("%3d\t%-10" LBAFlength "u\t%-10" LBAFlength
59 "u\t%08x-%02x\t%02x%s%s\n",
Stephen Warrene2e9b372012-10-08 08:14:40 +000060 part_num, lba_start, lba_size, disksig, part_num, p->sys_ind,
Rob Herring40e0e562012-08-23 11:31:43 +000061 (is_extended(p->sys_ind) ? " Extd" : ""),
Heinrich Schuchardt25801ac2020-03-19 13:49:34 +010062 (get_bootable(p) ? " Boot" : ""));
wdenkfe8c2802002-11-03 00:38:21 +000063}
64
wdenk7205e402003-09-10 22:30:53 +000065static int test_block_type(unsigned char *buffer)
66{
Egbert Eich9d956e02013-04-09 05:46:14 +000067 int slot;
68 struct dos_partition *p;
Heinrich Schuchardt34856b02019-10-15 20:43:42 +020069 int part_count = 0;
Egbert Eich9d956e02013-04-09 05:46:14 +000070
wdenk7205e402003-09-10 22:30:53 +000071 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 */
Egbert Eich9d956e02013-04-09 05:46:14 +000075 p = (struct dos_partition *)&buffer[DOS_PART_TBL_OFFSET];
wdenk7205e402003-09-10 22:30:53 +000076
Heinrich Schuchardt34856b02019-10-15 20:43:42 +020077 /* Check that the boot indicators are valid and count the partitions. */
78 for (slot = 0; slot < 4; ++slot, ++p) {
79 if (p->boot_ind != 0 && p->boot_ind != 0x80)
80 break;
81 if (p->sys_ind)
82 ++part_count;
83 }
84
85 /*
86 * If the partition table is invalid or empty,
87 * check if this is a DOS PBR
88 */
89 if (slot != 4 || !part_count) {
90 if (!strncmp((char *)&buffer[DOS_PBR_FSTYPE_OFFSET],
91 "FAT", 3) ||
92 !strncmp((char *)&buffer[DOS_PBR32_FSTYPE_OFFSET],
93 "FAT32", 5))
94 return DOS_PBR; /* This is a DOS PBR and not an MBR */
95 }
96 if (slot == 4)
97 return DOS_MBR; /* This is an DOS MBR */
98
99 /* This is neither a DOS MBR nor a DOS PBR */
100 return -1;
101}
wdenkfe8c2802002-11-03 00:38:21 +0000102
Simon Glass084bf4c2016-02-29 15:26:04 -0700103static int part_test_dos(struct blk_desc *dev_desc)
wdenkfe8c2802002-11-03 00:38:21 +0000104{
Fabio Estevam3ea05202017-10-04 13:29:57 -0300105#ifndef CONFIG_SPL_BUILD
Faiz Abbas7aed3d32019-09-04 20:10:12 +0530106 ALLOC_CACHE_ALIGN_BUFFER(legacy_mbr, mbr,
107 DIV_ROUND_UP(dev_desc->blksz, sizeof(legacy_mbr)));
wdenkfe8c2802002-11-03 00:38:21 +0000108
Peter Jonesff98cb92017-09-13 18:05:25 -0400109 if (blk_dread(dev_desc, 0, 1, (ulong *)mbr) != 1)
Stephen Warrend1efb642012-10-05 13:17:40 +0000110 return -1;
111
Peter Jonesff98cb92017-09-13 18:05:25 -0400112 if (test_block_type((unsigned char *)mbr) != DOS_MBR)
Stephen Warrend1efb642012-10-05 13:17:40 +0000113 return -1;
114
Peter Jonesff98cb92017-09-13 18:05:25 -0400115 if (dev_desc->sig_type == SIG_TYPE_NONE &&
116 mbr->unique_mbr_signature != 0) {
117 dev_desc->sig_type = SIG_TYPE_MBR;
118 dev_desc->mbr_sig = mbr->unique_mbr_signature;
119 }
Fabio Estevam3ea05202017-10-04 13:29:57 -0300120#else
121 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz);
122
123 if (blk_dread(dev_desc, 0, 1, (ulong *)buffer) != 1)
124 return -1;
125
126 if (test_block_type(buffer) != DOS_MBR)
127 return -1;
128#endif
Peter Jonesff98cb92017-09-13 18:05:25 -0400129
Stephen Warrend1efb642012-10-05 13:17:40 +0000130 return 0;
wdenkfe8c2802002-11-03 00:38:21 +0000131}
132
133/* Print a partition that is relative to its Extended partition table
134 */
Simon Glass4101f682016-02-29 15:25:34 -0700135static void print_partition_extended(struct blk_desc *dev_desc,
Stefan Monnierd29892b2015-08-25 15:24:13 -0400136 lbaint_t ext_part_sector,
137 lbaint_t relative,
Stephen Warrene2e9b372012-10-08 08:14:40 +0000138 int part_num, unsigned int disksig)
wdenkfe8c2802002-11-03 00:38:21 +0000139{
Eric Nelsondec049d2012-03-03 12:02:20 +0000140 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz);
wdenkfe8c2802002-11-03 00:38:21 +0000141 dos_partition_t *pt;
142 int i;
143
Paul Emge232e2f42019-07-08 16:37:03 -0700144 /* set a maximum recursion level */
145 if (part_num > MAX_EXT_PARTS)
146 {
147 printf("** Nested DOS partitions detected, stopping **\n");
148 return;
149 }
150
Simon Glass2a981dc2016-02-29 15:25:52 -0700151 if (blk_dread(dev_desc, ext_part_sector, 1, (ulong *)buffer) != 1) {
Stefan Monnierd29892b2015-08-25 15:24:13 -0400152 printf ("** Can't read partition table on %d:" LBAFU " **\n",
Simon Glassbcce53d2016-02-29 15:25:51 -0700153 dev_desc->devnum, ext_part_sector);
wdenkfe8c2802002-11-03 00:38:21 +0000154 return;
155 }
wdenk7205e402003-09-10 22:30:53 +0000156 i=test_block_type(buffer);
Stephen Warrend1efb642012-10-05 13:17:40 +0000157 if (i != DOS_MBR) {
wdenkfe8c2802002-11-03 00:38:21 +0000158 printf ("bad MBR sector signature 0x%02x%02x\n",
159 buffer[DOS_PART_MAGIC_OFFSET],
160 buffer[DOS_PART_MAGIC_OFFSET + 1]);
161 return;
162 }
Stephen Warrend1efb642012-10-05 13:17:40 +0000163
Stephen Warrene2e9b372012-10-08 08:14:40 +0000164 if (!ext_part_sector)
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100165 disksig = get_unaligned_le32(&buffer[DOS_PART_DISKSIG_OFFSET]);
Stephen Warrene2e9b372012-10-08 08:14:40 +0000166
wdenkfe8c2802002-11-03 00:38:21 +0000167 /* Print all primary/logical partitions */
168 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
169 for (i = 0; i < 4; i++, pt++) {
170 /*
wdenk8bde7f72003-06-27 21:31:46 +0000171 * fdisk does not show the extended partitions that
wdenkfe8c2802002-11-03 00:38:21 +0000172 * are not in the MBR
173 */
174
175 if ((pt->sys_ind != 0) &&
176 (ext_part_sector == 0 || !is_extended (pt->sys_ind)) ) {
Stephen Warrene2e9b372012-10-08 08:14:40 +0000177 print_one_part(pt, ext_part_sector, part_num, disksig);
wdenkfe8c2802002-11-03 00:38:21 +0000178 }
179
180 /* Reverse engr the fdisk part# assignment rule! */
181 if ((ext_part_sector == 0) ||
182 (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
183 part_num++;
184 }
185 }
186
187 /* Follows the extended partitions */
188 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
189 for (i = 0; i < 4; i++, pt++) {
190 if (is_extended (pt->sys_ind)) {
Stefan Monnierd29892b2015-08-25 15:24:13 -0400191 lbaint_t lba_start
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100192 = get_unaligned_le32 (pt->start4) + relative;
wdenkfe8c2802002-11-03 00:38:21 +0000193
Stephen Warren304b5712012-10-08 08:14:38 +0000194 print_partition_extended(dev_desc, lba_start,
195 ext_part_sector == 0 ? lba_start : relative,
Stephen Warrene2e9b372012-10-08 08:14:40 +0000196 part_num, disksig);
wdenkfe8c2802002-11-03 00:38:21 +0000197 }
198 }
199
200 return;
201}
202
203
204/* Print a partition that is relative to its Extended partition table
205 */
Simon Glass3e8bd462016-02-29 15:25:48 -0700206static int part_get_info_extended(struct blk_desc *dev_desc,
207 lbaint_t ext_part_sector, lbaint_t relative,
208 int part_num, int which_part,
Simon Glass05289792020-05-10 11:39:57 -0600209 struct disk_partition *info, uint disksig)
wdenkfe8c2802002-11-03 00:38:21 +0000210{
Eric Nelsondec049d2012-03-03 12:02:20 +0000211 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz);
wdenkfe8c2802002-11-03 00:38:21 +0000212 dos_partition_t *pt;
213 int i;
Darwin Dingel4a36be92014-06-06 15:48:26 +1200214 int dos_type;
wdenkfe8c2802002-11-03 00:38:21 +0000215
Paul Emge232e2f42019-07-08 16:37:03 -0700216 /* set a maximum recursion level */
217 if (part_num > MAX_EXT_PARTS)
218 {
219 printf("** Nested DOS partitions detected, stopping **\n");
220 return -1;
221 }
222
Simon Glass2a981dc2016-02-29 15:25:52 -0700223 if (blk_dread(dev_desc, ext_part_sector, 1, (ulong *)buffer) != 1) {
Stefan Monnierd29892b2015-08-25 15:24:13 -0400224 printf ("** Can't read partition table on %d:" LBAFU " **\n",
Simon Glassbcce53d2016-02-29 15:25:51 -0700225 dev_desc->devnum, ext_part_sector);
wdenkfe8c2802002-11-03 00:38:21 +0000226 return -1;
227 }
228 if (buffer[DOS_PART_MAGIC_OFFSET] != 0x55 ||
229 buffer[DOS_PART_MAGIC_OFFSET + 1] != 0xaa) {
230 printf ("bad MBR sector signature 0x%02x%02x\n",
231 buffer[DOS_PART_MAGIC_OFFSET],
232 buffer[DOS_PART_MAGIC_OFFSET + 1]);
233 return -1;
234 }
235
Patrick Delaunayb331cd62017-01-27 11:00:42 +0100236#if CONFIG_IS_ENABLED(PARTITION_UUIDS)
Stephen Warrend27b5f92012-09-21 09:51:00 +0000237 if (!ext_part_sector)
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100238 disksig = get_unaligned_le32(&buffer[DOS_PART_DISKSIG_OFFSET]);
Stephen Warrend27b5f92012-09-21 09:51:00 +0000239#endif
240
wdenkfe8c2802002-11-03 00:38:21 +0000241 /* Print all primary/logical partitions */
242 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
243 for (i = 0; i < 4; i++, pt++) {
244 /*
wdenk8bde7f72003-06-27 21:31:46 +0000245 * fdisk does not show the extended partitions that
246 * are not in the MBR
wdenkfe8c2802002-11-03 00:38:21 +0000247 */
Daniel Mack78f4ca72009-09-28 11:40:38 +0200248 if (((pt->boot_ind & ~0x80) == 0) &&
249 (pt->sys_ind != 0) &&
wdenk7f70e852003-05-20 14:25:27 +0000250 (part_num == which_part) &&
Shawn Guo8f7102c2017-11-02 16:46:34 +0800251 (ext_part_sector == 0 || is_extended(pt->sys_ind) == 0)) {
Darwin Dingel4a36be92014-06-06 15:48:26 +1200252 info->blksz = DOS_PART_DEFAULT_SECTOR;
Steve Raee04350d2014-05-26 11:52:23 -0700253 info->start = (lbaint_t)(ext_part_sector +
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100254 get_unaligned_le32(pt->start4));
255 info->size = (lbaint_t)get_unaligned_le32(pt->size4);
Petr Kulhavyda2ee242016-09-09 10:27:17 +0200256 part_set_generic_name(dev_desc, part_num,
257 (char *)info->name);
wdenkfe8c2802002-11-03 00:38:21 +0000258 /* sprintf(info->type, "%d, pt->sys_ind); */
Ben Whitten192bc692015-12-30 13:05:58 +0000259 strcpy((char *)info->type, "U-Boot");
Heinrich Schuchardt25801ac2020-03-19 13:49:34 +0100260 info->bootable = get_bootable(pt);
Patrick Delaunayb331cd62017-01-27 11:00:42 +0100261#if CONFIG_IS_ENABLED(PARTITION_UUIDS)
Stephen Warrend27b5f92012-09-21 09:51:00 +0000262 sprintf(info->uuid, "%08x-%02x", disksig, part_num);
263#endif
Dalon Westergreenf0fb4fa2017-02-10 17:15:34 -0800264 info->sys_ind = pt->sys_ind;
wdenkfe8c2802002-11-03 00:38:21 +0000265 return 0;
266 }
267
268 /* Reverse engr the fdisk part# assignment rule! */
269 if ((ext_part_sector == 0) ||
270 (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
271 part_num++;
272 }
273 }
274
275 /* Follows the extended partitions */
276 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
277 for (i = 0; i < 4; i++, pt++) {
278 if (is_extended (pt->sys_ind)) {
Stefan Monnierd29892b2015-08-25 15:24:13 -0400279 lbaint_t lba_start
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100280 = get_unaligned_le32 (pt->start4) + relative;
wdenkfe8c2802002-11-03 00:38:21 +0000281
Simon Glass3e8bd462016-02-29 15:25:48 -0700282 return part_get_info_extended(dev_desc, lba_start,
wdenkfe8c2802002-11-03 00:38:21 +0000283 ext_part_sector == 0 ? lba_start : relative,
Stephen Warrend27b5f92012-09-21 09:51:00 +0000284 part_num, which_part, info, disksig);
wdenkfe8c2802002-11-03 00:38:21 +0000285 }
286 }
Darwin Dingel4a36be92014-06-06 15:48:26 +1200287
288 /* Check for DOS PBR if no partition is found */
289 dos_type = test_block_type(buffer);
290
291 if (dos_type == DOS_PBR) {
292 info->start = 0;
293 info->size = dev_desc->lba;
294 info->blksz = DOS_PART_DEFAULT_SECTOR;
295 info->bootable = 0;
Ben Whitten192bc692015-12-30 13:05:58 +0000296 strcpy((char *)info->type, "U-Boot");
Patrick Delaunayb331cd62017-01-27 11:00:42 +0100297#if CONFIG_IS_ENABLED(PARTITION_UUIDS)
Darwin Dingel4a36be92014-06-06 15:48:26 +1200298 info->uuid[0] = 0;
299#endif
300 return 0;
301 }
302
wdenkfe8c2802002-11-03 00:38:21 +0000303 return -1;
304}
305
Marek Szyprowskicb571f92020-12-23 13:55:13 +0100306static void __maybe_unused part_print_dos(struct blk_desc *dev_desc)
wdenkfe8c2802002-11-03 00:38:21 +0000307{
Stephen Warrene2e9b372012-10-08 08:14:40 +0000308 printf("Part\tStart Sector\tNum Sectors\tUUID\t\tType\n");
309 print_partition_extended(dev_desc, 0, 0, 1, 0);
wdenkfe8c2802002-11-03 00:38:21 +0000310}
311
Marek Szyprowskicb571f92020-12-23 13:55:13 +0100312static int __maybe_unused part_get_info_dos(struct blk_desc *dev_desc, int part,
Simon Glass05289792020-05-10 11:39:57 -0600313 struct disk_partition *info)
wdenkfe8c2802002-11-03 00:38:21 +0000314{
Simon Glass3e8bd462016-02-29 15:25:48 -0700315 return part_get_info_extended(dev_desc, 0, 0, 1, part, info, 0);
wdenkfe8c2802002-11-03 00:38:21 +0000316}
317
Petr Kulhavyb6dd69a2016-09-09 10:27:16 +0200318int is_valid_dos_buf(void *buf)
319{
320 return test_block_type(buf) == DOS_MBR ? 0 : -1;
321}
322
Marek Szyprowski20bd5ac2020-12-23 13:55:14 +0100323#if CONFIG_IS_ENABLED(CMD_MBR)
324static void lba_to_chs(lbaint_t lba, unsigned char *rc, unsigned char *rh,
325 unsigned char *rs)
326{
327 unsigned int c, h, s;
328 /* use fixed CHS geometry */
329 unsigned int sectpertrack = 63;
330 unsigned int heads = 255;
331
332 c = (lba + 1) / sectpertrack / heads;
333 h = (lba + 1) / sectpertrack - c * heads;
334 s = (lba + 1) - (c * heads + h) * sectpertrack;
335
336 if (c > 1023) {
337 c = 1023;
338 h = 254;
339 s = 63;
340 }
341
342 *rc = c & 0xff;
343 *rh = h;
344 *rs = s + ((c & 0x300) >> 2);
345}
346
347static void mbr_fill_pt_entry(dos_partition_t *pt, lbaint_t start,
348 lbaint_t relative, lbaint_t size, uchar sys_ind, bool bootable)
349{
350 pt->boot_ind = bootable ? 0x80 : 0x00;
351 pt->sys_ind = sys_ind;
352 lba_to_chs(start, &pt->cyl, &pt->head, &pt->sector);
353 lba_to_chs(start + size - 1, &pt->end_cyl, &pt->end_head, &pt->end_sector);
354 put_unaligned_le32(relative, &pt->start4);
355 put_unaligned_le32(size, &pt->size4);
356}
357
358int write_mbr_partitions(struct blk_desc *dev,
359 struct disk_partition *p, int count, unsigned int disksig)
360{
361 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev->blksz);
362 lbaint_t ext_part_start = 0, ext_part_size = 0, ext_part_sect = 0;
363 dos_partition_t *pt;
364 int i;
365
366 memset(buffer, 0, dev->blksz);
367 buffer[DOS_PART_MAGIC_OFFSET] = 0x55;
368 buffer[DOS_PART_MAGIC_OFFSET + 1] = 0xaa;
369 put_unaligned_le32(disksig, &buffer[DOS_PART_DISKSIG_OFFSET]);
370 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
371
372 /* create all primary partitions */
373 for (i = 0; i < 4 && i < count; i++, pt++) {
374 mbr_fill_pt_entry(pt, p[i].start, p[i].start, p[i].size,
375 p[i].sys_ind, p[i].bootable);
376 if (is_extended(p[i].sys_ind)) {
377 ext_part_start = p[i].start;
378 ext_part_size = p[i].size;
379 ext_part_sect = p[i].start;
380 }
381 }
382
383 if (i < count && !ext_part_start) {
384 printf("%s: extended partition is needed for more than 4 partitions\n",
385 __func__);
386 return -1;
387 }
388
389 /* write MBR */
390 if (blk_dwrite(dev, 0, 1, buffer) != 1) {
391 printf("%s: failed writing 'MBR' (1 blks at 0x0)\n",
392 __func__);
393 return -1;
394 }
395
396 /* create extended volumes */
397 for (; i < count; i++) {
398 lbaint_t next_ebr = 0;
399
400 memset(buffer, 0, dev->blksz);
401 buffer[DOS_PART_MAGIC_OFFSET] = 0x55;
402 buffer[DOS_PART_MAGIC_OFFSET + 1] = 0xaa;
403 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
404
405 mbr_fill_pt_entry(pt, p[i].start, p[i].start - ext_part_sect,
406 p[i].size, p[i].sys_ind, p[i].bootable);
407
408 if (i + 1 < count) {
409 pt++;
410 next_ebr = p[i].start + p[i].size;
411 mbr_fill_pt_entry(pt, next_ebr,
412 next_ebr - ext_part_start,
413 p[i+1].start + p[i+1].size - next_ebr,
414 DOS_PART_TYPE_EXTENDED, 0);
415 }
416
417 /* write EBR */
418 if (blk_dwrite(dev, ext_part_sect, 1, buffer) != 1) {
419 printf("%s: failed writing 'EBR' (1 blks at 0x%lx)\n",
420 __func__, ext_part_sect);
421 return -1;
422 }
423 ext_part_sect = next_ebr;
424 }
425
Gary Bissonf14c5ee2021-01-28 09:10:07 +0100426 /* Update the partition table entries*/
Christian Melkic7d1b182021-06-07 11:21:15 +0200427 part_init(dev);
Gary Bissonf14c5ee2021-01-28 09:10:07 +0100428
Marek Szyprowski20bd5ac2020-12-23 13:55:14 +0100429 return 0;
430}
431
432int layout_mbr_partitions(struct disk_partition *p, int count,
433 lbaint_t total_sectors)
434{
435 struct disk_partition *ext = NULL;
436 int i, j;
437 lbaint_t ext_vol_start;
438
439 /* calculate primary partitions start and size if needed */
440 if (!p[0].start)
441 p[0].start = DOS_PART_DEFAULT_GAP;
442 for (i = 0; i < 4 && i < count; i++) {
443 if (!p[i].start)
444 p[i].start = p[i - 1].start + p[i - 1].size;
445 if (!p[i].size) {
446 lbaint_t end = total_sectors;
447 lbaint_t allocated = 0;
448
449 for (j = i + 1; j < 4 && j < count; j++) {
450 if (p[j].start) {
451 end = p[j].start;
452 break;
453 }
454 allocated += p[j].size;
455 }
456 p[i].size = end - allocated - p[i].start;
457 }
458 if (p[i].sys_ind == 0x05)
459 ext = &p[i];
460 }
461
Simon Glassb7c2cc42021-10-23 17:26:02 -0600462 if (count < 4)
463 return 0;
464
465 if (!ext) {
466 log_err("extended partition is needed for more than 4 partitions\n");
467 return -EINVAL;
Marek Szyprowski20bd5ac2020-12-23 13:55:14 +0100468 }
469
470 /* calculate extended volumes start and size if needed */
471 ext_vol_start = ext->start;
472 for (i = 4; i < count; i++) {
473 if (!p[i].start)
474 p[i].start = ext_vol_start + DOS_PART_DEFAULT_GAP;
475 if (!p[i].size) {
476 lbaint_t end = ext->start + ext->size;
477 lbaint_t allocated = 0;
478
479 for (j = i + 1; j < count; j++) {
480 if (p[j].start) {
481 end = p[j].start - DOS_PART_DEFAULT_GAP;
482 break;
483 }
484 allocated += p[j].size + DOS_PART_DEFAULT_GAP;
485 }
486 p[i].size = end - allocated - p[i].start;
487 }
488 ext_vol_start = p[i].start + p[i].size;
489 }
490
491 return 0;
492}
493#endif
494
Marek Szyprowski92f1c892020-12-23 13:55:10 +0100495int write_mbr_sector(struct blk_desc *dev_desc, void *buf)
Petr Kulhavyb6dd69a2016-09-09 10:27:16 +0200496{
497 if (is_valid_dos_buf(buf))
498 return -1;
499
500 /* write MBR */
501 if (blk_dwrite(dev_desc, 0, 1, buf) != 1) {
502 printf("%s: failed writing '%s' (1 blks at 0x0)\n",
503 __func__, "MBR");
504 return 1;
505 }
506
Gary Bissonf14c5ee2021-01-28 09:10:07 +0100507 /* Update the partition table entries*/
508 part_init(dev_desc);
509
Petr Kulhavyb6dd69a2016-09-09 10:27:16 +0200510 return 0;
511}
512
Simon Glass96e5b032016-02-29 15:25:47 -0700513U_BOOT_PART_TYPE(dos) = {
514 .name = "DOS",
515 .part_type = PART_TYPE_DOS,
Petr Kulhavy87b85302016-09-09 10:27:15 +0200516 .max_entries = DOS_ENTRY_NUMBERS,
Simon Glass3e8bd462016-02-29 15:25:48 -0700517 .get_info = part_get_info_ptr(part_get_info_dos),
Simon Glass084bf4c2016-02-29 15:26:04 -0700518 .print = part_print_ptr(part_print_dos),
519 .test = part_test_dos,
Simon Glass96e5b032016-02-29 15:25:47 -0700520};
wdenkfe8c2802002-11-03 00:38:21 +0000521
Jon Loeligercde5c642007-07-09 17:22:37 -0500522#endif