hw/r2d.c - third_party/qemu - Git at Google

 /*
  * 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 "sysbus.h"
 #include "hw.h"
 #include "sh.h"
 #include "devices.h"
 #include "sysemu.h"
 #include "boards.h"
 #include "pci.h"
 #include "net.h"
 #include "sh7750_regs.h"
 #include "ide.h"
 #include "loader.h"
 #include "usb.h"
 #include "flash.h"
 #include "blockdev.h"

 #define FLASH_BASE 0x00000000
 #define FLASH_SIZE 0x02000000

 #define SDRAM_BASE 0x0c000000 /* Physical location of SDRAM: Area 3 */
 #define SDRAM_SIZE 0x04000000

 #define SM501_VRAM_SIZE 0x800000

 #define BOOT_PARAMS_OFFSET 0x0010000
 /* CONFIG_BOOT_LINK_OFFSET of Linux kernel */
 #define LINUX_LOAD_OFFSET  0x0800000
 #define INITRD_LOAD_OFFSET 0x1800000

 #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 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 0x00;
     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:
         if (value & 1) {
             qemu_system_shutdown_request();
         }
         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,
                                        DEVICE_NATIVE_ENDIAN);
     cpu_register_physical_memory(base, 0x40, iomemtype);
     return qemu_allocate_irqs(r2d_fpga_irq_set, s, NR_IRQS);
 }

 typedef struct ResetData {
     CPUState *env;
     uint32_t vector;
 } ResetData;

 static void main_cpu_reset(void *opaque)
 {
     ResetData *s = (ResetData *)opaque;
     CPUState *env = s->env;

     cpu_reset(env);
     env->pc = s->vector;
 }

 static struct __attribute__((__packed__))
 {
     int mount_root_rdonly;
     int ramdisk_flags;
     int orig_root_dev;
     int loader_type;
     int initrd_start;
     int initrd_size;

     char pad[232];

     char kernel_cmdline[256];
 } boot_params;

 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;
     ResetData *reset_info;
     struct SH7750State *s;
     ram_addr_t sdram_addr;
     qemu_irq *irq;
     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);
     }
     reset_info = qemu_mallocz(sizeof(ResetData));
     reset_info->env = env;
     reset_info->vector = env->pc;
     qemu_register_reset(main_cpu_reset, reset_info);

     /* Allocate memory space */
     sdram_addr = qemu_ram_alloc(NULL, "r2d.sdram", 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));
     sysbus_create_varargs("sh_pci", 0x1e200000, irq[PCI_INTA], irq[PCI_INTB],
                           irq[PCI_INTC], irq[PCI_INTD], NULL);

     sm501_init(0x10000000, SM501_VRAM_SIZE, irq[SM501], serial_hds[2]);

     /* onboard CF (True IDE mode, Master only). */
     dinfo = drive_get(IF_IDE, 0, 0);
     mmio_ide_init(0x14001000, 0x1400080c, irq[CF_IDE], 1,
                   dinfo, NULL);

     /* onboard flash memory */
     dinfo = drive_get(IF_PFLASH, 0, 0);
     pflash_cfi02_register(0x0, qemu_ram_alloc(NULL, "r2d.flash", FLASH_SIZE),
                           dinfo ? dinfo->bdrv : NULL, (16 * 1024),
                           FLASH_SIZE >> 16,
                           1, 4, 0x0000, 0x0000, 0x0000, 0x0000,
                           0x555, 0x2aa, 0);

     /* 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);

     /* USB keyboard */
     usbdevice_create("keyboard");

     /* Todo: register on board registers */
     memset(&boot_params, 0, sizeof(boot_params));

     if (kernel_filename) {
         int kernel_size;

         kernel_size = load_image_targphys(kernel_filename,
                                           SDRAM_BASE + LINUX_LOAD_OFFSET,
                                           INITRD_LOAD_OFFSET - LINUX_LOAD_OFFSET);
         if (kernel_size < 0) {
           fprintf(stderr, "qemu: could not load kernel '%s'\n", kernel_filename);
           exit(1);
         }

         /* initialization which should be done by firmware */
         stl_phys(SH7750_BCR1, 1<<3); /* cs3 SDRAM */
         stw_phys(SH7750_BCR2, 3<<(3*2)); /* cs3 32bit */
         reset_info->vector = (SDRAM_BASE + LINUX_LOAD_OFFSET) | 0xa0000000; /* Start from P2 area */
     }

     if (initrd_filename) {
         int initrd_size;

         initrd_size = load_image_targphys(initrd_filename,
                                           SDRAM_BASE + INITRD_LOAD_OFFSET,
                                           SDRAM_SIZE - INITRD_LOAD_OFFSET);

         if (initrd_size < 0) {
           fprintf(stderr, "qemu: could not load initrd '%s'\n", initrd_filename);
           exit(1);
         }

         /* initialization which should be done by firmware */
         boot_params.loader_type = 1;
         boot_params.initrd_start = INITRD_LOAD_OFFSET;
         boot_params.initrd_size = initrd_size;
     }

     if (kernel_cmdline) {
         strncpy(boot_params.kernel_cmdline, kernel_cmdline,
                 sizeof(boot_params.kernel_cmdline));
     }

     rom_add_blob_fixed("boot_params", &boot_params, sizeof(boot_params),
                        SDRAM_BASE + BOOT_PARAMS_OFFSET);
 }

 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);
	/*
	* 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 "sysbus.h"
	#include "hw.h"
	#include "sh.h"
	#include "devices.h"
	#include "sysemu.h"
	#include "boards.h"
	#include "pci.h"
	#include "net.h"
	#include "sh7750_regs.h"
	#include "ide.h"
	#include "loader.h"
	#include "usb.h"
	#include "flash.h"
	#include "blockdev.h"

	#define FLASH_BASE 0x00000000
	#define FLASH_SIZE 0x02000000

	#define SDRAM_BASE 0x0c000000 /* Physical location of SDRAM: Area 3 */
	#define SDRAM_SIZE 0x04000000

	#define SM501_VRAM_SIZE 0x800000

	#define BOOT_PARAMS_OFFSET 0x0010000
	/* CONFIG_BOOT_LINK_OFFSET of Linux kernel */
	#define LINUX_LOAD_OFFSET 0x0800000
	#define INITRD_LOAD_OFFSET 0x1800000

	#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 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 0x00;
	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:
	if (value & 1) {
	qemu_system_shutdown_request();
	}
	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,
	DEVICE_NATIVE_ENDIAN);
	cpu_register_physical_memory(base, 0x40, iomemtype);
	return qemu_allocate_irqs(r2d_fpga_irq_set, s, NR_IRQS);
	}

	typedef struct ResetData {
	CPUState *env;
	uint32_t vector;
	} ResetData;

	static void main_cpu_reset(void *opaque)
	{
	ResetData s = (ResetData )opaque;
	CPUState *env = s->env;

	cpu_reset(env);
	env->pc = s->vector;
	}

	static struct __attribute__((__packed__))
	{
	int mount_root_rdonly;
	int ramdisk_flags;
	int orig_root_dev;
	int loader_type;
	int initrd_start;
	int initrd_size;

	char pad[232];

	char kernel_cmdline[256];
	} boot_params;

	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;
	ResetData *reset_info;
	struct SH7750State *s;
	ram_addr_t sdram_addr;
	qemu_irq *irq;
	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);
	}
	reset_info = qemu_mallocz(sizeof(ResetData));
	reset_info->env = env;
	reset_info->vector = env->pc;
	qemu_register_reset(main_cpu_reset, reset_info);

	/* Allocate memory space */
	sdram_addr = qemu_ram_alloc(NULL, "r2d.sdram", 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));
	sysbus_create_varargs("sh_pci", 0x1e200000, irq[PCI_INTA], irq[PCI_INTB],
	irq[PCI_INTC], irq[PCI_INTD], NULL);

	sm501_init(0x10000000, SM501_VRAM_SIZE, irq[SM501], serial_hds[2]);

	/* onboard CF (True IDE mode, Master only). */
	dinfo = drive_get(IF_IDE, 0, 0);
	mmio_ide_init(0x14001000, 0x1400080c, irq[CF_IDE], 1,
	dinfo, NULL);

	/* onboard flash memory */
	dinfo = drive_get(IF_PFLASH, 0, 0);
	pflash_cfi02_register(0x0, qemu_ram_alloc(NULL, "r2d.flash", FLASH_SIZE),
	dinfo ? dinfo->bdrv : NULL, (16 * 1024),
	FLASH_SIZE >> 16,
	1, 4, 0x0000, 0x0000, 0x0000, 0x0000,
	0x555, 0x2aa, 0);

	/* 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);

	/* USB keyboard */
	usbdevice_create("keyboard");

	/* Todo: register on board registers */
	memset(&boot_params, 0, sizeof(boot_params));

	if (kernel_filename) {
	int kernel_size;

	kernel_size = load_image_targphys(kernel_filename,
	SDRAM_BASE + LINUX_LOAD_OFFSET,
	INITRD_LOAD_OFFSET - LINUX_LOAD_OFFSET);
	if (kernel_size < 0) {
	fprintf(stderr, "qemu: could not load kernel '%s'\n", kernel_filename);
	exit(1);
	}

	/* initialization which should be done by firmware */
	stl_phys(SH7750_BCR1, 1<<3); /* cs3 SDRAM */
	stw_phys(SH7750_BCR2, 3<<(32)); / cs3 32bit */
	reset_info->vector = (SDRAM_BASE + LINUX_LOAD_OFFSET) \| 0xa0000000; /* Start from P2 area */
	}

	if (initrd_filename) {
	int initrd_size;

	initrd_size = load_image_targphys(initrd_filename,
	SDRAM_BASE + INITRD_LOAD_OFFSET,
	SDRAM_SIZE - INITRD_LOAD_OFFSET);

	if (initrd_size < 0) {
	fprintf(stderr, "qemu: could not load initrd '%s'\n", initrd_filename);
	exit(1);
	}

	/* initialization which should be done by firmware */
	boot_params.loader_type = 1;
	boot_params.initrd_start = INITRD_LOAD_OFFSET;
	boot_params.initrd_size = initrd_size;
	}

	if (kernel_cmdline) {
	strncpy(boot_params.kernel_cmdline, kernel_cmdline,
	sizeof(boot_params.kernel_cmdline));
	}

	rom_add_blob_fixed("boot_params", &boot_params, sizeof(boot_params),
	SDRAM_BASE + BOOT_PARAMS_OFFSET);
	}

	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);