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

/*
 * (C) Copyright 2014-2016 Leo C. <erbl259-lmu@yahoo.de>
 *
 * (C) Copyright 2000-2003
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 *
 * SPDX-License-Identifier:	GPL-2.0
 */

/*
 * Misc boot support
 */
#include "cmd_boot.h"
#include <ctype.h>
#include <util/atomic.h>

#include "cli_readline.h"	/* console_buffer[] */
#include "cli.h"			/* run_command() */
#include "env.h"
#include "eval_arg.h"
#include "con-utils.h"
#include "getopt-min.h"
#include "z80-if.h"
#include "z180-serv.h"	/* restart_z180_serv() */
#include "debug.h"

/* ugly hack to get Z180 loadfile into flash memory */
#define const const FLASH
#include "../z180/hdrom.h"
#include "../z180/cfboot.h"
#undef const


static void z80_load_mem(int_fast8_t verbosity,
				const FLASH unsigned char data[],
				const FLASH unsigned long *sections,
				const FLASH unsigned long address[],
				const FLASH unsigned long length_of_sections[])
{
	uint32_t sec_base = 0;

	if (verbosity > 1)
		printf_P(PSTR("Loading Z180 memory... \n"));

	for (unsigned sec = 0; sec < *sections; sec++) {
		if (verbosity > 0) {
			printf_P(PSTR("   From: 0x%.5lX to: 0x%.5lX    (%5li bytes)\n"),
					address[sec],
					address[sec]+length_of_sections[sec] - 1,
					length_of_sections[sec]);
		}

		z80_write_block_P((const FLASH unsigned char *) &data[sec_base],  /* src */
				address[sec],                  /* dest */
				length_of_sections[sec]);      /* len */
		sec_base += length_of_sections[sec];
	}
}

command_ret_t do_loadf(cmd_tbl_t *cmdtp, uint_fast8_t flag, int argc, char * const argv[])
{
	(void) cmdtp; (void) flag; (void) argc; (void) argv;

	if (z80_bus_state() & ZST_RUNNING) {
		my_puts_P(PSTR("Can't load while CPU is running!\n"));
		return CMD_RET_FAILURE;
	}
	if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
		my_puts_P(PSTR("Bus timeout\n"));
		return  CMD_RET_FAILURE;
	}
	z80_load_mem(2, hdrom,
				&hdrom_sections,
				hdrom_address,
				hdrom_length_of_sections);

	z80_bus_cmd(Release);

	return CMD_RET_SUCCESS;
}


void print_vars(char *title)
{
	uint8_t buf[5];
	zstate_t state = z80_bus_state();

	if((state & ZST_ACQUIRED) == 0)
		z80_bus_cmd(Request);

	z80_read_block(buf,	9, sizeof buf);

	if((state & ZST_ACQUIRED) == 0)
		z80_bus_cmd(Release);

	printf_P(PSTR("%s: stage: %d, flag: 0x%.02x, result: %d, IDE stat/error: 0x%.02x/0x%.02x\n"),
				title, buf[0], buf[1], buf[2], buf[3], buf[4]);
}


/*
 *  bootcf [options]
 *
 *		-a	address			(100h)
 *		-s	start sector	(0)
 *		-c	sector count	(7)
 *		-i	Partition id	(52)
 *		-n  load only
 *		-t	timeout			(10000)
 * 		-v	verbose
 */

command_ret_t do_bootcf(cmd_tbl_t *cmdtp, uint_fast8_t flag, int argc, char * const argv[])
{
	struct {
		uint8_t  jr[2];
		uint16_t loadaddr;
		uint8_t  sec_start;
		uint8_t  sec_cnt;
		uint8_t  part_id;
		uint16_t timeout;
		uint8_t  stages;
	} boot_param;

	struct {
		uint8_t  stages;
		uint8_t  done;
		uint8_t  result;
		uint8_t  ide_stat;
		uint8_t  ide_error;
	} boot_res;

	int_fast8_t verbosity = 0;
	uint8_t default_stages;
	uint32_t val;

	(void) cmdtp; (void) flag;

	/* get default values */
	memcpy_P(&boot_param, cfboot, sizeof boot_param);
	default_stages = boot_param.stages;

	/* reset getopt() */
	optind = 0;

	int opt;
	while ((opt = getopt(argc, argv, PSTR("vna:s:c:t:i:"))) != -1) {
		switch (opt) {
		case 'v':
			verbosity++;
			break;
		case 'n':
			if (boot_param.stages > 0)
				boot_param.stages--;
			break;
		case 'a':
			val = eval_arg(optarg, NULL);
			if (val < 0x100 || val > 0xFE00) {
				printf_P(PSTR("Address out of range: 0x%.4lX\n"), val);
				return CMD_RET_FAILURE;
			}
			boot_param.loadaddr = val;
			break;
		case 's':
			val = eval_arg(optarg, NULL);
			if (val > 255) {
				printf_P(PSTR("Start sector out of range: 0x%lX\n"), val);
				return CMD_RET_FAILURE;
			}
			boot_param.sec_start = val;
			break;
		case 'c':
			val = eval_arg(optarg, NULL);
			if (val > 127) {
				printf_P(PSTR("Sector count out of range: 0x%lX\n"), val);
				return CMD_RET_FAILURE;
			}
			boot_param.sec_cnt = val;
			break;
		case 't':
			val = eval_arg(optarg, NULL);
			if (val < 0x1 || val > 0xFFFF) {
				printf_P(PSTR("Timeout value out of range: 0x%lX\n"), val);
				return CMD_RET_FAILURE;
			}
			boot_param.timeout = val;
			break;
		case 'i':
			val = eval_arg(optarg, NULL);
			if (val < 0x01 || val > 0xFF) {
				printf_P(PSTR("Partition id out of range: 0x%lX\n"), val);
				return CMD_RET_FAILURE;
			}
			boot_param.part_id = val;
			break;
		default: /* '?' */
			return CMD_RET_USAGE;
		}
	}

	/* remaining arguments */
	argc -= optind;
	if (argc) {
		my_puts_P(PSTR("Argument error!\n"));
		return CMD_RET_USAGE;
	}

	if ((val = (uint32_t) boot_param.loadaddr + boot_param.sec_cnt * 512) >= 0xFF00) {
		printf_P(PSTR("Top address out of range: 0x%.4lX\n"), val);
		return CMD_RET_FAILURE;
	}


	if (z80_bus_state() & ZST_RUNNING) {
		my_puts_P(PSTR("CPU is allready running!\n"));
		return CMD_RET_FAILURE;
	}
	if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
		my_puts_P(PSTR("Bus timeout\n"));
		return  CMD_RET_FAILURE;
	}
	z80_load_mem(verbosity, cfboot,
				&cfboot_sections,
				cfboot_address,
				cfboot_length_of_sections);

	z80_write_block((const uint8_t *) &boot_param,
				cfboot_address[0], sizeof boot_param);
	z80_bus_cmd(Release);

	if (boot_param.stages == 0) {
		printf_P(PSTR("Bootloader loaded at: 0x%.4X\n"), (uint16_t) cfboot_address[0]);
	} else {
		printf_P(PSTR("Executing %d of %d Bootloader stages...\n"),
				boot_param.stages, default_stages);

		z80_bus_cmd(Run);
		z80_bus_cmd(Release);

		clear_ctrlc();		/* forget any previous Control C */
		for (boot_res.done = 0; boot_res.done != 0xFF;) {
			_delay_ms(8);
			/* check for ctrl-c to abort... */
			if (had_ctrlc() || ctrlc()) {
				break;
			}
			z80_bus_cmd(Request);
			z80_read_block((uint8_t *) &boot_res,
					cfboot_address[0]+sizeof boot_param - 1, sizeof boot_res);
			z80_bus_cmd(Release);
		}

		if (boot_res.done != 0xFF) {
			z80_bus_cmd(Reset);
			my_puts_P(PSTR("Abort\n"));
		} else {
			if (boot_param.stages == default_stages &&
					boot_res.stages == 0 &&
					boot_res.result == 0) {
				my_puts_P(PSTR("Booting...\n"));
			} else {
				z80_bus_cmd(Reset);
				boot_res.stages++;
				printf_P(PSTR("Bootloader stopped at stage %d, result: %d, IDE stat/error: 0x%.02x/0x%.02x\n"),
					boot_param.stages - boot_res.stages,
					boot_res.result, boot_res.ide_stat, boot_res.ide_error);
			}
		}
	}

	return CMD_RET_SUCCESS;
}

command_ret_t do_busreq_pulse(cmd_tbl_t *cmdtp, uint_fast8_t flag, int argc, char * const argv[])
{
	uint16_t count=1;

	(void) cmdtp; (void) flag;

	if (!(z80_bus_state() & ZST_RUNNING)) {
		printf_P(PSTR("## CPU is not running!\n"));
		return CMD_RET_FAILURE;
	}

	if (argc > 1)
		count = (uint16_t) eval_arg(argv[1], NULL);

	z80_bus_cmd(Request);
	while (count--)
		z80_bus_cmd(M_Cycle);

	return CMD_RET_SUCCESS;
}


command_ret_t do_go(cmd_tbl_t *cmdtp, uint_fast8_t flag, int argc, char * const argv[])
{
	uint32_t addr;

	(void) cmdtp; (void) flag;

	if (argc < 2)
		return CMD_RET_USAGE;
	addr = eval_arg(argv[1], NULL);
	if (addr >= (1UL<<16)) {
		printf_P(PSTR("## Startaddress 0x%05lx too high.\n"
			"   (Out of logical address space (0x00000-0x0ffff))\n"),
			addr);
		return CMD_RET_FAILURE;
	}

	if (z80_bus_state() & ZST_RUNNING) {
		printf_P(PSTR("## CPU allready running!\n"));
		return CMD_RET_FAILURE;
	}

	printf_P(PSTR("## Starting application at 0x%04lx ...\n"), addr);

	if (addr != 0) {
		uint8_t tmp[3];

		z80_bus_cmd(Request);
		z80_read_block (tmp, 0, 3);
		z80_write(0, 0xc3);
		z80_write(1, addr);
		z80_write(2, (addr >> 8));

		z80_bus_cmd(Run);
		z80_bus_cmd(M_Cycle);
		z80_bus_cmd(M_Cycle);
		z80_write_block(tmp, 0, 3);
	} else
		z80_bus_cmd(Run);

	z80_bus_cmd(Release);

	return CMD_RET_SUCCESS;
}

static
void reset_cpu(bus_cmd_t mode)
{
	restart_z180_serv();
	z80_bus_cmd(mode);
}


command_ret_t do_reset(cmd_tbl_t *cmdtp, uint_fast8_t flag, int argc, char * const argv[])
{
	(void) cmdtp; (void) flag; (void) argc; (void) argv;

	printf_P(PSTR("CPU now in reset state.\n"));

	reset_cpu(Reset);
	return CMD_RET_SUCCESS;
}

command_ret_t do_restart(cmd_tbl_t *cmdtp, uint_fast8_t flag, int argc, char * const argv[])
{
	(void) cmdtp; (void) flag; (void) argc; (void) argv;

	reset_cpu(Restart);

	return CMD_RET_SUCCESS;
}

static
void print_con_usage(char esc)
{	printf_P(PSTR("\n"
		"------------------------------------------------\n"
		" ?,H - This Help\n"
		" Q,X - Return to command line\n"
		" R   - Reset (Restart) CPU\n"
		" :   - Execute monitor command\n"
		" \\   - code input:\n"
		"       \\nnn   3 decimal digits character code\n"
		"       \\Xhh   2 hexadecimal digits character code\n"
		" ^%c  - (Escape char) Type again to send itself\n"
		"key>"
	), esc + 0x40);
}

command_ret_t do_console(cmd_tbl_t *cmdtp, uint_fast8_t flag, int argc, char * const argv[])
{
	int ch;
	uint8_t pending;
//	uint8_t help_prompt = 0;
	uint8_t code = 0;
	uint8_t state = 0;
	char esc_char = (char) getenv_ulong(PSTR(ENV_ESC_CHAR), 16, CONFIG_ESC_CHAR);

	(void) cmdtp; (void) flag; (void) argc; (void) argv;

	printf_P(PSTR("Connecting to CPU. Escape character is '^%c'.\n"),
					esc_char + 0x40);

	while (1) {

		ATOMIC_BLOCK(ATOMIC_FORCEON) {
			pending = (Stat & S_CON_PENDING) != 0;
			Stat &= ~S_CON_PENDING;
		}
		if (pending) {
			uint8_t count = 100;
			while ((ch = z80_memfifo_getc(fifo_conout)) >= 0 && --count)
				putchar(ch);
		}

		if ((ch = my_getchar(0)) >= 0) {
			switch (state) {
			case 0:
				if (ch == esc_char) {
					state = 1;
					/* TODO: Timer starten */
				} else {
					z80_memfifo_putc(fifo_conin, ch);
				}
				break;
			case 2:
				printf_P(PSTR("\n"
				  "------------------------------------------------\n"));
			case 1:
				state = 0;
				switch (toupper(ch)) {

				case '?':
				case 'H':
					print_con_usage(esc_char);
					state = 2;
					break;

				case 'R':
					reset_cpu(Restart);
					break;

				case 'X':
				case 'Q':
					printf_P(PSTR("\n"));
					goto quit;
					break;

				case ':':
						putchar('\n');
						int cmdlen = cli_readline(PSTR(": "), 1);
						if (cmdlen > 0)
							run_command(console_buffer, 0);
					break;

				case '\\':
					code = 0;
					state = 3;
					break;

				default:
					if (ch == esc_char)
						z80_memfifo_putc(fifo_conin, ch);
					break;
				}
				break;
			case 3:
				if (toupper(ch) == 'X') {
					state = 6;
					break;
				}
				/* fall thru */
			case 4:
			case 5:
				if (isdigit(ch)) {
					code = code * 10 + ch - '0';
					state++;
				} else {
					if (state > 3)
						z80_memfifo_putc(fifo_conin, code);
					z80_memfifo_putc(fifo_conin, ch);
					state = 0;
				}
				if (state > 5) {
					z80_memfifo_putc(fifo_conin, code);
					state = 0;
				}
				break;
			case 6:
			case 7:
				if (isxdigit(ch)) {
					ch = toupper(ch);
					if (ch >= 'A')
						ch -= 'A' - 10;
					code = code * 16 + ch - '0';
					state++;
				}else {
					if (state > 6)
						z80_memfifo_putc(fifo_conin, code);
					z80_memfifo_putc(fifo_conin, ch);
					state = 0;
				}
				if (state > 7) {
					z80_memfifo_putc(fifo_conin, code);
					state = 0;
				}
				break;
			}
		}
	}
quit:
	return CMD_RET_SUCCESS;
}
Commit	Line	Data
35edb766	1	/*
04b3ea0e	2	* (C) Copyright 2014-2016 Leo C. <erbl259-lmu@yahoo.de>
35edb766 L	3	*
	4	* (C) Copyright 2000-2003
	5	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	6	*
19a463f4	7	* SPDX-License-Identifier: GPL-2.0
35edb766	8	*/
534e1dfc L	9
	10	/*
	11	* Misc boot support
	12	*/
228b1c5f	13	#include "cmd_boot.h"
8a7decea	14	#include <ctype.h>
89adce76	15	#include <util/atomic.h>
534e1dfc	16
04b3ea0e L	17	#include "cli_readline.h" /* console_buffer[] */
04b3ea0e L	18	#include "cli.h" /* run_command() */
612a6965	19	#include "env.h"
2d914b45	20	#include "eval_arg.h"
89adce76	21	#include "con-utils.h"
a2907f2e	22	#include "getopt-min.h"
534e1dfc	23	#include "z80-if.h"
cb4fb1ed	24	#include "z180-serv.h" /* restart_z180_serv() */
8a7decea	25	#include "debug.h"
534e1dfc L	26
	27	/* ugly hack to get Z180 loadfile into flash memory */
	28	#define const const FLASH
	29	#include "../z180/hdrom.h"
a2907f2e	30	#include "../z180/cfboot.h"
534e1dfc L	31	#undef const
	32
	33
	34
a2907f2e L	35	static void z80_load_mem(int_fast8_t verbosity,
	36	const FLASH unsigned char data[],
	37	const FLASH unsigned long *sections,
	38	const FLASH unsigned long address[],
	39	const FLASH unsigned long length_of_sections[])
534e1dfc	40	{
a2907f2e L	41	uint32_t sec_base = 0;
	42
	43	if (verbosity > 1)
	44	printf_P(PSTR("Loading Z180 memory... \n"));
	45
	46	for (unsigned sec = 0; sec < *sections; sec++) {
	47	if (verbosity > 0) {
	48	printf_P(PSTR(" From: 0x%.5lX to: 0x%.5lX (%5li bytes)\n"),
	49	address[sec],
	50	address[sec]+length_of_sections[sec] - 1,
	51	length_of_sections[sec]);
	52	}
	53
	54	z80_write_block_P((const FLASH unsigned char ) &data[sec_base], / src */
	55	address[sec], /* dest */
	56	length_of_sections[sec]); /* len */
	57	sec_base += length_of_sections[sec];
534e1dfc L	58	}
	59	}
	60
93ea25f2	61	command_ret_t do_loadf(cmd_tbl_t cmdtp, uint_fast8_t flag, int argc, char const argv[])
534e1dfc L	62	{
	63	(void) cmdtp; (void) flag; (void) argc; (void) argv;
	64
6035a17b	65	if (z80_bus_state() & ZST_RUNNING) {
612a6965	66	my_puts_P(PSTR("Can't load while CPU is running!\n"));
6035a17b	67	return CMD_RET_FAILURE;
534e1dfc	68	}
612a6965 L	69	if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
	70	my_puts_P(PSTR("Bus timeout\n"));
	71	return CMD_RET_FAILURE;
	72	}
a2907f2e L	73	z80_load_mem(2, hdrom,
	74	&hdrom_sections,
	75	hdrom_address,
	76	hdrom_length_of_sections);
	77
612a6965	78	z80_bus_cmd(Release);
6035a17b	79
d0581f88	80	return CMD_RET_SUCCESS;
534e1dfc L	81	}
	82
	83
a2907f2e L	84	void print_vars(char *title)
	85	{
	86	uint8_t buf[5];
	87	zstate_t state = z80_bus_state();
	88
	89	if((state & ZST_ACQUIRED) == 0)
	90	z80_bus_cmd(Request);
	91
	92	z80_read_block(buf, 9, sizeof buf);
	93
	94	if((state & ZST_ACQUIRED) == 0)
	95	z80_bus_cmd(Release);
	96
	97	printf_P(PSTR("%s: stage: %d, flag: 0x%.02x, result: %d, IDE stat/error: 0x%.02x/0x%.02x\n"),
	98	title, buf[0], buf[1], buf[2], buf[3], buf[4]);
	99	}
	100
	101
	102	/*
	103	* bootcf [options]
	104	*
	105	* -a address (100h)
	106	* -s start sector (0)
	107	* -c sector count (7)
	108	* -i Partition id (52)
	109	* -n load only
	110	* -t timeout (10000)
	111	* -v verbose
	112	*/
	113
93ea25f2	114	command_ret_t do_bootcf(cmd_tbl_t cmdtp, uint_fast8_t flag, int argc, char const argv[])
a2907f2e L	115	{
	116	struct {
	117	uint8_t jr[2];
	118	uint16_t loadaddr;
	119	uint8_t sec_start;
	120	uint8_t sec_cnt;
	121	uint8_t part_id;
	122	uint16_t timeout;
16af58ea	123	uint8_t stages;
a2907f2e L	124	} boot_param;
	125
	126	struct {
16af58ea	127	uint8_t stages;
a2907f2e L	128	uint8_t done;
	129	uint8_t result;
	130	uint8_t ide_stat;
	131	uint8_t ide_error;
	132	} boot_res;
	133
	134	int_fast8_t verbosity = 0;
16af58ea	135	uint8_t default_stages;
a2907f2e L	136	uint32_t val;
	137
	138	(void) cmdtp; (void) flag;
	139
	140	/* get default values */
	141	memcpy_P(&boot_param, cfboot, sizeof boot_param);
16af58ea	142	default_stages = boot_param.stages;
a2907f2e L	143
	144	/* reset getopt() */
	145	optind = 0;
	146
	147	int opt;
	148	while ((opt = getopt(argc, argv, PSTR("vna:s:c:t:i:"))) != -1) {
	149	switch (opt) {
	150	case 'v':
	151	verbosity++;
	152	break;
	153	case 'n':
16af58ea L	154	if (boot_param.stages > 0)
16af58ea L	155	boot_param.stages--;
a2907f2e L	156	break;
a2907f2e L	157	case 'a':
2d914b45	158	val = eval_arg(optarg, NULL);
a2907f2e L	159	if (val < 0x100 \|\| val > 0xFE00) {
	160	printf_P(PSTR("Address out of range: 0x%.4lX\n"), val);
	161	return CMD_RET_FAILURE;
	162	}
	163	boot_param.loadaddr = val;
	164	break;
	165	case 's':
2d914b45	166	val = eval_arg(optarg, NULL);
a2907f2e L	167	if (val > 255) {
	168	printf_P(PSTR("Start sector out of range: 0x%lX\n"), val);
	169	return CMD_RET_FAILURE;
	170	}
	171	boot_param.sec_start = val;
	172	break;
	173	case 'c':
2d914b45	174	val = eval_arg(optarg, NULL);
a2907f2e L	175	if (val > 127) {
	176	printf_P(PSTR("Sector count out of range: 0x%lX\n"), val);
	177	return CMD_RET_FAILURE;
	178	}
	179	boot_param.sec_cnt = val;
	180	break;
	181	case 't':
2d914b45	182	val = eval_arg(optarg, NULL);
a2907f2e L	183	if (val < 0x1 \|\| val > 0xFFFF) {
	184	printf_P(PSTR("Timeout value out of range: 0x%lX\n"), val);
	185	return CMD_RET_FAILURE;
	186	}
16af58ea	187	boot_param.timeout = val;
a2907f2e L	188	break;
a2907f2e L	189	case 'i':
2d914b45	190	val = eval_arg(optarg, NULL);
a2907f2e L	191	if (val < 0x01 \|\| val > 0xFF) {
	192	printf_P(PSTR("Partition id out of range: 0x%lX\n"), val);
	193	return CMD_RET_FAILURE;
	194	}
	195	boot_param.part_id = val;
	196	break;
	197	default: /* '?' */
	198	return CMD_RET_USAGE;
	199	}
	200	}
	201
	202	/* remaining arguments */
	203	argc -= optind;
	204	if (argc) {
	205	my_puts_P(PSTR("Argument error!\n"));
	206	return CMD_RET_USAGE;
	207	}
	208
	209	if ((val = (uint32_t) boot_param.loadaddr + boot_param.sec_cnt * 512) >= 0xFF00) {
	210	printf_P(PSTR("Top address out of range: 0x%.4lX\n"), val);
	211	return CMD_RET_FAILURE;
	212	}
	213
	214
	215
	216	if (z80_bus_state() & ZST_RUNNING) {
	217	my_puts_P(PSTR("CPU is allready running!\n"));
	218	return CMD_RET_FAILURE;
	219	}
	220	if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
	221	my_puts_P(PSTR("Bus timeout\n"));
	222	return CMD_RET_FAILURE;
	223	}
	224	z80_load_mem(verbosity, cfboot,
	225	&cfboot_sections,
	226	cfboot_address,
	227	cfboot_length_of_sections);
	228
	229	z80_write_block((const uint8_t *) &boot_param,
	230	cfboot_address[0], sizeof boot_param);
	231	z80_bus_cmd(Release);
	232
16af58ea	233	if (boot_param.stages == 0) {
a2907f2e L	234	printf_P(PSTR("Bootloader loaded at: 0x%.4X\n"), (uint16_t) cfboot_address[0]);
	235	} else {
	236	printf_P(PSTR("Executing %d of %d Bootloader stages...\n"),
16af58ea	237	boot_param.stages, default_stages);
a2907f2e L	238
	239	z80_bus_cmd(Run);
	240	z80_bus_cmd(Release);
	241
	242	clear_ctrlc(); /* forget any previous Control C */
	243	for (boot_res.done = 0; boot_res.done != 0xFF;) {
	244	_delay_ms(8);
	245	/* check for ctrl-c to abort... */
	246	if (had_ctrlc() \|\| ctrlc()) {
	247	break;
	248	}
	249	z80_bus_cmd(Request);
	250	z80_read_block((uint8_t *) &boot_res,
	251	cfboot_address[0]+sizeof boot_param - 1, sizeof boot_res);
	252	z80_bus_cmd(Release);
	253	}
	254
	255	if (boot_res.done != 0xFF) {
	256	z80_bus_cmd(Reset);
	257	my_puts_P(PSTR("Abort\n"));
	258	} else {
16af58ea L	259	if (boot_param.stages == default_stages &&
	260	boot_res.stages == 0 &&
	261	boot_res.result == 0) {
a2907f2e L	262	my_puts_P(PSTR("Booting...\n"));
	263	} else {
	264	z80_bus_cmd(Reset);
16af58ea	265	boot_res.stages++;
a2907f2e	266	printf_P(PSTR("Bootloader stopped at stage %d, result: %d, IDE stat/error: 0x%.02x/0x%.02x\n"),
16af58ea	267	boot_param.stages - boot_res.stages,
a2907f2e L	268	boot_res.result, boot_res.ide_stat, boot_res.ide_error);
	269	}
	270	}
	271	}
	272
	273	return CMD_RET_SUCCESS;
	274	}
	275
93ea25f2	276	command_ret_t do_busreq_pulse(cmd_tbl_t cmdtp, uint_fast8_t flag, int argc, char const argv[])
534e1dfc	277	{
f338df2a	278	uint16_t count=1;
534e1dfc	279
f338df2a	280	(void) cmdtp; (void) flag;
534e1dfc	281
6035a17b	282	if (!(z80_bus_state() & ZST_RUNNING)) {
f338df2a	283	printf_P(PSTR("## CPU is not running!\n"));
d0581f88	284	return CMD_RET_FAILURE;
534e1dfc L	285	}
534e1dfc L	286
f338df2a	287	if (argc > 1)
2d914b45	288	count = (uint16_t) eval_arg(argv[1], NULL);
f338df2a	289
62f624d3	290	z80_bus_cmd(Request);
f338df2a	291	while (count--)
62f624d3	292	z80_bus_cmd(M_Cycle);
534e1dfc	293
d0581f88	294	return CMD_RET_SUCCESS;
f338df2a L	295	}
	296
	297
93ea25f2	298	command_ret_t do_go(cmd_tbl_t cmdtp, uint_fast8_t flag, int argc, char const argv[])
f338df2a L	299	{
	300	uint32_t addr;
	301
	302	(void) cmdtp; (void) flag;
6035a17b	303
f338df2a L	304	if (argc < 2)
f338df2a L	305	return CMD_RET_USAGE;
2d914b45	306	addr = eval_arg(argv[1], NULL);
f338df2a	307	if (addr >= (1UL<<16)) {
534e1dfc L	308	printf_P(PSTR("## Startaddress 0x%05lx too high.\n"
	309	" (Out of logical address space (0x00000-0x0ffff))\n"),
	310	addr);
d0581f88	311	return CMD_RET_FAILURE;
6035a17b	312	}
f338df2a	313
6035a17b	314	if (z80_bus_state() & ZST_RUNNING) {
f338df2a	315	printf_P(PSTR("## CPU allready running!\n"));
d0581f88	316	return CMD_RET_FAILURE;
534e1dfc L	317	}
534e1dfc L	318
f338df2a L	319	printf_P(PSTR("## Starting application at 0x%04lx ...\n"), addr);
	320
	321	if (addr != 0) {
	322	uint8_t tmp[3];
6035a17b	323
62f624d3	324	z80_bus_cmd(Request);
19a463f4	325	z80_read_block (tmp, 0, 3);
f338df2a L	326	z80_write(0, 0xc3);
	327	z80_write(1, addr);
	328	z80_write(2, (addr >> 8));
	329
62f624d3 L	330	z80_bus_cmd(Run);
	331	z80_bus_cmd(M_Cycle);
	332	z80_bus_cmd(M_Cycle);
19a463f4	333	z80_write_block(tmp, 0, 3);
f338df2a	334	} else
62f624d3	335	z80_bus_cmd(Run);
6035a17b	336
62f624d3	337	z80_bus_cmd(Release);
f338df2a	338
d0581f88	339	return CMD_RET_SUCCESS;
534e1dfc L	340	}
534e1dfc L	341
8a7decea L	342	static
	343	void reset_cpu(bus_cmd_t mode)
	344	{
	345	restart_z180_serv();
	346	z80_bus_cmd(mode);
	347	}
	348
	349
93ea25f2	350	command_ret_t do_reset(cmd_tbl_t cmdtp, uint_fast8_t flag, int argc, char const argv[])
534e1dfc L	351	{
	352	(void) cmdtp; (void) flag; (void) argc; (void) argv;
	353
612a6965	354	printf_P(PSTR("CPU now in reset state.\n"));
534e1dfc	355
8a7decea	356	reset_cpu(Reset);
d0581f88	357	return CMD_RET_SUCCESS;
534e1dfc L	358	}
534e1dfc L	359
93ea25f2	360	command_ret_t do_restart(cmd_tbl_t cmdtp, uint_fast8_t flag, int argc, char const argv[])
534e1dfc L	361	{
	362	(void) cmdtp; (void) flag; (void) argc; (void) argv;
	363
8a7decea	364	reset_cpu(Restart);
534e1dfc	365
d0581f88	366	return CMD_RET_SUCCESS;
534e1dfc L	367	}
534e1dfc L	368
8a7decea L	369	static
	370	void print_con_usage(char esc)
	371	{ printf_P(PSTR("\n"
	372	"------------------------------------------------\n"
	373	" ?,H - This Help\n"
8a7decea	374	" Q,X - Return to command line\n"
b08e079d L	375	" R - Reset (Restart) CPU\n"
b08e079d L	376	" : - Execute monitor command\n"
612a6965 L	377	" \\ - code input:\n"
	378	" \\nnn 3 decimal digits character code\n"
	379	" \\Xhh 2 hexadecimal digits character code\n"
	380	" ^%c - (Escape char) Type again to send itself\n"
8a7decea L	381	"key>"
	382	), esc + 0x40);
	383	}
89adce76	384
93ea25f2	385	command_ret_t do_console(cmd_tbl_t cmdtp, uint_fast8_t flag, int argc, char const argv[])
89adce76 L	386	{
89adce76 L	387	int ch;
8a7decea L	388	uint8_t pending;
	389	// uint8_t help_prompt = 0;
	390	uint8_t code = 0;
	391	uint8_t state = 0;
612a6965	392	char esc_char = (char) getenv_ulong(PSTR(ENV_ESC_CHAR), 16, CONFIG_ESC_CHAR);
ea6971b8	393
89adce76 L	394	(void) cmdtp; (void) flag; (void) argc; (void) argv;
89adce76 L	395
b08e079d L	396	printf_P(PSTR("Connecting to CPU. Escape character is '^%c'.\n"),
b08e079d L	397	esc_char + 0x40);
89adce76 L	398
	399	while (1) {
	400
8a7decea	401	ATOMIC_BLOCK(ATOMIC_FORCEON) {
89adce76 L	402	pending = (Stat & S_CON_PENDING) != 0;
	403	Stat &= ~S_CON_PENDING;
	404	}
3ad4143b L	405	if (pending) {
	406	uint8_t count = 100;
	407	while ((ch = z80_memfifo_getc(fifo_conout)) >= 0 && --count)
89adce76	408	putchar(ch);
3ad4143b	409	}
89adce76 L	410
	411	if ((ch = my_getchar(0)) >= 0) {
	412	switch (state) {
	413	case 0:
612a6965	414	if (ch == esc_char) {
89adce76 L	415	state = 1;
	416	/* TODO: Timer starten */
	417	} else {
	418	z80_memfifo_putc(fifo_conin, ch);
ea6971b8	419	}
89adce76	420	break;
8a7decea L	421	case 2:
	422	printf_P(PSTR("\n"
	423	"------------------------------------------------\n"));
89adce76	424	case 1:
8a7decea L	425	state = 0;
8a7decea L	426	switch (toupper(ch)) {
89adce76	427
8a7decea L	428	case '?':
8a7decea L	429	case 'H':
612a6965	430	print_con_usage(esc_char);
8a7decea	431	state = 2;
89adce76 L	432	break;
89adce76 L	433
8a7decea L	434	case 'R':
8a7decea L	435	reset_cpu(Restart);
89adce76 L	436	break;
89adce76 L	437
8a7decea	438	case 'X':
89adce76	439	case 'Q':
889202c4	440	printf_P(PSTR("\n"));
89adce76 L	441	goto quit;
	442	break;
	443
b08e079d L	444	case ':':
b08e079d L	445	putchar('\n');
8ed66016	446	int cmdlen = cli_readline(PSTR(": "), 1);
b08e079d L	447	if (cmdlen > 0)
	448	run_command(console_buffer, 0);
	449	break;
	450
8a7decea L	451	case '\\':
	452	code = 0;
	453	state = 3;
	454	break;
	455
8a7decea	456	default:
612a6965 L	457	if (ch == esc_char)
612a6965 L	458	z80_memfifo_putc(fifo_conin, ch);
8a7decea L	459	break;
	460	}
	461	break;
	462	case 3:
	463	if (toupper(ch) == 'X') {
	464	state = 6;
	465	break;
	466	}
	467	/* fall thru */
	468	case 4:
	469	case 5:
	470	if (isdigit(ch)) {
	471	code = code * 10 + ch - '0';
	472	state++;
b08e079d L	473	} else {
	474	if (state > 3)
	475	z80_memfifo_putc(fifo_conin, code);
	476	z80_memfifo_putc(fifo_conin, ch);
	477	state = 0;
8a7decea L	478	}
	479	if (state > 5) {
	480	z80_memfifo_putc(fifo_conin, code);
	481	state = 0;
	482	}
	483	break;
	484	case 6:
	485	case 7:
	486	if (isxdigit(ch)) {
	487	ch = toupper(ch);
	488	if (ch >= 'A')
	489	ch -= 'A' - 10;
	490	code = code * 16 + ch - '0';
	491	state++;
b08e079d L	492	}else {
	493	if (state > 6)
	494	z80_memfifo_putc(fifo_conin, code);
	495	z80_memfifo_putc(fifo_conin, ch);
	496	state = 0;
8a7decea L	497	}
	498	if (state > 7) {
	499	z80_memfifo_putc(fifo_conin, code);
	500	state = 0;
89adce76	501	}
89adce76 L	502	break;
	503	}
	504	}
89adce76 L	505	}
89adce76 L	506	quit:
89adce76 L	507	return CMD_RET_SUCCESS;
89adce76 L	508	}