X-Git-Url: http://cloudbase.mooo.com/gitweb/z180-stamp.git/blobdiff_plain/889202c46ced1be4fc0db3faf63564722eba2865..1157e75889d3d6d23d1e2514f401cd5b354bd149:/avr/cmd_misc.c

diff --git a/avr/cmd_misc.c b/avr/cmd_misc.c
index 7ab8fef..c9a3c45 100644
--- a/avr/cmd_misc.c
+++ b/avr/cmd_misc.c
@@ -1,4 +1,6 @@
 /*
+ * (C) Copyright 2014 Leo C. <erbl259-lmu@yahoo.de>
+ *
  * Copyright 2000-2009
  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  *
@@ -6,53 +8,82 @@
  */
 
 #include "common.h"
+#include <stdlib.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[])
 {
-	uint_fast8_t putnl = 1;
-	
+	bool put_newline = true;
+
 	(void) cmdtp; (void) flag;
 
-	for (uint_fast8_t i = 1; i < argc; i++) {
+	/* reset getopt() */
+	optind = 1;
 
-		uint_fast8_t backslash = 0;
-		char *p = argv[i];
-		char c;
-		
-		if (i != 1)
-			putchar(' ');
-		while ((c = *p++) != '\0') {
-		
-			if(backslash) {
-				backslash = 0;
-				if (c == 'c') {
-					putnl = 0;
-					continue;
-				} else
-					putchar('\\');
-			} else {
-				if (c == '\\') {
-					backslash = 1;
-					continue;
-				}
-			}
-			putchar(c);
+	int opt;
+	while ((opt = getopt(argc, argv, PSTR("n"))) != -1) {
+		switch (opt) {
+		case 'n':
+			put_newline = false;
+			break;
+		default: /* '?' */
+			return CMD_RET_USAGE;
 		}
-	}			
-					
-	if (putnl)
+	}
+
+	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;
 }
 
-#if 0
-U_BOOT_CMD(
-	echo,	CONFIG_SYS_MAXARGS,	1,	do_echo,
-	"echo args to console",
-	"[args..]\n"
-	"    - echo args to console; \\c suppresses newline"
-);
-#endif
+
+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 = strtoul(argv[1], &sp, 10);
+
+	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;
+}