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