/* * ARM Versatile Platform/Application Baseboard System emulation. * * Copyright (c) 2005-2006 CodeSourcery. * Written by Paul Brook * * This code is licenced under the GPL. */ #include "vl.h" #include "arm_pic.h" /* Primary interrupt controller. */ typedef struct vpb_sic_state { arm_pic_handler handler; uint32_t base; uint32_t level; uint32_t mask; uint32_t pic_enable; void *parent; int irq; } vpb_sic_state; static void vpb_sic_update(vpb_sic_state *s) { uint32_t flags; flags = s->level & s->mask; pic_set_irq_new(s->parent, s->irq, flags != 0); } static void vpb_sic_update_pic(vpb_sic_state *s) { int i; uint32_t mask; for (i = 21; i <= 30; i++) { mask = 1u << i; if (!(s->pic_enable & mask)) continue; pic_set_irq_new(s->parent, i, (s->level & mask) != 0); } } static void vpb_sic_set_irq(void *opaque, int irq, int level) { vpb_sic_state *s = (vpb_sic_state *)opaque; if (level) s->level |= 1u << irq; else s->level &= ~(1u << irq); if (s->pic_enable & (1u << irq)) pic_set_irq_new(s->parent, irq, level); vpb_sic_update(s); } static uint32_t vpb_sic_read(void *opaque, target_phys_addr_t offset) { vpb_sic_state *s = (vpb_sic_state *)opaque; offset -= s->base; switch (offset >> 2) { case 0: /* STATUS */ return s->level & s->mask; case 1: /* RAWSTAT */ return s->level; case 2: /* ENABLE */ return s->mask; case 4: /* SOFTINT */ return s->level & 1; case 8: /* PICENABLE */ return s->pic_enable; default: printf ("vpb_sic_read: Bad register offset 0x%x\n", (int)offset); return 0; } } static void vpb_sic_write(void *opaque, target_phys_addr_t offset, uint32_t value) { vpb_sic_state *s = (vpb_sic_state *)opaque; offset -= s->base; switch (offset >> 2) { case 2: /* ENSET */ s->mask |= value; break; case 3: /* ENCLR */ s->mask &= ~value; break; case 4: /* SOFTINTSET */ if (value) s->mask |= 1; break; case 5: /* SOFTINTCLR */ if (value) s->mask &= ~1u; break; case 8: /* PICENSET */ s->pic_enable |= (value & 0x7fe00000); vpb_sic_update_pic(s); break; case 9: /* PICENCLR */ s->pic_enable &= ~value; vpb_sic_update_pic(s); break; default: printf ("vpb_sic_write: Bad register offset 0x%x\n", (int)offset); return; } vpb_sic_update(s); } static CPUReadMemoryFunc *vpb_sic_readfn[] = { vpb_sic_read, vpb_sic_read, vpb_sic_read }; static CPUWriteMemoryFunc *vpb_sic_writefn[] = { vpb_sic_write, vpb_sic_write, vpb_sic_write }; static vpb_sic_state *vpb_sic_init(uint32_t base, void *parent, int irq) { vpb_sic_state *s; int iomemtype; s = (vpb_sic_state *)qemu_mallocz(sizeof(vpb_sic_state)); if (!s) return NULL; s->handler = vpb_sic_set_irq; s->base = base; s->parent = parent; s->irq = irq; iomemtype = cpu_register_io_memory(0, vpb_sic_readfn, vpb_sic_writefn, s); cpu_register_physical_memory(base, 0x00000fff, iomemtype); /* ??? Save/restore. */ return s; } /* Board init. */ /* The AB and PB boards both use the same core, just with different peripherans and expansion busses. For now we emulate a subset of the PB peripherals and just change the board ID. */ static void versatile_init(int ram_size, int vga_ram_size, int boot_device, DisplayState *ds, const char **fd_filename, int snapshot, const char *kernel_filename, const char *kernel_cmdline, const char *initrd_filename, int board_id) { CPUState *env; void *pic; void *sic; void *scsi_hba; PCIBus *pci_bus; NICInfo *nd; int n; int done_smc = 0; env = cpu_init(); cpu_arm_set_model(env, ARM_CPUID_ARM926); /* ??? RAM shoud repeat to fill physical