mirror of
https://github.com/fail0verflow/mini.git
synced 2024-06-27 13:36:06 +02:00
91 lines
1.9 KiB
C
91 lines
1.9 KiB
C
#include "irq.h"
|
|
#include "hollywood.h"
|
|
#include "gecko.h"
|
|
#include "utils.h"
|
|
#include "ipc.h"
|
|
#include "crypto.h"
|
|
#include "nand.h"
|
|
|
|
void irq_setup_stack(void);
|
|
|
|
void irq_initialize(void)
|
|
{
|
|
irq_setup_stack();
|
|
write32(HW_ARMIRQMASK, 0);
|
|
write32(HW_ARMIRQFLAG, 0xffffffff);
|
|
irq_restore(CPSR_FIQDIS);
|
|
|
|
//???
|
|
write32(HW_ARMIRQMASK+0x04, 0);
|
|
write32(HW_ARMIRQMASK+0x20, 0);
|
|
}
|
|
|
|
void irq_shutdown(void)
|
|
{
|
|
write32(HW_ARMIRQMASK, 0);
|
|
write32(HW_ARMIRQFLAG, 0xffffffff);
|
|
irq_kill();
|
|
}
|
|
|
|
void irq_handler(void)
|
|
{
|
|
u32 enabled = read32(HW_ARMIRQMASK);
|
|
u32 flags = read32(HW_ARMIRQFLAG);
|
|
|
|
//gecko_printf("In IRQ handler: 0x%08x 0x%08x 0x%08x\n", enabled, flags, flags & enabled);
|
|
|
|
flags = flags & enabled;
|
|
|
|
if(flags & IRQF_TIMER) {
|
|
gecko_printf("IRQ: timer\n");
|
|
gecko_printf("Timer: %08x\n", read32(HW_TIMER));
|
|
gecko_printf("Alarm: %08x\n", read32(HW_ALARM));
|
|
write32(HW_ALARM, 0); // shut it up
|
|
write32(HW_ARMIRQFLAG, IRQF_TIMER);
|
|
}
|
|
if(flags & IRQF_NAND) {
|
|
// gecko_printf("IRQ: NAND\n");
|
|
write32(NAND_CMD, 0x7fffffff); // shut it up
|
|
write32(HW_ARMIRQFLAG, IRQF_NAND);
|
|
nand_irq();
|
|
}
|
|
if(flags & IRQF_GPIO1B) {
|
|
gecko_printf("IRQ: GPIO1B\n");
|
|
write32(HW_GPIO1BINTFLAG, 0xFFFFFF); // shut it up
|
|
write32(HW_ARMIRQFLAG, IRQF_GPIO1B);
|
|
}
|
|
if(flags & IRQF_GPIO1) {
|
|
gecko_printf("IRQ: GPIO1\n");
|
|
write32(HW_GPIO1INTFLAG, 0xFFFFFF); // shut it up
|
|
write32(HW_ARMIRQFLAG, IRQF_GPIO1);
|
|
}
|
|
if(flags & IRQF_RESET) {
|
|
gecko_printf("IRQ: RESET\n");
|
|
write32(HW_ARMIRQFLAG, IRQF_RESET);
|
|
}
|
|
if(flags & IRQF_IPC) {
|
|
//gecko_printf("IRQ: IPC\n");
|
|
ipc_irq();
|
|
write32(HW_ARMIRQFLAG, IRQF_IPC);
|
|
}
|
|
if(flags & IRQF_AES) {
|
|
gecko_printf("IRQ: AES\n");
|
|
write32(HW_ARMIRQFLAG, IRQF_AES);
|
|
}
|
|
flags &= ~IRQF_ALL;
|
|
if(flags) {
|
|
gecko_printf("IRQ: unknown 0x%08x\n", flags);
|
|
write32(HW_ARMIRQFLAG, flags);
|
|
}
|
|
}
|
|
|
|
void irq_enable(u32 irq)
|
|
{
|
|
set32(HW_ARMIRQMASK, 1<<irq);
|
|
}
|
|
|
|
void irq_disable(u32 irq)
|
|
{
|
|
clear32(HW_ARMIRQMASK, 1<<irq);
|
|
}
|