mirror of
https://sourceware.org/git/binutils-gdb.git
synced 2024-11-24 18:44:20 +08:00
42a4f53d2b
This commit applies all changes made after running the gdb/copyright.py script. Note that one file was flagged by the script, due to an invalid copyright header (gdb/unittests/basic_string_view/element_access/char/empty.cc). As the file was copied from GCC's libstdc++-v3 testsuite, this commit leaves this file untouched for the time being; a patch to fix the header was sent to gcc-patches first. gdb/ChangeLog: Update copyright year range in all GDB files.
1021 lines
29 KiB
C
1021 lines
29 KiB
C
/* Blackfin System Interrupt Controller (SIC) model.
|
|
|
|
Copyright (C) 2010-2019 Free Software Foundation, Inc.
|
|
Contributed by Analog Devices, Inc.
|
|
|
|
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 "devices.h"
|
|
#include "dv-bfin_sic.h"
|
|
#include "dv-bfin_cec.h"
|
|
|
|
struct bfin_sic
|
|
{
|
|
/* We assume first element is the base. */
|
|
bu32 base;
|
|
|
|
/* Order after here is important -- matches hardware MMR layout. */
|
|
bu16 BFIN_MMR_16(swrst);
|
|
bu16 BFIN_MMR_16(syscr);
|
|
bu16 BFIN_MMR_16(rvect); /* XXX: BF59x has a 32bit AUX_REVID here. */
|
|
union {
|
|
struct {
|
|
bu32 imask0;
|
|
bu32 iar0, iar1, iar2, iar3;
|
|
bu32 isr0, iwr0;
|
|
bu32 _pad0[9];
|
|
bu32 imask1;
|
|
bu32 iar4, iar5, iar6, iar7;
|
|
bu32 isr1, iwr1;
|
|
} bf52x;
|
|
struct {
|
|
bu32 imask;
|
|
bu32 iar0, iar1, iar2, iar3;
|
|
bu32 isr, iwr;
|
|
} bf537;
|
|
struct {
|
|
bu32 imask0, imask1, imask2;
|
|
bu32 isr0, isr1, isr2;
|
|
bu32 iwr0, iwr1, iwr2;
|
|
bu32 iar0, iar1, iar2, iar3;
|
|
bu32 iar4, iar5, iar6, iar7;
|
|
bu32 iar8, iar9, iar10, iar11;
|
|
} bf54x;
|
|
struct {
|
|
bu32 imask0, imask1;
|
|
bu32 iar0, iar1, iar2, iar3;
|
|
bu32 iar4, iar5, iar6, iar7;
|
|
bu32 isr0, isr1;
|
|
bu32 iwr0, iwr1;
|
|
} bf561;
|
|
};
|
|
};
|
|
#define mmr_base() offsetof(struct bfin_sic, swrst)
|
|
#define mmr_offset(mmr) (offsetof(struct bfin_sic, mmr) - mmr_base())
|
|
#define mmr_idx(mmr) (mmr_offset (mmr) / 4)
|
|
|
|
static const char * const bf52x_mmr_names[] =
|
|
{
|
|
"SWRST", "SYSCR", "SIC_RVECT", "SIC_IMASK0", "SIC_IAR0", "SIC_IAR1",
|
|
"SIC_IAR2", "SIC_IAR3", "SIC_ISR0", "SIC_IWR0",
|
|
[mmr_idx (bf52x.imask1)] = "SIC_IMASK1", "SIC_IAR4", "SIC_IAR5",
|
|
"SIC_IAR6", "SIC_IAR7", "SIC_ISR1", "SIC_IWR1",
|
|
};
|
|
static const char * const bf537_mmr_names[] =
|
|
{
|
|
"SWRST", "SYSCR", "SIC_RVECT", "SIC_IMASK", "SIC_IAR0", "SIC_IAR1",
|
|
"SIC_IAR2", "SIC_IAR3", "SIC_ISR", "SIC_IWR",
|
|
};
|
|
static const char * const bf54x_mmr_names[] =
|
|
{
|
|
"SWRST", "SYSCR", "SIC_RVECT", "SIC_IMASK0", "SIC_IMASK1", "SIC_IMASK2",
|
|
"SIC_ISR0", "SIC_ISR1", "SIC_ISR2", "SIC_IWR0", "SIC_IWR1", "SIC_IWR2",
|
|
"SIC_IAR0", "SIC_IAR1", "SIC_IAR2", "SIC_IAR3",
|
|
"SIC_IAR4", "SIC_IAR5", "SIC_IAR6", "SIC_IAR7",
|
|
"SIC_IAR8", "SIC_IAR9", "SIC_IAR10", "SIC_IAR11",
|
|
};
|
|
static const char * const bf561_mmr_names[] =
|
|
{
|
|
"SWRST", "SYSCR", "SIC_RVECT", "SIC_IMASK0", "SIC_IMASK1",
|
|
"SIC_IAR0", "SIC_IAR1", "SIC_IAR2", "SIC_IAR3",
|
|
"SIC_IAR4", "SIC_IAR5", "SIC_IAR6", "SIC_IAR7",
|
|
"SIC_ISR0", "SIC_ISR1", "SIC_IWR0", "SIC_IWR1",
|
|
};
|
|
static const char * const *mmr_names;
|
|
#define mmr_name(off) (mmr_names[(off) / 4] ? : "<INV>")
|
|
|
|
static void
|
|
bfin_sic_forward_interrupts (struct hw *me, bu32 *isr, bu32 *imask, bu32 *iar)
|
|
{
|
|
int my_port;
|
|
bu32 ipend;
|
|
|
|
/* Process pending and unmasked interrupts. */
|
|
ipend = *isr & *imask;
|
|
|
|
/* Usually none are pending unmasked, so avoid bit twiddling. */
|
|
if (!ipend)
|
|
return;
|
|
|
|
for (my_port = 0; my_port < 32; ++my_port)
|
|
{
|
|
bu32 iar_idx, iar_off, iar_val;
|
|
bu32 bit = (1 << my_port);
|
|
|
|
/* This bit isn't pending, so check next one. */
|
|
if (!(ipend & bit))
|
|
continue;
|
|
|
|
/* The IAR registers map the System input to the Core output.
|
|
Every 4 bits in the IAR are used to map to IVG{7..15}. */
|
|
iar_idx = my_port / 8;
|
|
iar_off = (my_port % 8) * 4;
|
|
iar_val = (iar[iar_idx] & (0xf << iar_off)) >> iar_off;
|
|
HW_TRACE ((me, "forwarding int %i to CEC", IVG7 + iar_val));
|
|
hw_port_event (me, IVG7 + iar_val, 1);
|
|
}
|
|
}
|
|
|
|
static void
|
|
bfin_sic_52x_forward_interrupts (struct hw *me, struct bfin_sic *sic)
|
|
{
|
|
bfin_sic_forward_interrupts (me, &sic->bf52x.isr0, &sic->bf52x.imask0, &sic->bf52x.iar0);
|
|
bfin_sic_forward_interrupts (me, &sic->bf52x.isr1, &sic->bf52x.imask1, &sic->bf52x.iar4);
|
|
}
|
|
|
|
static unsigned
|
|
bfin_sic_52x_io_write_buffer (struct hw *me, const void *source, int space,
|
|
address_word addr, unsigned nr_bytes)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 mmr_off;
|
|
bu32 value;
|
|
bu16 *value16p;
|
|
bu32 *value32p;
|
|
void *valuep;
|
|
|
|
/* Invalid access mode is higher priority than missing register. */
|
|
if (!dv_bfin_mmr_require_16_32 (me, addr, nr_bytes, true))
|
|
return 0;
|
|
|
|
if (nr_bytes == 4)
|
|
value = dv_load_4 (source);
|
|
else
|
|
value = dv_load_2 (source);
|
|
|
|
mmr_off = addr - sic->base;
|
|
valuep = (void *)((unsigned long)sic + mmr_base() + mmr_off);
|
|
value16p = valuep;
|
|
value32p = valuep;
|
|
|
|
HW_TRACE_WRITE ();
|
|
|
|
/* XXX: Discard all SIC writes for now. */
|
|
switch (mmr_off)
|
|
{
|
|
case mmr_offset(swrst):
|
|
/* XXX: This should trigger a software reset ... */
|
|
break;
|
|
case mmr_offset(syscr):
|
|
/* XXX: what to do ... */
|
|
break;
|
|
case mmr_offset(bf52x.imask0):
|
|
case mmr_offset(bf52x.imask1):
|
|
bfin_sic_52x_forward_interrupts (me, sic);
|
|
*value32p = value;
|
|
break;
|
|
case mmr_offset(bf52x.iar0) ... mmr_offset(bf52x.iar3):
|
|
case mmr_offset(bf52x.iar4) ... mmr_offset(bf52x.iar7):
|
|
case mmr_offset(bf52x.iwr0):
|
|
case mmr_offset(bf52x.iwr1):
|
|
*value32p = value;
|
|
break;
|
|
case mmr_offset(bf52x.isr0):
|
|
case mmr_offset(bf52x.isr1):
|
|
/* ISR is read-only. */
|
|
break;
|
|
default:
|
|
/* XXX: Should discard other writes. */
|
|
;
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
static unsigned
|
|
bfin_sic_52x_io_read_buffer (struct hw *me, void *dest, int space,
|
|
address_word addr, unsigned nr_bytes)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 mmr_off;
|
|
bu16 *value16p;
|
|
bu32 *value32p;
|
|
void *valuep;
|
|
|
|
/* Invalid access mode is higher priority than missing register. */
|
|
if (!dv_bfin_mmr_require_16_32 (me, addr, nr_bytes, false))
|
|
return 0;
|
|
|
|
mmr_off = addr - sic->base;
|
|
valuep = (void *)((unsigned long)sic + mmr_base() + mmr_off);
|
|
value16p = valuep;
|
|
value32p = valuep;
|
|
|
|
HW_TRACE_READ ();
|
|
|
|
switch (mmr_off)
|
|
{
|
|
case mmr_offset(swrst):
|
|
case mmr_offset(syscr):
|
|
case mmr_offset(rvect):
|
|
dv_store_2 (dest, *value16p);
|
|
break;
|
|
case mmr_offset(bf52x.imask0):
|
|
case mmr_offset(bf52x.imask1):
|
|
case mmr_offset(bf52x.iar0) ... mmr_offset(bf52x.iar3):
|
|
case mmr_offset(bf52x.iar4) ... mmr_offset(bf52x.iar7):
|
|
case mmr_offset(bf52x.iwr0):
|
|
case mmr_offset(bf52x.iwr1):
|
|
case mmr_offset(bf52x.isr0):
|
|
case mmr_offset(bf52x.isr1):
|
|
dv_store_4 (dest, *value32p);
|
|
break;
|
|
default:
|
|
if (nr_bytes == 2)
|
|
dv_store_2 (dest, 0);
|
|
else
|
|
dv_store_4 (dest, 0);
|
|
break;
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
static void
|
|
bfin_sic_537_forward_interrupts (struct hw *me, struct bfin_sic *sic)
|
|
{
|
|
bfin_sic_forward_interrupts (me, &sic->bf537.isr, &sic->bf537.imask, &sic->bf537.iar0);
|
|
}
|
|
|
|
static unsigned
|
|
bfin_sic_537_io_write_buffer (struct hw *me, const void *source, int space,
|
|
address_word addr, unsigned nr_bytes)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 mmr_off;
|
|
bu32 value;
|
|
bu16 *value16p;
|
|
bu32 *value32p;
|
|
void *valuep;
|
|
|
|
/* Invalid access mode is higher priority than missing register. */
|
|
if (!dv_bfin_mmr_require_16_32 (me, addr, nr_bytes, true))
|
|
return 0;
|
|
|
|
if (nr_bytes == 4)
|
|
value = dv_load_4 (source);
|
|
else
|
|
value = dv_load_2 (source);
|
|
|
|
mmr_off = addr - sic->base;
|
|
valuep = (void *)((unsigned long)sic + mmr_base() + mmr_off);
|
|
value16p = valuep;
|
|
value32p = valuep;
|
|
|
|
HW_TRACE_WRITE ();
|
|
|
|
/* XXX: Discard all SIC writes for now. */
|
|
switch (mmr_off)
|
|
{
|
|
case mmr_offset(swrst):
|
|
/* XXX: This should trigger a software reset ... */
|
|
break;
|
|
case mmr_offset(syscr):
|
|
/* XXX: what to do ... */
|
|
break;
|
|
case mmr_offset(bf537.imask):
|
|
bfin_sic_537_forward_interrupts (me, sic);
|
|
*value32p = value;
|
|
break;
|
|
case mmr_offset(bf537.iar0):
|
|
case mmr_offset(bf537.iar1):
|
|
case mmr_offset(bf537.iar2):
|
|
case mmr_offset(bf537.iar3):
|
|
case mmr_offset(bf537.iwr):
|
|
*value32p = value;
|
|
break;
|
|
case mmr_offset(bf537.isr):
|
|
/* ISR is read-only. */
|
|
break;
|
|
default:
|
|
/* XXX: Should discard other writes. */
|
|
;
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
static unsigned
|
|
bfin_sic_537_io_read_buffer (struct hw *me, void *dest, int space,
|
|
address_word addr, unsigned nr_bytes)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 mmr_off;
|
|
bu16 *value16p;
|
|
bu32 *value32p;
|
|
void *valuep;
|
|
|
|
/* Invalid access mode is higher priority than missing register. */
|
|
if (!dv_bfin_mmr_require_16_32 (me, addr, nr_bytes, false))
|
|
return 0;
|
|
|
|
mmr_off = addr - sic->base;
|
|
valuep = (void *)((unsigned long)sic + mmr_base() + mmr_off);
|
|
value16p = valuep;
|
|
value32p = valuep;
|
|
|
|
HW_TRACE_READ ();
|
|
|
|
switch (mmr_off)
|
|
{
|
|
case mmr_offset(swrst):
|
|
case mmr_offset(syscr):
|
|
case mmr_offset(rvect):
|
|
dv_store_2 (dest, *value16p);
|
|
break;
|
|
case mmr_offset(bf537.imask):
|
|
case mmr_offset(bf537.iar0):
|
|
case mmr_offset(bf537.iar1):
|
|
case mmr_offset(bf537.iar2):
|
|
case mmr_offset(bf537.iar3):
|
|
case mmr_offset(bf537.isr):
|
|
case mmr_offset(bf537.iwr):
|
|
dv_store_4 (dest, *value32p);
|
|
break;
|
|
default:
|
|
if (nr_bytes == 2)
|
|
dv_store_2 (dest, 0);
|
|
else
|
|
dv_store_4 (dest, 0);
|
|
break;
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
static void
|
|
bfin_sic_54x_forward_interrupts (struct hw *me, struct bfin_sic *sic)
|
|
{
|
|
bfin_sic_forward_interrupts (me, &sic->bf54x.isr0, &sic->bf54x.imask0, &sic->bf54x.iar0);
|
|
bfin_sic_forward_interrupts (me, &sic->bf54x.isr1, &sic->bf54x.imask1, &sic->bf54x.iar4);
|
|
bfin_sic_forward_interrupts (me, &sic->bf54x.isr2, &sic->bf54x.imask2, &sic->bf54x.iar8);
|
|
}
|
|
|
|
static unsigned
|
|
bfin_sic_54x_io_write_buffer (struct hw *me, const void *source, int space,
|
|
address_word addr, unsigned nr_bytes)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 mmr_off;
|
|
bu32 value;
|
|
bu16 *value16p;
|
|
bu32 *value32p;
|
|
void *valuep;
|
|
|
|
/* Invalid access mode is higher priority than missing register. */
|
|
if (!dv_bfin_mmr_require_16_32 (me, addr, nr_bytes, true))
|
|
return 0;
|
|
|
|
if (nr_bytes == 4)
|
|
value = dv_load_4 (source);
|
|
else
|
|
value = dv_load_2 (source);
|
|
|
|
mmr_off = addr - sic->base;
|
|
valuep = (void *)((unsigned long)sic + mmr_base() + mmr_off);
|
|
value16p = valuep;
|
|
value32p = valuep;
|
|
|
|
HW_TRACE_WRITE ();
|
|
|
|
/* XXX: Discard all SIC writes for now. */
|
|
switch (mmr_off)
|
|
{
|
|
case mmr_offset(swrst):
|
|
/* XXX: This should trigger a software reset ... */
|
|
break;
|
|
case mmr_offset(syscr):
|
|
/* XXX: what to do ... */
|
|
break;
|
|
case mmr_offset(bf54x.imask0) ... mmr_offset(bf54x.imask2):
|
|
bfin_sic_54x_forward_interrupts (me, sic);
|
|
*value32p = value;
|
|
break;
|
|
case mmr_offset(bf54x.iar0) ... mmr_offset(bf54x.iar11):
|
|
case mmr_offset(bf54x.iwr0) ... mmr_offset(bf54x.iwr2):
|
|
*value32p = value;
|
|
break;
|
|
case mmr_offset(bf54x.isr0) ... mmr_offset(bf54x.isr2):
|
|
/* ISR is read-only. */
|
|
break;
|
|
default:
|
|
/* XXX: Should discard other writes. */
|
|
;
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
static unsigned
|
|
bfin_sic_54x_io_read_buffer (struct hw *me, void *dest, int space,
|
|
address_word addr, unsigned nr_bytes)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 mmr_off;
|
|
bu16 *value16p;
|
|
bu32 *value32p;
|
|
void *valuep;
|
|
|
|
/* Invalid access mode is higher priority than missing register. */
|
|
if (!dv_bfin_mmr_require_16_32 (me, addr, nr_bytes, false))
|
|
return 0;
|
|
|
|
mmr_off = addr - sic->base;
|
|
valuep = (void *)((unsigned long)sic + mmr_base() + mmr_off);
|
|
value16p = valuep;
|
|
value32p = valuep;
|
|
|
|
HW_TRACE_READ ();
|
|
|
|
switch (mmr_off)
|
|
{
|
|
case mmr_offset(swrst):
|
|
case mmr_offset(syscr):
|
|
case mmr_offset(rvect):
|
|
dv_store_2 (dest, *value16p);
|
|
break;
|
|
case mmr_offset(bf54x.imask0) ... mmr_offset(bf54x.imask2):
|
|
case mmr_offset(bf54x.iar0) ... mmr_offset(bf54x.iar11):
|
|
case mmr_offset(bf54x.iwr0) ... mmr_offset(bf54x.iwr2):
|
|
case mmr_offset(bf54x.isr0) ... mmr_offset(bf54x.isr2):
|
|
dv_store_4 (dest, *value32p);
|
|
break;
|
|
default:
|
|
if (nr_bytes == 2)
|
|
dv_store_2 (dest, 0);
|
|
else
|
|
dv_store_4 (dest, 0);
|
|
break;
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
static void
|
|
bfin_sic_561_forward_interrupts (struct hw *me, struct bfin_sic *sic)
|
|
{
|
|
bfin_sic_forward_interrupts (me, &sic->bf561.isr0, &sic->bf561.imask0, &sic->bf561.iar0);
|
|
bfin_sic_forward_interrupts (me, &sic->bf561.isr1, &sic->bf561.imask1, &sic->bf561.iar4);
|
|
}
|
|
|
|
static unsigned
|
|
bfin_sic_561_io_write_buffer (struct hw *me, const void *source, int space,
|
|
address_word addr, unsigned nr_bytes)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 mmr_off;
|
|
bu32 value;
|
|
bu16 *value16p;
|
|
bu32 *value32p;
|
|
void *valuep;
|
|
|
|
/* Invalid access mode is higher priority than missing register. */
|
|
if (!dv_bfin_mmr_require_16_32 (me, addr, nr_bytes, true))
|
|
return 0;
|
|
|
|
if (nr_bytes == 4)
|
|
value = dv_load_4 (source);
|
|
else
|
|
value = dv_load_2 (source);
|
|
|
|
mmr_off = addr - sic->base;
|
|
valuep = (void *)((unsigned long)sic + mmr_base() + mmr_off);
|
|
value16p = valuep;
|
|
value32p = valuep;
|
|
|
|
HW_TRACE_WRITE ();
|
|
|
|
/* XXX: Discard all SIC writes for now. */
|
|
switch (mmr_off)
|
|
{
|
|
case mmr_offset(swrst):
|
|
/* XXX: This should trigger a software reset ... */
|
|
break;
|
|
case mmr_offset(syscr):
|
|
/* XXX: what to do ... */
|
|
break;
|
|
case mmr_offset(bf561.imask0):
|
|
case mmr_offset(bf561.imask1):
|
|
bfin_sic_561_forward_interrupts (me, sic);
|
|
*value32p = value;
|
|
break;
|
|
case mmr_offset(bf561.iar0) ... mmr_offset(bf561.iar3):
|
|
case mmr_offset(bf561.iar4) ... mmr_offset(bf561.iar7):
|
|
case mmr_offset(bf561.iwr0):
|
|
case mmr_offset(bf561.iwr1):
|
|
*value32p = value;
|
|
break;
|
|
case mmr_offset(bf561.isr0):
|
|
case mmr_offset(bf561.isr1):
|
|
/* ISR is read-only. */
|
|
break;
|
|
default:
|
|
/* XXX: Should discard other writes. */
|
|
;
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
static unsigned
|
|
bfin_sic_561_io_read_buffer (struct hw *me, void *dest, int space,
|
|
address_word addr, unsigned nr_bytes)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 mmr_off;
|
|
bu16 *value16p;
|
|
bu32 *value32p;
|
|
void *valuep;
|
|
|
|
/* Invalid access mode is higher priority than missing register. */
|
|
if (!dv_bfin_mmr_require_16_32 (me, addr, nr_bytes, false))
|
|
return 0;
|
|
|
|
mmr_off = addr - sic->base;
|
|
valuep = (void *)((unsigned long)sic + mmr_base() + mmr_off);
|
|
value16p = valuep;
|
|
value32p = valuep;
|
|
|
|
HW_TRACE_READ ();
|
|
|
|
switch (mmr_off)
|
|
{
|
|
case mmr_offset(swrst):
|
|
case mmr_offset(syscr):
|
|
case mmr_offset(rvect):
|
|
dv_store_2 (dest, *value16p);
|
|
break;
|
|
case mmr_offset(bf561.imask0):
|
|
case mmr_offset(bf561.imask1):
|
|
case mmr_offset(bf561.iar0) ... mmr_offset(bf561.iar3):
|
|
case mmr_offset(bf561.iar4) ... mmr_offset(bf561.iar7):
|
|
case mmr_offset(bf561.iwr0):
|
|
case mmr_offset(bf561.iwr1):
|
|
case mmr_offset(bf561.isr0):
|
|
case mmr_offset(bf561.isr1):
|
|
dv_store_4 (dest, *value32p);
|
|
break;
|
|
default:
|
|
if (nr_bytes == 2)
|
|
dv_store_2 (dest, 0);
|
|
else
|
|
dv_store_4 (dest, 0);
|
|
break;
|
|
}
|
|
|
|
return nr_bytes;
|
|
}
|
|
|
|
/* Give each SIC its own base to make it easier to extract the pin at
|
|
runtime. The pin is used as its bit position in the SIC MMRs. */
|
|
#define ENC(sic, pin) (((sic) << 8) + (pin))
|
|
#define DEC_PIN(pin) ((pin) % 0x100)
|
|
#define DEC_SIC(pin) ((pin) >> 8)
|
|
|
|
/* It would be nice to declare just one set of input_ports, and then
|
|
have the device tree instantiate multiple SICs, but the MMR layout
|
|
on the BF54x/BF561 makes this pretty hard to pull off since their
|
|
regs are interwoven in the address space. */
|
|
|
|
#define BFIN_SIC_TO_CEC_PORTS \
|
|
{ "ivg7", IVG7, 0, output_port, }, \
|
|
{ "ivg8", IVG8, 0, output_port, }, \
|
|
{ "ivg9", IVG9, 0, output_port, }, \
|
|
{ "ivg10", IVG10, 0, output_port, }, \
|
|
{ "ivg11", IVG11, 0, output_port, }, \
|
|
{ "ivg12", IVG12, 0, output_port, }, \
|
|
{ "ivg13", IVG13, 0, output_port, }, \
|
|
{ "ivg14", IVG14, 0, output_port, }, \
|
|
{ "ivg15", IVG15, 0, output_port, },
|
|
|
|
#define SIC_PORTS(n) \
|
|
{ "int0@"#n, ENC(n, 0), 0, input_port, }, \
|
|
{ "int1@"#n, ENC(n, 1), 0, input_port, }, \
|
|
{ "int2@"#n, ENC(n, 2), 0, input_port, }, \
|
|
{ "int3@"#n, ENC(n, 3), 0, input_port, }, \
|
|
{ "int4@"#n, ENC(n, 4), 0, input_port, }, \
|
|
{ "int5@"#n, ENC(n, 5), 0, input_port, }, \
|
|
{ "int6@"#n, ENC(n, 6), 0, input_port, }, \
|
|
{ "int7@"#n, ENC(n, 7), 0, input_port, }, \
|
|
{ "int8@"#n, ENC(n, 8), 0, input_port, }, \
|
|
{ "int9@"#n, ENC(n, 9), 0, input_port, }, \
|
|
{ "int10@"#n, ENC(n, 10), 0, input_port, }, \
|
|
{ "int11@"#n, ENC(n, 11), 0, input_port, }, \
|
|
{ "int12@"#n, ENC(n, 12), 0, input_port, }, \
|
|
{ "int13@"#n, ENC(n, 13), 0, input_port, }, \
|
|
{ "int14@"#n, ENC(n, 14), 0, input_port, }, \
|
|
{ "int15@"#n, ENC(n, 15), 0, input_port, }, \
|
|
{ "int16@"#n, ENC(n, 16), 0, input_port, }, \
|
|
{ "int17@"#n, ENC(n, 17), 0, input_port, }, \
|
|
{ "int18@"#n, ENC(n, 18), 0, input_port, }, \
|
|
{ "int19@"#n, ENC(n, 19), 0, input_port, }, \
|
|
{ "int20@"#n, ENC(n, 20), 0, input_port, }, \
|
|
{ "int21@"#n, ENC(n, 21), 0, input_port, }, \
|
|
{ "int22@"#n, ENC(n, 22), 0, input_port, }, \
|
|
{ "int23@"#n, ENC(n, 23), 0, input_port, }, \
|
|
{ "int24@"#n, ENC(n, 24), 0, input_port, }, \
|
|
{ "int25@"#n, ENC(n, 25), 0, input_port, }, \
|
|
{ "int26@"#n, ENC(n, 26), 0, input_port, }, \
|
|
{ "int27@"#n, ENC(n, 27), 0, input_port, }, \
|
|
{ "int28@"#n, ENC(n, 28), 0, input_port, }, \
|
|
{ "int29@"#n, ENC(n, 29), 0, input_port, }, \
|
|
{ "int30@"#n, ENC(n, 30), 0, input_port, }, \
|
|
{ "int31@"#n, ENC(n, 31), 0, input_port, },
|
|
|
|
static const struct hw_port_descriptor bfin_sic1_ports[] =
|
|
{
|
|
BFIN_SIC_TO_CEC_PORTS
|
|
SIC_PORTS(0)
|
|
{ NULL, 0, 0, 0, },
|
|
};
|
|
|
|
static const struct hw_port_descriptor bfin_sic2_ports[] =
|
|
{
|
|
BFIN_SIC_TO_CEC_PORTS
|
|
SIC_PORTS(0)
|
|
SIC_PORTS(1)
|
|
{ NULL, 0, 0, 0, },
|
|
};
|
|
|
|
static const struct hw_port_descriptor bfin_sic3_ports[] =
|
|
{
|
|
BFIN_SIC_TO_CEC_PORTS
|
|
SIC_PORTS(0)
|
|
SIC_PORTS(1)
|
|
SIC_PORTS(2)
|
|
{ NULL, 0, 0, 0, },
|
|
};
|
|
|
|
static const struct hw_port_descriptor bfin_sic_561_ports[] =
|
|
{
|
|
{ "sup_irq@0", 0, 0, output_port, },
|
|
{ "sup_irq@1", 1, 0, output_port, },
|
|
BFIN_SIC_TO_CEC_PORTS
|
|
SIC_PORTS(0)
|
|
SIC_PORTS(1)
|
|
{ NULL, 0, 0, 0, },
|
|
};
|
|
|
|
static void
|
|
bfin_sic_port_event (struct hw *me, bu32 *isr, bu32 bit, int level)
|
|
{
|
|
if (level)
|
|
*isr |= bit;
|
|
else
|
|
*isr &= ~bit;
|
|
}
|
|
|
|
static void
|
|
bfin_sic_52x_port_event (struct hw *me, int my_port, struct hw *source,
|
|
int source_port, int level)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 idx = DEC_SIC (my_port);
|
|
bu32 pin = DEC_PIN (my_port);
|
|
bu32 bit = 1 << pin;
|
|
|
|
HW_TRACE ((me, "processing level %i from port %i (SIC %u pin %u)",
|
|
level, my_port, idx, pin));
|
|
|
|
/* SIC only exists to forward interrupts from the system to the CEC. */
|
|
switch (idx)
|
|
{
|
|
case 0: bfin_sic_port_event (me, &sic->bf52x.isr0, bit, level); break;
|
|
case 1: bfin_sic_port_event (me, &sic->bf52x.isr1, bit, level); break;
|
|
}
|
|
|
|
/* XXX: Handle SIC wakeup source ?
|
|
if (sic->bf52x.iwr0 & bit)
|
|
What to do ?;
|
|
if (sic->bf52x.iwr1 & bit)
|
|
What to do ?;
|
|
*/
|
|
|
|
bfin_sic_52x_forward_interrupts (me, sic);
|
|
}
|
|
|
|
static void
|
|
bfin_sic_537_port_event (struct hw *me, int my_port, struct hw *source,
|
|
int source_port, int level)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 idx = DEC_SIC (my_port);
|
|
bu32 pin = DEC_PIN (my_port);
|
|
bu32 bit = 1 << pin;
|
|
|
|
HW_TRACE ((me, "processing level %i from port %i (SIC %u pin %u)",
|
|
level, my_port, idx, pin));
|
|
|
|
/* SIC only exists to forward interrupts from the system to the CEC. */
|
|
bfin_sic_port_event (me, &sic->bf537.isr, bit, level);
|
|
|
|
/* XXX: Handle SIC wakeup source ?
|
|
if (sic->bf537.iwr & bit)
|
|
What to do ?;
|
|
*/
|
|
|
|
bfin_sic_537_forward_interrupts (me, sic);
|
|
}
|
|
|
|
static void
|
|
bfin_sic_54x_port_event (struct hw *me, int my_port, struct hw *source,
|
|
int source_port, int level)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 idx = DEC_SIC (my_port);
|
|
bu32 pin = DEC_PIN (my_port);
|
|
bu32 bit = 1 << pin;
|
|
|
|
HW_TRACE ((me, "processing level %i from port %i (SIC %u pin %u)",
|
|
level, my_port, idx, pin));
|
|
|
|
/* SIC only exists to forward interrupts from the system to the CEC. */
|
|
switch (idx)
|
|
{
|
|
case 0: bfin_sic_port_event (me, &sic->bf54x.isr0, bit, level); break;
|
|
case 1: bfin_sic_port_event (me, &sic->bf54x.isr0, bit, level); break;
|
|
case 2: bfin_sic_port_event (me, &sic->bf54x.isr0, bit, level); break;
|
|
}
|
|
|
|
/* XXX: Handle SIC wakeup source ?
|
|
if (sic->bf54x.iwr0 & bit)
|
|
What to do ?;
|
|
if (sic->bf54x.iwr1 & bit)
|
|
What to do ?;
|
|
if (sic->bf54x.iwr2 & bit)
|
|
What to do ?;
|
|
*/
|
|
|
|
bfin_sic_54x_forward_interrupts (me, sic);
|
|
}
|
|
|
|
static void
|
|
bfin_sic_561_port_event (struct hw *me, int my_port, struct hw *source,
|
|
int source_port, int level)
|
|
{
|
|
struct bfin_sic *sic = hw_data (me);
|
|
bu32 idx = DEC_SIC (my_port);
|
|
bu32 pin = DEC_PIN (my_port);
|
|
bu32 bit = 1 << pin;
|
|
|
|
HW_TRACE ((me, "processing level %i from port %i (SIC %u pin %u)",
|
|
level, my_port, idx, pin));
|
|
|
|
/* SIC only exists to forward interrupts from the system to the CEC. */
|
|
switch (idx)
|
|
{
|
|
case 0: bfin_sic_port_event (me, &sic->bf561.isr0, bit, level); break;
|
|
case 1: bfin_sic_port_event (me, &sic->bf561.isr1, bit, level); break;
|
|
}
|
|
|
|
/* XXX: Handle SIC wakeup source ?
|
|
if (sic->bf561.iwr0 & bit)
|
|
What to do ?;
|
|
if (sic->bf561.iwr1 & bit)
|
|
What to do ?;
|
|
*/
|
|
|
|
bfin_sic_561_forward_interrupts (me, sic);
|
|
}
|
|
|
|
static void
|
|
attach_bfin_sic_regs (struct hw *me, struct bfin_sic *sic)
|
|
{
|
|
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);
|
|
|
|
if (attach_size != BFIN_MMR_SIC_SIZE)
|
|
hw_abort (me, "\"reg\" size must be %#x", BFIN_MMR_SIC_SIZE);
|
|
|
|
hw_attach_address (hw_parent (me),
|
|
0, attach_space, attach_address, attach_size, me);
|
|
|
|
sic->base = attach_address;
|
|
}
|
|
|
|
static void
|
|
bfin_sic_finish (struct hw *me)
|
|
{
|
|
struct bfin_sic *sic;
|
|
|
|
sic = HW_ZALLOC (me, struct bfin_sic);
|
|
|
|
set_hw_data (me, sic);
|
|
attach_bfin_sic_regs (me, sic);
|
|
|
|
switch (hw_find_integer_property (me, "type"))
|
|
{
|
|
case 500 ... 509:
|
|
set_hw_io_read_buffer (me, bfin_sic_52x_io_read_buffer);
|
|
set_hw_io_write_buffer (me, bfin_sic_52x_io_write_buffer);
|
|
set_hw_ports (me, bfin_sic2_ports);
|
|
set_hw_port_event (me, bfin_sic_52x_port_event);
|
|
mmr_names = bf52x_mmr_names;
|
|
|
|
/* Initialize the SIC. */
|
|
sic->bf52x.imask0 = sic->bf52x.imask1 = 0;
|
|
sic->bf52x.isr0 = sic->bf52x.isr1 = 0;
|
|
sic->bf52x.iwr0 = sic->bf52x.iwr1 = 0xFFFFFFFF;
|
|
sic->bf52x.iar0 = 0x00000000;
|
|
sic->bf52x.iar1 = 0x22111000;
|
|
sic->bf52x.iar2 = 0x33332222;
|
|
sic->bf52x.iar3 = 0x44444433;
|
|
sic->bf52x.iar4 = 0x55555555;
|
|
sic->bf52x.iar5 = 0x06666655;
|
|
sic->bf52x.iar6 = 0x33333003;
|
|
sic->bf52x.iar7 = 0x00000000; /* XXX: Find and fix */
|
|
break;
|
|
case 510 ... 519:
|
|
set_hw_io_read_buffer (me, bfin_sic_52x_io_read_buffer);
|
|
set_hw_io_write_buffer (me, bfin_sic_52x_io_write_buffer);
|
|
set_hw_ports (me, bfin_sic2_ports);
|
|
set_hw_port_event (me, bfin_sic_52x_port_event);
|
|
mmr_names = bf52x_mmr_names;
|
|
|
|
/* Initialize the SIC. */
|
|
sic->bf52x.imask0 = sic->bf52x.imask1 = 0;
|
|
sic->bf52x.isr0 = sic->bf52x.isr1 = 0;
|
|
sic->bf52x.iwr0 = sic->bf52x.iwr1 = 0xFFFFFFFF;
|
|
sic->bf52x.iar0 = 0x00000000;
|
|
sic->bf52x.iar1 = 0x11000000;
|
|
sic->bf52x.iar2 = 0x33332222;
|
|
sic->bf52x.iar3 = 0x44444433;
|
|
sic->bf52x.iar4 = 0x55555555;
|
|
sic->bf52x.iar5 = 0x06666655;
|
|
sic->bf52x.iar6 = 0x33333000;
|
|
sic->bf52x.iar7 = 0x00000000; /* XXX: Find and fix */
|
|
break;
|
|
case 522 ... 527:
|
|
set_hw_io_read_buffer (me, bfin_sic_52x_io_read_buffer);
|
|
set_hw_io_write_buffer (me, bfin_sic_52x_io_write_buffer);
|
|
set_hw_ports (me, bfin_sic2_ports);
|
|
set_hw_port_event (me, bfin_sic_52x_port_event);
|
|
mmr_names = bf52x_mmr_names;
|
|
|
|
/* Initialize the SIC. */
|
|
sic->bf52x.imask0 = sic->bf52x.imask1 = 0;
|
|
sic->bf52x.isr0 = sic->bf52x.isr1 = 0;
|
|
sic->bf52x.iwr0 = sic->bf52x.iwr1 = 0xFFFFFFFF;
|
|
sic->bf52x.iar0 = 0x00000000;
|
|
sic->bf52x.iar1 = 0x11000000;
|
|
sic->bf52x.iar2 = 0x33332222;
|
|
sic->bf52x.iar3 = 0x44444433;
|
|
sic->bf52x.iar4 = 0x55555555;
|
|
sic->bf52x.iar5 = 0x06666655;
|
|
sic->bf52x.iar6 = 0x33333000;
|
|
sic->bf52x.iar7 = 0x00000000; /* XXX: Find and fix */
|
|
break;
|
|
case 531 ... 533:
|
|
set_hw_io_read_buffer (me, bfin_sic_537_io_read_buffer);
|
|
set_hw_io_write_buffer (me, bfin_sic_537_io_write_buffer);
|
|
set_hw_ports (me, bfin_sic1_ports);
|
|
set_hw_port_event (me, bfin_sic_537_port_event);
|
|
mmr_names = bf537_mmr_names;
|
|
|
|
/* Initialize the SIC. */
|
|
sic->bf537.imask = 0;
|
|
sic->bf537.isr = 0;
|
|
sic->bf537.iwr = 0xFFFFFFFF;
|
|
sic->bf537.iar0 = 0x10000000;
|
|
sic->bf537.iar1 = 0x33322221;
|
|
sic->bf537.iar2 = 0x66655444;
|
|
sic->bf537.iar3 = 0; /* XXX: fix this */
|
|
break;
|
|
case 534:
|
|
case 536:
|
|
case 537:
|
|
set_hw_io_read_buffer (me, bfin_sic_537_io_read_buffer);
|
|
set_hw_io_write_buffer (me, bfin_sic_537_io_write_buffer);
|
|
set_hw_ports (me, bfin_sic1_ports);
|
|
set_hw_port_event (me, bfin_sic_537_port_event);
|
|
mmr_names = bf537_mmr_names;
|
|
|
|
/* Initialize the SIC. */
|
|
sic->bf537.imask = 0;
|
|
sic->bf537.isr = 0;
|
|
sic->bf537.iwr = 0xFFFFFFFF;
|
|
sic->bf537.iar0 = 0x22211000;
|
|
sic->bf537.iar1 = 0x43333332;
|
|
sic->bf537.iar2 = 0x55555444;
|
|
sic->bf537.iar3 = 0x66655555;
|
|
break;
|
|
case 538 ... 539:
|
|
set_hw_io_read_buffer (me, bfin_sic_52x_io_read_buffer);
|
|
set_hw_io_write_buffer (me, bfin_sic_52x_io_write_buffer);
|
|
set_hw_ports (me, bfin_sic2_ports);
|
|
set_hw_port_event (me, bfin_sic_52x_port_event);
|
|
mmr_names = bf52x_mmr_names;
|
|
|
|
/* Initialize the SIC. */
|
|
sic->bf52x.imask0 = sic->bf52x.imask1 = 0;
|
|
sic->bf52x.isr0 = sic->bf52x.isr1 = 0;
|
|
sic->bf52x.iwr0 = sic->bf52x.iwr1 = 0xFFFFFFFF;
|
|
sic->bf52x.iar0 = 0x10000000;
|
|
sic->bf52x.iar1 = 0x33322221;
|
|
sic->bf52x.iar2 = 0x66655444;
|
|
sic->bf52x.iar3 = 0x00000000;
|
|
sic->bf52x.iar4 = 0x32222220;
|
|
sic->bf52x.iar5 = 0x44433333;
|
|
sic->bf52x.iar6 = 0x00444664;
|
|
sic->bf52x.iar7 = 0x00000000; /* XXX: Find and fix */
|
|
break;
|
|
case 540 ... 549:
|
|
set_hw_io_read_buffer (me, bfin_sic_54x_io_read_buffer);
|
|
set_hw_io_write_buffer (me, bfin_sic_54x_io_write_buffer);
|
|
set_hw_ports (me, bfin_sic3_ports);
|
|
set_hw_port_event (me, bfin_sic_54x_port_event);
|
|
mmr_names = bf54x_mmr_names;
|
|
|
|
/* Initialize the SIC. */
|
|
sic->bf54x.imask0 = sic->bf54x.imask1 = sic->bf54x.imask2 = 0;
|
|
sic->bf54x.isr0 = sic->bf54x.isr1 = sic->bf54x.isr2 = 0;
|
|
sic->bf54x.iwr0 = sic->bf54x.iwr1 = sic->bf54x.iwr2 = 0xFFFFFFFF;
|
|
sic->bf54x.iar0 = 0x10000000;
|
|
sic->bf54x.iar1 = 0x33322221;
|
|
sic->bf54x.iar2 = 0x66655444;
|
|
sic->bf54x.iar3 = 0x00000000;
|
|
sic->bf54x.iar4 = 0x32222220;
|
|
sic->bf54x.iar5 = 0x44433333;
|
|
sic->bf54x.iar6 = 0x00444664;
|
|
sic->bf54x.iar7 = 0x00000000;
|
|
sic->bf54x.iar8 = 0x44111111;
|
|
sic->bf54x.iar9 = 0x44444444;
|
|
sic->bf54x.iar10 = 0x44444444;
|
|
sic->bf54x.iar11 = 0x55444444;
|
|
break;
|
|
case 561:
|
|
set_hw_io_read_buffer (me, bfin_sic_561_io_read_buffer);
|
|
set_hw_io_write_buffer (me, bfin_sic_561_io_write_buffer);
|
|
set_hw_ports (me, bfin_sic_561_ports);
|
|
set_hw_port_event (me, bfin_sic_561_port_event);
|
|
mmr_names = bf561_mmr_names;
|
|
|
|
/* Initialize the SIC. */
|
|
sic->bf561.imask0 = sic->bf561.imask1 = 0;
|
|
sic->bf561.isr0 = sic->bf561.isr1 = 0;
|
|
sic->bf561.iwr0 = sic->bf561.iwr1 = 0xFFFFFFFF;
|
|
sic->bf561.iar0 = 0x00000000;
|
|
sic->bf561.iar1 = 0x11111000;
|
|
sic->bf561.iar2 = 0x21111111;
|
|
sic->bf561.iar3 = 0x22222222;
|
|
sic->bf561.iar4 = 0x33333222;
|
|
sic->bf561.iar5 = 0x43333333;
|
|
sic->bf561.iar6 = 0x21144444;
|
|
sic->bf561.iar7 = 0x00006552;
|
|
break;
|
|
case 590 ... 599:
|
|
set_hw_io_read_buffer (me, bfin_sic_537_io_read_buffer);
|
|
set_hw_io_write_buffer (me, bfin_sic_537_io_write_buffer);
|
|
set_hw_ports (me, bfin_sic1_ports);
|
|
set_hw_port_event (me, bfin_sic_537_port_event);
|
|
mmr_names = bf537_mmr_names;
|
|
|
|
/* Initialize the SIC. */
|
|
sic->bf537.imask = 0;
|
|
sic->bf537.isr = 0;
|
|
sic->bf537.iwr = 0xFFFFFFFF;
|
|
sic->bf537.iar0 = 0x00000000;
|
|
sic->bf537.iar1 = 0x33322221;
|
|
sic->bf537.iar2 = 0x55444443;
|
|
sic->bf537.iar3 = 0x66600005;
|
|
break;
|
|
default:
|
|
hw_abort (me, "no support for SIC on this Blackfin model yet");
|
|
}
|
|
}
|
|
|
|
const struct hw_descriptor dv_bfin_sic_descriptor[] =
|
|
{
|
|
{"bfin_sic", bfin_sic_finish,},
|
|
{NULL, NULL},
|
|
};
|