143 lines
3.4 KiB
C
143 lines
3.4 KiB
C
/* UART model.
|
|
|
|
Copyright (C) 1996-2016 Free Software Foundation, Inc.
|
|
Contributed by Cygnus Solutions and Mike Frysinger.
|
|
|
|
This file is part of simulators.
|
|
|
|
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 3 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, see <http://www.gnu.org/licenses/>. */
|
|
|
|
#include "config.h"
|
|
|
|
#include "sim-main.h"
|
|
#include "hw-main.h"
|
|
|
|
#include "dv-sockser.h"
|
|
#include "dv-m32r_uart.h"
|
|
|
|
struct m32r_uart
|
|
{
|
|
};
|
|
|
|
static unsigned
|
|
m32r_uart_io_write_buffer (struct hw *me, const void *source,
|
|
int space, address_word addr, unsigned nr_bytes)
|
|
{
|
|
SIM_DESC sd = hw_system (me);
|
|
struct m32r_uart *uart = hw_data (me);
|
|
int status = dv_sockser_status (sd);
|
|
|
|
switch (addr)
|
|
{
|
|
case UART_OUTCHAR_ADDR:
|
|
if (status & DV_SOCKSER_DISCONNECTED)
|
|
{
|
|
sim_io_write_stdout (sd, source, nr_bytes);
|
|
sim_io_flush_stdout (sd);
|
|
}
|
|
else
|
|
{
|
|
/* Normalize errors to a value of 0. */
|
|
int ret = dv_sockser_write_buffer (sd, source, nr_bytes);
|
|
if (ret < 0)
|
|
nr_bytes = 0;
|
|
}
|
|
break;
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
static unsigned
|
|
m32r_uart_io_read_buffer (struct hw *me, void *dest,
|
|
int space, address_word addr, unsigned nr_bytes)
|
|
{
|
|
SIM_DESC sd = hw_system (me);
|
|
struct m32r_uart *uart = hw_data (me);
|
|
int status = dv_sockser_status (sd);
|
|
|
|
switch (addr)
|
|
{
|
|
case UART_INCHAR_ADDR:
|
|
if (status & DV_SOCKSER_DISCONNECTED)
|
|
{
|
|
int ret = sim_io_poll_read (sd, 0/*STDIN*/, dest, 1);
|
|
return (ret < 0) ? 0 : 1;
|
|
}
|
|
else
|
|
{
|
|
char *buffer = dest;
|
|
buffer[0] = dv_sockser_read (sd);
|
|
return 1;
|
|
}
|
|
case UART_STATUS_ADDR:
|
|
{
|
|
unsigned char *p = dest;
|
|
p[0] = 0;
|
|
p[1] = (((status & DV_SOCKSER_INPUT_EMPTY)
|
|
#ifdef UART_INPUT_READY0
|
|
? UART_INPUT_READY : 0)
|
|
#else
|
|
? 0 : UART_INPUT_READY)
|
|
#endif
|
|
+ ((status & DV_SOCKSER_OUTPUT_EMPTY) ? UART_OUTPUT_READY : 0));
|
|
return 2;
|
|
}
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
static void
|
|
attach_m32r_uart_regs (struct hw *me, struct m32r_uart *uart)
|
|
{
|
|
address_word attach_address;
|
|
int attach_space;
|
|
unsigned attach_size;
|
|
reg_property_spec reg;
|
|
|
|
if (hw_find_property (me, "reg") == NULL)
|
|
hw_abort (me, "Missing \"reg\" property");
|
|
|
|
if (!hw_find_reg_array_property (me, "reg", 0, ®))
|
|
hw_abort (me, "\"reg\" property must contain three addr/size entries");
|
|
|
|
hw_unit_address_to_attach_address (hw_parent (me),
|
|
®.address,
|
|
&attach_space, &attach_address, me);
|
|
hw_unit_size_to_attach_size (hw_parent (me), ®.size, &attach_size, me);
|
|
|
|
hw_attach_address (hw_parent (me),
|
|
0, attach_space, attach_address, attach_size, me);
|
|
}
|
|
|
|
static void
|
|
m32r_uart_finish (struct hw *me)
|
|
{
|
|
struct m32r_uart *uart;
|
|
|
|
uart = HW_ZALLOC (me, struct m32r_uart);
|
|
|
|
set_hw_data (me, uart);
|
|
set_hw_io_read_buffer (me, m32r_uart_io_read_buffer);
|
|
set_hw_io_write_buffer (me, m32r_uart_io_write_buffer);
|
|
|
|
attach_m32r_uart_regs (me, uart);
|
|
}
|
|
|
|
const struct hw_descriptor dv_m32r_uart_descriptor[] =
|
|
{
|
|
{"m32r_uart", m32r_uart_finish,},
|
|
{NULL, NULL},
|
|
};
|