[people/ms/u-boot.git] / disk / part_amiga.c

/*
 * (C) Copyright 2001
 * Hans-Joerg Frieden, Hyperion Entertainment
 * Hans-JoergF@hyperion-entertainment.com
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */
#include <common.h>
#include <command.h>
#include <ide.h>
#include "part_amiga.h"

#ifdef HAVE_BLOCK_DEVICE

#undef AMIGA_DEBUG

#ifdef AMIGA_DEBUG
#define PRINTF(fmt, args...) printf(fmt ,##args)
#else
#define PRINTF(fmt, args...)
#endif

struct block_header
{
    u32 id;
    u32 summed_longs;
    s32 chk_sum;
};

static unsigned char block_buffer[DEFAULT_SECTOR_SIZE];
static struct rigid_disk_block rdb = {0};
static struct bootcode_block bootcode = {0};

/*
 * Copy a bcpl to a c string
 */
static void bcpl_strcpy(char *to, char *from)
{
    int len = *from++;

    while (len)
    {
	*to++ = *from++;
	len--;
    }
    *to = 0;
}

/*
 * Print a BCPL String. BCPL strings start with a byte with the length
 * of the string, and don't contain a terminating nul character
 */
static void bstr_print(char *string)
{
    int len = *string++;
    char buffer[256];
    int i;

    i = 0;
    while (len)
    {
	buffer[i++] = *string++;
	len--;
    }

    buffer[i] = 0;
    printf("%-10s", buffer);
}

/*
 * Sum a block. The checksum of a block must end up at zero
 * to be valid. The chk_sum field is selected so that adding
 * it yields zero.
 */
int sum_block(struct block_header *header)
{
    s32 *block = (s32 *)header;
    u32 i;
    s32 sum = 0;

    for (i = 0; i < header->summed_longs; i++)
	sum += *block++;

    return (sum != 0);
}

/*
 * Print an AmigaOS disk type. Disk types are a four-byte identifier
 * describing the file system. They are usually written as a three-letter
 * word followed by a backslash and a version number. For example,
 * DOS\0 would be the original file system. SFS\0 would be SmartFileSystem.
 * DOS\1 is FFS.
 */
static void print_disk_type(u32 disk_type)
{
    char buffer[6];
    buffer[0] = (disk_type & 0xFF000000)>>24;
    buffer[1] = (disk_type & 0x00FF0000)>>16;
    buffer[2] = (disk_type & 0x0000FF00)>>8;
    buffer[3] = '\\';
    buffer[4] = (disk_type & 0x000000FF) + '0';
    buffer[5] = 0;
    printf("%s", buffer);
}

/*
 * Print the info contained within the given partition block
 */
static void print_part_info(struct partition_block *p)
{
    struct amiga_part_geometry *g;

    g = (struct amiga_part_geometry *)&(p->environment);

    bstr_print(p->drive_name);
    printf("%6d\t%6d\t",
	   g->low_cyl * g->block_per_track * g->surfaces ,
	   (g->high_cyl - g->low_cyl + 1) * g->block_per_track * g->surfaces - 1);
    print_disk_type(g->dos_type);
    printf("\t%5d\n", g->boot_priority);
}

/*
 * Search for the Rigid Disk Block. The rigid disk block is required
 * to be within the first 16 blocks of a drive, needs to have
 * the ID AMIGA_ID_RDISK ('RDSK') and needs to have a valid
 * sum-to-zero checksum
 */
struct rigid_disk_block *get_rdisk(block_dev_desc_t *dev_desc)
{
    int i;
    int limit;
    char *s;

    s = getenv("amiga_scanlimit");
    if (s)
	limit = simple_strtoul(s, NULL, 10);
    else
	limit = AMIGA_BLOCK_LIMIT;

    for (i=0; i<limit; i++)
    {
	ulong res = dev_desc->block_read(dev_desc->dev, i, 1,
					 (ulong *)block_buffer);
	if (res == 1)
	{
	    struct rigid_disk_block *trdb = (struct rigid_disk_block *)block_buffer;
	    if (trdb->id == AMIGA_ID_RDISK)
	    {
		PRINTF("Rigid disk block suspect at %d, checking checksum\n",i);
		if (sum_block((struct block_header *)block_buffer) == 0)
		{
		    PRINTF("FOUND\n");
		    memcpy(&rdb, trdb, sizeof(struct rigid_disk_block));
		    return (struct rigid_disk_block *)&rdb;
		}
	    }
	}
    }
    PRINTF("Done scanning, no RDB found\n");
    return NULL;
}

/*
 * Search for boot code
 * Again, the first boot block must be located somewhere in the first 16 blocks, or rooted in the
 * Ridgid disk block
 */

struct bootcode_block *get_bootcode(block_dev_desc_t *dev_desc)
{
    int i;
    int limit;
    char *s;

    s = getenv("amiga_scanlimit");
    if (s)
	limit = simple_strtoul(s, NULL, 10);
    else
	limit = AMIGA_BLOCK_LIMIT;

    PRINTF("Scanning for BOOT from 0 to %d\n", limit);

    for (i = 0; i < limit; i++)
    {
	ulong res = dev_desc->block_read(dev_desc->dev, i, 1, (ulong *)block_buffer);
	if (res == 1)
	{
	    struct bootcode_block *boot = (struct bootcode_block *)block_buffer;
	    if (boot->id == AMIGA_ID_BOOT)
	    {
		PRINTF("BOOT block at %d, checking checksum\n", i);
		if (sum_block((struct block_header *)block_buffer) == 0)
		{
		    PRINTF("Found valid bootcode block\n");
		    memcpy(&bootcode, boot, sizeof(struct bootcode_block));
		    return &bootcode;
		}
	    }
	}
    }

    PRINTF("No boot code found on disk\n");
    return 0;
}

/*
 * Test if the given partition has an Amiga partition table/Rigid
 * Disk block
 */
int test_part_amiga(block_dev_desc_t *dev_desc)
{
    struct rigid_disk_block *rdb;
    struct bootcode_block *bootcode;

    PRINTF("test_part_amiga: Testing for an Amiga RDB partition\n");

    rdb = get_rdisk(dev_desc);
    if (rdb)
    {
	bootcode = get_bootcode(dev_desc);
	if (bootcode)
	    PRINTF("test_part_amiga: bootable Amiga disk\n");
	else
	    PRINTF("test_part_amiga: non-bootable Amiga disk\n");

	return 0;
    }
    else
    {
	PRINTF("test_part_amiga: no RDB found\n");
	return -1;
    }

}

/*
 * Find partition number partnum on the given drive.
 */
static struct partition_block *find_partition(block_dev_desc_t *dev_desc, int partnum)
{
    struct rigid_disk_block *rdb;
    struct partition_block *p;
    u32 block;

    PRINTF("Trying to find partition block %d\n", partnum);
    rdb = get_rdisk(dev_desc);
    if (!rdb)
    {
	PRINTF("find_partition: no rdb found\n");
	return NULL;
    }

    PRINTF("find_partition: Scanning partition list\n");

    block = rdb->partition_list;
    PRINTF("find_partition: partition list at 0x%x\n", block);

    while (block != 0xFFFFFFFF)
    {
	ulong res = dev_desc->block_read(dev_desc->dev, block, 1,
					 (ulong *)block_buffer);
	if (res == 1)
	{
	    p = (struct partition_block *)block_buffer;
	    if (p->id == AMIGA_ID_PART)
	    {
		PRINTF("PART block suspect at 0x%x, checking checksum\n",block);
		if (sum_block((struct block_header *)p) == 0)
		{
		    if (partnum == 0) break;
		    else
		    {
			partnum--;
			block = p->next;
		    }
		}
	    } else block = 0xFFFFFFFF;
	} else block = 0xFFFFFFFF;
    }

    if (block == 0xFFFFFFFF)
    {
	PRINTF("PART block not found\n");
	return NULL;
    }

    return (struct partition_block *)block_buffer;
}

/*
 * Get info about a partition
 */
int get_partition_info_amiga (block_dev_desc_t *dev_desc, int part, disk_partition_t *info)
{
    struct partition_block *p = find_partition(dev_desc, part-1);
    struct amiga_part_geometry *g;
    u32 disk_type;

    if (!p) return -1;

    g = (struct amiga_part_geometry *)&(p->environment);
    info->start = g->low_cyl  * g->block_per_track * g->surfaces;
    info->size  = (g->high_cyl - g->low_cyl + 1) * g->block_per_track * g->surfaces - 1;
    info->blksz = rdb.block_bytes;
    bcpl_strcpy(info->name, p->drive_name);


    disk_type = g->dos_type;

    info->type[0] = (disk_type & 0xFF000000)>>24;
    info->type[1] = (disk_type & 0x00FF0000)>>16;
    info->type[2] = (disk_type & 0x0000FF00)>>8;
    info->type[3] = '\\';
    info->type[4] = (disk_type & 0x000000FF) + '0';
    info->type[5] = 0;

    return 0;
}

void print_part_amiga (block_dev_desc_t *dev_desc)
{
    struct rigid_disk_block *rdb;
    struct bootcode_block *boot;
    struct partition_block *p;
    u32 block;
    int i = 1;

    rdb = get_rdisk(dev_desc);
    if (!rdb)
    {
	PRINTF("print_part_amiga: no rdb found\n");
	return;
    }

    PRINTF("print_part_amiga: Scanning partition list\n");

    block = rdb->partition_list;
    PRINTF("print_part_amiga: partition list at 0x%x\n", block);

    printf("Summary:  DiskBlockSize: %d\n"
	   "          Cylinders    : %d\n"
	   "          Sectors/Track: %d\n"
	   "          Heads        : %d\n\n",
	   rdb->block_bytes, rdb->cylinders, rdb->sectors,
	   rdb->heads);

    printf("                 First   Num. \n"
	   "Nr.  Part. Name  Block   Block  Type        Boot Priority\n");

    while (block != 0xFFFFFFFF)
    {
	ulong res;

	PRINTF("Trying to load block #0x%X\n", block);

	res = dev_desc->block_read(dev_desc->dev, block, 1,
				   (ulong *)block_buffer);
	if (res == 1)
	{
	    p = (struct partition_block *)block_buffer;
	    if (p->id == AMIGA_ID_PART)
	    {
		PRINTF("PART block suspect at 0x%x, checking checksum\n",block);
		if (sum_block((struct block_header *)p) == 0)
		{
		    printf("%-4d ", i); i++;
		    print_part_info(p);
		    block = p->next;
		}
	    } else block = 0xFFFFFFFF;
	} else block = 0xFFFFFFFF;
    }

    boot = get_bootcode(dev_desc);
    if (boot)
    {
	printf("Disk is bootable\n");
    }
}

#endif
Commit	Line	Data
c7de829c WD	1	/*
c7de829c WD	2	* (C) Copyright 2001
8bde7f77	3	* Hans-Joerg Frieden, Hyperion Entertainment
c7de829c WD	4	* Hans-JoergF@hyperion-entertainment.com
c7de829c WD	5	*
1a459660	6	* SPDX-License-Identifier: GPL-2.0+
c7de829c WD	7	*/
	8	#include <common.h>
	9	#include <command.h>
	10	#include <ide.h>
c7de829c WD	11	#include "part_amiga.h"
c7de829c WD	12
2c1af9dc	13	#ifdef HAVE_BLOCK_DEVICE
c7de829c WD	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;
8bde7f77	58
c7de829c WD	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++;
8bde7f77	83
c7de829c WD	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;
8bde7f77	112
c7de829c WD	113	g = (struct amiga_part_geometry *)&(p->environment);
	114
	115	bstr_print(p->drive_name);
8bde7f77 WD	116	printf("%6d\t%6d\t",
8bde7f77 WD	117	g->low_cyl * g->block_per_track * g->surfaces ,
c7de829c WD	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)
75eb82ec	137	limit = simple_strtoul(s, NULL, 10);
c7de829c WD	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
8bde7f77	164	/*
c7de829c WD	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)
75eb82ec	178	limit = simple_strtoul(s, NULL, 10);
c7de829c WD	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
8bde7f77	207	/*
c7de829c WD	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");
8bde7f77	217
c7de829c WD	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	}
8bde7f77	229	else
c7de829c WD	230	{
	231	PRINTF("test_part_amiga: no RDB found\n");
	232	return -1;
	233	}
	234
	235	}
	236
8bde7f77	237	/*
c7de829c WD	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);
8bde7f77	248	if (!rdb)
c7de829c WD	249	{
	250	PRINTF("find_partition: no rdb found\n");
	251	return NULL;
	252	}
8bde7f77	253
c7de829c WD	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;
8bde7f77	272	else
c7de829c WD	273	{
	274	partnum--;
	275	block = p->next;
	276	}
	277	}
	278	} else block = 0xFFFFFFFF;
	279	} else block = 0xFFFFFFFF;
	280	}
	281
8bde7f77	282	if (block == 0xFFFFFFFF)
c7de829c WD	283	{
	284	PRINTF("PART block not found\n");
	285	return NULL;
	286	}
	287
	288	return (struct partition_block *)block_buffer;
	289	}
	290
8bde7f77	291	/*
c7de829c WD	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);
8bde7f77	307
c7de829c WD	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;
8bde7f77	317
c7de829c WD	318	return 0;
	319	}
	320
	321	void print_part_amiga (block_dev_desc_t *dev_desc)
8bde7f77	322	{
c7de829c WD	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);
8bde7f77	330	if (!rdb)
c7de829c WD	331	{
	332	PRINTF("print_part_amiga: no rdb found\n");
	333	return;
	334	}
8bde7f77	335
c7de829c WD	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);
8bde7f77	356
c7de829c WD	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