Adds console simio device class

The console simio device class shows in the logs and or console
any byte written to its base address.

Makefile

@@ -152,6 +152,7 @@ OBJ=\
     simio/simio_wdt.o \
     simio/simio_hwmult.o \
     simio/simio_gpio.o \
+    simio/simio_console.o \
     ui/gdb.o \
     ui/rtools.o \
     ui/sym.o \

simio/simio.c

@@ -30,13 +30,15 @@
 #include "simio_wdt.h"
 #include "simio_hwmult.h"
 #include "simio_gpio.h"
+#include "simio_console.h"
 
 static const struct simio_class *const class_db[] = {
 	&simio_tracer,
 	&simio_timer,
 	&simio_wdt,
 	&simio_hwmult,
-	&simio_gpio
+	&simio_gpio,
+	&simio_console
 };
 
 /* Simulator data. We keep a list of devices on the bus, and the special

simio/simio_console.c

@@ -0,0 +1,139 @@
+/* MSPDebug - debugging tool for MSP430 MCUs
+ * Copyright (C) 2012 Unai Uribarri Rodriguez
+ *
+ * This program is free software; you can redisgibute 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 disgibuted 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ */
+
+#include <stdlib.h>
+#include <string.h>
+
+#include "simio_device.h"
+#include "simio_console.h"
+#include "expr.h"
+#include "output.h"
+
+
+struct console {
+	struct simio_device	base;
+
+	/* Base address */
+	address_t		base_addr;
+	char			buffer[256];
+	unsigned		buffer_offset;
+};
+
+static struct simio_device *console_create(char **arg_text)
+{
+	struct console *c;
+
+	(void)arg_text;
+
+	c = malloc(sizeof(*c));
+	if (!c) {
+		pr_error("console: can't allocate memory");
+		return NULL;
+	}
+
+	memset(c, 0, sizeof(*c));
+	c->base.type = &simio_console;
+	c->base_addr = 0xFF;
+	c->buffer_offset = 0;
+	return (struct simio_device *)c;
+}
+
+static void console_destroy(struct simio_device *dev)
+{
+	struct console *c = (struct console *)dev;
+	free(c);
+}
+
+static void console_reset(struct simio_device *dev)
+{
+	struct console *c = (struct console *)dev;
+	c->buffer_offset = 0;
+}
+
+static int config_addr(address_t *addr, char **arg_text)
+{
+	char *text = get_arg(arg_text);
+
+	if (!text) {
+		printc_err("console: config: expected address\n");
+		return -1;
+	}
+
+	if (expr_eval(text, addr) < 0) {
+		printc_err("console: can't parse address: %s\n", text);
+		return -1;
+	}
+
+	return 0;
+}
+
+static int console_config(struct simio_device *dev,
+			const char *param, char **arg_text)
+{
+	struct console *c = (struct console *)dev;
+
+	if (!strcasecmp(param, "base"))
+	{
+		return config_addr(&c->base_addr, arg_text);
+	}
+
+	printc_err("console: config: unknown parameter: %s\n", param);
+	return -1;
+}
+
+static int console_info(struct simio_device *dev)
+{
+	struct console *c = (struct console *)dev;
+	printc("Base address:   0x%04x\n", c->base_addr);
+	printc("Buffer:         %.*s\n", c->buffer_offset, c->buffer);
+	return 0;
+}
+
+static int console_write_b(struct simio_device *dev,
+			address_t addr, uint8_t data)
+{
+	struct console *c = (struct console *)dev;
+	if (addr == c->base_addr)
+	{
+		c->buffer[c->buffer_offset++] = data;
+		if (data == '\n' || c->buffer_offset == sizeof c->buffer)
+		{
+			printc("%.*s", c->buffer_offset, c->buffer);
+			c->buffer_offset = 0;
+		}
+	}
+	return 1;
+}
+
+const struct simio_class simio_console = {
+	.name = "console",
+	.help =
+"This peripheral prints to stdout every byte written to base address\n"
+"\n"
+"Config arguments are:\n"
+"    base <address>\n"
+"        Set the peripheral base address. Defaults to 0x00FF\n"
+"\n",
+
+	.create			= console_create,
+	.destroy		= console_destroy,
+	.reset			= console_reset,
+	.config			= console_config,
+	.info			= console_info,
+	.write_b		= console_write_b,
+};

simio/simio_console.h

@@ -0,0 +1,24 @@
+/* MSPDebug - debugging tool for MSP430 MCUs
+ * Copyright (C) 2012 Unai Uribarri
+ *
+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ */
+
+#ifndef SIMIO_CONSOLE_H_
+#define SIMIO_CONSOLE_H_
+
+extern const struct simio_class simio_console;
+
+#endif