pce / src / drivers / block / block.c

/*****************************************************************************
 * pce                                                                       *
 *****************************************************************************/

/*****************************************************************************
 * File name:   src/drivers/block/block.c                                    *
 * Created:     2003-04-14 by Hampa Hug <[e-mail]>                     *
 * Copyright:   (C) 2003-2019 Hampa Hug <[e-mail]>                     *
 *****************************************************************************/

/*****************************************************************************
 * This program is free software. You can redistribute it and / or modify it *
 * under the terms of the GNU General Public License version 2 as  published *
 * by the Free Software Foundation.                                          *
 *                                                                           *
 * This program is distributed in the hope  that  it  will  be  useful,  but *
 * WITHOUT  ANY   WARRANTY,   without   even   the   implied   warranty   of *
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU  General *
 * Public License for more details.                                          *
 *****************************************************************************/


#include <drivers/block/block.h>

#include <drivers/block/blkchd.h>
#include <drivers/block/blkdosem.h>
#include <drivers/block/blkpbi.h>
#include <drivers/block/blkpce.h>
#include <drivers/block/blkpri.h>
#include <drivers/block/blkpsi.h>
#include <drivers/block/blkqed.h>
#include <drivers/block/blkraw.h>

#include <stdlib.h>
#include <string.h>
#include <limits.h>

#include <drivers/psi/psi-img.h>


uint16_t dsk_get_uint16_be (const void *buf, unsigned i)
{
	const unsigned char *tmp;
	uint16_t            v;

	tmp = (const unsigned char *) buf + i;

	v = tmp[0];
	v = (v << 8) | tmp[1];

	return (v);
}

uint32_t dsk_get_uint32_be (const void *buf, unsigned i)
{
	const unsigned char *tmp;
	uint32_t            v;

	tmp = (const unsigned char *) buf + i;

	v = tmp[0];
	v = (v << 8) | tmp[1];
	v = (v << 8) | tmp[2];
	v = (v << 8) | tmp[3];

	return (v);
}

uint64_t dsk_get_uint64_be (const void *buf, unsigned i)
{
	const unsigned char *tmp;
	uint64_t            v;

	tmp = (const unsigned char *) buf + i;

	v = tmp[0];
	v = (v << 8) | tmp[1];
	v = (v << 8) | tmp[2];
	v = (v << 8) | tmp[3];
	v = (v << 8) | tmp[4];
	v = (v << 8) | tmp[5];
	v = (v << 8) | tmp[6];
	v = (v << 8) | tmp[7];

	return (v);
}

void dsk_set_uint16_be (void *buf, unsigned i, uint16_t v)
{
	unsigned char *tmp;

	tmp = (unsigned char *) buf + i;

	tmp[0] = (v >> 8) & 0xff;
	tmp[1] = v & 0xff;
}

void dsk_set_uint32_be (void *buf, unsigned i, uint32_t v)
{
	unsigned char *tmp;

	tmp = (unsigned char *) buf + i;

	tmp[0] = (v >> 24) & 0xff;
	tmp[1] = (v >> 16) & 0xff;
	tmp[2] = (v >> 8) & 0xff;
	tmp[3] = v & 0xff;
}

void dsk_set_uint64_be (void *buf, unsigned i, uint64_t v)
{
	unsigned char *tmp;

	tmp = (unsigned char *) buf + i;

	tmp[0] = (v >> 56) & 0xff;
	tmp[1] = (v >> 48) & 0xff;
	tmp[2] = (v >> 40) & 0xff;
	tmp[3] = (v >> 32) & 0xff;
	tmp[4] = (v >> 24) & 0xff;
	tmp[5] = (v >> 16) & 0xff;
	tmp[6] = (v >> 8) & 0xff;
	tmp[7] = v & 0xff;
}

uint16_t dsk_get_uint16_le (const void *buf, unsigned i)
{
	const unsigned char *tmp;
	uint16_t            v;

	tmp = (const unsigned char *) buf + i;

	v = tmp[1];
	v = (v << 8) | tmp[0];

	return (v);
}

uint32_t dsk_get_uint32_le (const void *buf, unsigned i)
{
	const unsigned char *tmp;
	uint32_t            v;

	tmp = (const unsigned char *) buf + i;

	v = tmp[3];
	v = (v << 8) | tmp[2];
	v = (v << 8) | tmp[1];
	v = (v << 8) | tmp[0];

	return (v);
}

uint64_t dsk_get_uint64_le (const void *buf, unsigned i)
{
	const unsigned char *tmp;
	uint64_t            v;

	tmp = (const unsigned char *) buf + i;

	v = tmp[7];
	v = (v << 8) | tmp[6];
	v = (v << 8) | tmp[5];
	v = (v << 8) | tmp[4];
	v = (v << 8) | tmp[3];
	v = (v << 8) | tmp[2];
	v = (v << 8) | tmp[1];
	v = (v << 8) | tmp[0];

	return (v);
}

void dsk_set_uint16_le (void *buf, unsigned i, uint16_t v)
{
	unsigned char *tmp;

	tmp = (unsigned char *) buf + i;

	tmp[0] = v & 0xff;
	tmp[1] = (v >> 8) & 0xff;
}

void dsk_set_uint32_le (void *buf, unsigned i, uint32_t v)
{
	unsigned char *tmp;

	tmp = (unsigned char *) buf + i;

	tmp[0] = v & 0xff;
	tmp[1] = (v >> 8) & 0xff;
	tmp[2] = (v >> 16) & 0xff;
	tmp[3] = (v >> 24) & 0xff;
}

void dsk_set_uint64_le (void *buf, unsigned i, uint64_t v)
{
	unsigned char *tmp;

	tmp = (unsigned char *) buf + i;

	tmp[0] = v & 0xff;
	tmp[1] = (v >> 8) & 0xff;
	tmp[2] = (v >> 16) & 0xff;
	tmp[3] = (v >> 24) & 0xff;
	tmp[4] = (v >> 32) & 0xff;
	tmp[5] = (v >> 40) & 0xff;
	tmp[6] = (v >> 48) & 0xff;
	tmp[7] = (v >> 56) & 0xff;
}


int dsk_set_pos (FILE *fp, uint64_t ofs)
{
#ifdef HAVE_FSEEKO
	if (fseeko (fp, ofs, SEEK_SET)) {
		return (1);
	}
#else
	if (ofs > (uint64_t) LONG_MAX) {
		return (1);
	}

	if (fseek (fp, (long) ofs, SEEK_SET)) {
		return (1);
	}
#endif

	return (0);
}

int dsk_read (FILE *fp, void *buf, uint64_t ofs, uint64_t cnt)
{
	size_t r;

	if (dsk_set_pos (fp, ofs)) {
		return (1);
	}

	r = fread (buf, 1, cnt, fp);

	if (r < cnt) {
		memset ((unsigned char *) buf + r, 0x00, cnt - r);
	}

	return (0);
}

int dsk_write (FILE *fp, const void *buf, uint64_t ofs, uint64_t cnt)
{
	size_t r;

	if (dsk_set_pos (fp, ofs)) {
		return (1);
	}

	r = fwrite (buf, 1, cnt, fp);

	if (r != cnt) {
		return (1);
	}

	return (0);
}

int dsk_get_filesize (FILE *fp, uint64_t *cnt)
{
#ifdef HAVE_FSEEKO
	off_t val;

	if (fseeko (fp, 0, SEEK_END)) {
		return (1);
	}

	val = ftello (fp);
	if (val == (off_t) -1) {
		return (1);
	}
#else
	long val;

	if (fseek (fp, 0, SEEK_END)) {
		return (1);
	}

	val = ftell (fp);
	if (val == -1) {
		return (1);
	}
#endif

	*cnt = val;

	return (0);
}

int dsk_set_filesize (FILE *fp, uint64_t cnt)
{
	fflush (fp);

#ifdef HAVE_FTRUNCATE
	if (ftruncate (fileno (fp), cnt) == 0) {
		return (0);
	}
#endif

	return (1);
}


int dsk_adjust_chs (uint32_t *n, uint32_t *c, uint32_t *h, uint32_t *s)
{
	if (*n == 0) {
		*n = *c * *h * *s;
	}

	if (*n == 0) {
		return (1);
	}

	if (*c == 0) {
		if (*s == 0) {
			*s = 63;
		}

		if (*h == 0) {
			*h = 16;
		}

		*c = *n / (*h * *s);
	}

	if (*h == 0) {
		if (*s == 0) {
			*s = 63;
		}

		*h = *n / (*c * *s);
	}

	if (*s == 0) {
		*s = *n / (*c * *h);
	}

	return (0);
}

void dsk_init (disk_t *dsk, void *ext, uint32_t n, uint32_t c, uint32_t h, uint32_t s)
{
	dsk->type = PCE_DISK_NONE;

	dsk->del = NULL;
	dsk->read = NULL;
	dsk->write = NULL;
	dsk->get_msg = NULL;
	dsk->set_msg = NULL;

	dsk->drive = 0;

	dsk_adjust_chs (&n, &c, &h, &s);

	dsk->blocks = n;

	dsk->c = c;
	dsk->h = h;
	dsk->s = s;

	dsk->visible_c = c;
	dsk->visible_h = h;
	dsk->visible_s = s;

	dsk->readonly = 0;

	dsk->fname = NULL;

	dsk->ext = ext;
}

void dsk_del (disk_t *dsk)
{
	char *tmp;

	if (dsk != NULL) {
		tmp = dsk->fname;

		if (dsk->del != NULL) {
			dsk->del (dsk);
		}

		free (tmp);
	}
}


void dsk_set_drive (disk_t *dsk, unsigned d)
{
	dsk->drive = d;
}

unsigned dsk_get_type (const disk_t *dsk)
{
	return (dsk->type);
}

void dsk_set_type (disk_t *dsk, unsigned type)
{
	dsk->type = type;
}

int dsk_get_readonly (disk_t *dsk)
{
	return (dsk->readonly != 0);
}

void dsk_set_readonly (disk_t *dsk, int v)
{
	dsk->readonly = (v != 0);
}

void dsk_set_fname (disk_t *dsk, const char *fname)
{
	if (dsk->fname != NULL) {
		free (dsk->fname);
	}

	if (fname == NULL) {
		dsk->fname = NULL;
		return;
	}

	dsk->fname = malloc (strlen (fname) + 1);

	if (dsk->fname == NULL) {
		return;
	}

	strcpy (dsk->fname, fname);
}

const char *dsk_get_fname (const disk_t *dsk)
{
	return (dsk->fname);
}

int dsk_set_geometry (disk_t *dsk, uint32_t n, uint32_t c, uint32_t h, uint32_t s)
{
	if (dsk_adjust_chs (&n, &c, &h, &s)) {
		return (1);
	}

	dsk->blocks = n;

	dsk->c = c;
	dsk->h = h;
	dsk->s = s;

	return (0);
}

void dsk_set_visible_chs (disk_t *dsk, uint32_t c, uint32_t h, uint32_t s)
{
	dsk->visible_c = c;
	dsk->visible_h = h;
	dsk->visible_s = s;
}

unsigned dsk_get_drive (const disk_t *dsk)
{
	return (dsk->drive);
}

uint32_t dsk_get_block_cnt (const disk_t *dsk)
{
	return (dsk->blocks);
}


/*
 * Calculate heads and sectors per track from a partition table entry.
 */
static
int dsk_guess_geometry_pte (const unsigned char *p, unsigned *h, unsigned *s)
{
	unsigned      c1, h1, s1;
	unsigned      c2, h2, s2;
	unsigned long l1, l2;
	long long     v1, v2;

	if (p[0] & 0x7f) {
		return (1);
	}

	/* partition start */
	c1 = p[3] | ((p[2] & 0xc0) << 2);
	h1 = p[1];
	s1 = p[2] & 0x3f;
	l1 = dsk_get_uint32_le (p, 8);

	/* partition end */
	c2 = p[7] | ((p[6] & 0xc0) << 2);
	h2 = p[5];
	s2 = p[6] & 0x3f;
	l2 = dsk_get_uint32_le (p, 12);

	if ((s1 == 0) || (s2 == 0) || (l1 == 0) || (l2 == 0)) {
		return (1);
	}

	s1 -= 1;
	s2 -= 1;
	l2 = l1 + l2 - 1;

	if ((l1 <= s1) || (l2 <= s2)) {
		return (1);
	}

	v1 = (long long) c1 * (l2 - s2) - (long long) c2 * (l1 - s1);
	v2 = (long long) c1 * h2 - (long long) c2 * h1;

	if (v2 == 0) {
		return (1);
	}

	*s = v1 / v2;

	if ((*s == 0) || (*s > 255)) {
		return (1);
	}

	v1 = (long long) (l2 - s2) - (long long) h2 * *s;
	v2 = (long long) c2 * *s;

	if (v2 == 0) {
		return (0);
	}

	*h = v1 / v2;

	if ((*h == 0) || (*h > 256)) {
		return (1);
	}

	return (0);
}

static
int dsk_guess_geometry_mbr (disk_t *dsk)
{
	unsigned      i;
	unsigned char buf[512];
	unsigned      c, h, s, th, ts;

	if (dsk_read_lba (dsk, buf, 0, 1)) {
		return (1);
	}

	if ((buf[510] != 0x55) || (buf[511] != 0xaa)) {
		return (1);
	}

	h = 0;
	s = 0;

	th = 0;
	ts = 0;

	for (i = 0; i < 4; i++) {
		if (dsk_guess_geometry_pte (buf + 0x1be + 16 * i, &th, &ts)) {
			continue;
		}

		if ((h != 0) && (h != th)) {
			return (1);
		}

		if ((s != 0) && (s != ts)) {
			return (1);
		}

		h = th;
		s = ts;
	}

	if ((h == 0) || (s == 0)) {
		return (1);
	}

	c = dsk->blocks / (h * s);

	dsk_set_geometry (dsk, dsk->blocks, c, h, s);

	return (0);
}

static
int dsk_guess_geometry_sun (disk_t *dsk)
{
	unsigned       i;
	unsigned       c, h, s, chk;
	unsigned char  buf[512];

	if (dsk_read_lba (dsk, buf, 0, 1)) {
		return (1);
	}

	if (dsk_get_uint16_be (buf, 508) != 0xdabe) {
		return (1);
	}

	chk = 0;

	for (i = 0; i < 512; i += 2) {
		chk ^= buf[i] << 8;
		chk ^= buf[i + 1];
	}

	if (chk != 0) {
		return (1);
	}

	if (dsk_get_uint32_be (buf, 128) != 1) {
		return (1);
	}

	if (dsk_get_uint16_be (buf, 140) > 8) {
		return (1);
	}

	c = dsk_get_uint16_be (buf, 422);
	h = dsk_get_uint16_be (buf, 436);
	s = dsk_get_uint16_be (buf, 438);

	dsk_set_geometry (dsk, dsk->blocks, c, h, s);

	return (0);
}

static
int dsk_guess_geometry_dos (disk_t *dsk)
{
	unsigned char buf[512];
	uint32_t      c, h, s;

	if (dsk_read_lba (dsk, buf, 0, 1)) {
		return (1);
	}

	/* boot sector id */
	if ((buf[510] != 0x55) || (buf[511] != 0xaa)) {
		return (1);
	}

	/* sector size */
	if (dsk_get_uint16_le (buf, 11) != 512) {
		return (1);
	}

	h = dsk_get_uint16_le (buf, 26);
	s = dsk_get_uint16_le (buf, 24);

	if ((h == 0) || (h > 255)) {
		return (1);
	}

	if ((s == 0) || (s > 255)) {
		return (1);
	}

	c = dsk->blocks / (h * s);

	dsk_set_geometry (dsk, dsk->blocks, c, h, s);

	return (0);
}

static
int dsk_guess_geometry_size (disk_t *dsk)
{
	switch (dsk->blocks) {
	case 160 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 40, 1, 8);
		break;

	case 180 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 40, 1, 9);
		break;

	case 320 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 40, 2, 8);
		break;

	case 360 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 40, 2, 9);
		break;

	case 400 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 40, 2, 10);
		break;

	case 720 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 80, 2, 9);
		break;

	case 800 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 80, 2, 10);
		break;

	case 1200 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 80, 2, 15);
		break;

	case 1440 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 80, 2, 18);
		break;

	case 2880 * 2:
		dsk_set_geometry (dsk, dsk->blocks, 80, 2, 36);
		break;

	default:
		return (1);
	}

	return (0);
}

int dsk_guess_geometry (disk_t *dsk)
{
	if (dsk_guess_geometry_mbr (dsk) == 0) {
		return (0);
	}

	if (dsk_guess_geometry_dos (dsk) == 0) {
		return (0);
	}

	if (dsk_guess_geometry_sun (dsk) == 0) {
		return (0);
	}

	if (dsk_guess_geometry_size (dsk) == 0) {
		return (0);
	}

	dsk_set_geometry (dsk, dsk->blocks, dsk->c, dsk->h, dsk->s);

	return (0);
}


disk_t *dsk_auto_open (const char *fname, uint64_t ofs, int ro)
{
	unsigned type;

	if (dsk_pbi_probe (fname)) {
		return (dsk_pbi_open (fname, ro));
	}

	if (dsk_pce_probe (fname)) {
		return (dsk_pce_open (fname, ro));
	}

	if (dsk_qed_probe (fname)) {
		return (dsk_qed_open (fname, ro));
	}

	if (dsk_chd_probe (fname)) {
		return (dsk_chd_open (fname, ro));
	}

	if (dsk_dosemu_probe (fname)) {
		return (dsk_dosemu_open (fname, ro));
	}

	type = dsk_psi_probe (fname);

	if (type != PSI_FORMAT_NONE) {
		return (dsk_psi_open (fname, type, ro));
	}

	type = dsk_pri_probe (fname);

	if (type != PRI_FORMAT_NONE) {
		return (dsk_pri_open (fname, type, ro));
	}

	type = psi_guess_type (fname);

	if (type != PSI_FORMAT_NONE) {
		if (type != PSI_FORMAT_RAW) {
			return (dsk_psi_open (fname, type, ro));
		}
	}

	return (dsk_img_open (fname, ofs, ro));
}


int dsk_get_lba (disk_t *dsk, uint32_t c, uint32_t h, uint32_t s, uint32_t *v)
{
	if ((s < 1) || (s > dsk->s)) {
		return (1);
	}

	if ((h >= dsk->h) || (c >= dsk->c)) {
		return (1);
	}

	*v = ((c * dsk->h + h) * dsk->s + s - 1);

	return (0);
}

int dsk_read_lba (disk_t *dsk, void *buf, uint32_t i, uint32_t n)
{
	if (dsk->read != NULL) {
		return (dsk->read (dsk, buf, i, n));
	}

	return (1);
}

int dsk_read_lbaz (disk_t *dsk, void *buf, uint32_t i, uint32_t n)
{
	if ((i + n) <= dsk->blocks) {
		return (dsk_read_lba (dsk, buf, i, n));
	}

	memset (buf, 0, 512 * n);

	if (i < dsk->blocks) {
		return (dsk_read_lba (dsk, buf, i, dsk->blocks - i));
	}

	return (0);
}

int dsk_read_chs (disk_t *dsk, void *buf,
	uint32_t c, uint32_t h, uint32_t s, uint32_t n)
{
	uint32_t i;

	if (dsk_get_lba (dsk, c, h, s, &i)) {
		return (1);
	}

	return (dsk_read_lba (dsk, buf, i, n));
}

int dsk_write_lba (disk_t *dsk, const void *buf, uint32_t i, uint32_t n)
{
	if (dsk->write != NULL) {
		return (dsk->write (dsk, buf, i, n));
	}

	return (1);
}

int dsk_write_chs (disk_t *dsk, const void *buf,
	uint32_t c, uint32_t h, uint32_t s, uint32_t n)
{
	uint32_t i;

	if (dsk_get_lba (dsk, c, h, s, &i)) {
		return (1);
	}

	return (dsk_write_lba (dsk, buf, i, n));
}

int dsk_commit (disk_t *dsk)
{
	return (dsk_set_msg (dsk, "commit", NULL));
}

disk_t *dsk_create_cow (disk_t *dsk, const char *name, unsigned long minblk)
{
	disk_t     *cow;
	disk_pbi_t *pbi;

	if ((minblk == 0) && (dsk->type == PCE_DISK_PBI)) {
		pbi = dsk->ext;
		minblk = pbi->block_size;
	}

	cow = dsk_pbi_cow_create (dsk, name, dsk->blocks, dsk->c, dsk->h, dsk->s, minblk);

	return (cow);
}

disk_t *dsk_open_cow (disk_t *dsk, const char *name)
{
	disk_t *cow;

	if ((cow = dsk_pbi_cow_open (dsk, name)) != NULL) {
		return (cow);
	}

	if ((cow = dsk_qed_cow_open (dsk, name)) != NULL) {
		return (cow);
	}

	return (NULL);
}

int dsk_get_msg (disk_t *dsk, const char *msg, char *val, unsigned max)
{
	if (dsk->get_msg != NULL) {
		return (dsk->get_msg (dsk, msg, val, max));
	}

	return (1);
}

int dsk_set_msg (disk_t *dsk, const char *msg, const char *val)
{
	if (dsk->set_msg != NULL) {
		if (val == NULL) {
			val = "";
		}

		return (dsk->set_msg (dsk, msg, val));
	}

	return (1);
}


disks_t *dsks_new (void)
{
	disks_t *dsks;

	dsks = (disks_t *) malloc (sizeof (disks_t));
	if (dsks == NULL) {
		return (NULL);
	}

	dsks->cnt = 0;
	dsks->dsk = NULL;

	return (dsks);
}

void dsks_del (disks_t *dsks)
{
	unsigned i;

	if (dsks == NULL) {
		return;
	}

	for (i = 0; i < dsks->cnt; i++) {
		dsk_del (dsks->dsk[i]);
	}

	free (dsks->dsk);
	free (dsks);
}

int dsks_add_disk (disks_t *dsks, disk_t *dsk)
{
	unsigned i, n;
	disk_t   **tmp;

	for (i = 0; i < dsks->cnt; i++) {
		if (dsks->dsk[i]->drive == dsk->drive) {
			return (1);
		}
	}

	n = dsks->cnt + 1;
	tmp = (disk_t **) realloc (dsks->dsk, n * sizeof (disk_t *));
	if (tmp == NULL) {
		return (1);
	}

	tmp[dsks->cnt] = dsk;

	dsks->cnt = n;
	dsks->dsk = tmp;

	return (0);
}

int dsks_rmv_disk (disks_t *dsks, disk_t *dsk)
{
	int      r;
	unsigned i, j;

	r = 0;
	j = 0;
	for (i = 0; i < dsks->cnt; i++) {
		if (dsks->dsk[i] != dsk) {
			dsks->dsk[j] = dsks->dsk[i];
			j += 1;
		}
		else {
			r = 1;
		}
	}

	dsks->cnt = j;

	return (r);
}

disk_t *dsks_get_disk (disks_t *dsks, unsigned drive)
{
	unsigned i;

	for (i = 0; i < dsks->cnt; i++) {
		if (dsks->dsk[i]->drive == drive) {
			return (dsks->dsk[i]);
		}
	}

	return (NULL);
}

int dsks_commit (disks_t *dsks)
{
	unsigned i;
	int      r;

	r = 0;

	for (i = 0; i < dsks->cnt; i++) {
		if (dsks->dsk[i]->set_msg != NULL) {
			if (dsk_set_msg (dsks->dsk[i], "commit", NULL)) {
				r = 1;
			}
		}
	}

	return (r);
}

int dsks_get_msg (disks_t *dsks, unsigned drv, const char *msg, char *val, unsigned max)
{
	disk_t *dsk;

	dsk = dsks_get_disk (dsks, drv);
	if (dsk == NULL) {
		return (1);
	}

	return (dsk_get_msg (dsk, msg, val, max));
}

int dsks_set_msg (disks_t *dsks, unsigned drv, const char *msg, const char *val)
{
	disk_t *dsk;

	dsk = dsks_get_disk (dsks, drv);
	if (dsk == NULL) {
		return (1);
	}

	if (val == NULL) {
		val = "";
	}

	return (dsk_set_msg (dsk, msg, val));
}