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