1
2
3
4
5
6
7
8
9
10
11
12
13
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
27
28#define MAX_EXT_PARTS 256
29
30
31
32static 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
41static inline int is_extended(int part_type)
42{
43 return (part_type == 0x5 ||
44 part_type == 0xf ||
45 part_type == 0x85);
46}
47
48static inline int is_bootable(dos_partition_t *p)
49{
50 return (p->sys_ind == 0xef) || (p->boot_ind == 0x80);
51}
52
53static 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
66static 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 }
76 p = (struct dos_partition *)&buffer[DOS_PART_TBL_OFFSET];
77
78
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
88
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;
96 }
97 if (slot == 4)
98 return DOS_MBR;
99
100
101 return -1;
102}
103
104static 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
135
136static 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
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
169 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
170 for (i = 0; i < 4; i++, pt++) {
171
172
173
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
182 if ((ext_part_sector == 0) ||
183 (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
184 part_num++;
185 }
186 }
187
188
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
206
207static 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
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
243 pt = (dos_partition_t *) (buffer + DOS_PART_TBL_OFFSET);
244 for (i = 0; i < 4; i++, pt++) {
245
246
247
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
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
270 if ((ext_part_sector == 0) ||
271 (pt->sys_ind != 0 && !is_extended (pt->sys_ind)) ) {
272 part_num++;
273 }
274 }
275
276
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
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
307void 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
313int 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
319int is_valid_dos_buf(void *buf)
320{
321 return test_block_type(buf) == DOS_MBR ? 0 : -1;
322}
323
324int write_mbr_partition(struct blk_desc *dev_desc, void *buf)
325{
326 if (is_valid_dos_buf(buf))
327 return -1;
328
329
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
339U_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
349