40,6 → 40,8 |
|
#include <arch/stack.h> |
#include <arch/sun4v/regdef.h> |
#include <arch/sun4v/arch.h> |
#include <arch/sun4v/hypercall.h> |
#include <arch/mm/sun4v/tlb.h> |
#include <arch/mm/sun4v/mmu.h> |
#include <arch/mm/sun4v/tte.h> |
57,23 → 59,52 |
|
#ifdef __ASM__ |
|
/* MMU fault status area data fault offset */ |
#define FSA_DFA_OFFSET 0x48 |
|
/* MMU fault status area data context */ |
#define FSA_DFC_OFFSET 0x50 |
|
/* offset of the target address within the TTE Data entry */ |
#define TTE_DATA_TADDR_OFFSET 13 |
|
.macro FAST_INSTRUCTION_ACCESS_MMU_MISS_HANDLER |
.endm |
|
/* |
* So far it is here only to process the trap which occurs when the kernel |
* needs to access the bootinfo structure, which is placed in the bootloader |
* memory (i.e. before address 0x400000). |
* Handler of the Fast Data Access MMU Miss trap. If the trap occurred in the kernel |
* (context 0), an identity mapping (with displacement) is installed. Otherwise |
* a higher level service routine is called. |
* |
* TODO implement calling the higher level service routine |
*/ |
.macro FAST_DATA_ACCESS_MMU_MISS_HANDLER tl |
save %sp, -STACK_WINDOW_SAVE_AREA_SIZE, %sp |
set 0x8000, %o0 |
set 0x0, %o1 |
setx 0x80000000804087c3, %g1, %o2 |
set 0x3, %o3 |
ta 0x83 |
restore %g0, 0, %g0 |
retry |
|
mov SCRATCHPAD_MMU_FSA, %g1 |
ldxa [%g1] ASI_SCRATCHPAD, %g1 ! g1 <= RA of MMU fault status area |
|
/* service by higher-level routine when context != 0 */ |
add %g1, FSA_DFC_OFFSET, %g2 ! g2 <= RA of data fault context |
ldxa [%g2] ASI_REAL, %g3 ! read the fault context |
brnz %g3, 0f |
nop |
|
/* read the faulting address */ |
add %g1, FSA_DFA_OFFSET, %g2 ! g2 <= RA of data fault address |
ldxa [%g2] ASI_REAL, %g1 ! read the fault address |
srlx %g1, TTE_DATA_TADDR_OFFSET, %g1 ! truncate it to page boundary |
sllx %g1, TTE_DATA_TADDR_OFFSET, %g1 |
|
/* exclude page number 0 from installing the identity mapping */ |
brz %g1, 0f |
nop |
|
/* installing the identity does not fit into 32 instructions, call a separate routine */ |
ba install_identity_mapping |
nop |
|
0: ! TODO - call higher level service routine |
|
.endm |
|
.macro FAST_DATA_ACCESS_PROTECTION_HANDLER tl |