140 lines
3.2 KiB
C
140 lines
3.2 KiB
C
/* 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,
|
|
};
|