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

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

#include "common.h"
#include "eval_arg.h"
#include <stdbool.h>

#include "command.h"
#include "timer.h"
#include "con-utils.h"
#include "getopt-min.h"


command_ret_t do_echo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
{
	bool put_newline = true;

	(void) cmdtp; (void) flag;

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

	int opt;
	while ((opt = getopt(argc, argv, PSTR("n"))) != -1) {
		switch (opt) {
		case 'n':
			put_newline = false;
			break;
		default: /* '?' */
			return CMD_RET_USAGE;
		}
	}

	for (uint_fast8_t i = optind; i < argc; i++) {

		if (i != optind)
			putchar(' ');

		my_puts(argv[i]);
	}

	if (put_newline)
		putchar('\n');

	return CMD_RET_SUCCESS;
}


command_ret_t do_sleep(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
{
	unsigned long start = get_timer(0);
	unsigned long delay;
	char *sp;
	uint_fast8_t millisec = 0;

	(void) cmdtp; (void) flag;

	if (argc != 2)
		return CMD_RET_USAGE;

	delay = eval_arg(argv[1], &sp);

	if (*sp == 'm') {
		millisec = 1;
		sp++;
	}
	if (*sp == 's')
		sp++;
	if (*sp != '\0')
		return CMD_RET_USAGE;

	if (!millisec)
		delay *= 1000;

	while (get_timer(start) < delay) {
		if (ctrlc())
			return CMD_RET_FAILURE;

		udelay(100);
	}

	return CMD_RET_SUCCESS;
}
Commit	Line	Data
d684c216	1	/*
2d914b45	2	* (C) Copyright 2014,2016 Leo C. <erbl259-lmu@yahoo.de>
35edb766	3	*
d684c216 L	4	* Copyright 2000-2009
	5	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	6	*
2d914b45	7	* SPDX-License-Identifier: GPL-2.0
d684c216 L	8	*/
	9
	10	#include "common.h"
2d914b45	11	#include "eval_arg.h"
bbd45c46	12	#include <stdbool.h>
8a7decea	13
d684c216	14	#include "command.h"
8a7decea L	15	#include "timer.h"
8a7decea L	16	#include "con-utils.h"
bbd45c46	17	#include "getopt-min.h"
d684c216 L	18
d684c216 L	19
d0581f88	20	command_ret_t do_echo(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
d684c216	21	{
bbd45c46	22	bool put_newline = true;
8a7decea	23
d684c216 L	24	(void) cmdtp; (void) flag;
d684c216 L	25
bbd45c46	26	/* reset getopt() */
beafa6d6	27	optind = 0;
bbd45c46 L	28
	29	int opt;
	30	while ((opt = getopt(argc, argv, PSTR("n"))) != -1) {
	31	switch (opt) {
	32	case 'n':
	33	put_newline = false;
	34	break;
	35	default: /* '?' */
	36	return CMD_RET_USAGE;
	37	}
	38	}
d684c216	39
bbd45c46	40	for (uint_fast8_t i = optind; i < argc; i++) {
8a7decea	41
bbd45c46	42	if (i != optind)
d684c216	43	putchar(' ');
bbd45c46 L	44
bbd45c46 L	45	my_puts(argv[i]);
8a7decea L	46	}
8a7decea L	47
bbd45c46	48	if (put_newline)
d684c216 L	49	putchar('\n');
d684c216 L	50
d0581f88	51	return CMD_RET_SUCCESS;
d684c216 L	52	}
d684c216 L	53
8a7decea L	54
	55	command_ret_t do_sleep(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
	56	{
	57	unsigned long start = get_timer(0);
	58	unsigned long delay;
	59	char *sp;
	60	uint_fast8_t millisec = 0;
	61
	62	(void) cmdtp; (void) flag;
	63
	64	if (argc != 2)
	65	return CMD_RET_USAGE;
	66
2d914b45	67	delay = eval_arg(argv[1], &sp);
8a7decea L	68
	69	if (*sp == 'm') {
	70	millisec = 1;
	71	sp++;
	72	}
	73	if (*sp == 's')
	74	sp++;
	75	if (*sp != '\0')
	76	return CMD_RET_USAGE;
	77
	78	if (!millisec)
	79	delay *= 1000;
	80
	81	while (get_timer(start) < delay) {
	82	if (ctrlc())
	83	return CMD_RET_FAILURE;
	84
	85	udelay(100);
	86	}
	87
	88	return CMD_RET_SUCCESS;
	89	}