cmd_attach.c, cmd_boot.c, cmd_loadcpm3.c: use cmd_error()

[z180-stamp.git] / avr / cmd_loadcpm3.c

/*
 * (C) Copyright 2015,2016,2018 Leo C. <erbl259-lmu@yahoo.de>
 *
 * SPDX-License-Identifier:	GPL-2.0
 */

/*
 * See CP/M 3 System Manual, Appendix D: CPM3.SYS File Format
 */

#include "cmd_loadcpm3.h"
#include <ctype.h>

#include "env.h"
#include "ff.h"
#include "eval_arg.h"
#include "con-utils.h"
#include "z80-if.h"
#include "debug.h"
#include "errnum.h"


#define RS		128		/* CP/M record size */

#define FSIZE_t DWORD

static FRESULT read_record(FIL *fp, uint8_t *buffer)
{
	unsigned int br;		/* bytes read */

	FRESULT res = f_read(fp, buffer, RS, &br);
	if (br != RS)
		return EEOF;
	return res;
}

/*
 *	Load Routine
 *
 *	Input:  addr = Page Address of load top
 *		 	len  = Length in pages of module to read
 *
 */
ERRNUM load(FIL *File, uint32_t addr, uint8_t len)
{
	uint8_t buffer[RS];

	len *= 2;		/* length in records of module */
	//debug("## load: addr: 0x%.4X, records: 0x%.4X, (%u)\n", addr, len, len);

	for (; len; len--) {
		addr -= RS;
		FRESULT res = read_record(File, buffer);
		if (res)
			return res;

		if (!(z80_bus_cmd(Request) & ZST_ACQUIRED))
			return EBUSTO;
		z80_write_block(buffer, addr, RS);
		z80_bus_cmd(Release);
		//debug("## written: 0x%.4X\n", addr);
	}

	return ESUCCESS;
}

#pragma GCC diagnostic ignored "-Wmaybe-uninitialized"

command_ret_t do_loadcpm3(cmd_tbl_t *cmdtp UNUSED, uint_fast8_t flag UNUSED, int argc, char * const argv[])
{
	uint16_t mem_top;
	uint8_t res_len;
	uint16_t bank_top;
	uint8_t bank_len;
	uint16_t osentry_addr = 0;
	uint32_t common_base = 0;
	uint32_t banked_base;
	char *fname;
	FIL File;
	char default_fname[strlen_P(PSTR(CONFIG_CPM3_SYSFILE)) + 1];
	uint8_t buffer[RS];
	FRESULT res;


	//common_base = getenv_ulong(PSTR(ENV_CPM3_COMMON_BASE), 16,
	//					CONFIG_CPM3_COMMON_BASE);
	banked_base = getenv_ulong(PSTR(ENV_CPM3_BANKED_BASE), 16,
						CONFIG_CPM3_BANKED_BASE);

	if (argc > 3)
		banked_base = eval_arg(argv[3], NULL);
	if (argc > 2)
		common_base = eval_arg(argv[2], NULL);

	fname = getenv_str(PSTR(ENV_CPM3_SYSFILE));
	if (fname == NULL || *fname == '\0') {
		strcpy_P(default_fname, PSTR(CONFIG_CPM3_SYSFILE));
		fname = default_fname;
	}
	if (argc > 1) {
		fname = argv[1];
	}

	res = f_open(&File, fname, FA_READ );
	if (res)
		goto out;

	printf_P(PSTR("Loading: '%s'...\n"), fname);

	/* read the load record */
	res = read_record(&File, buffer);
	if (res)
		goto out;

	mem_top = buffer[0] << 8;
	res_len = buffer[1];
	bank_top = buffer[2] << 8;
	bank_len = buffer[3];
	osentry_addr = buffer[4] + (buffer[5] << 8);

	/* read display info */
	res = read_record(&File, buffer);
	if (res)
		goto out;

	/* print the info */
	buffer[RS-1] = '$';
	uint8_t *p = memchr(buffer, '$', RS);
	*p = '\0';
	my_puts((char *)buffer);

	if (common_base == 0) {
		/* read common base
		 * http://www.seasip.info/Cpm/scb.html
		 */
		FSIZE_t common_base_ofs = ((res_len - 6) << 8)  + 2*RS + RS-7;
		FSIZE_t cur_pos = f_tell(&File);
		unsigned int br;					/* bytes read */
		if ((res = f_lseek(&File, common_base_ofs)) ||
				(res = f_read(&File, buffer, 2, &br)) ||
				(res = f_lseek(&File, cur_pos)))
			goto out;
		if (br != 2) {
			res = EEOF;
			goto out;
		}
		common_base = (uint16_t) buffer[0] + (buffer[1] << 8);
		setenv_hex(PSTR(ENV_CPM3_COMMON_BASE), common_base);
	}

	setenv_hex(PSTR(ENV_CPM3_SCB), mem_top - ((res_len - (6 - 1)) << 8) + common_base);

	/* Main System Load	*/

	/* Load Common Portion of System */
	if ((res = load(&File, common_base + mem_top, res_len)) != 0)
		goto out;

	/* Load Banked Portion of System */
	res = load(&File, banked_base + bank_top, bank_len);

out:
	f_close(&File);

	if (res)
		cmd_error(CMD_RET_FAILURE, res, PSTR("%s"), fname);

	if (res_len != 0) {
		if (osentry_addr + common_base > 0xffff) {
			z80_bus_cmd(Request);
			if (z80_read(osentry_addr + common_base) == 0xc3) {
				osentry_addr = z80_read(osentry_addr+common_base+1) +
						(z80_read(osentry_addr + common_base+2) << 8);
			}
			z80_bus_cmd(Release);
			if (banked_base + osentry_addr > 0xffff)
				osentry_addr = 0;
		}
		setenv_hex(PSTR(ENV_STARTADDRESS), osentry_addr);
	}
	printf_P(PSTR("Loaded: Resident: "));
	if (res_len != 0)
		printf_P(PSTR("%.5lX-%.5lX, "),
			(common_base + mem_top) - res_len*256,
			(common_base + mem_top) - 1);
	else
		printf_P(PSTR(" -  "));
	printf_P(PSTR("Banked: "));
	if (bank_len != 0)
		printf_P(PSTR("%.5lX-%.5lX\n"),
		(banked_base + bank_top) - bank_len*256,
		(banked_base + bank_top) - 1);
	else
		printf_P(PSTR(" -  \n"));

	return CMD_RET_SUCCESS;
}