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