]>
Commit | Line | Data |
---|---|---|
83d290c5 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
c7de829c WD |
2 | /* |
3 | * (C) Copyright 2001 | |
8bde7f77 | 4 | * Hans-Joerg Frieden, Hyperion Entertainment |
c7de829c | 5 | * [email protected] |
c7de829c WD |
6 | */ |
7 | #include <common.h> | |
8 | #include <command.h> | |
7b51b576 | 9 | #include <env.h> |
c7de829c | 10 | #include <ide.h> |
c7de829c | 11 | #include "part_amiga.h" |
e6f6f9e6 | 12 | #include <part.h> |
c7de829c | 13 | |
1811a928 | 14 | #ifdef CONFIG_HAVE_BLOCK_DEVICE |
c7de829c WD |
15 | |
16 | #undef AMIGA_DEBUG | |
17 | ||
18 | #ifdef AMIGA_DEBUG | |
19 | #define PRINTF(fmt, args...) printf(fmt ,##args) | |
20 | #else | |
21 | #define PRINTF(fmt, args...) | |
22 | #endif | |
23 | ||
24 | struct block_header | |
25 | { | |
26 | u32 id; | |
27 | u32 summed_longs; | |
28 | s32 chk_sum; | |
29 | }; | |
30 | ||
31 | static unsigned char block_buffer[DEFAULT_SECTOR_SIZE]; | |
32 | static struct rigid_disk_block rdb = {0}; | |
33 | static struct bootcode_block bootcode = {0}; | |
34 | ||
35 | /* | |
36 | * Copy a bcpl to a c string | |
37 | */ | |
38 | static void bcpl_strcpy(char *to, char *from) | |
39 | { | |
40 | int len = *from++; | |
41 | ||
42 | while (len) | |
43 | { | |
44 | *to++ = *from++; | |
45 | len--; | |
46 | } | |
47 | *to = 0; | |
48 | } | |
49 | ||
50 | /* | |
51 | * Print a BCPL String. BCPL strings start with a byte with the length | |
52 | * of the string, and don't contain a terminating nul character | |
53 | */ | |
54 | static void bstr_print(char *string) | |
55 | { | |
56 | int len = *string++; | |
57 | char buffer[256]; | |
58 | int i; | |
8bde7f77 | 59 | |
c7de829c WD |
60 | i = 0; |
61 | while (len) | |
62 | { | |
63 | buffer[i++] = *string++; | |
64 | len--; | |
65 | } | |
66 | ||
67 | buffer[i] = 0; | |
68 | printf("%-10s", buffer); | |
69 | } | |
70 | ||
71 | /* | |
72 | * Sum a block. The checksum of a block must end up at zero | |
73 | * to be valid. The chk_sum field is selected so that adding | |
74 | * it yields zero. | |
75 | */ | |
76 | int sum_block(struct block_header *header) | |
77 | { | |
78 | s32 *block = (s32 *)header; | |
79 | u32 i; | |
80 | s32 sum = 0; | |
81 | ||
82 | for (i = 0; i < header->summed_longs; i++) | |
83 | sum += *block++; | |
8bde7f77 | 84 | |
c7de829c WD |
85 | return (sum != 0); |
86 | } | |
87 | ||
88 | /* | |
89 | * Print an AmigaOS disk type. Disk types are a four-byte identifier | |
90 | * describing the file system. They are usually written as a three-letter | |
91 | * word followed by a backslash and a version number. For example, | |
92 | * DOS\0 would be the original file system. SFS\0 would be SmartFileSystem. | |
93 | * DOS\1 is FFS. | |
94 | */ | |
95 | static void print_disk_type(u32 disk_type) | |
96 | { | |
97 | char buffer[6]; | |
98 | buffer[0] = (disk_type & 0xFF000000)>>24; | |
99 | buffer[1] = (disk_type & 0x00FF0000)>>16; | |
100 | buffer[2] = (disk_type & 0x0000FF00)>>8; | |
101 | buffer[3] = '\\'; | |
102 | buffer[4] = (disk_type & 0x000000FF) + '0'; | |
103 | buffer[5] = 0; | |
104 | printf("%s", buffer); | |
105 | } | |
106 | ||
107 | /* | |
108 | * Print the info contained within the given partition block | |
109 | */ | |
110 | static void print_part_info(struct partition_block *p) | |
111 | { | |
112 | struct amiga_part_geometry *g; | |
8bde7f77 | 113 | |
c7de829c WD |
114 | g = (struct amiga_part_geometry *)&(p->environment); |
115 | ||
116 | bstr_print(p->drive_name); | |
8bde7f77 WD |
117 | printf("%6d\t%6d\t", |
118 | g->low_cyl * g->block_per_track * g->surfaces , | |
c7de829c WD |
119 | (g->high_cyl - g->low_cyl + 1) * g->block_per_track * g->surfaces - 1); |
120 | print_disk_type(g->dos_type); | |
121 | printf("\t%5d\n", g->boot_priority); | |
122 | } | |
123 | ||
124 | /* | |
125 | * Search for the Rigid Disk Block. The rigid disk block is required | |
126 | * to be within the first 16 blocks of a drive, needs to have | |
127 | * the ID AMIGA_ID_RDISK ('RDSK') and needs to have a valid | |
128 | * sum-to-zero checksum | |
129 | */ | |
4101f687 | 130 | struct rigid_disk_block *get_rdisk(struct blk_desc *dev_desc) |
c7de829c WD |
131 | { |
132 | int i; | |
133 | int limit; | |
134 | char *s; | |
135 | ||
00caae6d | 136 | s = env_get("amiga_scanlimit"); |
c7de829c | 137 | if (s) |
0b1284eb | 138 | limit = dectoul(s, NULL); |
c7de829c WD |
139 | else |
140 | limit = AMIGA_BLOCK_LIMIT; | |
141 | ||
142 | for (i=0; i<limit; i++) | |
143 | { | |
2a981dc2 | 144 | ulong res = blk_dread(dev_desc, i, 1, (ulong *)block_buffer); |
c7de829c WD |
145 | if (res == 1) |
146 | { | |
147 | struct rigid_disk_block *trdb = (struct rigid_disk_block *)block_buffer; | |
148 | if (trdb->id == AMIGA_ID_RDISK) | |
149 | { | |
150 | PRINTF("Rigid disk block suspect at %d, checking checksum\n",i); | |
151 | if (sum_block((struct block_header *)block_buffer) == 0) | |
152 | { | |
153 | PRINTF("FOUND\n"); | |
154 | memcpy(&rdb, trdb, sizeof(struct rigid_disk_block)); | |
155 | return (struct rigid_disk_block *)&rdb; | |
156 | } | |
157 | } | |
158 | } | |
159 | } | |
160 | PRINTF("Done scanning, no RDB found\n"); | |
161 | return NULL; | |
162 | } | |
163 | ||
8bde7f77 | 164 | /* |
c7de829c WD |
165 | * Search for boot code |
166 | * Again, the first boot block must be located somewhere in the first 16 blocks, or rooted in the | |
167 | * Ridgid disk block | |
168 | */ | |
169 | ||
4101f687 | 170 | struct bootcode_block *get_bootcode(struct blk_desc *dev_desc) |
c7de829c WD |
171 | { |
172 | int i; | |
173 | int limit; | |
174 | char *s; | |
175 | ||
00caae6d | 176 | s = env_get("amiga_scanlimit"); |
c7de829c | 177 | if (s) |
0b1284eb | 178 | limit = dectoul(s, NULL); |
c7de829c WD |
179 | else |
180 | limit = AMIGA_BLOCK_LIMIT; | |
181 | ||
182 | PRINTF("Scanning for BOOT from 0 to %d\n", limit); | |
183 | ||
184 | for (i = 0; i < limit; i++) | |
185 | { | |
2a981dc2 | 186 | ulong res = blk_dread(dev_desc, i, 1, (ulong *)block_buffer); |
c7de829c WD |
187 | if (res == 1) |
188 | { | |
189 | struct bootcode_block *boot = (struct bootcode_block *)block_buffer; | |
190 | if (boot->id == AMIGA_ID_BOOT) | |
191 | { | |
192 | PRINTF("BOOT block at %d, checking checksum\n", i); | |
193 | if (sum_block((struct block_header *)block_buffer) == 0) | |
194 | { | |
195 | PRINTF("Found valid bootcode block\n"); | |
196 | memcpy(&bootcode, boot, sizeof(struct bootcode_block)); | |
197 | return &bootcode; | |
198 | } | |
199 | } | |
200 | } | |
201 | } | |
202 | ||
203 | PRINTF("No boot code found on disk\n"); | |
204 | return 0; | |
205 | } | |
206 | ||
8bde7f77 | 207 | /* |
c7de829c WD |
208 | * Test if the given partition has an Amiga partition table/Rigid |
209 | * Disk block | |
210 | */ | |
084bf4c2 | 211 | static int part_test_amiga(struct blk_desc *dev_desc) |
c7de829c WD |
212 | { |
213 | struct rigid_disk_block *rdb; | |
214 | struct bootcode_block *bootcode; | |
215 | ||
084bf4c2 | 216 | PRINTF("part_test_amiga: Testing for an Amiga RDB partition\n"); |
8bde7f77 | 217 | |
c7de829c WD |
218 | rdb = get_rdisk(dev_desc); |
219 | if (rdb) | |
220 | { | |
221 | bootcode = get_bootcode(dev_desc); | |
222 | if (bootcode) | |
084bf4c2 | 223 | PRINTF("part_test_amiga: bootable Amiga disk\n"); |
c7de829c | 224 | else |
084bf4c2 | 225 | PRINTF("part_test_amiga: non-bootable Amiga disk\n"); |
c7de829c WD |
226 | |
227 | return 0; | |
228 | } | |
8bde7f77 | 229 | else |
c7de829c | 230 | { |
084bf4c2 | 231 | PRINTF("part_test_amiga: no RDB found\n"); |
c7de829c WD |
232 | return -1; |
233 | } | |
234 | ||
235 | } | |
236 | ||
8bde7f77 | 237 | /* |
c7de829c WD |
238 | * Find partition number partnum on the given drive. |
239 | */ | |
4101f687 SG |
240 | static struct partition_block *find_partition(struct blk_desc *dev_desc, |
241 | int partnum) | |
c7de829c WD |
242 | { |
243 | struct rigid_disk_block *rdb; | |
244 | struct partition_block *p; | |
245 | u32 block; | |
246 | ||
247 | PRINTF("Trying to find partition block %d\n", partnum); | |
248 | rdb = get_rdisk(dev_desc); | |
8bde7f77 | 249 | if (!rdb) |
c7de829c WD |
250 | { |
251 | PRINTF("find_partition: no rdb found\n"); | |
252 | return NULL; | |
253 | } | |
8bde7f77 | 254 | |
c7de829c WD |
255 | PRINTF("find_partition: Scanning partition list\n"); |
256 | ||
257 | block = rdb->partition_list; | |
258 | PRINTF("find_partition: partition list at 0x%x\n", block); | |
259 | ||
260 | while (block != 0xFFFFFFFF) | |
261 | { | |
2a981dc2 | 262 | ulong res = blk_dread(dev_desc, block, 1, (ulong *)block_buffer); |
c7de829c WD |
263 | if (res == 1) |
264 | { | |
265 | p = (struct partition_block *)block_buffer; | |
266 | if (p->id == AMIGA_ID_PART) | |
267 | { | |
268 | PRINTF("PART block suspect at 0x%x, checking checksum\n",block); | |
269 | if (sum_block((struct block_header *)p) == 0) | |
270 | { | |
271 | if (partnum == 0) break; | |
8bde7f77 | 272 | else |
c7de829c WD |
273 | { |
274 | partnum--; | |
275 | block = p->next; | |
276 | } | |
277 | } | |
278 | } else block = 0xFFFFFFFF; | |
279 | } else block = 0xFFFFFFFF; | |
280 | } | |
281 | ||
8bde7f77 | 282 | if (block == 0xFFFFFFFF) |
c7de829c WD |
283 | { |
284 | PRINTF("PART block not found\n"); | |
285 | return NULL; | |
286 | } | |
287 | ||
288 | return (struct partition_block *)block_buffer; | |
289 | } | |
290 | ||
8bde7f77 | 291 | /* |
c7de829c WD |
292 | * Get info about a partition |
293 | */ | |
3e8bd469 | 294 | static int part_get_info_amiga(struct blk_desc *dev_desc, int part, |
0528979f | 295 | struct disk_partition *info) |
c7de829c WD |
296 | { |
297 | struct partition_block *p = find_partition(dev_desc, part-1); | |
298 | struct amiga_part_geometry *g; | |
299 | u32 disk_type; | |
300 | ||
301 | if (!p) return -1; | |
302 | ||
303 | g = (struct amiga_part_geometry *)&(p->environment); | |
304 | info->start = g->low_cyl * g->block_per_track * g->surfaces; | |
305 | info->size = (g->high_cyl - g->low_cyl + 1) * g->block_per_track * g->surfaces - 1; | |
306 | info->blksz = rdb.block_bytes; | |
95a6f9df | 307 | bcpl_strcpy((char *)info->name, p->drive_name); |
8bde7f77 | 308 | |
c7de829c WD |
309 | |
310 | disk_type = g->dos_type; | |
311 | ||
312 | info->type[0] = (disk_type & 0xFF000000)>>24; | |
313 | info->type[1] = (disk_type & 0x00FF0000)>>16; | |
314 | info->type[2] = (disk_type & 0x0000FF00)>>8; | |
315 | info->type[3] = '\\'; | |
316 | info->type[4] = (disk_type & 0x000000FF) + '0'; | |
317 | info->type[5] = 0; | |
8bde7f77 | 318 | |
c7de829c WD |
319 | return 0; |
320 | } | |
321 | ||
084bf4c2 | 322 | static void part_print_amiga(struct blk_desc *dev_desc) |
8bde7f77 | 323 | { |
c7de829c WD |
324 | struct rigid_disk_block *rdb; |
325 | struct bootcode_block *boot; | |
326 | struct partition_block *p; | |
327 | u32 block; | |
328 | int i = 1; | |
329 | ||
330 | rdb = get_rdisk(dev_desc); | |
8bde7f77 | 331 | if (!rdb) |
c7de829c | 332 | { |
084bf4c2 | 333 | PRINTF("part_print_amiga: no rdb found\n"); |
c7de829c WD |
334 | return; |
335 | } | |
8bde7f77 | 336 | |
084bf4c2 | 337 | PRINTF("part_print_amiga: Scanning partition list\n"); |
c7de829c WD |
338 | |
339 | block = rdb->partition_list; | |
084bf4c2 | 340 | PRINTF("part_print_amiga: partition list at 0x%x\n", block); |
c7de829c WD |
341 | |
342 | printf("Summary: DiskBlockSize: %d\n" | |
343 | " Cylinders : %d\n" | |
344 | " Sectors/Track: %d\n" | |
345 | " Heads : %d\n\n", | |
346 | rdb->block_bytes, rdb->cylinders, rdb->sectors, | |
347 | rdb->heads); | |
348 | ||
349 | printf(" First Num. \n" | |
350 | "Nr. Part. Name Block Block Type Boot Priority\n"); | |
351 | ||
352 | while (block != 0xFFFFFFFF) | |
353 | { | |
354 | ulong res; | |
355 | ||
356 | PRINTF("Trying to load block #0x%X\n", block); | |
8bde7f77 | 357 | |
2a981dc2 | 358 | res = blk_dread(dev_desc, block, 1, (ulong *)block_buffer); |
c7de829c WD |
359 | if (res == 1) |
360 | { | |
361 | p = (struct partition_block *)block_buffer; | |
362 | if (p->id == AMIGA_ID_PART) | |
363 | { | |
364 | PRINTF("PART block suspect at 0x%x, checking checksum\n",block); | |
365 | if (sum_block((struct block_header *)p) == 0) | |
366 | { | |
367 | printf("%-4d ", i); i++; | |
368 | print_part_info(p); | |
369 | block = p->next; | |
370 | } | |
371 | } else block = 0xFFFFFFFF; | |
372 | } else block = 0xFFFFFFFF; | |
373 | } | |
374 | ||
375 | boot = get_bootcode(dev_desc); | |
376 | if (boot) | |
377 | { | |
378 | printf("Disk is bootable\n"); | |
379 | } | |
380 | } | |
381 | ||
96e5b03c SG |
382 | U_BOOT_PART_TYPE(amiga) = { |
383 | .name = "AMIGA", | |
384 | .part_type = PART_TYPE_AMIGA, | |
87b8530f | 385 | .max_entries = AMIGA_ENTRY_NUMBERS, |
3e8bd469 | 386 | .get_info = part_get_info_amiga, |
084bf4c2 SG |
387 | .print = part_print_amiga, |
388 | .test = part_test_amiga, | |
96e5b03c SG |
389 | }; |
390 | ||
c7de829c | 391 | #endif |