disk/part_amiga.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2001
   4  * Hans-Joerg Frieden, Hyperion Entertainment
   5  * Hans-JoergF@hyperion-entertainment.com
   6  */
   7 #include <common.h>
   8 #include <command.h>
   9 #include <env.h>
  10 #include <ide.h>
  11 #include "part_amiga.h"
  12 #include <part.h>
  13
  14 #ifdef CONFIG_HAVE_BLOCK_DEVICE
  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;
  59
  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++;
  84
  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;
 113
 114     g = (struct amiga_part_geometry *)&(p->environment);
 115
 116     bstr_print(p->drive_name);
 117     printf("%6d\t%6d\t",
 118            g->low_cyl * g->block_per_track * g->surfaces ,
 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  */
 130 struct rigid_disk_block *get_rdisk(struct blk_desc *dev_desc)
 131 {
 132     int i;
 133     int limit;
 134     char *s;
 135
 136     s = env_get("amiga_scanlimit");
 137     if (s)
 138         limit = simple_strtoul(s, NULL, 10);
 139     else
 140         limit = AMIGA_BLOCK_LIMIT;
 141
 142     for (i=0; i<limit; i++)
 143     {
 144         ulong res = blk_dread(dev_desc, i, 1, (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(struct blk_desc *dev_desc)
 171 {
 172     int i;
 173     int limit;
 174     char *s;
 175
 176     s = env_get("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 = blk_dread(dev_desc, 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 static int part_test_amiga(struct blk_desc *dev_desc)
 212 {
 213     struct rigid_disk_block *rdb;
 214     struct bootcode_block *bootcode;
 215
 216     PRINTF("part_test_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("part_test_amiga: bootable Amiga disk\n");
 224         else
 225             PRINTF("part_test_amiga: non-bootable Amiga disk\n");
 226
 227         return 0;
 228     }
 229     else
 230     {
 231         PRINTF("part_test_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(struct blk_desc *dev_desc,
 241                                               int partnum)
 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);
 249     if (!rdb)
 250     {
 251         PRINTF("find_partition: no rdb found\n");
 252         return NULL;
 253     }
 254
 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     {
 262         ulong res = blk_dread(dev_desc, block, 1, (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 static int part_get_info_amiga(struct blk_desc *dev_desc, int part,
 295                                     struct disk_partition *info)
 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;
 307     bcpl_strcpy((char *)info->name, p->drive_name);
 308
 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;
 318
 319     return 0;
 320 }
 321
 322 static void part_print_amiga(struct blk_desc *dev_desc)
 323 {
 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);
 331     if (!rdb)
 332     {
 333         PRINTF("part_print_amiga: no rdb found\n");
 334         return;
 335     }
 336
 337     PRINTF("part_print_amiga: Scanning partition list\n");
 338
 339     block = rdb->partition_list;
 340     PRINTF("part_print_amiga: partition list at 0x%x\n", block);
 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);
 357
 358         res = blk_dread(dev_desc, block, 1, (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 U_BOOT_PART_TYPE(amiga) = {
 383         .name           = "AMIGA",
 384         .part_type      = PART_TYPE_AMIGA,
 385         .max_entries    = AMIGA_ENTRY_NUMBERS,
 386         .get_info       = part_get_info_amiga,
 387         .print          = part_print_amiga,
 388         .test           = part_test_amiga,
 389 };
 390
 391 #endif