- convert all files to unix line-ending

git-svn-id: svn://svn.berlios.de/openocd/trunk@347 b42882b7-edfa-0310-969c-e2dbd0fdcd60

1 files changed, 607 insertions, 607 deletions

diff --git a/src/helper/command.c b/src/helper/command.c
index f13a86c..15cddcd 100644
--- a/src/helper/command.c
+++ b/src/helper/command.c
@@ -1,607 +1,607 @@
-/***************************************************************************

- *   Copyright (C) 2005 by Dominic Rath                                    *

- *   Dominic.Rath@gmx.de                                                   *

- *                                                                         *

- *   part of this file is taken from libcli (libcli.sourceforge.net)       *

- *   Copyright (C) David Parrish (david@dparrish.com)                      *

- *                                                                         *

- *   This program is free software; you can redistribute it and/or modify  *

- *   it under the terms of the GNU General Public License as published by  *

- *   the Free Software Foundation; either version 2 of the License, or     *

- *   (at your option) any later version.                                   *

- *                                                                         *

- *   This program is distributed in the hope that it will be useful,       *

- *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *

- *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *

- *   GNU General Public License for more details.                          *

- *                                                                         *

- *   You should have received a copy of the GNU General Public License     *

- *   along with this program; if not, write to the                         *

- *   Free Software Foundation, Inc.,                                       *

- *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *

- ***************************************************************************/

-#ifdef HAVE_CONFIG_H

-#include "config.h"

-#endif

-

-#include "replacements.h"

-

-#include "command.h"

-

-#include "log.h"

-#include "time_support.h"

-

-#include <stdlib.h>

-#include <string.h>

-#include <ctype.h>

-#include <stdarg.h>

-#include <stdio.h>

-#include <unistd.h>

-

-void command_print_help_line(command_context_t* context, struct command_s *command, int indent);

-

-int handle_sleep_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);

-int handle_time_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);

-

-int build_unique_lengths(command_context_t *context, command_t *commands)

-{

-	command_t *c, *p;

-

-	/* iterate through all commands */

-	for (c = commands; c; c = c->next)

-	{

-		/* find out how many characters are required to uniquely identify a command */

-		for (c->unique_len = 1; c->unique_len <= strlen(c->name); c->unique_len++)

-		{

-			int foundmatch = 0;

-			

-			/* for every command, see if the current length is enough */

-			for (p = commands; p; p = p->next)

-			{

-				/* ignore the command itself */

-				if (c == p)

-					continue;

-				

-				/* compare commands up to the current length */

-				if (strncmp(p->name, c->name, c->unique_len) == 0)

-					foundmatch++;

-			}

-			

-			/* when none of the commands matched, we've found the minimum length required */

-			if (!foundmatch)

-				break;

-		}

-		

-		/* if the current command has children, build the unique lengths for them */

-		if (c->children)

-			build_unique_lengths(context, c->children);

-	}

-	

-	return ERROR_OK;

-}

-

-/* Avoid evaluating this each time we add a command. Reduces overhead from O(n^2) to O(n). 

- * Makes a difference on ARM7 types machines and is not observable on GHz machines.

- */

-static int unique_length_dirty = 1; 

-

-command_t* register_command(command_context_t *context, command_t *parent, char *name, int (*handler)(struct command_context_s *context, char* name, char** args, int argc), enum command_mode mode, char *help)

-{

-	command_t *c, *p;

-	unique_length_dirty = 1;

-	

-	if (!context || !name)

-		return NULL;

-				

-	c = malloc(sizeof(command_t));

-	

-	c->name = strdup(name);

-	c->parent = parent;

-	c->children = NULL;

-	c->handler = handler;

-	c->mode = mode;

-	if (help)

-		c->help = strdup(help);

-	else

-		c->help = NULL;

-	c->unique_len = 0;

-	c->next = NULL;

-	

-	/* place command in tree */

-	if (parent)

-	{

-		if (parent->children)

-		{

-			/* find last child */

-			for (p = parent->children; p && p->next; p = p->next);

-			if (p)

-				p->next = c;

-		}

-		else

-		{

-			parent->children = c;

-		}

-	}

-	else

-	{

-		if (context->commands)

-		{

-			/* find last command */

-			for (p = context->commands; p && p->next; p = p->next);

-			if (p)

-				p->next = c;

-		}

-		else

-		{

-			context->commands = c;

-		}

-	}

-	

-	return c;

-}

-

-int unregister_command(command_context_t *context, char *name)

-{

-	unique_length_dirty = 1;

-	

-	command_t *c, *p = NULL, *c2;

-	

-	if ((!context) || (!name))

-		return ERROR_INVALID_ARGUMENTS;

-	

-	/* find command */

-	for (c = context->commands; c; c = c->next)

-	{

-		if (strcmp(name, c->name) == 0)

-		{

-			/* unlink command */

-			if (p)

-			{

-				p->next = c->next;

-			}

-			else

-			{

-				context->commands = c->next;

-			}

-			

-			/* unregister children */

-			if (c->children)

-			{

-				for (c2 = c->children; c2; c2 = c2->next)

-				{

-					free(c2->name);

-					if (c2->help)

-						free(c2->help);

-					free(c2);

-				}

-			}

-			

-			/* delete command */

-			free(c->name);

-			if (c->help)

-				free(c->help);

-			free(c);

-		}

-		

-		/* remember the last command for unlinking */

-		p = c;

-	}

-	

-	return ERROR_OK;

-}

-

-int parse_line(char *line, char *words[], int max_words)

-{

-	int nwords = 0;

-	char *p = line;

-	char *word_start = line;

-	int inquote = 0;

-

-	while (nwords < max_words - 1)

-	{

-		/* check if we reached

-		 * a terminating NUL

-		 * a matching closing quote character " or '

-		 * we're inside a word but not a quote, and the current character is whitespace

-		 */

-		if (!*p || *p == inquote || (word_start && !inquote && isspace(*p)))

-		{

-			/* we're inside a word or quote, and reached its end*/

-			if (word_start)

-			{

-				int len;

-				char *word_end=p;

-				

-				/* This will handle extra whitespace within quotes */

-				while (isspace(*word_start)&&(word_start<word_end))

-					word_start++;

-				while (isspace(*(word_end-1))&&(word_start<word_end))

-					word_end--;

-				len = word_end - word_start;

-				

-				if (len>0)

-				{

-					/* copy the word */

-					memcpy(words[nwords] = malloc(len + 1), word_start, len);

-					/* add terminating NUL */

-					words[nwords++][len] = 0;

-				}

-			}

-			/* we're done parsing the line */

-			if (!*p)

-				break;

-

-			/* skip over trailing quote or whitespace*/

-			if (inquote || isspace(*p))

-				p++;

-			while (isspace(*p))

-				p++;

-			

-			inquote = 0;

-			word_start = 0;

-		}

-		else if (*p == '"' || *p == '\'')

-		{

-			/* we've reached the beginning of a quote */

-			inquote = *p++;

-			word_start = p;

-		}

-		else

-		{

-			/* we've reached the beginning of a new word */

-			if (!word_start)

-				word_start = p;

-			

-			/* normal character, skip */

-			p++;

-		}

-	}

-	

-	return nwords;

-}

-

-void command_print(command_context_t *context, char *format, ...)

-{

-	char *buffer = NULL;

-	int n, size = 0;

-	char *p;

-

-	/* process format string */

-	for (;;)

-	{

-		va_list ap;

-		va_start(ap, format);

-		if (!buffer || (n = vsnprintf(buffer, size, format, ap)) >= size)

-		{

-			/* increase buffer until it fits the whole string */

-			if (!(p = realloc(buffer, size += 4096)))

-			{

-				/* gotta free up */

-				if (buffer)

-					free(buffer);

-				va_end(ap);

-				return;

-			}

-	

-			buffer = p;

-			

-			va_end(ap);

-			continue;

-		}

-		va_end(ap);

-		break;

-	}

-	

-	/* vsnprintf failed */

-	if (n < 0)

-	{

-		if (buffer)

-			free(buffer);

-		return;

-	}

-

-	p = buffer;

-	

-	/* process lines in buffer */

-	do {

-		char *next = strchr(p, '\n');

-		

-		if (next)

-			*next++ = 0;

-

-		if (context->output_handler)

-			context->output_handler(context, p);

-

-		p = next;

-	} while (p);

-	

-	if (buffer)

-		free(buffer);

-}

-

-int find_and_run_command(command_context_t *context, command_t *commands, char *words[], int num_words, int start_word)

-{

-	command_t *c;

-	

-	if (unique_length_dirty)

-	{

-		unique_length_dirty = 0;

-		/* update unique lengths */

-		build_unique_lengths(context, context->commands);

-	}

-	

-	for (c = commands; c; c = c->next)

-	{

-		if (strncasecmp(c->name, words[start_word], c->unique_len))

-			continue;

-

-		if (strncasecmp(c->name, words[start_word], strlen(words[start_word])))

-			continue;

-		

-		if ((context->mode == COMMAND_CONFIG) || (c->mode == COMMAND_ANY) || (c->mode == context->mode) )

-		{

-			if (!c->children)

-			{

-				if (!c->handler)

-				{

-					command_print(context, "No handler for command");

-					break;

-				}

-				else

-				{

-					int retval = c->handler(context, c->name, words + start_word + 1, num_words - start_word - 1);

-					if (retval == ERROR_COMMAND_SYNTAX_ERROR)

-					{

-						command_print(context, "Syntax error:");

-						command_print_help_line(context, c, 0);

-					}

-					return retval; 

-				}

-			}

-			else

-			{

-				if (start_word == num_words - 1)

-				{

-					command_print(context, "Incomplete command");

-					break;

-				}

-				return find_and_run_command(context, c->children, words, num_words, start_word + 1);

-			}

-		}

-	}

-	

-	command_print(context, "Command %s not found", words[start_word]);

-	return ERROR_OK;

-}

-

-int command_run_line(command_context_t *context, char *line)

-{

-	int nwords;

-	char *words[128] = {0};

-	int retval;

-	int i;

-	

-	if ((!context) || (!line))

-		return ERROR_INVALID_ARGUMENTS;

-	

-	/* skip preceding whitespace */

-	while (isspace(*line))

-		line++;

-	

-	/* empty line, ignore */

-	if (!*line)

-		return ERROR_OK;

-	

-	/* ignore comments */

-	if (*line && (line[0] == '#'))

-		return ERROR_OK;

-	

-	if (context->echo)

-	{

-		command_print(context, "%s", line);

-	}

-

-	nwords = parse_line(line, words, sizeof(words) / sizeof(words[0]));

-	

-	if (nwords > 0)

-		retval = find_and_run_command(context, context->commands, words, nwords, 0);

-	else

-		return ERROR_INVALID_ARGUMENTS;

-	

-	for (i = 0; i < nwords; i++)

-		free(words[i]);

-	

-	return retval;

-}

-

-int command_run_file(command_context_t *context, FILE *file, enum command_mode mode)

-{

-	int retval = ERROR_OK;

-	int old_command_mode;

-	char *buffer=malloc(4096);

-	if (buffer==NULL)

-	{

-		return ERROR_INVALID_ARGUMENTS;

-	}

-	

-	old_command_mode = context->mode;

-	context->mode = mode;

-	

-	while (fgets(buffer, 4096, file))

-	{

-		char *p;

-		char *cmd, *end;

-		

-		/* stop processing line after a comment (#, !) or a LF, CR were encountered */

-		if ((p = strpbrk(buffer, "#!\r\n")))

-			*p = 0;

-

-		/* skip over leading whitespace */

-		cmd = buffer;

-		while (isspace(*cmd))

-			cmd++;

-

-		/* empty (all whitespace) line? */

-		if (!*cmd)

-			continue;

-		

-		/* search the end of the current line, ignore trailing whitespace */

-		for (p = end = cmd; *p; p++)

-			if (!isspace(*p))

-				end = p;

-		

-		/* terminate end */

-		*++end = 0;

-		if (strcasecmp(cmd, "quit") == 0)

-			break;

-

-		/* run line */

-		if ((retval = command_run_line(context, cmd)) == ERROR_COMMAND_CLOSE_CONNECTION)

-			break;

-	}

-	

-	context->mode = old_command_mode;

-

-	

-	free(buffer);

-	

-	return retval;

-}

-

-void command_print_help_line(command_context_t* context, struct command_s *command, int indent)

-{

-	command_t *c;

-	char indents[32] = {0};

-	char *help = "no help available";

-	char name_buf[64];

-	int i;

-	

-	for (i = 0; i < indent; i+=2)

-	{

-		indents[i*2] = ' ';

-		indents[i*2+1] = '-';

-	}

-	indents[i*2] = 0;

-	

-	if (command->help)

-		help = command->help;

-		

-	snprintf(name_buf, 64, command->name);

-	strncat(name_buf, indents, 64);

-	command_print(context, "%20s\t%s", name_buf, help);

-	

-	if (command->children)

-	{

-		for (c = command->children; c; c = c->next)

-		{

-			command_print_help_line(context, c, indent + 1);

-		}

-	}

-}

-

-int command_print_help(command_context_t* context, char* name, char** args, int argc)

-{

-	command_t *c;

-

-	for (c = context->commands; c; c = c->next)

-	{

-		if (argc == 1)

-		{

-			 if (strncasecmp(c->name, args[0], c->unique_len))

-				 continue;

-

-			 if (strncasecmp(c->name, args[0], strlen(args[0])))

-				 continue;

-		} 

-

-		command_print_help_line(context, c, 0);

-	}

-	

-	return ERROR_OK;

-}

-

-void command_set_output_handler(command_context_t* context, int (*output_handler)(struct command_context_s *context, char* line), void *priv)

-{

-	context->output_handler = output_handler;

-	context->output_handler_priv = priv;

-}

-

-command_context_t* copy_command_context(command_context_t* context)

-{

-	command_context_t* copy_context = malloc(sizeof(command_context_t));

-

-	*copy_context = *context;

-	

-	return copy_context;

-}

-

-int command_done(command_context_t *context)

-{

-	free(context);

-	context = NULL;

-	

-	return ERROR_OK;

-}

-

-command_context_t* command_init()

-{

-	command_context_t* context = malloc(sizeof(command_context_t));

-	

-	context->mode = COMMAND_EXEC;

-	context->commands = NULL;

-	context->current_target = 0;

-	context->echo = 0;

-	context->output_handler = NULL;

-	context->output_handler_priv = NULL;

-	

-	register_command(context, NULL, "help", command_print_help,

-					 COMMAND_EXEC, "display this help");

-	

-	register_command(context, NULL, "sleep", handle_sleep_command,

-					 COMMAND_ANY, "sleep for <n> milliseconds");

-	

-	register_command(context, NULL, "time", handle_time_command,

-					 COMMAND_ANY, "time <cmd + args> - execute <cmd + args> and print time it took");

-	

-	return context;

-}

-

-/* sleep command sleeps for <n> miliseconds

- * this is useful in target startup scripts

- */

-int handle_sleep_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)

-{

-	unsigned long duration = 0;

-	

-	if (argc == 1)

-	{

-		duration = strtoul(args[0], NULL, 0);

-		usleep(duration * 1000);

-	}

-

-	return ERROR_OK;

-}

-

-int handle_time_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)

-{

-	if (argc<1)

-		return ERROR_COMMAND_SYNTAX_ERROR;

-	

-	duration_t duration;

-	char *duration_text;

-	int retval;

-	

-	duration_start_measure(&duration);

-	

-	retval = find_and_run_command(cmd_ctx, cmd_ctx->commands, args, argc, 0);

-	

-	duration_stop_measure(&duration, &duration_text);

-	

-	float t=duration.duration.tv_sec;

-	t+=((float)duration.duration.tv_usec / 1000000.0);

-	command_print(cmd_ctx, "%s took %fs", args[0], t);

-	

-	free(duration_text);

-

-	return retval;

-}

+/***************************************************************************
+ *   Copyright (C) 2005 by Dominic Rath                                    *
+ *   Dominic.Rath@gmx.de                                                   *
+ *                                                                         *
+ *   part of this file is taken from libcli (libcli.sourceforge.net)       *
+ *   Copyright (C) David Parrish (david@dparrish.com)                      *
+ *                                                                         *
+ *   This program is free software; you can redistribute it and/or modify  *
+ *   it under the terms of the GNU General Public License as published by  *
+ *   the Free Software Foundation; either version 2 of the License, or     *
+ *   (at your option) any later version.                                   *
+ *                                                                         *
+ *   This program is distributed in the hope that it will be useful,       *
+ *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
+ *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
+ *   GNU General Public License for more details.                          *
+ *                                                                         *
+ *   You should have received a copy of the GNU General Public License     *
+ *   along with this program; if not, write to the                         *
+ *   Free Software Foundation, Inc.,                                       *
+ *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
+ ***************************************************************************/
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#include "replacements.h"
+
+#include "command.h"
+
+#include "log.h"
+#include "time_support.h"
+
+#include <stdlib.h>
+#include <string.h>
+#include <ctype.h>
+#include <stdarg.h>
+#include <stdio.h>
+#include <unistd.h>
+
+void command_print_help_line(command_context_t* context, struct command_s *command, int indent);
+
+int handle_sleep_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+int handle_time_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
+
+int build_unique_lengths(command_context_t *context, command_t *commands)
+{
+	command_t *c, *p;
+
+	/* iterate through all commands */
+	for (c = commands; c; c = c->next)
+	{
+		/* find out how many characters are required to uniquely identify a command */
+		for (c->unique_len = 1; c->unique_len <= strlen(c->name); c->unique_len++)
+		{
+			int foundmatch = 0;
+			
+			/* for every command, see if the current length is enough */
+			for (p = commands; p; p = p->next)
+			{
+				/* ignore the command itself */
+				if (c == p)
+					continue;
+				
+				/* compare commands up to the current length */
+				if (strncmp(p->name, c->name, c->unique_len) == 0)
+					foundmatch++;
+			}
+			
+			/* when none of the commands matched, we've found the minimum length required */
+			if (!foundmatch)
+				break;
+		}
+		
+		/* if the current command has children, build the unique lengths for them */
+		if (c->children)
+			build_unique_lengths(context, c->children);
+	}
+	
+	return ERROR_OK;
+}
+
+/* Avoid evaluating this each time we add a command. Reduces overhead from O(n^2) to O(n). 
+ * Makes a difference on ARM7 types machines and is not observable on GHz machines.
+ */
+static int unique_length_dirty = 1; 
+
+command_t* register_command(command_context_t *context, command_t *parent, char *name, int (*handler)(struct command_context_s *context, char* name, char** args, int argc), enum command_mode mode, char *help)
+{
+	command_t *c, *p;
+	unique_length_dirty = 1;
+	
+	if (!context || !name)
+		return NULL;
+				
+	c = malloc(sizeof(command_t));
+	
+	c->name = strdup(name);
+	c->parent = parent;
+	c->children = NULL;
+	c->handler = handler;
+	c->mode = mode;
+	if (help)
+		c->help = strdup(help);
+	else
+		c->help = NULL;
+	c->unique_len = 0;
+	c->next = NULL;
+	
+	/* place command in tree */
+	if (parent)
+	{
+		if (parent->children)
+		{
+			/* find last child */
+			for (p = parent->children; p && p->next; p = p->next);
+			if (p)
+				p->next = c;
+		}
+		else
+		{
+			parent->children = c;
+		}
+	}
+	else
+	{
+		if (context->commands)
+		{
+			/* find last command */
+			for (p = context->commands; p && p->next; p = p->next);
+			if (p)
+				p->next = c;
+		}
+		else
+		{
+			context->commands = c;
+		}
+	}
+	
+	return c;
+}
+
+int unregister_command(command_context_t *context, char *name)
+{
+	unique_length_dirty = 1;
+	
+	command_t *c, *p = NULL, *c2;
+	
+	if ((!context) || (!name))
+		return ERROR_INVALID_ARGUMENTS;
+	
+	/* find command */
+	for (c = context->commands; c; c = c->next)
+	{
+		if (strcmp(name, c->name) == 0)
+		{
+			/* unlink command */
+			if (p)
+			{
+				p->next = c->next;
+			}
+			else
+			{
+				context->commands = c->next;
+			}
+			
+			/* unregister children */
+			if (c->children)
+			{
+				for (c2 = c->children; c2; c2 = c2->next)
+				{
+					free(c2->name);
+					if (c2->help)
+						free(c2->help);
+					free(c2);
+				}
+			}
+			
+			/* delete command */
+			free(c->name);
+			if (c->help)
+				free(c->help);
+			free(c);
+		}
+		
+		/* remember the last command for unlinking */
+		p = c;
+	}
+	
+	return ERROR_OK;
+}
+
+int parse_line(char *line, char *words[], int max_words)
+{
+	int nwords = 0;
+	char *p = line;
+	char *word_start = line;
+	int inquote = 0;
+
+	while (nwords < max_words - 1)
+	{
+		/* check if we reached
+		 * a terminating NUL
+		 * a matching closing quote character " or '
+		 * we're inside a word but not a quote, and the current character is whitespace
+		 */
+		if (!*p || *p == inquote || (word_start && !inquote && isspace(*p)))
+		{
+			/* we're inside a word or quote, and reached its end*/
+			if (word_start)
+			{
+				int len;
+				char *word_end=p;
+				
+				/* This will handle extra whitespace within quotes */
+				while (isspace(*word_start)&&(word_start<word_end))
+					word_start++;
+				while (isspace(*(word_end-1))&&(word_start<word_end))
+					word_end--;
+				len = word_end - word_start;
+				
+				if (len>0)
+				{
+					/* copy the word */
+					memcpy(words[nwords] = malloc(len + 1), word_start, len);
+					/* add terminating NUL */
+					words[nwords++][len] = 0;
+				}
+			}
+			/* we're done parsing the line */
+			if (!*p)
+				break;
+
+			/* skip over trailing quote or whitespace*/
+			if (inquote || isspace(*p))
+				p++;
+			while (isspace(*p))
+				p++;
+			
+			inquote = 0;
+			word_start = 0;
+		}
+		else if (*p == '"' || *p == '\'')
+		{
+			/* we've reached the beginning of a quote */
+			inquote = *p++;
+			word_start = p;
+		}
+		else
+		{
+			/* we've reached the beginning of a new word */
+			if (!word_start)
+				word_start = p;
+			
+			/* normal character, skip */
+			p++;
+		}
+	}
+	
+	return nwords;
+}
+
+void command_print(command_context_t *context, char *format, ...)
+{
+	char *buffer = NULL;
+	int n, size = 0;
+	char *p;
+
+	/* process format string */
+	for (;;)
+	{
+		va_list ap;
+		va_start(ap, format);
+		if (!buffer || (n = vsnprintf(buffer, size, format, ap)) >= size)
+		{
+			/* increase buffer until it fits the whole string */
+			if (!(p = realloc(buffer, size += 4096)))
+			{
+				/* gotta free up */
+				if (buffer)
+					free(buffer);
+				va_end(ap);
+				return;
+			}
+	
+			buffer = p;
+			
+			va_end(ap);
+			continue;
+		}
+		va_end(ap);
+		break;
+	}
+	
+	/* vsnprintf failed */
+	if (n < 0)
+	{
+		if (buffer)
+			free(buffer);
+		return;
+	}
+
+	p = buffer;
+	
+	/* process lines in buffer */
+	do {
+		char *next = strchr(p, '\n');
+		
+		if (next)
+			*next++ = 0;
+
+		if (context->output_handler)
+			context->output_handler(context, p);
+
+		p = next;
+	} while (p);
+	
+	if (buffer)
+		free(buffer);
+}
+
+int find_and_run_command(command_context_t *context, command_t *commands, char *words[], int num_words, int start_word)
+{
+	command_t *c;
+	
+	if (unique_length_dirty)
+	{
+		unique_length_dirty = 0;
+		/* update unique lengths */
+		build_unique_lengths(context, context->commands);
+	}
+	
+	for (c = commands; c; c = c->next)
+	{
+		if (strncasecmp(c->name, words[start_word], c->unique_len))
+			continue;
+
+		if (strncasecmp(c->name, words[start_word], strlen(words[start_word])))
+			continue;
+		
+		if ((context->mode == COMMAND_CONFIG) || (c->mode == COMMAND_ANY) || (c->mode == context->mode) )
+		{
+			if (!c->children)
+			{
+				if (!c->handler)
+				{
+					command_print(context, "No handler for command");
+					break;
+				}
+				else
+				{
+					int retval = c->handler(context, c->name, words + start_word + 1, num_words - start_word - 1);
+					if (retval == ERROR_COMMAND_SYNTAX_ERROR)
+					{
+						command_print(context, "Syntax error:");
+						command_print_help_line(context, c, 0);
+					}
+					return retval; 
+				}
+			}
+			else
+			{
+				if (start_word == num_words - 1)
+				{
+					command_print(context, "Incomplete command");
+					break;
+				}
+				return find_and_run_command(context, c->children, words, num_words, start_word + 1);
+			}
+		}
+	}
+	
+	command_print(context, "Command %s not found", words[start_word]);
+	return ERROR_OK;
+}
+
+int command_run_line(command_context_t *context, char *line)
+{
+	int nwords;
+	char *words[128] = {0};
+	int retval;
+	int i;
+	
+	if ((!context) || (!line))
+		return ERROR_INVALID_ARGUMENTS;
+	
+	/* skip preceding whitespace */
+	while (isspace(*line))
+		line++;
+	
+	/* empty line, ignore */
+	if (!*line)
+		return ERROR_OK;
+	
+	/* ignore comments */
+	if (*line && (line[0] == '#'))
+		return ERROR_OK;
+	
+	if (context->echo)
+	{
+		command_print(context, "%s", line);
+	}
+
+	nwords = parse_line(line, words, sizeof(words) / sizeof(words[0]));
+	
+	if (nwords > 0)
+		retval = find_and_run_command(context, context->commands, words, nwords, 0);
+	else
+		return ERROR_INVALID_ARGUMENTS;
+	
+	for (i = 0; i < nwords; i++)
+		free(words[i]);
+	
+	return retval;
+}
+
+int command_run_file(command_context_t *context, FILE *file, enum command_mode mode)
+{
+	int retval = ERROR_OK;
+	int old_command_mode;
+	char *buffer=malloc(4096);
+	if (buffer==NULL)
+	{
+		return ERROR_INVALID_ARGUMENTS;
+	}
+	
+	old_command_mode = context->mode;
+	context->mode = mode;
+	
+	while (fgets(buffer, 4096, file))
+	{
+		char *p;
+		char *cmd, *end;
+		
+		/* stop processing line after a comment (#, !) or a LF, CR were encountered */
+		if ((p = strpbrk(buffer, "#!\r\n")))
+			*p = 0;
+
+		/* skip over leading whitespace */
+		cmd = buffer;
+		while (isspace(*cmd))
+			cmd++;
+
+		/* empty (all whitespace) line? */
+		if (!*cmd)
+			continue;
+		
+		/* search the end of the current line, ignore trailing whitespace */
+		for (p = end = cmd; *p; p++)
+			if (!isspace(*p))
+				end = p;
+		
+		/* terminate end */
+		*++end = 0;
+		if (strcasecmp(cmd, "quit") == 0)
+			break;
+
+		/* run line */
+		if ((retval = command_run_line(context, cmd)) == ERROR_COMMAND_CLOSE_CONNECTION)
+			break;
+	}
+	
+	context->mode = old_command_mode;
+
+	
+	free(buffer);
+	
+	return retval;
+}
+
+void command_print_help_line(command_context_t* context, struct command_s *command, int indent)
+{
+	command_t *c;
+	char indents[32] = {0};
+	char *help = "no help available";
+	char name_buf[64];
+	int i;
+	
+	for (i = 0; i < indent; i+=2)
+	{
+		indents[i*2] = ' ';
+		indents[i*2+1] = '-';
+	}
+	indents[i*2] = 0;
+	
+	if (command->help)
+		help = command->help;
+		
+	snprintf(name_buf, 64, command->name);
+	strncat(name_buf, indents, 64);
+	command_print(context, "%20s\t%s", name_buf, help);
+	
+	if (command->children)
+	{
+		for (c = command->children; c; c = c->next)
+		{
+			command_print_help_line(context, c, indent + 1);
+		}
+	}
+}
+
+int command_print_help(command_context_t* context, char* name, char** args, int argc)
+{
+	command_t *c;
+
+	for (c = context->commands; c; c = c->next)
+	{
+		if (argc == 1)
+		{
+			 if (strncasecmp(c->name, args[0], c->unique_len))
+				 continue;
+
+			 if (strncasecmp(c->name, args[0], strlen(args[0])))
+				 continue;
+		} 
+
+		command_print_help_line(context, c, 0);
+	}
+	
+	return ERROR_OK;
+}
+
+void command_set_output_handler(command_context_t* context, int (*output_handler)(struct command_context_s *context, char* line), void *priv)
+{
+	context->output_handler = output_handler;
+	context->output_handler_priv = priv;
+}
+
+command_context_t* copy_command_context(command_context_t* context)
+{
+	command_context_t* copy_context = malloc(sizeof(command_context_t));
+
+	*copy_context = *context;
+	
+	return copy_context;
+}
+
+int command_done(command_context_t *context)
+{
+	free(context);
+	context = NULL;
+	
+	return ERROR_OK;
+}
+
+command_context_t* command_init()
+{
+	command_context_t* context = malloc(sizeof(command_context_t));
+	
+	context->mode = COMMAND_EXEC;
+	context->commands = NULL;
+	context->current_target = 0;
+	context->echo = 0;
+	context->output_handler = NULL;
+	context->output_handler_priv = NULL;
+	
+	register_command(context, NULL, "help", command_print_help,
+					 COMMAND_EXEC, "display this help");
+	
+	register_command(context, NULL, "sleep", handle_sleep_command,
+					 COMMAND_ANY, "sleep for <n> milliseconds");
+	
+	register_command(context, NULL, "time", handle_time_command,
+					 COMMAND_ANY, "time <cmd + args> - execute <cmd + args> and print time it took");
+	
+	return context;
+}
+
+/* sleep command sleeps for <n> miliseconds
+ * this is useful in target startup scripts
+ */
+int handle_sleep_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+	unsigned long duration = 0;
+	
+	if (argc == 1)
+	{
+		duration = strtoul(args[0], NULL, 0);
+		usleep(duration * 1000);
+	}
+
+	return ERROR_OK;
+}
+
+int handle_time_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+	if (argc<1)
+		return ERROR_COMMAND_SYNTAX_ERROR;
+	
+	duration_t duration;
+	char *duration_text;
+	int retval;
+	
+	duration_start_measure(&duration);
+	
+	retval = find_and_run_command(cmd_ctx, cmd_ctx->commands, args, argc, 0);
+	
+	duration_stop_measure(&duration, &duration_text);
+	
+	float t=duration.duration.tv_sec;
+	t+=((float)duration.duration.tv_usec / 1000000.0);
+	command_print(cmd_ctx, "%s took %fs", args[0], t);
+	
+	free(duration_text);
+
+	return retval;
+}