arm: zynq: zybo z7: fix MIO init issue
[platform/kernel/u-boot.git] / 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         int part_count = 0;
71
72         if((buffer[DOS_PART_MAGIC_OFFSET + 0] != 0x55) ||
73             (buffer[DOS_PART_MAGIC_OFFSET + 1] != 0xaa) ) {
74                 return (-1);
75         } /* no DOS Signature at all */
76         p = (struct dos_partition *)&buffer[DOS_PART_TBL_OFFSET];
77
78         /* Check that the boot indicators are valid and count the partitions. */
79         for (slot = 0; slot < 4; ++slot, ++p) {
80                 if (p->boot_ind != 0 && p->boot_ind != 0x80)
81                         break;
82                 if (p->sys_ind)
83                         ++part_count;
84         }
85
86         /*
87          * If the partition table is invalid or empty,
88          * check if this is a DOS PBR
89          */
90         if (slot != 4 || !part_count) {
91                 if (!strncmp((char *)&buffer[DOS_PBR_FSTYPE_OFFSET],
92                              "FAT", 3) ||
93                     !strncmp((char *)&buffer[DOS_PBR32_FSTYPE_OFFSET],
94                              "FAT32", 5))
95                         return DOS_PBR; /* This is a DOS PBR and not an MBR */
96         }
97         if (slot == 4)
98                 return DOS_MBR; /* This is an DOS MBR */
99
100         /* This is neither a DOS MBR nor a DOS PBR */
101         return -1;
102 }
103
104 static int part_test_dos(struct blk_desc *dev_desc)
105 {
106 #ifndef CONFIG_SPL_BUILD
107         ALLOC_CACHE_ALIGN_BUFFER(legacy_mbr, mbr,
108                         DIV_ROUND_UP(dev_desc->blksz, sizeof(legacy_mbr)));
109
110         if (blk_dread(dev_desc, 0, 1, (ulong *)mbr) != 1)
111                 return -1;
112
113         if (test_block_type((unsigned char *)mbr) != DOS_MBR)
114                 return -1;
115
116         if (dev_desc->sig_type == SIG_TYPE_NONE &&
117             mbr->unique_mbr_signature != 0) {
118                 dev_desc->sig_type = SIG_TYPE_MBR;
119                 dev_desc->mbr_sig = mbr->unique_mbr_signature;
120         }
121 #else
122         ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz);
123
124         if (blk_dread(dev_desc, 0, 1, (ulong *)buffer) != 1)
125                 return -1;
126
127         if (test_block_type(buffer) != DOS_MBR)
128                 return -1;
129 #endif
130
131         return 0;
132 }
133
134 /*  Print a partition that is relative to its Extended partition table
135  */
136 static void print_partition_extended(struct blk_desc *dev_desc,
137                                      lbaint_t ext_part_sector,
138                                      lbaint_t relative,
139                                      int part_num, unsigned int disksig)
140 {
141         ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz);
142         dos_partition_t *pt;
143         int i;
144
145         /* set a maximum recursion level */
146         if (part_num > MAX_EXT_PARTS)
147         {
148                 printf("** Nested DOS partitions detected, stopping **\n");
149                 return;
150     }
151
152         if (blk_dread(dev_desc, ext_part_sector, 1, (ulong *)buffer) != 1) {
153                 printf ("** Can't read partition table on %d:" LBAFU " **\n",
154                         dev_desc->devnum, ext_part_sector);
155                 return;
156         }
157         i=test_block_type(buffer);
158         if (i != DOS_MBR) {
159                 printf ("bad MBR sector signature 0x%02x%02x\n",
160                         buffer[DOS_PART_MAGIC_OFFSET],
161                         buffer[DOS_PART_MAGIC_OFFSET + 1]);
162                 return;
163         }
164
165         if (!ext_part_sector)
166                 disksig = le32_to_int(&buffer[DOS_PART_DISKSIG_OFFSET]);
167
168         /* Print all primary/logical partitions */
169         pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
170         for (i = 0; i < 4; i++, pt++) {
171                 /*
172                  * fdisk does not show the extended partitions that
173                  * are not in the MBR
174                  */
175
176                 if ((pt->sys_ind != 0) &&
177                     (ext_part_sector == 0 || !is_extended (pt->sys_ind)) ) {
178                         print_one_part(pt, ext_part_sector, part_num, disksig);
179                 }
180
181                 /* Reverse engr the fdisk part# assignment rule! */
182                 if ((ext_part_sector == 0) ||
183                     (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
184                         part_num++;
185                 }
186         }
187
188         /* Follows the extended partitions */
189         pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
190         for (i = 0; i < 4; i++, pt++) {
191                 if (is_extended (pt->sys_ind)) {
192                         lbaint_t lba_start
193                                 = le32_to_int (pt->start4) + relative;
194
195                         print_partition_extended(dev_desc, lba_start,
196                                 ext_part_sector == 0  ? lba_start : relative,
197                                 part_num, disksig);
198                 }
199         }
200
201         return;
202 }
203
204
205 /*  Print a partition that is relative to its Extended partition table
206  */
207 static int part_get_info_extended(struct blk_desc *dev_desc,
208                                   lbaint_t ext_part_sector, lbaint_t relative,
209                                   int part_num, int which_part,
210                                   disk_partition_t *info, unsigned int disksig)
211 {
212         ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz);
213         dos_partition_t *pt;
214         int i;
215         int dos_type;
216
217         /* set a maximum recursion level */
218         if (part_num > MAX_EXT_PARTS)
219         {
220                 printf("** Nested DOS partitions detected, stopping **\n");
221                 return -1;
222     }
223
224         if (blk_dread(dev_desc, ext_part_sector, 1, (ulong *)buffer) != 1) {
225                 printf ("** Can't read partition table on %d:" LBAFU " **\n",
226                         dev_desc->devnum, ext_part_sector);
227                 return -1;
228         }
229         if (buffer[DOS_PART_MAGIC_OFFSET] != 0x55 ||
230                 buffer[DOS_PART_MAGIC_OFFSET + 1] != 0xaa) {
231                 printf ("bad MBR sector signature 0x%02x%02x\n",
232                         buffer[DOS_PART_MAGIC_OFFSET],
233                         buffer[DOS_PART_MAGIC_OFFSET + 1]);
234                 return -1;
235         }
236
237 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
238         if (!ext_part_sector)
239                 disksig = le32_to_int(&buffer[DOS_PART_DISKSIG_OFFSET]);
240 #endif
241
242         /* Print all primary/logical partitions */
243         pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
244         for (i = 0; i < 4; i++, pt++) {
245                 /*
246                  * fdisk does not show the extended partitions that
247                  * are not in the MBR
248                  */
249                 if (((pt->boot_ind & ~0x80) == 0) &&
250                     (pt->sys_ind != 0) &&
251                     (part_num == which_part) &&
252                     (ext_part_sector == 0 || is_extended(pt->sys_ind) == 0)) {
253                         info->blksz = DOS_PART_DEFAULT_SECTOR;
254                         info->start = (lbaint_t)(ext_part_sector +
255                                         le32_to_int(pt->start4));
256                         info->size  = (lbaint_t)le32_to_int(pt->size4);
257                         part_set_generic_name(dev_desc, part_num,
258                                               (char *)info->name);
259                         /* sprintf(info->type, "%d, pt->sys_ind); */
260                         strcpy((char *)info->type, "U-Boot");
261                         info->bootable = is_bootable(pt);
262 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
263                         sprintf(info->uuid, "%08x-%02x", disksig, part_num);
264 #endif
265                         info->sys_ind = pt->sys_ind;
266                         return 0;
267                 }
268
269                 /* Reverse engr the fdisk part# assignment rule! */
270                 if ((ext_part_sector == 0) ||
271                     (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
272                         part_num++;
273                 }
274         }
275
276         /* Follows the extended partitions */
277         pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
278         for (i = 0; i < 4; i++, pt++) {
279                 if (is_extended (pt->sys_ind)) {
280                         lbaint_t lba_start
281                                 = le32_to_int (pt->start4) + relative;
282
283                         return part_get_info_extended(dev_desc, lba_start,
284                                  ext_part_sector == 0 ? lba_start : relative,
285                                  part_num, which_part, info, disksig);
286                 }
287         }
288
289         /* Check for DOS PBR if no partition is found */
290         dos_type = test_block_type(buffer);
291
292         if (dos_type == DOS_PBR) {
293                 info->start = 0;
294                 info->size = dev_desc->lba;
295                 info->blksz = DOS_PART_DEFAULT_SECTOR;
296                 info->bootable = 0;
297                 strcpy((char *)info->type, "U-Boot");
298 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
299                 info->uuid[0] = 0;
300 #endif
301                 return 0;
302         }
303
304         return -1;
305 }
306
307 void part_print_dos(struct blk_desc *dev_desc)
308 {
309         printf("Part\tStart Sector\tNum Sectors\tUUID\t\tType\n");
310         print_partition_extended(dev_desc, 0, 0, 1, 0);
311 }
312
313 int part_get_info_dos(struct blk_desc *dev_desc, int part,
314                       disk_partition_t *info)
315 {
316         return part_get_info_extended(dev_desc, 0, 0, 1, part, info, 0);
317 }
318
319 int is_valid_dos_buf(void *buf)
320 {
321         return test_block_type(buf) == DOS_MBR ? 0 : -1;
322 }
323
324 int write_mbr_partition(struct blk_desc *dev_desc, void *buf)
325 {
326         if (is_valid_dos_buf(buf))
327                 return -1;
328
329         /* write MBR */
330         if (blk_dwrite(dev_desc, 0, 1, buf) != 1) {
331                 printf("%s: failed writing '%s' (1 blks at 0x0)\n",
332                        __func__, "MBR");
333                 return 1;
334         }
335
336         return 0;
337 }
338
339 U_BOOT_PART_TYPE(dos) = {
340         .name           = "DOS",
341         .part_type      = PART_TYPE_DOS,
342         .max_entries    = DOS_ENTRY_NUMBERS,
343         .get_info       = part_get_info_ptr(part_get_info_dos),
344         .print          = part_print_ptr(part_print_dos),
345         .test           = part_test_dos,
346 };
347
348 #endif