blob: 33374384373a67337ce6c359bf3f53e54494d11f [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
Darwin Dingel4a36be92014-06-06 15:48:26 +120026#define DOS_PART_DEFAULT_SECTOR 512
27
Paul Emge232e2f42019-07-08 16:37:03 -070028/* should this be configurable? It looks like it's not very common at all
29 * to use large numbers of partitions */
30#define MAX_EXT_PARTS 256
31
wdenkfe8c2802002-11-03 00:38:21 +000032static inline int is_extended(int part_type)
33{
Marek Szyprowski80bd05f2020-12-23 13:55:11 +010034 return (part_type == DOS_PART_TYPE_EXTENDED ||
35 part_type == DOS_PART_TYPE_EXTENDED_LBA ||
36 part_type == DOS_PART_TYPE_EXTENDED_LINUX);
wdenkfe8c2802002-11-03 00:38:21 +000037}
38
Heinrich Schuchardt25801ac2020-03-19 13:49:34 +010039static int get_bootable(dos_partition_t *p)
Rob Herring40e0e562012-08-23 11:31:43 +000040{
Heinrich Schuchardt25801ac2020-03-19 13:49:34 +010041 int ret = 0;
42
43 if (p->sys_ind == 0xef)
44 ret |= PART_EFI_SYSTEM_PARTITION;
45 if (p->boot_ind == 0x80)
46 ret |= PART_BOOTABLE;
47 return ret;
Rob Herring40e0e562012-08-23 11:31:43 +000048}
49
Stefan Monnierd29892b2015-08-25 15:24:13 -040050static void print_one_part(dos_partition_t *p, lbaint_t ext_part_sector,
Stephen Warrene2e9b372012-10-08 08:14:40 +000051 int part_num, unsigned int disksig)
wdenkfe8c2802002-11-03 00:38:21 +000052{
Marek Szyprowski97163dd2020-12-23 13:55:12 +010053 lbaint_t lba_start = ext_part_sector + get_unaligned_le32(p->start4);
54 lbaint_t lba_size = get_unaligned_le32(p->size4);
wdenkfe8c2802002-11-03 00:38:21 +000055
Stefan Monnierd29892b2015-08-25 15:24:13 -040056 printf("%3d\t%-10" LBAFlength "u\t%-10" LBAFlength
57 "u\t%08x-%02x\t%02x%s%s\n",
Stephen Warrene2e9b372012-10-08 08:14:40 +000058 part_num, lba_start, lba_size, disksig, part_num, p->sys_ind,
Rob Herring40e0e562012-08-23 11:31:43 +000059 (is_extended(p->sys_ind) ? " Extd" : ""),
Heinrich Schuchardt25801ac2020-03-19 13:49:34 +010060 (get_bootable(p) ? " Boot" : ""));
wdenkfe8c2802002-11-03 00:38:21 +000061}
62
wdenk7205e402003-09-10 22:30:53 +000063static int test_block_type(unsigned char *buffer)
64{
Egbert Eich9d956e02013-04-09 05:46:14 +000065 int slot;
66 struct dos_partition *p;
Heinrich Schuchardt34856b02019-10-15 20:43:42 +020067 int part_count = 0;
Egbert Eich9d956e02013-04-09 05:46:14 +000068
wdenk7205e402003-09-10 22:30:53 +000069 if((buffer[DOS_PART_MAGIC_OFFSET + 0] != 0x55) ||
70 (buffer[DOS_PART_MAGIC_OFFSET + 1] != 0xaa) ) {
71 return (-1);
72 } /* no DOS Signature at all */
Egbert Eich9d956e02013-04-09 05:46:14 +000073 p = (struct dos_partition *)&buffer[DOS_PART_TBL_OFFSET];
wdenk7205e402003-09-10 22:30:53 +000074
Heinrich Schuchardt34856b02019-10-15 20:43:42 +020075 /* Check that the boot indicators are valid and count the partitions. */
76 for (slot = 0; slot < 4; ++slot, ++p) {
77 if (p->boot_ind != 0 && p->boot_ind != 0x80)
78 break;
79 if (p->sys_ind)
80 ++part_count;
81 }
82
83 /*
84 * If the partition table is invalid or empty,
85 * check if this is a DOS PBR
86 */
87 if (slot != 4 || !part_count) {
88 if (!strncmp((char *)&buffer[DOS_PBR_FSTYPE_OFFSET],
89 "FAT", 3) ||
90 !strncmp((char *)&buffer[DOS_PBR32_FSTYPE_OFFSET],
91 "FAT32", 5))
92 return DOS_PBR; /* This is a DOS PBR and not an MBR */
93 }
94 if (slot == 4)
95 return DOS_MBR; /* This is an DOS MBR */
96
97 /* This is neither a DOS MBR nor a DOS PBR */
98 return -1;
99}
wdenkfe8c2802002-11-03 00:38:21 +0000100
Simon Glasscfdcd412023-08-24 13:55:26 -0600101static int part_test_dos(struct blk_desc *desc)
wdenkfe8c2802002-11-03 00:38:21 +0000102{
Fabio Estevam3ea05202017-10-04 13:29:57 -0300103#ifndef CONFIG_SPL_BUILD
Faiz Abbas7aed3d32019-09-04 20:10:12 +0530104 ALLOC_CACHE_ALIGN_BUFFER(legacy_mbr, mbr,
Simon Glasscfdcd412023-08-24 13:55:26 -0600105 DIV_ROUND_UP(desc->blksz, sizeof(legacy_mbr)));
wdenkfe8c2802002-11-03 00:38:21 +0000106
Simon Glasscfdcd412023-08-24 13:55:26 -0600107 if (blk_dread(desc, 0, 1, (ulong *)mbr) != 1)
Stephen Warrend1efb642012-10-05 13:17:40 +0000108 return -1;
109
Peter Jonesff98cb92017-09-13 18:05:25 -0400110 if (test_block_type((unsigned char *)mbr) != DOS_MBR)
Stephen Warrend1efb642012-10-05 13:17:40 +0000111 return -1;
112
Simon Glasscfdcd412023-08-24 13:55:26 -0600113 if (desc->sig_type == SIG_TYPE_NONE && mbr->unique_mbr_signature) {
114 desc->sig_type = SIG_TYPE_MBR;
115 desc->mbr_sig = mbr->unique_mbr_signature;
Peter Jonesff98cb92017-09-13 18:05:25 -0400116 }
Fabio Estevam3ea05202017-10-04 13:29:57 -0300117#else
Simon Glasscfdcd412023-08-24 13:55:26 -0600118 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, desc->blksz);
Fabio Estevam3ea05202017-10-04 13:29:57 -0300119
Simon Glasscfdcd412023-08-24 13:55:26 -0600120 if (blk_dread(desc, 0, 1, (ulong *)buffer) != 1)
Fabio Estevam3ea05202017-10-04 13:29:57 -0300121 return -1;
122
123 if (test_block_type(buffer) != DOS_MBR)
124 return -1;
125#endif
Peter Jonesff98cb92017-09-13 18:05:25 -0400126
Stephen Warrend1efb642012-10-05 13:17:40 +0000127 return 0;
wdenkfe8c2802002-11-03 00:38:21 +0000128}
129
130/* Print a partition that is relative to its Extended partition table
131 */
Simon Glasscfdcd412023-08-24 13:55:26 -0600132static void print_partition_extended(struct blk_desc *desc,
Stefan Monnierd29892b2015-08-25 15:24:13 -0400133 lbaint_t ext_part_sector,
134 lbaint_t relative,
Stephen Warrene2e9b372012-10-08 08:14:40 +0000135 int part_num, unsigned int disksig)
wdenkfe8c2802002-11-03 00:38:21 +0000136{
Simon Glasscfdcd412023-08-24 13:55:26 -0600137 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, desc->blksz);
wdenkfe8c2802002-11-03 00:38:21 +0000138 dos_partition_t *pt;
139 int i;
140
Paul Emge232e2f42019-07-08 16:37:03 -0700141 /* set a maximum recursion level */
142 if (part_num > MAX_EXT_PARTS)
143 {
144 printf("** Nested DOS partitions detected, stopping **\n");
145 return;
146 }
147
Simon Glasscfdcd412023-08-24 13:55:26 -0600148 if (blk_dread(desc, ext_part_sector, 1, (ulong *)buffer) != 1) {
Stefan Monnierd29892b2015-08-25 15:24:13 -0400149 printf ("** Can't read partition table on %d:" LBAFU " **\n",
Simon Glasscfdcd412023-08-24 13:55:26 -0600150 desc->devnum, ext_part_sector);
wdenkfe8c2802002-11-03 00:38:21 +0000151 return;
152 }
wdenk7205e402003-09-10 22:30:53 +0000153 i=test_block_type(buffer);
Stephen Warrend1efb642012-10-05 13:17:40 +0000154 if (i != DOS_MBR) {
wdenkfe8c2802002-11-03 00:38:21 +0000155 printf ("bad MBR sector signature 0x%02x%02x\n",
156 buffer[DOS_PART_MAGIC_OFFSET],
157 buffer[DOS_PART_MAGIC_OFFSET + 1]);
158 return;
159 }
Stephen Warrend1efb642012-10-05 13:17:40 +0000160
Stephen Warrene2e9b372012-10-08 08:14:40 +0000161 if (!ext_part_sector)
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100162 disksig = get_unaligned_le32(&buffer[DOS_PART_DISKSIG_OFFSET]);
Stephen Warrene2e9b372012-10-08 08:14:40 +0000163
wdenkfe8c2802002-11-03 00:38:21 +0000164 /* Print all primary/logical partitions */
165 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
166 for (i = 0; i < 4; i++, pt++) {
167 /*
wdenk8bde7f72003-06-27 21:31:46 +0000168 * fdisk does not show the extended partitions that
wdenkfe8c2802002-11-03 00:38:21 +0000169 * are not in the MBR
170 */
171
172 if ((pt->sys_ind != 0) &&
173 (ext_part_sector == 0 || !is_extended (pt->sys_ind)) ) {
Stephen Warrene2e9b372012-10-08 08:14:40 +0000174 print_one_part(pt, ext_part_sector, part_num, disksig);
wdenkfe8c2802002-11-03 00:38:21 +0000175 }
176
177 /* Reverse engr the fdisk part# assignment rule! */
178 if ((ext_part_sector == 0) ||
179 (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
180 part_num++;
181 }
182 }
183
184 /* Follows the extended partitions */
185 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
186 for (i = 0; i < 4; i++, pt++) {
187 if (is_extended (pt->sys_ind)) {
Stefan Monnierd29892b2015-08-25 15:24:13 -0400188 lbaint_t lba_start
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100189 = get_unaligned_le32 (pt->start4) + relative;
wdenkfe8c2802002-11-03 00:38:21 +0000190
Simon Glasscfdcd412023-08-24 13:55:26 -0600191 print_partition_extended(desc, lba_start,
192 !ext_part_sector ? lba_start :
193 relative, part_num, disksig);
wdenkfe8c2802002-11-03 00:38:21 +0000194 }
195 }
196
197 return;
198}
199
200
201/* Print a partition that is relative to its Extended partition table
202 */
Simon Glasscfdcd412023-08-24 13:55:26 -0600203static int part_get_info_extended(struct blk_desc *desc,
Simon Glass3e8bd462016-02-29 15:25:48 -0700204 lbaint_t ext_part_sector, lbaint_t relative,
205 int part_num, int which_part,
Simon Glass05289792020-05-10 11:39:57 -0600206 struct disk_partition *info, uint disksig)
wdenkfe8c2802002-11-03 00:38:21 +0000207{
Simon Glasscfdcd412023-08-24 13:55:26 -0600208 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, desc->blksz);
Marek Vasute2b5cc62023-08-14 01:48:45 +0200209 struct disk_partition wdinfo = { 0 };
wdenkfe8c2802002-11-03 00:38:21 +0000210 dos_partition_t *pt;
Marek Vasute2b5cc62023-08-14 01:48:45 +0200211 int i, ret;
Darwin Dingel4a36be92014-06-06 15:48:26 +1200212 int dos_type;
wdenkfe8c2802002-11-03 00:38:21 +0000213
Paul Emge232e2f42019-07-08 16:37:03 -0700214 /* set a maximum recursion level */
215 if (part_num > MAX_EXT_PARTS)
216 {
217 printf("** Nested DOS partitions detected, stopping **\n");
218 return -1;
219 }
220
Simon Glasscfdcd412023-08-24 13:55:26 -0600221 if (blk_dread(desc, ext_part_sector, 1, (ulong *)buffer) != 1) {
Stefan Monnierd29892b2015-08-25 15:24:13 -0400222 printf ("** Can't read partition table on %d:" LBAFU " **\n",
Simon Glasscfdcd412023-08-24 13:55:26 -0600223 desc->devnum, ext_part_sector);
wdenkfe8c2802002-11-03 00:38:21 +0000224 return -1;
225 }
226 if (buffer[DOS_PART_MAGIC_OFFSET] != 0x55 ||
227 buffer[DOS_PART_MAGIC_OFFSET + 1] != 0xaa) {
228 printf ("bad MBR sector signature 0x%02x%02x\n",
229 buffer[DOS_PART_MAGIC_OFFSET],
230 buffer[DOS_PART_MAGIC_OFFSET + 1]);
231 return -1;
232 }
233
Simon Glassc5f1d002023-08-24 13:55:31 -0600234 if (CONFIG_IS_ENABLED(PARTITION_UUIDS) && !ext_part_sector)
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100235 disksig = get_unaligned_le32(&buffer[DOS_PART_DISKSIG_OFFSET]);
Stephen Warrend27b5f92012-09-21 09:51:00 +0000236
Simon Glasscfdcd412023-08-24 13:55:26 -0600237 ret = part_get_info_whole_disk(desc, &wdinfo);
Marek Vasute2b5cc62023-08-14 01:48:45 +0200238 if (ret)
239 return ret;
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)) {
Marek Vasute2b5cc62023-08-14 01:48:45 +0200252 if (wdinfo.blksz > DOS_PART_DEFAULT_SECTOR)
253 info->blksz = wdinfo.blksz;
254 else
255 info->blksz = DOS_PART_DEFAULT_SECTOR;
Steve Raee04350d2014-05-26 11:52:23 -0700256 info->start = (lbaint_t)(ext_part_sector +
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100257 get_unaligned_le32(pt->start4));
258 info->size = (lbaint_t)get_unaligned_le32(pt->size4);
Simon Glasscfdcd412023-08-24 13:55:26 -0600259 part_set_generic_name(desc, part_num,
Petr Kulhavyda2ee242016-09-09 10:27:17 +0200260 (char *)info->name);
wdenkfe8c2802002-11-03 00:38:21 +0000261 /* sprintf(info->type, "%d, pt->sys_ind); */
Ben Whitten192bc692015-12-30 13:05:58 +0000262 strcpy((char *)info->type, "U-Boot");
Heinrich Schuchardt25801ac2020-03-19 13:49:34 +0100263 info->bootable = get_bootable(pt);
Simon Glassc5f1d002023-08-24 13:55:31 -0600264 if (CONFIG_IS_ENABLED(PARTITION_UUIDS)) {
265 char str[12];
266
267 sprintf(str, "%08x-%02x", disksig, part_num);
268 disk_partition_set_uuid(info, str);
269 }
Dalon Westergreenf0fb4fa2017-02-10 17:15:34 -0800270 info->sys_ind = pt->sys_ind;
wdenkfe8c2802002-11-03 00:38:21 +0000271 return 0;
272 }
273
274 /* Reverse engr the fdisk part# assignment rule! */
275 if ((ext_part_sector == 0) ||
276 (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
277 part_num++;
278 }
279 }
280
281 /* Follows the extended partitions */
282 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
283 for (i = 0; i < 4; i++, pt++) {
284 if (is_extended (pt->sys_ind)) {
Stefan Monnierd29892b2015-08-25 15:24:13 -0400285 lbaint_t lba_start
Marek Szyprowski97163dd2020-12-23 13:55:12 +0100286 = get_unaligned_le32 (pt->start4) + relative;
wdenkfe8c2802002-11-03 00:38:21 +0000287
Simon Glasscfdcd412023-08-24 13:55:26 -0600288 return part_get_info_extended(desc, lba_start,
wdenkfe8c2802002-11-03 00:38:21 +0000289 ext_part_sector == 0 ? lba_start : relative,
Stephen Warrend27b5f92012-09-21 09:51:00 +0000290 part_num, which_part, info, disksig);
wdenkfe8c2802002-11-03 00:38:21 +0000291 }
292 }
Darwin Dingel4a36be92014-06-06 15:48:26 +1200293
294 /* Check for DOS PBR if no partition is found */
295 dos_type = test_block_type(buffer);
296
297 if (dos_type == DOS_PBR) {
298 info->start = 0;
Simon Glasscfdcd412023-08-24 13:55:26 -0600299 info->size = desc->lba;
Marek Vasute2b5cc62023-08-14 01:48:45 +0200300 if (wdinfo.blksz > DOS_PART_DEFAULT_SECTOR)
301 info->blksz = wdinfo.blksz;
302 else
303 info->blksz = DOS_PART_DEFAULT_SECTOR;
Darwin Dingel4a36be92014-06-06 15:48:26 +1200304 info->bootable = 0;
Ben Whitten192bc692015-12-30 13:05:58 +0000305 strcpy((char *)info->type, "U-Boot");
Simon Glassc5f1d002023-08-24 13:55:31 -0600306 disk_partition_clr_uuid(info);
Darwin Dingel4a36be92014-06-06 15:48:26 +1200307 return 0;
308 }
309
wdenkfe8c2802002-11-03 00:38:21 +0000310 return -1;
311}
312
Simon Glasscfdcd412023-08-24 13:55:26 -0600313static void __maybe_unused part_print_dos(struct blk_desc *desc)
wdenkfe8c2802002-11-03 00:38:21 +0000314{
Stephen Warrene2e9b372012-10-08 08:14:40 +0000315 printf("Part\tStart Sector\tNum Sectors\tUUID\t\tType\n");
Simon Glasscfdcd412023-08-24 13:55:26 -0600316 print_partition_extended(desc, 0, 0, 1, 0);
wdenkfe8c2802002-11-03 00:38:21 +0000317}
318
Simon Glasscfdcd412023-08-24 13:55:26 -0600319static int __maybe_unused part_get_info_dos(struct blk_desc *desc, int part,
320 struct disk_partition *info)
wdenkfe8c2802002-11-03 00:38:21 +0000321{
Simon Glasscfdcd412023-08-24 13:55:26 -0600322 return part_get_info_extended(desc, 0, 0, 1, part, info, 0);
wdenkfe8c2802002-11-03 00:38:21 +0000323}
324
Petr Kulhavyb6dd69a2016-09-09 10:27:16 +0200325int is_valid_dos_buf(void *buf)
326{
327 return test_block_type(buf) == DOS_MBR ? 0 : -1;
328}
329
Simon Glassd01bf202023-02-05 15:36:33 -0700330#if IS_ENABLED(CONFIG_CMD_MBR)
Marek Szyprowski20bd5ac2020-12-23 13:55:14 +0100331static void lba_to_chs(lbaint_t lba, unsigned char *rc, unsigned char *rh,
332 unsigned char *rs)
333{
334 unsigned int c, h, s;
335 /* use fixed CHS geometry */
336 unsigned int sectpertrack = 63;
337 unsigned int heads = 255;
338
339 c = (lba + 1) / sectpertrack / heads;
340 h = (lba + 1) / sectpertrack - c * heads;
341 s = (lba + 1) - (c * heads + h) * sectpertrack;
342
343 if (c > 1023) {
344 c = 1023;
345 h = 254;
346 s = 63;
347 }
348
349 *rc = c & 0xff;
350 *rh = h;
351 *rs = s + ((c & 0x300) >> 2);
352}
353
354static void mbr_fill_pt_entry(dos_partition_t *pt, lbaint_t start,
355 lbaint_t relative, lbaint_t size, uchar sys_ind, bool bootable)
356{
357 pt->boot_ind = bootable ? 0x80 : 0x00;
358 pt->sys_ind = sys_ind;
359 lba_to_chs(start, &pt->cyl, &pt->head, &pt->sector);
360 lba_to_chs(start + size - 1, &pt->end_cyl, &pt->end_head, &pt->end_sector);
361 put_unaligned_le32(relative, &pt->start4);
362 put_unaligned_le32(size, &pt->size4);
363}
364
365int write_mbr_partitions(struct blk_desc *dev,
366 struct disk_partition *p, int count, unsigned int disksig)
367{
368 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev->blksz);
369 lbaint_t ext_part_start = 0, ext_part_size = 0, ext_part_sect = 0;
370 dos_partition_t *pt;
371 int i;
372
373 memset(buffer, 0, dev->blksz);
374 buffer[DOS_PART_MAGIC_OFFSET] = 0x55;
375 buffer[DOS_PART_MAGIC_OFFSET + 1] = 0xaa;
376 put_unaligned_le32(disksig, &buffer[DOS_PART_DISKSIG_OFFSET]);
377 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
378
379 /* create all primary partitions */
380 for (i = 0; i < 4 && i < count; i++, pt++) {
381 mbr_fill_pt_entry(pt, p[i].start, p[i].start, p[i].size,
382 p[i].sys_ind, p[i].bootable);
383 if (is_extended(p[i].sys_ind)) {
384 ext_part_start = p[i].start;
385 ext_part_size = p[i].size;
386 ext_part_sect = p[i].start;
387 }
388 }
389
390 if (i < count && !ext_part_start) {
391 printf("%s: extended partition is needed for more than 4 partitions\n",
392 __func__);
393 return -1;
394 }
395
396 /* write MBR */
397 if (blk_dwrite(dev, 0, 1, buffer) != 1) {
398 printf("%s: failed writing 'MBR' (1 blks at 0x0)\n",
399 __func__);
400 return -1;
401 }
402
403 /* create extended volumes */
404 for (; i < count; i++) {
405 lbaint_t next_ebr = 0;
406
407 memset(buffer, 0, dev->blksz);
408 buffer[DOS_PART_MAGIC_OFFSET] = 0x55;
409 buffer[DOS_PART_MAGIC_OFFSET + 1] = 0xaa;
410 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
411
412 mbr_fill_pt_entry(pt, p[i].start, p[i].start - ext_part_sect,
413 p[i].size, p[i].sys_ind, p[i].bootable);
414
415 if (i + 1 < count) {
416 pt++;
417 next_ebr = p[i].start + p[i].size;
418 mbr_fill_pt_entry(pt, next_ebr,
419 next_ebr - ext_part_start,
420 p[i+1].start + p[i+1].size - next_ebr,
421 DOS_PART_TYPE_EXTENDED, 0);
422 }
423
424 /* write EBR */
425 if (blk_dwrite(dev, ext_part_sect, 1, buffer) != 1) {
426 printf("%s: failed writing 'EBR' (1 blks at 0x%lx)\n",
427 __func__, ext_part_sect);
428 return -1;
429 }
430 ext_part_sect = next_ebr;
431 }
432
Gary Bissonf14c5ee2021-01-28 09:10:07 +0100433 /* Update the partition table entries*/
Christian Melkic7d1b182021-06-07 11:21:15 +0200434 part_init(dev);
Gary Bissonf14c5ee2021-01-28 09:10:07 +0100435
Marek Szyprowski20bd5ac2020-12-23 13:55:14 +0100436 return 0;
437}
438
439int layout_mbr_partitions(struct disk_partition *p, int count,
440 lbaint_t total_sectors)
441{
442 struct disk_partition *ext = NULL;
443 int i, j;
444 lbaint_t ext_vol_start;
445
446 /* calculate primary partitions start and size if needed */
447 if (!p[0].start)
448 p[0].start = DOS_PART_DEFAULT_GAP;
449 for (i = 0; i < 4 && i < count; i++) {
450 if (!p[i].start)
451 p[i].start = p[i - 1].start + p[i - 1].size;
452 if (!p[i].size) {
453 lbaint_t end = total_sectors;
454 lbaint_t allocated = 0;
455
456 for (j = i + 1; j < 4 && j < count; j++) {
457 if (p[j].start) {
458 end = p[j].start;
459 break;
460 }
461 allocated += p[j].size;
462 }
463 p[i].size = end - allocated - p[i].start;
464 }
465 if (p[i].sys_ind == 0x05)
466 ext = &p[i];
467 }
468
Simon Glassb7c2cc42021-10-23 17:26:02 -0600469 if (count < 4)
470 return 0;
471
472 if (!ext) {
473 log_err("extended partition is needed for more than 4 partitions\n");
474 return -EINVAL;
Marek Szyprowski20bd5ac2020-12-23 13:55:14 +0100475 }
476
477 /* calculate extended volumes start and size if needed */
478 ext_vol_start = ext->start;
479 for (i = 4; i < count; i++) {
480 if (!p[i].start)
481 p[i].start = ext_vol_start + DOS_PART_DEFAULT_GAP;
482 if (!p[i].size) {
483 lbaint_t end = ext->start + ext->size;
484 lbaint_t allocated = 0;
485
486 for (j = i + 1; j < count; j++) {
487 if (p[j].start) {
488 end = p[j].start - DOS_PART_DEFAULT_GAP;
489 break;
490 }
491 allocated += p[j].size + DOS_PART_DEFAULT_GAP;
492 }
493 p[i].size = end - allocated - p[i].start;
494 }
495 ext_vol_start = p[i].start + p[i].size;
496 }
497
498 return 0;
499}
500#endif
501
Simon Glasscfdcd412023-08-24 13:55:26 -0600502int write_mbr_sector(struct blk_desc *desc, void *buf)
Petr Kulhavyb6dd69a2016-09-09 10:27:16 +0200503{
504 if (is_valid_dos_buf(buf))
505 return -1;
506
507 /* write MBR */
Simon Glasscfdcd412023-08-24 13:55:26 -0600508 if (blk_dwrite(desc, 0, 1, buf) != 1) {
Petr Kulhavyb6dd69a2016-09-09 10:27:16 +0200509 printf("%s: failed writing '%s' (1 blks at 0x0)\n",
510 __func__, "MBR");
511 return 1;
512 }
513
Gary Bissonf14c5ee2021-01-28 09:10:07 +0100514 /* Update the partition table entries*/
Simon Glasscfdcd412023-08-24 13:55:26 -0600515 part_init(desc);
Gary Bissonf14c5ee2021-01-28 09:10:07 +0100516
Petr Kulhavyb6dd69a2016-09-09 10:27:16 +0200517 return 0;
518}
519
Simon Glass96e5b032016-02-29 15:25:47 -0700520U_BOOT_PART_TYPE(dos) = {
521 .name = "DOS",
522 .part_type = PART_TYPE_DOS,
Petr Kulhavy87b85302016-09-09 10:27:15 +0200523 .max_entries = DOS_ENTRY_NUMBERS,
Simon Glass3e8bd462016-02-29 15:25:48 -0700524 .get_info = part_get_info_ptr(part_get_info_dos),
Simon Glass084bf4c2016-02-29 15:26:04 -0700525 .print = part_print_ptr(part_print_dos),
526 .test = part_test_dos,
Simon Glass96e5b032016-02-29 15:25:47 -0700527};