Received: from mailman by lists.gnu.org with tmda-scanned (Exim 4.43) id 1M1ckY-0006kB-GI for qemu-devel@nongnu.org; Wed, 06 May 2009 04:45:10 -0400 Received: from exim by lists.gnu.org with spam-scanned (Exim 4.43) id 1M1ckU-0006iE-TO for qemu-devel@nongnu.org; Wed, 06 May 2009 04:45:09 -0400 Received: from [199.232.76.173] (port=33366 helo=monty-python.gnu.org) by lists.gnu.org with esmtp (Exim 4.43) id 1M1ckT-0006hV-AT for qemu-devel@nongnu.org; Wed, 06 May 2009 04:45:05 -0400 Received: from flounder.pepperfish.net ([87.237.62.181]:38763) by monty-python.gnu.org with esmtps (TLS-1.0:RSA_AES_256_CBC_SHA1:32) (Exim 4.60) (envelope-from ) id 1M1ckS-00016u-Fn for qemu-devel@nongnu.org; Wed, 06 May 2009 04:45:04 -0400 From: Vincent Sanders Date: Wed, 6 May 2009 09:44:43 +0100 Message-Id: <1241599494-28654-5-git-send-email-vince@simtec.co.uk> In-Reply-To: <1241599494-28654-1-git-send-email-vince@simtec.co.uk> References: <1241599494-28654-1-git-send-email-vince@simtec.co.uk> Subject: [Qemu-devel] [PATCH 04/15] Peripheral driver for S3C SOC IRQ controller. List-Id: qemu-devel.nongnu.org List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , To: qemu-devel@nongnu.org Cc: Vincent Sanders Signed-off-by: Vincent Sanders --- Makefile.target | 2 +- hw/s3c24xx_irq.c | 200 ++++++++++++++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 201 insertions(+), 1 deletions(-) create mode 100644 hw/s3c24xx_irq.c diff --git a/Makefile.target b/Makefile.target index c5e6402..9d6d5fd 100644 --- a/Makefile.target +++ b/Makefile.target @@ -674,7 +674,7 @@ OBJS+= omap_sx1.o palm.o tsc210x.o OBJS+= nseries.o blizzard.o onenand.o vga.o cbus.o tusb6010.o usb-musb.o OBJS+= mst_fpga.o mainstone.o OBJS+= musicpal.o pflash_cfi02.o -OBJS+= s3c24xx_memc.o +OBJS+= s3c24xx_memc.o s3c24xx_irq.o OBJS+= framebuffer.o CPPFLAGS += -DHAS_AUDIO endif diff --git a/hw/s3c24xx_irq.c b/hw/s3c24xx_irq.c new file mode 100644 index 0000000..8084cd0 --- /dev/null +++ b/hw/s3c24xx_irq.c @@ -0,0 +1,200 @@ +/* hw/s3c24xx_irq.c + * + * Samsung S3C24XX IRQ controller emulation + * + * Copyright 2006, 2007, 2008 Daniel Silverstone and Vincent Sanders + * + * This file is under the terms of the GNU General Public + * License Version 2 + */ + +#include "hw.h" + +#include "s3c24xx.h" + +/* IRQ request status RW WORD */ +#define S3C_IRQ_SRCPND 0 +/* Interrupt mode control WR WORD */ +#define S3C_IRQ_INTMOD 1 +/* Interrupt mask control RW WORD */ +#define S3C_IRQ_INTMSK 2 +/* IRQ priority control WR WORD */ +#define S3C_IRQ_PRIORITY 3 +/* Interrupt request status RW WORD */ +#define S3C_IRQ_INTPND 4 +/* Interrupt request source offset RO WORD */ +#define S3C_IRQ_OFFSET 5 +/* Sub-source pending RW WORD */ +#define S3C_IRQ_SUBSRCPND 6 +/* Interrupt sub-mask RW WORD */ +#define S3C_IRQ_INTSUBMSK 7 + + +static void +s3c24xx_percolate_interrupt(S3CState *soc) +{ + /* Take the status of the srcpnd register, percolate it through, raise to + * CPU if necessary */ + uint32_t ints = (soc->irq_reg[S3C_IRQ_SRCPND] & + ~soc->irq_reg[S3C_IRQ_INTMSK]); + int fsb = ffs(ints); + + /* TODO: Priority encoder could go here */ + if (ints & soc->irq_reg[S3C_IRQ_INTMOD]) { + /* Detected a FIQ */ + cpu_interrupt(soc->cpu_env, CPU_INTERRUPT_FIQ); + return; + } else { + /* No FIQ here today */ + cpu_reset_interrupt(soc->cpu_env, CPU_INTERRUPT_FIQ); + } + + /* No FIQ, check for a normal IRQ */ + if (fsb) { + if ((soc->irq_reg[S3C_IRQ_INTPND] == 0) || + (soc->irq_reg[S3C_IRQ_INTPND] > 1<<(fsb-1))) { + /* Current INTPND is lower priority than fsb of ints (or empty) */ + soc->irq_reg[S3C_IRQ_INTPND] = 1<<(fsb-1); + soc->irq_reg[S3C_IRQ_OFFSET] = fsb-1; + } + } else { + /* No FSB, thus no IRQ, thus nothing to do yet */ + } + + if (soc->irq_reg[S3C_IRQ_INTPND] != 0) { + cpu_interrupt(soc->cpu_env, CPU_INTERRUPT_HARD); + } else { + cpu_reset_interrupt(soc->cpu_env, CPU_INTERRUPT_HARD); + } +} + +static void +s3c24xx_percolate_subsrc_interrupt(S3CState *soc) +{ + uint32_t ints; + + soc->irq_reg[S3C_IRQ_SRCPND] |= soc->irq_main_level; + soc->irq_reg[S3C_IRQ_SUBSRCPND] |= soc->irq_subsrc_level; + + ints = (soc->irq_reg[S3C_IRQ_SUBSRCPND] & + ~soc->irq_reg[S3C_IRQ_INTSUBMSK]); + + /* If UART0 has asserted, raise that */ + if( ints & 0x7 ) { + soc->irq_reg[S3C_IRQ_SRCPND] |= (1<<28); + } + + /* Ditto UART1 */ + if( ints & 0x7<<3 ) soc->irq_reg[S3C_IRQ_SRCPND] |= (1<<23); + + /* Ditto UART2 */ + if( ints & 0x7<<6 ) soc->irq_reg[S3C_IRQ_SRCPND] |= (1<<15); + + /* And percolate it through */ + s3c24xx_percolate_interrupt(soc); +} + +static void +s3c24xx_irq_write_f(void *opaque, target_phys_addr_t addr_, uint32_t value) +{ + S3CState *soc = (S3CState *)opaque; + int addr = (addr_ >> 2) & 7; + + if (addr == S3C_IRQ_SRCPND || + addr == S3C_IRQ_INTPND || + addr == S3C_IRQ_SUBSRCPND) { + soc->irq_reg[addr] &= ~value; + } else { + soc->irq_reg[addr] = value; + } + + /* Start at the subsrc irqs and percolate from there */ + s3c24xx_percolate_subsrc_interrupt(soc); +} + +static uint32_t +s3c24xx_irq_read_f(void *opaque, target_phys_addr_t addr_) +{ + S3CState *soc = (S3CState *)opaque; + int addr = (addr_ >> 2) & 0x7; + + return soc->irq_reg[addr]; +} + + +static CPUReadMemoryFunc *s3c24xx_irq_read[] = { + &s3c24xx_irq_read_f, + &s3c24xx_irq_read_f, + &s3c24xx_irq_read_f, +}; + +static CPUWriteMemoryFunc *s3c24xx_irq_write[] = { + &s3c24xx_irq_write_f, + &s3c24xx_irq_write_f, + &s3c24xx_irq_write_f, +}; + +static void +s3c24xx_irq_set_interrupt_level(S3CState *soc, int irq_num, int level, int set_level) +{ + if (level) { + if (set_level) soc->irq_main_level |= 1<irq_reg[S3C_IRQ_SRCPND] |= 1<irq_main_level &= ~(1<irq_reg[S3C_IRQ_SRCPND] &= ~(1<irq_subsrc_level |= 1<irq_reg[S3C_IRQ_SUBSRCPND] |= 1<irq_subsrc_level &= ~(1<irq_reg[S3C_IRQ_SUBSRCPND] &= ~(1<irq_reg[S3C_IRQ_SRCPND] = 0x00; + soc->irq_reg[S3C_IRQ_INTMOD] = 0x00; + soc->irq_reg[S3C_IRQ_INTMSK] = 0xFFFFFFFF; + soc->irq_reg[S3C_IRQ_PRIORITY] = 0x7F; + soc->irq_reg[S3C_IRQ_INTPND] = 0x00; + soc->irq_reg[S3C_IRQ_OFFSET] = 0x00; + soc->irq_reg[S3C_IRQ_SUBSRCPND] = 0x00; + soc->irq_reg[S3C_IRQ_INTSUBMSK] = 0x7FF; + + /* Allocate the interrupts and return them. All 64 potential ones. + * We return them doubled up because the latter half are level where + * the former half are edge. + */ + return qemu_allocate_irqs(s3c24xx_irq_handler, soc, 128); +} -- 1.5.4.3