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