nand_util.c: Use '%zd' for length in nand_unlock debug print
[platform/kernel/u-boot.git] / disk / part_amiga.c
1 /*
2  * (C) Copyright 2001
3  * Hans-Joerg Frieden, Hyperion Entertainment
4  * Hans-JoergF@hyperion-entertainment.com
5  *
6  * SPDX-License-Identifier:     GPL-2.0+
7  */
8 #include <common.h>
9 #include <command.h>
10 #include <ide.h>
11 #include "part_amiga.h"
12
13 #ifdef HAVE_BLOCK_DEVICE
14
15 #undef AMIGA_DEBUG
16
17 #ifdef AMIGA_DEBUG
18 #define PRINTF(fmt, args...) printf(fmt ,##args)
19 #else
20 #define PRINTF(fmt, args...)
21 #endif
22
23 struct block_header
24 {
25     u32 id;
26     u32 summed_longs;
27     s32 chk_sum;
28 };
29
30 static unsigned char block_buffer[DEFAULT_SECTOR_SIZE];
31 static struct rigid_disk_block rdb = {0};
32 static struct bootcode_block bootcode = {0};
33
34 /*
35  * Copy a bcpl to a c string
36  */
37 static void bcpl_strcpy(char *to, char *from)
38 {
39     int len = *from++;
40
41     while (len)
42     {
43         *to++ = *from++;
44         len--;
45     }
46     *to = 0;
47 }
48
49 /*
50  * Print a BCPL String. BCPL strings start with a byte with the length
51  * of the string, and don't contain a terminating nul character
52  */
53 static void bstr_print(char *string)
54 {
55     int len = *string++;
56     char buffer[256];
57     int i;
58
59     i = 0;
60     while (len)
61     {
62         buffer[i++] = *string++;
63         len--;
64     }
65
66     buffer[i] = 0;
67     printf("%-10s", buffer);
68 }
69
70 /*
71  * Sum a block. The checksum of a block must end up at zero
72  * to be valid. The chk_sum field is selected so that adding
73  * it yields zero.
74  */
75 int sum_block(struct block_header *header)
76 {
77     s32 *block = (s32 *)header;
78     u32 i;
79     s32 sum = 0;
80
81     for (i = 0; i < header->summed_longs; i++)
82         sum += *block++;
83
84     return (sum != 0);
85 }
86
87 /*
88  * Print an AmigaOS disk type. Disk types are a four-byte identifier
89  * describing the file system. They are usually written as a three-letter
90  * word followed by a backslash and a version number. For example,
91  * DOS\0 would be the original file system. SFS\0 would be SmartFileSystem.
92  * DOS\1 is FFS.
93  */
94 static void print_disk_type(u32 disk_type)
95 {
96     char buffer[6];
97     buffer[0] = (disk_type & 0xFF000000)>>24;
98     buffer[1] = (disk_type & 0x00FF0000)>>16;
99     buffer[2] = (disk_type & 0x0000FF00)>>8;
100     buffer[3] = '\\';
101     buffer[4] = (disk_type & 0x000000FF) + '0';
102     buffer[5] = 0;
103     printf("%s", buffer);
104 }
105
106 /*
107  * Print the info contained within the given partition block
108  */
109 static void print_part_info(struct partition_block *p)
110 {
111     struct amiga_part_geometry *g;
112
113     g = (struct amiga_part_geometry *)&(p->environment);
114
115     bstr_print(p->drive_name);
116     printf("%6d\t%6d\t",
117            g->low_cyl * g->block_per_track * g->surfaces ,
118            (g->high_cyl - g->low_cyl + 1) * g->block_per_track * g->surfaces - 1);
119     print_disk_type(g->dos_type);
120     printf("\t%5d\n", g->boot_priority);
121 }
122
123 /*
124  * Search for the Rigid Disk Block. The rigid disk block is required
125  * to be within the first 16 blocks of a drive, needs to have
126  * the ID AMIGA_ID_RDISK ('RDSK') and needs to have a valid
127  * sum-to-zero checksum
128  */
129 struct rigid_disk_block *get_rdisk(block_dev_desc_t *dev_desc)
130 {
131     int i;
132     int limit;
133     char *s;
134
135     s = getenv("amiga_scanlimit");
136     if (s)
137         limit = simple_strtoul(s, NULL, 10);
138     else
139         limit = AMIGA_BLOCK_LIMIT;
140
141     for (i=0; i<limit; i++)
142     {
143         ulong res = dev_desc->block_read(dev_desc->dev, i, 1,
144                                          (ulong *)block_buffer);
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
164 /*
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
170 struct bootcode_block *get_bootcode(block_dev_desc_t *dev_desc)
171 {
172     int i;
173     int limit;
174     char *s;
175
176     s = getenv("amiga_scanlimit");
177     if (s)
178         limit = simple_strtoul(s, NULL, 10);
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     {
186         ulong res = dev_desc->block_read(dev_desc->dev, i, 1, (ulong *)block_buffer);
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
207 /*
208  * Test if the given partition has an Amiga partition table/Rigid
209  * Disk block
210  */
211 int test_part_amiga(block_dev_desc_t *dev_desc)
212 {
213     struct rigid_disk_block *rdb;
214     struct bootcode_block *bootcode;
215
216     PRINTF("test_part_amiga: Testing for an Amiga RDB partition\n");
217
218     rdb = get_rdisk(dev_desc);
219     if (rdb)
220     {
221         bootcode = get_bootcode(dev_desc);
222         if (bootcode)
223             PRINTF("test_part_amiga: bootable Amiga disk\n");
224         else
225             PRINTF("test_part_amiga: non-bootable Amiga disk\n");
226
227         return 0;
228     }
229     else
230     {
231         PRINTF("test_part_amiga: no RDB found\n");
232         return -1;
233     }
234
235 }
236
237 /*
238  * Find partition number partnum on the given drive.
239  */
240 static struct partition_block *find_partition(block_dev_desc_t *dev_desc, int partnum)
241 {
242     struct rigid_disk_block *rdb;
243     struct partition_block *p;
244     u32 block;
245
246     PRINTF("Trying to find partition block %d\n", partnum);
247     rdb = get_rdisk(dev_desc);
248     if (!rdb)
249     {
250         PRINTF("find_partition: no rdb found\n");
251         return NULL;
252     }
253
254     PRINTF("find_partition: Scanning partition list\n");
255
256     block = rdb->partition_list;
257     PRINTF("find_partition: partition list at 0x%x\n", block);
258
259     while (block != 0xFFFFFFFF)
260     {
261         ulong res = dev_desc->block_read(dev_desc->dev, block, 1,
262                                          (ulong *)block_buffer);
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;
272                     else
273                     {
274                         partnum--;
275                         block = p->next;
276                     }
277                 }
278             } else block = 0xFFFFFFFF;
279         } else block = 0xFFFFFFFF;
280     }
281
282     if (block == 0xFFFFFFFF)
283     {
284         PRINTF("PART block not found\n");
285         return NULL;
286     }
287
288     return (struct partition_block *)block_buffer;
289 }
290
291 /*
292  * Get info about a partition
293  */
294 int get_partition_info_amiga (block_dev_desc_t *dev_desc, int part, disk_partition_t *info)
295 {
296     struct partition_block *p = find_partition(dev_desc, part-1);
297     struct amiga_part_geometry *g;
298     u32 disk_type;
299
300     if (!p) return -1;
301
302     g = (struct amiga_part_geometry *)&(p->environment);
303     info->start = g->low_cyl  * g->block_per_track * g->surfaces;
304     info->size  = (g->high_cyl - g->low_cyl + 1) * g->block_per_track * g->surfaces - 1;
305     info->blksz = rdb.block_bytes;
306     bcpl_strcpy(info->name, p->drive_name);
307
308
309     disk_type = g->dos_type;
310
311     info->type[0] = (disk_type & 0xFF000000)>>24;
312     info->type[1] = (disk_type & 0x00FF0000)>>16;
313     info->type[2] = (disk_type & 0x0000FF00)>>8;
314     info->type[3] = '\\';
315     info->type[4] = (disk_type & 0x000000FF) + '0';
316     info->type[5] = 0;
317
318     return 0;
319 }
320
321 void print_part_amiga (block_dev_desc_t *dev_desc)
322 {
323     struct rigid_disk_block *rdb;
324     struct bootcode_block *boot;
325     struct partition_block *p;
326     u32 block;
327     int i = 1;
328
329     rdb = get_rdisk(dev_desc);
330     if (!rdb)
331     {
332         PRINTF("print_part_amiga: no rdb found\n");
333         return;
334     }
335
336     PRINTF("print_part_amiga: Scanning partition list\n");
337
338     block = rdb->partition_list;
339     PRINTF("print_part_amiga: partition list at 0x%x\n", block);
340
341     printf("Summary:  DiskBlockSize: %d\n"
342            "          Cylinders    : %d\n"
343            "          Sectors/Track: %d\n"
344            "          Heads        : %d\n\n",
345            rdb->block_bytes, rdb->cylinders, rdb->sectors,
346            rdb->heads);
347
348     printf("                 First   Num. \n"
349            "Nr.  Part. Name  Block   Block  Type        Boot Priority\n");
350
351     while (block != 0xFFFFFFFF)
352     {
353         ulong res;
354
355         PRINTF("Trying to load block #0x%X\n", block);
356
357         res = dev_desc->block_read(dev_desc->dev, block, 1,
358                                    (ulong *)block_buffer);
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
382 #endif