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

diff --git a/avr/cmd_misc.c b/avr/cmd_misc.c
index 7ab8fef..b29aedd 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,13 +8,17 @@
  */
 
 #include "common.h"
+#include <stdlib.h>
+
 #include "command.h"
+#include "timer.h"
+#include "con-utils.h"
 
 
 command_ret_t do_echo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
 	uint_fast8_t putnl = 1;
-	
+
 	(void) cmdtp; (void) flag;
 
 	for (uint_fast8_t i = 1; i < argc; i++) {
@@ -20,11 +26,11 @@ command_ret_t do_echo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 		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') {
@@ -40,19 +46,47 @@ command_ret_t do_echo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 			}
 			putchar(c);
 		}
-	}			
-					
+	}
+
 	if (putnl)
 		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;
+}