X-Git-Url: http://cloudbase.mooo.com/gitweb/z180-stamp.git/blobdiff_plain/51dd0948df5ed53b11cab4e909e19ee7cee363c5..f1e16f884308e8ef720a4ecbcdcc97af97dce4bd:/avr/cmd_boot.c?ds=sidebyside

diff --git a/avr/cmd_boot.c b/avr/cmd_boot.c
index f4a6183..036a041 100644
--- a/avr/cmd_boot.c
+++ b/avr/cmd_boot.c
@@ -100,15 +100,11 @@ command_ret_t do_bootcf(cmd_tbl_t *cmdtp UNUSED, uint_fast8_t flag UNUSED, int a
 	int_fast8_t verbosity = 0;
 	uint8_t default_stages;
 	uint32_t val;
-	ERRNUM res = ESUCCESS;
 
 	/* 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) {
@@ -254,10 +250,23 @@ command_ret_t do_busreq_pulse(cmd_tbl_t *cmdtp UNUSED, uint_fast8_t flag UNUSED,
 command_ret_t do_go(cmd_tbl_t *cmdtp UNUSED, uint_fast8_t flag UNUSED, int argc, char * const argv[])
 {
 	uint32_t addr;
+	bool hold = 0;
 
-	if (argc < 2)
+	int opt;
+	while ((opt = getopt(argc, argv, PSTR("h"))) != -1) {
+		switch (opt) {
+		case 'h':
+			hold = 1;
+			break;
+		default: /* '?' */
+			return CMD_RET_USAGE;
+		}
+	}
+	argc -= optind; /* remaining arguments */
+
+	if (argc != 1)
 		return CMD_RET_USAGE;
-	addr = eval_arg(argv[1], NULL);
+	addr = eval_arg(argv[optind], NULL);
 	if (addr >= (1UL<<16)) {
 		printf_P(PSTR("Invalid startaddress: 0x%05lx\n"
 			"   (Out of logical address space (0x00000-0x0ffff))\n"),
@@ -282,13 +291,19 @@ command_ret_t do_go(cmd_tbl_t *cmdtp UNUSED, uint_fast8_t flag UNUSED, int argc,
 		z80_write(2, (addr >> 8));
 
 		z80_bus_cmd(Run);
+		_delay_us(10);
 		z80_bus_cmd(M_Cycle);
+		_delay_us(10);
 		z80_bus_cmd(M_Cycle);
+		_delay_us(10);
 		z80_write_block(tmp, 0, 3);
-	} else
+	} else {
+		if (!hold)
+			z80_bus_cmd(Request);
 		z80_bus_cmd(Run);
-
-	z80_bus_cmd(Release);
+	}
+	if (!hold)
+		z80_bus_cmd(Release);
 
 	return CMD_RET_SUCCESS;
 }