uboot/disk/part_amiga.c
<<
>>
Prefs
   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
  23struct block_header
  24{
  25    u32 id;
  26    u32 summed_longs;
  27    s32 chk_sum;
  28};
  29
  30static unsigned char block_buffer[DEFAULT_SECTOR_SIZE];
  31static struct rigid_disk_block rdb = {0};
  32static struct bootcode_block bootcode = {0};
  33
  34/*
  35 * Copy a bcpl to a c string
  36 */
  37static 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 */
  53static 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 */
  75int 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 */
  94static 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 */
 109static 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 */
 129struct rigid_disk_block *get_rdisk(struct blk_desc *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 = blk_dread(dev_desc, i, 1, (ulong *)block_buffer);
 144        if (res == 1)
 145        {
 146            struct rigid_disk_block *trdb = (struct rigid_disk_block *)block_buffer;
 147            if (trdb->id == AMIGA_ID_RDISK)
 148            {
 149                PRINTF("Rigid disk block suspect at %d, checking checksum\n",i);
 150                if (sum_block((struct block_header *)block_buffer) == 0)
 151                {
 152                    PRINTF("FOUND\n");
 153                    memcpy(&rdb, trdb, sizeof(struct rigid_disk_block));
 154                    return (struct rigid_disk_block *)&rdb;
 155                }
 156            }
 157        }
 158    }
 159    PRINTF("Done scanning, no RDB found\n");
 160    return NULL;
 161}
 162
 163/*
 164 * Search for boot code
 165 * Again, the first boot block must be located somewhere in the first 16 blocks, or rooted in the
 166 * Ridgid disk block
 167 */
 168
 169struct bootcode_block *get_bootcode(struct blk_desc *dev_desc)
 170{
 171    int i;
 172    int limit;
 173    char *s;
 174
 175    s = getenv("amiga_scanlimit");
 176    if (s)
 177        limit = simple_strtoul(s, NULL, 10);
 178    else
 179        limit = AMIGA_BLOCK_LIMIT;
 180
 181    PRINTF("Scanning for BOOT from 0 to %d\n", limit);
 182
 183    for (i = 0; i < limit; i++)
 184    {
 185        ulong res = blk_dread(dev_desc, i, 1, (ulong *)block_buffer);
 186        if (res == 1)
 187        {
 188            struct bootcode_block *boot = (struct bootcode_block *)block_buffer;
 189            if (boot->id == AMIGA_ID_BOOT)
 190            {
 191                PRINTF("BOOT block at %d, checking checksum\n", i);
 192                if (sum_block((struct block_header *)block_buffer) == 0)
 193                {
 194                    PRINTF("Found valid bootcode block\n");
 195                    memcpy(&bootcode, boot, sizeof(struct bootcode_block));
 196                    return &bootcode;
 197                }
 198            }
 199        }
 200    }
 201
 202    PRINTF("No boot code found on disk\n");
 203    return 0;
 204}
 205
 206/*
 207 * Test if the given partition has an Amiga partition table/Rigid
 208 * Disk block
 209 */
 210static int part_test_amiga(struct blk_desc *dev_desc)
 211{
 212    struct rigid_disk_block *rdb;
 213    struct bootcode_block *bootcode;
 214
 215    PRINTF("part_test_amiga: Testing for an Amiga RDB partition\n");
 216
 217    rdb = get_rdisk(dev_desc);
 218    if (rdb)
 219    {
 220        bootcode = get_bootcode(dev_desc);
 221        if (bootcode)
 222            PRINTF("part_test_amiga: bootable Amiga disk\n");
 223        else
 224            PRINTF("part_test_amiga: non-bootable Amiga disk\n");
 225
 226        return 0;
 227    }
 228    else
 229    {
 230        PRINTF("part_test_amiga: no RDB found\n");
 231        return -1;
 232    }
 233
 234}
 235
 236/*
 237 * Find partition number partnum on the given drive.
 238 */
 239static struct partition_block *find_partition(struct blk_desc *dev_desc,
 240                                              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 = blk_dread(dev_desc, block, 1, (ulong *)block_buffer);
 262        if (res == 1)
 263        {
 264            p = (struct partition_block *)block_buffer;
 265            if (p->id == AMIGA_ID_PART)
 266            {
 267                PRINTF("PART block suspect at 0x%x, checking checksum\n",block);
 268                if (sum_block((struct block_header *)p) == 0)
 269                {
 270                    if (partnum == 0) break;
 271                    else
 272                    {
 273                        partnum--;
 274                        block = p->next;
 275                    }
 276                }
 277            } else block = 0xFFFFFFFF;
 278        } else block = 0xFFFFFFFF;
 279    }
 280
 281    if (block == 0xFFFFFFFF)
 282    {
 283        PRINTF("PART block not found\n");
 284        return NULL;
 285    }
 286
 287    return (struct partition_block *)block_buffer;
 288}
 289
 290/*
 291 * Get info about a partition
 292 */
 293static int part_get_info_amiga(struct blk_desc *dev_desc, int part,
 294                                    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((char *)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
 321static void part_print_amiga(struct blk_desc *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("part_print_amiga: no rdb found\n");
 333        return;
 334    }
 335
 336    PRINTF("part_print_amiga: Scanning partition list\n");
 337
 338    block = rdb->partition_list;
 339    PRINTF("part_print_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 = blk_dread(dev_desc, block, 1, (ulong *)block_buffer);
 358        if (res == 1)
 359        {
 360            p = (struct partition_block *)block_buffer;
 361            if (p->id == AMIGA_ID_PART)
 362            {
 363                PRINTF("PART block suspect at 0x%x, checking checksum\n",block);
 364                if (sum_block((struct block_header *)p) == 0)
 365                {
 366                    printf("%-4d ", i); i++;
 367                    print_part_info(p);
 368                    block = p->next;
 369                }
 370            } else block = 0xFFFFFFFF;
 371        } else block = 0xFFFFFFFF;
 372    }
 373
 374    boot = get_bootcode(dev_desc);
 375    if (boot)
 376    {
 377        printf("Disk is bootable\n");
 378    }
 379}
 380
 381U_BOOT_PART_TYPE(amiga) = {
 382        .name           = "AMIGA",
 383        .part_type      = PART_TYPE_AMIGA,
 384        .max_entries    = AMIGA_ENTRY_NUMBERS,
 385        .get_info       = part_get_info_amiga,
 386        .print          = part_print_amiga,
 387        .test           = part_test_amiga,
 388};
 389
 390#endif
 391