279 lines
		
	
	
		
			7.1 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			279 lines
		
	
	
		
			7.1 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * Renesas SH7751R R2D-PLUS emulation
 | 
						|
 *
 | 
						|
 * Copyright (c) 2007 Magnus Damm
 | 
						|
 * Copyright (c) 2008 Paul Mundt
 | 
						|
 *
 | 
						|
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 | 
						|
 * of this software and associated documentation files (the "Software"), to deal
 | 
						|
 * in the Software without restriction, including without limitation the rights
 | 
						|
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 | 
						|
 * copies of the Software, and to permit persons to whom the Software is
 | 
						|
 * furnished to do so, subject to the following conditions:
 | 
						|
 *
 | 
						|
 * The above copyright notice and this permission notice shall be included in
 | 
						|
 * all copies or substantial portions of the Software.
 | 
						|
 *
 | 
						|
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 | 
						|
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 | 
						|
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 | 
						|
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 | 
						|
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 | 
						|
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 | 
						|
 * THE SOFTWARE.
 | 
						|
 */
 | 
						|
 | 
						|
#include "hw.h"
 | 
						|
#include "sh.h"
 | 
						|
#include "devices.h"
 | 
						|
#include "sysemu.h"
 | 
						|
#include "boards.h"
 | 
						|
#include "pci.h"
 | 
						|
#include "sh_pci.h"
 | 
						|
#include "net.h"
 | 
						|
#include "sh7750_regs.h"
 | 
						|
#include "ide.h"
 | 
						|
#include "loader.h"
 | 
						|
 | 
						|
#define SDRAM_BASE 0x0c000000 /* Physical location of SDRAM: Area 3 */
 | 
						|
#define SDRAM_SIZE 0x04000000
 | 
						|
 | 
						|
#define SM501_VRAM_SIZE 0x800000
 | 
						|
 | 
						|
/* CONFIG_BOOT_LINK_OFFSET of Linux kernel */
 | 
						|
#define LINUX_LOAD_OFFSET 0x800000
 | 
						|
 | 
						|
#define PA_IRLMSK	0x00
 | 
						|
#define PA_POWOFF	0x30
 | 
						|
#define PA_VERREG	0x32
 | 
						|
#define PA_OUTPORT	0x36
 | 
						|
 | 
						|
typedef struct {
 | 
						|
    uint16_t bcr;
 | 
						|
    uint16_t irlmsk;
 | 
						|
    uint16_t irlmon;
 | 
						|
    uint16_t cfctl;
 | 
						|
    uint16_t cfpow;
 | 
						|
    uint16_t dispctl;
 | 
						|
    uint16_t sdmpow;
 | 
						|
    uint16_t rtcce;
 | 
						|
    uint16_t pcicd;
 | 
						|
    uint16_t voyagerrts;
 | 
						|
    uint16_t cfrst;
 | 
						|
    uint16_t admrts;
 | 
						|
    uint16_t extrst;
 | 
						|
    uint16_t cfcdintclr;
 | 
						|
    uint16_t keyctlclr;
 | 
						|
    uint16_t pad0;
 | 
						|
    uint16_t pad1;
 | 
						|
    uint16_t powoff;
 | 
						|
    uint16_t verreg;
 | 
						|
    uint16_t inport;
 | 
						|
    uint16_t outport;
 | 
						|
    uint16_t bverreg;
 | 
						|
 | 
						|
/* output pin */
 | 
						|
    qemu_irq irl;
 | 
						|
} r2d_fpga_t;
 | 
						|
 | 
						|
enum r2d_fpga_irq {
 | 
						|
    PCI_INTD, CF_IDE, CF_CD, PCI_INTC, SM501, KEY, RTC_A, RTC_T,
 | 
						|
    SDCARD, PCI_INTA, PCI_INTB, EXT, TP,
 | 
						|
    NR_IRQS
 | 
						|
};
 | 
						|
 | 
						|
static const struct { short irl; uint16_t msk; } irqtab[NR_IRQS] = {
 | 
						|
    [CF_IDE]	= {  1, 1<<9 },
 | 
						|
    [CF_CD]	= {  2, 1<<8 },
 | 
						|
    [PCI_INTA]	= {  9, 1<<14 },
 | 
						|
    [PCI_INTB]	= { 10, 1<<13 },
 | 
						|
    [PCI_INTC]	= {  3, 1<<12 },
 | 
						|
    [PCI_INTD]	= {  0, 1<<11 },
 | 
						|
    [SM501]	= {  4, 1<<10 },
 | 
						|
    [KEY]	= {  5, 1<<6 },
 | 
						|
    [RTC_A]	= {  6, 1<<5 },
 | 
						|
    [RTC_T]	= {  7, 1<<4 },
 | 
						|
    [SDCARD]	= {  8, 1<<7 },
 | 
						|
    [EXT]	= { 11, 1<<0 },
 | 
						|
    [TP]	= { 12, 1<<15 },
 | 
						|
};
 | 
						|
 | 
						|
static void update_irl(r2d_fpga_t *fpga)
 | 
						|
{
 | 
						|
    int i, irl = 15;
 | 
						|
    for (i = 0; i < NR_IRQS; i++)
 | 
						|
        if (fpga->irlmon & fpga->irlmsk & irqtab[i].msk)
 | 
						|
            if (irqtab[i].irl < irl)
 | 
						|
                irl = irqtab[i].irl;
 | 
						|
    qemu_set_irq(fpga->irl, irl ^ 15);
 | 
						|
}
 | 
						|
 | 
						|
static void r2d_fpga_irq_set(void *opaque, int n, int level)
 | 
						|
{
 | 
						|
    r2d_fpga_t *fpga = opaque;
 | 
						|
    if (level)
 | 
						|
        fpga->irlmon |= irqtab[n].msk;
 | 
						|
    else
 | 
						|
        fpga->irlmon &= ~irqtab[n].msk;
 | 
						|
    update_irl(fpga);
 | 
						|
}
 | 
						|
 | 
						|
static uint32_t r2d_fpga_read(void *opaque, target_phys_addr_t addr)
 | 
						|
{
 | 
						|
    r2d_fpga_t *s = opaque;
 | 
						|
 | 
						|
    switch (addr) {
 | 
						|
    case PA_IRLMSK:
 | 
						|
        return s->irlmsk;
 | 
						|
    case PA_OUTPORT:
 | 
						|
	return s->outport;
 | 
						|
    case PA_POWOFF:
 | 
						|
	return s->powoff;
 | 
						|
    case PA_VERREG:
 | 
						|
	return 0x10;
 | 
						|
    }
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static void
 | 
						|
r2d_fpga_write(void *opaque, target_phys_addr_t addr, uint32_t value)
 | 
						|
{
 | 
						|
    r2d_fpga_t *s = opaque;
 | 
						|
 | 
						|
    switch (addr) {
 | 
						|
    case PA_IRLMSK:
 | 
						|
        s->irlmsk = value;
 | 
						|
        update_irl(s);
 | 
						|
	break;
 | 
						|
    case PA_OUTPORT:
 | 
						|
	s->outport = value;
 | 
						|
	break;
 | 
						|
    case PA_POWOFF:
 | 
						|
	s->powoff = value;
 | 
						|
	break;
 | 
						|
    case PA_VERREG:
 | 
						|
	/* Discard writes */
 | 
						|
	break;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static CPUReadMemoryFunc * const r2d_fpga_readfn[] = {
 | 
						|
    r2d_fpga_read,
 | 
						|
    r2d_fpga_read,
 | 
						|
    NULL,
 | 
						|
};
 | 
						|
 | 
						|
static CPUWriteMemoryFunc * const r2d_fpga_writefn[] = {
 | 
						|
    r2d_fpga_write,
 | 
						|
    r2d_fpga_write,
 | 
						|
    NULL,
 | 
						|
};
 | 
						|
 | 
						|
static qemu_irq *r2d_fpga_init(target_phys_addr_t base, qemu_irq irl)
 | 
						|
{
 | 
						|
    int iomemtype;
 | 
						|
    r2d_fpga_t *s;
 | 
						|
 | 
						|
    s = qemu_mallocz(sizeof(r2d_fpga_t));
 | 
						|
 | 
						|
    s->irl = irl;
 | 
						|
 | 
						|
    iomemtype = cpu_register_io_memory(r2d_fpga_readfn,
 | 
						|
				       r2d_fpga_writefn, s);
 | 
						|
    cpu_register_physical_memory(base, 0x40, iomemtype);
 | 
						|
    return qemu_allocate_irqs(r2d_fpga_irq_set, s, NR_IRQS);
 | 
						|
}
 | 
						|
 | 
						|
static void r2d_pci_set_irq(void *opaque, int n, int l)
 | 
						|
{
 | 
						|
    qemu_irq *p = opaque;
 | 
						|
 | 
						|
    qemu_set_irq(p[n], l);
 | 
						|
}
 | 
						|
 | 
						|
static int r2d_pci_map_irq(PCIDevice *d, int irq_num)
 | 
						|
{
 | 
						|
    const int intx[] = { PCI_INTA, PCI_INTB, PCI_INTC, PCI_INTD };
 | 
						|
    return intx[d->devfn >> 3];
 | 
						|
}
 | 
						|
 | 
						|
static void r2d_init(ram_addr_t ram_size,
 | 
						|
              const char *boot_device,
 | 
						|
	      const char *kernel_filename, const char *kernel_cmdline,
 | 
						|
	      const char *initrd_filename, const char *cpu_model)
 | 
						|
{
 | 
						|
    CPUState *env;
 | 
						|
    struct SH7750State *s;
 | 
						|
    ram_addr_t sdram_addr;
 | 
						|
    qemu_irq *irq;
 | 
						|
    PCIBus *pci;
 | 
						|
    DriveInfo *dinfo;
 | 
						|
    int i;
 | 
						|
 | 
						|
    if (!cpu_model)
 | 
						|
        cpu_model = "SH7751R";
 | 
						|
 | 
						|
    env = cpu_init(cpu_model);
 | 
						|
    if (!env) {
 | 
						|
        fprintf(stderr, "Unable to find CPU definition\n");
 | 
						|
        exit(1);
 | 
						|
    }
 | 
						|
 | 
						|
    /* Allocate memory space */
 | 
						|
    sdram_addr = qemu_ram_alloc(SDRAM_SIZE);
 | 
						|
    cpu_register_physical_memory(SDRAM_BASE, SDRAM_SIZE, sdram_addr);
 | 
						|
    /* Register peripherals */
 | 
						|
    s = sh7750_init(env);
 | 
						|
    irq = r2d_fpga_init(0x04000000, sh7750_irl(s));
 | 
						|
    pci = sh_pci_register_bus(r2d_pci_set_irq, r2d_pci_map_irq, irq, 0, 4);
 | 
						|
 | 
						|
    sm501_init(0x10000000, SM501_VRAM_SIZE, irq[SM501], serial_hds[2]);
 | 
						|
 | 
						|
    /* onboard CF (True IDE mode, Master only). */
 | 
						|
    if ((dinfo = drive_get(IF_IDE, 0, 0)) != NULL)
 | 
						|
	mmio_ide_init(0x14001000, 0x1400080c, irq[CF_IDE], 1,
 | 
						|
		      dinfo, NULL);
 | 
						|
 | 
						|
    /* NIC: rtl8139 on-board, and 2 slots. */
 | 
						|
    for (i = 0; i < nb_nics; i++)
 | 
						|
        pci_nic_init_nofail(&nd_table[i], "rtl8139", i==0 ? "2" : NULL);
 | 
						|
 | 
						|
    /* Todo: register on board registers */
 | 
						|
    if (kernel_filename) {
 | 
						|
      int kernel_size;
 | 
						|
      /* initialization which should be done by firmware */
 | 
						|
      stl_phys(SH7750_BCR1, 1<<3); /* cs3 SDRAM */
 | 
						|
      stw_phys(SH7750_BCR2, 3<<(3*2)); /* cs3 32bit */
 | 
						|
 | 
						|
      if (kernel_cmdline) {
 | 
						|
          kernel_size = load_image_targphys(kernel_filename,
 | 
						|
				   SDRAM_BASE + LINUX_LOAD_OFFSET,
 | 
						|
				   SDRAM_SIZE - LINUX_LOAD_OFFSET);
 | 
						|
          env->pc = (SDRAM_BASE + LINUX_LOAD_OFFSET) | 0xa0000000;
 | 
						|
          pstrcpy_targphys("cmdline", SDRAM_BASE + 0x10100, 256, kernel_cmdline);
 | 
						|
      } else {
 | 
						|
          kernel_size = load_image_targphys(kernel_filename, SDRAM_BASE, SDRAM_SIZE);
 | 
						|
          env->pc = SDRAM_BASE | 0xa0000000; /* Start from P2 area */
 | 
						|
      }
 | 
						|
 | 
						|
      if (kernel_size < 0) {
 | 
						|
        fprintf(stderr, "qemu: could not load kernel '%s'\n", kernel_filename);
 | 
						|
        exit(1);
 | 
						|
      }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static QEMUMachine r2d_machine = {
 | 
						|
    .name = "r2d",
 | 
						|
    .desc = "r2d-plus board",
 | 
						|
    .init = r2d_init,
 | 
						|
};
 | 
						|
 | 
						|
static void r2d_machine_init(void)
 | 
						|
{
 | 
						|
    qemu_register_machine(&r2d_machine);
 | 
						|
}
 | 
						|
 | 
						|
machine_init(r2d_machine_init);
 |