#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: s3c2800_intr.c,v 1.14 2022/09/27 06:36:43 skrll Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <machine/intr.h>
#include <arm/cpufunc.h>
#include <arm/s3c2xx0/s3c2800reg.h>
#include <arm/s3c2xx0/s3c2800var.h>
struct s3c2xx0_intr_dispatch handler[ICU_LEN];
volatile int intr_mask;
volatile int global_intr_mask = 0;
int s3c2xx0_imask[NIPL];
int s3c2xx0_ilevel[ICU_LEN];
vaddr_t intctl_base;
#define icreg(offset) \
(*(volatile uint32_t *)(intctl_base+(offset)))
#define PENDING_CLEAR_MASK (~((1<<S3C2800_INT_IIC0)|(1<<S3C2800_INT_IIC1)))
void s3c2800_irq_handler(struct clockframe *);
void
s3c2800_irq_handler(struct clockframe *frame)
{
uint32_t irqbits;
int irqno;
int saved_spl_level;
saved_spl_level = curcpl();
while ((irqbits = icreg(INTCTL_IRQPND) & ICU_INT_HWMASK) != 0) {
for (irqno = ICU_LEN-1; irqno >= 0; --irqno)
if (irqbits & (1<<irqno))
break;
if (irqno < 0)
break;
if (saved_spl_level < handler[irqno].level)
s3c2xx0_setipl(handler[irqno].level);
icreg(INTCTL_SRCPND) = PENDING_CLEAR_MASK & (1 << irqno);
enable_interrupts(I32_bit);
(*handler[irqno].func) (
handler[irqno].cookie == 0
? frame : handler[irqno].cookie);
disable_interrupts(I32_bit);
s3c2xx0_setipl(saved_spl_level);
}
#ifdef __HAVE_FAST_SOFTINTS
cpu_dosoftints();
#endif
}
static const u_char s3c2800_ist[] = {
EXTINTR_LOW,
EXTINTR_FALLING,
EXTINTR_FALLING,
EXTINTR_LOW,
EXTINTR_HIGH,
EXTINTR_RISING,
EXTINTR_BOTH,
};
void *
s3c2800_intr_establish(int irqno, int level, int type,
int (* func) (void *), void *cookie)
{
int save;
if (irqno < 0 || irqno >= ICU_LEN ||
type < IST_NONE || IST_EDGE_BOTH < type)
panic("intr_establish: bogus irq or type");
save = disable_interrupts(I32_bit);
handler[irqno].cookie = cookie;
handler[irqno].func = func;
handler[irqno].level = level;
s3c2xx0_update_intr_masks(irqno, level);
if (irqno <= S3C2800_INT_EXT(7)) {
uint32_t reg;
u_int trig;
trig = s3c2800_ist[type];
reg = bus_space_read_4(s3c2xx0_softc->sc_iot,
s3c2xx0_softc->sc_gpio_ioh,
GPIO_EXTINTR);
reg = reg & ~(0x0f << (4*irqno));
reg |= trig << (4*irqno);
bus_space_write_4(s3c2xx0_softc->sc_iot, s3c2xx0_softc->sc_gpio_ioh,
GPIO_EXTINTR, reg);
}
s3c2xx0_setipl(curcpl());
restore_interrupts(save);
return (&handler[irqno]);
}
static void
init_interrupt_masks(void)
{
int i;
for (i = 0; i < NIPL; i++)
s3c2xx0_imask[i] = 0;
}
void
s3c2800_intr_init(struct s3c2800_softc *sc)
{
intctl_base = (vaddr_t) bus_space_vaddr(sc->sc_sx.sc_iot,
sc->sc_sx.sc_intctl_ioh);
s3c2xx0_intr_mask_reg = (uint32_t *)(intctl_base + INTCTL_INTMSK);
icreg(INTCTL_SRCPND) = 0xffffffff;
init_interrupt_masks();
s3c2xx0_intr_init(handler, ICU_LEN);
}