64 lines
1.4 KiB
C
64 lines
1.4 KiB
C
//---
|
|
// gint:core:gint - Library functions
|
|
//---
|
|
|
|
#include <gint/gint.h>
|
|
#include <core/std.h>
|
|
#include <gint/mpu.h>
|
|
#include <gint/mpu/intc.h>
|
|
|
|
/* Interrupt controllers */
|
|
|
|
GDATA3 sh7705_intc_t SH7705_INTC = {
|
|
.IPRS = {
|
|
(void *)0xfffffee2, (void *)0xfffffee4,
|
|
(void *)0xa4000016, (void *)0xa4000018, (void *)0xa400001a,
|
|
(void *)0xa4080000, (void *)0xa4080002, (void *)0xa4080004,
|
|
},
|
|
.ICR1 = (void *)0xa4000010,
|
|
};
|
|
|
|
GDATA sh7305_intc_t SH7305_INTC = {
|
|
.IPRS = (void *)0xa4080000,
|
|
.MSK = (void *)0xa4080080,
|
|
.MSKCLR = (void *)0xa40800c0,
|
|
.USERIMASK = (void *)0xa4700000,
|
|
};
|
|
|
|
//---
|
|
// Library functions
|
|
//---
|
|
|
|
/* gint_intlevel() - configure the level of interrupts */
|
|
int gint_intlevel(int intid, int level)
|
|
{
|
|
int shift = (~intid & 0x3) << 2;
|
|
volatile uint16_t *ipr;
|
|
level &= 0xf;
|
|
|
|
ipr = isSH3()
|
|
? SH7705_INTC.IPRS[intid >> 2] /* SH3-based */
|
|
: &SH7305_INTC.IPRS[2 * (intid >> 2)]; /* SH4-based */
|
|
|
|
int oldlevel = (*ipr >> shift) & 0xf;
|
|
*ipr = (*ipr & ~(0xf << shift)) | (level << shift);
|
|
|
|
return oldlevel;
|
|
}
|
|
|
|
/* gint_inthandler() - configure interrupt handlers */
|
|
void *gint_inthandler(int event_code, const void *handler, size_t size)
|
|
{
|
|
extern char gint_vbr;
|
|
|
|
/* Normalize the event code */
|
|
event_code -= 0x400;
|
|
event_code &= ~0x1f;
|
|
|
|
/* Prevent overriding the entry gate */
|
|
if(event_code < 0) return NULL;
|
|
|
|
void *dest = (void *)&gint_vbr + event_code + 0x620;
|
|
return memcpy(dest, handler, size);
|
|
}
|