Merge branch 'fixes' of git://git.kernel.org/pub/scm/linux/kernel/git/davej/cpufreq
[pandora-kernel.git] / arch / sparc / kernel / head.S
1 /*
2  * head.S: The initial boot code for the Sparc port of Linux.
3  *
4  * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
5  * Copyright (C) 1995,1999 Pete Zaitcev   (zaitcev@yahoo.com)
6  * Copyright (C) 1996 Miguel de Icaza (miguel@nuclecu.unam.mx)
7  * Copyright (C) 1997 Jakub Jelinek   (jj@sunsite.mff.cuni.cz)
8  * Copyright (C) 1997 Michael A. Griffith (grif@acm.org)
9  *
10  * CompactPCI platform by Eric Brower, 1999.
11  */
12
13 #include <linux/version.h>
14 #include <linux/init.h>
15
16 #include <asm/head.h>
17 #include <asm/asi.h>
18 #include <asm/contregs.h>
19 #include <asm/ptrace.h>
20 #include <asm/psr.h>
21 #include <asm/page.h>
22 #include <asm/kdebug.h>
23 #include <asm/winmacro.h>
24 #include <asm/thread_info.h>    /* TI_UWINMASK */
25 #include <asm/errno.h>
26 #include <asm/pgtsrmmu.h>       /* SRMMU_PGDIR_SHIFT */
27
28         .data
29 /* 
30  * The following are used with the prom_vector node-ops to figure out
31  * the cpu-type 
32  */
33
34         .align 4
35         .globl  cputyp
36 cputyp:
37         .word   1
38
39         .align 4
40         .globl cputypval
41 cputypval:
42         .asciz "sun4c"
43         .ascii "     "
44
45 cputypvalend:
46 cputypvallen = cputypvar - cputypval
47
48         .align 4
49 /*
50  * Sun people can't spell worth damn. "compatability" indeed.
51  * At least we *know* we can't spell, and use a spell-checker.
52  */
53
54 /* Uh, actually Linus it is I who cannot spell. Too much murky
55  * Sparc assembly will do this to ya.
56  */
57 cputypvar:
58         .asciz "compatability"
59
60 /* Tested on SS-5, SS-10. Probably someone at Sun applied a spell-checker. */
61         .align 4
62 cputypvar_sun4m:
63         .asciz "compatible"
64
65         .align 4
66
67 #ifndef CONFIG_SUN4
68 sun4_notsup:
69         .asciz  "Sparc-Linux sun4 needs a specially compiled kernel, turn CONFIG_SUN4 on.\n\n"
70         .align 4
71 #else
72 sun4cdm_notsup:
73         .asciz  "Kernel compiled with CONFIG_SUN4 cannot run on SUN4C/SUN4M/SUN4D\nTurn CONFIG_SUN4 off.\n\n"
74         .align 4
75 #endif
76
77 sun4e_notsup:
78         .asciz  "Sparc-Linux sun4e support does not exist\n\n"
79         .align 4
80
81         /* The Sparc trap table, bootloader gives us control at _start. */
82         .text
83         .globl  start, _stext, _start, __stext
84         .globl  trapbase
85 _start:   /* danger danger */
86 __stext:
87 _stext:
88 start:
89 trapbase:
90 #ifdef CONFIG_SMP
91 trapbase_cpu0:
92 #endif
93 /* We get control passed to us here at t_zero. */
94 t_zero: b gokernel; nop; nop; nop;
95 t_tflt: SPARC_TFAULT                        /* Inst. Access Exception        */
96 t_bins: TRAP_ENTRY(0x2, bad_instruction)    /* Illegal Instruction           */
97 t_pins: TRAP_ENTRY(0x3, priv_instruction)   /* Privileged Instruction        */
98 t_fpd:  TRAP_ENTRY(0x4, fpd_trap_handler)   /* Floating Point Disabled       */
99 t_wovf: WINDOW_SPILL                        /* Window Overflow               */
100 t_wunf: WINDOW_FILL                         /* Window Underflow              */
101 t_mna:  TRAP_ENTRY(0x7, mna_handler)        /* Memory Address Not Aligned    */
102 t_fpe:  TRAP_ENTRY(0x8, fpe_trap_handler)   /* Floating Point Exception      */
103 t_dflt: SPARC_DFAULT                        /* Data Miss Exception           */
104 t_tio:  TRAP_ENTRY(0xa, do_tag_overflow)    /* Tagged Instruction Ovrflw     */
105 t_wpt:  TRAP_ENTRY(0xb, do_watchpoint)      /* Watchpoint Detected           */
106 t_badc: BAD_TRAP(0xc) BAD_TRAP(0xd) BAD_TRAP(0xe) BAD_TRAP(0xf) BAD_TRAP(0x10)
107 t_irq1: TRAP_ENTRY_INTERRUPT(1)             /* IRQ Software/SBUS Level 1     */
108 t_irq2: TRAP_ENTRY_INTERRUPT(2)             /* IRQ SBUS Level 2              */
109 t_irq3: TRAP_ENTRY_INTERRUPT(3)             /* IRQ SCSI/DMA/SBUS Level 3     */
110 t_irq4: TRAP_ENTRY_INTERRUPT(4)             /* IRQ Software Level 4          */
111 t_irq5: TRAP_ENTRY_INTERRUPT(5)             /* IRQ SBUS/Ethernet Level 5     */
112 t_irq6: TRAP_ENTRY_INTERRUPT(6)             /* IRQ Software Level 6          */
113 t_irq7: TRAP_ENTRY_INTERRUPT(7)             /* IRQ Video/SBUS Level 5        */
114 t_irq8: TRAP_ENTRY_INTERRUPT(8)             /* IRQ SBUS Level 6              */
115 t_irq9: TRAP_ENTRY_INTERRUPT(9)             /* IRQ SBUS Level 7              */
116 t_irq10:TRAP_ENTRY_INTERRUPT(10)            /* IRQ Timer #1 (one we use)     */
117 t_irq11:TRAP_ENTRY_INTERRUPT(11)            /* IRQ Floppy Intr.              */
118 t_irq12:TRAP_ENTRY_INTERRUPT(12)            /* IRQ Zilog serial chip         */
119 t_irq13:TRAP_ENTRY_INTERRUPT(13)            /* IRQ Audio Intr.               */
120 t_irq14:TRAP_ENTRY_INTERRUPT(14)            /* IRQ Timer #2                  */
121         .globl  t_nmi
122 #ifndef CONFIG_SMP
123 t_nmi:  NMI_TRAP                            /* Level 15 (NMI)                */
124 #else
125 t_nmi:  TRAP_ENTRY(0x1f, linux_trap_ipi15_sun4m)
126 #endif
127 t_racc: TRAP_ENTRY(0x20, do_reg_access)     /* General Register Access Error */
128 t_iacce:BAD_TRAP(0x21)                      /* Instr Access Error            */
129 t_bad22:BAD_TRAP(0x22) BAD_TRAP(0x23)
130 t_cpdis:TRAP_ENTRY(0x24, do_cp_disabled)    /* Co-Processor Disabled         */
131 t_uflsh:SKIP_TRAP(0x25, unimp_flush)        /* Unimplemented FLUSH inst.     */
132 t_bad26:BAD_TRAP(0x26) BAD_TRAP(0x27)
133 t_cpexc:TRAP_ENTRY(0x28, do_cp_exception)   /* Co-Processor Exception        */
134 t_dacce:SPARC_DFAULT                        /* Data Access Error             */
135 t_hwdz: TRAP_ENTRY(0x2a, do_hw_divzero)     /* Division by zero, you lose... */
136 t_dserr:BAD_TRAP(0x2b)                      /* Data Store Error              */
137 t_daccm:BAD_TRAP(0x2c)                      /* Data Access MMU-Miss          */
138 t_bad2d:BAD_TRAP(0x2d) BAD_TRAP(0x2e) BAD_TRAP(0x2f) BAD_TRAP(0x30) BAD_TRAP(0x31)
139 t_bad32:BAD_TRAP(0x32) BAD_TRAP(0x33) BAD_TRAP(0x34) BAD_TRAP(0x35) BAD_TRAP(0x36)
140 t_bad37:BAD_TRAP(0x37) BAD_TRAP(0x38) BAD_TRAP(0x39) BAD_TRAP(0x3a) BAD_TRAP(0x3b)
141 t_iaccm:BAD_TRAP(0x3c)                      /* Instr Access MMU-Miss         */
142 t_bad3d:BAD_TRAP(0x3d) BAD_TRAP(0x3e) BAD_TRAP(0x3f) BAD_TRAP(0x40) BAD_TRAP(0x41)
143 t_bad42:BAD_TRAP(0x42) BAD_TRAP(0x43) BAD_TRAP(0x44) BAD_TRAP(0x45) BAD_TRAP(0x46)
144 t_bad47:BAD_TRAP(0x47) BAD_TRAP(0x48) BAD_TRAP(0x49) BAD_TRAP(0x4a) BAD_TRAP(0x4b)
145 t_bad4c:BAD_TRAP(0x4c) BAD_TRAP(0x4d) BAD_TRAP(0x4e) BAD_TRAP(0x4f) BAD_TRAP(0x50)
146 t_bad51:BAD_TRAP(0x51) BAD_TRAP(0x52) BAD_TRAP(0x53) BAD_TRAP(0x54) BAD_TRAP(0x55)
147 t_bad56:BAD_TRAP(0x56) BAD_TRAP(0x57) BAD_TRAP(0x58) BAD_TRAP(0x59) BAD_TRAP(0x5a)
148 t_bad5b:BAD_TRAP(0x5b) BAD_TRAP(0x5c) BAD_TRAP(0x5d) BAD_TRAP(0x5e) BAD_TRAP(0x5f)
149 t_bad60:BAD_TRAP(0x60) BAD_TRAP(0x61) BAD_TRAP(0x62) BAD_TRAP(0x63) BAD_TRAP(0x64)
150 t_bad65:BAD_TRAP(0x65) BAD_TRAP(0x66) BAD_TRAP(0x67) BAD_TRAP(0x68) BAD_TRAP(0x69)
151 t_bad6a:BAD_TRAP(0x6a) BAD_TRAP(0x6b) BAD_TRAP(0x6c) BAD_TRAP(0x6d) BAD_TRAP(0x6e)
152 t_bad6f:BAD_TRAP(0x6f) BAD_TRAP(0x70) BAD_TRAP(0x71) BAD_TRAP(0x72) BAD_TRAP(0x73)
153 t_bad74:BAD_TRAP(0x74) BAD_TRAP(0x75) BAD_TRAP(0x76) BAD_TRAP(0x77) BAD_TRAP(0x78)
154 t_bad79:BAD_TRAP(0x79) BAD_TRAP(0x7a) BAD_TRAP(0x7b) BAD_TRAP(0x7c) BAD_TRAP(0x7d)
155 t_bad7e:BAD_TRAP(0x7e) BAD_TRAP(0x7f)
156 t_bad80:BAD_TRAP(0x80)                      /* SunOS System Call             */
157 t_sbkpt:BREAKPOINT_TRAP                     /* Software Breakpoint/KGDB      */
158 t_divz: TRAP_ENTRY(0x82, do_hw_divzero)     /* Divide by zero trap           */
159 t_flwin:TRAP_ENTRY(0x83, do_flush_windows)  /* Flush Windows Trap            */
160 t_clwin:BAD_TRAP(0x84)                      /* Clean Windows Trap            */
161 t_rchk: BAD_TRAP(0x85)                      /* Range Check                   */
162 t_funal:BAD_TRAP(0x86)                      /* Fix Unaligned Access Trap     */
163 t_iovf: BAD_TRAP(0x87)                      /* Integer Overflow Trap         */
164 t_bad88:BAD_TRAP(0x88)                      /* Slowaris System Call          */
165 t_bad89:BAD_TRAP(0x89)                      /* Net-B.S. System Call          */
166 t_bad8a:BAD_TRAP(0x8a) BAD_TRAP(0x8b) BAD_TRAP(0x8c) BAD_TRAP(0x8d) BAD_TRAP(0x8e)
167 t_bad8f:BAD_TRAP(0x8f)
168 t_linux:LINUX_SYSCALL_TRAP                  /* Linux System Call             */
169 t_bad91:BAD_TRAP(0x91) BAD_TRAP(0x92) BAD_TRAP(0x93) BAD_TRAP(0x94) BAD_TRAP(0x95)
170 t_bad96:BAD_TRAP(0x96) BAD_TRAP(0x97) BAD_TRAP(0x98) BAD_TRAP(0x99) BAD_TRAP(0x9a)
171 t_bad9b:BAD_TRAP(0x9b) BAD_TRAP(0x9c) BAD_TRAP(0x9d) BAD_TRAP(0x9e) BAD_TRAP(0x9f)
172 t_getcc:GETCC_TRAP                          /* Get Condition Codes           */
173 t_setcc:SETCC_TRAP                          /* Set Condition Codes           */
174 t_getpsr:GETPSR_TRAP                        /* Get PSR Register              */
175 t_bada3:BAD_TRAP(0xa3) BAD_TRAP(0xa4) BAD_TRAP(0xa5) BAD_TRAP(0xa6)
176 t_bada7:BAD_TRAP(0xa7)
177 t_bada8:BAD_TRAP(0xa8) BAD_TRAP(0xa9) BAD_TRAP(0xaa) BAD_TRAP(0xab)
178 t_badac:BAD_TRAP(0xac) BAD_TRAP(0xad) BAD_TRAP(0xae) BAD_TRAP(0xaf) BAD_TRAP(0xb0)
179 t_badb1:BAD_TRAP(0xb1) BAD_TRAP(0xb2) BAD_TRAP(0xb3) BAD_TRAP(0xb4) BAD_TRAP(0xb5)
180 t_badb6:BAD_TRAP(0xb6) BAD_TRAP(0xb7) BAD_TRAP(0xb8) BAD_TRAP(0xb9) BAD_TRAP(0xba)
181 t_badbb:BAD_TRAP(0xbb) BAD_TRAP(0xbc) BAD_TRAP(0xbd) BAD_TRAP(0xbe) BAD_TRAP(0xbf)
182 t_badc0:BAD_TRAP(0xc0) BAD_TRAP(0xc1) BAD_TRAP(0xc2) BAD_TRAP(0xc3) BAD_TRAP(0xc4)
183 t_badc5:BAD_TRAP(0xc5) BAD_TRAP(0xc6) BAD_TRAP(0xc7) BAD_TRAP(0xc8) BAD_TRAP(0xc9)
184 t_badca:BAD_TRAP(0xca) BAD_TRAP(0xcb) BAD_TRAP(0xcc) BAD_TRAP(0xcd) BAD_TRAP(0xce)
185 t_badcf:BAD_TRAP(0xcf) BAD_TRAP(0xd0) BAD_TRAP(0xd1) BAD_TRAP(0xd2) BAD_TRAP(0xd3)
186 t_badd4:BAD_TRAP(0xd4) BAD_TRAP(0xd5) BAD_TRAP(0xd6) BAD_TRAP(0xd7) BAD_TRAP(0xd8)
187 t_badd9:BAD_TRAP(0xd9) BAD_TRAP(0xda) BAD_TRAP(0xdb) BAD_TRAP(0xdc) BAD_TRAP(0xdd)
188 t_badde:BAD_TRAP(0xde) BAD_TRAP(0xdf) BAD_TRAP(0xe0) BAD_TRAP(0xe1) BAD_TRAP(0xe2)
189 t_bade3:BAD_TRAP(0xe3) BAD_TRAP(0xe4) BAD_TRAP(0xe5) BAD_TRAP(0xe6) BAD_TRAP(0xe7)
190 t_bade8:BAD_TRAP(0xe8) BAD_TRAP(0xe9) BAD_TRAP(0xea) BAD_TRAP(0xeb) BAD_TRAP(0xec)
191 t_baded:BAD_TRAP(0xed) BAD_TRAP(0xee) BAD_TRAP(0xef) BAD_TRAP(0xf0) BAD_TRAP(0xf1)
192 t_badf2:BAD_TRAP(0xf2) BAD_TRAP(0xf3) BAD_TRAP(0xf4) BAD_TRAP(0xf5) BAD_TRAP(0xf6)
193 t_badf7:BAD_TRAP(0xf7) BAD_TRAP(0xf8) BAD_TRAP(0xf9) BAD_TRAP(0xfa) BAD_TRAP(0xfb)
194 t_badfc:BAD_TRAP(0xfc)
195 t_kgdb: KGDB_TRAP(0xfd)
196 dbtrap: BAD_TRAP(0xfe)                      /* Debugger/PROM breakpoint #1   */
197 dbtrap2:BAD_TRAP(0xff)                      /* Debugger/PROM breakpoint #2   */ 
198
199         .globl  end_traptable
200 end_traptable:
201
202 #ifdef CONFIG_SMP
203         /* Trap tables for the other cpus. */
204         .globl  trapbase_cpu1, trapbase_cpu2, trapbase_cpu3
205 trapbase_cpu1:
206         BAD_TRAP(0x0) SRMMU_TFAULT TRAP_ENTRY(0x2, bad_instruction)
207         TRAP_ENTRY(0x3, priv_instruction) TRAP_ENTRY(0x4, fpd_trap_handler)
208         WINDOW_SPILL WINDOW_FILL TRAP_ENTRY(0x7, mna_handler)
209         TRAP_ENTRY(0x8, fpe_trap_handler) SRMMU_DFAULT
210         TRAP_ENTRY(0xa, do_tag_overflow) TRAP_ENTRY(0xb, do_watchpoint)
211         BAD_TRAP(0xc) BAD_TRAP(0xd) BAD_TRAP(0xe) BAD_TRAP(0xf) BAD_TRAP(0x10)
212         TRAP_ENTRY_INTERRUPT(1) TRAP_ENTRY_INTERRUPT(2)
213         TRAP_ENTRY_INTERRUPT(3) TRAP_ENTRY_INTERRUPT(4)
214         TRAP_ENTRY_INTERRUPT(5) TRAP_ENTRY_INTERRUPT(6)
215         TRAP_ENTRY_INTERRUPT(7) TRAP_ENTRY_INTERRUPT(8)
216         TRAP_ENTRY_INTERRUPT(9) TRAP_ENTRY_INTERRUPT(10)
217         TRAP_ENTRY_INTERRUPT(11) TRAP_ENTRY_INTERRUPT(12)
218         TRAP_ENTRY_INTERRUPT(13) TRAP_ENTRY_INTERRUPT(14)
219         TRAP_ENTRY(0x1f, linux_trap_ipi15_sun4m)
220         TRAP_ENTRY(0x20, do_reg_access) BAD_TRAP(0x21) BAD_TRAP(0x22)
221         BAD_TRAP(0x23) TRAP_ENTRY(0x24, do_cp_disabled) SKIP_TRAP(0x25, unimp_flush)
222         BAD_TRAP(0x26) BAD_TRAP(0x27) TRAP_ENTRY(0x28, do_cp_exception)
223         SRMMU_DFAULT TRAP_ENTRY(0x2a, do_hw_divzero) BAD_TRAP(0x2b) BAD_TRAP(0x2c)
224         BAD_TRAP(0x2d) BAD_TRAP(0x2e) BAD_TRAP(0x2f) BAD_TRAP(0x30) BAD_TRAP(0x31)
225         BAD_TRAP(0x32) BAD_TRAP(0x33) BAD_TRAP(0x34) BAD_TRAP(0x35) BAD_TRAP(0x36)
226         BAD_TRAP(0x37) BAD_TRAP(0x38) BAD_TRAP(0x39) BAD_TRAP(0x3a) BAD_TRAP(0x3b)
227         BAD_TRAP(0x3c) BAD_TRAP(0x3d) BAD_TRAP(0x3e) BAD_TRAP(0x3f) BAD_TRAP(0x40)
228         BAD_TRAP(0x41) BAD_TRAP(0x42) BAD_TRAP(0x43) BAD_TRAP(0x44) BAD_TRAP(0x45)
229         BAD_TRAP(0x46) BAD_TRAP(0x47) BAD_TRAP(0x48) BAD_TRAP(0x49) BAD_TRAP(0x4a)
230         BAD_TRAP(0x4b) BAD_TRAP(0x4c) BAD_TRAP(0x4d) BAD_TRAP(0x4e) BAD_TRAP(0x4f)
231         BAD_TRAP(0x50)
232         BAD_TRAP(0x51) BAD_TRAP(0x52) BAD_TRAP(0x53) BAD_TRAP(0x54) BAD_TRAP(0x55)
233         BAD_TRAP(0x56) BAD_TRAP(0x57) BAD_TRAP(0x58) BAD_TRAP(0x59) BAD_TRAP(0x5a)
234         BAD_TRAP(0x5b) BAD_TRAP(0x5c) BAD_TRAP(0x5d) BAD_TRAP(0x5e) BAD_TRAP(0x5f)
235         BAD_TRAP(0x60) BAD_TRAP(0x61) BAD_TRAP(0x62) BAD_TRAP(0x63) BAD_TRAP(0x64)
236         BAD_TRAP(0x65) BAD_TRAP(0x66) BAD_TRAP(0x67) BAD_TRAP(0x68) BAD_TRAP(0x69)
237         BAD_TRAP(0x6a) BAD_TRAP(0x6b) BAD_TRAP(0x6c) BAD_TRAP(0x6d) BAD_TRAP(0x6e)
238         BAD_TRAP(0x6f) BAD_TRAP(0x70) BAD_TRAP(0x71) BAD_TRAP(0x72) BAD_TRAP(0x73)
239         BAD_TRAP(0x74) BAD_TRAP(0x75) BAD_TRAP(0x76) BAD_TRAP(0x77) BAD_TRAP(0x78)
240         BAD_TRAP(0x79) BAD_TRAP(0x7a) BAD_TRAP(0x7b) BAD_TRAP(0x7c) BAD_TRAP(0x7d)
241         BAD_TRAP(0x7e) BAD_TRAP(0x7f)
242         BAD_TRAP(0x80)
243         BREAKPOINT_TRAP
244         TRAP_ENTRY(0x82, do_hw_divzero)
245         TRAP_ENTRY(0x83, do_flush_windows) BAD_TRAP(0x84) BAD_TRAP(0x85)
246         BAD_TRAP(0x86) BAD_TRAP(0x87) BAD_TRAP(0x88)
247         BAD_TRAP(0x89) BAD_TRAP(0x8a) BAD_TRAP(0x8b) BAD_TRAP(0x8c)
248         BAD_TRAP(0x8d) BAD_TRAP(0x8e) BAD_TRAP(0x8f)
249         LINUX_SYSCALL_TRAP BAD_TRAP(0x91) BAD_TRAP(0x92) BAD_TRAP(0x93) BAD_TRAP(0x94)
250         BAD_TRAP(0x95) BAD_TRAP(0x96) BAD_TRAP(0x97) BAD_TRAP(0x98) BAD_TRAP(0x99)
251         BAD_TRAP(0x9a) BAD_TRAP(0x9b) BAD_TRAP(0x9c) BAD_TRAP(0x9d) BAD_TRAP(0x9e)
252         BAD_TRAP(0x9f) GETCC_TRAP SETCC_TRAP GETPSR_TRAP
253         BAD_TRAP(0xa3) BAD_TRAP(0xa4) BAD_TRAP(0xa5) BAD_TRAP(0xa6)
254         BAD_TRAP(0xa7) BAD_TRAP(0xa8) BAD_TRAP(0xa9) BAD_TRAP(0xaa) BAD_TRAP(0xab)
255         BAD_TRAP(0xac) BAD_TRAP(0xad) BAD_TRAP(0xae) BAD_TRAP(0xaf) BAD_TRAP(0xb0)
256         BAD_TRAP(0xb1) BAD_TRAP(0xb2) BAD_TRAP(0xb3) BAD_TRAP(0xb4) BAD_TRAP(0xb5)
257         BAD_TRAP(0xb6) BAD_TRAP(0xb7) BAD_TRAP(0xb8) BAD_TRAP(0xb9) BAD_TRAP(0xba)
258         BAD_TRAP(0xbb) BAD_TRAP(0xbc) BAD_TRAP(0xbd) BAD_TRAP(0xbe) BAD_TRAP(0xbf)
259         BAD_TRAP(0xc0) BAD_TRAP(0xc1) BAD_TRAP(0xc2) BAD_TRAP(0xc3) BAD_TRAP(0xc4)
260         BAD_TRAP(0xc5) BAD_TRAP(0xc6) BAD_TRAP(0xc7) BAD_TRAP(0xc8) BAD_TRAP(0xc9)
261         BAD_TRAP(0xca) BAD_TRAP(0xcb) BAD_TRAP(0xcc) BAD_TRAP(0xcd) BAD_TRAP(0xce)
262         BAD_TRAP(0xcf) BAD_TRAP(0xd0) BAD_TRAP(0xd1) BAD_TRAP(0xd2) BAD_TRAP(0xd3)
263         BAD_TRAP(0xd4) BAD_TRAP(0xd5) BAD_TRAP(0xd6) BAD_TRAP(0xd7) BAD_TRAP(0xd8)
264         BAD_TRAP(0xd9) BAD_TRAP(0xda) BAD_TRAP(0xdb) BAD_TRAP(0xdc) BAD_TRAP(0xdd)
265         BAD_TRAP(0xde) BAD_TRAP(0xdf) BAD_TRAP(0xe0) BAD_TRAP(0xe1) BAD_TRAP(0xe2)
266         BAD_TRAP(0xe3) BAD_TRAP(0xe4) BAD_TRAP(0xe5) BAD_TRAP(0xe6) BAD_TRAP(0xe7)
267         BAD_TRAP(0xe8) BAD_TRAP(0xe9) BAD_TRAP(0xea) BAD_TRAP(0xeb) BAD_TRAP(0xec)
268         BAD_TRAP(0xed) BAD_TRAP(0xee) BAD_TRAP(0xef) BAD_TRAP(0xf0) BAD_TRAP(0xf1)
269         BAD_TRAP(0xf2) BAD_TRAP(0xf3) BAD_TRAP(0xf4) BAD_TRAP(0xf5) BAD_TRAP(0xf6)
270         BAD_TRAP(0xf7) BAD_TRAP(0xf8) BAD_TRAP(0xf9) BAD_TRAP(0xfa) BAD_TRAP(0xfb)
271         BAD_TRAP(0xfc) KGDB_TRAP(0xfd) BAD_TRAP(0xfe) BAD_TRAP(0xff)
272
273 trapbase_cpu2:
274         BAD_TRAP(0x0) SRMMU_TFAULT TRAP_ENTRY(0x2, bad_instruction)
275         TRAP_ENTRY(0x3, priv_instruction) TRAP_ENTRY(0x4, fpd_trap_handler)
276         WINDOW_SPILL WINDOW_FILL TRAP_ENTRY(0x7, mna_handler)
277         TRAP_ENTRY(0x8, fpe_trap_handler) SRMMU_DFAULT
278         TRAP_ENTRY(0xa, do_tag_overflow) TRAP_ENTRY(0xb, do_watchpoint)
279         BAD_TRAP(0xc) BAD_TRAP(0xd) BAD_TRAP(0xe) BAD_TRAP(0xf) BAD_TRAP(0x10)
280         TRAP_ENTRY_INTERRUPT(1) TRAP_ENTRY_INTERRUPT(2)
281         TRAP_ENTRY_INTERRUPT(3) TRAP_ENTRY_INTERRUPT(4)
282         TRAP_ENTRY_INTERRUPT(5) TRAP_ENTRY_INTERRUPT(6)
283         TRAP_ENTRY_INTERRUPT(7) TRAP_ENTRY_INTERRUPT(8)
284         TRAP_ENTRY_INTERRUPT(9) TRAP_ENTRY_INTERRUPT(10)
285         TRAP_ENTRY_INTERRUPT(11) TRAP_ENTRY_INTERRUPT(12)
286         TRAP_ENTRY_INTERRUPT(13) TRAP_ENTRY_INTERRUPT(14)
287         TRAP_ENTRY(0x1f, linux_trap_ipi15_sun4m)
288         TRAP_ENTRY(0x20, do_reg_access) BAD_TRAP(0x21) BAD_TRAP(0x22)
289         BAD_TRAP(0x23) TRAP_ENTRY(0x24, do_cp_disabled) SKIP_TRAP(0x25, unimp_flush)
290         BAD_TRAP(0x26) BAD_TRAP(0x27) TRAP_ENTRY(0x28, do_cp_exception)
291         SRMMU_DFAULT TRAP_ENTRY(0x2a, do_hw_divzero) BAD_TRAP(0x2b) BAD_TRAP(0x2c)
292         BAD_TRAP(0x2d) BAD_TRAP(0x2e) BAD_TRAP(0x2f) BAD_TRAP(0x30) BAD_TRAP(0x31)
293         BAD_TRAP(0x32) BAD_TRAP(0x33) BAD_TRAP(0x34) BAD_TRAP(0x35) BAD_TRAP(0x36)
294         BAD_TRAP(0x37) BAD_TRAP(0x38) BAD_TRAP(0x39) BAD_TRAP(0x3a) BAD_TRAP(0x3b)
295         BAD_TRAP(0x3c) BAD_TRAP(0x3d) BAD_TRAP(0x3e) BAD_TRAP(0x3f) BAD_TRAP(0x40)
296         BAD_TRAP(0x41) BAD_TRAP(0x42) BAD_TRAP(0x43) BAD_TRAP(0x44) BAD_TRAP(0x45)
297         BAD_TRAP(0x46) BAD_TRAP(0x47) BAD_TRAP(0x48) BAD_TRAP(0x49) BAD_TRAP(0x4a)
298         BAD_TRAP(0x4b) BAD_TRAP(0x4c) BAD_TRAP(0x4d) BAD_TRAP(0x4e) BAD_TRAP(0x4f)
299         BAD_TRAP(0x50)
300         BAD_TRAP(0x51) BAD_TRAP(0x52) BAD_TRAP(0x53) BAD_TRAP(0x54) BAD_TRAP(0x55)
301         BAD_TRAP(0x56) BAD_TRAP(0x57) BAD_TRAP(0x58) BAD_TRAP(0x59) BAD_TRAP(0x5a)
302         BAD_TRAP(0x5b) BAD_TRAP(0x5c) BAD_TRAP(0x5d) BAD_TRAP(0x5e) BAD_TRAP(0x5f)
303         BAD_TRAP(0x60) BAD_TRAP(0x61) BAD_TRAP(0x62) BAD_TRAP(0x63) BAD_TRAP(0x64)
304         BAD_TRAP(0x65) BAD_TRAP(0x66) BAD_TRAP(0x67) BAD_TRAP(0x68) BAD_TRAP(0x69)
305         BAD_TRAP(0x6a) BAD_TRAP(0x6b) BAD_TRAP(0x6c) BAD_TRAP(0x6d) BAD_TRAP(0x6e)
306         BAD_TRAP(0x6f) BAD_TRAP(0x70) BAD_TRAP(0x71) BAD_TRAP(0x72) BAD_TRAP(0x73)
307         BAD_TRAP(0x74) BAD_TRAP(0x75) BAD_TRAP(0x76) BAD_TRAP(0x77) BAD_TRAP(0x78)
308         BAD_TRAP(0x79) BAD_TRAP(0x7a) BAD_TRAP(0x7b) BAD_TRAP(0x7c) BAD_TRAP(0x7d)
309         BAD_TRAP(0x7e) BAD_TRAP(0x7f)
310         BAD_TRAP(0x80)
311         BREAKPOINT_TRAP
312         TRAP_ENTRY(0x82, do_hw_divzero)
313         TRAP_ENTRY(0x83, do_flush_windows) BAD_TRAP(0x84) BAD_TRAP(0x85)
314         BAD_TRAP(0x86) BAD_TRAP(0x87) BAD_TRAP(0x88)
315         BAD_TRAP(0x89) BAD_TRAP(0x8a) BAD_TRAP(0x8b) BAD_TRAP(0x8c)
316         BAD_TRAP(0x8d) BAD_TRAP(0x8e) BAD_TRAP(0x8f)
317         LINUX_SYSCALL_TRAP BAD_TRAP(0x91) BAD_TRAP(0x92) BAD_TRAP(0x93) BAD_TRAP(0x94)
318         BAD_TRAP(0x95) BAD_TRAP(0x96) BAD_TRAP(0x97) BAD_TRAP(0x98) BAD_TRAP(0x99)
319         BAD_TRAP(0x9a) BAD_TRAP(0x9b) BAD_TRAP(0x9c) BAD_TRAP(0x9d) BAD_TRAP(0x9e)
320         BAD_TRAP(0x9f) GETCC_TRAP SETCC_TRAP GETPSR_TRAP
321         BAD_TRAP(0xa3) BAD_TRAP(0xa4) BAD_TRAP(0xa5) BAD_TRAP(0xa6)
322         BAD_TRAP(0xa7) BAD_TRAP(0xa8) BAD_TRAP(0xa9) BAD_TRAP(0xaa) BAD_TRAP(0xab)
323         BAD_TRAP(0xac) BAD_TRAP(0xad) BAD_TRAP(0xae) BAD_TRAP(0xaf) BAD_TRAP(0xb0)
324         BAD_TRAP(0xb1) BAD_TRAP(0xb2) BAD_TRAP(0xb3) BAD_TRAP(0xb4) BAD_TRAP(0xb5)
325         BAD_TRAP(0xb6) BAD_TRAP(0xb7) BAD_TRAP(0xb8) BAD_TRAP(0xb9) BAD_TRAP(0xba)
326         BAD_TRAP(0xbb) BAD_TRAP(0xbc) BAD_TRAP(0xbd) BAD_TRAP(0xbe) BAD_TRAP(0xbf)
327         BAD_TRAP(0xc0) BAD_TRAP(0xc1) BAD_TRAP(0xc2) BAD_TRAP(0xc3) BAD_TRAP(0xc4)
328         BAD_TRAP(0xc5) BAD_TRAP(0xc6) BAD_TRAP(0xc7) BAD_TRAP(0xc8) BAD_TRAP(0xc9)
329         BAD_TRAP(0xca) BAD_TRAP(0xcb) BAD_TRAP(0xcc) BAD_TRAP(0xcd) BAD_TRAP(0xce)
330         BAD_TRAP(0xcf) BAD_TRAP(0xd0) BAD_TRAP(0xd1) BAD_TRAP(0xd2) BAD_TRAP(0xd3)
331         BAD_TRAP(0xd4) BAD_TRAP(0xd5) BAD_TRAP(0xd6) BAD_TRAP(0xd7) BAD_TRAP(0xd8)
332         BAD_TRAP(0xd9) BAD_TRAP(0xda) BAD_TRAP(0xdb) BAD_TRAP(0xdc) BAD_TRAP(0xdd)
333         BAD_TRAP(0xde) BAD_TRAP(0xdf) BAD_TRAP(0xe0) BAD_TRAP(0xe1) BAD_TRAP(0xe2)
334         BAD_TRAP(0xe3) BAD_TRAP(0xe4) BAD_TRAP(0xe5) BAD_TRAP(0xe6) BAD_TRAP(0xe7)
335         BAD_TRAP(0xe8) BAD_TRAP(0xe9) BAD_TRAP(0xea) BAD_TRAP(0xeb) BAD_TRAP(0xec)
336         BAD_TRAP(0xed) BAD_TRAP(0xee) BAD_TRAP(0xef) BAD_TRAP(0xf0) BAD_TRAP(0xf1)
337         BAD_TRAP(0xf2) BAD_TRAP(0xf3) BAD_TRAP(0xf4) BAD_TRAP(0xf5) BAD_TRAP(0xf6)
338         BAD_TRAP(0xf7) BAD_TRAP(0xf8) BAD_TRAP(0xf9) BAD_TRAP(0xfa) BAD_TRAP(0xfb)
339         BAD_TRAP(0xfc) KGDB_TRAP(0xfd) BAD_TRAP(0xfe) BAD_TRAP(0xff)
340
341 trapbase_cpu3:
342         BAD_TRAP(0x0) SRMMU_TFAULT TRAP_ENTRY(0x2, bad_instruction)
343         TRAP_ENTRY(0x3, priv_instruction) TRAP_ENTRY(0x4, fpd_trap_handler)
344         WINDOW_SPILL WINDOW_FILL TRAP_ENTRY(0x7, mna_handler)
345         TRAP_ENTRY(0x8, fpe_trap_handler) SRMMU_DFAULT
346         TRAP_ENTRY(0xa, do_tag_overflow) TRAP_ENTRY(0xb, do_watchpoint)
347         BAD_TRAP(0xc) BAD_TRAP(0xd) BAD_TRAP(0xe) BAD_TRAP(0xf) BAD_TRAP(0x10)
348         TRAP_ENTRY_INTERRUPT(1) TRAP_ENTRY_INTERRUPT(2)
349         TRAP_ENTRY_INTERRUPT(3) TRAP_ENTRY_INTERRUPT(4)
350         TRAP_ENTRY_INTERRUPT(5) TRAP_ENTRY_INTERRUPT(6)
351         TRAP_ENTRY_INTERRUPT(7) TRAP_ENTRY_INTERRUPT(8)
352         TRAP_ENTRY_INTERRUPT(9) TRAP_ENTRY_INTERRUPT(10)
353         TRAP_ENTRY_INTERRUPT(11) TRAP_ENTRY_INTERRUPT(12)
354         TRAP_ENTRY_INTERRUPT(13) TRAP_ENTRY_INTERRUPT(14)
355         TRAP_ENTRY(0x1f, linux_trap_ipi15_sun4m)
356         TRAP_ENTRY(0x20, do_reg_access) BAD_TRAP(0x21) BAD_TRAP(0x22)
357         BAD_TRAP(0x23) TRAP_ENTRY(0x24, do_cp_disabled) SKIP_TRAP(0x25, unimp_flush)
358         BAD_TRAP(0x26) BAD_TRAP(0x27) TRAP_ENTRY(0x28, do_cp_exception)
359         SRMMU_DFAULT TRAP_ENTRY(0x2a, do_hw_divzero) BAD_TRAP(0x2b) BAD_TRAP(0x2c)
360         BAD_TRAP(0x2d) BAD_TRAP(0x2e) BAD_TRAP(0x2f) BAD_TRAP(0x30) BAD_TRAP(0x31)
361         BAD_TRAP(0x32) BAD_TRAP(0x33) BAD_TRAP(0x34) BAD_TRAP(0x35) BAD_TRAP(0x36)
362         BAD_TRAP(0x37) BAD_TRAP(0x38) BAD_TRAP(0x39) BAD_TRAP(0x3a) BAD_TRAP(0x3b)
363         BAD_TRAP(0x3c) BAD_TRAP(0x3d) BAD_TRAP(0x3e) BAD_TRAP(0x3f) BAD_TRAP(0x40)
364         BAD_TRAP(0x41) BAD_TRAP(0x42) BAD_TRAP(0x43) BAD_TRAP(0x44) BAD_TRAP(0x45)
365         BAD_TRAP(0x46) BAD_TRAP(0x47) BAD_TRAP(0x48) BAD_TRAP(0x49) BAD_TRAP(0x4a)
366         BAD_TRAP(0x4b) BAD_TRAP(0x4c) BAD_TRAP(0x4d) BAD_TRAP(0x4e) BAD_TRAP(0x4f)
367         BAD_TRAP(0x50)
368         BAD_TRAP(0x51) BAD_TRAP(0x52) BAD_TRAP(0x53) BAD_TRAP(0x54) BAD_TRAP(0x55)
369         BAD_TRAP(0x56) BAD_TRAP(0x57) BAD_TRAP(0x58) BAD_TRAP(0x59) BAD_TRAP(0x5a)
370         BAD_TRAP(0x5b) BAD_TRAP(0x5c) BAD_TRAP(0x5d) BAD_TRAP(0x5e) BAD_TRAP(0x5f)
371         BAD_TRAP(0x60) BAD_TRAP(0x61) BAD_TRAP(0x62) BAD_TRAP(0x63) BAD_TRAP(0x64)
372         BAD_TRAP(0x65) BAD_TRAP(0x66) BAD_TRAP(0x67) BAD_TRAP(0x68) BAD_TRAP(0x69)
373         BAD_TRAP(0x6a) BAD_TRAP(0x6b) BAD_TRAP(0x6c) BAD_TRAP(0x6d) BAD_TRAP(0x6e)
374         BAD_TRAP(0x6f) BAD_TRAP(0x70) BAD_TRAP(0x71) BAD_TRAP(0x72) BAD_TRAP(0x73)
375         BAD_TRAP(0x74) BAD_TRAP(0x75) BAD_TRAP(0x76) BAD_TRAP(0x77) BAD_TRAP(0x78)
376         BAD_TRAP(0x79) BAD_TRAP(0x7a) BAD_TRAP(0x7b) BAD_TRAP(0x7c) BAD_TRAP(0x7d)
377         BAD_TRAP(0x7e) BAD_TRAP(0x7f)
378         BAD_TRAP(0x80)
379         BREAKPOINT_TRAP
380         TRAP_ENTRY(0x82, do_hw_divzero)
381         TRAP_ENTRY(0x83, do_flush_windows) BAD_TRAP(0x84) BAD_TRAP(0x85)
382         BAD_TRAP(0x86) BAD_TRAP(0x87) BAD_TRAP(0x88)
383         BAD_TRAP(0x89) BAD_TRAP(0x8a) BAD_TRAP(0x8b) BAD_TRAP(0x8c)
384         BAD_TRAP(0x8d) BAD_TRAP(0x8e) BAD_TRAP(0x8f)
385         LINUX_SYSCALL_TRAP BAD_TRAP(0x91) BAD_TRAP(0x92) BAD_TRAP(0x93) BAD_TRAP(0x94)
386         BAD_TRAP(0x95) BAD_TRAP(0x96) BAD_TRAP(0x97) BAD_TRAP(0x98) BAD_TRAP(0x99)
387         BAD_TRAP(0x9a) BAD_TRAP(0x9b) BAD_TRAP(0x9c) BAD_TRAP(0x9d) BAD_TRAP(0x9e)
388         BAD_TRAP(0x9f) GETCC_TRAP SETCC_TRAP GETPSR_TRAP
389         BAD_TRAP(0xa3) BAD_TRAP(0xa4) BAD_TRAP(0xa5) BAD_TRAP(0xa6)
390         BAD_TRAP(0xa7) BAD_TRAP(0xa8) BAD_TRAP(0xa9) BAD_TRAP(0xaa) BAD_TRAP(0xab)
391         BAD_TRAP(0xac) BAD_TRAP(0xad) BAD_TRAP(0xae) BAD_TRAP(0xaf) BAD_TRAP(0xb0)
392         BAD_TRAP(0xb1) BAD_TRAP(0xb2) BAD_TRAP(0xb3) BAD_TRAP(0xb4) BAD_TRAP(0xb5)
393         BAD_TRAP(0xb6) BAD_TRAP(0xb7) BAD_TRAP(0xb8) BAD_TRAP(0xb9) BAD_TRAP(0xba)
394         BAD_TRAP(0xbb) BAD_TRAP(0xbc) BAD_TRAP(0xbd) BAD_TRAP(0xbe) BAD_TRAP(0xbf)
395         BAD_TRAP(0xc0) BAD_TRAP(0xc1) BAD_TRAP(0xc2) BAD_TRAP(0xc3) BAD_TRAP(0xc4)
396         BAD_TRAP(0xc5) BAD_TRAP(0xc6) BAD_TRAP(0xc7) BAD_TRAP(0xc8) BAD_TRAP(0xc9)
397         BAD_TRAP(0xca) BAD_TRAP(0xcb) BAD_TRAP(0xcc) BAD_TRAP(0xcd) BAD_TRAP(0xce)
398         BAD_TRAP(0xcf) BAD_TRAP(0xd0) BAD_TRAP(0xd1) BAD_TRAP(0xd2) BAD_TRAP(0xd3)
399         BAD_TRAP(0xd4) BAD_TRAP(0xd5) BAD_TRAP(0xd6) BAD_TRAP(0xd7) BAD_TRAP(0xd8)
400         BAD_TRAP(0xd9) BAD_TRAP(0xda) BAD_TRAP(0xdb) BAD_TRAP(0xdc) BAD_TRAP(0xdd)
401         BAD_TRAP(0xde) BAD_TRAP(0xdf) BAD_TRAP(0xe0) BAD_TRAP(0xe1) BAD_TRAP(0xe2)
402         BAD_TRAP(0xe3) BAD_TRAP(0xe4) BAD_TRAP(0xe5) BAD_TRAP(0xe6) BAD_TRAP(0xe7)
403         BAD_TRAP(0xe8) BAD_TRAP(0xe9) BAD_TRAP(0xea) BAD_TRAP(0xeb) BAD_TRAP(0xec)
404         BAD_TRAP(0xed) BAD_TRAP(0xee) BAD_TRAP(0xef) BAD_TRAP(0xf0) BAD_TRAP(0xf1)
405         BAD_TRAP(0xf2) BAD_TRAP(0xf3) BAD_TRAP(0xf4) BAD_TRAP(0xf5) BAD_TRAP(0xf6)
406         BAD_TRAP(0xf7) BAD_TRAP(0xf8) BAD_TRAP(0xf9) BAD_TRAP(0xfa) BAD_TRAP(0xfb)
407         BAD_TRAP(0xfc) KGDB_TRAP(0xfd) BAD_TRAP(0xfe) BAD_TRAP(0xff)
408
409 #endif
410         .align PAGE_SIZE
411
412 /* This was the only reasonable way I could think of to properly align
413  * these page-table data structures.
414  */
415         .globl pg0, pg1, pg2, pg3
416         .globl empty_bad_page
417         .globl empty_bad_page_table
418         .globl empty_zero_page
419         .globl swapper_pg_dir
420 swapper_pg_dir:         .skip PAGE_SIZE
421 pg0:                    .skip PAGE_SIZE
422 pg1:                    .skip PAGE_SIZE
423 pg2:                    .skip PAGE_SIZE
424 pg3:                    .skip PAGE_SIZE
425 empty_bad_page:         .skip PAGE_SIZE
426 empty_bad_page_table:   .skip PAGE_SIZE
427 empty_zero_page:        .skip PAGE_SIZE
428
429         .global root_flags
430         .global ram_flags
431         .global root_dev
432         .global sparc_ramdisk_image
433         .global sparc_ramdisk_size
434
435 /* This stuff has to be in sync with SILO and other potential boot loaders
436  * Fields should be kept upward compatible and whenever any change is made,
437  * HdrS version should be incremented.
438  */
439         .ascii  "HdrS"
440         .word   LINUX_VERSION_CODE
441         .half   0x0203          /* HdrS version */
442 root_flags:
443         .half   1
444 root_dev:
445         .half   0
446 ram_flags:
447         .half   0
448 sparc_ramdisk_image:
449         .word   0
450 sparc_ramdisk_size:
451         .word   0
452         .word   reboot_command
453         .word   0, 0, 0
454         .word   _end
455
456 /* Cool, here we go. Pick up the romvec pointer in %o0 and stash it in
457  * %g7 and at prom_vector_p. And also quickly check whether we are on
458  * a v0, v2, or v3 prom.
459  */
460 gokernel:
461                 /* Ok, it's nice to know, as early as possible, if we
462                  * are already mapped where we expect to be in virtual
463                  * memory.  The Solaris /boot elf format bootloader
464                  * will peek into our elf header and load us where
465                  * we want to be, otherwise we have to re-map.
466                  *
467                  * Some boot loaders don't place the jmp'rs address
468                  * in %o7, so we do a pc-relative call to a local
469                  * label, then see what %o7 has.
470                  */
471
472                 mov     %o7, %g4                ! Save %o7
473
474                 /* Jump to it, and pray... */
475 current_pc:
476                 call    1f
477                  nop
478
479 1:
480                 mov     %o7, %g3
481
482                 tst     %o0
483                 be      no_sun4u_here
484                  mov    %g4, %o7                /* Previous %o7. */
485         
486                 mov     %o0, %l0                ! stash away romvec
487                 mov     %o0, %g7                ! put it here too
488                 mov     %o1, %l1                ! stash away debug_vec too
489
490                 /* Ok, let's check out our run time program counter. */
491                 set     current_pc, %g5
492                 cmp     %g3, %g5
493                 be      already_mapped
494                  nop 
495
496                 /* %l6 will hold the offset we have to subtract
497                  * from absolute symbols in order to access areas
498                  * in our own image.  If already mapped this is
499                  * just plain zero, else it is KERNBASE.
500                  */
501                 set     KERNBASE, %l6
502                 b       copy_prom_lvl14
503                  nop
504
505 already_mapped:
506                 mov     0, %l6
507
508                 /* Copy over the Prom's level 14 clock handler. */
509 copy_prom_lvl14:
510 #if 1
511                 /* DJHR
512                  * preserve our linked/calculated instructions
513                  */
514                 set     lvl14_save, %g1
515                 set     t_irq14, %g3
516                 sub     %g1, %l6, %g1           ! translate to physical
517                 sub     %g3, %l6, %g3           ! translate to physical
518                 ldd     [%g3], %g4
519                 std     %g4, [%g1]
520                 ldd     [%g3+8], %g4
521                 std     %g4, [%g1+8]
522 #endif
523                 rd      %tbr, %g1
524                 andn    %g1, 0xfff, %g1         ! proms trap table base
525                 or      %g0, (0x1e<<4), %g2     ! offset to lvl14 intr
526                 or      %g1, %g2, %g2
527                 set     t_irq14, %g3
528                 sub     %g3, %l6, %g3
529                 ldd     [%g2], %g4
530                 std     %g4, [%g3]
531                 ldd     [%g2 + 0x8], %g4
532                 std     %g4, [%g3 + 0x8]        ! Copy proms handler
533
534 /* Must determine whether we are on a sun4c MMU, SRMMU, or SUN4/400 MUTANT
535  * MMU so we can remap ourselves properly.  DON'T TOUCH %l0 thru %l5 in these
536  * remapping routines, we need their values afterwards!
537  */
538                 /* Now check whether we are already mapped, if we
539                  * are we can skip all this garbage coming up.
540                  */
541 copy_prom_done:
542                 cmp     %l6, 0
543                 be      go_to_highmem           ! this will be a nop then
544                  nop
545
546                 set     LOAD_ADDR, %g6
547                 cmp     %g7, %g6
548                 bne     remap_not_a_sun4        ! This is not a Sun4
549                  nop
550
551                 or      %g0, 0x1, %g1
552                 lduba   [%g1] ASI_CONTROL, %g1  ! Only safe to try on Sun4.
553                 subcc   %g1, 0x24, %g0          ! Is this a mutant Sun4/400???
554                 be      sun4_mutant_remap       ! Ugh, it is...
555                  nop
556
557                 b       sun4_normal_remap       ! regular sun4, 2 level mmu
558                  nop
559
560 remap_not_a_sun4:
561                 lda     [%g0] ASI_M_MMUREGS, %g1 ! same as ASI_PTE on sun4c
562                 and     %g1, 0x1, %g1           ! Test SRMMU Enable bit ;-)
563                 cmp     %g1, 0x0
564                 be      sun4c_remap             ! A sun4c MMU or normal Sun4
565                  nop
566 srmmu_remap:
567                 /* First, check for a viking (TI) module. */
568                 set     0x40000000, %g2
569                 rd      %psr, %g3
570                 and     %g2, %g3, %g3
571                 subcc   %g3, 0x0, %g0
572                 bz      srmmu_nviking
573                  nop
574
575                 /* Figure out what kind of viking we are on.
576                  * We need to know if we have to play with the
577                  * AC bit and disable traps or not.
578                  */
579
580                 /* I've only seen MicroSparc's on SparcClassics with this
581                  * bit set.
582                  */
583                 set     0x800, %g2
584                 lda     [%g0] ASI_M_MMUREGS, %g3        ! peek in the control reg
585                 and     %g2, %g3, %g3
586                 subcc   %g3, 0x0, %g0
587                 bnz     srmmu_nviking                   ! is in mbus mode
588                  nop
589                 
590                 rd      %psr, %g3                       ! DO NOT TOUCH %g3
591                 andn    %g3, PSR_ET, %g2
592                 wr      %g2, 0x0, %psr
593                 WRITE_PAUSE
594                 
595                 /* Get context table pointer, then convert to
596                  * a physical address, which is 36 bits.
597                  */
598                 set     AC_M_CTPR, %g4
599                 lda     [%g4] ASI_M_MMUREGS, %g4
600                 sll     %g4, 0x4, %g4                   ! We use this below
601                                                         ! DO NOT TOUCH %g4
602
603                 /* Set the AC bit in the Viking's MMU control reg. */
604                 lda     [%g0] ASI_M_MMUREGS, %g5        ! DO NOT TOUCH %g5
605                 set     0x8000, %g6                     ! AC bit mask
606                 or      %g5, %g6, %g6                   ! Or it in...
607                 sta     %g6, [%g0] ASI_M_MMUREGS        ! Close your eyes...
608
609                 /* Grrr, why does it seem like every other load/store
610                  * on the sun4m is in some ASI space...
611                  * Fine with me, let's get the pointer to the level 1
612                  * page table directory and fetch its entry.
613                  */
614                 lda     [%g4] ASI_M_BYPASS, %o1         ! This is a level 1 ptr
615                 srl     %o1, 0x4, %o1                   ! Clear low 4 bits
616                 sll     %o1, 0x8, %o1                   ! Make physical
617                 
618                 /* Ok, pull in the PTD. */
619                 lda     [%o1] ASI_M_BYPASS, %o2         ! This is the 0x0 16MB pgd
620
621                 /* Calculate to KERNBASE entry. */
622                 add     %o1, KERNBASE >> (SRMMU_PGDIR_SHIFT - 2), %o3           
623
624                 /* Poke the entry into the calculated address. */
625                 sta     %o2, [%o3] ASI_M_BYPASS
626
627                 /* I don't get it Sun, if you engineered all these
628                  * boot loaders and the PROM (thank you for the debugging
629                  * features btw) why did you not have them load kernel
630                  * images up in high address space, since this is necessary
631                  * for ABI compliance anyways?  Does this low-mapping provide
632                  * enhanced interoperability?
633                  *
634                  * "The PROM is the computer."
635                  */
636
637                 /* Ok, restore the MMU control register we saved in %g5 */
638                 sta     %g5, [%g0] ASI_M_MMUREGS        ! POW... ouch
639
640                 /* Turn traps back on.  We saved it in %g3 earlier. */
641                 wr      %g3, 0x0, %psr                  ! tick tock, tick tock
642
643                 /* Now we burn precious CPU cycles due to bad engineering. */
644                 WRITE_PAUSE
645
646                 /* Wow, all that just to move a 32-bit value from one
647                  * place to another...  Jump to high memory.
648                  */
649                 b       go_to_highmem
650                  nop
651
652                 /* This works on viking's in Mbus mode and all
653                  * other MBUS modules.  It is virtually the same as
654                  * the above madness sans turning traps off and flipping
655                  * the AC bit.
656                  */
657 srmmu_nviking:
658                 set     AC_M_CTPR, %g1
659                 lda     [%g1] ASI_M_MMUREGS, %g1        ! get ctx table ptr
660                 sll     %g1, 0x4, %g1                   ! make physical addr
661                 lda     [%g1] ASI_M_BYPASS, %g1         ! ptr to level 1 pg_table
662                 srl     %g1, 0x4, %g1
663                 sll     %g1, 0x8, %g1                   ! make phys addr for l1 tbl
664
665                 lda     [%g1] ASI_M_BYPASS, %g2         ! get level1 entry for 0x0
666                 add     %g1, KERNBASE >> (SRMMU_PGDIR_SHIFT - 2), %g3
667                 sta     %g2, [%g3] ASI_M_BYPASS         ! place at KERNBASE entry
668                 b       go_to_highmem
669                  nop                                    ! wheee....
670
671                 /* This remaps the kernel on Sun4/4xx machines
672                  * that have the Sun Mutant Three Level MMU.
673                  * It's like a platypus, Sun didn't have the
674                  * SRMMU in conception so they kludged the three
675                  * level logic in the regular Sun4 MMU probably.
676                  *
677                  * Basically, you take each entry in the top level
678                  * directory that maps the low 3MB starting at
679                  * address zero and put the mapping in the KERNBASE
680                  * slots.  These top level pgd's are called regmaps.
681                  */
682 sun4_mutant_remap:
683                 or      %g0, %g0, %g3           ! source base
684                 sethi   %hi(KERNBASE), %g4      ! destination base
685                 or      %g4, %lo(KERNBASE), %g4
686                 sethi   %hi(0x300000), %g5
687                 or      %g5, %lo(0x300000), %g5 ! upper bound 3MB
688                 or      %g0, 0x1, %l6
689                 sll     %l6, 24, %l6            ! Regmap mapping size
690                 add     %g3, 0x2, %g3           ! Base magic
691                 add     %g4, 0x2, %g4           ! Base magic
692
693                 /* Main remapping loop on Sun4-Mutant-MMU.
694                  * "I am not an animal..." -Famous Mutant Person
695                  */
696 sun4_mutant_loop:
697                 lduha   [%g3] ASI_REGMAP, %g2   ! Get lower entry
698                 stha    %g2, [%g4] ASI_REGMAP   ! Store in high entry
699                 add     %g4, %l6, %g4           ! Move up high memory ptr
700                 subcc   %g3, %g5, %g0           ! Reached our limit?
701                 blu     sun4_mutant_loop        ! Nope, loop again
702                  add    %g3, %l6, %g3           ! delay, Move up low ptr
703                 b       go_to_highmem           ! Jump to high memory.
704                  nop
705
706                 /* The following is for non-4/4xx sun4 MMU's. */
707 sun4_normal_remap:
708                 mov     0, %g3                  ! source base
709                 set     KERNBASE, %g4           ! destination base
710                 set     0x300000, %g5           ! upper bound 3MB
711                 mov     1, %l6
712                 sll     %l6, 18, %l6            ! sun4 mmu segmap size
713 sun4_normal_loop:
714                 lduha   [%g3] ASI_SEGMAP, %g6   ! load phys_seg
715                 stha    %g6, [%g4] ASI_SEGMAP   ! stort new virt mapping
716                 add     %g3, %l6, %g3           ! increment source pointer
717                 subcc   %g3, %g5, %g0           ! reached limit?
718                 blu     sun4_normal_loop        ! nope, loop again
719                  add    %g4, %l6, %g4           ! delay, increment dest ptr
720                 b       go_to_highmem
721                  nop
722
723                 /* The following works for Sun4c MMU's */
724 sun4c_remap:
725                 mov     0, %g3                  ! source base
726                 set     KERNBASE, %g4           ! destination base
727                 set     0x300000, %g5           ! upper bound 3MB
728                 mov     1, %l6
729                 sll     %l6, 18, %l6            ! sun4c mmu segmap size
730 sun4c_remap_loop:
731                 lda     [%g3] ASI_SEGMAP, %g6   ! load phys_seg
732                 sta     %g6, [%g4] ASI_SEGMAP   ! store new virt mapping
733                 add     %g3, %l6, %g3           ! Increment source ptr
734                 subcc   %g3, %g5, %g0           ! Reached limit?
735                 bl      sun4c_remap_loop        ! Nope, loop again
736                  add    %g4, %l6, %g4           ! delay, Increment dest ptr
737
738 /* Now do a non-relative jump so that PC is in high-memory */
739 go_to_highmem:
740                 set     execute_in_high_mem, %g1
741                 jmpl    %g1, %g0
742                  nop
743
744 /* The code above should be at beginning and we have to take care about
745  * short jumps, as branching to .text.init section from .text is usually
746  * impossible */
747                 __INIT
748 /* Acquire boot time privileged register values, this will help debugging.
749  * I figure out and store nwindows and nwindowsm1 later on.
750  */
751 execute_in_high_mem:
752                 mov     %l0, %o0                ! put back romvec
753                 mov     %l1, %o1                ! and debug_vec
754
755                 sethi   %hi(prom_vector_p), %g1
756                 st      %o0, [%g1 + %lo(prom_vector_p)]
757
758                 sethi   %hi(linux_dbvec), %g1
759                 st      %o1, [%g1 + %lo(linux_dbvec)]
760
761                 ld      [%o0 + 0x4], %o3
762                 and     %o3, 0x3, %o5                   ! get the version
763
764                 cmp     %o3, 0x2                        ! a v2 prom?
765                 be      found_version
766                  nop
767
768                 /* paul@sfe.com.au */
769                 cmp     %o3, 0x3                        ! a v3 prom?
770                 be      found_version
771                  nop
772
773 /* Old sun4's pass our load address into %o0 instead of the prom
774  * pointer. On sun4's you have to hard code the romvec pointer into
775  * your code. Sun probably still does that because they don't even
776  * trust their own "OpenBoot" specifications.
777  */
778                 set     LOAD_ADDR, %g6
779                 cmp     %o0, %g6                ! an old sun4?
780                 be      sun4_init
781                  nop
782
783 found_version:
784 #ifdef CONFIG_SUN4
785 /* For people who try sun4 kernels, even if Configure.help advises them. */
786                 ld      [%g7 + 0x68], %o1
787                 set     sun4cdm_notsup, %o0
788                 call    %o1
789                  nop
790                 b       halt_me
791                  nop
792 #endif
793 /* Get the machine type via the mysterious romvec node operations. */
794
795                 add     %g7, 0x1c, %l1          
796                 ld      [%l1], %l0
797                 ld      [%l0], %l0
798                 call    %l0
799                  or     %g0, %g0, %o0           ! next_node(0) = first_node
800                 or      %o0, %g0, %g6
801
802                 sethi   %hi(cputypvar), %o1     ! First node has cpu-arch
803                 or      %o1, %lo(cputypvar), %o1
804                 sethi   %hi(cputypval), %o2     ! information, the string
805                 or      %o2, %lo(cputypval), %o2
806                 ld      [%l1], %l0              ! 'compatibility' tells
807                 ld      [%l0 + 0xc], %l0        ! that we want 'sun4x' where
808                 call    %l0                     ! x is one of '', 'c', 'm',
809                  nop                            ! 'd' or 'e'. %o2 holds pointer
810                                                 ! to a buf where above string
811                                                 ! will get stored by the prom.
812
813                 subcc   %o0, %g0, %g0
814                 bpos    got_prop                ! Got the property
815                  nop
816
817                 or      %g6, %g0, %o0
818                 sethi   %hi(cputypvar_sun4m), %o1
819                 or      %o1, %lo(cputypvar_sun4m), %o1
820                 sethi   %hi(cputypval), %o2
821                 or      %o2, %lo(cputypval), %o2
822                 ld      [%l1], %l0
823                 ld      [%l0 + 0xc], %l0
824                 call    %l0
825                  nop
826
827 got_prop:
828                 set     cputypval, %o2
829                 ldub    [%o2 + 0x4], %l1
830
831                 cmp     %l1, ' '
832                 be      1f
833                  cmp    %l1, 'c'
834                 be      1f
835                  cmp    %l1, 'm'
836                 be      1f
837                  cmp    %l1, 's'
838                 be      1f
839                  cmp    %l1, 'd'
840                 be      1f
841                  cmp    %l1, 'e'
842                 be      no_sun4e_here           ! Could be a sun4e.
843                  nop
844                 b       no_sun4u_here           ! AIEEE, a V9 sun4u... Get our BIG BROTHER kernel :))
845                  nop
846
847 1:              set     cputypval, %l1
848                 ldub    [%l1 + 0x4], %l1
849                 cmp     %l1, 'm'                ! Test for sun4d, sun4e ?
850                 be      sun4m_init
851                  cmp    %l1, 's'                ! Treat sun4s as sun4m
852                 be      sun4m_init
853                  cmp    %l1, 'd'                ! Let us see how the beast will die
854                 be      sun4d_init
855                  nop
856
857                 /* Jump into mmu context zero. */
858                 set     AC_CONTEXT, %g1
859                 stba    %g0, [%g1] ASI_CONTROL
860
861                 b       sun4c_continue_boot
862                  nop
863
864 /* CPUID in bootbus can be found at PA 0xff0140000 */
865 #define SUN4D_BOOTBUS_CPUID     0xf0140000
866
867 sun4d_init:
868         /* Need to patch call to handler_irq */
869         set     patch_handler_irq, %g4
870         set     sun4d_handler_irq, %g5
871         sethi   %hi(0x40000000), %g3            ! call
872         sub     %g5, %g4, %g5
873         srl     %g5, 2, %g5
874         or      %g5, %g3, %g5
875         st      %g5, [%g4]
876
877 #ifdef CONFIG_SMP
878         /* Get our CPU id out of bootbus */
879         set     SUN4D_BOOTBUS_CPUID, %g3
880         lduba   [%g3] ASI_M_CTL, %g3
881         and     %g3, 0xf8, %g3
882         srl     %g3, 3, %g4
883         sta     %g4, [%g0] ASI_M_VIKING_TMP1
884         sethi   %hi(boot_cpu_id), %g5
885         stb     %g4, [%g5 + %lo(boot_cpu_id)]
886         sll     %g4, 2, %g4
887         sethi   %hi(boot_cpu_id4), %g5
888         stb     %g4, [%g5 + %lo(boot_cpu_id4)]
889 #endif
890
891         /* Fall through to sun4m_init */
892
893 sun4m_init:
894         /* XXX Fucking Cypress... */
895         lda     [%g0] ASI_M_MMUREGS, %g5
896         srl     %g5, 28, %g4
897
898         cmp     %g4, 1
899         bne     1f
900          srl    %g5, 24, %g4
901
902         and     %g4, 0xf, %g4
903         cmp     %g4, 7          /* This would be a HyperSparc. */
904
905         bne     2f
906          nop
907
908 1:
909
910 #define PATCH_IT(dst, src)      \
911         set     (dst), %g5;     \
912         set     (src), %g4;     \
913         ld      [%g4], %g3;     \
914         st      %g3, [%g5];     \
915         ld      [%g4+0x4], %g3; \
916         st      %g3, [%g5+0x4];
917
918         /* Signed multiply. */
919         PATCH_IT(.mul, .mul_patch)
920         PATCH_IT(.mul+0x08, .mul_patch+0x08)
921
922         /* Signed remainder. */
923         PATCH_IT(.rem, .rem_patch)
924         PATCH_IT(.rem+0x08, .rem_patch+0x08)
925         PATCH_IT(.rem+0x10, .rem_patch+0x10)
926         PATCH_IT(.rem+0x18, .rem_patch+0x18)
927         PATCH_IT(.rem+0x20, .rem_patch+0x20)
928         PATCH_IT(.rem+0x28, .rem_patch+0x28)
929
930         /* Signed division. */
931         PATCH_IT(.div, .div_patch)
932         PATCH_IT(.div+0x08, .div_patch+0x08)
933         PATCH_IT(.div+0x10, .div_patch+0x10)
934         PATCH_IT(.div+0x18, .div_patch+0x18)
935         PATCH_IT(.div+0x20, .div_patch+0x20)
936
937         /* Unsigned multiply. */
938         PATCH_IT(.umul, .umul_patch)
939         PATCH_IT(.umul+0x08, .umul_patch+0x08)
940
941         /* Unsigned remainder. */
942         PATCH_IT(.urem, .urem_patch)
943         PATCH_IT(.urem+0x08, .urem_patch+0x08)
944         PATCH_IT(.urem+0x10, .urem_patch+0x10)
945         PATCH_IT(.urem+0x18, .urem_patch+0x18)
946
947         /* Unsigned division. */
948         PATCH_IT(.udiv, .udiv_patch)
949         PATCH_IT(.udiv+0x08, .udiv_patch+0x08)
950         PATCH_IT(.udiv+0x10, .udiv_patch+0x10)
951
952 #undef PATCH_IT
953
954 /* Ok, the PROM could have done funny things and apple cider could still
955  * be sitting in the fault status/address registers.  Read them all to
956  * clear them so we don't get magic faults later on.
957  */
958 /* This sucks, apparently this makes Vikings call prom panic, will fix later */
959 2:
960                 rd      %psr, %o1
961                 srl     %o1, 28, %o1            ! Get a type of the CPU
962
963                 subcc   %o1, 4, %g0             ! TI: Viking or MicroSPARC
964                 be      sun4c_continue_boot
965                  nop
966
967                 set     AC_M_SFSR, %o0
968                 lda     [%o0] ASI_M_MMUREGS, %g0
969                 set     AC_M_SFAR, %o0
970                 lda     [%o0] ASI_M_MMUREGS, %g0
971
972                 /* Fujitsu MicroSPARC-II has no asynchronous flavors of FARs */
973                 subcc   %o1, 0, %g0
974                 be      sun4c_continue_boot
975                  nop
976
977                 set     AC_M_AFSR, %o0
978                 lda     [%o0] ASI_M_MMUREGS, %g0
979                 set     AC_M_AFAR, %o0
980                 lda     [%o0] ASI_M_MMUREGS, %g0
981                  nop
982
983
984 sun4c_continue_boot:
985
986
987 /* Aieee, now set PC and nPC, enable traps, give ourselves a stack and it's
988  * show-time!
989  */
990
991                 sethi   %hi(cputyp), %o0
992                 st      %g4, [%o0 + %lo(cputyp)]
993
994                 /* Turn on Supervisor, EnableFloating, and all the PIL bits.
995                  * Also puts us in register window zero with traps off.
996                  */
997                 set     (PSR_PS | PSR_S | PSR_PIL | PSR_EF), %g2
998                 wr      %g2, 0x0, %psr
999                 WRITE_PAUSE
1000
1001                 /* I want a kernel stack NOW! */
1002                 set     init_thread_union, %g1
1003                 set     (THREAD_SIZE - STACKFRAME_SZ), %g2
1004                 add     %g1, %g2, %sp
1005                 mov     0, %fp                  /* And for good luck */
1006
1007                 /* Zero out our BSS section. */
1008                 set     __bss_start , %o0       ! First address of BSS
1009                 set     end , %o1               ! Last address of BSS
1010                 add     %o0, 0x1, %o0
1011 1:      
1012                 stb     %g0, [%o0]
1013                 subcc   %o0, %o1, %g0
1014                 bl      1b
1015                  add    %o0, 0x1, %o0
1016
1017                 /* Initialize the uwinmask value for init task just in case.
1018                  * But first make current_set[boot_cpu_id] point to something useful.
1019                  */
1020                 set     init_thread_union, %g6
1021                 set     current_set, %g2
1022 #ifdef CONFIG_SMP
1023                 sethi   %hi(boot_cpu_id4), %g3
1024                 ldub    [%g3 + %lo(boot_cpu_id4)], %g3
1025                 st      %g6, [%g2]
1026                 add     %g2, %g3, %g2
1027 #endif
1028                 st      %g6, [%g2]
1029
1030                 st      %g0, [%g6 + TI_UWINMASK]
1031
1032 /* Compute NWINDOWS and stash it away. Now uses %wim trick explained
1033  * in the V8 manual. Ok, this method seems to work, Sparc is cool...
1034  * No, it doesn't work, have to play the save/readCWP/restore trick.
1035  */
1036
1037                 wr      %g0, 0x0, %wim                  ! so we do not get a trap
1038                 WRITE_PAUSE
1039
1040                 save
1041
1042                 rd      %psr, %g3
1043
1044                 restore
1045
1046                 and     %g3, 0x1f, %g3
1047                 add     %g3, 0x1, %g3
1048
1049                 mov     2, %g1
1050                 wr      %g1, 0x0, %wim                  ! make window 1 invalid
1051                 WRITE_PAUSE
1052
1053                 cmp     %g3, 0x7
1054                 bne     2f
1055                  nop
1056
1057                 /* Adjust our window handling routines to
1058                  * do things correctly on 7 window Sparcs.
1059                  */
1060
1061 #define         PATCH_INSN(src, dest) \
1062                 set     src, %g5; \
1063                 set     dest, %g2; \
1064                 ld      [%g5], %g4; \
1065                 st      %g4, [%g2];
1066         
1067                 /* Patch for window spills... */
1068                 PATCH_INSN(spnwin_patch1_7win, spnwin_patch1)
1069                 PATCH_INSN(spnwin_patch2_7win, spnwin_patch2)
1070                 PATCH_INSN(spnwin_patch3_7win, spnwin_patch3)
1071
1072                 /* Patch for window fills... */
1073                 PATCH_INSN(fnwin_patch1_7win, fnwin_patch1)
1074                 PATCH_INSN(fnwin_patch2_7win, fnwin_patch2)
1075
1076                 /* Patch for trap entry setup... */
1077                 PATCH_INSN(tsetup_7win_patch1, tsetup_patch1)
1078                 PATCH_INSN(tsetup_7win_patch2, tsetup_patch2)
1079                 PATCH_INSN(tsetup_7win_patch3, tsetup_patch3)
1080                 PATCH_INSN(tsetup_7win_patch4, tsetup_patch4)
1081                 PATCH_INSN(tsetup_7win_patch5, tsetup_patch5)
1082                 PATCH_INSN(tsetup_7win_patch6, tsetup_patch6)
1083
1084                 /* Patch for returning from traps... */
1085                 PATCH_INSN(rtrap_7win_patch1, rtrap_patch1)
1086                 PATCH_INSN(rtrap_7win_patch2, rtrap_patch2)
1087                 PATCH_INSN(rtrap_7win_patch3, rtrap_patch3)
1088                 PATCH_INSN(rtrap_7win_patch4, rtrap_patch4)
1089                 PATCH_INSN(rtrap_7win_patch5, rtrap_patch5)
1090
1091                 /* Patch for killing user windows from the register file. */
1092                 PATCH_INSN(kuw_patch1_7win, kuw_patch1)
1093
1094                 /* Now patch the kernel window flush sequences.
1095                  * This saves 2 traps on every switch and fork.
1096                  */
1097                 set     0x01000000, %g4
1098                 set     flush_patch_one, %g5
1099                 st      %g4, [%g5 + 0x18]
1100                 st      %g4, [%g5 + 0x1c]
1101                 set     flush_patch_two, %g5
1102                 st      %g4, [%g5 + 0x18]
1103                 st      %g4, [%g5 + 0x1c]
1104                 set     flush_patch_three, %g5
1105                 st      %g4, [%g5 + 0x18]
1106                 st      %g4, [%g5 + 0x1c]
1107                 set     flush_patch_four, %g5
1108                 st      %g4, [%g5 + 0x18]
1109                 st      %g4, [%g5 + 0x1c]
1110                 set     flush_patch_exception, %g5
1111                 st      %g4, [%g5 + 0x18]
1112                 st      %g4, [%g5 + 0x1c]
1113                 set     flush_patch_switch, %g5
1114                 st      %g4, [%g5 + 0x18]
1115                 st      %g4, [%g5 + 0x1c]
1116
1117 2:              
1118                 sethi   %hi(nwindows), %g4
1119                 st      %g3, [%g4 + %lo(nwindows)]      ! store final value
1120                 sub     %g3, 0x1, %g3
1121                 sethi   %hi(nwindowsm1), %g4
1122                 st      %g3, [%g4 + %lo(nwindowsm1)]
1123
1124                 /* Here we go, start using Linux's trap table... */
1125                 set     trapbase, %g3
1126                 wr      %g3, 0x0, %tbr
1127                 WRITE_PAUSE
1128
1129                 /* Finally, turn on traps so that we can call c-code. */
1130                 rd      %psr, %g3
1131                 wr      %g3, 0x0, %psr
1132                 WRITE_PAUSE
1133
1134                 wr      %g3, PSR_ET, %psr
1135                 WRITE_PAUSE
1136
1137                 /* First we call prom_init() to set up PROMLIB, then
1138                  * off to start_kernel().
1139                  */
1140
1141                 sethi   %hi(prom_vector_p), %g5
1142                 ld      [%g5 + %lo(prom_vector_p)], %o0
1143                 call    prom_init
1144                  nop
1145
1146                 call    start_kernel
1147                  nop
1148         
1149                 /* We should not get here. */
1150                 call    halt_me
1151                  nop
1152
1153 sun4_init:
1154 #ifdef CONFIG_SUN4
1155 /* There, happy now Adrian? */
1156                 set     cputypval, %o2          ! Let everyone know we
1157                 set     ' ', %o0                        ! are a "sun4 " architecture
1158                 stb     %o0, [%o2 + 0x4]                
1159
1160                 b got_prop 
1161                  nop
1162 #else
1163                 sethi   %hi(SUN4_PROM_VECTOR+0x84), %o1
1164                 ld      [%o1 + %lo(SUN4_PROM_VECTOR+0x84)], %o1
1165                 set     sun4_notsup, %o0
1166                 call    %o1     /* printf */
1167                  nop
1168                 sethi   %hi(SUN4_PROM_VECTOR+0xc4), %o1
1169                 ld      [%o1 + %lo(SUN4_PROM_VECTOR+0xc4)], %o1
1170                 call    %o1     /* exittomon */
1171                  nop
1172 1:              ba      1b                      ! Cannot exit into KMON
1173                  nop
1174 #endif
1175 no_sun4e_here:
1176                 ld      [%g7 + 0x68], %o1
1177                 set     sun4e_notsup, %o0
1178                 call    %o1
1179                  nop
1180                 b       halt_me
1181                  nop
1182
1183                 __INITDATA
1184
1185 sun4u_1:
1186                 .asciz "finddevice"
1187                 .align  4
1188 sun4u_2:
1189                 .asciz "/chosen"
1190                 .align  4
1191 sun4u_3:
1192                 .asciz "getprop"
1193                 .align  4
1194 sun4u_4:
1195                 .asciz "stdout"
1196                 .align  4
1197 sun4u_5:
1198                 .asciz "write"
1199                 .align  4
1200 sun4u_6:
1201                 .asciz  "\n\rOn sun4u you have to use UltraLinux (64bit) kernel\n\rand not a 32bit sun4[cdem] version\n\r\n\r"
1202 sun4u_6e:
1203                 .align  4
1204 sun4u_7:
1205                 .asciz "exit"
1206                 .align  8
1207 sun4u_a1:
1208                 .word   0, sun4u_1, 0, 1, 0, 1, 0, sun4u_2, 0
1209 sun4u_r1:
1210                 .word   0
1211 sun4u_a2:
1212                 .word   0, sun4u_3, 0, 4, 0, 1, 0
1213 sun4u_i2:
1214                 .word   0, 0, sun4u_4, 0, sun4u_1, 0, 8, 0
1215 sun4u_r2:
1216                 .word   0
1217 sun4u_a3:
1218                 .word   0, sun4u_5, 0, 3, 0, 1, 0
1219 sun4u_i3:
1220                 .word   0, 0, sun4u_6, 0, sun4u_6e - sun4u_6 - 1, 0
1221 sun4u_r3:
1222                 .word   0
1223 sun4u_a4:
1224                 .word   0, sun4u_7, 0, 0, 0, 0
1225 sun4u_r4:
1226
1227                 __INIT
1228 no_sun4u_here:
1229                 set     sun4u_a1, %o0
1230                 set     current_pc, %l2
1231                 cmp     %l2, %g3
1232                 be      1f
1233                  mov    %o4, %l0
1234                 sub     %g3, %l2, %l6
1235                 add     %o0, %l6, %o0
1236                 mov     %o0, %l4
1237                 mov     sun4u_r4 - sun4u_a1, %l3
1238                 ld      [%l4], %l5
1239 2:
1240                 add     %l4, 4, %l4
1241                 cmp     %l5, %l2
1242                 add     %l5, %l6, %l5
1243                 bgeu,a  3f
1244                  st     %l5, [%l4 - 4]
1245 3:
1246                 subcc   %l3, 4, %l3
1247                 bne     2b
1248                  ld     [%l4], %l5
1249 1:
1250                 call    %l0
1251                  mov    %o0, %l1
1252
1253                 ld      [%l1 + (sun4u_r1 - sun4u_a1)], %o1
1254                 add     %l1, (sun4u_a2 - sun4u_a1), %o0
1255                 call    %l0
1256                  st     %o1, [%o0 + (sun4u_i2 - sun4u_a2)]
1257
1258                 ld      [%l1 + (sun4u_1 - sun4u_a1)], %o1
1259                 add     %l1, (sun4u_a3 - sun4u_a1), %o0
1260                 call    %l0
1261                 st      %o1, [%o0 + (sun4u_i3 - sun4u_a3)]
1262
1263                 call    %l0
1264                  add    %l1, (sun4u_a4 - sun4u_a1), %o0
1265
1266                 /* Not reached */
1267 halt_me:
1268                 ld      [%g7 + 0x74], %o0
1269                 call    %o0                     ! Get us out of here...
1270                  nop                            ! Apparently Solaris is better.
1271
1272 /* Ok, now we continue in the .data/.text sections */
1273
1274         .data
1275         .align 4
1276
1277 /*
1278  * Fill up the prom vector, note in particular the kind first element,
1279  * no joke. I don't need all of them in here as the entire prom vector
1280  * gets initialized in c-code so all routines can use it.
1281  */
1282
1283         .globl  prom_vector_p
1284 prom_vector_p:
1285                 .word 0
1286
1287 /* We calculate the following at boot time, window fills/spills and trap entry
1288  * code uses these to keep track of the register windows.
1289  */
1290
1291         .align 4
1292         .globl  nwindows
1293         .globl  nwindowsm1
1294 nwindows:
1295         .word   8
1296 nwindowsm1:
1297         .word   7
1298
1299 /* Boot time debugger vector value.  We need this later on. */
1300
1301         .align 4
1302         .globl  linux_dbvec
1303 linux_dbvec:
1304         .word   0
1305         .word   0
1306
1307         .align 8
1308
1309         .globl  lvl14_save
1310 lvl14_save:
1311         .word   0
1312         .word   0
1313         .word   0
1314         .word   0
1315         .word   t_irq14
1316
1317         .section        ".fixup",#alloc,#execinstr
1318         .globl  __ret_efault
1319 __ret_efault:
1320         ret
1321          restore %g0, -EFAULT, %o0