1 | /* |
---|
2 | * Copyright (c) 2011 Aeroflex Gaisler |
---|
3 | * |
---|
4 | * BSD license: |
---|
5 | * |
---|
6 | * Permission is hereby granted, free of charge, to any person obtaining a copy |
---|
7 | * of this software and associated documentation files (the "Software"), to deal |
---|
8 | * in the Software without restriction, including without limitation the rights |
---|
9 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
---|
10 | * copies of the Software, and to permit persons to whom the Software is |
---|
11 | * furnished to do so, subject to the following conditions: |
---|
12 | * |
---|
13 | * The above copyright notice and this permission notice shall be included in |
---|
14 | * all copies or substantial portions of the Software. |
---|
15 | * |
---|
16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
---|
17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
---|
18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
---|
19 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
---|
20 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
---|
21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
---|
22 | * THE SOFTWARE. |
---|
23 | */ |
---|
24 | |
---|
25 | |
---|
26 | /* The traptable has to be the first code in a boot PROM. */ |
---|
27 | |
---|
28 | #include <asm-leon/head.h> |
---|
29 | |
---|
30 | #define TRAP(H) mov %psr, %l0; sethi %hi(H), %l4; jmp %l4+%lo(H); nop; |
---|
31 | #define TRAPL(H) mov %g0, %g4; sethi %hi(H), %g4; jmp %g4+%lo(H); nop; |
---|
32 | #define TRAP_ENTRY(H) rd %psr, %l0; b H; rd %wim, %l3; nop; |
---|
33 | /* srmmu trap */ |
---|
34 | #define SRMMU_TFAULT rd %psr, %l0; rd %wim, %l3; b _srmmu_fault; mov 1, %l6; |
---|
35 | #define SRMMU_DFAULT rd %psr, %l0; rd %wim, %l3; b _srmmu_fault; mov 9, %l6; |
---|
36 | |
---|
37 | #define WIM_INIT 2 |
---|
38 | #ifdef _SOFT_FLOAT |
---|
39 | #define PSR_INIT 0x0e0 |
---|
40 | #else |
---|
41 | #define PSR_INIT 0x10e0 |
---|
42 | #endif |
---|
43 | |
---|
44 | #define NUMREGWINDOWS 8 |
---|
45 | |
---|
46 | /* Unexcpected trap will halt the processor by forcing it to error state */ |
---|
47 | #define BAD_TRAP ta 0; nop; nop; nop; |
---|
48 | |
---|
49 | /* Software trap. Treat as BAD_TRAP */ |
---|
50 | #define SOFT_TRAP BAD_TRAP |
---|
51 | |
---|
52 | .seg "text" |
---|
53 | .global _trap_table, cpuinit, leonbare_irq_entry, _hardreset, _hardreset_mvt |
---|
54 | .global _window_overflow, _window_underflow, _flush_windows, _fpdis_enable |
---|
55 | .global start |
---|
56 | start: |
---|
57 | _trap_table: |
---|
58 | TRAPL(_hardreset_mvt); ! 00 reset trap |
---|
59 | SRMMU_TFAULT ! 01 instruction_access_exception (in mmu_asm.S) |
---|
60 | BAD_TRAP; ! 02 illegal_instruction |
---|
61 | BAD_TRAP; ! 03 priveleged_instruction |
---|
62 | #ifndef _SOFT_FLOAT |
---|
63 | TRAP(_fpdis_enable); ! 04 fp_disabled |
---|
64 | #else |
---|
65 | TRAP(_fpdis); ! 04 fp_disabled |
---|
66 | #endif |
---|
67 | #ifndef _FLAT |
---|
68 | TRAP(_window_overflow); ! 05 window_overflow |
---|
69 | TRAP(_window_underflow); ! 06 window_underflow |
---|
70 | #else |
---|
71 | BAD_TRAP; BAD_TRAP; |
---|
72 | #endif |
---|
73 | BAD_TRAP; ! 07 memory_address_not_aligned |
---|
74 | BAD_TRAP; ! 08 fp_exception |
---|
75 | SRMMU_DFAULT ! 09 data_access_exception (in mmu_asm.S) |
---|
76 | BAD_TRAP; ! 0A tag_overflow |
---|
77 | |
---|
78 | BAD_TRAP; ! 0B undefined |
---|
79 | BAD_TRAP; ! 0C undefined |
---|
80 | BAD_TRAP; ! 0D undefined |
---|
81 | BAD_TRAP; ! 0E undefined |
---|
82 | BAD_TRAP; ! 0F undefined |
---|
83 | BAD_TRAP; ! 10 undefined |
---|
84 | |
---|
85 | /* Interrupt entries */ |
---|
86 | TRAP_ENTRY_INTERRUPT(1); ! 11 interrupt level 1 |
---|
87 | TRAP_ENTRY_INTERRUPT(2); ! 12 interrupt level 2 |
---|
88 | TRAP_ENTRY_INTERRUPT(3); ! 13 interrupt level 3 |
---|
89 | TRAP_ENTRY_INTERRUPT(4); ! 14 interrupt level 4 |
---|
90 | TRAP_ENTRY_INTERRUPT(5); ! 15 interrupt level 5 |
---|
91 | TRAP_ENTRY_INTERRUPT(6); ! 16 interrupt level 6 |
---|
92 | TRAP_ENTRY_INTERRUPT(7); ! 17 interrupt level 7 |
---|
93 | TRAP_ENTRY_INTERRUPT(8); ! 18 interrupt level 8 |
---|
94 | TRAP_ENTRY_INTERRUPT(9); ! 19 interrupt level 9 |
---|
95 | TRAP_ENTRY_INTERRUPT(10); ! 1A interrupt level 1 |
---|
96 | TRAP_ENTRY_INTERRUPT(11); ! 1B interrupt level 11 |
---|
97 | TRAP_ENTRY_INTERRUPT(12); ! 1C interrupt level 12 |
---|
98 | TRAP_ENTRY_INTERRUPT(13); ! 1D interrupt level 13 |
---|
99 | TRAP_ENTRY_INTERRUPT(14); ! 1E interrupt level 14 |
---|
100 | TRAP_ENTRY_INTERRUPT(15); ! 1F interrupt level 15 |
---|
101 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 20 - 23 undefined |
---|
102 | BAD_TRAP; ! 24 cp_disabled |
---|
103 | BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 25 - 27 undefined |
---|
104 | BAD_TRAP; ! 28 cp_exception |
---|
105 | BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 29 - 2B undefined |
---|
106 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 2C - 2F undefined |
---|
107 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 30 - 33 undefined |
---|
108 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 34 - 37 undefined |
---|
109 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 38 - 3B undefined |
---|
110 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 3C - 3F undefined |
---|
111 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 40 - 43 undefined |
---|
112 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 44 - 47 undefined |
---|
113 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 48 - 4B undefined |
---|
114 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 4C - 4F undefined |
---|
115 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 50 - 53 undefined |
---|
116 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 54 - 57 undefined |
---|
117 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 58 - 5B undefined |
---|
118 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 5C - 5F undefined |
---|
119 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 60 - 63 undefined |
---|
120 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 64 - 67 undefined |
---|
121 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 68 - 6B undefined |
---|
122 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 6C - 6F undefined |
---|
123 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 70 - 73 undefined |
---|
124 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 74 - 77 undefined |
---|
125 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 78 - 7B undefined |
---|
126 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 7C - 7F undefined |
---|
127 | |
---|
128 | /* Software traps */ |
---|
129 | SOFT_TRAP; SOFT_TRAP; TRAP(_irqcall); ! 80 - 82 |
---|
130 | #ifndef _FLAT |
---|
131 | TRAP_ENTRY(_flush_windows) ! 83 |
---|
132 | #else |
---|
133 | SOFT_TRAP |
---|
134 | #endif |
---|
135 | SOFT_TRAP; ! 84 |
---|
136 | TRAP(_irqcall_disableirq); ! 85 |
---|
137 | SOFT_TRAP; SOFT_TRAP; ! 86 - 87 |
---|
138 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 88 - 8B |
---|
139 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 8C - 8F |
---|
140 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 90 - 93 |
---|
141 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 94 - 97 |
---|
142 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 98 - 9B |
---|
143 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 9C - 9F |
---|
144 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! A0 - A3 |
---|
145 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! A4 - A7 |
---|
146 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! A8 - AB |
---|
147 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! AC - AF |
---|
148 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! B0 - B3 |
---|
149 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! B4 - B7 |
---|
150 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! B8 - BB |
---|
151 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! BC - BF |
---|
152 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! C0 - C3 |
---|
153 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! C4 - C7 |
---|
154 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! C8 - CB |
---|
155 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! CC - CF |
---|
156 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! D0 - D3 |
---|
157 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! D4 - D7 |
---|
158 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! D8 - DB |
---|
159 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! DC - DF |
---|
160 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! E0 - E3 |
---|
161 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! E4 - E7 |
---|
162 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! E8 - EB |
---|
163 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! EC - EF |
---|
164 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! F0 - F3 |
---|
165 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! F4 - F7 |
---|
166 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! F8 - FB |
---|
167 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! FC - FF |
---|
168 | |
---|
169 | |
---|
170 | |
---|