X-Git-Url: http://cloudbase.mooo.com/gitweb/z180-stamp.git/blobdiff_plain/afc7c4b41af6cc2008bdc525f944e61f14cad93f..cb4fb1ed02b59f798368a76f2596d7c24125e68a:/avr/cmd_attach.c?ds=sidebyside

diff --git a/avr/cmd_attach.c b/avr/cmd_attach.c
new file mode 100644
index 0000000..e1a3b2c
--- /dev/null
+++ b/avr/cmd_attach.c
@@ -0,0 +1,157 @@
+/*
+ * (C) Copyright 2016 Leo C. <erbl259-lmu@yahoo.de>
+ *
+ * SPDX-License-Identifier:	GPL-2.0
+ */
+
+/*
+ * attach chanels to devices
+ */
+
+#include "common.h"
+#include <string.h>
+#include <stdbool.h>
+
+#include "command.h"
+#include "z180-serv.h"
+#include "getopt-min.h"
+//#include "print-utils.h"
+//#include "con-utils.h"
+//#include "timer.h"
+//#include "z80-if.h"
+//#include "debug.h"
+
+
+static const FLASH char * const FLASH rc_messages[] = {
+			FSTR("OK"),
+			FSTR("Unknown error"),
+			FSTR("Disk number out of range 0..7"),
+			FSTR("Disk allready attached"),
+			FSTR("Disk not attached"),
+			FSTR("File not found"),
+			FSTR("Not enough memory"),
+			FSTR("Error opening file"),
+			FSTR("File allready attached to other drive"),
+		};
+
+static
+void printerror(int rc, uint8_t unit, char *fn)
+{
+	if (rc < 0 || (unsigned) rc >= ARRAY_SIZE(rc_messages))
+		rc = 1;
+
+#if GCC_BUG_61443 * 0
+		printf_P(PSTR("rc=%u FR_"), rc);
+		my_puts_P(rc_names[rc]);
+		my_puts_P(PSTR("\n"));
+#else
+		printf_P(PSTR("Attachment of '%s' to dsk%d failed: %S!\n"),
+				fn, unit, rc_messages[rc]);
+#endif
+}
+
+/*
+ * attach [[options] [unit [diskfile]]]
+ *
+ * detach unit
+ * attach -d unit
+ *
+ * attach -o reattach unit
+ * attach -o reattach unit diskfile
+ *
+ * attach unit diskfile
+ *
+ */
+
+command_ret_t do_attach(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
+{
+	uint8_t unit;
+	char *filename = NULL;
+	bool detach = false;
+	drv_opt_t options = 0;
+	int res;
+
+	(void) cmdtp; (void) flag;
+
+
+	if (argv[0][0] == 'd')
+		/* we are called as 'detach' */
+		detach = true;
+
+	if (argc == 1) {
+		/* no arguments */
+		drv_list();
+		return CMD_RET_SUCCESS;
+	}
+
+	/* reset getopt() */
+	optind = 1;
+
+	int opt;
+	while ((opt = getopt(argc, argv, PSTR("drwo:"))) != -1) {
+		switch (opt) {
+		case 'd':
+			detach = true;
+			break;
+		case 'r':
+			options |= DRV_OPT_RO;
+			break;
+		case 'w':
+			options &= ~DRV_OPT_RO;
+			break;
+		case 'o':
+			{
+				static const FLASH char delim[] = {", "};
+				char *p = strtok_P(optarg, delim);
+				while (p != NULL) {
+					if (!strcmp_P(p, PSTR("ro")))
+						options |= DRV_OPT_RO;
+					else if (!strcmp_P(p, PSTR("rw")))
+						options &= ~DRV_OPT_RO;
+					else if (!strcmp_P(p, PSTR("debug")))
+						options |= DRV_OPT_DEBUG;
+					else if (!strcmp_P(p, PSTR("nodebug")))
+						options &= ~DRV_OPT_DEBUG;
+					else if (!strcmp_P(p, PSTR("reattach")))
+						options |= DRV_OPT_REATTATCH;
+					else
+						return CMD_RET_USAGE;
+
+					p = strtok_P(NULL, delim);
+				}
+			}
+			break;
+		default: /* '?' */
+			return CMD_RET_USAGE;
+		}
+	}
+
+	/* remaining arguments */
+	argc -= optind;
+	if ( !((detach && argc == 1) ||
+			((options & DRV_OPT_REATTATCH) && argc == 1) ||
+			argc == 2) )
+		return CMD_RET_USAGE;
+
+	if ((strlen(argv[optind]) != 4) ||
+			strncmp_P(argv[optind], PSTR("dsk"), 3) ||
+			(unit = argv[optind][3] - '0') >= CONFIG_CPM_MAX_DRIVE) {
+
+		printf_P(PSTR("Unknown device: '%s'\n"), argv[optind]);
+		return CMD_RET_FAILURE;
+	}
+
+	if (detach) {
+		res = drv_detach(unit);
+		return CMD_RET_SUCCESS;
+	}
+
+	if (argc == 2)
+		filename = argv[++optind];
+
+	res = drv_attach(unit, filename, options);
+	if (res)
+		printerror(res, unit, filename);
+
+	return res ? CMD_RET_FAILURE : CMD_RET_SUCCESS;
+}