Subversion Repositories HelenOS-historic

Rev

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

Rev 867 Rev 883
Line 40... Line 40...
40 
#include <arch/drivers/tick.h>
 40 
#include <arch/drivers/tick.h>
41 
 
 41 
 
42 
/** Initialize trap table. */
 42 
/** Initialize trap table. */
43 
void trap_init(void)
 43 
void trap_init(void)
44 
{
 44 
{
45 
    /*
 - 
 
46 
     * Save kernel provided trap handlers.
 - 
 
47 
     */
 - 
 
48 
    memcpy((void *) trap_table_save, (void *) trap_table, TRAP_TABLE_SIZE);
 - 
 
49 
 
 - 
 
50 
    /*
 - 
 
51 
     * Copy OFW's trap table into kernel.
 - 
 
52 
     */
 - 
 
53 
    memcpy((void *) trap_table, (void *) tba_read(), TRAP_TABLE_SIZE);
 - 
 
54 
   
 - 
 
55 
    /*
 - 
 
56 
     * Install kernel-provided handlers.
 - 
 
57 
     */
 - 
 
58 
    trap_install_handler(TT_INSTRUCTION_ACCESS_EXCEPTION, TRAP_TABLE_ENTRY_SIZE, false);
 - 
 
59 
    trap_install_handler(TT_CLEAN_WINDOW, CLEAN_WINDOW_HANDLER_SIZE, false);
 - 
 
60 
    trap_install_handler(TT_MEM_ADDRESS_NOT_ALIGNED, TRAP_TABLE_ENTRY_SIZE, false);
 - 
 
61 
    trap_install_handler(TT_SPILL_0_NORMAL, SPILL_HANDLER_SIZE, false);
 - 
 
62 
    trap_install_handler(TT_FILL_0_NORMAL, FILL_HANDLER_SIZE, false);
 - 
 
63 
    trap_install_handler(TT_INSTRUCTION_ACCESS_EXCEPTION, TRAP_TABLE_ENTRY_SIZE, true);
 - 
 
64 
    trap_install_handler(TT_CLEAN_WINDOW, CLEAN_WINDOW_HANDLER_SIZE, true);
 - 
 
65 
    trap_install_handler(TT_MEM_ADDRESS_NOT_ALIGNED, TRAP_TABLE_ENTRY_SIZE, true);
 - 
 
66 
    trap_install_handler(TT_SPILL_0_NORMAL, SPILL_HANDLER_SIZE, true);
 - 
 
67 
    trap_install_handler(TT_FILL_0_NORMAL, FILL_HANDLER_SIZE, true);
 - 
 
68 
    trap_install_handler(TT_INTERRUPT_LEVEL_1, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
69 
    trap_install_handler(TT_INTERRUPT_LEVEL_2, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
70 
    trap_install_handler(TT_INTERRUPT_LEVEL_3, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
71 
    trap_install_handler(TT_INTERRUPT_LEVEL_4, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
72 
    trap_install_handler(TT_INTERRUPT_LEVEL_5, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
73 
    trap_install_handler(TT_INTERRUPT_LEVEL_6, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
74 
    trap_install_handler(TT_INTERRUPT_LEVEL_7, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
75 
    trap_install_handler(TT_INTERRUPT_LEVEL_8, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
76 
    trap_install_handler(TT_INTERRUPT_LEVEL_9, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
77 
    trap_install_handler(TT_INTERRUPT_LEVEL_10, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
78 
    trap_install_handler(TT_INTERRUPT_LEVEL_11, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
79 
    trap_install_handler(TT_INTERRUPT_LEVEL_12, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
80 
    trap_install_handler(TT_INTERRUPT_LEVEL_13, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
81 
    trap_install_handler(TT_INTERRUPT_LEVEL_14, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
82 
    trap_install_handler(TT_INTERRUPT_LEVEL_15, INTERRUPT_LEVEL_N_HANDLER_SIZE, false);
 - 
 
83 
    trap_install_handler(TT_INTERRUPT_VECTOR_TRAP, INTERRUPT_VECTOR_TRAP_HANDLER_SIZE, false);
 - 
 
84 
 
 - 
 
85 
    /*
 - 
 
86 
     * Kernel must become independent on Open Firmware calls before MMU handlers are enabled.
 - 
 
87 
     */
 - 
 
88 
/*
 - 
 
89 
    trap_install_handler(TT_FAST_INSTRUCTION_ACCESS_MMU_MISS, FAST_MMU_HANDLER_SIZE, false);
 - 
 
90 
    trap_install_handler(TT_FAST_DATA_ACCESS_MMU_MISS, FAST_MMU_HANDLER_SIZE, false);
 - 
 
91 
    trap_install_handler(TT_FAST_DATA_ACCESS_PROTECTION, FAST_MMU_HANDLER_SIZE, false);
 - 
 
92 
    trap_install_handler(TT_FAST_INSTRUCTION_ACCESS_MMU_MISS, FAST_MMU_HANDLER_SIZE, true);
 - 
 
93 
    trap_install_handler(TT_FAST_DATA_ACCESS_MMU_MISS, FAST_MMU_HANDLER_SIZE, true);
 - 
 
94 
    trap_install_handler(TT_FAST_DATA_ACCESS_PROTECTION, FAST_MMU_HANDLER_SIZE, true);
 - 
 
95 
*/
 - 
 
96 
 
 - 
 
97 
}
 - 
 
98 
 
 - 
 
99 
/** Copy trap handler to active trap table.
 - 
 
100 
 *
 - 
 
101 
 * The handler is copied from trap_table_kernel to trap_handler.
 - 
 
102 
 *
 - 
 
103 
 * @param tt Trap type. An index that uniquelly identifies handler code.
 - 
 
104 
 * @param len Length of the handler in bytes. Must be multiple of TRAP_TABLE_ENTRY_SIZE (i.e. 32).
 - 
 
105 
 * @param tlnonz If false, tt is considered from the lower half of trap table. If true, the upper half is chosen.
 - 
 
106 
 */
 - 
 
107 
void trap_install_handler(index_t tt, size_t len, bool tlnonz)
 - 
 
108 
{
 - 
 
109 
    count_t cnt;
 - 
 
110 
    int i;
 - 
 
111 
 
 - 
 
112 
    ASSERT(tt < TRAP_TABLE_ENTRY_COUNT/2);
 - 
 
113 
    ASSERT(len % TRAP_TABLE_ENTRY_SIZE == 0);
 - 
 
114 
 
 - 
 
115 
    if (tlnonz)
 - 
 
116 
        tt += TRAP_TABLE_ENTRY_COUNT/2;
 - 
 
117 
 
 - 
 
118 
    cnt = len/TRAP_TABLE_ENTRY_SIZE;
 - 
 
119 
   
 - 
 
120 
    for (i = tt; i < tt + cnt; i++) {
 - 
 
121 
        trap_table[i] = trap_table_save[i];
 - 
 
122 
    }  
 - 
 
123 
}
 45 
}