mirror of
git://projects.qi-hardware.com/iris.git
synced 2024-11-05 04:53:08 +02:00
127 lines
3.4 KiB
COBOL
127 lines
3.4 KiB
COBOL
#pypp 0
|
|
#define ARCH
|
|
#include "kernel.hh"
|
|
|
|
/// A TLB miss has occurred. This is the slow version. It is only used
|
|
/// when k0 or k1 is not 0, or when an error occurs.
|
|
/// Otherwise, the ultra-fast code in entry.S is used.
|
|
Thread *tlb_refill ():
|
|
//panic (0x88776655, "TLB refill")
|
|
if !directory:
|
|
panic (0x44449999, "No directory")
|
|
unsigned EntryHi
|
|
cp0_get (CP0_ENTRY_HI, EntryHi)
|
|
unsigned *t = directory[EntryHi >> 21]
|
|
if !t:
|
|
panic (0x99992222, "No page table")
|
|
// - 2 instead of - 1 means reset bit 0
|
|
unsigned idx = (EntryHi >> 12) & ((1 << 9) - 2)
|
|
cp0_set (CP0_ENTRY_LO0, t[idx])
|
|
cp0_set (CP0_ENTRY_LO1, t[idx + 1])
|
|
__asm__ volatile ("tlbwr")
|
|
return current
|
|
|
|
/// An interrupt which is not an exception has occurred.
|
|
Thread *interrupt ():
|
|
panic (0x88877722, "Interrupt")
|
|
unsigned cause, status
|
|
cp0_get (CP0_CAUSE, cause)
|
|
cp0_get (CP0_STATUS, status)
|
|
for unsigned i = 0; i < 8; ++i:
|
|
if cause & (1 << (i + 8)):
|
|
// Disable the interrupt while handling it.
|
|
status &= ~(1 << (i + 8))
|
|
// Send message to interrupt handler.
|
|
if arch_interrupt_receiver[i]:
|
|
unsigned data[4] = {0, 0, 0, 0}
|
|
Capability *cap[4] = {NULL, NULL, NULL, NULL}
|
|
bool copy[4] = {false, false, false, false}
|
|
arch_interrupt_receiver[i]->send_message (i, data, cap, copy)
|
|
return current
|
|
|
|
/// A general exception has occurred.
|
|
Thread *exception ():
|
|
unsigned cause
|
|
cp0_get (CP0_CAUSE, cause)
|
|
//dbg_send (cause >> 2, 5)
|
|
switch (cause >> 2) & 0x1f:
|
|
case 0:
|
|
// Interrupt. This shouldn't happen, since CAUSE[IV] == 1.
|
|
panic (0x11223344, "Interrupt on exception vector.")
|
|
case 1:
|
|
// TLB modification.
|
|
panic (0x21223344, "TLB modification.")
|
|
case 2:
|
|
// TLB load or instruction fetch.
|
|
panic (0x31223344, "TLB load or instruction fetch.")
|
|
case 3:
|
|
// TLB store.
|
|
panic (0x41223344, "TLB store.")
|
|
case 4:
|
|
// Address error load or instruction fetch.
|
|
panic (0x51223344, "Address error load or instruction fetch.")
|
|
case 5:
|
|
// Address error store.
|
|
panic (0x61223344, "Address error store.")
|
|
case 6:
|
|
// Bus error instruction fetch.
|
|
panic (0x71223344, "Bus error instruction fetch.")
|
|
case 7:
|
|
// Bus error load or store.
|
|
panic (0x81223344, "Bus error load or store.")
|
|
case 8:
|
|
// Syscall.
|
|
arch_invoke ()
|
|
break
|
|
case 9:
|
|
// Breakpoint.
|
|
panic (0x91223344, "Breakpoint.")
|
|
case 10:
|
|
// Reserved instruction.
|
|
panic (0xa1223344, "Reserved instruction.")
|
|
case 11:
|
|
// Coprocessor unusable.
|
|
panic (0xb1223344, "Coprocessor unusable.")
|
|
case 12:
|
|
// Arithmetic overflow.
|
|
panic (0xc1223344, "Arithmetic overflow.")
|
|
case 13:
|
|
// Trap.
|
|
panic (0xe1223344, "Trap.")
|
|
case 15:
|
|
// Floating point exception.
|
|
panic (0xf1223344, "Floating point exception.")
|
|
case 23:
|
|
// Reference to WatchHi/WatchLo address.
|
|
panic (0xf2223344, "Reference to WatchHi/WatchLo address.")
|
|
case 24:
|
|
// Machine check.
|
|
panic (0xf3223344, "Machine check.")
|
|
case 30:
|
|
// Cache error (EJTAG only).
|
|
panic (0xf4223344, "Cache error (EJTAG only).")
|
|
case 14:
|
|
case 16:
|
|
case 17:
|
|
case 18:
|
|
case 19:
|
|
case 20:
|
|
case 21:
|
|
case 22:
|
|
case 25:
|
|
case 26:
|
|
case 27:
|
|
case 28:
|
|
case 29:
|
|
case 31:
|
|
// Reserved.
|
|
panic (0xf5223344, "Reserved exception code")
|
|
default:
|
|
panic (0xf6223344, "Impossible exception code")
|
|
return current
|
|
|
|
/// There's a cache error. Big trouble. Probably not worth trying to recover.
|
|
Thread *cache_error ():
|
|
panic (0x33333333, "cache error")
|
|
return current
|