Rev 1050 | Rev 1060 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1050 | Rev 1051 | ||
|---|---|---|---|
| Line 40... | Line 40... | ||
| 40 | #include <symtab.h> |
40 | #include <symtab.h> |
| 41 | #include <arch/asm.h> |
41 | #include <arch/asm.h> |
| 42 | #include <proc/scheduler.h> |
42 | #include <proc/scheduler.h> |
| 43 | #include <proc/thread.h> |
43 | #include <proc/thread.h> |
| 44 | 44 | ||
| 45 | static void print_info_errcode(int n, istate_t *istate) |
45 | void print_info_errcode(int n, istate_t *istate) |
| 46 | { |
46 | { |
| 47 | char *symbol; |
47 | char *symbol; |
| 48 | __u64 *x = &istate->stack[0]; |
48 | __u64 *x = &istate->stack[0]; |
| 49 | 49 | ||
| 50 | if (!(symbol=get_symtab_entry(istate->rip))) |
50 | if (!(symbol=get_symtab_entry(istate->rip))) |
| Line 90... | Line 90... | ||
| 90 | { |
90 | { |
| 91 | print_info_errcode(n, istate); |
91 | print_info_errcode(n, istate); |
| 92 | panic("stack fault\n"); |
92 | panic("stack fault\n"); |
| 93 | } |
93 | } |
| 94 | 94 | ||
| 95 | - | ||
| 96 | void nm_fault(int n, istate_t *istate) |
95 | void nm_fault(int n, istate_t *istate) |
| 97 | { |
96 | { |
| 98 | #ifdef CONFIG_FPU_LAZY |
97 | #ifdef CONFIG_FPU_LAZY |
| 99 | scheduler_fpu_lazy_request(); |
98 | scheduler_fpu_lazy_request(); |
| 100 | #else |
99 | #else |
| 101 | panic("fpu fault"); |
100 | panic("fpu fault"); |
| 102 | #endif |
101 | #endif |
| 103 | } |
102 | } |
| 104 | 103 | ||
| 105 | - | ||
| 106 | /* Definitions for identic page mapper */ |
- | |
| 107 | pte_t helper_ptl1[512] __attribute__((aligned (PAGE_SIZE))); |
- | |
| 108 | pte_t helper_ptl2[512] __attribute__((aligned (PAGE_SIZE))); |
- | |
| 109 | pte_t helper_ptl3[512] __attribute__((aligned (PAGE_SIZE))); |
- | |
| 110 | extern pte_t ptl_0; /* From boot.S */ |
- | |
| 111 | - | ||
| 112 | #define PTL1_PRESENT(ptl0, page) (!(GET_PTL1_FLAGS_ARCH(ptl0, PTL0_INDEX_ARCH(page)) & PAGE_NOT_PRESENT)) |
- | |
| 113 | #define PTL2_PRESENT(ptl1, page) (!(GET_PTL2_FLAGS_ARCH(ptl1, PTL1_INDEX_ARCH(page)) & PAGE_NOT_PRESENT)) |
- | |
| 114 | #define PTL3_PRESENT(ptl2, page) (!(GET_PTL3_FLAGS_ARCH(ptl2, PTL2_INDEX_ARCH(page)) & PAGE_NOT_PRESENT)) |
- | |
| 115 | - | ||
| 116 | #define PTL1_ADDR(ptl0, page) ((pte_t *)PA2KA(GET_PTL1_ADDRESS_ARCH(ptl0, PTL0_INDEX_ARCH(page)))) |
- | |
| 117 | #define PTL2_ADDR(ptl1, page) ((pte_t *)PA2KA(GET_PTL2_ADDRESS_ARCH(ptl1, PTL1_INDEX_ARCH(page)))) |
- | |
| 118 | #define PTL3_ADDR(ptl2, page) ((pte_t *)PA2KA(GET_PTL3_ADDRESS_ARCH(ptl2, PTL2_INDEX_ARCH(page)))) |
- | |
| 119 | - | ||
| 120 | #define SETUP_PTL1(ptl0, page, tgt) { \ |
- | |
| 121 | SET_PTL1_ADDRESS_ARCH(ptl0, PTL0_INDEX_ARCH(page), (__address)KA2PA(tgt)); \ |
- | |
| 122 | SET_PTL1_FLAGS_ARCH(ptl0, PTL0_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \ |
- | |
| 123 | } |
- | |
| 124 | #define SETUP_PTL2(ptl1, page, tgt) { \ |
- | |
| 125 | SET_PTL2_ADDRESS_ARCH(ptl1, PTL1_INDEX_ARCH(page), (__address)KA2PA(tgt)); \ |
- | |
| 126 | SET_PTL2_FLAGS_ARCH(ptl1, PTL1_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \ |
- | |
| 127 | } |
- | |
| 128 | #define SETUP_PTL3(ptl2, page, tgt) { \ |
- | |
| 129 | SET_PTL3_ADDRESS_ARCH(ptl2, PTL2_INDEX_ARCH(page), (__address)KA2PA(tgt)); \ |
- | |
| 130 | SET_PTL3_FLAGS_ARCH(ptl2, PTL2_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \ |
- | |
| 131 | } |
- | |
| 132 | #define SETUP_FRAME(ptl3, page, tgt) { \ |
- | |
| 133 | SET_FRAME_ADDRESS_ARCH(ptl3, PTL3_INDEX_ARCH(page), (__address)KA2PA(tgt)); \ |
- | |
| 134 | SET_FRAME_FLAGS_ARCH(ptl3, PTL3_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \ |
- | |
| 135 | } |
- | |
| 136 | - | ||
| 137 | /** Identic page mapper |
- | |
| 138 | * |
- | |
| 139 | * We need to map whole physical memory identically before the page subsystem |
- | |
| 140 | * is initializaed. This thing clears page table and fills in the specific |
- | |
| 141 | * items. |
- | |
| 142 | */ |
- | |
| 143 | void ident_page_fault(int n, istate_t *istate) |
- | |
| 144 | { |
- | |
| 145 | __address page; |
- | |
| 146 | static __address oldpage = 0; |
- | |
| 147 | pte_t *aptl_1, *aptl_2, *aptl_3; |
- | |
| 148 | - | ||
| 149 | page = read_cr2(); |
- | |
| 150 | if (oldpage) { |
- | |
| 151 | /* Unmap old address */ |
- | |
| 152 | aptl_1 = PTL1_ADDR(&ptl_0, oldpage); |
- | |
| 153 | aptl_2 = PTL2_ADDR(aptl_1, oldpage); |
- | |
| 154 | aptl_3 = PTL3_ADDR(aptl_2, oldpage); |
- | |
| 155 | - | ||
| 156 | SET_FRAME_FLAGS_ARCH(aptl_3, PTL3_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT); |
- | |
| 157 | if (aptl_3 == helper_ptl3) |
- | |
| 158 | SET_PTL3_FLAGS_ARCH(aptl_2, PTL2_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT); |
- | |
| 159 | if (aptl_2 == helper_ptl2) |
- | |
| 160 | SET_PTL2_FLAGS_ARCH(aptl_1, PTL1_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT); |
- | |
| 161 | if (aptl_1 == helper_ptl1) |
- | |
| 162 | SET_PTL1_FLAGS_ARCH(&ptl_0, PTL0_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT); |
- | |
| 163 | } |
- | |
| 164 | if (PTL1_PRESENT(&ptl_0, page)) |
- | |
| 165 | aptl_1 = PTL1_ADDR(&ptl_0, page); |
- | |
| 166 | else { |
- | |
| 167 | SETUP_PTL1(&ptl_0, page, helper_ptl1); |
- | |
| 168 | aptl_1 = helper_ptl1; |
- | |
| 169 | } |
- | |
| 170 | - | ||
| 171 | if (PTL2_PRESENT(aptl_1, page)) |
- | |
| 172 | aptl_2 = PTL2_ADDR(aptl_1, page); |
- | |
| 173 | else { |
- | |
| 174 | SETUP_PTL2(aptl_1, page, helper_ptl2); |
- | |
| 175 | aptl_2 = helper_ptl2; |
- | |
| 176 | } |
- | |
| 177 | - | ||
| 178 | if (PTL3_PRESENT(aptl_2, page)) |
- | |
| 179 | aptl_3 = PTL3_ADDR(aptl_2, page); |
- | |
| 180 | else { |
- | |
| 181 | SETUP_PTL3(aptl_2, page, helper_ptl3); |
- | |
| 182 | aptl_3 = helper_ptl3; |
- | |
| 183 | } |
- | |
| 184 | - | ||
| 185 | SETUP_FRAME(aptl_3, page, page); |
- | |
| 186 | - | ||
| 187 | oldpage = page; |
- | |
| 188 | } |
- | |
| 189 | - | ||
| 190 | void page_fault(int n, istate_t *istate) |
- | |
| 191 | { |
- | |
| 192 | __address page; |
- | |
| 193 | - | ||
| 194 | page = read_cr2(); |
- | |
| 195 | if (!as_page_fault(page)) { |
- | |
| 196 | print_info_errcode(n, istate); |
- | |
| 197 | printf("Page fault address: %Q\n", page); |
- | |
| 198 | panic("page fault\n"); |
- | |
| 199 | } |
- | |
| 200 | } |
- | |
| 201 | - | ||
| 202 | void tlb_shootdown_ipi(int n, istate_t *istate) |
104 | void tlb_shootdown_ipi(int n, istate_t *istate) |
| 203 | { |
105 | { |
| 204 | trap_virtual_eoi(); |
106 | trap_virtual_eoi(); |
| 205 | tlb_shootdown_ipi_recv(); |
107 | tlb_shootdown_ipi_recv(); |
| 206 | } |
108 | } |