Subversion Repositories HelenOS-historic

Rev

Rev 825 | Rev 1063 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 825 Rev 1051
Line 35... Line 35...
35 
#include <arch/interrupt.h>
 35 
#include <arch/interrupt.h>
36 
#include <arch/asm.h>
 36 
#include <arch/asm.h>
37 
#include <config.h>
 37 
#include <config.h>
38 
#include <memstr.h>
 38 
#include <memstr.h>
39 
#include <interrupt.h>
 39 
#include <interrupt.h>
- 
 
 40 
#include <print.h>
- 
 
 41 
#include <panic.h>
- 
 
 42 
 
- 
 
 43 
/* Definitions for identity page mapper */
- 
 
 44 
pte_t helper_ptl1[512] __attribute__((aligned (PAGE_SIZE)));
- 
 
 45 
pte_t helper_ptl2[512] __attribute__((aligned (PAGE_SIZE)));
- 
 
 46 
pte_t helper_ptl3[512] __attribute__((aligned (PAGE_SIZE)));
- 
 
 47 
extern pte_t ptl_0; /* From boot.S */
- 
 
 48 
 
- 
 
 49 
#define PTL1_PRESENT(ptl0, page) (!(GET_PTL1_FLAGS_ARCH(ptl0, PTL0_INDEX_ARCH(page)) & PAGE_NOT_PRESENT))
- 
 
 50 
#define PTL2_PRESENT(ptl1, page) (!(GET_PTL2_FLAGS_ARCH(ptl1, PTL1_INDEX_ARCH(page)) & PAGE_NOT_PRESENT))
- 
 
 51 
#define PTL3_PRESENT(ptl2, page) (!(GET_PTL3_FLAGS_ARCH(ptl2, PTL2_INDEX_ARCH(page)) & PAGE_NOT_PRESENT))
- 
 
 52 
 
- 
 
 53 
#define PTL1_ADDR(ptl0, page) ((pte_t *)PA2KA(GET_PTL1_ADDRESS_ARCH(ptl0, PTL0_INDEX_ARCH(page))))
- 
 
 54 
#define PTL2_ADDR(ptl1, page) ((pte_t *)PA2KA(GET_PTL2_ADDRESS_ARCH(ptl1, PTL1_INDEX_ARCH(page))))
- 
 
 55 
#define PTL3_ADDR(ptl2, page) ((pte_t *)PA2KA(GET_PTL3_ADDRESS_ARCH(ptl2, PTL2_INDEX_ARCH(page))))
- 
 
 56 
 
- 
 
 57 
#define SETUP_PTL1(ptl0, page, tgt)  {  \
- 
 
 58 
    SET_PTL1_ADDRESS_ARCH(ptl0, PTL0_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
- 
 
 59 
        SET_PTL1_FLAGS_ARCH(ptl0, PTL0_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
- 
 
 60 
    }
- 
 
 61 
#define SETUP_PTL2(ptl1, page, tgt)  {  \
- 
 
 62 
    SET_PTL2_ADDRESS_ARCH(ptl1, PTL1_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
- 
 
 63 
        SET_PTL2_FLAGS_ARCH(ptl1, PTL1_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
- 
 
 64 
    }
- 
 
 65 
#define SETUP_PTL3(ptl2, page, tgt)  {  \
- 
 
 66 
    SET_PTL3_ADDRESS_ARCH(ptl2, PTL2_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
- 
 
 67 
        SET_PTL3_FLAGS_ARCH(ptl2, PTL2_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
- 
 
 68 
    }
- 
 
 69 
#define SETUP_FRAME(ptl3, page, tgt)  { \
- 
 
 70 
    SET_FRAME_ADDRESS_ARCH(ptl3, PTL3_INDEX_ARCH(page), (__address)KA2PA(tgt)); \
- 
 
 71 
        SET_FRAME_FLAGS_ARCH(ptl3, PTL3_INDEX_ARCH(page), PAGE_WRITE | PAGE_EXEC); \
- 
 
 72 
    }
40 
 
 73 
 
41 
void page_arch_init(void)
 74 
void page_arch_init(void)
42 
{
 75 
{
43 
    __address cur;
 76 
    __address cur;
44 
    int flags;
 77 
    int flags;
Line 60... Line 93...
60 
    }
 93 
    }
61 
    else {
 94 
    else {
62 
        write_cr3((__address) AS_KERNEL->page_table);
 95 
        write_cr3((__address) AS_KERNEL->page_table);
63 
    }
 96 
    }
64 
}
 97 
}
- 
 
 98 
 
- 
 
 99 
/** Identity page mapper
- 
 
 100 
 *
- 
 
 101 
 * We need to map whole physical memory identically before the page subsystem
- 
 
 102 
 * is initializaed. This thing clears page table and fills in the specific
- 
 
 103 
 * items.
- 
 
 104 
 */
- 
 
 105 
void ident_page_fault(int n, istate_t *istate)
- 
 
 106 
{
- 
 
 107 
    __address page;
- 
 
 108 
    static __address oldpage = 0;
- 
 
 109 
    pte_t *aptl_1, *aptl_2, *aptl_3;
- 
 
 110 
 
- 
 
 111 
    page = read_cr2();
- 
 
 112 
    if (oldpage) {
- 
 
 113 
        /* Unmap old address */
- 
 
 114 
        aptl_1 = PTL1_ADDR(&ptl_0, oldpage);
- 
 
 115 
        aptl_2 = PTL2_ADDR(aptl_1, oldpage);
- 
 
 116 
        aptl_3 = PTL3_ADDR(aptl_2, oldpage);
- 
 
 117 
 
- 
 
 118 
        SET_FRAME_FLAGS_ARCH(aptl_3, PTL3_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
- 
 
 119 
        if (aptl_3 == helper_ptl3)
- 
 
 120 
            SET_PTL3_FLAGS_ARCH(aptl_2, PTL2_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
- 
 
 121 
        if (aptl_2 == helper_ptl2)
- 
 
 122 
            SET_PTL2_FLAGS_ARCH(aptl_1, PTL1_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
- 
 
 123 
        if (aptl_1 == helper_ptl1)
- 
 
 124 
            SET_PTL1_FLAGS_ARCH(&ptl_0, PTL0_INDEX_ARCH(oldpage), PAGE_NOT_PRESENT);
- 
 
 125 
    }
- 
 
 126 
    if (PTL1_PRESENT(&ptl_0, page))
- 
 
 127 
        aptl_1 = PTL1_ADDR(&ptl_0, page);
- 
 
 128 
    else {
- 
 
 129 
        SETUP_PTL1(&ptl_0, page, helper_ptl1);
- 
 
 130 
        aptl_1 = helper_ptl1;
- 
 
 131 
    }
- 
 
 132 
       
- 
 
 133 
    if (PTL2_PRESENT(aptl_1, page))
- 
 
 134 
        aptl_2 = PTL2_ADDR(aptl_1, page);
- 
 
 135 
    else {
- 
 
 136 
        SETUP_PTL2(aptl_1, page, helper_ptl2);
- 
 
 137 
        aptl_2 = helper_ptl2;
- 
 
 138 
    }
- 
 
 139 
 
- 
 
 140 
    if (PTL3_PRESENT(aptl_2, page))
- 
 
 141 
        aptl_3 = PTL3_ADDR(aptl_2, page);
- 
 
 142 
    else {
- 
 
 143 
        SETUP_PTL3(aptl_2, page, helper_ptl3);
- 
 
 144 
        aptl_3 = helper_ptl3;
- 
 
 145 
    }
- 
 
 146 
   
- 
 
 147 
    SETUP_FRAME(aptl_3, page, page);
- 
 
 148 
 
- 
 
 149 
    oldpage = page;
- 
 
 150 
}
- 
 
 151 
 
- 
 
 152 
void page_fault(int n, istate_t *istate)
- 
 
 153 
{
- 
 
 154 
    __address page;
- 
 
 155 
   
- 
 
 156 
    page = read_cr2();
- 
 
 157 
    if (!as_page_fault(page)) {
- 
 
 158 
        print_info_errcode(n, istate);
- 
 
 159 
        printf("Page fault address: %Q\n", page);
- 
 
 160 
        panic("page fault\n");
- 
 
 161 
    }
- 
 
 162 
}