| 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 |