139 lines
5.5 KiB
C
139 lines
5.5 KiB
C
#include <kernel/hardware/intc.h>
|
|
#include <kernel/bits/driver.h>
|
|
|
|
// Internal hardware context
|
|
struct __sh7305_intc_context intc_context;
|
|
|
|
static void sh7305_intc_driver_install(void)
|
|
{
|
|
// Dump current context
|
|
intc_context.ipra = SH7305_INTC.IPRA.WORD;
|
|
intc_context.iprb = SH7305_INTC.IPRB.WORD;
|
|
intc_context.iprc = SH7305_INTC.IPRC.WORD;
|
|
intc_context.iprd = SH7305_INTC.IPRD.WORD;
|
|
intc_context.ipre = SH7305_INTC.IPRE.WORD;
|
|
intc_context.iprf = SH7305_INTC.IPRF.WORD;
|
|
intc_context.iprg = SH7305_INTC.IPRG.WORD;
|
|
intc_context.iprh = SH7305_INTC.IPRH.WORD;
|
|
intc_context.ipri = SH7305_INTC.IPRI.WORD;
|
|
intc_context.iprj = SH7305_INTC.IPRJ.WORD;
|
|
intc_context.iprk = SH7305_INTC.IPRK.WORD;
|
|
intc_context.iprl = SH7305_INTC.IPRL.WORD;
|
|
intc_context.imr[0] = SH7305_INTC.IMR0.BYTE;
|
|
intc_context.imr[1] = SH7305_INTC.IMR1.BYTE;
|
|
intc_context.imr[2] = SH7305_INTC.IMR2.BYTE;
|
|
intc_context.imr[3] = SH7305_INTC.IMR3.BYTE;
|
|
intc_context.imr[4] = SH7305_INTC.IMR4.BYTE;
|
|
intc_context.imr[5] = SH7305_INTC.IMR5.BYTE;
|
|
intc_context.imr[6] = SH7305_INTC.IMR6.BYTE;
|
|
intc_context.imr[7] = SH7305_INTC.IMR7.BYTE;
|
|
intc_context.imr[8] = SH7305_INTC.IMR8.BYTE;
|
|
intc_context.imr[9] = SH7305_INTC.IMR9.BYTE;
|
|
intc_context.imr[10] = SH7305_INTC.IMR10.BYTE;
|
|
intc_context.imr[11] = SH7305_INTC.IMR11.BYTE;
|
|
intc_context.icr[0] = SH7305_INTC.ICR0.WORD;
|
|
intc_context.icr[1] = SH7305_INTC.ICR1.WORD;
|
|
intc_context.intpri00 = SH7305_INTC.INTPRI00.LONG_WORD;
|
|
intc_context.intreq00 = SH7305_INTC.INTREQ00.BYTE;
|
|
intc_context.intmsk00 = SH7305_INTC.INTMSK00.BYTE;
|
|
intc_context.intmskclr00 = SH7305_INTC.INTMSKCLR00.BYTE;
|
|
intc_context.nmifcr = SH7305_INTC.NMIFCR.WORD;
|
|
intc_context.usermsk = SH7305_INTC.USERMSK.LONG_WORD;
|
|
|
|
// Initialize Interrupt Controller (INTC).
|
|
SH7305_INTC.IPRA.WORD = 0x0000;
|
|
SH7305_INTC.IPRB.WORD = 0x0000;
|
|
SH7305_INTC.IPRC.WORD = 0x0000;
|
|
SH7305_INTC.IPRD.WORD = 0x0000;
|
|
SH7305_INTC.IPRE.WORD = 0x0000;
|
|
SH7305_INTC.IPRF.WORD = 0x0000;
|
|
SH7305_INTC.IPRG.WORD = 0x0000;
|
|
SH7305_INTC.IPRH.WORD = 0x0000;
|
|
SH7305_INTC.IPRI.WORD = 0x0000;
|
|
SH7305_INTC.IPRJ.WORD = 0x0000;
|
|
SH7305_INTC.IPRK.WORD = 0x0000;
|
|
SH7305_INTC.IPRL.WORD = 0x0000;
|
|
|
|
SH7305_INTC.IMR0.BYTE = 0xff;
|
|
SH7305_INTC.IMR1.BYTE = 0xff;
|
|
SH7305_INTC.IMR2.BYTE = 0xff;
|
|
SH7305_INTC.IMR3.BYTE = 0xff;
|
|
SH7305_INTC.IMR4.BYTE = 0xff;
|
|
SH7305_INTC.IMR5.BYTE = 0xff;
|
|
SH7305_INTC.IMR6.BYTE = 0xff;
|
|
SH7305_INTC.IMR7.BYTE = 0xff;
|
|
SH7305_INTC.IMR8.BYTE = 0xff;
|
|
SH7305_INTC.IMR9.BYTE = 0xff;
|
|
SH7305_INTC.IMR10.BYTE = 0xff;
|
|
SH7305_INTC.IMR11.BYTE = 0xff;
|
|
|
|
SH7305_INTC.ICR0.NMIL = 0; // NMI input level to low
|
|
SH7305_INTC.ICR0.MAI = 1; // disable NMI interrupt when input is low
|
|
SH7305_INTC.ICR0.NMIB = 0; // keep NMI interrupt pending when BL bit is set
|
|
SH7305_INTC.ICR0.NMIE = 0; // select faling edge interrupt
|
|
SH7305_INTC.ICR0.LVLMODE = 1; // retain interrupt request
|
|
SH7305_INTC.ICR1.WORD = 0x0000; // select (all) interrupt request on falling edge
|
|
SH7305_INTC.INTPRI00.LONG_WORD = 0x00000000; // disable all interrupt request
|
|
SH7305_INTC.INTMSK00.BYTE = 0x00; // mask all interrupt request
|
|
SH7305_INTC.NMIFCR.NMIFL = 0; // clear NMI flags
|
|
|
|
SH7305_INTC.USERMSK.SECRET = 0xa5; // secret
|
|
SH7305_INTC.USERMSK.UIMASK = 0b0000; // enable all interrupt in user mode (not used here)
|
|
}
|
|
|
|
static void sh7305_intc_driver_uninstall(void)
|
|
{
|
|
SH7305_INTC.IPRA.WORD = intc_context.ipra;
|
|
SH7305_INTC.IPRB.WORD = intc_context.iprb;
|
|
SH7305_INTC.IPRC.WORD = intc_context.iprc;
|
|
SH7305_INTC.IPRD.WORD = intc_context.iprd;
|
|
SH7305_INTC.IPRE.WORD = intc_context.ipre;
|
|
SH7305_INTC.IPRF.WORD = intc_context.iprf;
|
|
SH7305_INTC.IPRG.WORD = intc_context.iprg;
|
|
SH7305_INTC.IPRH.WORD = intc_context.iprh;
|
|
SH7305_INTC.IPRI.WORD = intc_context.ipri;
|
|
SH7305_INTC.IPRJ.WORD = intc_context.iprj;
|
|
SH7305_INTC.IPRK.WORD = intc_context.iprk;
|
|
SH7305_INTC.IPRL.WORD = intc_context.iprl;
|
|
SH7305_INTC.IMR0.BYTE = intc_context.imr[0];
|
|
SH7305_INTC.IMR1.BYTE = intc_context.imr[1];
|
|
SH7305_INTC.IMR2.BYTE = intc_context.imr[2];
|
|
SH7305_INTC.IMR3.BYTE = intc_context.imr[3];
|
|
SH7305_INTC.IMR4.BYTE = intc_context.imr[4];
|
|
SH7305_INTC.IMR5.BYTE = intc_context.imr[5];
|
|
SH7305_INTC.IMR6.BYTE = intc_context.imr[6];
|
|
SH7305_INTC.IMR7.BYTE = intc_context.imr[7];
|
|
SH7305_INTC.IMR8.BYTE = intc_context.imr[8];
|
|
SH7305_INTC.IMR9.BYTE = intc_context.imr[9];
|
|
SH7305_INTC.IMR10.BYTE = intc_context.imr[10];
|
|
SH7305_INTC.IMR11.BYTE = intc_context.imr[11];
|
|
SH7305_INTC.IMCR0.BYTE = ~intc_context.imr[0];
|
|
SH7305_INTC.IMCR1.BYTE = ~intc_context.imr[1];
|
|
SH7305_INTC.IMCR2.BYTE = ~intc_context.imr[2];
|
|
SH7305_INTC.IMCR3.BYTE = ~intc_context.imr[3];
|
|
SH7305_INTC.IMCR4.BYTE = ~intc_context.imr[4];
|
|
SH7305_INTC.IMCR5.BYTE = ~intc_context.imr[5];
|
|
SH7305_INTC.IMCR6.BYTE = ~intc_context.imr[6];
|
|
SH7305_INTC.IMCR7.BYTE = ~intc_context.imr[7];
|
|
SH7305_INTC.IMCR8.BYTE = ~intc_context.imr[8];
|
|
SH7305_INTC.IMCR9.BYTE = ~intc_context.imr[9];
|
|
SH7305_INTC.IMCR10.BYTE = intc_context.imr[10];
|
|
SH7305_INTC.IMCR11.BYTE = intc_context.imr[11];
|
|
SH7305_INTC.ICR0.WORD = intc_context.icr[0];
|
|
SH7305_INTC.ICR1.WORD = intc_context.icr[1];
|
|
SH7305_INTC.INTPRI00.LONG_WORD = intc_context.intpri00;
|
|
SH7305_INTC.INTREQ00.BYTE = intc_context.intreq00;
|
|
SH7305_INTC.INTMSK00.BYTE = intc_context.intmsk00;
|
|
SH7305_INTC.INTMSKCLR00.BYTE = intc_context.intmskclr00;
|
|
SH7305_INTC.NMIFCR.WORD = intc_context.nmifcr;
|
|
SH7305_INTC.USERMSK.LONG_WORD = intc_context.usermsk;
|
|
}
|
|
|
|
// Create driver object
|
|
VHEX_DRIVER(2, driver_intc_sh7305) = {
|
|
.arch = MPU_SH7305,
|
|
.install = &sh7305_intc_driver_install,
|
|
.uninstall = &sh7305_intc_driver_uninstall,
|
|
.name = "intc"
|
|
};
|