Commit 2a1086d9 authored by ths's avatar ths
Browse files

More PCI mapping/remapping for Gallileo.


git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@2972 c046a42c-6fe2-441c-8c8c-71466251a162
parent 924edcae
......@@ -222,34 +222,217 @@ typedef target_phys_addr_t pci_addr_t;
#define GT_PCI0_HICMASK (0xca4 >> 2)
#define GT_PCI1_SERR1MASK (0xca8 >> 2)
#define PCI_MAPPING_ENTRY(regname) \
target_phys_addr_t regname ##_start; \
target_phys_addr_t regname ##_length; \
int regname ##_handle
#define PCI_REMAPPING_ENTRY(regname) \
target_phys_addr_t regname ##_start; \
target_phys_addr_t regname ##_length; \
target_phys_addr_t regname ##_offset; \
int regname ##_handle
typedef PCIHostState GT64120PCIState;
typedef struct GT64120State {
GT64120PCIState *pci;
uint32_t regs[GT_REGS];
target_phys_addr_t PCI0IO_start;
target_phys_addr_t PCI0IO_length;
PCI_MAPPING_ENTRY(SCS10);
PCI_REMAPPING_ENTRY(SCS10AR);
PCI_MAPPING_ENTRY(SCS32);
PCI_REMAPPING_ENTRY(SCS32AR);
PCI_MAPPING_ENTRY(CS20);
PCI_REMAPPING_ENTRY(CS20R);
PCI_MAPPING_ENTRY(CS3BOOT);
PCI_REMAPPING_ENTRY(CS3BOOTR);
PCI_MAPPING_ENTRY(PCI0IO);
PCI_REMAPPING_ENTRY(PCI0IOREMAP);
PCI_MAPPING_ENTRY(PCI0M0);
PCI_REMAPPING_ENTRY(PCI0M0REMAP);
PCI_MAPPING_ENTRY(PCI0M1);
PCI_REMAPPING_ENTRY(PCI0M1REMAP);
PCI_MAPPING_ENTRY(PCI1IO);
PCI_REMAPPING_ENTRY(PCI1IOREMAP);
PCI_MAPPING_ENTRY(PCI1M0);
PCI_REMAPPING_ENTRY(PCI1M0REMAP);
PCI_MAPPING_ENTRY(PCI1M1);
PCI_REMAPPING_ENTRY(PCI1M1REMAP);
PCI_MAPPING_ENTRY(ISD);
} GT64120State;
static void gt64120_pci_mapping(GT64120State *s)
/* Adjust range to avoid touching space which isn't mappable via PCI */
/* XXX: Hardcoded values for Malta: 0x1e000000 - 0x1f100000
0x1fc00000 - 0x1fd00000 */
static void check_reserved_space (target_phys_addr_t *start,
target_phys_addr_t *length)
{
/* Update IO mapping */
if ((s->regs[GT_PCI0IOLD] & 0x7f) <= s->regs[GT_PCI0IOHD])
{
/* Unmap old IO address */
if (s->PCI0IO_length)
{
cpu_register_physical_memory(s->PCI0IO_start, s->PCI0IO_length, IO_MEM_UNASSIGNED);
}
/* Map new IO address */
s->PCI0IO_start = s->regs[GT_PCI0IOLD] << 21;
s->PCI0IO_length = ((s->regs[GT_PCI0IOHD] + 1) - (s->regs[GT_PCI0IOLD] & 0x7f)) << 21;
isa_mem_base = s->PCI0IO_start;
isa_mmio_init(s->PCI0IO_start, s->PCI0IO_length);
}
target_phys_addr_t begin = *start;
target_phys_addr_t end = *start + *length;
if (end >= 0x1e000000LL && end < 0x1f100000LL)
end = 0x1e000000LL;
if (begin >= 0x1e000000LL && begin < 0x1f100000LL)
begin = 0x1f100000LL;
if (end >= 0x1fc00000LL && end < 0x1fd00000LL)
end = 0x1fc00000LL;
if (begin >= 0x1fc00000LL && begin < 0x1fd00000LL)
begin = 0x1fd00000LL;
/* XXX: This is broken when a reserved range splits the requested range */
if (end >= 0x1f100000LL && begin < 0x1e000000LL)
end = 0x1e000000LL;
if (end >= 0x1fd00000LL && begin < 0x1fc00000LL)
end = 0x1fc00000LL;
*start = begin;
*length = end - begin;
}
/* XXX: cpu_register_physical_memory isn't really suited for dynamic mappings
since it doesn't layer several mappings over the same address range.
This should keep track of mappings as set of 2 MB pages / 20 mappings. */
#define BUILD_UPDATE_PCI_MAPPING(reg, remap) \
static void gt64120_## reg ##_mapping(GT64120State *s) \
{ \
target_phys_addr_t start = s->regs[GT_## reg ##LD] << 21; \
target_phys_addr_t length = ((s->regs[GT_## reg ##HD] + 1) - \
(s->regs[GT_## reg ##LD] & 0x7f)) << 21; \
\
/* Unmap old address */ \
if (s->remap ##_length) \
cpu_register_physical_memory(s->remap ##_start, \
s->remap ##_length, \
IO_MEM_UNASSIGNED); \
s->remap ##_length = 0; \
if (s->reg ##_length) \
cpu_register_physical_memory(s->reg ##_start, \
s->reg ##_length, \
IO_MEM_UNASSIGNED); \
\
if ((s->regs[GT_## reg ##LD] & 0x7f) <= s->regs[GT_## reg ##HD]) \
{ \
check_reserved_space(&start, &length); \
/* Map new address */ \
dprintf("PCI " # reg ": %x@%x -> %x@%x, %x\n", s->reg ##_length, s->reg ##_start, length, start, s->reg ##_handle); \
s->reg ##_start = start; \
s->reg ##_length = length; \
cpu_register_physical_memory(s->reg ##_start, \
s->reg ##_length, \
s->reg ##_handle); \
} else \
dprintf("PCI " # reg ": %x@%x disabled, %x\n", s->reg ##_length, s->reg ##_start, s->reg ##_handle); \
} \
\
static void gt64120_## remap ##_mapping(GT64120State *s) \
{ \
/* XXX: range calculation is broken */ \
target_phys_addr_t start = (s->reg ## _start & ~(0x7ff << 21)) | \
(s->regs[GT_## remap] << 21); \
target_phys_addr_t length = s->reg ##_length; \
\
if (s->remap ##_length) \
cpu_register_physical_memory(s->remap ##_start, \
s->remap ##_length, \
IO_MEM_UNASSIGNED); \
check_reserved_space(&start, &length); \
s->remap ##_start = start; \
s->remap ##_length = length; \
s->remap ##_offset = s->reg ##_start - start; \
dprintf("PCI " # remap ": %x@%x +> %x@%x, %x\n", s->reg ##_length, s->reg ##_start, length, start, s->remap ##_handle); \
cpu_register_physical_memory(s->remap ##_start, \
s->remap ##_length, \
s->remap ##_handle); \
}
BUILD_UPDATE_PCI_MAPPING(SCS10, SCS10AR)
BUILD_UPDATE_PCI_MAPPING(SCS32, SCS32AR)
BUILD_UPDATE_PCI_MAPPING(CS20, CS20R)
BUILD_UPDATE_PCI_MAPPING(CS3BOOT, CS3BOOTR)
BUILD_UPDATE_PCI_MAPPING(PCI0IO, PCI0IOREMAP)
BUILD_UPDATE_PCI_MAPPING(PCI0M0, PCI0M0REMAP)
BUILD_UPDATE_PCI_MAPPING(PCI0M1, PCI0M1REMAP)
BUILD_UPDATE_PCI_MAPPING(PCI1IO, PCI1IOREMAP)
BUILD_UPDATE_PCI_MAPPING(PCI1M0, PCI1M0REMAP)
BUILD_UPDATE_PCI_MAPPING(PCI1M1, PCI1M1REMAP)
static void gt64120_isd_mapping(GT64120State *s)
{
if (s->ISD_length)
cpu_register_physical_memory(s->ISD_start, s->ISD_length,
IO_MEM_UNASSIGNED);
dprintf("PCI ISD: %x@%x -> %x@%x, %x\n", s->ISD_length, s->ISD_start, 0x1000, s->regs[GT_ISD] << 21, s->ISD_handle);
s->ISD_start = s->regs[GT_ISD] << 21;
s->ISD_length = 0x1000;
cpu_register_physical_memory(s->ISD_start, s->ISD_length, s->ISD_handle);
}
static void gt64120_mmio_writeb (void *opaque, target_phys_addr_t addr,
uint32_t val)
{
cpu_outb(NULL, addr & 0xffff, val);
}
static void gt64120_mmio_writew (void *opaque, target_phys_addr_t addr,
uint32_t val)
{
#ifdef TARGET_WORDS_BIGENDIAN
val = bswap16(val);
#endif
cpu_outw(NULL, addr & 0xffff, val);
}
static void gt64120_mmio_writel (void *opaque, target_phys_addr_t addr,
uint32_t val)
{
#ifdef TARGET_WORDS_BIGENDIAN
val = bswap32(val);
#endif
cpu_outl(NULL, addr & 0xffff, val);
}
static uint32_t gt64120_mmio_readb (void *opaque, target_phys_addr_t addr)
{
uint32_t val;
val = cpu_inb(NULL, addr & 0xffff);
return val;
}
static uint32_t gt64120_mmio_readw (void *opaque, target_phys_addr_t addr)
{
uint32_t val;
val = cpu_inw(NULL, addr & 0xffff);
#ifdef TARGET_WORDS_BIGENDIAN
val = bswap16(val);
#endif
return val;
}
static uint32_t gt64120_mmio_readl (void *opaque, target_phys_addr_t addr)
{
uint32_t val;
val = cpu_inl(NULL, addr & 0xffff);
#ifdef TARGET_WORDS_BIGENDIAN
val = bswap32(val);
#endif
return val;
}
static CPUWriteMemoryFunc *gt64120_mmio_write[] = {
&gt64120_mmio_writeb,
&gt64120_mmio_writew,
&gt64120_mmio_writel,
};
static CPUReadMemoryFunc *gt64120_mmio_read[] = {
&gt64120_mmio_readb,
&gt64120_mmio_readw,
&gt64120_mmio_readl,
};
static void gt64120_writel (void *opaque, target_phys_addr_t addr,
uint32_t val)
{
......@@ -272,53 +455,142 @@ static void gt64120_writel (void *opaque, target_phys_addr_t addr,
break;
/* CPU Address Decode */
case GT_SCS10LD:
s->regs[GT_SCS10LD] = val & 0x00007fff;
s->regs[GT_SCS10AR] = val & 0x000007ff;
gt64120_SCS10_mapping(s);
break;
case GT_SCS32LD:
s->regs[GT_SCS32LD] = val & 0x00007fff;
s->regs[GT_SCS32AR] = val & 0x000007ff;
//
// gt64120_SCS32_mapping(s);
break;
case GT_CS20LD:
s->regs[GT_CS20LD] = val & 0x00007fff;
s->regs[GT_CS20R] = val & 0x000007ff;
gt64120_CS20_mapping(s);
break;
case GT_CS3BOOTLD:
s->regs[GT_CS3BOOTLD] = val & 0x00007fff;
s->regs[GT_CS3BOOTR] = val & 0x000007ff;
gt64120_CS3BOOT_mapping(s);
break;
case GT_SCS10HD:
s->regs[saddr] = val & 0x0000007f;
gt64120_SCS10_mapping(s);
break;
case GT_SCS32HD:
s->regs[saddr] = val & 0x0000007f;
//
// gt64120_SCS32_mapping(s);
break;
case GT_CS20HD:
s->regs[saddr] = val & 0x0000007f;
gt64120_CS20_mapping(s);
break;
case GT_CS3BOOTHD:
s->regs[saddr] = val & 0x0000007f;
gt64120_CS3BOOT_mapping(s);
break;
case GT_PCI0IOLD:
s->regs[GT_PCI0IOLD] = val & 0x00007fff;
s->regs[GT_PCI0IOREMAP] = val & 0x000007ff;
gt64120_pci_mapping(s);
gt64120_PCI0IO_mapping(s);
break;
case GT_PCI0M0LD:
s->regs[GT_PCI0M0LD] = val & 0x00007fff;
s->regs[GT_PCI0M0REMAP] = val & 0x000007ff;
gt64120_pci_mapping(s);
gt64120_PCI0M0_mapping(s);
break;
case GT_PCI0M1LD:
s->regs[GT_PCI0M1LD] = val & 0x00007fff;
s->regs[GT_PCI0M1REMAP] = val & 0x000007ff;
gt64120_pci_mapping(s);
gt64120_PCI0M1_mapping(s);
break;
case GT_PCI1IOLD:
s->regs[GT_PCI1IOLD] = val & 0x00007fff;
s->regs[GT_PCI1IOREMAP] = val & 0x000007ff;
gt64120_pci_mapping(s);
gt64120_PCI1IO_mapping(s);
break;
case GT_PCI1M0LD:
s->regs[GT_PCI1M0LD] = val & 0x00007fff;
s->regs[GT_PCI1M0REMAP] = val & 0x000007ff;
gt64120_pci_mapping(s);
gt64120_PCI1M1_mapping(s);
break;
case GT_PCI1M1LD:
s->regs[GT_PCI1M1LD] = val & 0x00007fff;
s->regs[GT_PCI1M1REMAP] = val & 0x000007ff;
gt64120_pci_mapping(s);
gt64120_PCI1M1_mapping(s);
break;
case GT_PCI0IOHD:
s->regs[saddr] = val & 0x0000007f;
gt64120_PCI0IO_mapping(s);
break;
case GT_PCI0M0HD:
s->regs[saddr] = val & 0x0000007f;
gt64120_PCI0M0_mapping(s);
break;
case GT_PCI0M1HD:
s->regs[saddr] = val & 0x0000007f;
gt64120_PCI0M1_mapping(s);
break;
case GT_PCI1IOHD:
s->regs[saddr] = val & 0x0000007f;
gt64120_PCI1IO_mapping(s);
break;
case GT_PCI1M0HD:
s->regs[saddr] = val & 0x0000007f;
gt64120_PCI1M0_mapping(s);
break;
case GT_PCI1M1HD:
s->regs[saddr] = val & 0x0000007f;
gt64120_pci_mapping(s);
gt64120_PCI1M1_mapping(s);
break;
case GT_ISD:
s->regs[saddr] = val & 0x00007fff;
gt64120_isd_mapping(s);
break;
case GT_SCS10AR:
s->regs[saddr] = val & 0x000007ff;
gt64120_SCS10AR_mapping(s);
break;
case GT_SCS32AR:
s->regs[saddr] = val & 0x000007ff;
gt64120_SCS32AR_mapping(s);
break;
case GT_CS20R:
s->regs[saddr] = val & 0x000007ff;
gt64120_CS20R_mapping(s);
break;
case GT_CS3BOOTR:
s->regs[saddr] = val & 0x000007ff;
gt64120_CS3BOOTR_mapping(s);
break;
case GT_PCI0IOREMAP:
s->regs[saddr] = val & 0x000007ff;
gt64120_PCI0IOREMAP_mapping(s);
break;
case GT_PCI0M0REMAP:
s->regs[saddr] = val & 0x000007ff;
gt64120_PCI0M0REMAP_mapping(s);
break;
case GT_PCI0M1REMAP:
s->regs[saddr] = val & 0x000007ff;
gt64120_PCI0M1REMAP_mapping(s);
break;
case GT_PCI1IOREMAP:
s->regs[saddr] = val & 0x000007ff;
gt64120_PCI1IOREMAP_mapping(s);
break;
case GT_PCI1M0REMAP:
s->regs[saddr] = val & 0x000007ff;
gt64120_PCI1M0REMAP_mapping(s);
break;
case GT_PCI1M1REMAP:
s->regs[saddr] = val & 0x000007ff;
gt64120_pci_mapping(s);
gt64120_PCI1M1REMAP_mapping(s);
break;
/* CPU Error Report */
......@@ -1026,7 +1298,17 @@ void gt64120_reset(void *opaque)
/* Interrupt registers are all zeroed at reset */
gt64120_pci_mapping(s);
gt64120_isd_mapping(s);
gt64120_SCS10_mapping(s);
// gt64120_SCS32_mapping(s);
gt64120_CS20_mapping(s);
gt64120_CS3BOOT_mapping(s);
gt64120_PCI0IO_mapping(s);
gt64120_PCI0M0_mapping(s);
gt64120_PCI0M1_mapping(s);
gt64120_PCI1IO_mapping(s);
gt64120_PCI1M0_mapping(s);
gt64120_PCI1M1_mapping(s);
}
static uint32_t gt64120_read_config(PCIDevice *d, uint32_t address, int len)
......@@ -1070,18 +1352,16 @@ PCIBus *pci_gt64120_init(qemu_irq *pic)
{
GT64120State *s;
PCIDevice *d;
int gt64120;
s = qemu_mallocz(sizeof(GT64120State));
s->pci = qemu_mallocz(sizeof(GT64120PCIState));
gt64120_reset(s);
s->pci->bus = pci_register_bus(pci_gt64120_set_irq, pci_gt64120_map_irq,
pic, 144, 4);
gt64120 = cpu_register_io_memory(0, gt64120_read,
gt64120_write, s);
cpu_register_physical_memory(0x1be00000LL, 0x1000, gt64120);
s->ISD_handle = cpu_register_io_memory(0, gt64120_read, gt64120_write, s);
s->PCI0IO_handle = cpu_register_io_memory(0, gt64120_mmio_read,
gt64120_mmio_write, s);
gt64120_reset(s);
d = pci_register_device(s->pci->bus, "GT64120 PCI Bus", sizeof(PCIDevice),
0, gt64120_read_config, gt64120_write_config);
......
......@@ -543,6 +543,15 @@ static void write_bootloader (CPUState *env, unsigned long bios_offset, int64_t
stl_raw(p++, 0x34e70000 | (env->ram_size & 0xffff)); /* ori a3, a3, low(env->ram_size) */
/* Load BAR registers as done by YAMON */
stl_raw(p++, 0x3c09b400); /* lui t1, 0xb400 */
#ifdef TARGET_WORDS_BIGENDIAN
stl_raw(p++, 0x3c08df00); /* lui t0, 0xdf00 */
#else
stl_raw(p++, 0x340800df); /* ori t0, r0, 0x00df */
#endif
stl_raw(p++, 0xad280068); /* sw t0, 0x0068(t1) */
stl_raw(p++, 0x3c09bbe0); /* lui t1, 0xbbe0 */
#ifdef TARGET_WORDS_BIGENDIAN
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment