481d79819e
The code looks like it should be doing a bit check, not logical. URL: http://sourceware.org/bugzilla/show_bug.cgi?id=9302 Signed-off-by: Mike Frysinger <vapier@gentoo.org>
555 lines
12 KiB
C
555 lines
12 KiB
C
/* This file is part of the program GDB, the GNU debugger.
|
|
|
|
Copyright (C) 1998, 2007, 2008, 2009, 2010, 2011
|
|
Free Software Foundation, Inc.
|
|
Contributed by Cygnus Solutions.
|
|
|
|
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 "sim-main.h"
|
|
#include "hw-main.h"
|
|
|
|
/* DEVICE
|
|
|
|
|
|
mn103iop - mn103002 I/O ports 0-3.
|
|
|
|
|
|
DESCRIPTION
|
|
|
|
Implements the mn103002 i/o ports as described in the mn103002 user guide.
|
|
|
|
|
|
PROPERTIES
|
|
|
|
reg = <ioport-addr> <ioport-size> ...
|
|
|
|
|
|
BUGS
|
|
|
|
*/
|
|
|
|
|
|
/* The I/O ports' registers' address block */
|
|
|
|
struct mn103iop_block {
|
|
unsigned_word base;
|
|
unsigned_word bound;
|
|
};
|
|
|
|
|
|
|
|
enum io_port_register_types {
|
|
P0OUT,
|
|
P1OUT,
|
|
P2OUT,
|
|
P3OUT,
|
|
P0MD,
|
|
P1MD,
|
|
P2MD,
|
|
P3MD,
|
|
P2SS,
|
|
P4SS,
|
|
P0DIR,
|
|
P1DIR,
|
|
P2DIR,
|
|
P3DIR,
|
|
P0IN,
|
|
P1IN,
|
|
P2IN,
|
|
P3IN,
|
|
};
|
|
|
|
#define NR_PORTS 4
|
|
|
|
enum {
|
|
OUTPUT_BLOCK,
|
|
MODE_BLOCK,
|
|
DED_CTRL_BLOCK,
|
|
CTRL_BLOCK,
|
|
PIN_BLOCK,
|
|
NR_BLOCKS
|
|
};
|
|
|
|
typedef struct _mn10300_ioport {
|
|
unsigned8 output, output_mode, control, pin;
|
|
struct hw_event *event;
|
|
} mn10300_ioport;
|
|
|
|
|
|
|
|
struct mn103iop {
|
|
struct mn103iop_block block[NR_BLOCKS];
|
|
mn10300_ioport port[NR_PORTS];
|
|
unsigned8 p2ss, p4ss;
|
|
};
|
|
|
|
|
|
/* Finish off the partially created hw device. Attach our local
|
|
callbacks. Wire up our port names etc */
|
|
|
|
static hw_io_read_buffer_method mn103iop_io_read_buffer;
|
|
static hw_io_write_buffer_method mn103iop_io_write_buffer;
|
|
|
|
static void
|
|
attach_mn103iop_regs (struct hw *me,
|
|
struct mn103iop *io_port)
|
|
{
|
|
int i;
|
|
unsigned_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");
|
|
|
|
for (i=0; i < NR_BLOCKS; ++i )
|
|
{
|
|
if (!hw_find_reg_array_property (me, "reg", i, ®))
|
|
hw_abort (me, "\"reg\" property must contain five addr/size entries");
|
|
hw_unit_address_to_attach_address (hw_parent (me),
|
|
®.address,
|
|
&attach_space,
|
|
&attach_address,
|
|
me);
|
|
io_port->block[i].base = attach_address;
|
|
hw_unit_size_to_attach_size (hw_parent (me),
|
|
®.size,
|
|
&attach_size, me);
|
|
io_port->block[i].bound = attach_address + (attach_size - 1);
|
|
hw_attach_address (hw_parent (me),
|
|
0,
|
|
attach_space, attach_address, attach_size,
|
|
me);
|
|
}
|
|
}
|
|
|
|
static void
|
|
mn103iop_finish (struct hw *me)
|
|
{
|
|
struct mn103iop *io_port;
|
|
int i;
|
|
|
|
io_port = HW_ZALLOC (me, struct mn103iop);
|
|
set_hw_data (me, io_port);
|
|
set_hw_io_read_buffer (me, mn103iop_io_read_buffer);
|
|
set_hw_io_write_buffer (me, mn103iop_io_write_buffer);
|
|
|
|
/* Attach ourself to our parent bus */
|
|
attach_mn103iop_regs (me, io_port);
|
|
|
|
/* Initialize the i/o port registers. */
|
|
for ( i=0; i<NR_PORTS; ++i )
|
|
{
|
|
io_port->port[i].output = 0;
|
|
io_port->port[i].output_mode = 0;
|
|
io_port->port[i].control = 0;
|
|
io_port->port[i].pin = 0;
|
|
}
|
|
io_port->port[2].output_mode = 0xff;
|
|
io_port->p2ss = 0;
|
|
io_port->p4ss = 0x0f;
|
|
}
|
|
|
|
|
|
/* read and write */
|
|
|
|
static int
|
|
decode_addr (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word address)
|
|
{
|
|
unsigned_word offset;
|
|
offset = address - io_port->block[0].base;
|
|
switch (offset)
|
|
{
|
|
case 0x00: return P0OUT;
|
|
case 0x01: return P1OUT;
|
|
case 0x04: return P2OUT;
|
|
case 0x05: return P3OUT;
|
|
case 0x20: return P0MD;
|
|
case 0x21: return P1MD;
|
|
case 0x24: return P2MD;
|
|
case 0x25: return P3MD;
|
|
case 0x44: return P2SS;
|
|
case 0x48: return P4SS;
|
|
case 0x60: return P0DIR;
|
|
case 0x61: return P1DIR;
|
|
case 0x64: return P2DIR;
|
|
case 0x65: return P3DIR;
|
|
case 0x80: return P0IN;
|
|
case 0x81: return P1IN;
|
|
case 0x84: return P2IN;
|
|
case 0x85: return P3IN;
|
|
default:
|
|
{
|
|
hw_abort (me, "bad address");
|
|
return -1;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
static void
|
|
read_output_reg (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word io_port_reg,
|
|
const void *dest,
|
|
unsigned nr_bytes)
|
|
{
|
|
if ( nr_bytes == 1 )
|
|
{
|
|
*(unsigned8 *)dest = io_port->port[io_port_reg].output;
|
|
}
|
|
else
|
|
{
|
|
hw_abort (me, "bad read size of %d bytes from P%dOUT.", nr_bytes,
|
|
io_port_reg);
|
|
}
|
|
}
|
|
|
|
|
|
static void
|
|
read_output_mode_reg (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word io_port_reg,
|
|
const void *dest,
|
|
unsigned nr_bytes)
|
|
{
|
|
if ( nr_bytes == 1 )
|
|
{
|
|
/* check if there are fields which can't be written and
|
|
take appropriate action depending what bits are set */
|
|
*(unsigned8 *)dest = io_port->port[io_port_reg].output_mode;
|
|
}
|
|
else
|
|
{
|
|
hw_abort (me, "bad read size of %d bytes to P%dMD.", nr_bytes,
|
|
io_port_reg);
|
|
}
|
|
}
|
|
|
|
|
|
static void
|
|
read_control_reg (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word io_port_reg,
|
|
const void *dest,
|
|
unsigned nr_bytes)
|
|
{
|
|
if ( nr_bytes == 1 )
|
|
{
|
|
*(unsigned8 *)dest = io_port->port[io_port_reg].control;
|
|
}
|
|
else
|
|
{
|
|
hw_abort (me, "bad read size of %d bytes to P%dDIR.", nr_bytes,
|
|
io_port_reg);
|
|
}
|
|
}
|
|
|
|
|
|
static void
|
|
read_pin_reg (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word io_port_reg,
|
|
const void *dest,
|
|
unsigned nr_bytes)
|
|
{
|
|
if ( nr_bytes == 1 )
|
|
{
|
|
*(unsigned8 *)dest = io_port->port[io_port_reg].pin;
|
|
}
|
|
else
|
|
{
|
|
hw_abort (me, "bad read size of %d bytes to P%dIN.", nr_bytes,
|
|
io_port_reg);
|
|
}
|
|
}
|
|
|
|
|
|
static void
|
|
read_dedicated_control_reg (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word io_port_reg,
|
|
const void *dest,
|
|
unsigned nr_bytes)
|
|
{
|
|
if ( nr_bytes == 1 )
|
|
{
|
|
/* select on io_port_reg: */
|
|
if ( io_port_reg == P2SS )
|
|
{
|
|
*(unsigned8 *)dest = io_port->p2ss;
|
|
}
|
|
else
|
|
{
|
|
*(unsigned8 *)dest = io_port->p4ss;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
hw_abort (me, "bad read size of %d bytes to PSS.", nr_bytes);
|
|
}
|
|
}
|
|
|
|
|
|
static unsigned
|
|
mn103iop_io_read_buffer (struct hw *me,
|
|
void *dest,
|
|
int space,
|
|
unsigned_word base,
|
|
unsigned nr_bytes)
|
|
{
|
|
struct mn103iop *io_port = hw_data (me);
|
|
enum io_port_register_types io_port_reg;
|
|
HW_TRACE ((me, "read 0x%08lx %d", (long) base, (int) nr_bytes));
|
|
|
|
io_port_reg = decode_addr (me, io_port, base);
|
|
switch (io_port_reg)
|
|
{
|
|
/* Port output registers */
|
|
case P0OUT:
|
|
case P1OUT:
|
|
case P2OUT:
|
|
case P3OUT:
|
|
read_output_reg(me, io_port, io_port_reg-P0OUT, dest, nr_bytes);
|
|
break;
|
|
|
|
/* Port output mode registers */
|
|
case P0MD:
|
|
case P1MD:
|
|
case P2MD:
|
|
case P3MD:
|
|
read_output_mode_reg(me, io_port, io_port_reg-P0MD, dest, nr_bytes);
|
|
break;
|
|
|
|
/* Port control registers */
|
|
case P0DIR:
|
|
case P1DIR:
|
|
case P2DIR:
|
|
case P3DIR:
|
|
read_control_reg(me, io_port, io_port_reg-P0DIR, dest, nr_bytes);
|
|
break;
|
|
|
|
/* Port pin registers */
|
|
case P0IN:
|
|
case P1IN:
|
|
case P2IN:
|
|
read_pin_reg(me, io_port, io_port_reg-P0IN, dest, nr_bytes);
|
|
break;
|
|
|
|
case P2SS:
|
|
case P4SS:
|
|
read_dedicated_control_reg(me, io_port, io_port_reg, dest, nr_bytes);
|
|
break;
|
|
|
|
default:
|
|
hw_abort(me, "invalid address");
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
|
|
static void
|
|
write_output_reg (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word io_port_reg,
|
|
const void *source,
|
|
unsigned nr_bytes)
|
|
{
|
|
unsigned8 buf = *(unsigned8 *)source;
|
|
if ( nr_bytes == 1 )
|
|
{
|
|
if ( io_port_reg == 3 && (buf & 0xfc) != 0 )
|
|
{
|
|
hw_abort(me, "Cannot write to read-only bits of P3OUT.");
|
|
}
|
|
else
|
|
{
|
|
io_port->port[io_port_reg].output = buf;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
hw_abort (me, "bad read size of %d bytes from P%dOUT.", nr_bytes,
|
|
io_port_reg);
|
|
}
|
|
}
|
|
|
|
|
|
static void
|
|
write_output_mode_reg (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word io_port_reg,
|
|
const void *source,
|
|
unsigned nr_bytes)
|
|
{
|
|
unsigned8 buf = *(unsigned8 *)source;
|
|
if ( nr_bytes == 1 )
|
|
{
|
|
/* check if there are fields which can't be written and
|
|
take appropriate action depending what bits are set */
|
|
if ( ( io_port_reg == 3 && (buf & 0xfc) != 0 )
|
|
|| ( (io_port_reg == 0 || io_port_reg == 1) && (buf & 0xfe) != 0 ) )
|
|
{
|
|
hw_abort(me, "Cannot write to read-only bits of output mode register.");
|
|
}
|
|
else
|
|
{
|
|
io_port->port[io_port_reg].output_mode = buf;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
hw_abort (me, "bad write size of %d bytes to P%dMD.", nr_bytes,
|
|
io_port_reg);
|
|
}
|
|
}
|
|
|
|
|
|
static void
|
|
write_control_reg (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word io_port_reg,
|
|
const void *source,
|
|
unsigned nr_bytes)
|
|
{
|
|
unsigned8 buf = *(unsigned8 *)source;
|
|
if ( nr_bytes == 1 )
|
|
{
|
|
if ( io_port_reg == 3 && (buf & 0xfc) != 0 )
|
|
{
|
|
hw_abort(me, "Cannot write to read-only bits of P3DIR.");
|
|
}
|
|
else
|
|
{
|
|
io_port->port[io_port_reg].control = buf;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
hw_abort (me, "bad write size of %d bytes to P%dDIR.", nr_bytes,
|
|
io_port_reg);
|
|
}
|
|
}
|
|
|
|
|
|
static void
|
|
write_dedicated_control_reg (struct hw *me,
|
|
struct mn103iop *io_port,
|
|
unsigned_word io_port_reg,
|
|
const void *source,
|
|
unsigned nr_bytes)
|
|
{
|
|
unsigned8 buf = *(unsigned8 *)source;
|
|
if ( nr_bytes == 1 )
|
|
{
|
|
/* select on io_port_reg: */
|
|
if ( io_port_reg == P2SS )
|
|
{
|
|
if ( (buf & 0xfc) != 0 )
|
|
{
|
|
hw_abort(me, "Cannot write to read-only bits in p2ss.");
|
|
}
|
|
else
|
|
{
|
|
io_port->p2ss = buf;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if ( (buf & 0xf0) != 0 )
|
|
{
|
|
hw_abort(me, "Cannot write to read-only bits in p4ss.");
|
|
}
|
|
else
|
|
{
|
|
io_port->p4ss = buf;
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
hw_abort (me, "bad write size of %d bytes to PSS.", nr_bytes);
|
|
}
|
|
}
|
|
|
|
|
|
static unsigned
|
|
mn103iop_io_write_buffer (struct hw *me,
|
|
const void *source,
|
|
int space,
|
|
unsigned_word base,
|
|
unsigned nr_bytes)
|
|
{
|
|
struct mn103iop *io_port = hw_data (me);
|
|
enum io_port_register_types io_port_reg;
|
|
HW_TRACE ((me, "write 0x%08lx %d", (long) base, (int) nr_bytes));
|
|
|
|
io_port_reg = decode_addr (me, io_port, base);
|
|
switch (io_port_reg)
|
|
{
|
|
/* Port output registers */
|
|
case P0OUT:
|
|
case P1OUT:
|
|
case P2OUT:
|
|
case P3OUT:
|
|
write_output_reg(me, io_port, io_port_reg-P0OUT, source, nr_bytes);
|
|
break;
|
|
|
|
/* Port output mode registers */
|
|
case P0MD:
|
|
case P1MD:
|
|
case P2MD:
|
|
case P3MD:
|
|
write_output_mode_reg(me, io_port, io_port_reg-P0MD, source, nr_bytes);
|
|
break;
|
|
|
|
/* Port control registers */
|
|
case P0DIR:
|
|
case P1DIR:
|
|
case P2DIR:
|
|
case P3DIR:
|
|
write_control_reg(me, io_port, io_port_reg-P0DIR, source, nr_bytes);
|
|
break;
|
|
|
|
/* Port pin registers */
|
|
case P0IN:
|
|
case P1IN:
|
|
case P2IN:
|
|
hw_abort(me, "Cannot write to pin register.");
|
|
break;
|
|
|
|
case P2SS:
|
|
case P4SS:
|
|
write_dedicated_control_reg(me, io_port, io_port_reg, source, nr_bytes);
|
|
break;
|
|
|
|
default:
|
|
hw_abort(me, "invalid address");
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
|
|
const struct hw_descriptor dv_mn103iop_descriptor[] = {
|
|
{ "mn103iop", mn103iop_finish, },
|
|
{ NULL },
|
|
};
|