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