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

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

/*
 * attach channels to devices
 */

#include "cmd_attach.h"

#include "command.h"
#include "z180-serv.h"
#include "getopt-min.h"


/*
 * 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, uint_fast8_t flag, int argc, char * const argv[])
{
	uint8_t unit = 0;
	char *filename = NULL;
	bool detach = false;
	bool detach_all = false;
	drv_opt_t options = 0;
	int res;

	(void) cmdtp; (void) flag;


	if (argv[0][0] == 'd') {
		/* we are called as 'detach' */
		detach = true;
	} else if (argc == 1) {
		/* no arguments */
		drv_list();
		return CMD_RET_SUCCESS;
	}

	int opt;
	while ((opt = getopt(argc, argv, PSTR("darwo:"))) != -1) {
		switch (opt) {
		case 'd':
			detach = true;
			break;
		case 'a':
			detach_all = 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 ( !( (argc == 0 && detach && detach_all) ||
			(argc == 1 && detach) ||
			(argc == 1 && (options & DRV_OPT_REATTATCH)) ||
			 argc == 2) )
		return CMD_RET_USAGE;

	if (argc > 0 && ((strlen(argv[optind]) != 4) ||
			strncmp_P(argv[optind], PSTR("dsk"), 3) ||
			(unit = argv[optind][3] - '0') >= CONFIG_CPM_MAX_DRIVE)) {

		cmd_error(CMD_RET_FAILURE, 0, PSTR("Invalid device: '%s'"), argv[optind]);
	}

	if (detach) {
		if (detach_all)
			for (uint8_t i = 0; i < CONFIG_CPM_MAX_DRIVE; i++)
				drv_detach(i);
		else
			drv_detach(unit);
		return CMD_RET_SUCCESS;
	}

	if (argc == 2)
		filename = argv[++optind];

	res = drv_attach(unit, filename, options);
	if (res)
		cmd_error(CMD_RET_FAILURE, res, PSTR("Attachment of '%s' to dsk%d failed"),	filename, unit);

	return CMD_RET_SUCCESS;
}
Commit	Line	Data
cb4fb1ed L	1	/*
	2	* (C) Copyright 2016 Leo C. <erbl259-lmu@yahoo.de>
	3	*
	4	* SPDX-License-Identifier: GPL-2.0
	5	*/
	6
	7	/*
4122fe90	8	* attach channels to devices
cb4fb1ed L	9	*/
cb4fb1ed L	10
7eecbdac	11	#include "cmd_attach.h"
cb4fb1ed L	12
	13	#include "command.h"
	14	#include "z180-serv.h"
	15	#include "getopt-min.h"
cb4fb1ed L	16
cb4fb1ed L	17
cb4fb1ed L	18	/*
	19	* attach [[options] [unit [diskfile]]]
	20	*
	21	* detach unit
	22	* attach -d unit
	23	*
	24	* attach -o reattach unit
	25	* attach -o reattach unit diskfile
	26	*
	27	* attach unit diskfile
	28	*
	29	*/
	30
fcf1d5b3	31	command_ret_t do_attach(cmd_tbl_t cmdtp, uint_fast8_t flag, int argc, char const argv[])
cb4fb1ed	32	{
5e8ac5e0	33	uint8_t unit = 0;
cb4fb1ed L	34	char *filename = NULL;
cb4fb1ed L	35	bool detach = false;
4122fe90	36	bool detach_all = false;
cb4fb1ed L	37	drv_opt_t options = 0;
	38	int res;
	39
	40	(void) cmdtp; (void) flag;
	41
	42
4122fe90	43	if (argv[0][0] == 'd') {
cb4fb1ed L	44	/* we are called as 'detach' */
cb4fb1ed L	45	detach = true;
4122fe90	46	} else if (argc == 1) {
cb4fb1ed L	47	/* no arguments */
	48	drv_list();
	49	return CMD_RET_SUCCESS;
	50	}
	51
cb4fb1ed	52	int opt;
4122fe90	53	while ((opt = getopt(argc, argv, PSTR("darwo:"))) != -1) {
cb4fb1ed L	54	switch (opt) {
	55	case 'd':
	56	detach = true;
	57	break;
4122fe90 L	58	case 'a':
	59	detach_all = true;
	60	break;
cb4fb1ed L	61	case 'r':
	62	options \|= DRV_OPT_RO;
	63	break;
	64	case 'w':
	65	options &= ~DRV_OPT_RO;
	66	break;
	67	case 'o':
	68	{
	69	static const FLASH char delim[] = {", "};
	70	char *p = strtok_P(optarg, delim);
	71	while (p != NULL) {
	72	if (!strcmp_P(p, PSTR("ro")))
	73	options \|= DRV_OPT_RO;
	74	else if (!strcmp_P(p, PSTR("rw")))
	75	options &= ~DRV_OPT_RO;
	76	else if (!strcmp_P(p, PSTR("debug")))
	77	options \|= DRV_OPT_DEBUG;
	78	else if (!strcmp_P(p, PSTR("nodebug")))
	79	options &= ~DRV_OPT_DEBUG;
	80	else if (!strcmp_P(p, PSTR("reattach")))
	81	options \|= DRV_OPT_REATTATCH;
	82	else
	83	return CMD_RET_USAGE;
	84
	85	p = strtok_P(NULL, delim);
	86	}
	87	}
	88	break;
	89	default: /* '?' */
	90	return CMD_RET_USAGE;
	91	}
	92	}
	93
	94	/* remaining arguments */
	95	argc -= optind;
4122fe90 L	96	if ( !( (argc == 0 && detach && detach_all) \|\|
	97	(argc == 1 && detach) \|\|
	98	(argc == 1 && (options & DRV_OPT_REATTATCH)) \|\|
	99	argc == 2) )
cb4fb1ed L	100	return CMD_RET_USAGE;
cb4fb1ed L	101
4122fe90	102	if (argc > 0 && ((strlen(argv[optind]) != 4) \|\|
cb4fb1ed	103	strncmp_P(argv[optind], PSTR("dsk"), 3) \|\|
4122fe90	104	(unit = argv[optind][3] - '0') >= CONFIG_CPM_MAX_DRIVE)) {
cb4fb1ed	105
5e8ac5e0	106	cmd_error(CMD_RET_FAILURE, 0, PSTR("Invalid device: '%s'"), argv[optind]);
cb4fb1ed L	107	}
	108
	109	if (detach) {
4122fe90 L	110	if (detach_all)
	111	for (uint8_t i = 0; i < CONFIG_CPM_MAX_DRIVE; i++)
	112	drv_detach(i);
	113	else
	114	drv_detach(unit);
cb4fb1ed L	115	return CMD_RET_SUCCESS;
	116	}
	117
	118	if (argc == 2)
	119	filename = argv[++optind];
	120
	121	res = drv_attach(unit, filename, options);
	122	if (res)
5e8ac5e0	123	cmd_error(CMD_RET_FAILURE, res, PSTR("Attachment of '%s' to dsk%d failed"), filename, unit);
cb4fb1ed	124
5e8ac5e0	125	return CMD_RET_SUCCESS;
cb4fb1ed	126	}